|
|
@ -1537,7 +1537,7 @@ void process_commands()
|
|
|
|
#ifdef SCARA
|
|
|
|
#ifdef SCARA
|
|
|
|
current_position[X_AXIS]=code_value();
|
|
|
|
current_position[X_AXIS]=code_value();
|
|
|
|
#else
|
|
|
|
#else
|
|
|
|
current_position[X_AXIS]=code_value()+add_homing[0];
|
|
|
|
current_position[X_AXIS]=code_value()+add_homing[X_AXIS];
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -1547,7 +1547,7 @@ void process_commands()
|
|
|
|
#ifdef SCARA
|
|
|
|
#ifdef SCARA
|
|
|
|
current_position[Y_AXIS]=code_value();
|
|
|
|
current_position[Y_AXIS]=code_value();
|
|
|
|
#else
|
|
|
|
#else
|
|
|
|
current_position[Y_AXIS]=code_value()+add_homing[1];
|
|
|
|
current_position[Y_AXIS]=code_value()+add_homing[Y_AXIS];
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -1612,7 +1612,7 @@ void process_commands()
|
|
|
|
|
|
|
|
|
|
|
|
if(code_seen(axis_codes[Z_AXIS])) {
|
|
|
|
if(code_seen(axis_codes[Z_AXIS])) {
|
|
|
|
if(code_value_long() != 0) {
|
|
|
|
if(code_value_long() != 0) {
|
|
|
|
current_position[Z_AXIS]=code_value()+add_homing[2];
|
|
|
|
current_position[Z_AXIS]=code_value()+add_homing[Z_AXIS];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#ifdef ENABLE_AUTO_BED_LEVELING
|
|
|
|
#ifdef ENABLE_AUTO_BED_LEVELING
|
|
|
@ -2745,9 +2745,9 @@ Sigma_Exit:
|
|
|
|
SERIAL_PROTOCOLLN("");
|
|
|
|
SERIAL_PROTOCOLLN("");
|
|
|
|
|
|
|
|
|
|
|
|
SERIAL_PROTOCOLPGM("SCARA Cal - Theta:");
|
|
|
|
SERIAL_PROTOCOLPGM("SCARA Cal - Theta:");
|
|
|
|
SERIAL_PROTOCOL(delta[X_AXIS]+add_homing[0]);
|
|
|
|
SERIAL_PROTOCOL(delta[X_AXIS]+add_homing[X_AXIS]);
|
|
|
|
SERIAL_PROTOCOLPGM(" Psi+Theta (90):");
|
|
|
|
SERIAL_PROTOCOLPGM(" Psi+Theta (90):");
|
|
|
|
SERIAL_PROTOCOL(delta[Y_AXIS]-delta[X_AXIS]-90+add_homing[1]);
|
|
|
|
SERIAL_PROTOCOL(delta[Y_AXIS]-delta[X_AXIS]-90+add_homing[Y_AXIS]);
|
|
|
|
SERIAL_PROTOCOLLN("");
|
|
|
|
SERIAL_PROTOCOLLN("");
|
|
|
|
|
|
|
|
|
|
|
|
SERIAL_PROTOCOLPGM("SCARA step Cal - Theta:");
|
|
|
|
SERIAL_PROTOCOLPGM("SCARA step Cal - Theta:");
|
|
|
@ -2883,11 +2883,11 @@ Sigma_Exit:
|
|
|
|
#ifdef SCARA
|
|
|
|
#ifdef SCARA
|
|
|
|
if(code_seen('T')) // Theta
|
|
|
|
if(code_seen('T')) // Theta
|
|
|
|
{
|
|
|
|
{
|
|
|
|
add_homing[0] = code_value() ;
|
|
|
|
add_homing[X_AXIS] = code_value() ;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if(code_seen('P')) // Psi
|
|
|
|
if(code_seen('P')) // Psi
|
|
|
|
{
|
|
|
|
{
|
|
|
|
add_homing[1] = code_value() ;
|
|
|
|
add_homing[Y_AXIS] = code_value() ;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
break;
|
|
|
|
break;
|
|
|
@ -3275,11 +3275,11 @@ Sigma_Exit:
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
if(Stopped == false) {
|
|
|
|
if(Stopped == false) {
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
delta[0] = 0;
|
|
|
|
delta[X_AXIS] = 0;
|
|
|
|
delta[1] = 120;
|
|
|
|
delta[Y_AXIS] = 120;
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
destination[0] = delta[0]/axis_scaling[X_AXIS];
|
|
|
|
destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
|
|
destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
|
|
destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
|
|
|
|
|
|
|
|
|
|
|
prepare_move();
|
|
|
|
prepare_move();
|
|
|
|
//ClearToSend();
|
|
|
|
//ClearToSend();
|
|
|
@ -3293,11 +3293,11 @@ Sigma_Exit:
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
if(Stopped == false) {
|
|
|
|
if(Stopped == false) {
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
delta[0] = 90;
|
|
|
|
delta[X_AXIS] = 90;
|
|
|
|
delta[1] = 130;
|
|
|
|
delta[Y_AXIS] = 130;
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
destination[0] = delta[0]/axis_scaling[X_AXIS];
|
|
|
|
destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
|
|
destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
|
|
destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
|
|
|
|
|
|
|
|
|
|
|
prepare_move();
|
|
|
|
prepare_move();
|
|
|
|
//ClearToSend();
|
|
|
|
//ClearToSend();
|
|
|
@ -3310,11 +3310,11 @@ Sigma_Exit:
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
if(Stopped == false) {
|
|
|
|
if(Stopped == false) {
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
delta[0] = 60;
|
|
|
|
delta[X_AXIS] = 60;
|
|
|
|
delta[1] = 180;
|
|
|
|
delta[Y_AXIS] = 180;
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
destination[0] = delta[0]/axis_scaling[X_AXIS];
|
|
|
|
destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
|
|
destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
|
|
destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
|
|
|
|
|
|
|
|
|
|
|
prepare_move();
|
|
|
|
prepare_move();
|
|
|
|
//ClearToSend();
|
|
|
|
//ClearToSend();
|
|
|
@ -3327,11 +3327,11 @@ Sigma_Exit:
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
if(Stopped == false) {
|
|
|
|
if(Stopped == false) {
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
delta[0] = 50;
|
|
|
|
delta[X_AXIS] = 50;
|
|
|
|
delta[1] = 90;
|
|
|
|
delta[Y_AXIS] = 90;
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
destination[0] = delta[0]/axis_scaling[X_AXIS];
|
|
|
|
destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
|
|
destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
|
|
destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
|
|
|
|
|
|
|
|
|
|
|
prepare_move();
|
|
|
|
prepare_move();
|
|
|
|
//ClearToSend();
|
|
|
|
//ClearToSend();
|
|
|
@ -3344,11 +3344,11 @@ Sigma_Exit:
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
if(Stopped == false) {
|
|
|
|
if(Stopped == false) {
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
delta[0] = 45;
|
|
|
|
delta[X_AXIS] = 45;
|
|
|
|
delta[1] = 135;
|
|
|
|
delta[Y_AXIS] = 135;
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
calculate_SCARA_forward_Transform(delta);
|
|
|
|
destination[0] = delta[0]/axis_scaling[X_AXIS];
|
|
|
|
destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
|
|
destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
|
|
destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
|
|
|
|
|
|
|
|
|
|
|
prepare_move();
|
|
|
|
prepare_move();
|
|
|
|
//ClearToSend();
|
|
|
|
//ClearToSend();
|
|
|
@ -4020,9 +4020,9 @@ for (int s = 1; s <= steps; s++) {
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
calculate_delta(destination);
|
|
|
|
calculate_delta(destination);
|
|
|
|
//SERIAL_ECHOPGM("destination[0]="); SERIAL_ECHOLN(destination[0]);
|
|
|
|
//SERIAL_ECHOPGM("destination[X_AXIS]="); SERIAL_ECHOLN(destination[X_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("destination[1]="); SERIAL_ECHOLN(destination[1]);
|
|
|
|
//SERIAL_ECHOPGM("destination[Y_AXIS]="); SERIAL_ECHOLN(destination[Y_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("destination[2]="); SERIAL_ECHOLN(destination[2]);
|
|
|
|
//SERIAL_ECHOPGM("destination[Z_AXIS]="); SERIAL_ECHOLN(destination[Z_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("delta[X_AXIS]="); SERIAL_ECHOLN(delta[X_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("delta[X_AXIS]="); SERIAL_ECHOLN(delta[X_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("delta[Y_AXIS]="); SERIAL_ECHOLN(delta[Y_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("delta[Y_AXIS]="); SERIAL_ECHOLN(delta[Y_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("delta[Z_AXIS]="); SERIAL_ECHOLN(delta[Z_AXIS]);
|
|
|
|
//SERIAL_ECHOPGM("delta[Z_AXIS]="); SERIAL_ECHOLN(delta[Z_AXIS]);
|
|
|
|