mirror of
https://github.com/apache/nuttx.git
synced 2026-06-05 07:12:54 +08:00
timekeeping: initial implementation
This commit is contained in:
committed by
Gregory Nutt
parent
90917d9741
commit
8db29071da
@@ -225,6 +225,7 @@ config ARCH_CHIP_STM32
|
|||||||
select ARCH_HAVE_I2CRESET
|
select ARCH_HAVE_I2CRESET
|
||||||
select ARCH_HAVE_HEAPCHECK
|
select ARCH_HAVE_HEAPCHECK
|
||||||
select ARCH_HAVE_TICKLESS
|
select ARCH_HAVE_TICKLESS
|
||||||
|
select ARCH_HAVE_TIMEKEEPING
|
||||||
select ARMV7M_HAVE_STACKCHECK
|
select ARMV7M_HAVE_STACKCHECK
|
||||||
---help---
|
---help---
|
||||||
STMicro STM32 architectures (ARM Cortex-M3/4).
|
STMicro STM32 architectures (ARM Cortex-M3/4).
|
||||||
|
|||||||
@@ -53,7 +53,7 @@
|
|||||||
#ifdef CONFIG_STM32_FREERUN
|
#ifdef CONFIG_STM32_FREERUN
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Private Functions
|
* Private Data
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
static struct stm32_freerun_s *g_freerun;
|
static struct stm32_freerun_s *g_freerun;
|
||||||
@@ -80,6 +80,7 @@ static struct stm32_freerun_s *g_freerun;
|
|||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
static int stm32_freerun_handler(int irq, void *context)
|
static int stm32_freerun_handler(int irq, void *context)
|
||||||
{
|
{
|
||||||
struct stm32_freerun_s *freerun = g_freerun;
|
struct stm32_freerun_s *freerun = g_freerun;
|
||||||
@@ -90,6 +91,7 @@ static int stm32_freerun_handler(int irq, void *context)
|
|||||||
STM32_TIM_ACKINT(freerun->tch, 0);
|
STM32_TIM_ACKINT(freerun->tch, 0);
|
||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
#endif /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Public Functions
|
* Public Functions
|
||||||
@@ -142,13 +144,19 @@ int stm32_freerun_initialize(struct stm32_freerun_s *freerun, int chan,
|
|||||||
|
|
||||||
freerun->chan = chan;
|
freerun->chan = chan;
|
||||||
freerun->running = false;
|
freerun->running = false;
|
||||||
freerun->overflow = 0;
|
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
freerun->counter_mask = 0xffffffffull;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
freerun->overflow = 0;
|
||||||
g_freerun = freerun;
|
g_freerun = freerun;
|
||||||
|
|
||||||
/* Set up to receive the callback when the counter overflow occurs */
|
/* Set up to receive the callback when the counter overflow occurs */
|
||||||
|
|
||||||
STM32_TIM_SETISR(freerun->tch, stm32_freerun_handler, 0);
|
STM32_TIM_SETISR(freerun->tch, stm32_freerun_handler, 0);
|
||||||
|
#endif
|
||||||
|
|
||||||
/* Set timer period */
|
/* Set timer period */
|
||||||
|
|
||||||
@@ -157,8 +165,11 @@ int stm32_freerun_initialize(struct stm32_freerun_s *freerun, int chan,
|
|||||||
/* Start the counter */
|
/* Start the counter */
|
||||||
|
|
||||||
STM32_TIM_SETMODE(freerun->tch, STM32_TIM_MODE_UP);
|
STM32_TIM_SETMODE(freerun->tch, STM32_TIM_MODE_UP);
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
STM32_TIM_ACKINT(freerun->tch, 0);
|
STM32_TIM_ACKINT(freerun->tch, 0);
|
||||||
STM32_TIM_ENABLEINT(freerun->tch, 0);
|
STM32_TIM_ENABLEINT(freerun->tch, 0);
|
||||||
|
#endif
|
||||||
|
|
||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
@@ -182,6 +193,8 @@ int stm32_freerun_initialize(struct stm32_freerun_s *freerun, int chan,
|
|||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
|
||||||
int stm32_freerun_counter(struct stm32_freerun_s *freerun,
|
int stm32_freerun_counter(struct stm32_freerun_s *freerun,
|
||||||
struct timespec *ts)
|
struct timespec *ts)
|
||||||
{
|
{
|
||||||
@@ -257,6 +270,16 @@ int stm32_freerun_counter(struct stm32_freerun_s *freerun,
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#else /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
|
|
||||||
|
int stm32_freerun_counter(struct stm32_freerun_s *freerun, uint64_t *counter)
|
||||||
|
{
|
||||||
|
*counter = (uint64_t)STM32_TIM_GETCOUNTER(freerun->tch);
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: stm32_freerun_uninitialize
|
* Name: stm32_freerun_uninitialize
|
||||||
*
|
*
|
||||||
|
|||||||
@@ -64,9 +64,16 @@ struct stm32_freerun_s
|
|||||||
{
|
{
|
||||||
uint8_t chan; /* The timer/counter in use */
|
uint8_t chan; /* The timer/counter in use */
|
||||||
bool running; /* True: the timer is running */
|
bool running; /* True: the timer is running */
|
||||||
uint32_t overflow; /* Timer counter overflow */
|
|
||||||
FAR struct stm32_tim_dev_s *tch; /* Handle returned by stm32_tim_init() */
|
FAR struct stm32_tim_dev_s *tch; /* Handle returned by stm32_tim_init() */
|
||||||
uint32_t frequency;
|
uint32_t frequency;
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
uint32_t overflow; /* Timer counter overflow */
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
uint64_t counter_mask;
|
||||||
|
#endif
|
||||||
};
|
};
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
@@ -127,9 +134,18 @@ int stm32_freerun_initialize(struct stm32_freerun_s *freerun, int chan,
|
|||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
|
||||||
int stm32_freerun_counter(struct stm32_freerun_s *freerun,
|
int stm32_freerun_counter(struct stm32_freerun_s *freerun,
|
||||||
struct timespec *ts);
|
struct timespec *ts);
|
||||||
|
|
||||||
|
#else /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
|
|
||||||
|
int stm32_freerun_counter(struct stm32_freerun_s *freerun,
|
||||||
|
uint64_t *counter);
|
||||||
|
|
||||||
|
#endif /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: stm32_freerun_uninitialize
|
* Name: stm32_freerun_uninitialize
|
||||||
*
|
*
|
||||||
|
|||||||
@@ -272,11 +272,44 @@ void up_timer_initialize(void)
|
|||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
|
||||||
int up_timer_gettime(FAR struct timespec *ts)
|
int up_timer_gettime(FAR struct timespec *ts)
|
||||||
{
|
{
|
||||||
return stm32_freerun_counter(&g_tickless.freerun, ts);
|
return stm32_freerun_counter(&g_tickless.freerun, ts);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#else
|
||||||
|
|
||||||
|
int up_timer_getcounter(FAR uint64_t *cycles)
|
||||||
|
{
|
||||||
|
return stm32_freerun_counter(&g_tickless.freerun, cycles);
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: up_timer_getmask
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* To be provided
|
||||||
|
*
|
||||||
|
* Input Parameters:
|
||||||
|
* mask - Location to return the 64-bit mask
|
||||||
|
*
|
||||||
|
* Returned Value:
|
||||||
|
* None
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
void up_timer_getmask(FAR uint64_t *mask)
|
||||||
|
{
|
||||||
|
DEBUGASSERT(mask != NULL);
|
||||||
|
*mask = g_tickless.freerun.counter_mask;
|
||||||
|
}
|
||||||
|
#endif /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: up_timer_cancel
|
* Name: up_timer_cancel
|
||||||
*
|
*
|
||||||
|
|||||||
@@ -1496,10 +1496,15 @@ void up_timer_initialize(void);
|
|||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
#ifdef CONFIG_SCHED_TICKLESS
|
#if defined(CONFIG_SCHED_TICKLESS) && !defined(CONFIG_SCHED_TIMEKEEPING)
|
||||||
int up_timer_gettime(FAR struct timespec *ts);
|
int up_timer_gettime(FAR struct timespec *ts);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
int up_timer_getcounter(FAR uint64_t *cycles);
|
||||||
|
void up_timer_getmask(FAR uint64_t *mask);
|
||||||
|
#endif
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: up_alarm_cancel
|
* Name: up_alarm_cancel
|
||||||
*
|
*
|
||||||
|
|||||||
+14
-1
@@ -1,7 +1,7 @@
|
|||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* include/sys/time.h
|
* include/sys/time.h
|
||||||
*
|
*
|
||||||
* Copyright (C) 2009, 2015 Gregory Nutt. All rights reserved.
|
* Copyright (C) 2009, 2015-2016 Gregory Nutt. All rights reserved.
|
||||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||||
*
|
*
|
||||||
* Redistribution and use in source and binary forms, with or without
|
* Redistribution and use in source and binary forms, with or without
|
||||||
@@ -112,6 +112,7 @@
|
|||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Public Type Definitions
|
* Public Type Definitions
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
/* struct timeval represents time as seconds plus microseconds */
|
/* struct timeval represents time as seconds plus microseconds */
|
||||||
|
|
||||||
struct timeval
|
struct timeval
|
||||||
@@ -190,6 +191,18 @@ int gettimeofday(FAR struct timeval *tv, FAR struct timezone *tz);
|
|||||||
|
|
||||||
int settimeofday(FAR const struct timeval *tv, FAR struct timezone *tz);
|
int settimeofday(FAR const struct timeval *tv, FAR struct timezone *tz);
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adjtime
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Correct the time to synchronize the system clock
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
int adjtime(const struct timeval *delta, struct timeval *olddelta);
|
||||||
|
#endif
|
||||||
|
|
||||||
#undef EXTERN
|
#undef EXTERN
|
||||||
#if defined(__cplusplus)
|
#if defined(__cplusplus)
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -167,6 +167,17 @@ config CLOCK_MONOTONIC
|
|||||||
|
|
||||||
The value of the CLOCK_MONOTONIC clock cannot be set via clock_settime().
|
The value of the CLOCK_MONOTONIC clock cannot be set via clock_settime().
|
||||||
|
|
||||||
|
config ARCH_HAVE_TIMEKEEPING
|
||||||
|
bool
|
||||||
|
default n
|
||||||
|
|
||||||
|
config SCHED_TIMEKEEPING
|
||||||
|
bool "Support timekeeping algorithms"
|
||||||
|
default n
|
||||||
|
depends on EXPERIMENTAL && ARCH_HAVE_TIMEKEEPING
|
||||||
|
---help---
|
||||||
|
SCHED_TIMEKEEPING enables experimental time management algorithms.
|
||||||
|
|
||||||
config JULIAN_TIME
|
config JULIAN_TIME
|
||||||
bool "Enables Julian time conversions"
|
bool "Enables Julian time conversions"
|
||||||
default n
|
default n
|
||||||
|
|||||||
@@ -38,6 +38,10 @@ CSRCS += clock_time2ticks.c clock_abstime2ticks.c clock_ticks2time.c
|
|||||||
CSRCS += clock_systimer.c clock_systimespec.c clock_timespec_add.c
|
CSRCS += clock_systimer.c clock_systimespec.c clock_timespec_add.c
|
||||||
CSRCS += clock_timespec_subtract.c
|
CSRCS += clock_timespec_subtract.c
|
||||||
|
|
||||||
|
ifeq ($(CONFIG_SCHED_TIMEKEEPING),y
|
||||||
|
CSRCS += clock_timekeeping.c
|
||||||
|
endif
|
||||||
|
|
||||||
# Include clock build support
|
# Include clock build support
|
||||||
|
|
||||||
DEPPATH += --dep-path clock
|
DEPPATH += --dep-path clock
|
||||||
|
|||||||
@@ -79,7 +79,9 @@ extern volatile uint32_t g_system_timer;
|
|||||||
# endif
|
# endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
extern struct timespec g_basetime;
|
extern struct timespec g_basetime;
|
||||||
|
#endif
|
||||||
|
|
||||||
/********************************************************************************
|
/********************************************************************************
|
||||||
* Public Function Prototypes
|
* Public Function Prototypes
|
||||||
|
|||||||
@@ -49,6 +49,9 @@
|
|||||||
#include <nuttx/arch.h>
|
#include <nuttx/arch.h>
|
||||||
|
|
||||||
#include "clock/clock.h"
|
#include "clock/clock.h"
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
# include "clock/clock_timekeeping.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Public Functions
|
* Public Functions
|
||||||
@@ -90,7 +93,9 @@ int clock_gettime(clockid_t clock_id, struct timespec *tp)
|
|||||||
* reset.
|
* reset.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifdef CONFIG_SCHED_TICKLESS
|
#if defined(CONFIG_SCHED_TIMEKEEPING)
|
||||||
|
ret = clock_timekeeping_get_monotonic_time(tp);
|
||||||
|
#elif defined(CONFIG_SCHED_TICKLESS)
|
||||||
ret = up_timer_gettime(tp);
|
ret = up_timer_gettime(tp);
|
||||||
#else
|
#else
|
||||||
ret = clock_systimespec(tp);
|
ret = clock_systimespec(tp);
|
||||||
@@ -113,7 +118,15 @@ int clock_gettime(clockid_t clock_id, struct timespec *tp)
|
|||||||
* last set.
|
* last set.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#if defined(CONFIG_SCHED_TIMEKEEPING)
|
||||||
|
ret = clock_timekeeping_get_wall_time(tp);
|
||||||
|
#elif defined(CONFIG_SCHED_TICKLESS)
|
||||||
|
ret = up_timer_gettime(&ts);
|
||||||
|
#else
|
||||||
ret = clock_systimespec(&ts);
|
ret = clock_systimespec(&ts);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
if (ret == OK)
|
if (ret == OK)
|
||||||
{
|
{
|
||||||
/* Add the base time to this. The base time is the time-of-day
|
/* Add the base time to this. The base time is the time-of-day
|
||||||
@@ -138,6 +151,7 @@ int clock_gettime(clockid_t clock_id, struct timespec *tp)
|
|||||||
tp->tv_sec = ts.tv_sec;
|
tp->tv_sec = ts.tv_sec;
|
||||||
tp->tv_nsec = ts.tv_nsec;
|
tp->tv_nsec = ts.tv_nsec;
|
||||||
}
|
}
|
||||||
|
#endif /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
|
|||||||
@@ -54,6 +54,9 @@
|
|||||||
#include <nuttx/time.h>
|
#include <nuttx/time.h>
|
||||||
|
|
||||||
#include "clock/clock.h"
|
#include "clock/clock.h"
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
# include "clock/clock_timekeeping.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Pre-processor Definitions
|
* Pre-processor Definitions
|
||||||
@@ -172,10 +175,16 @@ static void clock_inittime(void)
|
|||||||
{
|
{
|
||||||
/* (Re-)initialize the time value to match the RTC */
|
/* (Re-)initialize the time value to match the RTC */
|
||||||
|
|
||||||
(void)clock_basetime(&g_basetime);
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
#ifndef CONFIG_RTC_HIRES
|
||||||
|
clock_basetime(&g_basetime);
|
||||||
|
#endif
|
||||||
#ifndef CONFIG_SCHED_TICKLESS
|
#ifndef CONFIG_SCHED_TICKLESS
|
||||||
g_system_timer = 0;
|
g_system_timer = 0;
|
||||||
#endif
|
#endif
|
||||||
|
#else
|
||||||
|
clock_inittimekeeping();
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
|
|||||||
@@ -48,6 +48,9 @@
|
|||||||
#include <nuttx/irq.h>
|
#include <nuttx/irq.h>
|
||||||
|
|
||||||
#include "clock/clock.h"
|
#include "clock/clock.h"
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
# include "clock/clock_timekeeping.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Public Functions
|
* Public Functions
|
||||||
@@ -76,6 +79,7 @@ int clock_settime(clockid_t clock_id, FAR const struct timespec *tp)
|
|||||||
|
|
||||||
if (clock_id == CLOCK_REALTIME)
|
if (clock_id == CLOCK_REALTIME)
|
||||||
{
|
{
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
/* Interrupts are disabled here so that the in-memory time
|
/* Interrupts are disabled here so that the in-memory time
|
||||||
* representation and the RTC setting will be as close as
|
* representation and the RTC setting will be as close as
|
||||||
* possible.
|
* possible.
|
||||||
@@ -123,6 +127,9 @@ int clock_settime(clockid_t clock_id, FAR const struct timespec *tp)
|
|||||||
sinfo("basetime=(%ld,%lu) bias=(%ld,%lu)\n",
|
sinfo("basetime=(%ld,%lu) bias=(%ld,%lu)\n",
|
||||||
(long)g_basetime.tv_sec, (unsigned long)g_basetime.tv_nsec,
|
(long)g_basetime.tv_sec, (unsigned long)g_basetime.tv_nsec,
|
||||||
(long)bias.tv_sec, (unsigned long)bias.tv_nsec);
|
(long)bias.tv_sec, (unsigned long)bias.tv_nsec);
|
||||||
|
#else
|
||||||
|
ret = clock_timekeeping_set_wall_time(tp);
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
|
|||||||
@@ -83,7 +83,11 @@ systime_t clock_systimer(void)
|
|||||||
|
|
||||||
/* Get the time from the platform specific hardware */
|
/* Get the time from the platform specific hardware */
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
(void)up_timer_gettime(&ts);
|
(void)up_timer_gettime(&ts);
|
||||||
|
#else
|
||||||
|
(void)clock_timekeeping_get_monotonic_time(&ts);
|
||||||
|
#endif
|
||||||
|
|
||||||
/* Convert to a 64-bit value in microseconds, then in clock tick units */
|
/* Convert to a 64-bit value in microseconds, then in clock tick units */
|
||||||
|
|
||||||
@@ -96,7 +100,11 @@ systime_t clock_systimer(void)
|
|||||||
|
|
||||||
/* Get the time from the platform specific hardware */
|
/* Get the time from the platform specific hardware */
|
||||||
|
|
||||||
|
#ifndef CONFIG_SCHED_TIMEKEEPING
|
||||||
(void)up_timer_gettime(&ts);
|
(void)up_timer_gettime(&ts);
|
||||||
|
#else
|
||||||
|
(void)clock_timekeeping_get_monotonic_time(&ts);
|
||||||
|
#endif
|
||||||
|
|
||||||
/* Convert to a 64- then a 32-bit value */
|
/* Convert to a 64- then a 32-bit value */
|
||||||
|
|
||||||
|
|||||||
@@ -0,0 +1,297 @@
|
|||||||
|
/************************************************************************
|
||||||
|
* sched/clock/clock_timekeeping.c
|
||||||
|
*
|
||||||
|
* Copyright (C) 2016 Gregory Nutt. All rights reserved.
|
||||||
|
* Author: Max Neklyudov <macscomp@gmail.com>
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in
|
||||||
|
* the documentation and/or other materials provided with the
|
||||||
|
* distribution.
|
||||||
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
||||||
|
* used to endorse or promote products derived from this software
|
||||||
|
* without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||||
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||||
|
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||||
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||||
|
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Included Files
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
#include <nuttx/config.h>
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
|
||||||
|
#include <sys/time.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <time.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <debug.h>
|
||||||
|
|
||||||
|
#include <nuttx/irq.h>
|
||||||
|
#include <nuttx/arch.h>
|
||||||
|
|
||||||
|
#include "clock/clock.h"
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Pre-processor Definitions
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
#define NTP_MAX_ADJUST 500
|
||||||
|
|
||||||
|
/**********************************************************************
|
||||||
|
* Private Data
|
||||||
|
**********************************************************************/
|
||||||
|
|
||||||
|
static struct timespec g_clock_wall_time;
|
||||||
|
static struct timespec g_clock_monotonic_time;
|
||||||
|
static uint64_t g_clock_last_counter;
|
||||||
|
static uint64_t g_clock_mask;
|
||||||
|
static long g_clock_adjust;
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Private Functions
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Name: clock_get_current_time
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
static int clock_get_current_time(FAR struct timespec *ts,
|
||||||
|
FAR struct timespec *base)
|
||||||
|
{
|
||||||
|
irqstate_t flags;
|
||||||
|
uint64_t counter;
|
||||||
|
uint64_t offset;
|
||||||
|
uint64_t nsec;
|
||||||
|
time_t sec;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
flags = enter_critical_section();
|
||||||
|
|
||||||
|
ret = up_timer_getcounter(&counter);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
goto errout_in_critical_section;
|
||||||
|
}
|
||||||
|
|
||||||
|
offset = (counter - g_clock_last_counter) & g_clock_mask;
|
||||||
|
nsec = offset * NSEC_PER_TICK;
|
||||||
|
sec = nsec / NSEC_PER_SEC;
|
||||||
|
nsec -= sec * NSEC_PER_SEC;
|
||||||
|
|
||||||
|
nsec += base->tv_nsec;
|
||||||
|
if (nsec > NSEC_PER_SEC)
|
||||||
|
{
|
||||||
|
nsec -= NSEC_PER_SEC;
|
||||||
|
sec += 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
ts->tv_nsec = nsec;
|
||||||
|
ts->tv_sec = base->tv_sec + sec;
|
||||||
|
|
||||||
|
errout_in_critical_section:
|
||||||
|
leave_critical_section(flags);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Public Functions
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Name: clock_timekeeping_get_monotonic_time
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
int clock_timekeeping_get_monotonic_time(FAR struct timespec *ts)
|
||||||
|
{
|
||||||
|
return clock_get_current_time(ts, &g_clock_monotonic_time);
|
||||||
|
}
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Name: clock_timekeeping_get_wall_time
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
int clock_timekeeping_get_wall_time(FAR struct timespec *ts)
|
||||||
|
{
|
||||||
|
return clock_get_current_time(ts, &g_clock_wall_time);
|
||||||
|
}
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Name: clock_timekeeping_set_wall_time
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
int clock_timekeeping_set_wall_time(FAR struct timespec *ts)
|
||||||
|
{
|
||||||
|
irqstate_t flags;
|
||||||
|
uint64_t counter;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
flags = enter_critical_section();
|
||||||
|
|
||||||
|
ret = up_timer_getcounter(&counter);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
goto errout_in_critical_section;
|
||||||
|
}
|
||||||
|
|
||||||
|
g_clock_wall_time = *ts;
|
||||||
|
g_clock_adjust = 0;
|
||||||
|
g_clock_last_counter = counter;
|
||||||
|
|
||||||
|
errout_in_critical_section:
|
||||||
|
leave_critical_section(flags);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Name: adjtime
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
int adjtime(const struct timeval *delta, struct timeval *olddelta)
|
||||||
|
{
|
||||||
|
irqstate_t flags;
|
||||||
|
long adjust_usec;
|
||||||
|
|
||||||
|
if (!delta)
|
||||||
|
{
|
||||||
|
set_errno(EINVAL);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
flags = enter_critical_section();
|
||||||
|
|
||||||
|
adjust_usec = delta->tv_sec * USEC_PER_SEC + delta->tv_usec;
|
||||||
|
|
||||||
|
if (olddelta)
|
||||||
|
{
|
||||||
|
olddelta->tv_usec = g_clock_adjust;
|
||||||
|
}
|
||||||
|
|
||||||
|
g_clock_adjust = adjust_usec;
|
||||||
|
|
||||||
|
leave_critical_section(flags);
|
||||||
|
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Name: clock_update_wall_time
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
void clock_update_wall_time(void)
|
||||||
|
{
|
||||||
|
irqstate_t flags;
|
||||||
|
uint64_t counter;
|
||||||
|
uint64_t offset;
|
||||||
|
int64_t nsec;
|
||||||
|
time_t sec;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
flags = enter_critical_section();
|
||||||
|
|
||||||
|
ret = up_timer_getcounter(&counter);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
goto errout_in_critical_section;
|
||||||
|
}
|
||||||
|
|
||||||
|
offset = (counter - g_clock_last_counter) & g_clock_mask;
|
||||||
|
if (offset == 0)
|
||||||
|
{
|
||||||
|
goto errout_in_critical_section;
|
||||||
|
}
|
||||||
|
|
||||||
|
nsec = offset * NSEC_PER_TICK;
|
||||||
|
sec = nsec / NSEC_PER_SEC;
|
||||||
|
nsec -= sec * NSEC_PER_SEC;
|
||||||
|
|
||||||
|
g_clock_monotonic_time.tv_sec += sec;
|
||||||
|
g_clock_monotonic_time.tv_nsec += nsec;
|
||||||
|
if (g_clock_monotonic_time.tv_nsec > NSEC_PER_SEC)
|
||||||
|
{
|
||||||
|
g_clock_monotonic_time.tv_nsec -= NSEC_PER_SEC;
|
||||||
|
g_clock_monotonic_time.tv_sec += 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
nsec += g_clock_wall_time.tv_nsec;
|
||||||
|
if (nsec > NSEC_PER_SEC)
|
||||||
|
{
|
||||||
|
nsec -= NSEC_PER_SEC;
|
||||||
|
sec += 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (g_clock_adjust != 0 && sec > 0)
|
||||||
|
{
|
||||||
|
long adjust = NTP_MAX_ADJUST * (long)sec;
|
||||||
|
if (g_clock_adjust < adjust && g_clock_adjust > -adjust)
|
||||||
|
{
|
||||||
|
adjust = g_clock_adjust;
|
||||||
|
}
|
||||||
|
|
||||||
|
nsec += adjust * NSEC_PER_USEC;
|
||||||
|
|
||||||
|
while (nsec < 0)
|
||||||
|
{
|
||||||
|
nsec += NSEC_PER_SEC;
|
||||||
|
sec -= 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
while (nsec > NSEC_PER_SEC)
|
||||||
|
{
|
||||||
|
nsec -= NSEC_PER_SEC;
|
||||||
|
sec += 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
g_clock_wall_time.tv_sec += sec;
|
||||||
|
g_clock_wall_time.tv_nsec = (long)nsec;
|
||||||
|
|
||||||
|
g_clock_last_counter = counter;
|
||||||
|
|
||||||
|
errout_in_critical_section:
|
||||||
|
leave_critical_section(flags);
|
||||||
|
}
|
||||||
|
|
||||||
|
/************************************************************************
|
||||||
|
* Name: clock_inittimekeeping
|
||||||
|
************************************************************************/
|
||||||
|
|
||||||
|
void clock_inittimekeeping(void)
|
||||||
|
{
|
||||||
|
struct tm rtctime;
|
||||||
|
|
||||||
|
up_timer_getmask(&g_clock_mask);
|
||||||
|
|
||||||
|
/* Get the broken-errout_in_critical_section time from the date/time RTC. */
|
||||||
|
|
||||||
|
(void)up_rtc_getdatetime(&rtctime);
|
||||||
|
|
||||||
|
/* And use the broken-errout_in_critical_section time to initialize the system time */
|
||||||
|
|
||||||
|
g_clock_wall_time.tv_sec = mktime(&rtctime);
|
||||||
|
g_clock_wall_time.tv_nsec = 0;
|
||||||
|
|
||||||
|
memset(&g_clock_monotonic_time, 0, sizeof(g_clock_monotonic_time));
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif /* CONFIG_SCHED_TIMEKEEPING */
|
||||||
@@ -0,0 +1,62 @@
|
|||||||
|
/********************************************************************************
|
||||||
|
* sched/clock/clock_timekeeping.h
|
||||||
|
*
|
||||||
|
* Copyright (C) 2016 Gregory Nutt. All rights reserved.
|
||||||
|
* Author: Max Neklyudov <macscomp@gmail.com>
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in
|
||||||
|
* the documentation and/or other materials provided with the
|
||||||
|
* distribution.
|
||||||
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
||||||
|
* used to endorse or promote products derived from this software
|
||||||
|
* without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||||
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||||
|
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||||
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||||
|
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
********************************************************************************/
|
||||||
|
|
||||||
|
#ifndef __SCHED_CLOCK_CLOCK_TIMEKEEPING_H
|
||||||
|
#define __SCHED_CLOCK_CLOCK_TIMEKEEPING_H
|
||||||
|
|
||||||
|
/********************************************************************************
|
||||||
|
* Included Files
|
||||||
|
********************************************************************************/
|
||||||
|
|
||||||
|
#include <nuttx/config.h>
|
||||||
|
#include <nuttx/compiler.h>
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include <nuttx/clock.h>
|
||||||
|
|
||||||
|
/********************************************************************************
|
||||||
|
* Public Function Prototypes
|
||||||
|
********************************************************************************/
|
||||||
|
|
||||||
|
int clock_timekeeping_get_monotonic_time(FAR struct timespec *ts);
|
||||||
|
int clock_timekeeping_get_wall_time(FAR struct timespec *ts);
|
||||||
|
int clock_timekeeping_set_wall_time(FAR struct timespec *ts);
|
||||||
|
|
||||||
|
void clock_update_wall_time(void);
|
||||||
|
|
||||||
|
void clock_inittimekeeping(void);
|
||||||
|
|
||||||
|
#endif /* __SCHED_CLOCK_CLOCK_TIMEKEEPING_H */
|
||||||
@@ -1,7 +1,7 @@
|
|||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* sched/sched/sched_processtimer.c
|
* sched/sched/sched_processtimer.c
|
||||||
*
|
*
|
||||||
* Copyright (C) 2007, 2009, 2014-2015 Gregory Nutt. All rights reserved.
|
* Copyright (C) 2007, 2009, 2014-2016 Gregory Nutt. All rights reserved.
|
||||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||||
*
|
*
|
||||||
* Redistribution and use in source and binary forms, with or without
|
* Redistribution and use in source and binary forms, with or without
|
||||||
@@ -144,6 +144,12 @@ static inline void sched_process_scheduler(void)
|
|||||||
|
|
||||||
void sched_process_timer(void)
|
void sched_process_timer(void)
|
||||||
{
|
{
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
/* Process wall time */
|
||||||
|
|
||||||
|
clock_update_wall_time();
|
||||||
|
#endif
|
||||||
|
|
||||||
/* Increment the system time (if in the link) */
|
/* Increment the system time (if in the link) */
|
||||||
|
|
||||||
#ifdef CONFIG_HAVE_WEAKFUNCTIONS
|
#ifdef CONFIG_HAVE_WEAKFUNCTIONS
|
||||||
|
|||||||
@@ -1,7 +1,7 @@
|
|||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* sched/sched/sched_timerexpiration.c
|
* sched/sched/sched_timerexpiration.c
|
||||||
*
|
*
|
||||||
* Copyright (C) 2014-2015 Gregory Nutt. All rights reserved.
|
* Copyright (C) 2014-2016 Gregory Nutt. All rights reserved.
|
||||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||||
*
|
*
|
||||||
* Redistribution and use in source and binary forms, with or without
|
* Redistribution and use in source and binary forms, with or without
|
||||||
@@ -53,6 +53,10 @@
|
|||||||
#include "wdog/wdog.h"
|
#include "wdog/wdog.h"
|
||||||
#include "clock/clock.h"
|
#include "clock/clock.h"
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
# include "clock/clock_timekeeping.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
#ifdef CONFIG_SCHED_TICKLESS
|
#ifdef CONFIG_SCHED_TICKLESS
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
@@ -262,6 +266,12 @@ static unsigned int sched_timer_process(unsigned int ticks, bool noswitches)
|
|||||||
unsigned int rettime = 0;
|
unsigned int rettime = 0;
|
||||||
unsigned int tmp;
|
unsigned int tmp;
|
||||||
|
|
||||||
|
#ifdef CONFIG_SCHED_TIMEKEEPING
|
||||||
|
/* Process wall time */
|
||||||
|
|
||||||
|
clock_update_wall_time();
|
||||||
|
#endif
|
||||||
|
|
||||||
/* Process watchdogs */
|
/* Process watchdogs */
|
||||||
|
|
||||||
tmp = wd_timer(ticks);
|
tmp = wd_timer(ticks);
|
||||||
|
|||||||
Reference in New Issue
Block a user