current_sampling.asm

直流电机驱动程序

              .title "current_sampling.asm"

              
              
         ldpk  _current_first_count
         lacc  _current_first_flag
         bnz   back
         lacc  _current_first_count
         add   #1
         sacl  _current_first_count
         sub   #2000
         blz   back
         sub   #10
         bgez  calculate_current   
         
         
	     
calculate_current:        
         splk  #0,_current_first_count
         splk  #1,_current_first_flag
         lacc  _current_ac_count
         rpt   #15
         subc  _count    
         sacl  adc_ia_ref
         lacc  current_bd_count
         rpt   #15
         subc  count
         sacl  adc_ib_ref
         lacc  current_bd_count
         rpt   #15
         subc  count
         sacl  adc_vdc_ref
         
back:
         ret