Advertisement
Guest User

Untitled

a guest
Oct 2nd, 2019
97
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 9.88 KB | None | 0 0
  1. # Generated by PNCconf at Wed Oct 2 08:15:16 2019
  2. # If you make changes to this file, they will be
  3. # overwritten when you run PNCconf again
  4.  
  5. loadrt trivkins
  6. loadrt [EMCMOT]EMCMOT servo_period_nsec=[EMCMOT]SERVO_PERIOD num_joints=[TRAJ]AXES
  7. loadrt hostmot2
  8. loadrt hm2_eth board_ip="192.168.1.121" config=" num_encoders=0 num_pwmgens=0 num_stepgens=3"
  9. setp hm2_7i76e.0.watchdog.timeout_ns 5000000
  10. loadrt pid names=pid.x,pid.y,pid.z,pid.s
  11.  
  12. addf hm2_7i76e.0.read servo-thread
  13. addf motion-command-handler servo-thread
  14. addf motion-controller servo-thread
  15. addf pid.x.do-pid-calcs servo-thread
  16. addf pid.y.do-pid-calcs servo-thread
  17. addf pid.z.do-pid-calcs servo-thread
  18. addf pid.s.do-pid-calcs servo-thread
  19. addf hm2_7i76e.0.write servo-thread
  20. setp hm2_7i76e.0.dpll.01.timer-us -50
  21. setp hm2_7i76e.0.stepgen.timer-number 1
  22.  
  23. # external output signals
  24.  
  25. # external input signals
  26.  
  27. #*******************
  28. # AXIS X
  29. #*******************
  30.  
  31. setp pid.x.Pgain [AXIS_0]P
  32. setp pid.x.Igain [AXIS_0]I
  33. setp pid.x.Dgain [AXIS_0]D
  34. setp pid.x.bias [AXIS_0]BIAS
  35. setp pid.x.FF0 [AXIS_0]FF0
  36. setp pid.x.FF1 [AXIS_0]FF1
  37. setp pid.x.FF2 [AXIS_0]FF2
  38. setp pid.x.deadband [AXIS_0]DEADBAND
  39. setp pid.x.maxoutput [AXIS_0]MAX_OUTPUT
  40. setp pid.x.error-previous-target true
  41. setp pid.x.maxerror .0005
  42.  
  43. net x-index-enable <=> pid.x.index-enable
  44. net x-enable => pid.x.enable
  45. net x-pos-cmd => pid.x.command
  46. net x-vel-cmd => pid.x.command-deriv
  47. net x-pos-fb => pid.x.feedback
  48. net x-output => pid.x.output
  49.  
  50. # Step Gen signals/setup
  51.  
  52. setp hm2_7i76e.0.stepgen.02.dirsetup [AXIS_0]DIRSETUP
  53. setp hm2_7i76e.0.stepgen.02.dirhold [AXIS_0]DIRHOLD
  54. setp hm2_7i76e.0.stepgen.02.steplen [AXIS_0]STEPLEN
  55. setp hm2_7i76e.0.stepgen.02.stepspace [AXIS_0]STEPSPACE
  56. setp hm2_7i76e.0.stepgen.02.position-scale [AXIS_0]STEP_SCALE
  57. setp hm2_7i76e.0.stepgen.02.step_type 0
  58. setp hm2_7i76e.0.stepgen.02.control-type 1
  59. setp hm2_7i76e.0.stepgen.02.maxaccel [AXIS_0]STEPGEN_MAXACCEL
  60. setp hm2_7i76e.0.stepgen.02.maxvel [AXIS_0]STEPGEN_MAXVEL
  61.  
  62. # ---closedloop stepper signals---
  63.  
  64. net x-pos-cmd <= axis.0.motor-pos-cmd
  65. net x-vel-cmd <= axis.0.joint-vel-cmd
  66. net x-output => hm2_7i76e.0.stepgen.02.velocity-cmd
  67. net x-pos-fb <= hm2_7i76e.0.stepgen.02.position-fb
  68. net x-pos-fb => axis.0.motor-pos-fb
  69. net x-enable <= axis.0.amp-enable-out
  70. net x-enable => hm2_7i76e.0.stepgen.02.enable
  71.  
  72. # ---setup home / limit switch signals---
  73.  
  74. net x-home-sw => axis.0.home-sw-in
  75. net x-neg-limit => axis.0.neg-lim-sw-in
  76. net x-pos-limit => axis.0.pos-lim-sw-in
  77.  
  78. #*******************
  79. # AXIS Y
  80. #*******************
  81.  
  82. setp pid.y.Pgain [AXIS_1]P
  83. setp pid.y.Igain [AXIS_1]I
  84. setp pid.y.Dgain [AXIS_1]D
  85. setp pid.y.bias [AXIS_1]BIAS
  86. setp pid.y.FF0 [AXIS_1]FF0
  87. setp pid.y.FF1 [AXIS_1]FF1
  88. setp pid.y.FF2 [AXIS_1]FF2
  89. setp pid.y.deadband [AXIS_1]DEADBAND
  90. setp pid.y.maxoutput [AXIS_1]MAX_OUTPUT
  91. setp pid.y.error-previous-target true
  92. setp pid.y.maxerror .0005
  93.  
  94. net y-index-enable <=> pid.y.index-enable
  95. net y-enable => pid.y.enable
  96. net y-pos-cmd => pid.y.command
  97. net y-vel-cmd => pid.y.command-deriv
  98. net y-pos-fb => pid.y.feedback
  99. net y-output => pid.y.output
  100.  
  101. # Step Gen signals/setup
  102.  
  103. setp hm2_7i76e.0.stepgen.01.dirsetup [AXIS_1]DIRSETUP
  104. setp hm2_7i76e.0.stepgen.01.dirhold [AXIS_1]DIRHOLD
  105. setp hm2_7i76e.0.stepgen.01.steplen [AXIS_1]STEPLEN
  106. setp hm2_7i76e.0.stepgen.01.stepspace [AXIS_1]STEPSPACE
  107. setp hm2_7i76e.0.stepgen.01.position-scale [AXIS_1]STEP_SCALE
  108. setp hm2_7i76e.0.stepgen.01.step_type 0
  109. setp hm2_7i76e.0.stepgen.01.control-type 1
  110. setp hm2_7i76e.0.stepgen.01.maxaccel [AXIS_1]STEPGEN_MAXACCEL
  111. setp hm2_7i76e.0.stepgen.01.maxvel [AXIS_1]STEPGEN_MAXVEL
  112.  
  113. # ---closedloop stepper signals---
  114.  
  115. net y-pos-cmd <= axis.1.motor-pos-cmd
  116. net y-vel-cmd <= axis.1.joint-vel-cmd
  117. net y-output => hm2_7i76e.0.stepgen.01.velocity-cmd
  118. net y-pos-fb <= hm2_7i76e.0.stepgen.01.position-fb
  119. net y-pos-fb => axis.1.motor-pos-fb
  120. net y-enable <= axis.1.amp-enable-out
  121. net y-enable => hm2_7i76e.0.stepgen.01.enable
  122.  
  123. # ---setup home / limit switch signals---
  124.  
  125. net y-home-sw => axis.1.home-sw-in
  126. net y-neg-limit => axis.1.neg-lim-sw-in
  127. net y-pos-limit => axis.1.pos-lim-sw-in
  128.  
  129. #*******************
  130. # AXIS Z
  131. #*******************
  132.  
  133. setp pid.z.Pgain [AXIS_2]P
  134. setp pid.z.Igain [AXIS_2]I
  135. setp pid.z.Dgain [AXIS_2]D
  136. setp pid.z.bias [AXIS_2]BIAS
  137. setp pid.z.FF0 [AXIS_2]FF0
  138. setp pid.z.FF1 [AXIS_2]FF1
  139. setp pid.z.FF2 [AXIS_2]FF2
  140. setp pid.z.deadband [AXIS_2]DEADBAND
  141. setp pid.z.maxoutput [AXIS_2]MAX_OUTPUT
  142. setp pid.z.error-previous-target true
  143. setp pid.z.maxerror .0005
  144.  
  145. net z-index-enable <=> pid.z.index-enable
  146. net z-enable => pid.z.enable
  147. net z-pos-cmd => pid.z.command
  148. net z-vel-cmd => pid.z.command-deriv
  149. net z-pos-fb => pid.z.feedback
  150. net z-output => pid.z.output
  151.  
  152. # Step Gen signals/setup
  153.  
  154. setp hm2_7i76e.0.stepgen.00.dirsetup [AXIS_2]DIRSETUP
  155. setp hm2_7i76e.0.stepgen.00.dirhold [AXIS_2]DIRHOLD
  156. setp hm2_7i76e.0.stepgen.00.steplen [AXIS_2]STEPLEN
  157. setp hm2_7i76e.0.stepgen.00.stepspace [AXIS_2]STEPSPACE
  158. setp hm2_7i76e.0.stepgen.00.position-scale [AXIS_2]STEP_SCALE
  159. setp hm2_7i76e.0.stepgen.00.step_type 0
  160. setp hm2_7i76e.0.stepgen.00.control-type 1
  161. setp hm2_7i76e.0.stepgen.00.maxaccel [AXIS_2]STEPGEN_MAXACCEL
  162. setp hm2_7i76e.0.stepgen.00.maxvel [AXIS_2]STEPGEN_MAXVEL
  163.  
  164. # ---closedloop stepper signals---
  165.  
  166. net z-pos-cmd <= axis.2.motor-pos-cmd
  167. net z-vel-cmd <= axis.2.joint-vel-cmd
  168. net z-output => hm2_7i76e.0.stepgen.00.velocity-cmd
  169. net z-pos-fb <= hm2_7i76e.0.stepgen.00.position-fb
  170. net z-pos-fb => axis.2.motor-pos-fb
  171. net z-enable <= axis.2.amp-enable-out
  172. net z-enable => hm2_7i76e.0.stepgen.00.enable
  173.  
  174. # ---setup home / limit switch signals---
  175.  
  176. net z-home-sw => axis.2.home-sw-in
  177. net z-neg-limit => axis.2.neg-lim-sw-in
  178. net z-pos-limit => axis.2.pos-lim-sw-in
  179.  
  180. #*******************
  181. # SPINDLE S
  182. #*******************
  183.  
  184. setp pid.s.Pgain [SPINDLE_9]P
  185. setp pid.s.Igain [SPINDLE_9]I
  186. setp pid.s.Dgain [SPINDLE_9]D
  187. setp pid.s.bias [SPINDLE_9]BIAS
  188. setp pid.s.FF0 [SPINDLE_9]FF0
  189. setp pid.s.FF1 [SPINDLE_9]FF1
  190. setp pid.s.FF2 [SPINDLE_9]FF2
  191. setp pid.s.deadband [SPINDLE_9]DEADBAND
  192. setp pid.s.maxoutput [SPINDLE_9]MAX_OUTPUT
  193. setp pid.s.error-previous-target true
  194.  
  195. net spindle-index-enable <=> pid.s.index-enable
  196. net spindle-enable => pid.s.enable
  197. net spindle-vel-cmd-rpm => pid.s.command
  198. net spindle-vel-fb-rpm => pid.s.feedback
  199. net spindle-output <= pid.s.output
  200.  
  201. # ---setup spindle control signals---
  202.  
  203. net spindle-vel-cmd-rps <= motion.spindle-speed-out-rps
  204. net spindle-vel-cmd-rps-abs <= motion.spindle-speed-out-rps-abs
  205. net spindle-vel-cmd-rpm <= motion.spindle-speed-out
  206. net spindle-vel-cmd-rpm-abs <= motion.spindle-speed-out-abs
  207. net spindle-enable <= motion.spindle-on
  208. net spindle-cw <= motion.spindle-forward
  209. net spindle-ccw <= motion.spindle-reverse
  210. net spindle-brake <= motion.spindle-brake
  211. net spindle-revs => motion.spindle-revs
  212. net spindle-at-speed => motion.spindle-at-speed
  213. net spindle-vel-fb-rps => motion.spindle-speed-in
  214. net spindle-index-enable <=> motion.spindle-index-enable
  215.  
  216. # ---Setup spindle at speed signals---
  217.  
  218. sets spindle-at-speed true
  219.  
  220.  
  221. #******************************
  222. # connect miscellaneous signals
  223. #******************************
  224.  
  225. # ---HALUI signals---
  226.  
  227. net joint-select-a halui.joint.0.select
  228. net x-is-homed halui.joint.0.is-homed
  229. net jog-x-pos halui.jog.0.plus
  230. net jog-x-neg halui.jog.0.minus
  231. net jog-x-analog halui.jog.0.analog
  232. net joint-select-b halui.joint.1.select
  233. net y-is-homed halui.joint.1.is-homed
  234. net jog-y-pos halui.jog.1.plus
  235. net jog-y-neg halui.jog.1.minus
  236. net jog-y-analog halui.jog.1.analog
  237. net joint-select-c halui.joint.2.select
  238. net z-is-homed halui.joint.2.is-homed
  239. net jog-z-pos halui.jog.2.plus
  240. net jog-z-neg halui.jog.2.minus
  241. net jog-z-analog halui.jog.2.analog
  242. net jog-selected-pos halui.jog.selected.plus
  243. net jog-selected-neg halui.jog.selected.minus
  244. net spindle-manual-cw halui.spindle.forward
  245. net spindle-manual-ccw halui.spindle.reverse
  246. net spindle-manual-stop halui.spindle.stop
  247. net machine-is-on halui.machine.is-on
  248. net jog-speed halui.jog-speed
  249. net MDI-mode halui.mode.is-mdi
  250.  
  251. # ---coolant signals---
  252.  
  253. net coolant-mist <= iocontrol.0.coolant-mist
  254. net coolant-flood <= iocontrol.0.coolant-flood
  255.  
  256. # ---probe signal---
  257.  
  258. net probe-in => motion.probe-input
  259.  
  260. # ---motion control signals---
  261.  
  262. net in-position <= motion.in-position
  263. net machine-is-enabled <= motion.motion-enabled
  264.  
  265. # ---digital in / out signals---
  266.  
  267. # ---estop signals---
  268.  
  269. net estop-out <= iocontrol.0.user-enable-out
  270. net estop-out => iocontrol.0.emc-enable-in
  271.  
  272. # ---toolchange signals for custom tool changer---
  273.  
  274. net tool-number <= iocontrol.0.tool-prep-number
  275. net tool-change-request <= iocontrol.0.tool-change
  276. net tool-change-confirmed => iocontrol.0.tool-changed
  277. net tool-prepare-request <= iocontrol.0.tool-prepare
  278. net tool-prepare-confirmed => iocontrol.0.tool-prepared
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement