Delta Tau GEO BRICK LV User Manual

Page of 271
Geo Brick LV User Manual
 
PinOuts and Software Setup 
 64 
Calculating the Tracking Filter Gains 
The tracking filter gains are system dependent, and need to be fine-tuned. This can be done by gathering 
and plotting filtered versus unfiltered data while moving the motor shaft manually. Best case scenario is 
super-imposing the filtered data on top of the unfiltered with minimum ripple and overshoot. 
 
The  empirical  equations  for  the  filter’s  proportional  and  integral  gains  (usually  acceptable  most 
applications) present a good starting point: 
F
f
: Filter Frequency (Hz) 
S
f
: Servo Frequency (Hz) 
 
                    
 
    
 
  (
 
 
 
)
 
  
  
 
 
                        
 
      (
 
 
 
)
 
  
  
 
 
Motors 1-8 Resolver Encoder Conversion Table Setup Example 
// Channel 1 
I8000= $F78B00 ; Resolver Counter Clockwise 
I8001= $478B10 ; Excitation address 
I8002= $000000 ; SIN/COS Bias word 
I8003=$D83503  ; Tracking filter from conversion location $3503 
I8004=$400 
; Maximum change in counts/cycle 
I8005=$80000 
; Proportional gain 
I8006=$0 
; Reserved setup word 
I8007=$1 
; Integral gain 
// Channel 2 
I8008=$F78B02  ; Resolver Counter Clockwise 
I8009=$478B10  ; Excitation address 
I8010=$000000  ; SIN/COS Bias word 
I8011=$D8350B  ; Tracking filter from conversion location $350B 
I8012=$400 
; Maximum change in counts/cycle 
I8013=$80000 
; Proportional gain 
I8014=$0 
; Reserved setup word 
I8015=$1 
; Integral gain 
// Channel 3 
I8016=$F78B04  ; Resolver Counter Clockwise 
I8017=$478B10  ; Excitation address 
I8018=$000000  ; SIN/COS Bias word 
I8019=$D83513  ; Tracking filter from conversion location $3513 
I8020=$400 
; Maximum change in counts/cycle 
I8021=$80000 
; Proportional gain 
I8022=$0 
; Reserved setup word 
I8023=$1 
; Integral gain 
// Channel 4 
I8024=$F78B06  ; Resolver Counter Clockwise 
I8025=$478B10  ; Excitation address 
I8026=$000000  ; SIN/COS Bias word 
I8027=$D8351B  ; Tracking filter from conversion location $351B 
I8028=$400 
; Maximum change in counts/cycle 
I8029=$80000 
; Proportional gain 
I8030=$0 
; Reserved setup word 
I8031=$1 
; Integral gain 
// Channel 5 
 
I8032=$F78B08  ; Resolver Counter Clockwise 
I8033=$478B10  ; Excitation address 
I8034=$000000  ; SIN/COS Bias word 
I8035=$D83523  ; Tracking filter from conversion location $3523 
I8036=$400 
; Maximum change in counts/cycle 
I8037=$80000 
; Proportional gain 
I8038=$0 
; Reserved setup word 
I8039=$1 
; Integral gain 
// Channel 6 
 
I8040=$F78B0A  ; Resolver Counter Clockwise 
I8041=$478B10  ; Excitation address