|
84 | 84 | # Should put the bottom of the plate this mm below the latch when storing.
|
85 | 85 | LATCH_CLEARANCE = 2.5
|
86 | 86 |
|
87 |
| -# Configs |
88 |
| -TOF_DETECTION_CONFIG = { |
89 |
| - TOFSensor.X: { |
90 |
| - Direction.EXTEND: TOFDetection( |
91 |
| - TOFSensor.X, |
92 |
| - zones=[5, 6, 7], |
93 |
| - bins=list(range(30, 40)), |
94 |
| - threshold=1000, |
95 |
| - ), |
96 |
| - Direction.RETRACT: TOFDetection( |
97 |
| - TOFSensor.X, |
98 |
| - zones=[5, 6, 7], |
99 |
| - bins=list(range(17, 30)), |
100 |
| - threshold=1000, |
101 |
| - ), |
102 |
| - }, |
103 |
| - TOFSensor.Z: { |
104 |
| - Direction.EXTEND: TOFDetection( |
105 |
| - TOFSensor.Z, |
106 |
| - zones=[1, 2, 3], |
107 |
| - bins=list(range(15, 63)), |
108 |
| - threshold=1000, |
109 |
| - ), |
110 |
| - Direction.RETRACT: TOFDetection( |
111 |
| - TOFSensor.Z, |
112 |
| - zones=[1, 2, 3], |
113 |
| - bins=list(range(15, 63)), |
114 |
| - threshold=1000, |
115 |
| - ), |
116 |
| - }, |
117 |
| -} |
118 |
| - |
119 |
| - |
120 |
| -# Stallguard defaults |
121 |
| -STALLGUARD_CONFIG = { |
122 |
| - StackerAxis.X: StallGuardParams(StackerAxis.X, True, 0), |
123 |
| - StackerAxis.Z: StallGuardParams(StackerAxis.Z, True, 0), |
124 |
| -} |
125 |
| - |
126 |
| -STACKER_MOTION_CONFIG = { |
127 |
| - StackerAxis.X: { |
128 |
| - "home": AxisParams( |
129 |
| - run_current=1.5, # mAmps |
130 |
| - hold_current=0.75, |
131 |
| - move_params=MoveParams( |
132 |
| - max_speed=10.0, # mm/s |
133 |
| - acceleration=100.0, # mm/s^2 |
134 |
| - max_speed_discont=40.0, # mm/s |
135 |
| - ), |
136 |
| - ), |
137 |
| - "move": AxisParams( |
138 |
| - run_current=1.2, |
139 |
| - hold_current=0.75, |
140 |
| - move_params=MoveParams( |
141 |
| - max_speed=200.0, |
142 |
| - acceleration=1500.0, |
143 |
| - max_speed_discont=40.0, |
144 |
| - ), |
145 |
| - ), |
146 |
| - }, |
147 |
| - StackerAxis.Z: { |
148 |
| - "home": AxisParams( |
149 |
| - run_current=1.5, |
150 |
| - hold_current=1.5, |
151 |
| - move_params=MoveParams( |
152 |
| - max_speed=10.0, |
153 |
| - acceleration=100.0, |
154 |
| - max_speed_discont=25.0, |
155 |
| - ), |
156 |
| - ), |
157 |
| - "move": AxisParams( |
158 |
| - run_current=1.5, |
159 |
| - hold_current=1.5, |
160 |
| - move_params=MoveParams( |
161 |
| - max_speed=150.0, |
162 |
| - acceleration=500.0, |
163 |
| - max_speed_discont=25.0, |
164 |
| - ), |
165 |
| - ), |
166 |
| - }, |
167 |
| - StackerAxis.L: { |
168 |
| - "home": AxisParams( |
169 |
| - run_current=1.2, |
170 |
| - hold_current=0.5, |
171 |
| - move_params=MoveParams( |
172 |
| - max_speed=100.0, |
173 |
| - acceleration=800.0, |
174 |
| - max_speed_discont=40.0, |
175 |
| - ), |
176 |
| - ), |
177 |
| - "move": AxisParams( |
178 |
| - run_current=1.2, |
179 |
| - hold_current=0.5, |
180 |
| - move_params=MoveParams( |
181 |
| - max_speed=100.0, |
182 |
| - acceleration=800.0, |
183 |
| - max_speed_discont=40.0, |
184 |
| - ), |
185 |
| - ), |
186 |
| - }, |
187 |
| -} |
188 | 87 |
|
189 | 88 | # Configs
|
190 | 89 | TOF_DETECTION_CONFIG = {
|
|
0 commit comments