diff options
| author | TiejunZhou <[email protected]> | 2022-04-26 14:21:38 +0800 |
|---|---|---|
| committer | GitHub <[email protected]> | 2022-04-26 14:21:38 +0800 |
| commit | e11c166a4045d80ea74fe917e5608474754f5067 (patch) | |
| tree | 0618f87d27c3856df9e856db75048424a8829399 /ports/rxv3/ccrx/src/tx_thread_schedule.src | |
| parent | cef9cb22a5e2b9bca56074c5e627225ec0dd3d73 (diff) | |
| parent | 408f9fa1b78059906368d60d8375ba1fdbb9dc9f (diff) | |
Merge pull request #187 from azure-rtos/tizho/rx_updatev6.1.11_rel
Import RX port update for 6.1.11 release.
Diffstat (limited to 'ports/rxv3/ccrx/src/tx_thread_schedule.src')
| -rw-r--r-- | ports/rxv3/ccrx/src/tx_thread_schedule.src | 54 |
1 files changed, 42 insertions, 12 deletions
diff --git a/ports/rxv3/ccrx/src/tx_thread_schedule.src b/ports/rxv3/ccrx/src/tx_thread_schedule.src index c62b3b6a..e3248c20 100644 --- a/ports/rxv3/ccrx/src/tx_thread_schedule.src +++ b/ports/rxv3/ccrx/src/tx_thread_schedule.src @@ -34,6 +34,11 @@ .GLB __tx_thread_execute_ptr .GLB __tx_thread_current_ptr .GLB __tx_timer_time_slice +.IF TX_LOW_POWER==1 + .GLB _tx_low_power_enter + .GLB _tx_low_power_exit + .GLB __tx_thread_preempt_disable +.ENDIF ; .SECTION P,CODE @@ -42,7 +47,7 @@ ;/* FUNCTION RELEASE */ ;/* */ ;/* _tx_thread_schedule RXv3/CCRX */ -;/* 6.1.10 */ +;/* 6.1.11 */ ;/* AUTHOR */ ;/* */ ;/* William E. Lamie, Microsoft Corporation */ @@ -81,6 +86,9 @@ ;/* resulting in version 6.1.9 */ ;/* 01-31-2022 William E. Lamie Modified comment(s), */ ;/* resulting in version 6.1.10 */ +;/* 04-25-2022 William E. Lamie Modified comment(s), and */ +;/* added low power support, */ +;/* resulting in version 6.1.11 */ ;/* */ ;/**************************************************************************/ ;VOID _tx_thread_schedule(VOID) @@ -88,26 +96,48 @@ .GLB __tx_thread_schedule __tx_thread_schedule: ; -; /* Enable interrupts. */ -; - SETPSW I ; ; /* Wait for a thread to execute. */ ; do ; { - MOV.L #__tx_thread_execute_ptr, R1 ; Address of thread to executer ptr + MOV.L #__tx_thread_execute_ptr, R1 ; Address of thread to executer ptr __tx_thread_schedule_loop: - MOV.L [R1],R2 ; Pickup next thread to execute - CMP #0,R2 ; Is it NULL? - BEQ __tx_thread_schedule_loop ; Yes, idle system, keep checking + SETPSW I ; Enable interrupts + CLRPSW I ; Disable interrupts + MOV.L [R1],R2 ; Pickup next thread to execute + CMP #0,R2 ; Is it NULL? + BNE __tx_thread_thread_ready ; Not NULL, schedule the thread + ; Idle system - no thread is ready +.IF TX_LOW_POWER==1 + MOV.L #__tx_thread_preempt_disable, R1 ; Load prempt disable flag. + MOV.L [R1], R2 + ADD #1, R2 ; Disable preemption while enter/exit + MOV.L R2, [R1] + BSR _tx_low_power_enter ; Possibly enter low power mode +.ENDIF + +.IF TX_ENABLE_WAIT==1 + WAIT ; Wait for interrupt +.ENDIF + +.IF TX_LOW_POWER==1 + CLRPSW I ; Disable interrupts (because WAIT enables interrupts) + BSR _tx_low_power_exit ; Possibly exit low power mode + MOV.L #__tx_thread_preempt_disable, R1 ; Load prempt disable flag. + MOV.L [R1], R2 + SUB #1, R2 ; Enable preemption + MOV.L R2, [R1] + MOV.L #__tx_thread_execute_ptr, R1 ; Address of thread to executer ptr +.ENDIF + + BRA __tx_thread_schedule_loop ; Idle system, keep checking + +__tx_thread_thread_ready: ; ; } ; while(_tx_thread_execute_ptr == TX_NULL); ; -; /* Yes! We have a thread to execute. Lockout interrupts and -; transfer control to it. */ -; - CLRPSW I ; Disable interrupts +; /* Yes! We have a thread to execute. Note that interrupts are locked out at this point. */ ; ; /* Setup the current thread pointer. */ ; _tx_thread_current_ptr = _tx_thread_execute_ptr; |