STM32F4-Base/App/sys_clock.c

/*
 * 模块名称：System Clock — Wall Clock Time Maintenance
 * 模块功能：实现系统墙钟时间维护，包括 RTC 初始读取、HAL Tick 漂移维持
 * 适用平台：STM32F407ZGTx (Cortex-M4 FPU, 168MHz)
 * 作者：王建锋
 * 创建日期：2026-07-19
 * 修改记录：
 *   v1.0  2026-07-19  王建锋  创建初始版本
 */

#include "sys_clock.h"
#include "main.h"
#include <string.h>
#include <stdio.h>

#define DBG_TAG "[CLK]"
#include "dbg_log.h"

/* ============================================================
 * 内部状态：系统墙钟
 * ============================================================ */

static volatile uint32_t s_base_tick = 0;  /* HAL_GetTick() 基准 */
static volatile uint32_t s_base_unix_secs = UINT32_MAX;

/* ============================================================
 * 内部辅助函数：Unix time ↔ sd2506_time_t 转换
 * ============================================================ */

static void unix_to_sd2506(uint32_t unix_secs, sd2506_time_t *p_sd_time)
{
    uint32_t y, m, d;
    uint8_t h, mi, s;
    int is_leap;

    /* 时分秒 */
    {
        uint64_t total = (uint64_t)unix_secs;
        s = (uint8_t)(total % 60uLL);
        total /= 60uLL;
        mi = (uint8_t)(total % 60uLL);
        total /= 60uLL;
        h = (uint8_t)(total % 24uL);
    }

    /* 年月日 */
    {
        uint64_t day_count = ((uint64_t)unix_secs / 86400uL);

        y = 1970u;
        while (day_count >= 365uLL) {
            uint64_t diy = 365uLL;
            if ((y % 4 == 0 && y % 100 != 0) || (y % 400 == 0)) {
                diy = 366uLL;
            }
            if (day_count < diy) break;
            day_count -= diy;
            y++;
        }

        is_leap = ((y % 4 == 0 && y % 100 != 0) || (y % 400 == 0));
        uint8_t mdays[12] = {31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31};
        if (is_leap) mdays[1] = 29;

        m = 0;
        while (m < 12u) {
            if (day_count < (uint64_t)mdays[m]) break;
            day_count -= mdays[m];
            m++;
        }
        d = (uint32_t)(day_count + 1uL);

        /* 星期（Zeller's congruence，0=Sunday） */
        uint64_t wy = y;
        uint64_t wm = m;
        if (wm <= 2) {
            wy--;
            wm += 12uL;
        }
        uint8_t week = ((uint32_t)(wy % 100uLL + wy / 100uLL / 4uLL - wy / 100uLL / 15uLL) +
                       (uint32_t)(((uint64_t)26 * (wm + 1uL)) / 10uLL) +
                       (uint32_t)(d % 100uLL)) % 7uLL;

        /* SD2506 year 字段为 0~99（+2000） */
        uint16_t sd_year = y >= 2000 ? (y - 2000) : (y + 2000);

        p_sd_time->year   = sd_year;
        p_sd_time->month  = m + 1uL;    /* 月份从 0 → 1 */
        p_sd_time->day    = d;
        p_sd_time->hour   = h;
        p_sd_time->minute = mi;
        p_sd_time->second = s;
        p_sd_time->week   = week;
    }
}

/* ============================================================
 * 系统墙钟时间维护
 * ============================================================ */

int sys_clock_init(void)
{
    sd2506_time_t sd_time;
    uint32_t year, month, day, hour, minute, second;
    int64_t unix_secs = 0;
    int i;

    /* Step 1: 从 SD2506 RTC 读取初始时间 */
    sd2506_get_time(&sd_time);

    year   = (uint32_t)sd_time.year + 2000uL;
    month  = (uint32_t)sd_time.month;
    day    = (uint32_t)sd_time.day;
    hour   = (uint32_t)sd_time.hour;
    minute = (uint32_t)sd_time.minute;
    second = (uint32_t)sd_time.second;

    DBG_INFO("sys_clock_init: RTC initial time %04d-%02d-%02d %02d:%02d:%02d",
             year, month, day, hour, minute, second);

    /* Step 2: Unix epoch → seconds（简化算法，适用于 1970~2038） */
    {
        uint64_t total_days = 0;

        for (i = 1970; i < year; i++) {
            if ((i % 4 == 0 && i % 100 != 0) || (i % 400 == 0)) {
                total_days += 366uLL;
            } else {
                total_days += 365uLL;
            }
        }

        int is_leap = ((year % 4 == 0 && year % 100 != 0) || (year % 400 == 0));
        uint8_t mdays[12] = {31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31};
        if (is_leap) mdays[1] = 29;

        for (i = 0; i < month - 1; i++) {
            total_days += mdays[i];
        }
        total_days += day - 1uL;

        unix_secs = (int64_t)(total_days * 86400LL) + hour * 3600LL + minute * 60LL + second;
    }

    /* Step 3: 设置系统墙钟基准 */
    s_base_tick = HAL_GetTick();
    s_base_unix_secs = (uint32_t)unix_secs;

    DBG_INFO("sys_clock_init: wall clock base = unix %lu, base_tick=%lu",
             (unsigned long)s_base_unix_secs, (unsigned long)s_base_tick);

    return 0;
}

uint32_t sys_clock_get(void)
{
    uint32_t now_tick = HAL_GetTick();
    int64_t unix_secs = (int64_t)s_base_unix_secs + (int64_t)((uint32_t)(now_tick - s_base_tick) / 1000uL);

    if (unix_secs < 0) {
        return UINT32_MAX; /* 未初始化 */
    }

    return (uint32_t)unix_secs;
}

char *sys_clock_get_str(char *buf, size_t buf_size)
{
    uint32_t unix_secs = sys_clock_get();
    if (unix_secs == UINT32_MAX) {
        snprintf(buf, buf_size, "----/--/-- --:--:--");
        return buf;
    }

    sd2506_time_t sd;
    unix_to_sd2506(unix_secs, &sd);

    snprintf(buf, buf_size, "%04d-%02d-%02d %02d:%02d:%02d",
             sd.year + 2000uL, sd.month, sd.day,
             sd.hour, sd.minute, sd.second);
    return buf;
}

int sys_clock_set(uint32_t unix_secs, const sd2506_time_t *sd_time)
{
    /* Step 1: 更新墙钟基准 */
    s_base_tick = HAL_GetTick();
    s_base_unix_secs = unix_secs;

    DBG_INFO("sys_clock_set: wall clock updated to %lu", (unsigned long)unix_secs);

    /* Step 2: 写回 SD2506 RTC（若提供了 sd_time） */
    if (sd_time != NULL) {
        sd2506_set_time(sd_time);
        DBG_INFO("sys_clock_set: SD2506 RTC written");
    }

    return 0;
}