20
20
;/**************************************************************************/
21
21
;/**************************************************************************/
22
22
23
+ SWI0 EQU 0x872E0
24
+
23
25
extern __tx_timer_expiration_process
24
26
extern __tx_timer_system_clock
25
27
extern __tx_timer_expired_time_slice
29
31
extern __tx_timer_time_slice
30
32
extern __tx_timer_list_end
31
33
extern __tx_thread_time_slice
34
+ extern __tx_thread_preempt_disable
35
+ extern __tx_thread_execute_ptr
36
+ extern __tx_thread_current_ptr
32
37
33
38
section .text:CODE:ROOT
34
39
37
42
;/* FUNCTION RELEASE */
38
43
;/* */
39
44
;/* _tx_timer_interrupt RXv2/IAR */
40
- ;/* 6.1.9 */
45
+ ;/* 6.1.10 */
41
46
;/* AUTHOR */
42
47
;/* */
43
48
;/* William E. Lamie, Microsoft Corporation */
76
81
;/* 12-30-2020 William E. Lamie Initial Version 6.1.3 */
77
82
;/* 10-15-2021 William E. Lamie Modified comment(s), */
78
83
;/* resulting in version 6.1.9 */
84
+ ;/* 01-31-2022 William E. Lamie Modified comment(s), and */
85
+ ;/* added missing thread */
86
+ ;/* preemption logic, */
87
+ ;/* resulting in version 6.1.10 */
79
88
;/* */
80
89
;/**************************************************************************/
81
90
@@ -94,38 +103,38 @@ __tx_timer_interrupt:
94
103
PUSHM R14 - R15
95
104
PUSHM R1 - R5
96
105
97
- MOV .L #__tx_timer_system_clock , R1 ; Pickup address of system clock
98
- MOV .L [ R1 ], R2 ; Pickup system clock
99
- ADD # 1 , R2 ; Increment system clock
100
- MOV .L R2 ,[ R1 ] ; Store new system clock
106
+ MOV .L #__tx_timer_system_clock , R1 ; Pickup address of system clock
107
+ MOV .L [ R1 ], R2 ; Pickup system clock
108
+ ADD # 1 , R2 ; Increment system clock
109
+ MOV .L R2 ,[ R1 ] ; Store new system clock
101
110
;
102
111
; /* Test for time-slice expiration. */
103
112
; if (_tx_timer_time_slice)
104
113
; {
105
114
;
106
- MOV .L #__tx_timer_time_slice , R1 ; Pickup address of time slice
107
- MOV .L [ R1 ], R2 ; Pickup the current time slice
108
- CMP # 0 , R2 ; Is a time slice active?
109
- BEQ __tx_timer_no_time_slice ; No, skip timer slice processing
115
+ MOV .L #__tx_timer_time_slice , R1 ; Pickup address of time slice
116
+ MOV .L [ R1 ], R2 ; Pickup the current time slice
117
+ CMP # 0 , R2 ; Is a time slice active?
118
+ BEQ __tx_timer_no_time_slice ; No, skip timer slice processing
110
119
;
111
120
; /* Decrement the time_slice. */
112
121
; _tx_timer_time_slice--;
113
122
;
114
- SUB # 1 , R2 ; Decrement the time-slice
115
- MOV .L R2 , [ R1 ] ; Store time-slice
123
+ SUB # 1 , R2 ; Decrement the time-slice
124
+ MOV .L R2 , [ R1 ] ; Store time-slice
116
125
;
117
126
; /* Check for expiration. */
118
127
; if (__tx_timer_time_slice == 0)
119
128
;
120
- CMP # 0 , R2 ; Has it expired?
121
- BNE __tx_timer_no_time_slice ; No, time-slice has not expired
129
+ CMP # 0 , R2 ; Has it expired?
130
+ BNE __tx_timer_no_time_slice ; No, time-slice has not expired
122
131
;
123
132
; /* Set the time-slice expired flag. */
124
133
; _tx_timer_expired_time_slice = TX_TRUE;
125
134
;
126
- MOV .L #__tx_timer_expired_time_slice , R1 ; Pickup address of expired time-slice
127
- MOV .L # 1 , R2 ; Build expired value
128
- MOV .L R2 , [ R1 ] ; Set expired time slice variable
135
+ MOV .L #__tx_timer_expired_time_slice , R1 ; Pickup address of expired time-slice
136
+ MOV .L # 1 , R2 ; Build expired value
137
+ MOV .L R2 , [ R1 ] ; Set expired time slice variable
129
138
; }
130
139
;
131
140
__tx_timer_no_time_slice:
@@ -134,20 +143,20 @@ __tx_timer_no_time_slice:
134
143
; if (*_tx_timer_current_ptr)
135
144
; {
136
145
;
137
- MOV .L #__tx_timer_current_ptr , R1 ; Pickup address of current timer ptr
138
- MOV .L [ R1 ], R2 ; Pickup current pointer
146
+ MOV .L #__tx_timer_current_ptr , R1 ; Pickup address of current timer ptr
147
+ MOV .L [ R1 ], R2 ; Pickup current pointer
139
148
MOV .L [ R2 +], R1 ; Pickup timer list entry, _tx_timer_current_ptr++
140
- CMP # 0 , R1 ; Is timer pointer NULL?
141
- BEQ __tx_timer_no_timer ; Yes, no timer has expired
149
+ CMP # 0 , R1 ; Is timer pointer NULL?
150
+ BEQ __tx_timer_no_timer ; Yes, no timer has expired
142
151
143
152
;
144
153
; /* Set expiration flag. */
145
154
; _tx_timer_expired = TX_TRUE;
146
155
;
147
- MOV .L #__tx_timer_expired , R2 ; Build address of expired flag
148
- MOV .L # 1 , R1 ; Build expired value
156
+ MOV .L #__tx_timer_expired , R2 ; Build address of expired flag
157
+ MOV .L # 1 , R1 ; Build expired value
149
158
MOV .L R1 , [ R2 ]
150
- BRA __tx_timer_done ; Finished with timer processing
159
+ BRA __tx_timer_done ; Finished with timer processing
151
160
;
152
161
; }
153
162
; else
@@ -162,17 +171,17 @@ __tx_timer_no_timer:
162
171
; /* Check for wrap-around. */
163
172
; if (_tx_timer_current_ptr == _tx_timer_list_end)
164
173
;
165
- MOV .L #__tx_timer_list_end , R1 ; Pickup the timer list end ptr
166
- MOV .L [ R1 ], R1 ; Pickup actual timer list end
167
- CMP R1 , R2 ; Are we at list end?
168
- BNE __tx_timer_skip_wrap ; No, don't move pointer to the
169
- ; top of the list
174
+ MOV .L #__tx_timer_list_end , R1 ; Pickup the timer list end ptr
175
+ MOV .L [ R1 ], R1 ; Pickup actual timer list end
176
+ CMP R1 , R2 ; Are we at list end?
177
+ BNE __tx_timer_skip_wrap ; No, don't move pointer to the
178
+ ; top of the list
170
179
;
171
180
; /* Wrap to beginning of list. */
172
181
; _tx_timer_current_ptr = _tx_timer_list_start;
173
182
;
174
- MOV .L #__tx_timer_list_start , R2 ; Pickup the timer list start ptr
175
- MOV .L [ R2 ], R2 ; Pickup the start of the list
183
+ MOV .L #__tx_timer_list_start , R2 ; Pickup the timer list start ptr
184
+ MOV .L [ R2 ], R2 ; Pickup the start of the list
176
185
; }
177
186
;
178
187
__tx_timer_skip_wrap:
@@ -186,25 +195,25 @@ __tx_timer_done:
186
195
; {
187
196
;
188
197
MOV .L #__tx_timer_expired_time_slice , R1 ; Pickup expired time slice addr
189
- MOV .L [ R1 ], R1 ; Pickup expired time slice
190
- MOV .L #__tx_timer_expired , R2 ; Pickup expired timer flag address
191
- MOV .L [ R2 ], R2 ; Pickup actual flag
192
- OR R1 , R2 ; Or flags together
193
- BEQ __tx_timer_nothing_expired ; If Z set, nothing has expired
198
+ MOV .L [ R1 ], R1 ; Pickup expired time slice
199
+ MOV .L #__tx_timer_expired , R2 ; Pickup expired timer flag address
200
+ MOV .L [ R2 ], R2 ; Pickup actual flag
201
+ OR R1 , R2 ; Or flags together
202
+ BEQ __tx_timer_nothing_expired ; If Z set, nothing has expired
194
203
195
204
__tx_something_expired:
196
205
; /* Did a timer expire? */
197
206
; if (_tx_timer_expired)
198
207
; {
199
- MOV .L #__tx_timer_expired , R1 ; Pickup expired flag address
200
- MOV .L [ R1 ], R1 ; Pickup expired flag
201
- CMP # 0 , R1 ; Is the expired timer flag set?
202
- BEQ __tx_timer_dont_activate ; No, skip timer activation
208
+ MOV .L #__tx_timer_expired , R1 ; Pickup expired flag address
209
+ MOV .L [ R1 ], R1 ; Pickup expired flag
210
+ CMP # 0 , R1 ; Is the expired timer flag set?
211
+ BEQ __tx_timer_dont_activate ; No, skip timer activation
203
212
;
204
213
; /* Process timer expiration. */
205
214
; _tx_timer_expiration_process();
206
215
;
207
- BSR __tx_timer_expiration_process ; Call the timer expiration handling routine
216
+ BSR __tx_timer_expiration_process ; Call the timer expiration handling routine
208
217
;
209
218
; }
210
219
__tx_timer_dont_activate:
@@ -214,14 +223,31 @@ __tx_timer_dont_activate:
214
223
; {
215
224
;
216
225
MOV .L #__tx_timer_expired_time_slice , R1 ; Pickup time-slice expired flag addr
217
- MOV .L [ R1 ], R1 ; Pickup actual flag
218
- CMP # 0 , R1 ; Has time-slice expired?
219
- BEQ __tx_timer_not_ts_expiration ; No, skip time-slice expiration
226
+ MOV .L [ R1 ], R1 ; Pickup actual flag
227
+ CMP # 0 , R1 ; Has time-slice expired?
228
+ BEQ __tx_timer_not_ts_expiration ; No, skip time-slice expiration
220
229
;
221
230
; /* Time slice interrupted thread. */
222
231
; _tx_thread_time_slice();
223
232
224
- BSR __tx_thread_time_slice ; Call time-slice processing
233
+ BSR __tx_thread_time_slice ; Call time-slice processing
234
+
235
+ ; /* Check if we must trigger a context switch. */
236
+ MOV .L #__tx_thread_preempt_disable , R1 ; Load prempt disable flag.
237
+ MOV .L [ R1 ], R1
238
+ CMP # 0 , R1
239
+ BNE __tx_timer_not_ts_expiration ; Skip if prempt disabled.
240
+
241
+ MOV .L #__tx_thread_execute_ptr , R1
242
+ MOV .L [ R1 ], R1
243
+ MOV .L #__tx_thread_current_ptr , R2
244
+ MOV .L [ R2 ], R2
245
+ CMP R1 , R2
246
+ BEQ __tx_timer_not_ts_expiration
247
+
248
+ MOV .L #SWI0 , R1
249
+ MOV .L # 1 , [ R1 ]
250
+
225
251
; }
226
252
;
227
253
__tx_timer_not_ts_expiration:
0 commit comments