Advertisement
Guest User

Untitled

a guest
Oct 8th, 2012
73
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.36 KB | None | 0 0
  1.  
  2. # axis enable chain
  3. newsig emcmot.02.enable bit
  4. sets emcmot.02.enable FALSE
  5. net emcmot.02.enable => pid.2.enable
  6. net emcmot.02.enable => hm2_[HOSTMOT2](BOARD).0.pwmgen.02.enable
  7. net emcmot.02.enable <= axis.2.amp-enable-out
  8.  
  9. # encoder feedback
  10. setp hm2_[HOSTMOT2](BOARD).0.encoder.02.counter-mode 0
  11. setp hm2_[HOSTMOT2](BOARD).0.encoder.02.filter 1
  12. setp hm2_[HOSTMOT2](BOARD).0.encoder.02.index-invert 0
  13. setp hm2_[HOSTMOT2](BOARD).0.encoder.02.index-mask 0
  14. setp hm2_[HOSTMOT2](BOARD).0.encoder.02.index-mask-invert 0
  15.  
  16. setp hm2_[HOSTMOT2](BOARD).0.encoder.02.scale [AXIS_2]INPUT_SCALE
  17. net motor.02.pos-fb hm2_[HOSTMOT2](BOARD).0.encoder.02.position => pid.2.feedback
  18. net motor.02.pos-fb => axis.2.motor-pos-fb #push copy back to Axis GUI
  19.  
  20. # set PID loop gains from inifile
  21. setp pid.2.Pgain [AXIS_2]P
  22. setp pid.2.Igain [AXIS_2]I
  23. setp pid.2.Dgain [AXIS_2]D
  24. setp pid.2.bias [AXIS_2]BIAS
  25. setp pid.2.FF0 [AXIS_2]FF0
  26. setp pid.2.FF1 [AXIS_2]FF1
  27. setp pid.2.FF2 [AXIS_2]FF2
  28. setp pid.2.deadband [AXIS_2]DEADBAND
  29. setp pid.2.maxoutput [AXIS_2]MAX_OUTPUT
  30.  
  31. # position command signals
  32. setp hm2_[HOSTMOT2](BOARD).0.pwmgen.02.output-type 1 #pwm on pin1, dir on pin2
  33. setp hm2_[HOSTMOT2](BOARD).0.pwmgen.02.scale [AXIS_2]OUTPUT_SCALE
  34.  
  35. net emcmot.02.pos-cmd axis.2.motor-pos-cmd => pid.2.command
  36. net motor.02.command pid.2.output => hm2_[HOSTMOT2](BOARD).0.pwmgen.02.value
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement