|
|
@ -8587,7 +8587,7 @@ void prepare_move_to_destination() {
|
|
|
|
cartes[Y_AXIS] = a_sin + b_sin + SCARA_OFFSET_Y; //theta+phi
|
|
|
|
cartes[Y_AXIS] = a_sin + b_sin + SCARA_OFFSET_Y; //theta+phi
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
/*
|
|
|
|
SERIAL_ECHOPAIR("Angle a=", a);
|
|
|
|
SERIAL_ECHOPAIR("SCARA FK Angle a=", a);
|
|
|
|
SERIAL_ECHOPAIR(" b=", b);
|
|
|
|
SERIAL_ECHOPAIR(" b=", b);
|
|
|
|
SERIAL_ECHOPAIR(" a_sin=", a_sin);
|
|
|
|
SERIAL_ECHOPAIR(" a_sin=", a_sin);
|
|
|
|
SERIAL_ECHOPAIR(" a_cos=", a_cos);
|
|
|
|
SERIAL_ECHOPAIR(" a_cos=", a_cos);
|
|
|
|