Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- # Generated by PNCconf at Sat Feb 14 01:30:03 2015
- # If you make changes to this file, they will be
- # overwritten when you run PNCconf again
- loadrt trivkins
- loadrt [EMCMOT]EMCMOT servo_period_nsec=[EMCMOT]SERVO_PERIOD num_joints=[TRAJ]AXES
- loadrt probe_parport
- loadrt hostmot2
- loadrt hm2_pci config=" num_encoders=6 num_pwmgens=0 num_3pwmgens=0 num_stepgens=0 sserial_port_0=000xx "
- setp hm2_5i25.0.watchdog.timeout_ns 10000000
- loadrt pid names=pid.x,pid.y,pid.z,pid.s
- loadrt near
- addf hm2_5i25.0.read servo-thread
- addf motion-command-handler servo-thread
- addf motion-controller servo-thread
- addf pid.x.do-pid-calcs servo-thread
- addf pid.y.do-pid-calcs servo-thread
- addf pid.z.do-pid-calcs servo-thread
- addf pid.s.do-pid-calcs servo-thread
- addf near.0 servo-thread
- addf hm2_5i25.0.write servo-thread
- addf hm2_5i25.0.pet_watchdog servo-thread
- # external output signals
- # external input signals
- # --- ESTOP-EXT ---
- net estop-ext <= hm2_5i25.0.7i77.0.0.input-00
- # --- MIN-X ---
- net min-x <= hm2_5i25.0.7i77.0.0.input-01-not
- # --- MAX-HOME-X ---
- net max-home-x <= hm2_5i25.0.7i77.0.0.input-02
- # --- MIN-Y ---
- net min-y <= hm2_5i25.0.7i77.0.0.input-03-not
- # --- MAX-HOME-Y ---
- net max-home-y <= hm2_5i25.0.7i77.0.0.input-04-not
- # --- MIN-Z ---
- net min-z <= hm2_5i25.0.7i77.0.0.input-05-not
- # --- MAX-HOME-Z ---
- net max-home-z <= hm2_5i25.0.7i77.0.0.input-06-not
- #*******************
- # AXIS X
- #*******************
- setp pid.x.Pgain [AXIS_0]P
- setp pid.x.Igain [AXIS_0]I
- setp pid.x.Dgain [AXIS_0]D
- setp pid.x.bias [AXIS_0]BIAS
- setp pid.x.FF0 [AXIS_0]FF0
- setp pid.x.FF1 [AXIS_0]FF1
- setp pid.x.FF2 [AXIS_0]FF2
- setp pid.x.deadband [AXIS_0]DEADBAND
- setp pid.x.maxoutput [AXIS_0]MAX_OUTPUT
- net x-index-enable <=> pid.x.index-enable
- net x-enable => pid.x.enable
- net x-output => pid.x.output
- net x-pos-cmd => pid.x.command
- net x-vel-fb => pid.x.feedback-deriv
- net x-pos-fb => pid.x.feedback
- # ---PWM Generator signals/setup---
- setp hm2_5i25.0.7i77.0.1.analogout0-scalemax [AXIS_0]OUTPUT_SCALE
- setp hm2_5i25.0.7i77.0.1.analogout0-minlim [AXIS_0]OUTPUT_MIN_LIMIT
- setp hm2_5i25.0.7i77.0.1.analogout0-maxlim [AXIS_0]OUTPUT_MAX_LIMIT
- net x-output => hm2_5i25.0.7i77.0.1.analogout0
- net x-pos-cmd axis.0.motor-pos-cmd
- net x-enable axis.0.amp-enable-out
- # enable _all_ sserial pwmgens
- net x-enable hm2_5i25.0.7i77.0.1.analogena
- # ---Encoder feedback signals/setup---
- setp hm2_5i25.0.encoder.00.counter-mode 0
- setp hm2_5i25.0.encoder.00.filter 1
- setp hm2_5i25.0.encoder.00.index-invert 0
- setp hm2_5i25.0.encoder.00.index-mask 0
- setp hm2_5i25.0.encoder.00.index-mask-invert 0
- setp hm2_5i25.0.encoder.00.scale [AXIS_0]ENCODER_SCALE
- net x-pos-fb <= hm2_5i25.0.encoder.00.position
- net x-vel-fb <= hm2_5i25.0.encoder.00.velocity
- net x-pos-fb => axis.0.motor-pos-fb
- net x-index-enable axis.0.index-enable <=> hm2_5i25.0.encoder.00.index-enable
- net x-pos-rawcounts <= hm2_5i25.0.encoder.00.rawcounts
- # ---setup home / limit switch signals---
- net max-home-x => axis.0.home-sw-in
- net min-x => axis.0.neg-lim-sw-in
- net max-home-x => axis.0.pos-lim-sw-in
- #*******************
- # AXIS Y
- #*******************
- setp pid.y.Pgain [AXIS_1]P
- setp pid.y.Igain [AXIS_1]I
- setp pid.y.Dgain [AXIS_1]D
- setp pid.y.bias [AXIS_1]BIAS
- setp pid.y.FF0 [AXIS_1]FF0
- setp pid.y.FF1 [AXIS_1]FF1
- setp pid.y.FF2 [AXIS_1]FF2
- setp pid.y.deadband [AXIS_1]DEADBAND
- setp pid.y.maxoutput [AXIS_1]MAX_OUTPUT
- net y-index-enable <=> pid.y.index-enable
- net y-enable => pid.y.enable
- net y-output => pid.y.output
- net y-pos-cmd => pid.y.command
- net y-vel-fb => pid.y.feedback-deriv
- net y-pos-fb => pid.y.feedback
- # ---PWM Generator signals/setup---
- setp hm2_5i25.0.7i77.0.1.analogout1-scalemax [AXIS_1]OUTPUT_SCALE
- setp hm2_5i25.0.7i77.0.1.analogout1-minlim [AXIS_1]OUTPUT_MIN_LIMIT
- setp hm2_5i25.0.7i77.0.1.analogout1-maxlim [AXIS_1]OUTPUT_MAX_LIMIT
- net y-output => hm2_5i25.0.7i77.0.1.analogout1
- net y-pos-cmd axis.1.motor-pos-cmd
- net y-enable axis.1.amp-enable-out
- # ---Encoder feedback signals/setup---
- setp hm2_5i25.0.encoder.01.counter-mode 0
- setp hm2_5i25.0.encoder.01.filter 1
- setp hm2_5i25.0.encoder.01.index-invert 0
- setp hm2_5i25.0.encoder.01.index-mask 0
- setp hm2_5i25.0.encoder.01.index-mask-invert 0
- setp hm2_5i25.0.encoder.01.scale [AXIS_1]ENCODER_SCALE
- net y-pos-fb <= hm2_5i25.0.encoder.01.position
- net y-vel-fb <= hm2_5i25.0.encoder.01.velocity
- net y-pos-fb => axis.1.motor-pos-fb
- net y-index-enable axis.1.index-enable <=> hm2_5i25.0.encoder.01.index-enable
- net y-pos-rawcounts <= hm2_5i25.0.encoder.01.rawcounts
- # ---setup home / limit switch signals---
- net max-home-y => axis.1.home-sw-in
- net min-y => axis.1.neg-lim-sw-in
- net max-home-y => axis.1.pos-lim-sw-in
- #*******************
- # AXIS Z
- #*******************
- setp pid.z.Pgain [AXIS_2]P
- setp pid.z.Igain [AXIS_2]I
- setp pid.z.Dgain [AXIS_2]D
- setp pid.z.bias [AXIS_2]BIAS
- setp pid.z.FF0 [AXIS_2]FF0
- setp pid.z.FF1 [AXIS_2]FF1
- setp pid.z.FF2 [AXIS_2]FF2
- setp pid.z.deadband [AXIS_2]DEADBAND
- setp pid.z.maxoutput [AXIS_2]MAX_OUTPUT
- net z-index-enable <=> pid.z.index-enable
- net z-enable => pid.z.enable
- net z-output => pid.z.output
- net z-pos-cmd => pid.z.command
- net z-vel-fb => pid.z.feedback-deriv
- net z-pos-fb => pid.z.feedback
- # ---PWM Generator signals/setup---
- setp hm2_5i25.0.7i77.0.1.analogout2-scalemax [AXIS_2]OUTPUT_SCALE
- setp hm2_5i25.0.7i77.0.1.analogout2-minlim [AXIS_2]OUTPUT_MIN_LIMIT
- setp hm2_5i25.0.7i77.0.1.analogout2-maxlim [AXIS_2]OUTPUT_MAX_LIMIT
- net z-output => hm2_5i25.0.7i77.0.1.analogout2
- net z-pos-cmd axis.2.motor-pos-cmd
- net z-enable axis.2.amp-enable-out
- # ---Encoder feedback signals/setup---
- setp hm2_5i25.0.encoder.02.counter-mode 0
- setp hm2_5i25.0.encoder.02.filter 1
- setp hm2_5i25.0.encoder.02.index-invert 0
- setp hm2_5i25.0.encoder.02.index-mask 0
- setp hm2_5i25.0.encoder.02.index-mask-invert 0
- setp hm2_5i25.0.encoder.02.scale [AXIS_2]ENCODER_SCALE
- net z-pos-fb <= hm2_5i25.0.encoder.02.position
- net z-vel-fb <= hm2_5i25.0.encoder.02.velocity
- net z-pos-fb => axis.2.motor-pos-fb
- net z-index-enable axis.2.index-enable <=> hm2_5i25.0.encoder.02.index-enable
- net z-pos-rawcounts <= hm2_5i25.0.encoder.02.rawcounts
- # ---setup home / limit switch signals---
- net max-home-z => axis.2.home-sw-in
- net min-z => axis.2.neg-lim-sw-in
- net max-home-z => axis.2.pos-lim-sw-in
- #*******************
- # SPINDLE S
- #*******************
- # ---Encoder feedback signals/setup---
- setp hm2_5i25.0.encoder.05.counter-mode 0
- setp hm2_5i25.0.encoder.05.filter 1
- setp hm2_5i25.0.encoder.05.index-invert 0
- setp hm2_5i25.0.encoder.05.index-mask 0
- setp hm2_5i25.0.encoder.05.index-mask-invert 0
- setp hm2_5i25.0.encoder.05.scale [SPINDLE_9]ENCODER_SCALE
- net spindle-revs <= hm2_5i25.0.encoder.05.position
- net spindle-vel-fb <= hm2_5i25.0.encoder.05.velocity
- net spindle-index-enable <=> hm2_5i25.0.encoder.05.index-enable
- # ---setup spindle control signals---
- net spindle-vel-cmd-rps <= motion.spindle-speed-out-rps
- net spindle-vel-cmd-rps-abs <= motion.spindle-speed-out-rps-abs
- net spindle-vel-cmd <= motion.spindle-speed-out
- net spindle-vel-cmd-rpm-abs <= motion.spindle-speed-out-abs
- net spindle-on <= motion.spindle-on
- net spindle-cw <= motion.spindle-forward
- net spindle-ccw <= motion.spindle-reverse
- net spindle-brake <= motion.spindle-brake
- net spindle-revs => motion.spindle-revs
- net spindle-at-speed => motion.spindle-at-speed
- net spindle-vel-fb => motion.spindle-speed-in
- net spindle-index-enable <=> motion.spindle-index-enable
- # ---Setup spindle at speed signals---
- net spindle-vel-cmd-rps => near.0.in1
- net spindle-vel-fb => near.0.in2
- net spindle-at-speed <= near.0.out
- setp near.0.scale 1.000000
- setp near.0.difference 3.333333
- #******************************
- # connect miscellaneous signals
- #******************************
- # ---HALUI signals---
- net joint-select-a halui.joint.0.select
- net x-is-homed halui.joint.0.is-homed
- net jog-x-pos halui.jog.0.plus
- net jog-x-neg halui.jog.0.minus
- net jog-x-analog halui.jog.0.analog
- net joint-select-b halui.joint.1.select
- net y-is-homed halui.joint.1.is-homed
- net jog-y-pos halui.jog.1.plus
- net jog-y-neg halui.jog.1.minus
- net jog-y-analog halui.jog.1.analog
- net joint-select-c halui.joint.2.select
- net z-is-homed halui.joint.2.is-homed
- net jog-z-pos halui.jog.2.plus
- net jog-z-neg halui.jog.2.minus
- net jog-z-analog halui.jog.2.analog
- net jog-selected-pos halui.jog.selected.plus
- net jog-selected-neg halui.jog.selected.minus
- net spindle-manual-cw halui.spindle.forward
- net spindle-manual-ccw halui.spindle.reverse
- net spindle-manual-stop halui.spindle.stop
- net machine-is-on halui.machine.is-on
- net jog-speed halui.jog-speed
- net MDI-mode halui.mode.is-mdi
- # ---coolant signals---
- net coolant-mist <= iocontrol.0.coolant-mist
- net coolant-flood <= iocontrol.0.coolant-flood
- # ---probe signal---
- net probe-in => motion.probe-input
- # ---motion control signals---
- net in-position <= motion.in-position
- net machine-is-enabled <= motion.motion-enabled
- # ---digital in / out signals---
- # ---estop signals---
- net estop-out <= iocontrol.0.user-enable-out
- net estop-ext => iocontrol.0.emc-enable-in
- # ---manual tool change signals---
- loadusr -W hal_manualtoolchange
- net tool-change-request iocontrol.0.tool-change => hal_manualtoolchange.change
- net tool-change-confirmed iocontrol.0.tool-changed <= hal_manualtoolchange.changed
- net tool-number iocontrol.0.tool-prep-number => hal_manualtoolchange.number
- net tool-prepare-loopback iocontrol.0.tool-prepare => iocontrol.0.tool-prepared
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement