PES4 / Mbed OS Queue_02
Committer:
demayer
Date:
Sat Mar 28 15:28:19 2020 +0000
Revision:
0:6bf0743ece18
IMU Thread with an event-queue running parallel to handle tasks like a 5 times blinking LED. Button with interrupt detected.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
demayer 0:6bf0743ece18 1 /* mbed Microcontroller Library
demayer 0:6bf0743ece18 2 * Copyright (c) 2017-2017 ARM Limited
demayer 0:6bf0743ece18 3 *
demayer 0:6bf0743ece18 4 * Licensed under the Apache License, Version 2.0 (the "License");
demayer 0:6bf0743ece18 5 * you may not use this file except in compliance with the License.
demayer 0:6bf0743ece18 6 * You may obtain a copy of the License at
demayer 0:6bf0743ece18 7 *
demayer 0:6bf0743ece18 8 * http://www.apache.org/licenses/LICENSE-2.0
demayer 0:6bf0743ece18 9 *
demayer 0:6bf0743ece18 10 * Unless required by applicable law or agreed to in writing, software
demayer 0:6bf0743ece18 11 * distributed under the License is distributed on an "AS IS" BASIS,
demayer 0:6bf0743ece18 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
demayer 0:6bf0743ece18 13 * See the License for the specific language governing permissions and
demayer 0:6bf0743ece18 14 * limitations under the License.
demayer 0:6bf0743ece18 15 */
demayer 0:6bf0743ece18 16
demayer 0:6bf0743ece18 17 #include "mbed_mktime.h"
demayer 0:6bf0743ece18 18
demayer 0:6bf0743ece18 19 /*
demayer 0:6bf0743ece18 20 * time constants
demayer 0:6bf0743ece18 21 */
demayer 0:6bf0743ece18 22 #define SECONDS_BY_MINUTES 60
demayer 0:6bf0743ece18 23 #define MINUTES_BY_HOUR 60
demayer 0:6bf0743ece18 24 #define SECONDS_BY_HOUR (SECONDS_BY_MINUTES * MINUTES_BY_HOUR)
demayer 0:6bf0743ece18 25 #define HOURS_BY_DAY 24
demayer 0:6bf0743ece18 26 #define SECONDS_BY_DAY (SECONDS_BY_HOUR * HOURS_BY_DAY)
demayer 0:6bf0743ece18 27
demayer 0:6bf0743ece18 28 /*
demayer 0:6bf0743ece18 29 * 2 dimensional array containing the number of seconds elapsed before a given
demayer 0:6bf0743ece18 30 * month.
demayer 0:6bf0743ece18 31 * The second index map to the month while the first map to the type of year:
demayer 0:6bf0743ece18 32 * - 0: non leap year
demayer 0:6bf0743ece18 33 * - 1: leap year
demayer 0:6bf0743ece18 34 */
demayer 0:6bf0743ece18 35 static const uint32_t seconds_before_month[2][12] = {
demayer 0:6bf0743ece18 36 {
demayer 0:6bf0743ece18 37 0,
demayer 0:6bf0743ece18 38 31 * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 39 (31 + 28) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 40 (31 + 28 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 41 (31 + 28 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 42 (31 + 28 + 31 + 30 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 43 (31 + 28 + 31 + 30 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 44 (31 + 28 + 31 + 30 + 31 + 30 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 45 (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 46 (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 47 (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31 + 30 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 48 (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31 + 30 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 49 },
demayer 0:6bf0743ece18 50 {
demayer 0:6bf0743ece18 51 0,
demayer 0:6bf0743ece18 52 31 * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 53 (31 + 29) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 54 (31 + 29 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 55 (31 + 29 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 56 (31 + 29 + 31 + 30 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 57 (31 + 29 + 31 + 30 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 58 (31 + 29 + 31 + 30 + 31 + 30 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 59 (31 + 29 + 31 + 30 + 31 + 30 + 31 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 60 (31 + 29 + 31 + 30 + 31 + 30 + 31 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 61 (31 + 29 + 31 + 30 + 31 + 30 + 31 + 31 + 30 + 31) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 62 (31 + 29 + 31 + 30 + 31 + 30 + 31 + 31 + 30 + 31 + 30) * SECONDS_BY_DAY,
demayer 0:6bf0743ece18 63 }
demayer 0:6bf0743ece18 64 };
demayer 0:6bf0743ece18 65
demayer 0:6bf0743ece18 66 bool _rtc_is_leap_year(int year) {
demayer 0:6bf0743ece18 67 /*
demayer 0:6bf0743ece18 68 * since in practice, the value manipulated by this algorithm lie in the
demayer 0:6bf0743ece18 69 * range [70 : 138], the algorith can be reduced to: year % 4.
demayer 0:6bf0743ece18 70 * The algorithm valid over the full range of value is:
demayer 0:6bf0743ece18 71
demayer 0:6bf0743ece18 72 year = 1900 + year;
demayer 0:6bf0743ece18 73 if (year % 4) {
demayer 0:6bf0743ece18 74 return false;
demayer 0:6bf0743ece18 75 } else if (year % 100) {
demayer 0:6bf0743ece18 76 return true;
demayer 0:6bf0743ece18 77 } else if (year % 400) {
demayer 0:6bf0743ece18 78 return false;
demayer 0:6bf0743ece18 79 }
demayer 0:6bf0743ece18 80 return true;
demayer 0:6bf0743ece18 81
demayer 0:6bf0743ece18 82 */
demayer 0:6bf0743ece18 83 return (year) % 4 ? false : true;
demayer 0:6bf0743ece18 84 }
demayer 0:6bf0743ece18 85
demayer 0:6bf0743ece18 86 time_t _rtc_mktime(const struct tm* time) {
demayer 0:6bf0743ece18 87 // partial check for the upper bound of the range
demayer 0:6bf0743ece18 88 // normalization might happen at the end of the function
demayer 0:6bf0743ece18 89 // this solution is faster than checking if the input is after the 19th of
demayer 0:6bf0743ece18 90 // january 2038 at 03:14:07.
demayer 0:6bf0743ece18 91 if ((time->tm_year < 70) || (time->tm_year > 138)) {
demayer 0:6bf0743ece18 92 return ((time_t) -1);
demayer 0:6bf0743ece18 93 }
demayer 0:6bf0743ece18 94
demayer 0:6bf0743ece18 95 uint32_t result = time->tm_sec;
demayer 0:6bf0743ece18 96 result += time->tm_min * SECONDS_BY_MINUTES;
demayer 0:6bf0743ece18 97 result += time->tm_hour * SECONDS_BY_HOUR;
demayer 0:6bf0743ece18 98 result += (time->tm_mday - 1) * SECONDS_BY_DAY;
demayer 0:6bf0743ece18 99 result += seconds_before_month[_rtc_is_leap_year(time->tm_year)][time->tm_mon];
demayer 0:6bf0743ece18 100
demayer 0:6bf0743ece18 101 if (time->tm_year > 70) {
demayer 0:6bf0743ece18 102 // valid in the range [70:138]
demayer 0:6bf0743ece18 103 uint32_t count_of_leap_days = ((time->tm_year - 1) / 4) - (70 / 4);
demayer 0:6bf0743ece18 104 result += (((time->tm_year - 70) * 365) + count_of_leap_days) * SECONDS_BY_DAY;
demayer 0:6bf0743ece18 105 }
demayer 0:6bf0743ece18 106
demayer 0:6bf0743ece18 107 if (result > INT32_MAX) {
demayer 0:6bf0743ece18 108 return (time_t) -1;
demayer 0:6bf0743ece18 109 }
demayer 0:6bf0743ece18 110
demayer 0:6bf0743ece18 111 return result;
demayer 0:6bf0743ece18 112 }
demayer 0:6bf0743ece18 113
demayer 0:6bf0743ece18 114 bool _rtc_localtime(time_t timestamp, struct tm* time_info) {
demayer 0:6bf0743ece18 115 if (((int32_t) timestamp) < 0) {
demayer 0:6bf0743ece18 116 return false;
demayer 0:6bf0743ece18 117 }
demayer 0:6bf0743ece18 118
demayer 0:6bf0743ece18 119 time_info->tm_sec = timestamp % 60;
demayer 0:6bf0743ece18 120 timestamp = timestamp / 60; // timestamp in minutes
demayer 0:6bf0743ece18 121 time_info->tm_min = timestamp % 60;
demayer 0:6bf0743ece18 122 timestamp = timestamp / 60; // timestamp in hours
demayer 0:6bf0743ece18 123 time_info->tm_hour = timestamp % 24;
demayer 0:6bf0743ece18 124 timestamp = timestamp / 24; // timestamp in days;
demayer 0:6bf0743ece18 125
demayer 0:6bf0743ece18 126 // compute the weekday
demayer 0:6bf0743ece18 127 // The 1st of January 1970 was a Thursday which is equal to 4 in the weekday
demayer 0:6bf0743ece18 128 // representation ranging from [0:6]
demayer 0:6bf0743ece18 129 time_info->tm_wday = (timestamp + 4) % 7;
demayer 0:6bf0743ece18 130
demayer 0:6bf0743ece18 131 // years start at 70
demayer 0:6bf0743ece18 132 time_info->tm_year = 70;
demayer 0:6bf0743ece18 133 while (true) {
demayer 0:6bf0743ece18 134 if (_rtc_is_leap_year(time_info->tm_year) && timestamp >= 366) {
demayer 0:6bf0743ece18 135 ++time_info->tm_year;
demayer 0:6bf0743ece18 136 timestamp -= 366;
demayer 0:6bf0743ece18 137 } else if (!_rtc_is_leap_year(time_info->tm_year) && timestamp >= 365) {
demayer 0:6bf0743ece18 138 ++time_info->tm_year;
demayer 0:6bf0743ece18 139 timestamp -= 365;
demayer 0:6bf0743ece18 140 } else {
demayer 0:6bf0743ece18 141 // the remaining days are less than a years
demayer 0:6bf0743ece18 142 break;
demayer 0:6bf0743ece18 143 }
demayer 0:6bf0743ece18 144 }
demayer 0:6bf0743ece18 145
demayer 0:6bf0743ece18 146 time_info->tm_yday = timestamp;
demayer 0:6bf0743ece18 147
demayer 0:6bf0743ece18 148 // convert days into seconds and find the current month
demayer 0:6bf0743ece18 149 timestamp *= SECONDS_BY_DAY;
demayer 0:6bf0743ece18 150 time_info->tm_mon = 11;
demayer 0:6bf0743ece18 151 bool leap = _rtc_is_leap_year(time_info->tm_year);
demayer 0:6bf0743ece18 152 for (uint32_t i = 0; i < 12; ++i) {
demayer 0:6bf0743ece18 153 if ((uint32_t) timestamp < seconds_before_month[leap][i]) {
demayer 0:6bf0743ece18 154 time_info->tm_mon = i - 1;
demayer 0:6bf0743ece18 155 break;
demayer 0:6bf0743ece18 156 }
demayer 0:6bf0743ece18 157 }
demayer 0:6bf0743ece18 158
demayer 0:6bf0743ece18 159 // remove month from timestamp and compute the number of days.
demayer 0:6bf0743ece18 160 // note: unlike other fields, days are not 0 indexed.
demayer 0:6bf0743ece18 161 timestamp -= seconds_before_month[leap][time_info->tm_mon];
demayer 0:6bf0743ece18 162 time_info->tm_mday = (timestamp / SECONDS_BY_DAY) + 1;
demayer 0:6bf0743ece18 163
demayer 0:6bf0743ece18 164 return true;
demayer 0:6bf0743ece18 165 }