-
Notifications
You must be signed in to change notification settings - Fork 3
/
Copy pathaxis_x_gantry.hal
73 lines (53 loc) · 2.18 KB
/
axis_x_gantry.hal
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
# ################
# Gantry
# ################
# position command and feedback
net emcmot.00.pos-cmd <= axis.0.motor-pos-cmd
net emcmot.00.pos-cmd => gantry.0.position-cmd
# Workaround for joint following error
net emcmot.00.pos-fb <= gantry.0.position-fb
#net emcmot.00.pos-fb => axis.0.motor-pos-fb
net emcmot.00.pos-cmd => axis.0.motor-pos-fb
# ################
# X1 [0] Axis
# ################
# axis enable chain
newsig emcmot.00.enable bit
net emcmot.00.enable <= axis.0.amp-enable-out
net emcmot.00.enable => hpg.stepgen.00.enable
net emcmot.00.enable => or2.axis-enable.in1
net emcmot.00.enable => or2.status-led.in1
# position command and feedback
net emcmot.00.0.pos-cmd <= gantry.0.joint.00.pos-cmd
net emcmot.00.0.pos-cmd => hpg.stepgen.00.position-cmd
net emcmot.00.0.pos-fb <= hpg.stepgen.00.position-fb
net emcmot.00.0.pos-fb => gantry.0.joint.00.pos-fb
# timing parameters
setp hpg.stepgen.00.dirsetup [AXIS_0]DIRSETUP
setp hpg.stepgen.00.dirhold [AXIS_0]DIRHOLD
setp hpg.stepgen.00.steplen [AXIS_0]STEPLEN
setp hpg.stepgen.00.stepspace [AXIS_0]STEPSPACE
setp hpg.stepgen.00.position-scale [AXIS_0]SCALE
setp hpg.stepgen.00.maxvel [AXIS_0]STEPGEN_MAX_VEL
setp hpg.stepgen.00.maxaccel [AXIS_0]STEPGEN_MAX_ACC
setp hpg.stepgen.00.minvel [AXIS_0]STEPGEN_MIN_VEL
# Note: steppers connected in pinconfig file
# ################
# X2 [0] Axis
# ################
# axis enable chain
net emcmot.00.enable => hpg.stepgen.05.enable
net emcmot.00.1.pos-cmd <= gantry.0.joint.01.pos-cmd
net emcmot.00.1.pos-cmd => hpg.stepgen.05.position-cmd
net emcmot.00.1.pos-fb <= hpg.stepgen.05.position-fb
net emcmot.00.1.pos-fb => gantry.0.joint.01.pos-fb
# timing parameters
setp hpg.stepgen.05.dirsetup [AXIS_0]DIRSETUP
setp hpg.stepgen.05.dirhold [AXIS_0]DIRHOLD
setp hpg.stepgen.05.steplen [AXIS_0]STEPLEN
setp hpg.stepgen.05.stepspace [AXIS_0]STEPSPACE
setp hpg.stepgen.05.position-scale [AXIS_0]SCALE
setp hpg.stepgen.05.maxvel [AXIS_0]STEPGEN_MAX_VEL
setp hpg.stepgen.05.maxaccel [AXIS_0]STEPGEN_MAX_ACC
setp hpg.stepgen.05.minvel [AXIS_0]STEPGEN_MIN_VEL
# Note: steppers connected in pinconfig file