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