|
|
@ -32,10 +32,7 @@
|
|
|
|
inline bool SCARA_move_to_cal(const uint8_t delta_a, const uint8_t delta_b) {
|
|
|
|
inline bool SCARA_move_to_cal(const uint8_t delta_a, const uint8_t delta_b) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
forward_kinematics_SCARA(delta_a, delta_b);
|
|
|
|
forward_kinematics_SCARA(delta_a, delta_b);
|
|
|
|
destination[X_AXIS] = cartes[X_AXIS];
|
|
|
|
do_blocking_move_to_xy(cartes[X_AXIS], cartes[Y_AXIS]);
|
|
|
|
destination[Y_AXIS] = cartes[Y_AXIS];
|
|
|
|
|
|
|
|
destination[Z_AXIS] = current_position[Z_AXIS];
|
|
|
|
|
|
|
|
prepare_move_to_destination();
|
|
|
|
|
|
|
|
return true;
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return false;
|
|
|
|
return false;
|
|
|
|