View difference between Paste ID: FjDnRChx and 5m7ZJPD5
SHOW: | | - or go back to the newest paste.
1
# Generated by stepconf at Mon May 21 18:43:24 2012
2
# If you make changes to this file, they will be
3
# overwritten when you run stepconf again
4
loadrt trivkins
5
loadrt [EMCMOT]EMCMOT base_period_nsec=[EMCMOT]BASE_PERIOD servo_period_nsec=[EMCMOT]SERVO_PERIOD num_joints=[TRAJ]AXES
6
loadrt probe_parport
7
loadrt hal_parport cfg="0x378 out  "
8
setp parport.0.reset-time 5000
9
loadrt stepgen step_type=0,0
10
loadrt encoder num_chan=1
11
loadrt pwmgen output_type=0
12
#lowpass for spindle velocity
13
loadrt lowpass count=1
14
#scale for rpm
15
loadrt scale count=1
16
17
addf parport.0.read base-thread
18
addf stepgen.make-pulses base-thread
19
addf encoder.update-counters base-thread
20
addf pwmgen.make-pulses base-thread
21
addf parport.0.write base-thread
22
addf parport.0.reset base-thread
23
24
addf stepgen.capture-position servo-thread
25
addf encoder.capture-position servo-thread
26
addf motion-command-handler servo-thread
27
addf motion-controller servo-thread
28
addf stepgen.update-freq servo-thread
29
addf pwmgen.update servo-thread
30
addf lowpass.0 servo-thread
31
addf scale.0 servo-thread
32
33
net spindle-cmd <= motion.spindle-speed-out => pwmgen.0.value
34
net spindle-enable <= motion.spindle-on => pwmgen.0.enable
35
net spindle-pwm <= pwmgen.0.pwm
36
setp pwmgen.0.pwm-freq 10000.0
37
setp pwmgen.0.scale 1166.66666667
38
setp pwmgen.0.offset 0.114285714286
39
setp pwmgen.0.dither-pwm true
40
net spindle-cw <= motion.spindle-forward
41
42
#Smoothing of spindle rps factor.
43
setp lowpass.0.gain 0.01
44
45
#scale rps to rpm
46
setp scale.0.gain 60
47
48
setp encoder.0.position-scale 1.000000
49
setp encoder.0.counter-mode 1
50
51-
net spindle-velocity encoder.0.velocity lowpass.0.in
51+
52-
net spindle-velfiltered lowpass.0.out motion.spindle-speed-in
52+
53
54
#hooking the low pass in for spindle velocity smoothing (remarked out original line)
55
# net spindle-velocity encoder.0.velocity => motion.spindle-speed-in
56
net spindle-velocity encoder.0.velocity lowpass.0.in 
57
net spindle-velfiltered lowpass.0.out scale.0.in motion.spindle-speed-in
58
#pin for rpm to pyvcp panel
59
net spindle-rpm-filtered scale.0.out
60
61
net spindle-index-enable encoder.0.index-enable <=> motion.spindle-index-enable
62
63
#hook index to a also..
64
net spindle-index <= parport.0.pin-11-in
65
net spindle-index encoder.0.phase-A
66
#net spindle-phase-b encoder.0.phase-B
67
net spindle-index encoder.0.phase-Z
68
69
net estop-out => parport.0.pin-01-out
70
net xstep => parport.0.pin-02-out
71
setp parport.0.pin-02-out-reset 1
72
net xdir => parport.0.pin-03-out
73
net ystep => parport.0.pin-04-out
74
setp parport.0.pin-04-out-reset 1
75
net ydir => parport.0.pin-05-out
76
net zstep => parport.0.pin-06-out
77
setp parport.0.pin-06-out-reset 1
78
setp parport.0.pin-07-out-invert 1
79
net zdir => parport.0.pin-07-out
80
net astep => parport.0.pin-08-out
81
setp parport.0.pin-08-out-reset 1
82
net adir => parport.0.pin-09-out
83
net spindle-cw => parport.0.pin-14-out
84
net spindle-pwm => parport.0.pin-16-out
85
net xenable => parport.0.pin-17-out
86
87
88
net estop-ext <= parport.0.pin-10-in
89
# net spindle-phase-a <= parport.0.pin-12-in
90
91
92
setp stepgen.0.position-scale [AXIS_0]SCALE
93
setp stepgen.0.steplen 1
94
setp stepgen.0.stepspace 0
95
setp stepgen.0.dirhold 35000
96
setp stepgen.0.dirsetup 35000
97
setp stepgen.0.maxaccel [AXIS_0]STEPGEN_MAXACCEL
98
net xpos-cmd axis.0.motor-pos-cmd => stepgen.0.position-cmd
99
net xpos-fb stepgen.0.position-fb => axis.0.motor-pos-fb
100
net xstep <= stepgen.0.step
101
net xdir <= stepgen.0.dir
102
net xenable axis.0.amp-enable-out => stepgen.0.enable
103
104
setp stepgen.1.position-scale [AXIS_2]SCALE
105
setp stepgen.1.steplen 1
106
setp stepgen.1.stepspace 0
107
setp stepgen.1.dirhold 35000
108
setp stepgen.1.dirsetup 35000
109
setp stepgen.1.maxaccel [AXIS_2]STEPGEN_MAXACCEL
110
net zpos-cmd axis.2.motor-pos-cmd => stepgen.1.position-cmd
111
net zpos-fb stepgen.1.position-fb => axis.2.motor-pos-fb
112
net zstep <= stepgen.1.step
113
net zdir <= stepgen.1.dir
114
net zenable axis.2.amp-enable-out => stepgen.1.enable
115
116
net estop-out <= iocontrol.0.user-enable-out
117
net estop-ext => iocontrol.0.emc-enable-in
118
119
loadusr -W hal_manualtoolchange
120
net tool-change iocontrol.0.tool-change => hal_manualtoolchange.change
121
net tool-changed iocontrol.0.tool-changed <= hal_manualtoolchange.changed
122
net tool-number iocontrol.0.tool-prep-number => hal_manualtoolchange.number
123
net tool-prepare-loopback iocontrol.0.tool-prepare => iocontrol.0.tool-prepared