365 lines
9.4 KiB
C
365 lines
9.4 KiB
C
/*
|
|
ChibiOS/RT - Copyright (C) 2006-2013 Giovanni Di Sirio
|
|
|
|
Licensed under the Apache License, Version 2.0 (the "License");
|
|
you may not use this file except in compliance with the License.
|
|
You may obtain a copy of the License at
|
|
|
|
http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
Unless required by applicable law or agreed to in writing, software
|
|
distributed under the License is distributed on an "AS IS" BASIS,
|
|
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
See the License for the specific language governing permissions and
|
|
limitations under the License.
|
|
*/
|
|
/*
|
|
Concepts and parts of this file have been contributed by Uladzimir Pylinsky
|
|
aka barthess.
|
|
*/
|
|
|
|
/**
|
|
* @file chrtclib.c
|
|
* @brief RTC time conversion utilities code.
|
|
*
|
|
* @addtogroup chrtclib
|
|
* @{
|
|
*/
|
|
|
|
#include <time.h>
|
|
|
|
#include "ch.h"
|
|
#include "hal.h"
|
|
|
|
#include "chrtclib.h"
|
|
|
|
#if HAL_USE_RTC || defined(__DOXYGEN__)
|
|
|
|
#if (defined(STM32F4XX) || defined(STM32F2XX) || defined(STM32L1XX) || \
|
|
defined(STM32F30X) || defined(STM32F37X) || \
|
|
defined(STM32F1XX) || defined(STM32F10X_MD) || defined(STM32F10X_LD) || \
|
|
defined(STM32F10X_HD) || defined(STM32F10X_CL) || defined(STM32F0XX) || \
|
|
defined(LPC122X) || defined(__DOXYGEN__))
|
|
#if STM32_RTC_IS_CALENDAR
|
|
/**
|
|
* @brief Converts from STM32 BCD to canonicalized time format.
|
|
*
|
|
* @param[out] timp pointer to a @p tm structure as defined in time.h
|
|
* @param[in] timespec pointer to a @p RTCTime structure
|
|
*
|
|
* @notapi
|
|
*/
|
|
static void stm32_rtc_bcd2tm(struct tm *timp, RTCTime *timespec) {
|
|
uint32_t tv_time = timespec->tv_time;
|
|
uint32_t tv_date = timespec->tv_date;
|
|
|
|
#if CH_DBG_ENABLE_CHECKS
|
|
timp->tm_isdst = 0;
|
|
timp->tm_wday = 0;
|
|
timp->tm_mday = 0;
|
|
timp->tm_yday = 0;
|
|
timp->tm_mon = 0;
|
|
timp->tm_year = 0;
|
|
timp->tm_sec = 0;
|
|
timp->tm_min = 0;
|
|
timp->tm_hour = 0;
|
|
#endif
|
|
|
|
timp->tm_isdst = -1;
|
|
|
|
timp->tm_wday = (tv_date & RTC_DR_WDU) >> RTC_DR_WDU_OFFSET;
|
|
if (timp->tm_wday == 7)
|
|
timp->tm_wday = 0;
|
|
|
|
timp->tm_mday = (tv_date & RTC_DR_DU) >> RTC_DR_DU_OFFSET;
|
|
timp->tm_mday += ((tv_date & RTC_DR_DT) >> RTC_DR_DT_OFFSET) * 10;
|
|
|
|
timp->tm_mon = (tv_date & RTC_DR_MU) >> RTC_DR_MU_OFFSET;
|
|
timp->tm_mon += ((tv_date & RTC_DR_MT) >> RTC_DR_MT_OFFSET) * 10;
|
|
timp->tm_mon -= 1;
|
|
|
|
timp->tm_year = (tv_date & RTC_DR_YU) >> RTC_DR_YU_OFFSET;
|
|
timp->tm_year += ((tv_date & RTC_DR_YT) >> RTC_DR_YT_OFFSET) * 10;
|
|
timp->tm_year += 2000 - 1900;
|
|
|
|
timp->tm_sec = (tv_time & RTC_TR_SU) >> RTC_TR_SU_OFFSET;
|
|
timp->tm_sec += ((tv_time & RTC_TR_ST) >> RTC_TR_ST_OFFSET) * 10;
|
|
|
|
timp->tm_min = (tv_time & RTC_TR_MNU) >> RTC_TR_MNU_OFFSET;
|
|
timp->tm_min += ((tv_time & RTC_TR_MNT) >> RTC_TR_MNT_OFFSET) * 10;
|
|
|
|
timp->tm_hour = (tv_time & RTC_TR_HU) >> RTC_TR_HU_OFFSET;
|
|
timp->tm_hour += ((tv_time & RTC_TR_HT) >> RTC_TR_HT_OFFSET) * 10;
|
|
timp->tm_hour += 12 * ((tv_time & RTC_TR_PM) >> RTC_TR_PM_OFFSET);
|
|
}
|
|
|
|
/**
|
|
* @brief Converts from canonicalized to STM32 BCD time format.
|
|
*
|
|
* @param[in] timp pointer to a @p tm structure as defined in time.h
|
|
* @param[out] timespec pointer to a @p RTCTime structure
|
|
*
|
|
* @notapi
|
|
*/
|
|
static void stm32_rtc_tm2bcd(struct tm *timp, RTCTime *timespec) {
|
|
uint32_t v = 0;
|
|
|
|
timespec->tv_date = 0;
|
|
timespec->tv_time = 0;
|
|
|
|
v = timp->tm_year - 100;
|
|
timespec->tv_date |= ((v / 10) << RTC_DR_YT_OFFSET) & RTC_DR_YT;
|
|
timespec->tv_date |= (v % 10) << RTC_DR_YU_OFFSET;
|
|
|
|
if (timp->tm_wday == 0)
|
|
v = 7;
|
|
else
|
|
v = timp->tm_wday;
|
|
timespec->tv_date |= (v << RTC_DR_WDU_OFFSET) & RTC_DR_WDU;
|
|
|
|
v = timp->tm_mon + 1;
|
|
timespec->tv_date |= ((v / 10) << RTC_DR_MT_OFFSET) & RTC_DR_MT;
|
|
timespec->tv_date |= (v % 10) << RTC_DR_MU_OFFSET;
|
|
|
|
v = timp->tm_mday;
|
|
timespec->tv_date |= ((v / 10) << RTC_DR_DT_OFFSET) & RTC_DR_DT;
|
|
timespec->tv_date |= (v % 10) << RTC_DR_DU_OFFSET;
|
|
|
|
v = timp->tm_hour;
|
|
timespec->tv_time |= ((v / 10) << RTC_TR_HT_OFFSET) & RTC_TR_HT;
|
|
timespec->tv_time |= (v % 10) << RTC_TR_HU_OFFSET;
|
|
|
|
v = timp->tm_min;
|
|
timespec->tv_time |= ((v / 10) << RTC_TR_MNT_OFFSET) & RTC_TR_MNT;
|
|
timespec->tv_time |= (v % 10) << RTC_TR_MNU_OFFSET;
|
|
|
|
v = timp->tm_sec;
|
|
timespec->tv_time |= ((v / 10) << RTC_TR_ST_OFFSET) & RTC_TR_ST;
|
|
timespec->tv_time |= (v % 10) << RTC_TR_SU_OFFSET;
|
|
}
|
|
|
|
/**
|
|
* @brief Gets raw time from RTC and converts it to canonicalized format.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @param[out] timp pointer to a @p tm structure as defined in time.h
|
|
*
|
|
* @api
|
|
*/
|
|
void rtcGetTimeTm(RTCDriver *rtcp, struct tm *timp) {
|
|
#if STM32_RTC_HAS_SUBSECONDS
|
|
RTCTime timespec = {0,0,FALSE,0};
|
|
#else
|
|
RTCTime timespec = {0,0,FALSE};
|
|
#endif
|
|
|
|
rtcGetTime(rtcp, ×pec);
|
|
stm32_rtc_bcd2tm(timp, ×pec);
|
|
}
|
|
|
|
/**
|
|
* @brief Sets RTC time.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @param[out] timp pointer to a @p tm structure as defined in time.h
|
|
*
|
|
* @api
|
|
*/
|
|
void rtcSetTimeTm(RTCDriver *rtcp, struct tm *timp) {
|
|
#if STM32_RTC_HAS_SUBSECONDS
|
|
RTCTime timespec = {0,0,FALSE,0};
|
|
#else
|
|
RTCTime timespec = {0,0,FALSE};
|
|
#endif
|
|
|
|
stm32_rtc_tm2bcd(timp, ×pec);
|
|
rtcSetTime(rtcp, ×pec);
|
|
}
|
|
|
|
/**
|
|
* @brief Gets raw time from RTC and converts it to unix format.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @return Unix time value in seconds.
|
|
*
|
|
* @api
|
|
*/
|
|
time_t rtcGetTimeUnixSec(RTCDriver *rtcp) {
|
|
#if STM32_RTC_HAS_SUBSECONDS
|
|
RTCTime timespec = {0,0,FALSE,0};
|
|
#else
|
|
RTCTime timespec = {0,0,FALSE};
|
|
#endif
|
|
struct tm timp;
|
|
|
|
rtcGetTime(rtcp, ×pec);
|
|
stm32_rtc_bcd2tm(&timp, ×pec);
|
|
|
|
return mktime(&timp);
|
|
}
|
|
|
|
/**
|
|
* @brief Sets RTC time.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @param[in] tv_sec time specification
|
|
* @return Unix time value in seconds.
|
|
*
|
|
* @api
|
|
*/
|
|
void rtcSetTimeUnixSec(RTCDriver *rtcp, time_t tv_sec) {
|
|
#if STM32_RTC_HAS_SUBSECONDS
|
|
RTCTime timespec = {0,0,FALSE,0};
|
|
#else
|
|
RTCTime timespec = {0,0,FALSE};
|
|
#endif
|
|
struct tm timp;
|
|
|
|
localtime_r(&tv_sec, &timp);
|
|
stm32_rtc_tm2bcd(&timp, ×pec);
|
|
rtcSetTime(rtcp, ×pec);
|
|
}
|
|
|
|
/**
|
|
* @brief Gets raw time from RTC and converts it to unix format.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @return Unix time value in microseconds.
|
|
*
|
|
* @api
|
|
*/
|
|
uint64_t rtcGetTimeUnixUsec(RTCDriver *rtcp) {
|
|
#if STM32_RTC_HAS_SUBSECONDS
|
|
uint64_t result = 0;
|
|
RTCTime timespec = {0,0,FALSE,0};
|
|
struct tm timp;
|
|
|
|
rtcGetTime(rtcp, ×pec);
|
|
stm32_rtc_bcd2tm(&timp, ×pec);
|
|
|
|
result = (uint64_t)mktime(&timp) * 1000000;
|
|
return result + timespec.tv_msec * 1000;
|
|
#else
|
|
return (uint64_t)rtcGetTimeUnixSec(rtcp) * 1000000;
|
|
#endif
|
|
}
|
|
|
|
#else /* STM32_RTC_IS_CALENDAR */
|
|
/**
|
|
* @brief Gets raw time from RTC and converts it to canonicalized format.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @param[out] timp pointer to a @p tm structure as defined in time.h
|
|
*
|
|
* @api
|
|
*/
|
|
void rtcGetTimeTm(RTCDriver *rtcp, struct tm *timp) {
|
|
RTCTime timespec = {0};
|
|
|
|
rtcGetTime(rtcp, ×pec);
|
|
localtime_r((time_t *)&(timespec.tv_sec), timp);
|
|
}
|
|
|
|
/**
|
|
* @brief Sets RTC time.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @param[out] timp pointer to a @p tm structure as defined in time.h
|
|
*
|
|
* @api
|
|
*/
|
|
void rtcSetTimeTm(RTCDriver *rtcp, struct tm *timp) {
|
|
RTCTime timespec = {0};
|
|
|
|
timespec.tv_sec = mktime(timp);
|
|
#if !defined(LPC122X)
|
|
timespec.tv_msec = 0;
|
|
#endif
|
|
rtcSetTime(rtcp, ×pec);
|
|
}
|
|
|
|
/**
|
|
* @brief Gets raw time from RTC and converts it to unix format.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @return Unix time value in seconds.
|
|
*
|
|
* @api
|
|
*/
|
|
time_t rtcGetTimeUnixSec(RTCDriver *rtcp) {
|
|
RTCTime timespec = {0};
|
|
|
|
rtcGetTime(rtcp, ×pec);
|
|
return timespec.tv_sec;
|
|
}
|
|
|
|
/**
|
|
* @brief Sets RTC time.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @param[in] tv_sec time specification
|
|
* @return Unix time value in seconds.
|
|
*
|
|
* @api
|
|
*/
|
|
void rtcSetTimeUnixSec(RTCDriver *rtcp, time_t tv_sec) {
|
|
RTCTime timespec = {0};
|
|
|
|
timespec.tv_sec = tv_sec;
|
|
#if !defined(LPC122X)
|
|
timespec.tv_msec = 0;
|
|
#endif
|
|
rtcSetTime(rtcp, ×pec);
|
|
}
|
|
|
|
/**
|
|
* @brief Gets raw time from RTC and converts it to unix format.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @return Unix time value in microseconds.
|
|
*
|
|
* @api
|
|
*/
|
|
uint64_t rtcGetTimeUnixUsec(RTCDriver *rtcp) {
|
|
#if STM32_RTC_HAS_SUBSECONDS
|
|
uint64_t result = 0;
|
|
RTCTime timespec = {0,0};
|
|
|
|
rtcGetTime(rtcp, ×pec);
|
|
result = (uint64_t)timespec.tv_sec * 1000000;
|
|
return result + timespec.tv_msec * 1000;
|
|
#else
|
|
return (uint64_t)rtcGetTimeUnixSec(rtcp) * 1000000;
|
|
#endif
|
|
}
|
|
|
|
/**
|
|
* @brief Get current time in format suitable for usage in FatFS.
|
|
*
|
|
* @param[in] rtcp pointer to RTC driver structure
|
|
* @return FAT time value.
|
|
*
|
|
* @api
|
|
*/
|
|
uint32_t rtcGetTimeFatFromCounter(RTCDriver *rtcp) {
|
|
uint32_t fattime;
|
|
struct tm timp;
|
|
|
|
rtcGetTimeTm(rtcp, &timp);
|
|
|
|
fattime = (timp.tm_sec) >> 1;
|
|
fattime |= (timp.tm_min) << 5;
|
|
fattime |= (timp.tm_hour) << 11;
|
|
fattime |= (timp.tm_mday) << 16;
|
|
fattime |= (timp.tm_mon + 1) << 21;
|
|
fattime |= (timp.tm_year - 80) << 25;
|
|
|
|
return fattime;
|
|
}
|
|
#endif /* STM32_RTC_IS_CALENDAR */
|
|
#endif /* (defined(STM32F4XX) || defined(STM32F2XX) || defined(STM32L1XX) || defined(STM32F1XX)) */
|
|
|
|
#endif /* HAL_USE_RTC */
|
|
|
|
/** @} */
|