vector_inveter:
;--------------------------------------主循環(huán)程序(SET_F由外部輸入)---------------------------------MAIN_LOOP LDP #6LT SET_F ;將頻率調(diào)節(jié)比(Q15格式)轉換成角頻率MPY F_OMEGA ;Q20PAC ;積送ACC,Q4格式SACH OMEGA,1 ;保存角頻率,Q5格式LACC OMEGA LT SET_F ;將頻率調(diào)節(jié)比(Q15格式)轉換成參考電壓MPY MAX_V ;Q15*Q14=Q29PACSACH SET_V,1 ;保存參考電壓幅值,Q14格式B MAIN_LOOP ;循環(huán);--------------------------------------假中斷處理----------------------------------------------------------PHANTOM CLRC INTM RET;--------------------------------------T1下溢中斷處理子程序-----------------------------------------_C_INT2 SST #ST0,ST0_SAVE ;保存現(xiàn)場ST0SST #ST1,ST1_SAVE ;保存ST1LDP #5SACH ACCHSACL ACCL ;保存ACCSPH P_HISPL P_LO ;保存PMPY #1 ;P