|
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