cf.asm

基于TIc6205DSP上开发的MeanShift结合Kalman滤波的代码

          .def _AppExt
          .def _test
           
_AppExt:
         mvkl 0x00006540,a1
         mvkh 0x00006540,a1
         mvkl 0xff,a3
         mvkh 0xff,a3
Loop1:   ldw *a4++, a0
         ldw *b4++, b5
         mvkl 0x4,a2
         mvkh 0x4,a2 
         zero a5
         zero b6
Loop2:   sub a2,1,a2
     ||  shr a0,b6,b0
         shr b5,b6,b1
         and b0,a3,b0
     ||  and b1,a3,b1
    [a2] b  Loop2 
         sub b0,b1,b2
         abs b2,b2
         shl b2,b6,b2 
         add a5,b2,a5
         add b6,8,b6
    [a1] b  Loop1
         stw a5,*a6++ 
         sub a1,1,a1
         nop 3
         b b3
         nop 5        



_test:
         
         mvkl 0x0004,a1
         mvkh 0x0004,a1
loopx:   
         
         nop 
    [a1] b loopx 
         stw b0,*a4++ 
         sub a1,1,a1
         nop 4  
         b b3
         nop 5