hal/python control scheme help

More
26 Aug 2017 19:51 #98048 by blazini36
I'm having a pretty tough time putting this together in hal. I've been bouncing back and forth with the docs and so far I have a custom.hal file that probably doesn't make any sense.

Any chance you could help me out with an example?

my hal file
# Generated by PNCconf at Sun Jul 16 19:11:56 2017
# 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 hostmot2
loadrt hm2_eth board_ip="10.10.10.10" config="firmware=hm2/7i76/7i76e.BIT num_encoders=1 num_pwmgens=0 num_stepgens=5 sserial_port_0=00xxxx" 
setp    hm2_7i76e.0.watchdog.timeout_ns 5000000
loadrt pid names=pid.x,pid.y,pid.z,pid.s
loadrt abs names=abs.spindle
loadrt lowpass names=lowpass.spindle
loadrt scale names=scale.spindle

addf hm2_7i76e.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 scale.spindle            servo-thread
addf abs.spindle              servo-thread
addf lowpass.spindle          servo-thread
addf hm2_7i76e.0.write         servo-thread
setp hm2_7i76e.0.dpll.01.timer-us -50
setp hm2_7i76e.0.stepgen.timer-number 1

# external output signals


# --- CAM0_TRIGGER_OUT ---
net cam0_trigger_OUT hm2_7i76e.0.7i76.0.0.output-00

# --- CAM0_FLASH_TRIGGER_OUT ---
net cam0_flash_trigger_OUT hm2_7i76e.0.7i76.0.0.output-01

# --- CAM1_TRIGGER_OUT ---
net cam1_trigger_OUT hm2_7i76e.0.7i76.0.0.output-04

# --- CAM1_FLASH_TRIGGER_OUT ---
net cam1_flash_trigger_OUT hm2_7i76e.0.7i76.0.0.output-05

# --- FLASH_INTENSITY_AOUT ---
# net Flash_intensity_AOUT-enable            =>  hm2_7i76e.0.7i76.0.0..spinena
# net Flash_intensity_AOUT-output            =>  hm2_7i76e.0.7i76.0.0..spinout
# net Flash_intensity_AOUT-direction          =>  hm2_7i76e.0.7i76.0.0..spindir

# external input signals


# --- MIN-X ---
net min-x     <=  hm2_7i76e.0.7i76.0.0.input-00

# --- MAX-X ---
net max-x     <=  hm2_7i76e.0.7i76.0.0.input-01

# --- HOME-X ---
net home-x     <=  hm2_7i76e.0.7i76.0.0.input-02

# --- MIN-Y ---
net min-y     <=  hm2_7i76e.0.7i76.0.0.input-08

# --- MAX-Y ---
net max-y     <=  hm2_7i76e.0.7i76.0.0.input-09

# --- HOME-Y ---
net home-y     <=  hm2_7i76e.0.7i76.0.0.input-10

# --- DIN-01 ---
net Park-Cams     <=  hm2_7i76e.0.7i76.0.0.input-16

# --- DIN-01 ---
net cue-sense     <=  hm2_7i76e.0.7i76.0.0.input-17

#*******************
#  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
setp   pid.x.error-previous-target true
setp   pid.x.maxerror .0005

net x-index-enable  <=> pid.x.index-enable
net x-enable        =>  pid.x.enable
net x-pos-cmd       =>  pid.x.command
net x-vel-cmd       =>  pid.x.command-deriv
net x-pos-fb        =>  pid.x.feedback
net x-output        =>  pid.x.output

# Step Gen signals/setup

setp   hm2_7i76e.0.stepgen.00.dirsetup        [AXIS_0]DIRSETUP
setp   hm2_7i76e.0.stepgen.00.dirhold         [AXIS_0]DIRHOLD
setp   hm2_7i76e.0.stepgen.00.steplen         [AXIS_0]STEPLEN
setp   hm2_7i76e.0.stepgen.00.stepspace       [AXIS_0]STEPSPACE
setp   hm2_7i76e.0.stepgen.00.position-scale  [AXIS_0]STEP_SCALE
setp   hm2_7i76e.0.stepgen.00.step_type        0
setp   hm2_7i76e.0.stepgen.00.control-type     1
setp   hm2_7i76e.0.stepgen.00.maxaccel         [AXIS_0]STEPGEN_MAXACCEL
setp   hm2_7i76e.0.stepgen.00.maxvel           [AXIS_0]STEPGEN_MAXVEL

# ---closedloop stepper signals---

net x-pos-cmd    <= axis.0.motor-pos-cmd
net x-vel-cmd    <= axis.0.joint-vel-cmd
net x-output     <= hm2_7i76e.0.stepgen.00.velocity-cmd
net x-pos-fb     <= hm2_7i76e.0.stepgen.00.position-fb
net x-pos-fb     => axis.0.motor-pos-fb
net x-enable     <= axis.0.amp-enable-out
net x-enable     => hm2_7i76e.0.stepgen.00.enable

# ---setup home / limit switch signals---

net home-x     =>  axis.0.home-sw-in
net min-x     =>  axis.0.neg-lim-sw-in
net max-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
setp   pid.y.error-previous-target true
setp   pid.y.maxerror .0005

net y-index-enable  <=> pid.y.index-enable
net y-enable        =>  pid.y.enable
net y-pos-cmd       =>  pid.y.command
net y-vel-cmd       =>  pid.y.command-deriv
net y-pos-fb        =>  pid.y.feedback
net y-output        =>  pid.y.output

# Step Gen signals/setup

setp   hm2_7i76e.0.stepgen.01.dirsetup        [AXIS_1]DIRSETUP
setp   hm2_7i76e.0.stepgen.01.dirhold         [AXIS_1]DIRHOLD
setp   hm2_7i76e.0.stepgen.01.steplen         [AXIS_1]STEPLEN
setp   hm2_7i76e.0.stepgen.01.stepspace       [AXIS_1]STEPSPACE
setp   hm2_7i76e.0.stepgen.01.position-scale  [AXIS_1]STEP_SCALE
setp   hm2_7i76e.0.stepgen.01.step_type        0
setp   hm2_7i76e.0.stepgen.01.control-type     1
setp   hm2_7i76e.0.stepgen.01.maxaccel         [AXIS_1]STEPGEN_MAXACCEL
setp   hm2_7i76e.0.stepgen.01.maxvel           [AXIS_1]STEPGEN_MAXVEL

# ---closedloop stepper signals---

net y-pos-cmd    <= axis.1.motor-pos-cmd
net y-vel-cmd    <= axis.1.joint-vel-cmd
net y-output     <= hm2_7i76e.0.stepgen.01.velocity-cmd
net y-pos-fb     <= hm2_7i76e.0.stepgen.01.position-fb
net y-pos-fb     => axis.1.motor-pos-fb
net y-enable     <= axis.1.amp-enable-out
net y-enable     => hm2_7i76e.0.stepgen.01.enable

# ---setup home / limit switch signals---

net home-y     =>  axis.1.home-sw-in
net min-y     =>  axis.1.neg-lim-sw-in
net max-y     =>  axis.1.pos-lim-sw-in


#*******************
#  SPINDLE S
#*******************

setp   pid.s.Pgain     [SPINDLE_9]P
setp   pid.s.Igain     [SPINDLE_9]I
setp   pid.s.Dgain     [SPINDLE_9]D
setp   pid.s.bias      [SPINDLE_9]BIAS
setp   pid.s.FF0       [SPINDLE_9]FF0
setp   pid.s.FF1       [SPINDLE_9]FF1
setp   pid.s.FF2       [SPINDLE_9]FF2
setp   pid.s.deadband  [SPINDLE_9]DEADBAND
setp   pid.s.maxoutput [SPINDLE_9]MAX_OUTPUT
setp   pid.s.error-previous-target true

net spindle-index-enable  <=> pid.s.index-enable
net spindle-enable        =>  pid.s.enable
net spindle-vel-cmd-rpm     => pid.s.command
net spindle-vel-fb-rpm      => pid.s.feedback
net spindle-output        <=  pid.s.output

# ---Encoder feedback signals/setup---

setp    hm2_7i76e.0.encoder.00.counter-mode 0
setp    hm2_7i76e.0.encoder.00.filter 1
setp    hm2_7i76e.0.encoder.00.index-invert 0
setp    hm2_7i76e.0.encoder.00.index-mask 0
setp    hm2_7i76e.0.encoder.00.index-mask-invert 0
setp    hm2_7i76e.0.encoder.00.scale  [SPINDLE_9]ENCODER_SCALE

net spindle-revs             <=   hm2_7i76e.0.encoder.00.position
net spindle-vel-fb-rps       <=   hm2_7i76e.0.encoder.00.velocity
net spindle-index-enable     <=>  hm2_7i76e.0.encoder.00.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-rpm        <=  motion.spindle-speed-out
net spindle-vel-cmd-rpm-abs    <=  motion.spindle-speed-out-abs
net spindle-enable             <=  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-rps         =>  motion.spindle-speed-in
net spindle-index-enable      <=>  motion.spindle-index-enable

# ---Setup spindle at speed signals---

sets spindle-at-speed true

#  Use ACTUAL spindle velocity from spindle encoder
#  spindle-velocity bounces around so we filter it with lowpass
#  spindle-velocity is signed so we use absolute component to remove sign
#  ACTUAL velocity is in RPS not RPM so we scale it.

setp     scale.spindle.gain 60
setp     lowpass.spindle.gain 1.000000
net spindle-vel-fb-rps        =>     scale.spindle.in
net spindle-fb-rpm               scale.spindle.out       =>   abs.spindle.in
net spindle-fb-rpm-abs           abs.spindle.out         =>   lowpass.spindle.in
net spindle-fb-rpm-abs-filtered  lowpass.spindle.out  

#******************************
# 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 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 


#  ---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-out     =>  iocontrol.0.emc-enable-in

#  ---toolchange signals for custom tool changer---

net tool-number             <=  iocontrol.0.tool-prep-number
net tool-change-request     <=  iocontrol.0.tool-change
net tool-change-confirmed   =>  iocontrol.0.tool-changed
net tool-prepare-request    <=  iocontrol.0.tool-prepare
net tool-prepare-confirmed  =>  iocontrol.0.tool-prepared

Please Log in or Create an account to join the conversation.

More
30 Aug 2017 00:19 #98171 by blazini36
I'm working on this and I could have sworn that in halshow the hm2_7i76e.0.encoder.00.input-index pin would go true as the sensor on it went high. If I setp index-enable true the sensor going high changes the enable pin to false so I know it's being seen by the board. I should just be able to put the updown function on a field input right? we're probably talking 50hz max. Any Idea of the max GPIO speed? I'm sure it's above 50hz

Please Log in or Create an account to join the conversation.

More
30 Aug 2017 03:41 - 30 Aug 2017 03:41 #98175 by PCW
Replied by PCW on topic hal/python control scheme help
Both the hm2_7i76e.0.encoder.00.input-index pin and the field I/O are sampled at the servo thread rate so normally every
1 millisecond. So as long as the input high and low times are greater than 1 ms you should be fine

You may not see them reliably using the watch or halmeter functions since with default settings,
the GUI is only updated about 10 times per second, but you can check them with halscope.
Last edit: 30 Aug 2017 03:41 by PCW.

Please Log in or Create an account to join the conversation.

More
30 Aug 2017 04:12 #98178 by blazini36
I'm was triggering the sensor slowly by hand, I never changed to voltage divider so the pin may not have been going completely low, but it did trigger index-enable false. the GPIO input

I'm writing a new hal file for this and I'm using updown as you suggested for the sensor I'm using for the index and it works.

My issue is I'm not sure what to do with the comparator you mentioned, I can't figure out how that works.

right now im trying to run encoder counts into another updown which might work but I'm afraid I'm using too much software to do this.

Please Log in or Create an account to join the conversation.

More
30 Aug 2017 06:40 #98182 by blazini36
I figured out the use of comparator and actually managed to write a hal file. This works exactly as intended.

Would you say this is an efficient way to do this?

loadrt updown names=updown.contrast
loadrt conv_s32_bit names=conv_s32_bit.contrast
loadrt offset names=offset.encoder
loadrt comp names=comp.trigger

addf updown.encoder servo-thread
addf updown.contrast servo-thread
addf conv_s32_bit.contrast servo-thread
addf comp.trigger servo-thread


####trigger encoder index enable on value of setp updown.contrast.max######
net contrast_count updown.contrast.countup <= hm2_7i76e.0.7i76.0.0.input-17
net contrast_limit_reached conv_s32_bit.contrast.in <= updown.contrast.count
net contrast_reset_encdr hm2_7i76e.0.encoder.00.reset <= conv_s32_bit.contrast.out

#####count encoder and trigger camera on comp.trigger.in0#####
net trigger_position comp.trigger.in1 <= hm2_7i76e.0.encoder.00.position
net cam0_trigger_OUT <= comp.trigger.out

setp hm2_7i76e.0.encoder.00.counter-mode 1
setp hm2_7i76e.0.encoder.00.scale [WEB_1]ENCODER_SCALE
setp updown.contrast.wrap true
setp updown.contrast.max 2

#####comparator input for trigger offset########
setp comp.trigger.in0 25

Please Log in or Create an account to join the conversation.

Time to create page: 0.113 seconds
Powered by Kunena Forum