版权声明:本文为本文为博主原创文章,转载请注明出处。如有问题,欢迎指正。博客地址:https://www.cnblogs.com/wsg1100/
clock可以说是操作系统正常运行的发动机,整个操作系统的活动都受到它的激励。系统利用时钟中断维持系统时间、促使任务调度,以保证所有进程共享CPU资源;可以说,“时钟中断”是整个操作系统的脉搏。
那你是否好奇xenomai cobalt内核和Linux内核双内核共存的情况下,时间子系统是如何工作的?一个硬件时钟如何为两个操作系统提供服务的?本文将揭开xenomai双核系统时间机制的面纱。
首先回看一下之前的文章[xenomai内核解析之xenomai的组成结构](https://www.cnblogs.com/wsg1100/p/12833126.html)。
我们说到:在内核空间,在标准linux基础上添加一个实时内核Cobalt,得益于基于ADEOS(Adaptive Domain Environment for Operating System),使Cobalt内核在内核空间与linux内核并存,并把标准的Linux内核作为实时内核中的一个idle进程在实时内核上调度。
”并把标准的Linux内核作为实时内核中的一个idle进程在实时内核上调度“,这句话是本文的重点,接下我们先从Linux时间子系统介绍。
中间部分为个人分析代码简单记录,比较啰嗦,如果你只是想知道xenomai时钟子系统与linux时钟子系统之间的关系可直接到2.6 xenomai内核下Linux时钟工作流程查看总结。
linux时间子系统是一个很大的板块,控制着linux的方方面面。这里只说双核相关的部分。即侧重于Linux与底层硬件交互这一块。
关于Linux时间子系统的详细内容,请移步蜗窝科技关系Linux 时间子系统专栏。文章中Linux时间子系统大部分内容来自于此,在此谢过~
Linux时间子系统框架大致如下:
处理器采用时钟定时器来周期性地提供系统脉搏。时钟中断是普通外设中断的一种。调度器利用时钟中断来定时检测当前正在运行的线程是否需要调度。提供时钟中断的设备就是tick device。
如今在多核架构下,每个CPU形成了自己的一个小系统,有自己的调度、自己的进程统计等,这个小系统拥有自己的tick device,而且每个CPU上tick device是唯一的,tick device可以工作在periodic mode或者one shot mode,这是和系统配置有关(由于中断的处理会影响实时性,一般将xenomai所在CPU的tick device配置工作在one shot mode模式)。因此,整个系统中,在tick device layer,有多少个cpu,就会有多少个tick device,称为local tick device。当然,有些事情(例如整个系统的负荷计算)不适合在local tick驱动下进行,因此,所有的local tick device中会有一个被选择做global tick device,该device负责维护整个系统的jiffies,更新wall clock,计算全局负荷什么的。
tick_device 数据结构如下
/*tick device可以工作在两种模式下,一种是周期性tick模式,另外一种是one shot模式。*/ enum tick_device_mode { TICKDEV_MODE_PERIODIC, TICKDEV_MODE_ONESHOT,/*one shot模式主要和tickless系统以及高精度timer有关*/ }; struct tick_device { struct clock_event_device *evtdev; enum tick_device_mode mode; };
tick device依赖于底层硬件产生定时事件来推动运行,这些产生定时事件的硬件是timer,除此之外还需要一个在指定输入频率的clock下工作的一个counter来提供计时。对形形色色的timer和counter硬件,linux kernel抽象出了通用clock event layer和通用clock source模块,这两个模块和硬件无关。所谓clock source是用来抽象一个在指定输入频率的clock下工作的一个counter。clock event提供的是一定周期的event,如果应用程序需要读取当前的时间,比如ns精度时,就需要通过timekeeping从clock source中获取与上个tick之间的时间后返回此时时间。
底层的clock source chip驱动通过调用通用clock event和clock source模块的接口函数,注册clock source和clock event设备。
int clocksource_register(struct clocksource *cs) void clockevents_register_device(struct clock_event_device *dev)
每个CPU上tick device是唯一的,但为Tick device提供tick event的timer硬件并不唯一,如上图中有Lapic-timer、lapic-deadline、Hpet
等,有多少个timer硬件就注册多少个clock event device,各个cpu的tick device会选择自己适合的那个clock event设备。
clock_event_devic
结构如下:
struct clock_event_device { void (*event_handler)(struct clock_event_device *); int (*set_next_event)(unsigned long evt, struct clock_event_device *); int (*set_next_ktime)(ktime_t expires, struct clock_event_device *); ktime_t next_event; u64 max_delta_ns; u64 min_delta_ns; u32 mult; u32 shift; enum clock_event_state state_use_accessors; unsigned int features; unsigned long retries; int (*set_state_periodic)(struct clock_event_device *); int (*set_state_oneshot)(struct clock_event_device *); int (*set_state_oneshot_stopped)(struct clock_event_device *); int (*set_state_shutdown)(struct clock_event_device *); int (*tick_resume)(struct clock_event_device *); void (*broadcast)(const struct cpumask *mask); void (*suspend)(struct clock_event_device *); void (*resume)(struct clock_event_device *); unsigned long min_delta_ticks; unsigned long max_delta_ticks; const char *name; int rating; int irq; int bound_on; const struct cpumask *cpumask; struct list_head list; ...... } ____cacheline_aligned;
简要说下各成员变量的含义:
event_handler
产生了clock event的时候调用的handler,硬件timer中断到来的时候调用该timer中断handler,而在这个中断handler中再调用event_handler
。
set_next_event
设定产生下一个event。一般是clock的counter的cycle数值,一般的timer硬件都是用cycle值设定会比较方便,当然,不排除有些奇葩可以直接使用ktime(秒、纳秒),这时候clock event device的features成员要打上CLOCK_EVT_FEAT_KTIME的标记使用set_next_ktime()函数设置。
set_state_periodic
、set_state_oneshot
、set_state_shutdown
设置各个模式的配置函数。
broadcast
上面说到每个cpu有一个tcik device外还需要一个全局的clock event,为各CPU提供唤醒等功能。
rating
该clock evnet的精度等级,在选做tick device时做参考。
irq
该clock event对应的系统中断号。
void clockevents_register_device(struct clock_event_device *dev) { unsigned long flags; ...... if (!dev->cpumask) { WARN_ON(num_possible_cpus() > 1); dev->cpumask = cpumask_of(smp_processor_id()); } list_add(&dev->list, &clockevent_devices);/*加入clock event设备全局列表 */ tick_check_new_device(dev);/*让上层软件知道底层又注册一个新的clock device,当然,是否上层软件要使用这个新的clock event device是上层软件的事情*/ clockevents_notify_released(); ...... }
clock event device的cpumask
指明该设备为哪一个CPU工作,如果没有设定并且cpu的个数大于1的时候要给出warning信息并进行设定(设定为当前运行该代码的那个CPU core)。在multi core的环境下,底层driver在调用该接口函数注册clock event设备之前就需要设定cpumask成员,毕竟一个timer硬件附着在哪一个cpu上底层硬件最清楚。这里只是对未做设定的的设定为当前CPU。
将新注册的clockevent device添加到全局链表clockevent_devices
,然后调用tick_check_new_device()
让上层软件知道底层又注册一个新的clock device,当然,是否上层软件会通过一系列判断后来决定是否使用这个clock event作为tick device。如果被选作tick device 会为该clock event设置回调函数event_handler
,如上图所示:event_handler
不同的模式会被设置为tick_handle_periodic()
、hrtimer_interrupt()
或tick_nohz_handler()
。代码详细解析,后面会简要说明;
对应x86平台,clock event device有APIC-timer、hept,hept的rating没有lapic timer高。所以每个CPU上的loacl-apic timer作为该CPU的tick device。
//arch\x86\kernel\hpet.c static struct clock_event_device lapic_clockevent = { .name = "lapic", .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT | CLOCK_EVT_FEAT_C3STOP | CLOCK_EVT_FEAT_DUMMY, .shift = 32, .set_state_shutdown = lapic_timer_shutdown, .set_state_periodic = lapic_timer_set_periodic, .set_state_oneshot = lapic_timer_set_oneshot, .set_state_oneshot_stopped = lapic_timer_shutdown, .set_next_event = lapic_next_event, .broadcast = lapic_timer_broadcast, .rating = 100, .irq = -1, }; //arch\x86\kernel\apic\apic.c static struct clock_event_device hpet_clockevent = { .name = "hpet", .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT, .set_state_periodic = hpet_legacy_set_periodic, .set_state_oneshot = hpet_legacy_set_oneshot, .set_state_shutdown = hpet_legacy_shutdown, .tick_resume = hpet_legacy_resume, .set_next_event = hpet_legacy_next_event, .irq = 0, .rating = 50, };
apic的中断函数smp_apic_timer_interrupt()
,然后调用local_apic_timer_interrupt()
:
__visible void __irq_entry smp_apic_timer_interrupt(struct pt_regs *regs) { struct pt_regs *old_regs = set_irq_regs(regs); /* * NOTE! We'd better ACK the irq immediately, * because timer handling can be slow. * * update_process_times() expects us to have done irq_enter(). * Besides, if we don't timer interrupts ignore the global * interrupt lock, which is the WrongThing (tm) to do. */ entering_ack_irq(); trace_local_timer_entry(LOCAL_TIMER_VECTOR); local_apic_timer_interrupt(); /*执行handle*/ trace_local_timer_exit(LOCAL_TIMER_VECTOR); exiting_irq(); set_irq_regs(old_regs); } static void local_apic_timer_interrupt(void) { struct clock_event_device *evt = this_cpu_ptr(&lapic_events); if (!evt->event_handler) { pr_warning("Spurious LAPIC timer interrupt on cpu %d\n", smp_processor_id()); /* Switch it off */ lapic_timer_shutdown(evt); return; } inc_irq_stat(apic_timer_irqs); evt->event_handler(evt);/*执行event_handler*/ }
local_apic_timer_interrupt()
先获得产生该中断的clock_event_device
,然后执行event_handler()
。
linux 中clock source主要与timekeeping模块关联,这里不细说,查看系统中的可用的clock source:
$cat /sys/devices/system/clocksource/clocksource0/available_clocksource tsc hpet acpi_pm
查看系统中当前使用的clock source的信息:
$ cat /sys/devices/system/clocksource/clocksource0/current_clocksource tsc
这里主要说一下与xenomai相关的clock source 设备TSC(Time Stamp Counter),x86处理器提供的TSC是一个高分辨率计数器,以恒定速率运行(在较旧的处理器上,TSC计算内部处理器的时钟周期,这意味着当处理器的频率缩放比例改变时,TSC的频率也会改变,现今的TSC在处理器的所有操作状态下均以恒定的速率运行,其频率远远超过了处理器的频率),可以用单指令RDTSC
读取。
struct clocksource clocksource_tsc = { .name = "tsc", .rating = 300, .read = read_tsc, .mask = CLOCKSOURCE_MASK(64), .flags = CLOCK_SOURCE_IS_CONTINUOUS | CLOCK_SOURCE_MUST_VERIFY, .archdata = { .vclock_mode = VCLOCK_TSC }, .resume = tsc_resume, .mark_unstable = tsc_cs_mark_unstable, .tick_stable = tsc_cs_tick_stable, };
tsc在init_tsc_clocksource()
中调用int clocksource_register(struct clocksource *cs)
注册,流程如下:
1.调用__clocksource_update_freq_scale(cs, scale, freq)
,根据tsc频率计算mult和shift,具体计算流程文章实时内核与linux内核时钟漂移过大原因.docx已分析过。
2.调用clocksource_enqueue(cs)
根据clock source按照rating的顺序插入到全局链表clock source list中
3.选择一个合适的clock source。kernel当然是选用一个rating最高的clocksource作为当前的正在使用的那个clock source。每当注册一个新的clock source的时候调用clocksource_select进行选择,毕竟有可能注册了一个精度更高的clock source。 X86系统中tsc rating最高,为300。
到此clock source注册就注册完了。
上面说到tick device的几种模式,下面结合整个系统模式说明。高精度的timer需要高精度的clock event,工作在one shot mode的tick device工提供高精度的clock event(clockeventHandler中处理高精度timer)。因此,基于one shot mode下的tick device,系统实现了高精度timer,系统的各个模块可以使用高精度timer的接口来完成定时服务。
虽然有了高精度timer的出现, 内核并没有抛弃老的低精度timer机制(内核开发人员试图整合高精度timer和低精度的timer,不过失败了,所以目前内核中,两种timer是同时存在的)。当系统处于高精度timer的时候(tick device处于one shot mode),系统会setup一个特别的高精度timer(可以称之sched timer),该高精度timer会周期性的触发,从而模拟的传统的periodic tick,从而推动了传统低精度timer的运转。因此,一些传统的内核模块仍然可以调用经典的低精度timer模块的接口。系统可根据需要配置为以下几种模式,具体配置见其他文档:
1、使用低精度timer + 周期tick
根据当前系统的配置情况(周期性tick),会调用tick_setup_periodic
函数,这时候,该tick device对应的clock event device的clock event handler被设置为tick_handle_periodic。底层硬件会周期性的产生中断,从而会周期性的调用tick_handle_periodic
从而驱动整个系统的运转。
这时候高精度timer模块是运行在低精度的模式,也就是说这些hrtimer虽然是按照高精度timer的红黑树进行组织,但是系统只是在每一周期性tick到来的时候调用hrtimer_run_queues
函数,来检查是否有expire的hrtimer。毫无疑问,这里的高精度timer也就是没有意义了。
2、低精度timer + Dynamic Tick
系统开始的时候并不是直接进入Dynamic tick mode的,而是经历一个切换过程。开始的时候,系统运行在周期tick的模式下,各个cpu对应的tick device的(clock event device的)event handler是tick_handle_periodic
。在timer的软中断上下文中,会调用tick_check_oneshot_change进行是否切换到one shot模式的检查,如果系统中有支持one-shot的clock event device,并且没有配置高精度timer的话,那么就会发生tick mode的切换(调用tick_nohz_switch_to_nohz),这时候,tick device会切换到one shot模式,而event handler被设置为tick_nohz_handler
。由于这时候的clock event device工作在one shot模式,因此当系统正常运行的时候,在event handler中每次都要reprogram clock event,以便正常产生tick。当cpu运行idle进程的时候,clock event device不再reprogram产生下次的tick信号,这样,整个系统的周期性的tick就停下来。
高精度timer和低精度timer的工作原理同上。
3、高精度timer + Dynamic Tick
同样的,系统开始的时候并不是直接进入Dynamic tick mode的,而是经历一个切换过程。系统开始的时候是运行在周期tick的模式下,event handler是tick_handle_periodic
。在周期tick的软中断上下文中(参考run_timer_softirq),如果满足条件,会调用hrtimer_switch_to_hres将hrtimer从低精度模式切换到高精度模式上。这时候,系统会有下面的动作:
(1)Tick device的clock event设备切换到oneshot mode(参考tick_init_highres函数)
(2)Tick device的clock event设备的event handler会更新为
hrtimer_interrupt
(参考tick_init_highres
函数)(3)设定sched timer(即模拟周期tick那个高精度timer,参考
tick_setup_sched_timer
函数)这样,当下一次tick到来的时候,系统会调用hrtimer_interrupt
来处理这个tick(该tick是通过sched timer产生的)。
在Dynamic tick的模式下,各个cpu的tick device工作在one shot模式,该tick device对应的clock event设备也工作在one shot的模式,这时候,硬件Timer的中断不会周期性的产生,但是linux kernel中很多的模块是依赖于周期性的tick的,因此,在这种情况下,系统使用hrtime模拟了一个周期性的tick。在切换到dynamic tick模式的时候会初始化这个高精度timer,该高精度timer的回调函数是tick_sched_timer。这个函数执行的函数类似周期性tick中event handler执行的内容。不过在最后会reprogram该高精度timer,以便可以周期性的产生clock event。当系统进入idle的时候,就会stop这个高精度timer,这样,当没有用户事件的时候,CPU可以持续在idle状态,从而减少功耗。
4、高精度timer + 周期性Tick
这种配置不多见,多半是由于硬件无法支持one shot的clock event device,这种情况下,整个系统仍然是运行在周期tick的模式下。
总结一下:linux启动过程中初始化时钟系统,当xenomai内核未启动时,linux直接对底层硬件lapic-timer编程,底层硬件lapic-timer产生中断推动整个Linux中的各个时钟及调度运行。
我们可以将Linux抽出如下图,只需要为Linux提供设置下一个时钟事件set_next_event()
和提供event触发eventHandler()
执行两个接口就能推动整个linux时间子系统运转,下面解析Xenomai是怎样为linux提供这两个接口的,达到控制整个时钟系统的。
我们知道x86下每个cpu核有一个lapic,lapic中有定时硬件lapic-timer和hpet。tsc作为timeline,提供计时,lapic-timer用来产生clock event。对于现今X86 CPU 操作系统一般都是使用TSC和lapic-timer作为clock source和clock event,因为精度最高(Atom 系列处理器可能会有区别).
xenomai的默认时间管理对象是xnclock,xnclock管理着xenomai整个系统的时间、任务定时、调度等,xnclok的默认时钟源为TSC。当然我们可以自定义clocksource。比如在TSC不可靠的系统上,可以使用外部定时硬件来作为时钟源,当自定义时钟时需要实现结构体中的宏CONFIG_XENO_OPT_EXTCLOCK
包含的几个必要函数,且编译配置使能CONFIG_XENO_OPT_EXTCLOCK
。
注意:这里的自定义时钟源只是将TSC替换为其他时钟源,产生event的还是lapic-timer.
struct xnclock { /** (ns) */ xnticks_t wallclock_offset; /*获取时钟偏移:timekeeping - tsc*/ /** (ns) */ xnticks_t resolution; /** (raw clock ticks). */ struct xnclock_gravity gravity; /** Clock name. */ const char *name; struct { #ifdef CONFIG_XENO_OPT_EXTCLOCK xnticks_t (*read_raw)(struct xnclock *clock); xnticks_t (*read_monotonic)(struct xnclock *clock); int (*set_time)(struct xnclock *clock, const struct timespec *ts); xnsticks_t (*ns_to_ticks)(struct xnclock *clock, xnsticks_t ns); xnsticks_t (*ticks_to_ns)(struct xnclock *clock, xnsticks_t ticks); xnsticks_t (*ticks_to_ns_rounded)(struct xnclock *clock, xnsticks_t ticks); void (*program_local_shot)(struct xnclock *clock, struct xnsched *sched); void (*program_remote_shot)(struct xnclock *clock, struct xnsched *sched); #endif int (*set_gravity)(struct xnclock *clock, const struct xnclock_gravity *p); void (*reset_gravity)(struct xnclock *clock); #ifdef CONFIG_XENO_OPT_VFILE void (*print_status)(struct xnclock *clock, struct xnvfile_regular_iterator *it); #endif } ops; /* Private section. */ struct xntimerdata *timerdata; int id; #ifdef CONFIG_SMP /** Possible CPU affinity of clock beat. */ cpumask_t affinity; #endif #ifdef CONFIG_XENO_OPT_STATS struct xnvfile_snapshot timer_vfile; struct xnvfile_rev_tag timer_revtag; struct list_head timerq; int nrtimers; /*统计挂在xnclock xntimer 的数量*/ #endif /* CONFIG_XENO_OPT_STATS */ #ifdef CONFIG_XENO_OPT_VFILE struct xnvfile_regular vfile;//vfile.ops= &clock_ops #endif };
wallclock_offset:linux系统wall time(1970开始的时间值)与系统TSC cycle转换为时间的偏移
resolution:该xnclock的精度
struct xnclock_gravity gravity:该xnclok下,中断、内核、用户空间程序定时器的调整量,对系统精确定时很重要,后面会说到。
struct xnclock_gravity { unsigned long irq; unsigned long kernel; unsigned long user; };
ops:该xnclok的各操作函数。
timerdata:xntimer 管理结构头节点,当系统中使用红黑树来管理xntimer时,他是红黑树head节点,当系统使用优先级链表来管理时它是链表头节点,系统会为每个cpu分配一个timerdata,管理着本CPU上已启动的xntimer,当为红黑树时head始终指向最近到期的xntimer,当某个cpu上一个clockevent到来时,xnclock会从该CPU timerdata取出head指向的那个timer看是否到期,然后进一步处理。
#if defined(CONFIG_XENO_OPT_TIMER_RBTREE) typedef struct { struct rb_root root; xntimerh_t *head; } xntimerq_t; #else typedef struct list_head xntimerq_t; #endif struct xntimerdata { xntimerq_t q; };
timerq:不论是属于哪个cpu的xntimer初始化后都会挂到这个链表上,nrtimers挂在timerq上xntimer的个数
vfile:proc文件系统操作接口,可通过proc查看xenomai clock信息。
cat /proc/xenomai/clock/coreclok
gravity: irq=99 kernel=1334 user=1334
devices: timer=lapic-deadline, clock=tsc
status: on
setup: 99
ticks: 376931548560 (0057 c2defd90)
gravity即xnclock中的结构体gravity的值,devices表示xenomai用于产生clock event的硬件timer,clock为xnclock计时的时钟源。
xenomai 内核默认定义xnclock如下,名字和结构体名一样,至于xnclock怎么和硬件timer 、tsc联系起来后面分析:
struct xnclock nkclock = { .name = "coreclk", .resolution = 1, /* nanosecond. */ .ops = { .set_gravity = set_core_clock_gravity, .reset_gravity = reset_core_clock_gravity, .print_status = print_core_clock_status, }, .id = -1, };
实时任务的所有定时行为最后都会落到内核中的xntimer上,而xnclock管理着硬件clock event,xntimer要完成定时就需要xnclock来获取起始时间,xntimer结构如下:
struct xntimer { #ifdef CONFIG_XENO_OPT_EXTCLOCK struct xnclock *clock; #endif /** Link in timers list. */ xntimerh_t aplink; struct list_head adjlink; /** Timer status. */ unsigned long status; /** Periodic interval (clock ticks, 0 == one shot). */ xnticks_t interval; /** Periodic interval (nanoseconds, 0 == one shot). */ xnticks_t interval_ns; /** Count of timer ticks in periodic mode. */ xnticks_t periodic_ticks; /** First tick date in periodic mode. */ xnticks_t start_date; /** Date of next periodic release point (timer ticks). */ xnticks_t pexpect_ticks; /** Sched structure to which the timer is attached. 附加计时器的Sched结构。*/ struct xnsched *sched; /** Timeout handler. */ void (*handler)(struct xntimer *timer); #ifdef CONFIG_XENO_OPT_STATS #ifdef CONFIG_XENO_OPT_EXTCLOCK struct xnclock *tracker; #endif /** Timer name to be displayed. */ char name[XNOBJECT_NAME_LEN]; /** Timer holder in timebase. */ struct list_head next_stat; /** Number of timer schedules. */ xnstat_counter_t scheduled; /** Number of timer events. */ xnstat_counter_t fired; #endif /* CONFIG_XENO_OPT_STATS */ };
clock:当自定义外部时钟源时,使用外部时钟时的xnclock.
aplink:上面介绍新clock时说到timerdata,当xntimer启动是,aplink就会插入到所在cpu的timerdata中,当timerdata为红黑树时,aplink就是一个rb节点,否则是一个链表节点。分别如下:
//优先级链表结构 struct xntlholder { struct list_head link; xnticks_t key; int prio; }; typedef struct xntlholder xntimerh_t; //树结构 typedef struct { unsigned long long date; unsigned prio; struct rb_node link; } xntimerh_t;
系统默认配置以红黑树形式管理xntimer,date表示定时器的多久后到期;prio表示该定时器的优先级,当加入链表时先date来排序,如果几个定时器date相同就看优先级,优先级高的先处理;link为红黑树节点。
status:定时器状态,所有状态为如下:
#define XNTIMER_DEQUEUED 0x00000001 /*没有挂在xnclock上*/ #define XNTIMER_KILLED 0x00000002 /*该定时器已经被取消*/ #define XNTIMER_PERIODIC 0x00000004 /*该定时器是一个周期定时器*/ #define XNTIMER_REALTIME 0x00000008 /*定时器相对于Linux walltime定时*/ #define XNTIMER_FIRED 0x00000010 /*定时已经到期*/ #define XNTIMER_NOBLCK 0x00000020 /*非阻塞定时器*/ #define XNTIMER_RUNNING 0x00000040 /*定时器已经start*/ #define XNTIMER_KGRAVITY 0x00000080 /*该timer是一个内核态timer*/ #define XNTIMER_UGRAVITY 0x00000100 /*该timer是一个用户态timer*/ #define XNTIMER_IGRAVITY 0 /*该timer是一个中断timer*/
interval、interval_ns:周期定时器的定时周期,分别是tick 和ns,0表示这个xntimer 是单次定时的。
handler:定时器到期后执行的函数。
sched:该timer所在的sched,每个cpu核上有一个sched,管理本cpu上的线程调度,timer又需要本cpu的lapic定时,所以指定了sched就指定了该timer所属cpu。
xntimer 使用需要先调用xntimer_init()
初始化xntimer结构成员,然后xntimer_start()
启动这个xntimer,启动timer就是将它插入xnclock管理的红黑树。
xntimer_init()
是一个宏,内部调用 __xntimer_init
初始化timer,参数timer
:需要初始化的timer;clock
:该timer是依附于哪个xnclock,也就是说哪个xnclock来处理我是否触发,没有自定义就是xnclock,在timer_start的时候就会将这个timer挂到对应的xnclock上去;handler
:该timer到期后执行的hanler;sched
:timer所属的sched;flags:指定该timer标志。
#define xntimer_init(__timer, __clock, __handler, __sched, __flags) \ do { \ __xntimer_init(__timer, __clock, __handler, __sched, __flags); \ xntimer_set_name(__timer, #__handler); \ } while (0) void __xntimer_init(struct xntimer *timer, struct xnclock *clock, void (*handler)(struct xntimer *timer), struct xnsched *sched, int flags) { spl_t s __maybe_unused; #ifdef CONFIG_XENO_OPT_EXTCLOCK timer->clock = clock; #endif xntimerh_init(&timer->aplink); xntimerh_date(&timer->aplink) = XN_INFINITE;//0 xntimer_set_priority(timer, XNTIMER_STDPRIO); timer->status = (XNTIMER_DEQUEUED|(flags & XNTIMER_INIT_MASK)); // (0x01 | flags & 0x000001A0) timer->handler = handler; timer->interval_ns = 0; timer->sched = NULL; /* * Set the timer affinity, preferably to xnsched_cpu(sched) if * sched was given, CPU0 otherwise. */ if (sched == NULL) sched = xnsched_struct(0); xntimer_set_affinity(timer, sched); #ifdef CONFIG_XENO_OPT_STATS #ifdef CONFIG_XENO_OPT_EXTCLOCK timer->tracker = clock; #endif ksformat(timer->name, XNOBJECT_NAME_LEN, "%d/%s", task_pid_nr(current), current->comm); xntimer_reset_stats(timer); xnlock_get_irqsave(&nklock, s); list_add_tail(&timer->next_stat, &clock->timerq); clock->nrtimers++; xnvfile_touch(&clock->timer_vfile); xnlock_put_irqrestore(&nklock, s); #endif /* CONFIG_XENO_OPT_STATS */ }
前面几行都是初始化xntimer 结构体指针,xntimer_set_affinity(timer, sched)
表示将timer移到sched上(timer->shced=sched
)。后面将这个初始化的time加到xnclock 的timerq队列,nrtimers加1。基本成员初始化完了,还有优先级没有设置,aplink中的优先级就代表了该timer的优先级:
static inline void xntimer_set_priority(struct xntimer *timer, int prio) { xntimerh_prio(&timer->aplink) = prio;/*设置timer节点优先级*/ }
启动一个定时器xntimer_start()代码如下:
int xntimer_start(struct xntimer *timer, xnticks_t value, xnticks_t interval, xntmode_t mode) { struct xnclock *clock = xntimer_clock(timer); xntimerq_t *q = xntimer_percpu_queue(timer); xnticks_t date, now, delay, period; unsigned long gravity; int ret = 0; trace_cobalt_timer_start(timer, value, interval, mode); if ((timer->status & XNTIMER_DEQUEUED) == 0) xntimer_dequeue(timer, q); now = xnclock_read_raw(clock); timer->status &= ~(XNTIMER_REALTIME | XNTIMER_FIRED | XNTIMER_PERIODIC); switch (mode) { case XN_RELATIVE: if ((xnsticks_t)value < 0) return -ETIMEDOUT; date = xnclock_ns_to_ticks(clock, value) + now; break; case XN_REALTIME: timer->status |= XNTIMER_REALTIME; value -= xnclock_get_offset(clock); /* fall through */ default: /* XN_ABSOLUTE || XN_REALTIME */ date = xnclock_ns_to_ticks(clock, value); if ((xnsticks_t)(date - now) <= 0) { if (interval == XN_INFINITE) return -ETIMEDOUT; /* * We are late on arrival for the first * delivery, wait for the next shot on the * periodic time line. */ delay = now - date; period = xnclock_ns_to_ticks(clock, interval); date += period * (xnarch_div64(delay, period) + 1); } break; } /* * To cope with the basic system latency, we apply a clock * gravity value, which is the amount of time expressed in * clock ticks by which we should anticipate the shot for any * outstanding timer. The gravity value varies with the type * of context the timer wakes up, i.e. irq handler, kernel or * user thread. */ gravity = xntimer_gravity(timer); xntimerh_date(&timer->aplink) = date - gravity; if (now >= xntimerh_date(&timer->aplink)) xntimerh_date(&timer->aplink) += gravity / 2; timer->interval_ns = XN_INFINITE; timer->interval = XN_INFINITE; if (interval != XN_INFINITE) { timer->interval_ns = interval; timer->interval = xnclock_ns_to_ticks(clock, interval); timer->periodic_ticks = 0; timer->start_date = date; timer->pexpect_ticks = 0; timer->status |= XNTIMER_PERIODIC; } timer->status |= XNTIMER_RUNNING; xntimer_enqueue_and_program(timer, q); return ret; }
启动一个timer即将该timer插入xnclock 红黑树xntimerq_t
。参数value
表示定时时间、interval
为0表示这个timer是单次触发,非0表示周期定时器定时间隔,value
和interval
的单位由mode
决定,当mode
设置为XN_RELATIVE
表示相对定时定时、XN_REALTIME
为相对linux时间定时,时间都为ns,其他则为绝对定时单位为timer的tick。
首先取出红黑树根节点q,如果这个timer的状态是从队列删除(其他地方取消了这个定时器),就先把他从红黑树中删除。读取tsc得到此时tsc的tick值now
,然后根据参数计算timer的到期时间date,中间将单位转换为ticks。下面开始设置红黑树中的最终值,xntimer_gravity(timer)
根据这个timer为谁服务取出对应的gravity
。
static inline unsigned long xntimer_gravity(struct xntimer *timer) { struct xnclock *clock = xntimer_clock(timer); if (timer->status & XNTIMER_KGRAVITY)/*内核空间定时器*/ return clock->gravity.kernel; if (timer->status & XNTIMER_UGRAVITY)/*用户空间定时器*/ return clock->gravity.user; return clock->gravity.irq;/*中断*/ }
为什么要设置gravity呢?xenomai是个实时系统必须保证定时器的精确,xntimer都是由硬件timer产生中断后处理的,如果没有gravity,对于用户空间实时任务RT:假如此时时间刻度是0,该任务定时10us后触发定时器,10us后,产生了中断,此时时间刻度为10us,开始处理xntimer,然后切换回内核空间执行调度,最后切换回用户空间,从定时器到期到最后切换回RT也是需要时间的,已经超过RT所定的10us,因此,需要得到定时器超时->回到用户空间的这段时间gravity;不同空间的任务经过的路径不一样,所以针对kernel、user和irq分别计算gravity,当任务定时,定时器到期时间date-gravity才是xntimer的触发时间。当切换回原来的任务时刚好是定时时间。
gravity是怎样计算的,xenomai初始化相关文章分析;
最后将timer状态设置为XNTIMER_RUNNING
,调用xntimer_enqueue_and_program(timer, q)
将timer按超时时间date和优先级插入该CPU红黑树timedata,新加入了一个timer就需要重新看看,最近超时的timer是哪一个,然后设置底层硬件timer的下一个event时间,为最近一个要超时的timer date:
void xntimer_enqueue_and_program(struct xntimer *timer, xntimerq_t *q) { xntimer_enqueue(timer, q);/*添加到红黑树*/ if (xntimer_heading_p(timer)) {/*这个timer处于第一个节点或者需要重新调度的sched的第二个节点*/ struct xnsched *sched = xntimer_sched(timer);/*timer所在的sched*/ struct xnclock *clock = xntimer_clock(timer);/*当前存数所在的CPU*/ if (sched != xnsched_current())/*不是当前CPU任务的定时器*/ xnclock_remote_shot(clock, sched);/*给当前CPU发送ipipe_send_ipi(IPIPE_HRTIMER_IPI),让 sched 对应CPU重新调度*/ else xnclock_program_shot(clock, sched);/*设置下一个one shot*/ } } int xntimer_heading_p(struct xntimer *timer) { struct xnsched *sched = timer->sched; xntimerq_t *q; xntimerh_t *h; q = xntimer_percpu_queue(timer); h = xntimerq_head(q); if (h == &timer->aplink)/*timer 就是第一个*/ return 1; if (sched->lflags & XNHDEFER) {/*处于重新调度状态*/ h = xntimerq_second(q, h);/*这个timer 处于重新调度状态下红黑树下 */ if (h == &timer->aplink) return 1; } return 0; }
由于head始终指向时间最小的timer,xntimer_heading_p()
中先看head是不是刚刚插入的这个timer,如果是并且是本CPU上的timer就直接设置这timer的时间为lapic-timer的中断时间,对应22行返回->执行10行。
如果是最小但是不是本CPU上的就需要通过ipipe向timer所在CPU发送一个中断信号IPIPE_HRTIMER_IPI
,告诉那个cpu,那个cpu就会执行中断处理函数xnintr_core_clock_handler()
,对应22行返回->执行8行,为什么是IPIPE_HRTIMER_IPI
?相当于模拟底层lapic-timer 产生了一个event事件,ipipe会让那个cpu 执行xnintr_core_clock_handler()
对timer进行一个刷新,重新对底层硬件timer编程。
如果新插入的timer不是最小的,但是所在的sched处于XNHDEFER
状态,说明第一个timer虽然最小,但是这个最小的如果到期暂时不需要处理,那就取出定时时间第二小的timer,看是不是新插入的timer,如果是,返回1,继续决定是编程还是发中断信号。
如果其他情况,那就不用管了,启动定时器流程完毕。一个一个timer到期后总会处理到新插入的这个的。
其中的向某个cpu发送中断信号函数如下,IPIPE_HRTIMER_IPI
是注册到xnsched_realtime_domain的中断,底层硬件timer产生中断的中断号就是IPIPE_HRTIMER_VECTOR
,这里的发送中断是通过中断控制器APIC来完成的,APIC会给对应cpu产生一个中断,然后就会被ipipe通过ipipeline,优先给xnsched_realtime_domain处理,ipipe domain管理说过:
void xnclock_core_remote_shot(struct xnsched *sched) { ipipe_send_ipi(IPIPE_HRTIMER_IPI, *cpumask_of(xnsched_cpu(sched))); } int xntimer_setup_ipi(void) { return ipipe_request_irq(&xnsched_realtime_domain, IPIPE_HRTIMER_IPI, (ipipe_irq_handler_t)xnintr_core_clock_handler, NULL, NULL); }
对底层timer编程的函调用xnclock_core_local_shot()
函数,最后调用ipipe_timer_set(delay)
进行设置,event时间:
static inline void xnclock_program_shot(struct xnclock *clock, struct xnsched *sched) { xnclock_core_local_shot(sched); } void xnclock_core_local_shot(struct xnsched *sched) { ....... delay = xntimerh_date(&timer->aplink) - xnclock_core_read_raw(); if (delay < 0) delay = 0; else if (delay > ULONG_MAX) delay = ULONG_MAX; ipipe_timer_set(delay); }
ipipe_timer_set()
中先获取这个cpu的percpu_timer t
,然后将定时时间转换为硬件的tick数,最后调用t->set(tdelay, t->timer_set)
进行设置。这里的percpu_timer 与ipipe 相关下面解析,这里只用知道最后是调用了percpu_timer 的set函数,这个set函数是直接设置硬件lapic-timer的。
void ipipe_timer_set(unsigned long cdelay) { unsigned long tdelay; struct ipipe_timer *t; t = __ipipe_raw_cpu_read(percpu_timer); ....... /*将时间转换定时器 频率数*/ tdelay = cdelay; if (t->c2t_integ != 1) tdelay *= t->c2t_integ; if (t->c2t_frac) tdelay += ((unsigned long long)cdelay * t->c2t_frac) >> 32; if (tdelay < t->min_delay_ticks) tdelay = t->min_delay_ticks; if (tdelay > t->max_delay_ticks) tdelay = t->max_delay_ticks; if (t->set(tdelay, t->timer_set) < 0) ipipe_raise_irq(t->irq); }
总结:启动一个xntimer,首先确定属于哪个cpu,然后将它插入到该cpu的xntimer管理结构timerdata,插入时按定时长短和优先级来决定,最后设置底层硬件timer产生下一个中断的时间点。
linux时间系统中说到有多少个硬件timer,就会注册多少个clock event device,最后linux会为每个cpu选择一个合适的clock event来为tick device产生event。xenomai系统的运行也需要这么一个合适的硬件timer来产生event,由于xenomai需要的硬件都是由ipipe来提供,所以ipipe需要知道系统中有哪些clock event device被注册,然后ipipe为每一个cpu核选择一个合适的。
ipipe将linux中clock event device按xenomai系统需要重新抽象为结构体struct ipipe_timer
,系统中有一个全局链表timer,当底层驱动调用clockevents_register_device
,注册clock event设备时ipipe对应的创建一个ipipe_timer插入链表timer。struct ipipe_timer
如下:
struct ipipe_timer { int irq; void (*request)(struct ipipe_timer *timer, int steal); int (*set)(unsigned long ticks, void *timer); void (*ack)(void); void (*release)(struct ipipe_timer *timer); /* Only if registering a timer directly */ const char *name; unsigned rating; unsigned long freq; unsigned long min_delay_ticks; unsigned long max_delay_ticks; const struct cpumask *cpumask; /* For internal use */ void *timer_set; /* pointer passed to ->set() callback */ struct clock_event_device *host_timer;/*依赖的clock event*/ struct list_head link; unsigned c2t_integ; unsigned c2t_frac; /* For clockevent interception */ u32 real_mult; u32 real_shift; void (*mode_handler)(enum clock_event_mode mode, struct clock_event_device *); int orig_mode; int (*orig_set_state_periodic)(struct clock_event_device *); int (*orig_set_state_oneshot)(struct clock_event_device *); int (*orig_set_state_oneshot_stopped)(struct clock_event_device *); int (*orig_set_state_shutdown)(struct clock_event_device *); int (*orig_set_next_event)(unsigned long evt, struct clock_event_device *cdev); unsigned int (*refresh_freq)(void); };
irq:该ipipe_timer所依赖的clock_event_device的中断号,产生中断时ipipe将中断分配给谁处理用到;
request:设定clock_event_device模式的函数
set:设置下一个定时中断的函数,这个就是上面启动xntimer时的那个函数
ack:产生中断后中断清除函数
rating:该clock_event_device的raning级别
freq:该clock_event_device的运行频率
min_delay_ticks、max_delay_ticks:最小、最大定时时间
cpumask:cpu掩码,标识可以为哪个cpu提供定时服务
host_timer:这个ipipe_timer对应是哪个clock_event_device
link:链表节点,加入全局链表timer时使用
orig_set_state_periodic、orig_set_state_oneshot、orig_set_state_oneshot_stopped、orig_set_next_event,为xenomai提供服务需要将clock_event_device中一些已经设置的函数替换,这些用来备份原clock_event_device中的函数。
再来看一看clock xevent注册函数clockevents_register_device()
,ipipe补丁在其中插入了一个注册函数ipipe_host_timer_register()
先把clock xevent管理起来:
void clockevents_register_device(struct clock_event_device *dev) { unsigned long flags; ...... ipipe_host_timer_register(dev); .... } static int get_dev_mode(struct clock_event_device *evtdev) { if (clockevent_state_oneshot(evtdev) || clockevent_state_oneshot_stopped(evtdev)) return CLOCK_EVT_MODE_ONESHOT; if (clockevent_state_periodic(evtdev)) return CLOCK_EVT_MODE_PERIODIC; if (clockevent_state_shutdown(evtdev)) return CLOCK_EVT_MODE_SHUTDOWN; return CLOCK_EVT_MODE_UNUSED; } void ipipe_host_timer_register(struct clock_event_device *evtdev) { struct ipipe_timer *timer = evtdev->ipipe_timer; if (timer == NULL) return; timer->orig_mode = CLOCK_EVT_MODE_UNUSED; if (timer->request == NULL) timer->request = ipipe_timer_default_request;/*设置request函数*/ /* * By default, use the same method as linux timer, on ARM at * least, most set_next_event methods are safe to be called * from Xenomai domain anyway. */ if (timer->set == NULL) { timer->timer_set = evtdev; timer->set = (typeof(timer->set))evtdev->set_next_event;/*设定的counter的cycle数值*/ } if (timer->release == NULL) timer->release = ipipe_timer_default_release; if (timer->name == NULL) timer->name = evtdev->name; if (timer->rating == 0) timer->rating = evtdev->rating; timer->freq = (1000000000ULL * evtdev->mult) >> evtdev->shift;/*1G*mult >> shift*/ if (timer->min_delay_ticks == 0) timer->min_delay_ticks = (evtdev->min_delta_ns * evtdev->mult) >> evtdev->shift; if (timer->max_delay_ticks == 0) timer->max_delay_ticks = (evtdev->max_delta_ns * evtdev->mult) >> evtdev->shift; if (timer->cpumask == NULL) timer->cpumask = evtdev->cpumask; timer->host_timer = evtdev; ipipe_timer_register(timer); }
这里面通过evtdev直接将一些结构体成员赋值,这里需要注意的的是timer->set = (typeof(timer->set))evtdev->set_next_event;对于lapic-timer来说timer->set=lapic_next_event
,如果CPU支持tsc deadline特性则是timer->set=lapic_next_deadline,TSC-deadline模式允许软件使用本地APIC timer 在绝对时间发出中断信号,使用tsc来设置deadline,为了全文统一,使用apic-timer,这决定了xenomai是否能直接控制硬件,然后调用ipipe_timer_register()
将ipipe_timer添加到链表timer完成注册:
void ipipe_timer_register(struct ipipe_timer *timer) { struct ipipe_timer *t; unsigned long flags; if (timer->timer_set == NULL) timer->timer_set = timer; if (timer->cpumask == NULL) timer->cpumask = cpumask_of(smp_processor_id()); raw_spin_lock_irqsave(&lock, flags); list_for_each_entry(t, &timers, link) {/*按插入链表*/ if (t->rating <= timer->rating) { __list_add(&timer->link, t->link.prev, &t->link); goto done; } } list_add_tail(&timer->link, &timers);/*按插入全局链表尾*/ done: raw_spin_unlock_irqrestore(&lock, flags); }
xenomai在每一个cpu核都需要一个ipipe_timer 来推动调度、定时等,ipipe为每个CPU分配了一个ipipe_timer指针percpu_timer
,链表timers
记录了所有ipipe_timer,这样就可以从链表中选择可供xenomai使用的ipipe_timer
:
static DEFINE_PER_CPU(struct ipipe_timer *, percpu_timer);
另外,在3.ipipe domian管理说到每个cpu上管理不同域的结构体ipipe_percpu_data
,里面有一个成员变量int hrtimer_irq
,这个hrtimer_irq
是用来存放为这个cpu提供event的硬件timer的中断号的,用于将ipipe_percpu_data
与ipipe_timer
联系起来,介绍完相关数据结构下面来看xenomai 时钟系统初始化流程。
DECLARE_PER_CPU(struct ipipe_percpu_data, ipipe_percpu);
xenomai内核系统初始化源码文件:kernel\xenomai\init.c
,时钟系统在xenomai初始化流程中调用mach_setup()
完成硬件相关初始化:
xenomai_init(void)
->mach_setup()
static int __init mach_setup(void) { struct ipipe_sysinfo sysinfo; int ret, virq; ret = ipipe_select_timers(&xnsched_realtime_cpus); ... ipipe_get_sysinfo(&sysinfo);/*获取 系统ipipe 信息*/ if (timerfreq_arg == 0) timerfreq_arg = sysinfo.sys_hrtimer_freq; if (clockfreq_arg == 0) clockfreq_arg = sysinfo.sys_hrclock_freq; cobalt_pipeline.timer_freq = timerfreq_arg; cobalt_pipeline.clock_freq = clockfreq_arg; if (cobalt_machine.init) { ret = cobalt_machine.init();/* mach_x86_init */ if (ret) return ret; } ipipe_register_head(&xnsched_realtime_domain, "Xenomai"); ...... ret = xnclock_init(cobalt_pipeline.clock_freq);/*初始化xnclock,为Cobalt提供clock服务时钟*/ return 0;
首先调用ipipe_select_timers()
来为每个cpu选择一个ipipe_timer。
int ipipe_select_timers(const struct cpumask *mask) { unsigned hrclock_freq; unsigned long long tmp; struct ipipe_timer *t; struct clock_event_device *evtdev; unsigned long flags; unsigned cpu; cpumask_t fixup; ....... if (__ipipe_hrclock_freq > UINT_MAX) { tmp = __ipipe_hrclock_freq; do_div(tmp, 1000); hrclock_freq = tmp; } else hrclock_freq = __ipipe_hrclock_freq;/*1000ULL * cpu_khz*/ ....... for_each_cpu(cpu, mask) {/*从timers 为每一个CPU选择一个 percpu_timer*/ list_for_each_entry(t, &timers, link) {/*遍历ipipe全局timer链表*/ if (!cpumask_test_cpu(cpu, t->cpumask)) continue; evtdev = t->host_timer; if (evtdev && clockevent_state_shutdown(evtdev))/*该CPU timer 被软件shutdown则跳过*/ continue; goto found; } .... goto err_remove_all; found: install_pcpu_timer(cpu, hrclock_freq, t);/*设置每一个CPU的timer*/ } ....... flags = ipipe_critical_enter(ipipe_timer_request_sync); ipipe_timer_request_sync();/*如果支持,则切换到单触发模式。*/ ipipe_critical_exit(flags); ....... }
先得到从全局变量cpu_khz得到tsc频率保存到hrclock_freq
,然后为xenomai运行的每一个cpu核进行ippie_timer选择,对每一个遍历全局链表timers
,取出evtdev
,看是否能为该cpu服务,并且没有处于关闭状态。evtdev
在Linux没有被使用就会被Linux关闭。最后选出来的也就是lapic-timer 。
找到合适的tevtdev后调用install_pcpu_timer(cpu, hrclock_freq, t)
,为该cpu设置ipipe_timer:
static void install_pcpu_timer(unsigned cpu, unsigned hrclock_freq, struct ipipe_timer *t) { per_cpu(ipipe_percpu.hrtimer_irq, cpu) = t->irq; per_cpu(percpu_timer, cpu) = t; config_pcpu_timer(t, hrclock_freq); }
主要是设置几个xenomai相关的precpu变量,ipipe_percpu.hrtimer_irq
设置为该evtdev
的irq,percpu_timer
为该evtdev对应的ipipe_timer,然后计算ipipe_timer中lapic-timer与tsc频率之间的转换因子c2t_integ、c2t_frac
;
回到ipipe_select_timers(),通过ipipe给每一个cpu发送一个中断IPIPE_CRITICAL_IPI
,将每一个lapic-timer通过ipipe_timer->request
设置为oneshot模式。
回到mach_setup()
,为每个cpu选出ipipe_timer后获取此时系统信息:ipipe_get_sysinfo(&sysinfo)
int ipipe_get_sysinfo(struct ipipe_sysinfo *info) { info->sys_nr_cpus = num_online_cpus();/*运行的cpu数据*/ info->sys_cpu_freq = __ipipe_cpu_freq;/*1000ULL * cpu_khz*/ info->sys_hrtimer_irq = per_cpu(ipipe_percpu.hrtimer_irq, 0);/*cpu0的ipipe_timer中断号*/ info->sys_hrtimer_freq = __ipipe_hrtimer_freq;/*time的频率*/ info->sys_hrclock_freq = __ipipe_hrclock_freq;/*1000ULL * cpu_khz*/ return 0; }
在这里还是觉得有问题,CPU和TSC、timer三者频率不一定相等。
这几个变量在接下来初始化xnclock中使用。xnclock_init(cobalt_pipeline.clock_freq)
:
int __init xnclock_init(unsigned long long freq) { xnclock_update_freq(freq); nktimerlat = xnarch_timer_calibrate(); xnclock_reset_gravity(&nkclock); /* reset_core_clock_gravity */ xnclock_register(&nkclock, &xnsched_realtime_cpus); return 0; }
xnclock_update_freq(freq)
计算出tsc频率与时间ns单位的转换因子tsc_scale,tsc_shift,计算流程可参考文档实时内核与linux内核时钟漂移过大原因.docx
xnarch_timer_calibrate()
计算出每次对硬件timer编程这个执行过程需要多长时间,也就是测量ipipe_timer_set()
这个函数的执行时间nktimerlat
,计算方法是这样先确保测量这段时间timer不会触发中断干扰,所以先用ipipe_timer_set()
给硬件timer设置一个很长的超时值,然后开始测量,先从TSC读取现在的时间tick值\(t_0\),然后循环执行100次ipipe_timer_set()
,接着从TSC读取现在的时间tick值\(t_1\),ipipe_timer_set()
平均每次的执行时间是$(t_1-t_0)/100 \(单位\)tick$,为了算上其他可能的延迟\(5\%\),\(nktimerlat = (t_1-t_0)/105\);
下面计算对kernel、user、irq xntimer精确定时的gravity,上面已经说过为甚需要这个,xnclock_reset_gravity(&nkclock)
调用执行xnclock->ops.reset_gravity()
,也就是reset_core_clock_gravity()
函数:
static void reset_core_clock_gravity(struct xnclock *clock) { struct xnclock_gravity gravity; xnarch_get_latencies(&gravity); gravity.user += nktimerlat; if (gravity.kernel == 0) gravity.kernel = gravity.user; if (gravity.irq == 0) gravity.irq = nktimerlat; set_core_clock_gravity(clock, &gravity); }
首先通过xnarch_get_latencies()
函数来计算各空间的gravity
,其实这个函数里没有具体的计算流程,给的都是一些经验值,要么我们自己编译时配置:
static inline void xnarch_get_latencies(struct xnclock_gravity *p) { unsigned long sched_latency; #if CONFIG_XENO_OPT_TIMING_SCHEDLAT != 0 sched_latency = CONFIG_XENO_OPT_TIMING_SCHEDLAT; #else /* !CONFIG_XENO_OPT_TIMING_SCHEDLAT */ if (strcmp(ipipe_timer_name(), "lapic") == 0) { #ifdef CONFIG_SMP if (num_online_cpus() > 1) sched_latency = 3350; else sched_latency = 2000; #else /* !SMP */ sched_latency = 1000; #endif /* !SMP */ } else if (strcmp(ipipe_timer_name(), "pit")) { /* HPET */ #ifdef CONFIG_SMP if (num_online_cpus() > 1) sched_latency = 3350; else sched_latency = 1500; #else /* !SMP */ sched_latency = 1000; #endif /* !SMP */ } else { sched_latency = (__get_bogomips() < 250 ? 17000 : __get_bogomips() < 2500 ? 4200 : 3500); #ifdef CONFIG_SMP sched_latency += 1000; #endif /* CONFIG_SMP */ } #endif /* !CONFIG_XENO_OPT_TIMING_SCHEDLAT */ p->user = sched_latency; p->kernel = CONFIG_XENO_OPT_TIMING_KSCHEDLAT; p->irq = CONFIG_XENO_OPT_TIMING_IRQLAT; }
首先判断宏CONFIG_XENO_OPT_TIMING_SCHEDLAT 如果不等于0,说明我们自己配置了这个数,直接赋值就行,否则的话,根据xenomai使用的定时器是lapic 还是hept给不同的一些经验值了:
p->user = CONFIG_XENO_OPT_TIMING_SCHEDLAT; p->kernel = CONFIG_XENO_OPT_TIMING_KSCHEDLAT; p->irq = CONFIG_XENO_OPT_TIMING_IRQLAT;
CONFIG_XENO_OPT_TIMING_SCHEDLAT宏在内核编译时设置,默认为0,使用已有的经验值:
[*] Xenomai/cobalt --->
Latency settings --->
(0) User scheduling latency (ns)
(0) Intra-kernel scheduling latency (ns)
(0) Interrupt latency (ns)
实际使用后发现这个经验值也不太准,从测试数据看i5处理器与赛扬就存在差别,如果开启内核trace,就更不准了.
计算出gravity后加上ipipe_timer_set()
执行需要的时间nktimerlat
,就是最终的gravity。以用户空间实时程序定时为例如下(图中时间段与比例无关):
到此mach_setup()
函数中上层软件时钟相关初始化完了,但xenomai还不能直接对硬件timer,此时xenomai进程调度还没初始化,硬件timer与内核调度等息息相关,xenomai内核还不能掌管硬件timer,不能保证linux愉快运行,硬抢过来只能一起阵亡。等xenomai内核任务管理等初始化完毕,给Linux舒适的运行空间,就可以直接控制硬件timer了,下面继续解析这个函数sys_init()
;
sys_init()
涉及每个CPU上的调度结构体初始化等。先插以点内容,每个cpu上的xenomai 调度由对象xnsched
来管理,xnsched
对象每个cpu有一个,其中包含各类sched class,还包含两个xntimer,一个host timer ---htimer
,主要给linux定时,另一个循环计时timer rrbtimer
;一个xnthead结构rootcb
,xenomai调度的是线程,每个实时线程使用xnthead结构表示,这个rootcb表示本cpu上xenomai调度的linux,在双核下linux只是xenomai的一个idle任务,cpu0上xnsched结构如下;
详细的结构后面会分析,这里只解析时钟相关部分。
static __init int sys_init(void) { struct xnsched *sched; void *heapaddr; int ret, cpu; if (sysheap_size_arg == 0) sysheap_size_arg = CONFIG_XENO_OPT_SYS_HEAPSZ;/**/ heapaddr = xnheap_vmalloc(sysheap_size_arg * 1024);/*256 * 1024*/ ..... xnheap_set_name(&cobalt_heap, "system heap"); for_each_online_cpu(cpu) { sched = &per_cpu(nksched, cpu); xnsched_init(sched, cpu); } #ifdef CONFIG_SMP ipipe_request_irq(&xnsched_realtime_domain, IPIPE_RESCHEDULE_IPI, (ipipe_irq_handler_t)__xnsched_run_handler, NULL, NULL); #endif xnregistry_init(); /* * If starting in stopped mode, do all initializations, but do * not enable the core timer. */ if (realtime_core_state() == COBALT_STATE_WARMUP) { ret = xntimer_grab_hardware(); /*霸占硬件host定时器*/ ..... set_realtime_core_state(COBALT_STATE_RUNNING); /*更新实时内核状态*/ } return 0; }
sys_init()
中先初始化内核堆空间,初始化每个CPU上的调度结构体xnsched
、创建idle线程,也就是上面说到的roottcb
,多cpu核调度等,经过这一些步骤,LInux已经变成xenomai的一个idle线程了,最后调用xntimer_grab_hardware()
,接管硬件timer:
int xntimer_grab_hardware(void) { struct xnsched *sched; int ret, cpu, _cpu; spl_t s; ....... nkclock.wallclock_offset = xnclock_get_host_time() - xnclock_read_monotonic(&nkclock); ret = xntimer_setup_ipi(); ipipe_request_irq(&xnsched_realtime_domain,IPIPE_HRTIMER_IPI, (ipipe_irq_handler_t)xnintr_core_clock_handler, NULL, NULL); for_each_realtime_cpu(cpu) { ret = grab_hardware_timer(cpu); if (ret < 0) goto fail; xnlock_get_irqsave(&nklock, s); sched = xnsched_struct(cpu); if (ret > 1) xntimer_start(&sched->htimer, ret, ret, XN_RELATIVE); else if (ret == 1) xntimer_start(&sched->htimer, 0, 0, XN_RELATIVE); #ifdef CONFIG_XENO_OPT_WATCHDOG /*启动看门狗定时器*/ xntimer_start(&sched->wdtimer, 1000000000UL, 1000000000UL, XN_RELATIVE); xnsched_reset_watchdog(sched); #endif xnlock_put_irqrestore(&nklock, s); } ...... return ret; }
注册xnclock时nkclock.wallclock_offset
没有设置,现在设置也就是walltime的时间与tsc 的时间偏移。然后注册IPIPE_HRTIMER_IPI中断到xnsched_realtime_domain,9.2xntimer那一节启动一个xntimer需要通知其他cpu处理时发送的IPIPE_HRTIMER_IPI:
int xntimer_setup_ipi(void) { return ipipe_request_irq(&xnsched_realtime_domain, IPIPE_HRTIMER_IPI, (ipipe_irq_handler_t)xnintr_core_clock_handler, NULL, NULL); }
接下来就是重要的为每个cpu接管硬件timer了,其实过程也简单,就是将原来lcock event的一些操作函数替换来达到目的,每个cpu上xenomai调度管理结构xnsched
,每个xnsched中有一个定时器htimer
,这个xntimer就是为linux服务的,根据底层timer的类型,后启动htimer
,htimer
推动linux继时间子系统运行。这些后面会详细解析。 回到接管timer函数grab_hardware_timer(cpu)
:
static int grab_hardware_timer(int cpu) { int tickval, ret; ret = ipipe_timer_start(xnintr_core_clock_handler, switch_htick_mode, program_htick_shot, cpu); switch (ret) { case CLOCK_EVT_MODE_PERIODIC: /* * Oneshot tick emulation callback won't be used, ask * the caller to start an internal timer for emulating * a periodic tick. */ tickval = 1000000000UL / HZ; break; case CLOCK_EVT_MODE_ONESHOT: /* oneshot tick emulation */ tickval = 1; break; case CLOCK_EVT_MODE_UNUSED: /* we don't need to emulate the tick at all. */ tickval = 0; break; case CLOCK_EVT_MODE_SHUTDOWN: return -ENODEV; default: return ret; } return tickval; }
主要的操作在ipipe_timer_start(xnintr_core_clock_handler,switch_htick_mode, program_htick_shot, cpu)
,后面的就是判断这个timer工作在什么模式,相应的返回好根据模式设置htimer为linux服务;
ipipe_timer_start(xnintr_core_clock_handler,switch_htick_mode, program_htick_shot, cpu)
其中的xnintr_core_clock_handler
是lapic-timer 产生中断时xenomai内核的处理函数,里面会去处理每个xntimer以及xenomai调度;switch_htick_mode
是lapic-timer工作模式切换函数,program_htick_shot
函数是对sched->htimer重新定时的函数,这个函数对linux来说特别重要,以后linux就不直接对硬件timer设置定时了,而是给xenomai中的sched->htimer设置。下面是ipipe_timer_start
代码:
int ipipe_timer_start(void (*tick_handler)(void), void (*emumode)(enum clock_event_mode mode, struct clock_event_device *cdev), int (*emutick)(unsigned long evt, struct clock_event_device *cdev), unsigned int cpu) { struct grab_timer_data data; int ret; data.tick_handler = tick_handler;/*xnintr_core_clock_handler*/ data.emutick = emutick;/*program_htick_shot*/ data.emumode = emumode;/*switch_htick_mode*/ data.retval = -EINVAL; ret = smp_call_function_single(cpu, grab_timer, &data, true);/*执行grab_timer*/ return ret ?: data.retval; }
先将传入的几个函数指正存到结构体data,然后调用smp_call_function_single
传给函数grab_timer
处理,smp_call_function_single
中的smp
表示给指定的cpu去执行grab_timer
,对应的cpu执行grab_timer(&data)
:
static void grab_timer(void *arg) { struct grab_timer_data *data = arg; struct clock_event_device *evtdev; struct ipipe_timer *timer; struct irq_desc *desc; unsigned long flags; int steal, ret; flags = hard_local_irq_save(); timer = this_cpu_read(percpu_timer); evtdev = timer->host_timer; ret = ipipe_request_irq(ipipe_head_domain, timer->irq, (ipipe_irq_handler_t)data->tick_handler, NULL, __ipipe_ack_hrtimer_irq); if (ret < 0 && ret != -EBUSY) { hard_local_irq_restore(flags); data->retval = ret; return; } steal = evtdev != NULL && !clockevent_state_detached(evtdev); if (steal && evtdev->ipipe_stolen == 0) { timer->real_mult = evtdev->mult; timer->real_shift = evtdev->shift; timer->orig_set_state_periodic = evtdev->set_state_periodic; timer->orig_set_state_oneshot = evtdev->set_state_oneshot; timer->orig_set_state_oneshot_stopped = evtdev->set_state_oneshot_stopped; timer->orig_set_state_shutdown = evtdev->set_state_shutdown; timer->orig_set_next_event = evtdev->set_next_event; timer->mode_handler = data->emumode;/*switch_htick_mode*/ evtdev->mult = 1; evtdev->shift = 0; evtdev->max_delta_ns = UINT_MAX; if (timer->orig_set_state_periodic) evtdev->set_state_periodic = do_set_periodic; if (timer->orig_set_state_oneshot) evtdev->set_state_oneshot = do_set_oneshot; if (timer->orig_set_state_oneshot_stopped) evtdev->set_state_oneshot_stopped = do_set_oneshot_stopped; if (timer->orig_set_state_shutdown) evtdev->set_state_shutdown = do_set_shutdown; evtdev->set_next_event = data->emutick; /* program_htick_shot */ evtdev->ipipe_stolen = 1; } hard_local_irq_restore(flags); data->retval = get_dev_mode(evtdev); desc = irq_to_desc(timer->irq); if (desc && irqd_irq_disabled(&desc->irq_data)) ipipe_enable_irq(timer->irq); if (evtdev->ipipe_stolen && clockevent_state_oneshot(evtdev)) {/* 启动oneshot*/ ret = clockevents_program_event(evtdev, evtdev->next_event, true); if (ret) data->retval = ret; } }
首先从percpu_timer取出我们在ipipe_select_timers选择的那个clockevent device evtdev
,现在要这个evtdev
为xenomai服务,所以将它的中断注册到ipipe_head_domain,当中断来的时候后ipipe会交给ipipe_head_domain调用data->tick_handler也就是xnintr_core_clock_handler
处理,xnintr_core_clock_handler
中处理xenomai在本CPU当上的调度、定时等。
在struct clock_event_device
中ipipe添加了一个标志位ipipe_stolen用来表示该evtdev
是不是已经为实时系统服务,是就是1,否则为0,这里当然为0,先将原来evtdev
的操作函数备份到’orig_‘打头的成员变量中,设置ipipe_timer的real_mult、real_shift为evtdev的mult、shift,原evtdev的mult、shift设置为1、0,linux计算的时候才能与xntimer定时时间对应起来。
最重要的是把原来evtdev->set_next_event
设置成了program_htick_shot
,program_htick_shot如下,从此linux就是对shched->htimer
定时器设置定时,来替代原来的evtdev
:
static int program_htick_shot(unsigned long delay, struct clock_event_device *cdev) { struct xnsched *sched; int ret; spl_t s; xnlock_get_irqsave(&nklock, s); sched = xnsched_current(); ret = xntimer_start(&sched->htimer, delay, XN_INFINITE, XN_RELATIVE); /*相对,单次定时*/ xnlock_put_irqrestore(&nklock, s); return ret ? -ETIME : 0; }
其余的最后如果evtdev中断没有使能就使能中断,evtdev是oneshot状态启动oneshot,到此xenomai掌管了lpic-tiemr,从此xenomai内核直接设置lpic-tiemr,lpic-tiemr到时产生中断,ipipe调用执行xnintr_core_clock_handler
处理lpic-tiemr中断,xnintr_core_clock_handler
处理xenomai时钟系统:
void xnintr_core_clock_handler(void) { struct xnsched *sched = xnsched_current(); int cpu __maybe_unused = xnsched_cpu(sched); xnstat_exectime_t *prev; if (!xnsched_supported_cpu(cpu)) { #ifdef XNARCH_HOST_TICK_IRQ ipipe_post_irq_root(XNARCH_HOST_TICK_IRQ); #endif return; } ...... ++sched->inesting; /*中断嵌套++*/ sched->lflags |= XNINIRQ; /*在中断上下文状态*/ xnlock_get(&nklock); xnclock_tick(&nkclock); /* 处理一个时钟tick*/ xnlock_put(&nklock); trace_cobalt_clock_exit(per_cpu(ipipe_percpu.hrtimer_irq, cpu)); xnstat_exectime_switch(sched, prev); if (--sched->inesting == 0) { /*如果没有其他中断嵌套,执行从新调度*/ sched->lflags &= ~XNINIRQ; xnsched_run(); /*调度*/ sched = xnsched_current(); } /* * If the core clock interrupt preempted a real-time thread, * any transition to the root thread has already triggered a * host tick propagation from xnsched_run(), so at this point, * we only need to propagate the host tick in case the * interrupt preempted the root thread. */ if ((sched->lflags & XNHTICK) && xnthread_test_state(sched->curr, XNROOT)) xnintr_host_tick(sched); }
xnintr_core_clock_handler
中,首先判断产生这个中断的cpu属不属于实时调度cpu,如果不属于,那就把中断post到root域后直接返回,ipipe会在root域上挂起这个中断给linux处理。
如果这是运行xenomai的cpu,接下来调用xnclock_tick(&nkclock)
,来处理一个时钟tick,里面就是看该cpu上哪些xntimer到期了做相应处理:
void xnclock_tick(struct xnclock *clock) { struct xnsched *sched = xnsched_current(); struct xntimer *timer; xnsticks_t delta; xntimerq_t *tmq; xnticks_t now; xntimerh_t *h; atomic_only(); ...... tmq = &xnclock_this_timerdata(clock)->q;/**/ /* * Optimisation: any local timer reprogramming triggered by * invoked timer handlers can wait until we leave the tick * handler. Use this status flag as hint to xntimer_start(). */ sched->status |= XNINTCK; now = xnclock_read_raw(clock); while ((h = xntimerq_head(tmq)) != NULL) { timer = container_of(h, struct xntimer, aplink); delta = (xnsticks_t)(xntimerh_date(&timer->aplink) - now); if (delta > 0) break; trace_cobalt_timer_expire(timer); xntimer_dequeue(timer, tmq); xntimer_account_fired(timer);/*timer->fired ++*/ /* * By postponing the propagation of the low-priority * host tick to the interrupt epilogue (see * xnintr_irq_handler()), we save some I-cache, which * translates into precious microsecs on low-end hw. */ if (unlikely(timer == &sched->htimer)) { sched->lflags |= XNHTICK; sched->lflags &= ~XNHDEFER; if (timer->status & XNTIMER_PERIODIC) goto advance; continue; } /* Check for a locked clock state (i.e. ptracing).*/ if (unlikely(nkclock_lock > 0)) { if (timer->status & XNTIMER_NOBLCK) goto fire; if (timer->status & XNTIMER_PERIODIC) goto advance; /* * We have no period for this blocked timer, * so have it tick again at a reasonably close * date in the future, waiting for the clock * to be unlocked at some point. Since clocks * are blocked when single-stepping into an * application using a debugger, it is fine to * wait for 250 ms for the user to continue * program execution. */ xntimerh_date(&timer->aplink) += xnclock_ns_to_ticks(xntimer_clock(timer), 250000000); goto requeue; } fire: timer->handler(timer);/******************************/ now = xnclock_read_raw(clock); timer->status |= XNTIMER_FIRED; /* * Only requeue periodic timers which have not been * requeued, stopped or killed. */ if ((timer->status & (XNTIMER_PERIODIC|XNTIMER_DEQUEUED|XNTIMER_KILLED|XNTIMER_RUNNING)) != (XNTIMER_PERIODIC|XNTIMER_DEQUEUED|XNTIMER_RUNNING)) continue; advance: do { timer->periodic_ticks++; xntimer_update_date(timer); } while (xntimerh_date(&timer->aplink) < now); requeue: #ifdef CONFIG_SMP /* * If the timer was migrated over its timeout handler, * xntimer_migrate() re-queued it already. */ if (unlikely(timer->sched != sched)) continue; #endif xntimer_enqueue(timer, tmq); } sched->status &= ~XNINTCK; xnclock_program_shot(clock, sched); }
xnclock_tick里主要处理各种类型的xntimer,首先取出本cpu上管理xntimer红黑树的根节点xntimerq_t,然后开始处理,为了安全设置sched状态标识status
为XNINTCK,标识该sched正在处理tick,得到现在tsc值now
,然后一个while循环,取出红黑树上定时最小的那个xntimer,得到这个xntimer的时间date
,如果date减去now大于0,说明最短定时的xntimer都没有到期,那就不需要继续处理,直接跳出循环,执行xnclock_program_shot(clock, sched)
设置定时器下一个中断触发时间。
如果有xntimer到期,date减去now小于等于0,首先从红黑树中删除,然后xntimer.fire加1,表示xntimer到期次数,然后处理,这里逻辑有点绕:
1.如果是sched->htimer
,就是为Linux定时的,先设置sched->lflags |= XNHTICK
,这个标志设置的是lflags不是status,因为linux的不是紧急的,后面本cpu没有高优先级实时任务运行才会给linux处理。接着判断是不是一个周期timer,如果是,goto到advance更新timer时间date,可能已将过去几个周期时间了,所有使用循环一个一个周期的增加直到现在时间now,然后重新插入红黑树。
2.如果这个xntimer是一个非阻塞timer,直接跳转fire执行handler,并设置状态已经FIRED。
3.如果这是一个非htimer的周期定时器,那同样更新时间后重新加入红黑树。
4.以上都不是就将xntimer重新定时250ms,加入红黑树。
xnclock_tick
执行返回后,xnstat_exectime_switch()
更新该cpu上每个域的执行时间,然后如果没有其他中断嵌套则进行任务调度xnsched_run()
;
不知经过多少个rt任务切换后回到这个上下文,并且当前cpu运行linux,上次离开这linux的定时器htimer还没处理呢,检查如果当前cpu上运行linux,并且sched->lflags
中有 XNHTICK
标志,那将中断通过ipipe post给linux处理,并清除lflags中的XNHTICK,linux中断子系统就会去只执行eventhandler,处理linux时间子系统。
void xnintr_host_tick(struct xnsched *sched) /* Interrupts off. */ { sched->lflags &= ~XNHTICK; #ifdef XNARCH_HOST_TICK_IRQ ipipe_post_irq_root(XNARCH_HOST_TICK_IRQ); #endif }
到此时钟系统中除调度相关的外,一个CPU上双核系统时钟流程如下图所示:
总结:xenomai内核启动时,grab_timer()
结合ipipe通过替换回调函数将原linux系统timer lapic-timer作为xenomai 系统timer,xenomai直接对层硬件lapic-timer编程,linux退化为xenomai的idle任务,idle任务的主时钟就变成linux的时钟来源,由linux直接对层硬件lapic-timer编程变成对idle hrtimer编程。idle hrtimer依附于xenomai时钟xnclock,xnclock运作来源于底层硬件lapic-timer。
为什么要设置gravity呢?
xenomai是个实时系统必须保证定时器的精确,xntimer都是由硬件timer产生中断后处理的,如果没有gravity,对于用户空间实时任务RT:假如此时时间刻度是0,该任务定时10us后触发定时器,10us后,产生了中断,此时时间刻度为10us,开始处理xntimer,然后切换回内核空间执行调度,最后切换回用户空间,从定时器到期到最后切换回RT也是需要时间的,已经超过RT所定的10us,因此,需要得到定时器超时->回到用户空间的这段时间gravity;不同空间的任务经过的路径不一样,所以针对kernel、user和irq分别计算gravity,当任务定时,定时器到期时间date-gravity才是xntimer的触发时间。当切换回原来的任务时刚好是定时时间。
总结来说是,CPU执行代码需要时间,调度度上下切换需要时间,中断、内核态、用户态需要的时间不一样,需要将中间的这些时间排除,这些时间就是gravity。
gravity可以使用xenomai 内核代码中的经验值,还可以内核编译时自定义,除这两种之外,xenomai还提供了一种自动计算的程序autotune,它的使用需要配合内核模块autotune,编译内核时选中编译:
[] Xenomai/cobalt --->
Core features --->
<> Auto-tuning
程序autotune位于/usr/xenomai/sbin目录下,直接执行会分别计算irq、kernel、user的gravity;