Advertisement
Guest User

2 motors 1 axis hal file

a guest
Oct 26th, 2017
116
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 4.18 KB | None | 0 0
  1. # Generated by stepconf 1.1 at Sun Oct 22 16:46:33 2017
  2. # If you make changes to this file, they will be
  3. # overwritten when you run stepconf again
  4. loadrt [KINS]KINEMATICS
  5. loadrt [EMCMOT]EMCMOT base_period_nsec=[EMCMOT]BASE_PERIOD servo_period_nsec=[EMCMOT]SERVO_PERIOD num_joints=[KINS]JOINTS
  6. loadrt hal_parport cfg="0 out"
  7. setp parport.0.reset-time 5000
  8. loadrt stepgen step_type=0,0,0
  9. loadrt pwmgen output_type=1
  10.  
  11. addf parport.0.read base-thread
  12. addf stepgen.make-pulses base-thread
  13. addf pwmgen.make-pulses base-thread
  14. addf parport.0.write base-thread
  15. addf parport.0.reset base-thread
  16.  
  17. addf stepgen.capture-position servo-thread
  18. addf motion-command-handler servo-thread
  19. addf motion-controller servo-thread
  20. addf stepgen.update-freq servo-thread
  21. addf pwmgen.update servo-thread
  22.  
  23. net spindle-cmd-rpm => pwmgen.0.value
  24. net spindle-on <= motion.spindle-on => pwmgen.0.enable
  25. net spindle-pwm <= pwmgen.0.pwm
  26. setp pwmgen.0.pwm-freq 100.0
  27. setp pwmgen.0.scale 1166.66666667
  28. setp pwmgen.0.offset 0.114285714286
  29. setp pwmgen.0.dither-pwm true
  30. net spindle-cmd-rpm <= motion.spindle-speed-out
  31. net spindle-cmd-rpm-abs <= motion.spindle-speed-out-abs
  32. net spindle-cmd-rps <= motion.spindle-speed-out-rps
  33. net spindle-cmd-rps-abs <= motion.spindle-speed-out-rps-abs
  34. net spindle-at-speed => motion.spindle-at-speed
  35. net spindle-cw <= motion.spindle-forward
  36.  
  37. net estop-out => parport.0.pin-01-out
  38. net xstep => parport.0.pin-02-out
  39. setp parport.0.pin-02-out-reset 1
  40. net xdir => parport.0.pin-03-out
  41. net ystep => parport.0.pin-04-out
  42. setp parport.0.pin-04-out-reset 1
  43. net ydir => parport.0.pin-05-out
  44. net zstep => parport.0.pin-06-out
  45. setp parport.0.pin-06-out-reset 1
  46. net zdir => parport.0.pin-07-out
  47. net xodir => parport.0.pin-08-out
  48. net xostep => parport.0.pin-09-out
  49. setp parport.0.pin-09-out-reset 1
  50. net spindle-cw => parport.0.pin-14-out
  51. net spindle-pwm => parport.0.pin-16-out
  52. net xenable => parport.0.pin-17-out
  53.  
  54.  
  55. setp stepgen.0.position-scale [JOINT_0]SCALE
  56. setp stepgen.0.steplen 1
  57. setp stepgen.0.stepspace 0
  58. setp stepgen.0.dirhold 35000
  59. setp stepgen.0.dirsetup 35000
  60. setp stepgen.0.maxaccel [JOINT_0]STEPGEN_MAXACCEL
  61. net xpos-cmd joint.0.motor-pos-cmd => stepgen.0.position-cmd
  62. net xpos-fb stepgen.0.position-fb => joint.0.motor-pos-fb
  63. net xstep <= stepgen.0.step
  64. net xdir <= stepgen.0.dir
  65. net xenable joint.0.amp-enable-out => stepgen.0.enable
  66.  
  67. setp stepgen.1.position-scale [JOINT_1]SCALE
  68. setp stepgen.1.steplen 1
  69. setp stepgen.1.stepspace 0
  70. setp stepgen.1.dirhold 35000
  71. setp stepgen.1.dirsetup 35000
  72. setp stepgen.1.maxaccel [JOINT_1]STEPGEN_MAXACCEL
  73. net xopos-cmd joint.1.motor-pos-cmd => stepgen.1.position-cmd
  74. net xopos-fb stepgen.1.position-fb => joint.1.motor-pos-fb
  75. net xostep <= stepgen.1.step
  76. net xodir <= stepgen.1.dir
  77. net xoenable joint.1.amp-enable-out => stepgen.1.enable
  78.  
  79. setp stepgen.2.position-scale [JOINT_2]SCALE
  80. setp stepgen.2.steplen 1
  81. setp stepgen.2.stepspace 0
  82. setp stepgen.2.dirhold 35000
  83. setp stepgen.2.dirsetup 35000
  84. setp stepgen.2.maxaccel [JOINT_2]STEPGEN_MAXACCEL
  85. net ypos-cmd joint.2.motor-pos-cmd => stepgen.2.position-cmd
  86. net ypos-fb stepgen.2.position-fb => joint.2.motor-pos-fb
  87. net ystep <= stepgen.2.step
  88. net ydir <= stepgen.2.dir
  89. net yenable joint.2.amp-enable-out => stepgen.2.enable
  90.  
  91. setp stepgen.3.position-scale [JOINT_3]SCALE
  92. setp stepgen.3.steplen 1
  93. setp stepgen.3.stepspace 0
  94. setp stepgen.3.dirhold 35000
  95. setp stepgen.3.dirsetup 35000
  96. setp stepgen.3.maxaccel [JOINT_3]STEPGEN_MAXACCEL
  97. net zpos-cmd joint.3.motor-pos-cmd => stepgen.3.position-cmd
  98. net zpos-fb stepgen.3.position-fb => joint.3.motor-pos-fb
  99. net zstep <= stepgen.3.step
  100. net zdir <= stepgen.3.dir
  101. net zenable joint.3.amp-enable-out => stepgen.3.enable
  102.  
  103. net estop-out <= iocontrol.0.user-enable-out
  104. net estop-out => iocontrol.0.emc-enable-in
  105.  
  106. loadusr -W hal_manualtoolchange
  107. net tool-change iocontrol.0.tool-change => hal_manualtoolchange.change
  108. net tool-changed iocontrol.0.tool-changed <= hal_manualtoolchange.changed
  109. net tool-number iocontrol.0.tool-prep-number => hal_manualtoolchange.number
  110. net tool-prepare-loopback iocontrol.0.tool-prepare => iocontrol.0.tool-prepared
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement