os_cpu_c.s

ucos-ii-at90S-icc-avr

	.module os_cpu_c.c
	.area text(rom, con, rel)
	.dbfile G:\编程2002-10-15-HOME\做过的项目\2002-10-22\home-c\software\ucos-ii-at90S-icc-avr\os-task-sem\os_cpu_c.c
	.dbfunc e OSTaskStkInit _OSTaskStkInit fpc
;           stks -> R10,R11
;            tmp -> R22,R23
;            stk -> R20,R21
;       stk_size -> y+10
;           ptos -> y+8
;          pdata -> R12,R13
;           task -> R22,R23
	.even
_OSTaskStkInit::
	rcall push_gset4
	mov R12,R18
	mov R13,R19
	mov R22,R16
	mov R23,R17
	.dbline -1
	.dbline 42
; #include "includes.h"
; 
; /*
; ********************************************************************************
; *                     INITIALIZE A TASK'S STACK
; *
; * Description:
; *	This function is called by either OSTaskCreate() or OSTaskCreateExt() to
; *	initialize the stack frame of the task being created. This function is
; *	highly processor specific.
; *
; * Arguments:
; *	task - 	is a pointer to the task code
; *
; *	pdata -	is a pointer to a user supplied data area that will be passed to the
; *			 task when the task first executes.
; *
; *	ptos - 	is a pointer to the top of stack. It is assumed that 'ptos' points to
; *			the highest valid address on the stack.
; *
; *	opt - 	specifies options that can be used to alter the behavior of 
; 			OSTaskStkInit(). (see uCOS_II.H for OS_TASK_OPT_???).
; *
; * Returns:
; *	Always returns the location of the new top-of-stack' once the processor 
; *	registers have been placed on the stack in the proper order.
; *
; * Note(s):
; *	Interrupts are enabled when your task starts executing. You can change this 
; * 	by setting the SREG to 0x00 instead. In this case, interrupts would be 
; *	disabled upon task startup. The application code would be responsible for 
; *	enabling interrupts at the beginning of the task code. You will need to 
; *	modify OSTaskIdle() and OSTaskStat() so that they enable interrupts. Failure
; *	to do this will make your system crash! The AVR return stack is placed 64 
; *	bytes above the start of the (512 byte) stack. This provides 32 levels of 
; *	function call nesting which should be more than enough for most applications
; *	(see the "read.me" file for more info).
; *
; ********************************************************************************
; */
; OS_STK *OSTaskStkInit (void (*task)(void *pd),
; 						 void *pdata, OS_STK *ptos, INT16U stk_size){
	.dbline 48
;     INT8U  *stk;
;     INT8U  *stks;		// Temp. variable used for setting up AVR hardware stack
;     INT16U tmp;
; 
; 
;     stk     = (INT8U *)ptos;
	ldd R20,y+8
	ldd R21,y+9
	.dbline 54
; 	// AVR return stack ("hardware stack")
;     //from IAR C
;     //stks    = (INT8U *)(ptos)-(OS_TASK_DEF_STK_SIZE-64);/* AVR return stack ("hardware stack")          */
;     //from ICC AVR C
;     //stks    = (INT8U *)(ptos)-(OS_TASK_DEF_STK_SIZE-32);
;     stks    = (INT8U *)(ptos)-(stk_size - OS_HARDWARE_STACK_SIZE);
	ldd R24,y+10
	ldd R25,y+11
	subi R24,64
	sbci R25,0
	ldd R10,y+8
	ldd R11,y+9
	sub R10,R24
	sbc R11,R25
	.dbline 56
; #if OS_STRICT
;     if((0==task)||(ptos==0)||((INT16U)ptos<stk_size)||(stk_size<OS_HARDWARE_STACK_SIZE+40))
	cpi R22,0
	cpc R22,R23
	breq L7
X0:
	ldd R2,y+8
	ldd R3,y+9
	tst R2
	brne X1
	tst R3
	breq L7
X1:
	ldd R0,y+10
	ldd R1,y+11
	cp R2,R0
	cpc R3,R1
	brlo L7
	ldd R24,y+10
	ldd R25,y+11
	cpi R24,104
	ldi R30,0
	cpc R25,R30
	brsh L3
L7:
	.dbline 57
; 	  OSError(0);
	clr R16
	rcall _OSError
L3:
	.dbline 62
; #endif	
; 	// the function address has an extra level of indirection. Fetch the
;     // actual address.
;     //    
;     tmp = *(INT16U const *)task;
	mov R16,R22
	mov R17,R23
	rcall lpm16
	mov R22,R16
	mov R23,R17
	.dbline 65
;    
; 	// 36 Bytes
;     *stks-- = (INT8U)tmp;	//Put task start address on top of hardware stack
	mov R2,R10
	mov R3,R11
	mov R24,R2
	mov R25,R3
	sbiw R24,1
	mov R30,R2
	mov R31,R3
	std z+0,R22
	.dbline 66
;     *stks-- = (INT8U)(tmp >> 8);
	mov R2,R24
	mov R3,R25
	sbiw R24,1
	mov R10,R24
	mov R11,R25
	mov R4,R22
	mov R5,R23
	mov R4,R5
	clr R5
	mov R30,R2
	mov R31,R3
	std z+0,R4
	.dbline 68
; 
;     *stk-- = (INT8U)0x00;		// R0  = 0x00
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	clr R4
	mov R30,R2
	mov R31,R3
	std z+0,R4
	.dbline 69
;     *stk-- = (INT8U)0x01; 
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,1
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 70
;     *stk-- = (INT8U)0x02;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,2
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 71
;     *stk-- = (INT8U)0x03;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,3
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 72
;     *stk-- = (INT8U)0x04;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,4
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 73
;     *stk-- = (INT8U)0x05;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,5
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 74
;     *stk-- = (INT8U)0x06;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,6
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 75
;     *stk-- = (INT8U)0x07;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,7
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 76
;     *stk-- = (INT8U)0x08;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,8
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 77
;     *stk-- = (INT8U)0x09;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,9
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 78
;     *stk-- = (INT8U)0x10;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,16
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 79
;     *stk-- = (INT8U)0x11;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,17
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 80
;     *stk-- = (INT8U)0x12;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,18
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 81
;     *stk-- = (INT8U)0x13;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,19
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 82
;     *stk-- = (INT8U)0x14;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,20
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 83
;     *stk-- = (INT8U)0x15;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,21
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 84
;     tmp    = (INT16U)pdata;
	mov R22,R12
	mov R23,R13
	.dbline 85
;     *stk-- = (INT8U)tmp;	//Simulate call to function with argument
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	mov R30,R2
	mov R31,R3
	std z+0,R22
	.dbline 86
;     *stk-- = (INT8U)(tmp >> 8);
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	mov R4,R22
	mov R5,R23
	mov R4,R5
	clr R5
	mov R30,R2
	mov R31,R3
	std z+0,R4
	.dbline 87
;     *stk-- = (INT8U)0x18;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,24
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 88
;     *stk-- = (INT8U)0x19;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,25
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 89
;     *stk-- = (INT8U)0x20;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,32
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 90
;     *stk-- = (INT8U)0x21;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,33
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 91
;     *stk-- = (INT8U)0x22;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,34
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 92
;     *stk-- = (INT8U)0x23;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,35
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 93
;     *stk-- = (INT8U)0x24;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,36
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 94
;     *stk-- = (INT8U)0x25;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,37
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 95
;     *stk-- = (INT8U)0x26;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,38
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 96
;     *stk-- = (INT8U)0x27;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,39
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 98
; 	// the heap pointer Y=R29:R28 will not be stored
;     *stk-- = (INT8U)0x30;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,48
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 99
;     *stk-- = (INT8U)0x31;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,49
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 100
;     *stk-- = (INT8U)0x3B;
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,59
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 101
;     *stk-- = (INT8U)0x80;	//SREG = Interrupts enabled
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	ldi R24,128
	mov R30,R2
	mov R31,R3
	std z+0,R24
	.dbline 103
; 
;     tmp    = (INT16U)(stks);
	mov R22,R10
	mov R23,R11
	.dbline 104
;     *stk-- = (INT8U)(tmp >> 8);
	mov R2,R20
	mov R3,R21
	subi R20,1
	sbci R21,0
	mov R4,R22
	mov R5,R23
	mov R4,R5
	clr R5
	mov R30,R2
	mov R31,R3
	std z+0,R4
	.dbline 105
;     *stk   = (INT8U)(tmp);
	mov R30,R20
	mov R31,R21
	std z+0,R22
	.dbline 106
;     return ((void *)stk);
	mov R16,R20
	mov R17,R21
	.dbline -2
L2:
	rcall pop_gset4
	.dbline 0 ; func end
	ret
	.dbsym r stks 10 pc
	.dbsym r tmp 22 i
	.dbsym r stk 20 pc
	.dbsym l stk_size 10 i
	.dbsym l ptos 8 pc
	.dbsym r pdata 12 pV
	.dbsym r task 22 pfV
	.dbend