Advertisement
RYU_cz

Untitled

Jun 23rd, 2020
206
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 11.86 KB | None | 0 0
  1. # Generated by PNCconf at Sat May 30 22:59:47 2020
  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=4 num_pwmgens=0 num_stepgens=4"
  9. setp hm2_7i93.0.watchdog.timeout_ns 10000000
  10. loadrt pid names=pid.x,pid.y,pid.z,pid.s
  11.  
  12. addf hm2_7i93.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_7i93.0.write servo-thread
  20.  
  21. # external output signals
  22.  
  23. # --- DOUT-01 ---
  24. setp hm2_7i93.0.gpio.021.is_output true
  25. net dout-01 hm2_7i93.0.gpio.021.out
  26.  
  27. # --- COOLANT-FLOOD ---
  28. setp hm2_7i93.0.gpio.022.is_output true
  29. net coolant-flood hm2_7i93.0.gpio.022.out
  30.  
  31. # --- ESTOP-OUT ---
  32. setp hm2_7i93.0.gpio.023.is_output true
  33. net estop-out hm2_7i93.0.gpio.023.out
  34.  
  35. # --- MACHINE-IS-ENABLED ---
  36. setp hm2_7i93.0.gpio.029.is_output true
  37. net machine-is-enabled hm2_7i93.0.gpio.029.out
  38. setp hm2_7i93.0.gpio.029.invert_output true
  39.  
  40. # --- MACHINE-IS-ENABLED ---
  41. setp hm2_7i93.0.gpio.035.is_output true
  42. net machine-is-enabled hm2_7i93.0.gpio.035.out
  43.  
  44. # --- DOUT-03 ---
  45. setp hm2_7i93.0.gpio.044.is_output true
  46. net dout-03 hm2_7i93.0.gpio.044.out
  47.  
  48. # --- DOUT-02 ---
  49. setp hm2_7i93.0.gpio.045.is_output true
  50. net dout-02 hm2_7i93.0.gpio.045.out
  51.  
  52. # --- DOUT-00 ---
  53. setp hm2_7i93.0.gpio.046.is_output true
  54. net dout-00 hm2_7i93.0.gpio.046.out
  55.  
  56. # --- COOLANT-MIST ---
  57. setp hm2_7i93.0.gpio.047.is_output true
  58. net coolant-mist hm2_7i93.0.gpio.047.out
  59.  
  60. # external input signals
  61.  
  62. # --- ESTOP-EXT ---
  63. net estop-ext <= hm2_7i93.0.gpio.010.in
  64.  
  65. # --- DIN-00 ---
  66. net din-00 <= hm2_7i93.0.gpio.038.in
  67.  
  68. #*******************
  69. # AXIS X
  70. #*******************
  71.  
  72. setp pid.x.Pgain [AXIS_0]P
  73. setp pid.x.Igain [AXIS_0]I
  74. setp pid.x.Dgain [AXIS_0]D
  75. setp pid.x.bias [AXIS_0]BIAS
  76. setp pid.x.FF0 [AXIS_0]FF0
  77. setp pid.x.FF1 [AXIS_0]FF1
  78. setp pid.x.FF2 [AXIS_0]FF2
  79. setp pid.x.deadband [AXIS_0]DEADBAND
  80. setp pid.x.maxoutput [AXIS_0]MAX_OUTPUT
  81. setp pid.x.error-previous-target true
  82. setp pid.x.maxerror .0005
  83.  
  84. net x-index-enable <=> pid.x.index-enable
  85. net x-enable => pid.x.enable
  86. net x-pos-cmd => pid.x.command
  87. net x-vel-cmd => pid.x.command-deriv
  88. net x-pos-fb => pid.x.feedback
  89. #net x-output => pid.x.output
  90. net x-output <= axis.0.motor-pos-cmd
  91.  
  92. # Step Gen signals/setup
  93.  
  94. setp hm2_7i93.0.stepgen.02.dirsetup [AXIS_0]DIRSETUP
  95. setp hm2_7i93.0.stepgen.02.dirhold [AXIS_0]DIRHOLD
  96. setp hm2_7i93.0.stepgen.02.steplen [AXIS_0]STEPLEN
  97. setp hm2_7i93.0.stepgen.02.stepspace [AXIS_0]STEPSPACE
  98. setp hm2_7i93.0.stepgen.02.position-scale [AXIS_0]STEP_SCALE
  99. setp hm2_7i93.0.stepgen.02.step_type 1
  100. setp hm2_7i93.0.stepgen.02.control-type 1
  101. setp hm2_7i93.0.stepgen.02.maxaccel [AXIS_0]STEPGEN_MAXACCEL
  102. setp hm2_7i93.0.stepgen.02.maxvel [AXIS_0]STEPGEN_MAXVEL
  103.  
  104. # ---closedloop stepper signals---
  105.  
  106. #net x-pos-cmd <= axis.0.motor-pos-cmd
  107. net x-vel-cmd <= axis.0.joint-vel-cmd
  108. net x-output => hm2_7i93.0.stepgen.02.velocity-cmd
  109. #net x-pos-fb <= hm2_7i93.0.stepgen.02.position-fb
  110. net x-pos-fb => axis.0.motor-pos-fb
  111. net x-enable <= axis.0.amp-enable-out
  112. net x-enable => hm2_7i93.0.stepgen.02.enable
  113.  
  114. # ---Encoder feedback signals/setup---
  115.  
  116. setp hm2_7i93.0.encoder.02.counter-mode 0
  117. setp hm2_7i93.0.encoder.02.filter 1
  118. setp hm2_7i93.0.encoder.02.index-invert 0
  119. setp hm2_7i93.0.encoder.02.index-mask 0
  120. setp hm2_7i93.0.encoder.02.index-mask-invert 0
  121. setp hm2_7i93.0.encoder.02.scale [AXIS_0]ENCODER_SCALE
  122.  
  123. net x-pos-fb <= hm2_7i93.0.encoder.02.position
  124. net x-vel-fb <= hm2_7i93.0.encoder.02.velocity
  125. net x-pos-fb => axis.0.motor-pos-fb
  126. net x-index-enable axis.0.index-enable <=> hm2_7i93.0.encoder.02.index-enable
  127. net x-pos-rawcounts <= hm2_7i93.0.encoder.02.rawcounts
  128.  
  129. # ---setup home / limit switch signals---
  130.  
  131. net x-home-sw => axis.0.home-sw-in
  132. net x-neg-limit => axis.0.neg-lim-sw-in
  133. net x-pos-limit => axis.0.pos-lim-sw-in
  134.  
  135. #*******************
  136. # AXIS Y
  137. #*******************
  138.  
  139. setp pid.y.Pgain [AXIS_1]P
  140. setp pid.y.Igain [AXIS_1]I
  141. setp pid.y.Dgain [AXIS_1]D
  142. setp pid.y.bias [AXIS_1]BIAS
  143. setp pid.y.FF0 [AXIS_1]FF0
  144. setp pid.y.FF1 [AXIS_1]FF1
  145. setp pid.y.FF2 [AXIS_1]FF2
  146. setp pid.y.deadband [AXIS_1]DEADBAND
  147. setp pid.y.maxoutput [AXIS_1]MAX_OUTPUT
  148. setp pid.y.error-previous-target true
  149. setp pid.y.maxerror .0005
  150.  
  151. net y-index-enable <=> pid.y.index-enable
  152. net y-enable => pid.y.enable
  153. net y-pos-cmd => pid.y.command
  154. net y-vel-cmd => pid.y.command-deriv
  155. net y-pos-fb => pid.y.feedback
  156. net y-output => pid.y.output
  157.  
  158. # Step Gen signals/setup
  159.  
  160. setp hm2_7i93.0.stepgen.01.dirsetup [AXIS_1]DIRSETUP
  161. setp hm2_7i93.0.stepgen.01.dirhold [AXIS_1]DIRHOLD
  162. setp hm2_7i93.0.stepgen.01.steplen [AXIS_1]STEPLEN
  163. setp hm2_7i93.0.stepgen.01.stepspace [AXIS_1]STEPSPACE
  164. setp hm2_7i93.0.stepgen.01.position-scale [AXIS_1]STEP_SCALE
  165. setp hm2_7i93.0.stepgen.01.step_type 1
  166. setp hm2_7i93.0.stepgen.01.control-type 1
  167. setp hm2_7i93.0.stepgen.01.maxaccel [AXIS_1]STEPGEN_MAXACCEL
  168. setp hm2_7i93.0.stepgen.01.maxvel [AXIS_1]STEPGEN_MAXVEL
  169.  
  170. # ---closedloop stepper signals---
  171.  
  172. net y-pos-cmd <= axis.1.motor-pos-cmd
  173. net y-vel-cmd <= axis.1.joint-vel-cmd
  174. net y-output => hm2_7i93.0.stepgen.01.velocity-cmd
  175. net y-pos-fb <= hm2_7i93.0.stepgen.01.position-fb
  176. net y-pos-fb => axis.1.motor-pos-fb
  177. net y-enable <= axis.1.amp-enable-out
  178. net y-enable => hm2_7i93.0.stepgen.01.enable
  179.  
  180. # ---setup home / limit switch signals---
  181.  
  182. net y-home-sw => axis.1.home-sw-in
  183. net y-neg-limit => axis.1.neg-lim-sw-in
  184. net y-pos-limit => axis.1.pos-lim-sw-in
  185.  
  186. #*******************
  187. # AXIS Z
  188. #*******************
  189.  
  190. setp pid.z.Pgain [AXIS_2]P
  191. setp pid.z.Igain [AXIS_2]I
  192. setp pid.z.Dgain [AXIS_2]D
  193. setp pid.z.bias [AXIS_2]BIAS
  194. setp pid.z.FF0 [AXIS_2]FF0
  195. setp pid.z.FF1 [AXIS_2]FF1
  196. setp pid.z.FF2 [AXIS_2]FF2
  197. setp pid.z.deadband [AXIS_2]DEADBAND
  198. setp pid.z.maxoutput [AXIS_2]MAX_OUTPUT
  199. setp pid.z.error-previous-target true
  200. setp pid.z.maxerror .0005
  201.  
  202. net z-index-enable <=> pid.z.index-enable
  203. net z-enable => pid.z.enable
  204. net z-pos-cmd => pid.z.command
  205. net z-vel-cmd => pid.z.command-deriv
  206. net z-pos-fb => pid.z.feedback
  207. net z-output => pid.z.output
  208.  
  209. # Step Gen signals/setup
  210.  
  211. setp hm2_7i93.0.stepgen.00.dirsetup [AXIS_2]DIRSETUP
  212. setp hm2_7i93.0.stepgen.00.dirhold [AXIS_2]DIRHOLD
  213. setp hm2_7i93.0.stepgen.00.steplen [AXIS_2]STEPLEN
  214. setp hm2_7i93.0.stepgen.00.stepspace [AXIS_2]STEPSPACE
  215. setp hm2_7i93.0.stepgen.00.position-scale [AXIS_2]STEP_SCALE
  216. setp hm2_7i93.0.stepgen.00.step_type 0
  217. setp hm2_7i93.0.stepgen.00.control-type 1
  218. setp hm2_7i93.0.stepgen.00.maxaccel [AXIS_2]STEPGEN_MAXACCEL
  219. setp hm2_7i93.0.stepgen.00.maxvel [AXIS_2]STEPGEN_MAXVEL
  220.  
  221. # ---closedloop stepper signals---
  222.  
  223. net z-pos-cmd <= axis.2.motor-pos-cmd
  224. net z-vel-cmd <= axis.2.joint-vel-cmd
  225. net z-output => hm2_7i93.0.stepgen.00.velocity-cmd
  226. net z-pos-fb <= hm2_7i93.0.stepgen.00.position-fb
  227. net z-pos-fb => axis.2.motor-pos-fb
  228. net z-enable <= axis.2.amp-enable-out
  229. net z-enable => hm2_7i93.0.stepgen.00.enable
  230.  
  231. # ---setup home / limit switch signals---
  232.  
  233. net z-home-sw => axis.2.home-sw-in
  234. net z-neg-limit => axis.2.neg-lim-sw-in
  235. net z-pos-limit => axis.2.pos-lim-sw-in
  236.  
  237. #*******************
  238. # SPINDLE S
  239. #*******************
  240.  
  241. setp pid.s.Pgain [SPINDLE_9]P
  242. setp pid.s.Igain [SPINDLE_9]I
  243. setp pid.s.Dgain [SPINDLE_9]D
  244. setp pid.s.bias [SPINDLE_9]BIAS
  245. setp pid.s.FF0 [SPINDLE_9]FF0
  246. setp pid.s.FF1 [SPINDLE_9]FF1
  247. setp pid.s.FF2 [SPINDLE_9]FF2
  248. setp pid.s.deadband [SPINDLE_9]DEADBAND
  249. setp pid.s.maxoutput [SPINDLE_9]MAX_OUTPUT
  250. setp pid.s.error-previous-target true
  251.  
  252. net spindle-index-enable <=> pid.s.index-enable
  253. net spindle-enable => pid.s.enable
  254. net spindle-vel-cmd-rpm => pid.s.command
  255. net spindle-vel-fb-rpm => pid.s.feedback
  256. net spindle-output <= pid.s.output
  257.  
  258. # ---setup spindle control signals---
  259.  
  260. net spindle-vel-cmd-rps <= motion.spindle-speed-out-rps
  261. net spindle-vel-cmd-rps-abs <= motion.spindle-speed-out-rps-abs
  262. net spindle-vel-cmd-rpm <= motion.spindle-speed-out
  263. net spindle-vel-cmd-rpm-abs <= motion.spindle-speed-out-abs
  264. net spindle-enable <= motion.spindle-on
  265. net spindle-cw <= motion.spindle-forward
  266. net spindle-ccw <= motion.spindle-reverse
  267. net spindle-brake <= motion.spindle-brake
  268. net spindle-revs => motion.spindle-revs
  269. net spindle-at-speed => motion.spindle-at-speed
  270. net spindle-vel-fb-rps => motion.spindle-speed-in
  271. net spindle-index-enable <=> motion.spindle-index-enable
  272.  
  273. # ---Setup spindle at speed signals---
  274.  
  275. sets spindle-at-speed true
  276.  
  277.  
  278. #******************************
  279. # connect miscellaneous signals
  280. #******************************
  281.  
  282. # ---HALUI signals---
  283.  
  284. net joint-select-a halui.joint.0.select
  285. net x-is-homed halui.joint.0.is-homed
  286. net jog-x-pos halui.jog.0.plus
  287. net jog-x-neg halui.jog.0.minus
  288. net jog-x-analog halui.jog.0.analog
  289. net joint-select-b halui.joint.1.select
  290. net y-is-homed halui.joint.1.is-homed
  291. net jog-y-pos halui.jog.1.plus
  292. net jog-y-neg halui.jog.1.minus
  293. net jog-y-analog halui.jog.1.analog
  294. net joint-select-c halui.joint.2.select
  295. net z-is-homed halui.joint.2.is-homed
  296. net jog-z-pos halui.jog.2.plus
  297. net jog-z-neg halui.jog.2.minus
  298. net jog-z-analog halui.jog.2.analog
  299. net jog-selected-pos halui.jog.selected.plus
  300. net jog-selected-neg halui.jog.selected.minus
  301. net spindle-manual-cw halui.spindle.forward
  302. net spindle-manual-ccw halui.spindle.reverse
  303. net spindle-manual-stop halui.spindle.stop
  304. net machine-is-on halui.machine.is-on
  305. net jog-speed halui.jog-speed
  306. net MDI-mode halui.mode.is-mdi
  307.  
  308. # ---coolant signals---
  309.  
  310. net coolant-mist <= iocontrol.0.coolant-mist
  311. net coolant-flood <= iocontrol.0.coolant-flood
  312.  
  313. # ---probe signal---
  314.  
  315. net probe-in => motion.probe-input
  316.  
  317. # ---motion control signals---
  318.  
  319. net in-position <= motion.in-position
  320. net machine-is-enabled <= motion.motion-enabled
  321.  
  322. # ---digital in / out signals---
  323.  
  324. net dout-00 <= motion.digital-out-00
  325. net dout-01 <= motion.digital-out-01
  326. net dout-02 <= motion.digital-out-02
  327. net dout-03 <= motion.digital-out-03
  328. net din-00 => motion.digital-in-00
  329. # ---estop signals---
  330.  
  331. net estop-out <= iocontrol.0.user-enable-out
  332. net estop-ext => iocontrol.0.emc-enable-in
  333.  
  334. # ---manual tool change signals---
  335.  
  336. loadusr -W hal_manualtoolchange
  337. net tool-change-request iocontrol.0.tool-change => hal_manualtoolchange.change
  338. net tool-change-confirmed iocontrol.0.tool-changed <= hal_manualtoolchange.changed
  339. net tool-number iocontrol.0.tool-prep-number => hal_manualtoolchange.number
  340. net tool-prepare-loopback iocontrol.0.tool-prepare => iocontrol.0.tool-prepared
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement