ucos_ii.s

atmel128L

; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
	.dbline 1435
; p
; p
; p
; p
; p
; p
; p
	xcall _OS_CPU_SR_Save
	mov R10,R16
	.dbline 1436
; p
	lds R12,_OSTCBFreeList
	lds R13,_OSTCBFreeList+1
	.dbline 1437
; p
	tst R12
	brne X17
	tst R13
	brne X19
	xjmp L103
X19:
X17:
	.dbline 1437
	.dbline 1438
; p
	movw R30,R12
	ldd R2,z+2
	ldd R3,z+3
	sts _OSTCBFreeList+1,R3
	sts _OSTCBFreeList,R2
	.dbline 1439
; p
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 1440
; p
	movw R30,R12
	ldd R0,y+10
	ldd R1,y+11
	std z+1,R1
	std z+0,R0
	.dbline 1441
; p
	std z+11,R14
	.dbline 1442
; p
	clr R2
	std z+10,R2
	.dbline 1443
; p
	clr R3
	std z+9,R3
	std z+8,R2
	.dbline 1452
; p
; p
; p
; p
; p
; p
; p
; p
; p
	.dbline 1453
; p
	movw R30,R28
	ldd R2,z+16
	ldd R3,z+17
	ldd R4,z+18
	ldd R5,z+19
	std z+16,R2
	std z+17,R3
	std z+18,R4
	std z+19,R5
	.dbline 1454
; p
	.dbline 1455
; p
	.dbline 1456
; p
	.dbline 1463
; p
; p
; p
; p
; p
; p
; p
	mov R2,R14
	clr R3
	asr R3
	ror R2
	asr R3
	ror R2
	asr R3
	ror R2
	movw R30,R12
	std z+13,R2
	.dbline 1464
; p
	ldi R24,<_OSMapTbl
	ldi R25,>_OSMapTbl
	ldd R30,z+13
	clr R31
	add R30,R24
	adc R31,R25
	lpm R30,Z
	movw R26,R12
	adiw R26,15
	st x,R30
	.dbline 1465
; p
	mov R24,R14
	clr R25
	andi R24,7
	andi R25,0
	movw R30,R12
	std z+12,R24
	.dbline 1466
; p
	ldi R24,<_OSMapTbl
	ldi R25,>_OSMapTbl
	ldd R30,z+12
	clr R31
	add R30,R24
	adc R31,R25
	lpm R30,Z
	movw R26,R12
	adiw R26,14
	st x,R30
	.dbline 1469
; p
; p
; p
	clr R2
	clr R3
	movw R30,R12
	std z+7,R3
	std z+6,R2
	.dbline 1481
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
; p
	ldi R20,0
	ldi R21,0
	ldi R22,0
	ldi R23,0
	std z+16,R20
	std z+17,R21
	std z+18,R22
	std z+19,R23
	.dbline 1482
; p
	ldi R20,0
	ldi R21,0
	ldi R22,0
	ldi R23,0
	std z+24,R20
	std z+25,R21
	std z+26,R22
	std z+27,R23
	.dbline 1483
; p
	ldi R20,0
	ldi R21,0
	ldi R22,0
	ldi R23,0
	std z+20,R20
	std z+21,R21
	std z+22,R22
	std z+23,R23
	.dbline 1484
; p
	std z+29,R3
	std z+28,R2
	.dbline 1485
; p
	ldi R20,0
	ldi R21,0
	ldi R22,0
	ldi R23,0
	std z+30,R20
	std z+31,R21
	std z+32,R22
	std z+33,R23
	.dbline 1494
; p
; p
; p
; p
; p
; p
; p
; p
; p
	movw R16,R30
	xcall _OSTCBInitHook
	.dbline 1497
; p
; p
; p
	movw R16,R12
	xcall _OSTaskCreateHook
	.dbline 1499
; p
; p
	xcall _OS_CPU_SR_Save
	mov R10,R16
	.dbline 1500
; p
	ldi R24,2
	mul R24,R14
	movw R30,R0
	ldi R24,<_OSTCBPrioTbl
	ldi R25,>_OSTCBPrioTbl
	add R30,R24
	adc R31,R25
	std z+1,R13
	std z+0,R12
	.dbline 1501
; p
	lds R2,_OSTCBList
	lds R3,_OSTCBList+1
	movw R30,R12
	std z+3,R3
	std z+2,R2
	.dbline 1502
; p
	clr R2
	clr R3
	std z+5,R3
	std z+4,R2
	.dbline 1503
; p
	lds R2,_OSTCBList
	lds R3,_OSTCBList+1
	tst R2
	brne X18
	tst R3
	breq L105
X18:
	.dbline 1503
	.dbline 1504
; p
	lds R30,_OSTCBList
	lds R31,_OSTCBList+1
	std z+5,R13
	std z+4,R12
	.dbline 1505
; p
L105:
	.dbline 1506
; p
	sts _OSTCBList+1,R13
	sts _OSTCBList,R12
	.dbline 1507
; p
	movw R30,R12
	ldd R2,z+15
	lds R3,_OSRdyGrp
	or R3,R2
	sts _OSRdyGrp,R3
	.dbline 1508
; p
	ldi R24,<_OSRdyTbl
	ldi R25,>_OSRdyTbl
	ldd R2,z+13
	clr R3
	add R2,R24
	adc R3,R25
	ldd R4,z+14
	movw R30,R2
	ldd R5,z+0
	or R5,R4
	std z+0,R5
	.dbline 1509
; p
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 1510
; p
	clr R16
	xjmp L102
L103:
	.dbline 1512
; p
; p
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 1513
; p
	ldi R16,70
	.dbline -2
L102:
	xcall pop_gset5
	adiw R28,2
	.dbline 0 ; func end
	ret
	.dbsym r cpu_sr 10 c
	.dbsym r ptcb 12 pX
	.dbsym l opt 22 i
	.dbsym l pext 20 pV
	.dbsym l stk_size 16 l
	.dbsym l id 14 i
	.dbsym l pbos 12 pc
	.dbsym l ptos 10 pc
	.dbsym r prio 14 c
	.dbend
	.dbfile /UCOS-II_AVR_ICC/RTOSIC~1/OS_SOURCE/os_sem.c
	.dbfunc e OSSemAccept _OSSemAccept fi
;         cpu_sr -> R22
;            cnt -> R20,R21
;         pevent -> R10,R11
	.even
_OSSemAccept::
	xcall push_gset3
	movw R10,R16
	.dbline -1
	.dbline 40
	.dbline 52
	movw R30,R10
	ldd R24,z+0
	cpi R24,3
	breq L108
	.dbline 52
	.dbline 53
	clr R16
	clr R17
	xjmp L107
L108:
	.dbline 55
	xcall _OS_CPU_SR_Save
	mov R22,R16
	.dbline 56
	movw R30,R10
	ldd R20,z+2
	ldd R21,z+3
	.dbline 57
	cpi R20,0
	cpc R20,R21
	breq L110
X20:
	.dbline 57
	.dbline 58
	movw R24,R10
	adiw R24,2
	movw R30,R24
	ldd R24,z+0
	ldd R25,z+1
	sbiw R24,1
	std z+1,R25
	std z+0,R24
	.dbline 59
L110:
	.dbline 60
	mov R16,R22
	xcall _OS_CPU_SR_Restore
	.dbline 61
	movw R16,R20
	.dbline -2
L107:
	xcall pop_gset3
	.dbline 0 ; func end
	ret
	.dbsym r cpu_sr 22 c
	.dbsym r cnt 20 i
	.dbsym r pevent 10 pX
	.dbend
	.dbfunc e OSSemCreate _OSSemCreate fpX
;         cpu_sr -> R10
;         pevent -> R20,R21
;            cnt -> R22,R23
	.even
_OSSemCreate::
	xcall push_gset3
	movw R22,R16
	.dbline -1
	.dbline 84
	.dbline 91
	clr R2
	lds R3,_OSIntNesting
	cp R2,R3
	brsh L113
	.dbline 91
	.dbline 92
	clr R16
	clr R17
	xjmp L112
L113:
	.dbline 94
	xcall _OS_CPU_SR_Save
	mov R10,R16
	.dbline 95
	lds R20,_OSEventFreeList
	lds R21,_OSEventFreeList+1
	.dbline 96
	cpi R20,0
	cpc R20,R21
	breq L115
X21:
	.dbline 96
	.dbline 97
	lds R30,_OSEventFreeList
	lds R31,_OSEventFreeList+1
	ldd R2,z+4
	ldd R3,z+5
	sts _OSEventFreeList+1,R3
	sts _OSEventFreeList,R2
	.dbline 98
L115:
	.dbline 99
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 100
	cpi R20,0
	cpc R20,R21
	breq L117
X22:
	.dbline 100
	.dbline 101
	ldi R24,3
	movw R30,R20
	std z+0,R24
	.dbline 102
	std z+3,R23
	std z+2,R22
	.dbline 103
	clr R2
	clr R3
	std z+5,R3
	std z+4,R2
	.dbline 108
	movw R16,R30
	xcall _OS_EventWaitListInit
	.dbline 109
L117:
	.dbline 110
	movw R16,R20
	.dbline -2
L112:
	xcall pop_gset3
	.dbline 0 ; func end
	ret
	.dbsym r cpu_sr 10 c
	.dbsym r pevent 20 pX
	.dbsym r cnt 22 i
	.dbend
	.dbfunc e OSSemDel _OSSemDel fpX
;  tasks_waiting -> R12
;         cpu_sr -> R10
;            err -> R22,R23
;            opt -> R14
;         pevent -> R20,R21
	.even
_OSSemDel::
	xcall push_gset5
	mov R14,R18
	movw R20,R16
	sbiw R28,1
	ldd R22,y+11
	ldd R23,y+12
	.dbline -1
	.dbline 153
	.dbline 160
	clr R2
	lds R3,_OSIntNesting
	cp R2,R3
	brsh L120
	.dbline 160
	.dbline 161
	ldi R24,140
	movw R30,R22
	std z+0,R24
	.dbline 162
	movw R16,R20
	xjmp L119
L120:
	.dbline 170
	movw R30,R20
	ldd R24,z+0
	cpi R24,3
	breq L122
	.dbline 170
	.dbline 171
	ldi R24,1
	movw R30,R22
	std z+0,R24
	.dbline 172
	movw R16,R20
	xjmp L119
L122:
	.dbline 174
	xcall _OS_CPU_SR_Save
	mov R10,R16
	.dbline 175
	movw R30,R20
	ldd R2,z+1
	tst R2
	breq L124
	.dbline 175
	.dbline 176
	clr R12
	inc R12
	.dbline 177
	xjmp L125
L124:
	.dbline 177
	.dbline 178
	clr R12
	.dbline 179
L125:
	.dbline 180
	clr R15
	tst R14
	brne X23
	tst R15
	breq L129
X23:
	movw R24,R14
	cpi R24,1
	ldi R30,0
	cpc R25,R30
	brne X25
	xjmp L134
X25:
	xjmp L126
X24:
	.dbline 180
L129:
	.dbline 182
	tst R12
	brne L130
	.dbline 182
	.dbline 187
	clr R2
	movw R30,R20
	std z+0,R2
	.dbline 188
	lds R2,_OSEventFreeList
	lds R3,_OSEventFreeList+1
	std z+5,R3
	std z+4,R2
	.dbline 189
	clr R2
	clr R3
	std z+3,R3
	std z+2,R2
	.dbline 190
	sts _OSEventFreeList+1,R21
	sts _OSEventFreeList,R20
	.dbline 191
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 192
	clr R2
	movw R30,R22
	std z+0,R2
	.dbline 193
	clr R16
	clr R17
	xjmp L119
L130:
	.dbline 194
	.dbline 195
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 196
	ldi R24,8
	movw R30,R22
	std z+0,R24
	.dbline 197
	movw R16,R20
	xjmp L119
L133:
	.dbline 201
	.dbline 202
	ldi R24,1
	std y+0,R24
	clr R18
	clr R19
	movw R16,R20
	xcall _OS_EventTaskRdy
	.dbline 203
L134:
	.dbline 201
	movw R30,R20
	ldd R2,z+1
	tst R2
	brne L133
	.dbline 208
	clr R2
	std z+0,R2
	.dbline 209
	lds R2,_OSEventFreeList
	lds R3,_OSEventFreeList+1
	std z+5,R3
	std z+4,R2
	.dbline 210
	clr R2
	clr R3
	std z+3,R3
	std z+2,R2
	.dbline 211
	sts _OSEventFreeList+1,R21
	sts _OSEventFreeList,R20
	.dbline 212
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 213
	mov R24,R12
	cpi R24,1
	brne L136
	.dbline 213
	.dbline 214
	xcall _OS_Sched
	.dbline 215
L136:
	.dbline 216
	clr R2
	movw R30,R22
	std z+0,R2
	.dbline 217
	clr R16
	clr R17
	xjmp L119
L126:
	.dbline 220
	mov R16,R10
	xcall _OS_CPU_SR_Restore
	.dbline 221
	ldi R24,7
	movw R30,R22
	std z+0,R24
	.dbline 222
	movw R16,R20
	.dbline -2
L119:
	adiw R28,1
	xcall pop_gset5
	.dbline 0 ; func end
	ret
	.dbsym r tasks_waiting 12 c
	.dbsym r cpu_sr 10 c
	.dbsym r err 22 pc
	.dbsym r opt 14 c
	.dbsym r pevent 20 pX
	.dbend
	.dbfunc e OSSemPend _OSSemPend fV
;         cpu_sr -> R22
;            err -> R20,R21
;        timeout -> R12,R13
;         pevent -> R10,R11
	.even
_OSSemPend::
	xcall push_gset4
	movw R12,R18
	movw R10,R16
	ldd R20,y+8
	ldd R21,y+9
	.dbline -1
	.dbline 259
	.dbline 265
	clr R2
	lds R3,_OSIntNesting
	cp R2,R3
	brsh L139
	.dbline 265
	.dbline 266
	ldi R24,2
	movw R30,R20
	std z+0,R24
	.dbline 267
	xjmp L138
L139:
	.dbline 275
	movw R30,R10
	ldd R24,z+0
	cpi R24,3
	breq L141
	.dbline 275
	.dbline 276
	ldi R24,1
	movw R30,R20
	std z+0,R24
	.dbline 277
	xjmp L138
L141:
	.dbline 279
	xcall _OS_CPU_SR_Save
	mov R22,R16
	.dbline 280
	movw R30,R10
	ldd R2,z+2
	ldd R3,z+3
	tst R2
	brne X26
	tst R3
	breq L143
X26:
	.dbline 280
	.dbline 281
	movw R24,R10
	adiw R24,2
	movw R30,R24
	ldd R24,z+0
	ldd R25,z+1
	sbiw R24,1
	std z+1,R25
	std z+0,R24
	.dbline 282
	mov R16,R22
	xcall _OS_CPU_SR_Restore
	.dbline 283
	clr R2
	movw R30,R20
	std z+0,R2
	.dbline 284
	xjmp L138
L143:
	.dbline 287
	lds R24,_OSTCBCur
	lds R25,_OSTCBCur+1
	adiw R24,10
	movw R30,R24
	ldd R24,z+0
	ori R24,1
	std z+0,R24
	.dbline 288
	lds R30,_OSTCBCur
	lds R31,_OSTCBCur+1
	std z+9,R13
	std z+8,R12
	.dbline 289
	movw R16,R10
	xcall _OS_EventTaskWait
	.dbline 290
	mov R16,R22
	xcall _OS_CPU_SR_Restore
	.dbline 291
	xcall _OS_Sched
	.dbline 292
	xcall _OS_CPU_SR_Save
	mov R22,R16
	.dbline 293
	lds R30,_OSTCBCur
	lds R31,_OSTCBCur+1
	ldd R2,z+10
	sbrs R2,0
	rjmp L145
	.dbline 293
	.dbline 294
	movw R16,R10
	xcall _OS_EventTO
	.dbline 295
	mov R16,R22
	xcall _OS_CPU_SR_Restore
	.dbline 296
	ldi R24,10
	movw R30,R20
	std z+0,R24
	.dbline 297
	xjmp L138
L145:
	.dbline 299
	clr R2
	clr R3
	lds R30,_OSTCBCur
	lds R31,_OSTCBCur+1
	std z+7,R3
	std z+6,R2
	.dbline 300
	mov R16,R22
	xcall _OS_CPU_SR_Restore
	.dbline 301
	clr R2
	movw R30,R20
	std z+0,R2
	.dbline -2
	.dbline 302
L138:
	xcall pop_gset4
	.dbline 0 ; func end
	ret
	.dbsym r cpu_sr 22 c
	.dbsym r err 20 pc
	.dbsym r timeout 12 i
	.dbsym r pevent 10 pX
	.dbend
	.dbfunc e OSSemPost _OSSemPost fc
;         cpu_sr -> R20
;         pevent -> R22,R23
	.even
_OSSemPost::
	xcall push_gset2
	movw R22,R16
	sbiw R28,1
	.dbline -1
	.dbline 323
	.dbline 334
	movw R30,R22