add xenomai

hc

2024-11-01 2f529f9b558ca1c1bd74be7437a84e4711743404

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
/*
 * SPDX-License-Identifier: GPL-2.0
 *
 * Copyright (C) 2019 Philippe Gerum  <rpm@xenomai.org>.
 */
#ifndef _ASM_X86_IRQ_PIPELINE_H
#define _ASM_X86_IRQ_PIPELINE_H
 
#include <asm-generic/irq_pipeline.h>
 
#ifdef CONFIG_IRQ_PIPELINE
 
#include <asm/ptrace.h>
 
#define FIRST_SYSTEM_IRQ    NR_IRQS
#define TIMER_OOB_IPI        apicm_vector_irq(TIMER_OOB_VECTOR)
#define RESCHEDULE_OOB_IPI    apicm_vector_irq(RESCHEDULE_OOB_VECTOR)
#define apicm_irq_vector(__irq) ((__irq) - FIRST_SYSTEM_IRQ + FIRST_SYSTEM_VECTOR)
#define apicm_vector_irq(__vec) ((__vec) - FIRST_SYSTEM_VECTOR + FIRST_SYSTEM_IRQ)
 
#define X86_EFLAGS_SS_BIT    31
 
static inline notrace
unsigned long arch_irqs_virtual_to_native_flags(int stalled)
{
    return (!stalled) << X86_EFLAGS_IF_BIT;
}
 
static inline notrace
unsigned long arch_irqs_native_to_virtual_flags(unsigned long flags)
{
    return hard_irqs_disabled_flags(flags) << X86_EFLAGS_SS_BIT;
}
 
#ifndef CONFIG_PARAVIRT_XXL
 
static inline notrace unsigned long arch_local_irq_save(void)
{
    int stalled = inband_irq_save();
    barrier();
    return arch_irqs_virtual_to_native_flags(stalled);
}
 
static inline notrace void arch_local_irq_enable(void)
{
    barrier();
    inband_irq_enable();
}
 
static inline notrace void arch_local_irq_disable(void)
{
    inband_irq_disable();
    barrier();
}
 
static inline notrace unsigned long arch_local_save_flags(void)
{
    int stalled = inband_irqs_disabled();
    barrier();
    return arch_irqs_virtual_to_native_flags(stalled);
}
 
static inline notrace void arch_local_irq_restore(unsigned long flags)
{
    inband_irq_restore(native_irqs_disabled_flags(flags));
    barrier();
}
 
#endif /* !CONFIG_PARAVIRT_XXL */
 
static inline
void arch_save_timer_regs(struct pt_regs *dst, struct pt_regs *src)
{
    dst->flags = src->flags;
    dst->cs = src->cs;
    dst->ip = src->ip;
    dst->bp = src->bp;
    dst->ss = src->ss;
    dst->sp = src->sp;
}
 
static inline bool arch_steal_pipelined_tick(struct pt_regs *regs)
{
    return !(regs->flags & X86_EFLAGS_IF);
}
 
static inline int arch_enable_oob_stage(void)
{
    return 0;
}
 
static inline void handle_arch_irq(struct pt_regs *regs)
{ }
 
#else /* !CONFIG_IRQ_PIPELINE */
 
struct pt_regs;
 
#ifndef CONFIG_PARAVIRT_XXL
 
static inline notrace unsigned long arch_local_save_flags(void)
{
    return native_save_fl();
}
 
static inline notrace void arch_local_irq_restore(unsigned long flags)
{
    native_restore_fl(flags);
}
 
static inline notrace void arch_local_irq_disable(void)
{
    native_irq_disable();
}
 
static inline notrace void arch_local_irq_enable(void)
{
    native_irq_enable();
}
 
/*
 * For spinlocks, etc:
 */
static inline notrace unsigned long arch_local_irq_save(void)
{
    unsigned long flags = arch_local_save_flags();
    arch_local_irq_disable();
    return flags;
}
 
#endif /* !CONFIG_PARAVIRT_XXL */
 
#endif /* !CONFIG_IRQ_PIPELINE */
 
#endif /* _ASM_X86_IRQ_PIPELINE_H */