📄 os_sem.src
字号:
; pevent->OSEventPtr = OSEventFreeList; /* Return Event Control Block to free list */
; OSEventFreeList = pevent; /* Get next free event control block */
; OS_EXIT_CRITICAL();
; *err = OS_NO_ERR;
; return ((OS_EVENT *)0); /* Semaphore has been deleted */
; } else {
; OS_EXIT_CRITICAL();
; *err = OS_ERR_TASK_WAITING;
; return (pevent);
; }
;
; case OS_DEL_ALWAYS: /* Always delete the semaphore */
; while (pevent->OSEventGrp != 0x00) { /* Ready ALL tasks waiting for semaphore */
; OS_EventTaskRdy(pevent, (void *)0, OS_STAT_SEM);
; }
; pevent->OSEventType = OS_EVENT_TYPE_UNUSED;
; pevent->OSEventPtr = OSEventFreeList; /* Return Event Control Block to free list */
; OSEventFreeList = pevent; /* Get next free event control block */
; OS_EXIT_CRITICAL();
; if (tasks_waiting == TRUE) { /* Reschedule only if task(s) were waiting */
; OS_Sched(); /* Find highest priority task ready to run */
; }
; *err = OS_NO_ERR;
; return ((OS_EVENT *)0); /* Semaphore has been deleted */
;
; default:
; OS_EXIT_CRITICAL();
; *err = OS_ERR_INVALID_OPT;
; return (pevent);
; }
; }
; #endif
;
; /*$PAGE*/
; /*
; *********************************************************************************************************
; * PEND ON SEMAPHORE
; *
; * Description: This function waits for a semaphore.
; *
; * Arguments : pevent is a pointer to the event control block associated with the desired
; * semaphore.
; *
; * timeout is an optional timeout period (in clock ticks). If non-zero, your task will
; * wait for the resource up to the amount of time specified by this argument.
; * If you specify 0, however, your task will wait forever at the specified
; * semaphore or, until the resource becomes available (or the event occurs).
; *
; * err is a pointer to where an error message will be deposited. Possible error
; * messages are:
; *
; * OS_NO_ERR The call was successful and your task owns the resource
; * or, the event you are waiting for occurred.
; * OS_TIMEOUT The semaphore was not received within the specified
; * timeout.
; * OS_ERR_EVENT_TYPE If you didn't pass a pointer to a semaphore.
; * OS_ERR_PEND_ISR If you called this function from an ISR and the result
; * would lead to a suspension.
; * OS_ERR_PEVENT_NULL If 'pevent' is a NULL pointer.
; *
; * Returns : none
; *********************************************************************************************************
; */
;
; void OSSemPend (OS_EVENT *pevent, INT16U timeout, INT8U *err)LG_REENTRANT
RSEG ?PR?_?OSSemPend?OS_SEM
_?OSSemPend:
USING 0
; SOURCE LINE # 244
MOV DPTR,#0FFFEH
LCALL ?C?ADDXBP
MOV A,R4
MOVX @DPTR,A
INC DPTR
MOV A,R5
MOVX @DPTR,A
MOV DPTR,#0FFFDH
LCALL ?C?ADDXBP
LCALL ?C?PSTXDATA
; {
; #if OS_CRITICAL_METHOD == 3 /* Allocate storage for CPU status register */
; OS_CPU_SR cpu_sr;
; #endif
;
;
; if (OSIntNesting > 0) { /* See if called from ISR ... */
; SOURCE LINE # 251
MOV DPTR,#OSIntNesting
MOVX A,@DPTR
SETB C
SUBB A,#00H
JC ?C0005
; *err = OS_ERR_PEND_ISR; /* ... can't PEND from an ISR */
; SOURCE LINE # 252
MOV DPTR,#05H
LCALL ?C?XBPOFF
LCALL ?C?PLDXDATA
MOV A,#02H
LJMP ?C0024
; return;
; }
; SOURCE LINE # 254
?C0005:
; #if OS_ARG_CHK_EN > 0
; if (pevent == (OS_EVENT *)0) { /* Validate 'pevent' */
; SOURCE LINE # 256
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
MOV A,R1
ORL A,R2
ORL A,R3
JNZ ?C0007
; *err = OS_ERR_PEVENT_NULL;
; SOURCE LINE # 257
MOV DPTR,#05H
LCALL ?C?XBPOFF
LCALL ?C?PLDXDATA
MOV A,#04H
?C0020:
LJMP ?C0024
; return;
; }
; SOURCE LINE # 259
?C0007:
; if (pevent->OSEventType != OS_EVENT_TYPE_SEM) { /* Validate event block type */
; SOURCE LINE # 260
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
LCALL ?C?CLDPTR
XRL A,#03H
JZ ?C0008
; *err = OS_ERR_EVENT_TYPE;
; SOURCE LINE # 261
MOV DPTR,#05H
LCALL ?C?XBPOFF
LCALL ?C?PLDXDATA
MOV A,#01H
?C0021:
LJMP ?C0024
; return;
; }
; SOURCE LINE # 263
?C0008:
; #endif
; OS_ENTER_CRITICAL();
; SOURCE LINE # 265
CLR EA
; if (pevent->OSEventCnt > 0) { /* If sem. is positive, resource available ... */
; SOURCE LINE # 266
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
MOV DPTR,#02H
LCALL ?C?ILDOPTR
SETB C
SUBB A,#00H
MOV A,B
SUBB A,#00H
JC ?C0009
; pevent->OSEventCnt--; /* ... decrement semaphore only if positive. */
; SOURCE LINE # 267
MOV DPTR,#02H
MOV A,#0FFH
MOV B,A
LCALL ?C?IILDOPTR
; OS_EXIT_CRITICAL();
; SOURCE LINE # 268
SETB EA
; *err = OS_NO_ERR;
; SOURCE LINE # 269
MOV DPTR,#05H
LCALL ?C?XBPOFF
LCALL ?C?PLDXDATA
CLR A
?C0022:
LJMP ?C0024
; return;
; }
; SOURCE LINE # 271
?C0009:
; /* Otherwise, must wait until event occurs */
; OSTCBCur->OSTCBStat |= OS_STAT_SEM; /* Resource not available, pend on semaphore */
; SOURCE LINE # 273
MOV DPTR,#OSTCBCur
LCALL ?C?PLDXDATA
MOV A,R1
ADD A,#0EH
MOV R1,A
CLR A
ADDC A,R2
MOV R2,A
LCALL ?C?CLDPTR
ORL A,#01H
LCALL ?C?CSTPTR
; OSTCBCur->OSTCBDly = timeout; /* Store pend timeout in TCB */
; SOURCE LINE # 274
MOV DPTR,#03H
LCALL ?C?XBPOFF
MOVX A,@DPTR
MOV R6,A
INC DPTR
MOVX A,@DPTR
MOV R7,A
MOV DPTR,#OSTCBCur
LCALL ?C?PLDXDATA
MOV DPTR,#0CH
MOV A,R6
MOV B,R7
LCALL ?C?ISTOPTR
; OS_EventTaskWait(pevent); /* Suspend task until event or timeout occurs */
; SOURCE LINE # 275
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
LCALL _?OS_EventTaskWait
; OS_EXIT_CRITICAL();
; SOURCE LINE # 276
SETB EA
; OS_Sched(); /* Find next highest priority task ready */
; SOURCE LINE # 277
LCALL _?OS_Sched
; OS_ENTER_CRITICAL();
; SOURCE LINE # 278
CLR EA
; if (OSTCBCur->OSTCBStat & OS_STAT_SEM) { /* Must have timed out if still waiting for event*/
; SOURCE LINE # 279
MOV DPTR,#OSTCBCur
LCALL ?C?PLDXDATA
MOV DPTR,#0EH
LCALL ?C?CLDOPTR
JNB ACC.0,?C0010
; OS_EventTO(pevent);
; SOURCE LINE # 280
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
LCALL _?OS_EventTO
; OS_EXIT_CRITICAL();
; SOURCE LINE # 281
SETB EA
; *err = OS_TIMEOUT; /* Indicate that didn't get event within TO */
; SOURCE LINE # 282
MOV DPTR,#05H
LCALL ?C?XBPOFF
LCALL ?C?PLDXDATA
MOV A,#0AH
?C0023:
SJMP ?C0024
; return;
; }
; SOURCE LINE # 284
?C0010:
; OSTCBCur->OSTCBEventPtr = (OS_EVENT *)0;
; SOURCE LINE # 285
MOV R3,#00H
MOV R2,#00H
MOV R1,#00H
PUSH AR3
PUSH AR2
PUSH AR1
MOV DPTR,#OSTCBCur
LCALL ?C?PLDXDATA
MOV DPTR,#09H
LCALL ?C?PSTOPTR
; OS_EXIT_CRITICAL();
; SOURCE LINE # 286
SETB EA
; *err = OS_NO_ERR;
; SOURCE LINE # 287
MOV DPTR,#05H
LCALL ?C?XBPOFF
LCALL ?C?PLDXDATA
CLR A
?C0024:
LCALL ?C?CSTPTR
; }
; SOURCE LINE # 288
?C0006:
MOV DPTR,#08H
LJMP ?C?ADDXBP
; END OF _?OSSemPend
; /*$PAGE*/
; /*
; *********************************************************************************************************
; * POST TO A SEMAPHORE
; *
; * Description: This function signals a semaphore
; *
; * Arguments : pevent is a pointer to the event control block associated with the desired
; * semaphore.
; *
; * Returns : OS_NO_ERR The call was successful and the semaphore was signaled.
; * OS_SEM_OVF If the semaphore count exceeded its limit. In other words, you have
; * signalled the semaphore more often than you waited on it with either
; * OSSemAccept() or OSSemPend().
; * OS_ERR_EVENT_TYPE If you didn't pass a pointer to a semaphore
; * OS_ERR_PEVENT_NULL If 'pevent' is a NULL pointer.
; *********************************************************************************************************
; */
;
; INT8U OSSemPost (OS_EVENT *pevent)LG_REENTRANT
RSEG ?PR?_?OSSemPost?OS_SEM
_?OSSemPost:
USING 0
; SOURCE LINE # 308
MOV DPTR,#0FFFDH
LCALL ?C?ADDXBP
LCALL ?C?PSTXDATA
; {
; #if OS_CRITICAL_METHOD == 3 /* Allocate storage for CPU status register */
; OS_CPU_SR cpu_sr;
; #endif
;
;
; #if OS_ARG_CHK_EN > 0
; if (pevent == (OS_EVENT *)0) { /* Validate 'pevent' */
; SOURCE LINE # 316
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
MOV A,R1
ORL A,R2
ORL A,R3
JNZ ?C0011
; return (OS_ERR_PEVENT_NULL);
; SOURCE LINE # 317
MOV R7,#04H
SJMP ?C0012
; }
; SOURCE LINE # 318
?C0011:
; if (pevent->OSEventType != OS_EVENT_TYPE_SEM) { /* Validate event block type */
; SOURCE LINE # 319
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
LCALL ?C?CLDPTR
XRL A,#03H
JZ ?C0013
; return (OS_ERR_EVENT_TYPE);
; SOURCE LINE # 320
MOV R7,#01H
SJMP ?C0012
; }
; SOURCE LINE # 321
?C0013:
; #endif
; OS_ENTER_CRITICAL();
; SOURCE LINE # 323
CLR EA
; if (pevent->OSEventGrp != 0x00) { /* See if any task waiting for semaphore */
; SOURCE LINE # 324
MOV DPTR,#01H
LCALL ?C?CLDOPTR
JZ ?C0014
; OS_EventTaskRdy(pevent, (void *)0, OS_STAT_SEM); /* Ready highest prio task waiting on event */
; SOURCE LINE # 325
MOV DPTR,#0FFFFH
LCALL ?C?ADDXBP
MOV A,#01H
MOVX @DPTR,A
MOV R3,#00H
MOV R2,#00H
MOV R1,#00H
MOV DPTR,#0FFFDH
LCALL ?C?ADDXBP
LCALL ?C?PSTXDATA
MOV DPTR,#04H
LCALL ?C?XBPOFF
LCALL ?C?PLDXDATA
LCALL _?OS_EventTaskRdy
; OS_EXIT_CRITICAL();
; SOURCE LINE # 326
SETB EA
; OS_Sched(); /* Find highest priority task ready to run */
; SOURCE LINE # 327
LCALL _?OS_Sched
; return (OS_NO_ERR);
; SOURCE LINE # 328
MOV R7,#00H
SJMP ?C0012
; }
; SOURCE LINE # 329
?C0014:
; if (pevent->OSEventCnt < 65535) { /* Make sure semaphore will not overflow */
; SOURCE LINE # 330
MOV DPH,?C_XBP
MOV DPL,?C_XBP+01H
LCALL ?C?PLDXDATA
MOV DPTR,#02H
LCALL ?C?ILDOPTR
CLR C
SUBB A,#0FFH
MOV A,B
SUBB A,#0FFH
JNC ?C0015
; pevent->OSEventCnt++; /* Increment semaphore count to register event */
; SOURCE LINE # 331
MOV DPTR,#02H
CLR A
MOV B,#01H
LCALL ?C?IILDOPTR
; OS_EXIT_CRITICAL();
; SOURCE LINE # 332
SETB EA
; return (OS_NO_ERR);
; SOURCE LINE # 333
MOV R7,#00H
SJMP ?C0012
; }
; SOURCE LINE # 334
?C0015:
; OS_EXIT_CRITICAL(); /* Semaphore value has reached its maximum */
; SOURCE LINE # 335
SETB EA
; return (OS_SEM_OVF);
; SOURCE LINE # 336
MOV R7,#032H
; }
; SOURCE LINE # 337
?C0012:
MOV DPTR,#03H
LJMP ?C?ADDXBP
; END OF _?OSSemPost
END
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -