📄 os_q.lst
字号:
\ 00000084 0300003A BCC ??OSQPend_6
417 *err = OS_ERR_PEND_LOCKED; /* ... can't PEND when locked */
\ 00000088 0D00A0E3 MOV R0,#+13
\ 0000008C 0000C4E5 STRB R0,[R4, #+0]
418 return ((void *)0);
\ 00000090 0000A0E3 MOV R0,#+0
\ 00000094 580000EA B ??OSQPend_1
419 }
420 OS_ENTER_CRITICAL();
\ ??OSQPend_6:
\ 00000098 ........ _BLF OS_CPU_SR_Save,??OS_CPU_SR_Save??rA
\ 0000009C 0070B0E1 MOVS R7,R0
421 pq = (OS_Q *)pevent->OSEventPtr; /* Point at queue control block */
\ 000000A0 040095E5 LDR R0,[R5, #+4]
422 if (pq->OSQEntries > 0) { /* See if any messages in the queue */
\ 000000A4 B611D0E1 LDRH R1,[R0, #+22]
\ 000000A8 010051E3 CMP R1,#+1
\ 000000AC 1400003A BCC ??OSQPend_7
423 msg = *pq->OSQOut++; /* Yes, extract oldest message from the queue */
\ 000000B0 101090E5 LDR R1,[R0, #+16]
\ 000000B4 042091E2 ADDS R2,R1,#+4
\ 000000B8 102080E5 STR R2,[R0, #+16]
\ 000000BC 005091E5 LDR R5,[R1, #+0]
424 pq->OSQEntries--; /* Update the number of entries in the queue */
\ 000000C0 B611D0E1 LDRH R1,[R0, #+22]
\ 000000C4 FF20A0E3 MOV R2,#+255
\ 000000C8 FF2C82E3 ORR R2,R2,#0xFF00
\ 000000CC 011092E0 ADDS R1,R2,R1
\ 000000D0 B611C0E1 STRH R1,[R0, #+22]
425 if (pq->OSQOut == pq->OSQEnd) { /* Wrap OUT pointer if we are at the end of the queue */
\ 000000D4 101090E5 LDR R1,[R0, #+16]
\ 000000D8 082090E5 LDR R2,[R0, #+8]
\ 000000DC 020051E1 CMP R1,R2
\ 000000E0 0100001A BNE ??OSQPend_8
426 pq->OSQOut = pq->OSQStart;
\ 000000E4 041090E5 LDR R1,[R0, #+4]
\ 000000E8 101080E5 STR R1,[R0, #+16]
427 }
428 OS_EXIT_CRITICAL();
\ ??OSQPend_8:
\ 000000EC 0700B0E1 MOVS R0,R7
\ 000000F0 ........ _BLF OS_CPU_SR_Restore,??OS_CPU_SR_Restore??rA
429 *err = OS_ERR_NONE;
\ 000000F4 0000A0E3 MOV R0,#+0
\ 000000F8 0000C4E5 STRB R0,[R4, #+0]
430 return (msg); /* Return message received */
\ 000000FC 0500B0E1 MOVS R0,R5
\ 00000100 3D0000EA B ??OSQPend_1
431 }
432 OSTCBCur->OSTCBStat |= OS_STAT_Q; /* Task will have to pend for a message to be posted */
\ ??OSQPend_7:
\ 00000104 F8009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 00000108 000090E5 LDR R0,[R0, #+0]
\ 0000010C F0109FE5 LDR R1,??OSQPend_5+0x4 ;; OSTCBCur
\ 00000110 001091E5 LDR R1,[R1, #+0]
\ 00000114 2C10D1E5 LDRB R1,[R1, #+44]
\ 00000118 041091E3 ORRS R1,R1,#0x4
\ 0000011C 2C10C0E5 STRB R1,[R0, #+44]
433 OSTCBCur->OSTCBStatPend = OS_STAT_PEND_OK;
\ 00000120 DC009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 00000124 000090E5 LDR R0,[R0, #+0]
\ 00000128 0010A0E3 MOV R1,#+0
\ 0000012C 2D10C0E5 STRB R1,[R0, #+45]
434 OSTCBCur->OSTCBDly = timeout; /* Load timeout into TCB */
\ 00000130 CC009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 00000134 000090E5 LDR R0,[R0, #+0]
\ 00000138 BA62C0E1 STRH R6,[R0, #+42]
435 OS_EventTaskWait(pevent); /* Suspend task until event or timeout occurs */
\ 0000013C 0500B0E1 MOVS R0,R5
\ 00000140 ........ _BLF OS_EventTaskWait,??OS_EventTaskWait??rA
436 OS_EXIT_CRITICAL();
\ 00000144 0700B0E1 MOVS R0,R7
\ 00000148 ........ _BLF OS_CPU_SR_Restore,??OS_CPU_SR_Restore??rA
437 OS_Sched(); /* Find next highest priority task ready to run */
\ 0000014C ........ _BLF OS_Sched,??OS_Sched??rA
438 OS_ENTER_CRITICAL();
\ 00000150 ........ _BLF OS_CPU_SR_Save,??OS_CPU_SR_Save??rA
\ 00000154 0070B0E1 MOVS R7,R0
439 if (OSTCBCur->OSTCBStatPend != OS_STAT_PEND_OK) { /* Was task readied because timed-out or aborted?*/
\ 00000158 A4009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 0000015C 000090E5 LDR R0,[R0, #+0]
\ 00000160 2D00D0E5 LDRB R0,[R0, #+45]
\ 00000164 000050E3 CMP R0,#+0
\ 00000168 0F00000A BEQ ??OSQPend_9
440 pend_stat = OSTCBCur->OSTCBStatPend;
\ 0000016C 90009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 00000170 000090E5 LDR R0,[R0, #+0]
\ 00000174 2D60D0E5 LDRB R6,[R0, #+45]
441 OS_EventTOAbort(pevent);
\ 00000178 0500B0E1 MOVS R0,R5
\ 0000017C ........ _BLF OS_EventTOAbort,??OS_EventTOAbort??rA
442 OS_EXIT_CRITICAL();
\ 00000180 0700B0E1 MOVS R0,R7
\ 00000184 ........ _BLF OS_CPU_SR_Restore,??OS_CPU_SR_Restore??rA
443 switch (pend_stat) {
\ 00000188 020056E3 CMP R6,#+2
\ 0000018C 0200000A BEQ ??OSQPend_10
444 case OS_STAT_PEND_TO:
445 default:
446 *err = OS_ERR_TIMEOUT; /* Indicate a timeout occured */
\ ??OSQPend_11:
\ 00000190 0A00A0E3 MOV R0,#+10
\ 00000194 0000C4E5 STRB R0,[R4, #+0]
\ 00000198 010000EA B ??OSQPend_12
447 break;
448
449 case OS_STAT_PEND_ABORT:
450 *err = OS_ERR_PEND_ABORT; /* Indicate that we aborted */
\ ??OSQPend_10:
\ 0000019C 0E00A0E3 MOV R0,#+14
\ 000001A0 0000C4E5 STRB R0,[R4, #+0]
451 break;
452 }
453 return ((void *)0); /* No message received */
\ ??OSQPend_12:
\ 000001A4 0000A0E3 MOV R0,#+0
\ 000001A8 130000EA B ??OSQPend_1
454 }
455 msg = OSTCBCur->OSTCBMsg;/* No, Extract message from TCB (Put there by QPost) */
\ ??OSQPend_9:
\ 000001AC 50009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 000001B0 000090E5 LDR R0,[R0, #+0]
\ 000001B4 205090E5 LDR R5,[R0, #+32]
456 OSTCBCur->OSTCBMsg = (void *)0;
\ 000001B8 44009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 000001BC 000090E5 LDR R0,[R0, #+0]
\ 000001C0 0010A0E3 MOV R1,#+0
\ 000001C4 201080E5 STR R1,[R0, #+32]
457 OSTCBCur->OSTCBStat = OS_STAT_RDY;
\ 000001C8 34009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 000001CC 000090E5 LDR R0,[R0, #+0]
\ 000001D0 0010A0E3 MOV R1,#+0
\ 000001D4 2C10C0E5 STRB R1,[R0, #+44]
458 OSTCBCur->OSTCBEventPtr = (OS_EVENT *)0; /* No longer waiting for event */
\ 000001D8 24009FE5 LDR R0,??OSQPend_5+0x4 ;; OSTCBCur
\ 000001DC 000090E5 LDR R0,[R0, #+0]
\ 000001E0 0010A0E3 MOV R1,#+0
\ 000001E4 1C1080E5 STR R1,[R0, #+28]
459 OS_EXIT_CRITICAL();
\ 000001E8 0700B0E1 MOVS R0,R7
\ 000001EC ........ _BLF OS_CPU_SR_Restore,??OS_CPU_SR_Restore??rA
460 *err = OS_ERR_NONE;
\ 000001F0 0000A0E3 MOV R0,#+0
\ 000001F4 0000C4E5 STRB R0,[R4, #+0]
461 return (msg); /* Return message received */
\ 000001F8 0500B0E1 MOVS R0,R5
\ ??OSQPend_1:
\ 000001FC F080BDE8 POP {R4-R7,PC} ;; return
\ ??OSQPend_5:
\ 00000200 ........ DC32 OSLockNesting
\ 00000204 ........ DC32 OSTCBCur
462 }
463 /*$PAGE*/
464 /*
465 *********************************************************************************************************
466 * ABORT WAITING ON A MESSAGE QUEUE
467 *
468 * Description: This function aborts & readies any tasks currently waiting on a queue. This function
469 * should be used to fault-abort the wait on the queue, rather than to normally signal
470 * the queue via OSQPost(), OSQPostFront() or OSQPostOpt().
471 *
472 * Arguments : pevent is a pointer to the event control block associated with the desired queue.
473 *
474 * opt determines the type of ABORT performed:
475 * OS_PEND_OPT_NONE ABORT wait for a single task (HPT) waiting on the
476 * queue
477 * OS_PEND_OPT_BROADCAST ABORT wait for ALL tasks that are waiting on the
478 * queue
479 *
480 * err is a pointer to where an error message will be deposited. Possible error
481 * messages are:
482 *
483 * OS_ERR_NONE No tasks were waiting on the queue.
484 * OS_ERR_PEND_ABORT At least one task waiting on the queue was readied
485 * and informed of the aborted wait; check return value
486 * for the number of tasks whose wait on the queue
487 * was aborted.
488 * OS_ERR_EVENT_TYPE If you didn't pass a pointer to a queue.
489 * OS_ERR_PEVENT_NULL If 'pevent' is a NULL pointer.
490 *
491 * Returns : == 0 if no tasks were waiting on the queue, or upon error.
492 * > 0 if one or more tasks waiting on the queue are now readied and informed.
493 *********************************************************************************************************
494 */
495
496 #if OS_Q_PEND_ABORT_EN > 0
\ In segment CODE, align 4, keep-with-next
497 INT8U OSQPendAbort (OS_EVENT *pevent, INT8U opt, INT8U *err)
498 {
\ OSQPendAbort:
\ 00000000 F0412DE9 PUSH {R4-R8,LR}
\ 00000004 0050B0E1 MOVS R5,R0
\ 00000008 0160B0E1 MOVS R6,R1
\ 0000000C 0240B0E1 MOVS R4,R2
499 INT8U nbr_tasks;
500 #if OS_CRITICAL_METHOD == 3 /* Allocate storage for CPU status register */
501 OS_CPU_SR cpu_sr = 0;
\ 00000010 0080A0E3 MOV R8,#+0
502 #endif
503
50⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -