b32a44aa7e
this adds the option to have the clock periodically resynced with the time from the sntp server, instead of just syncing at startup. Signed-off-by: Fin Maaß <f.maass@vogl-electronic.com>
78 lines
2.0 KiB
C
78 lines
2.0 KiB
C
/*
|
|
* Copyright (c) 2019 Linaro Limited
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/logging/log.h>
|
|
LOG_MODULE_DECLARE(net_config, CONFIG_NET_CONFIG_LOG_LEVEL);
|
|
|
|
#include <errno.h>
|
|
#include <zephyr/net/net_if.h>
|
|
#include <zephyr/net/sntp.h>
|
|
#include <zephyr/posix/time.h>
|
|
|
|
#ifdef CONFIG_NET_CONFIG_SNTP_INIT_RESYNC
|
|
static void sntp_resync_handler(struct k_work *work);
|
|
static K_WORK_DELAYABLE_DEFINE(sntp_resync_work_handle, sntp_resync_handler);
|
|
#endif
|
|
|
|
static int sntp_init_helper(struct sntp_time *tm)
|
|
{
|
|
#ifdef CONFIG_NET_CONFIG_SNTP_INIT_SERVER_USE_DHCPV4_OPTION
|
|
struct net_if *iface = net_if_get_default();
|
|
|
|
if (!net_ipv4_is_addr_unspecified(&iface->config.dhcpv4.ntp_addr)) {
|
|
struct sockaddr_in sntp_addr = {0};
|
|
|
|
sntp_addr.sin_family = AF_INET;
|
|
sntp_addr.sin_addr.s_addr = iface->config.dhcpv4.ntp_addr.s_addr;
|
|
return sntp_simple_addr((struct sockaddr *)&sntp_addr, sizeof(sntp_addr),
|
|
CONFIG_NET_CONFIG_SNTP_INIT_TIMEOUT, tm);
|
|
}
|
|
LOG_INF("SNTP address not set by DHCPv4, using Kconfig defaults");
|
|
#endif /* NET_CONFIG_SNTP_INIT_SERVER_USE_DHCPV4_OPTION */
|
|
return sntp_simple(CONFIG_NET_CONFIG_SNTP_INIT_SERVER,
|
|
CONFIG_NET_CONFIG_SNTP_INIT_TIMEOUT, tm);
|
|
}
|
|
|
|
int net_init_clock_via_sntp(void)
|
|
{
|
|
struct sntp_time ts;
|
|
struct timespec tspec;
|
|
int res = sntp_init_helper(&ts);
|
|
|
|
if (res < 0) {
|
|
LOG_ERR("Cannot set time using SNTP");
|
|
goto end;
|
|
}
|
|
|
|
tspec.tv_sec = ts.seconds;
|
|
tspec.tv_nsec = ((uint64_t)ts.fraction * (1000 * 1000 * 1000)) >> 32;
|
|
res = clock_settime(CLOCK_REALTIME, &tspec);
|
|
|
|
end:
|
|
#ifdef CONFIG_NET_CONFIG_SNTP_INIT_RESYNC
|
|
k_work_reschedule(&sntp_resync_work_handle,
|
|
K_SECONDS(CONFIG_NET_CONFIG_SNTP_INIT_RESYNC_INTERVAL));
|
|
#endif
|
|
return res;
|
|
}
|
|
|
|
#ifdef CONFIG_NET_CONFIG_SNTP_INIT_RESYNC
|
|
static void sntp_resync_handler(struct k_work *work)
|
|
{
|
|
int res;
|
|
|
|
ARG_UNUSED(work);
|
|
|
|
res = net_init_clock_via_sntp();
|
|
if (res < 0) {
|
|
LOG_ERR("Cannot resync time using SNTP");
|
|
return;
|
|
}
|
|
LOG_DBG("Time resynced using SNTP");
|
|
}
|
|
#endif /* CONFIG_NET_CONFIG_SNTP_INIT_RESYNC */
|