Advertisement
Guest User

Untitled

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