moter.asm

哈工大智能电动车软件的源代码

.include hardware.inc
.code

 //*****************************
 //*****************************
.public _F_MoterAtoC
_F_MoterAtoC:.proc
   r1=0x2e00
   [P_IOB_Data]=r1
   INT  IRQ
   INT  FIQ
   r1=0xa908
   [P_INT_Ctrl]=r1  //开中断FIQ,ex1,irq54hz
   //r2=[P_IOA_Data]
   //r2&=0x0007
   //cmp r2,0x0007
   //je  endover
  // cmp r2,0x0002
  // jb turnleft
  // r1=0x0001
   //[P_IOB_Data]=r1
   //jmp endover
 //turnleft:
   //r1=0x0004
   //[P_IOB_Data]=r1
 //endover: 
   retf
   .endp
.public _F_Delay10ms
_F_Delay10ms:.proc
  	push r1,r2 to [sp]
    r1=20
  LOOPD11:
    r2=200
   LOOPD12:
    r2-=1
    jnz LOOPD12
    r1-=1
    jnz LOOPD11
    pop r1,r2 from [sp]
    retf
    .endp
 .PUBLIC  _F_Delay               //传入参数为1延时2.5ms              
_F_Delay: .proc
    push r1,r5 to  [sp];
    bp=sp+3  
    r1=[bp+1]; 		
//	R1=200;
L_Loop1:
	R2=1248;
	nop;
L_Loop2:  
    R2-=1;
    JNZ L_Loop2;
    R1-=1;
    JNZ L_Loop1;
    pop r1,r5 from  [sp];
    retf
    .endp