Advertisement
Guest User

Untitled

a guest
Jul 1st, 2017
59
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.60 KB | None | 0 0
  1. # axis enable chain
  2. newsig emcmot.00.enable bit
  3. sets emcmot.00.enable FALSE
  4.  
  5. net emcmot.00.enable <= axis.0.amp-enable-out
  6. net emcmot.00.enable => hm2_[HOSTMOT2](BOARD).0.stepgen.00.enable pid.0.enable
  7.  
  8.  
  9. # position command and feedback
  10. net emcmot.00.pos-cmd axis.0.motor-pos-cmd => pid.0.command
  11. net emcmot.00.vel-cmd axis.0.joint-vel-cmd => pid.0.command-deriv
  12. net motor.00.pos-fb <= hm2_[HOSTMOT2](BOARD).0.stepgen.00.position-fb axis.0.motor-pos-fb pid.0.feedback
  13. net motor.00.command pid.0.output hm2_[HOSTMOT2](BOARD).0.stepgen.00.velocity-cmd
  14. setp pid.0.error-previous-target true
  15.  
  16.  
  17.  
  18. # timing parameters
  19. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.dirsetup [AXIS_0]DIRSETUP
  20. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.dirhold [AXIS_0]DIRHOLD
  21.  
  22. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.steplen [AXIS_0]STEPLEN
  23. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.stepspace [AXIS_0]STEPSPACE
  24.  
  25. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.position-scale [AXIS_0]SCALE
  26.  
  27. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.maxvel [AXIS_0]STEPGEN_MAX_VEL
  28. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.maxaccel [AXIS_0]STEPGEN_MAX_ACC
  29.  
  30. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.step_type 0
  31. setp hm2_[HOSTMOT2](BOARD).0.stepgen.00.control-type 1
  32.  
  33. # set PID loop gains from inifile
  34. setp pid.0.Pgain [AXIS_0]P
  35. setp pid.0.Igain [AXIS_0]I
  36. setp pid.0.Dgain [AXIS_0]D
  37. setp pid.0.bias [AXIS_0]BIAS
  38. setp pid.0.FF0 [AXIS_0]FF0
  39. setp pid.0.FF1 [AXIS_0]FF1
  40. setp pid.0.FF2 [AXIS_0]FF2
  41. setp pid.0.deadband [AXIS_0]DEADBAND
  42. setp pid.0.maxoutput [AXIS_0]MAX_OUTPUT
  43. setp pid.0.maxerror [AXIS_0]MAX_ERROR
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement