-
Notifications
You must be signed in to change notification settings - Fork 3
/
Copy pathaxis_xy.hal
69 lines (50 loc) · 2.07 KB
/
axis_xy.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
# ################
# X [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.pos-cmd <= axis.0.motor-pos-cmd
net emcmot.00.pos-cmd => hpg.stepgen.00.position-cmd
# Workaround for joint following error
#net motor.00.pos-fb <= hpg.stepgen.00.position-fb
#net motor.00.pos-fb => axis.0.motor-pos-fb
net emcmot.00.pos-cmd => axis.0.motor-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
# ################
# Y [1] Axis
# ################
# axis enable chain
newsig emcmot.01.enable bit
net emcmot.01.enable <= axis.1.amp-enable-out
net emcmot.01.enable => hpg.stepgen.01.enable
# position command and feedback
net emcmot.01.pos-cmd <= axis.1.motor-pos-cmd
net emcmot.01.pos-cmd => hpg.stepgen.01.position-cmd
# Workaround for joint following error
#net motor.01.pos-fb <= hpg.stepgen.01.position-fb
#net motor.01.pos-fb => axis.1.motor-pos-fb
net emcmot.01.pos-cmd => axis.1.motor-pos-fb
# timing parameters
setp hpg.stepgen.01.dirsetup [AXIS_1]DIRSETUP
setp hpg.stepgen.01.dirhold [AXIS_1]DIRHOLD
setp hpg.stepgen.01.steplen [AXIS_1]STEPLEN
setp hpg.stepgen.01.stepspace [AXIS_1]STEPSPACE
setp hpg.stepgen.01.position-scale [AXIS_1]SCALE
setp hpg.stepgen.01.maxvel [AXIS_1]STEPGEN_MAX_VEL
setp hpg.stepgen.01.maxaccel [AXIS_1]STEPGEN_MAX_ACC
setp hpg.stepgen.01.minvel [AXIS_1]STEPGEN_MIN_VEL
# Note: steppers connected in pinconfig file