Guest User

Untitled

a guest
Jan 23rd, 2019
73
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.22 KB | None | 0 0
  1. # PID loop signals
  2.  
  3. setp pid.0.Pgain [JOINT_0]P
  4. setp pid.0.Igain [JOINT_0]I
  5. setp pid.0.Dgain [JOINT_0]D
  6. setp pid.0.bias [JOINT_0]BIAS
  7. setp pid.0.FF0 [JOINT_0]FF0
  8. setp pid.0.FF1 [JOINT_0]FF1
  9. setp pid.0.FF2 [JOINT_0]FF2
  10. setp pid.0.deadband [JOINT_0]DEADBAND
  11. setp pid.0.maxoutput [JOINT_0]MAX_OUTPUT
  12.  
  13. net x-index-enable pid.0.index-enable <= joint.0.index-enable => hm2_[HOSTMOT2](BOARD).0.encoder.00.index-enable # Adjust Encoder Number !!!
  14. net x-enable pid.0.enable <= joint.0.amp-enable-out => hm2_[HOSTMOT2](BOARD).0.stepgen.00.enable
  15. net x-output pid.0.output => hm2_[HOSTMOT2](BOARD).0.stepgen.00.velocity-cmd
  16. net x-pos-cmd pid.0.command <= joint.0.motor-pos-cmd
  17. net x-vel-fb pid.0.feedback-deriv => hm2_[HOSTMOT2](BOARD).0.encoder.00.velocity # Adjust Encoder Number !!!
  18. net x-pos-fb pid.0.feedback <= joint.0.motor-pos-fb => hm2_[HOSTMOT2](BOARD).0.encoder.00.position # Adjust Encoder Number !!!
  19.  
  20. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.dirsetup [JOINT_0]DIRSETUP
  21. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.dirhold [JOINT_0]DIRHOLD
  22. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.steplen [JOINT_0]STEPLEN
  23. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.stepspace [JOINT_0]STEPSPACE
  24. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.position-scale [JOINT_0]SCALE
  25. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.step_type 0
  26. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.control-type 1
  27. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.maxvel [JOINT_0]STEPGEN_MAX_VEL
  28. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.maxaccel [JOINT_0]STEPGEN_MAX_ACC
  29.  
  30. setp hm2_[HOSTMOT2](BOARD).0.encoder.00.counter-mode 0
  31. setp hm2_[HOSTMOT2](BOARD).0.encoder.00.filter 1
  32. setp hm2_[HOSTMOT2](BOARD).0.encoder.00.index-invert 0
  33. setp hm2_[HOSTMOT2](BOARD).0.encoder.00.index-mask 0
  34. setp hm2_[HOSTMOT2](BOARD).0.encoder.00.index-mask-invert 0
  35. setp hm2_[HOSTMOT2](BOARD).0.encoder.00.scale [JOINT_0]ENCODER_SCALE
Add Comment
Please, Sign In to add comment