|
@@ -1537,7 +1537,7 @@ void process_commands()
|
1537
|
1537
|
#ifdef SCARA
|
1538
|
1538
|
current_position[X_AXIS]=code_value();
|
1539
|
1539
|
#else
|
1540
|
|
- current_position[X_AXIS]=code_value()+add_homing[0];
|
|
1540
|
+ current_position[X_AXIS]=code_value()+add_homing[X_AXIS];
|
1541
|
1541
|
#endif
|
1542
|
1542
|
}
|
1543
|
1543
|
}
|
|
@@ -1547,7 +1547,7 @@ void process_commands()
|
1547
|
1547
|
#ifdef SCARA
|
1548
|
1548
|
current_position[Y_AXIS]=code_value();
|
1549
|
1549
|
#else
|
1550
|
|
- current_position[Y_AXIS]=code_value()+add_homing[1];
|
|
1550
|
+ current_position[Y_AXIS]=code_value()+add_homing[Y_AXIS];
|
1551
|
1551
|
#endif
|
1552
|
1552
|
}
|
1553
|
1553
|
}
|
|
@@ -1612,7 +1612,7 @@ void process_commands()
|
1612
|
1612
|
|
1613
|
1613
|
if(code_seen(axis_codes[Z_AXIS])) {
|
1614
|
1614
|
if(code_value_long() != 0) {
|
1615
|
|
- current_position[Z_AXIS]=code_value()+add_homing[2];
|
|
1615
|
+ current_position[Z_AXIS]=code_value()+add_homing[Z_AXIS];
|
1616
|
1616
|
}
|
1617
|
1617
|
}
|
1618
|
1618
|
#ifdef ENABLE_AUTO_BED_LEVELING
|
|
@@ -2745,9 +2745,9 @@ Sigma_Exit:
|
2745
|
2745
|
SERIAL_PROTOCOLLN("");
|
2746
|
2746
|
|
2747
|
2747
|
SERIAL_PROTOCOLPGM("SCARA Cal - Theta:");
|
2748
|
|
- SERIAL_PROTOCOL(delta[X_AXIS]+add_homing[0]);
|
|
2748
|
+ SERIAL_PROTOCOL(delta[X_AXIS]+add_homing[X_AXIS]);
|
2749
|
2749
|
SERIAL_PROTOCOLPGM(" Psi+Theta (90):");
|
2750
|
|
- SERIAL_PROTOCOL(delta[Y_AXIS]-delta[X_AXIS]-90+add_homing[1]);
|
|
2750
|
+ SERIAL_PROTOCOL(delta[Y_AXIS]-delta[X_AXIS]-90+add_homing[Y_AXIS]);
|
2751
|
2751
|
SERIAL_PROTOCOLLN("");
|
2752
|
2752
|
|
2753
|
2753
|
SERIAL_PROTOCOLPGM("SCARA step Cal - Theta:");
|
|
@@ -2883,11 +2883,11 @@ Sigma_Exit:
|
2883
|
2883
|
#ifdef SCARA
|
2884
|
2884
|
if(code_seen('T')) // Theta
|
2885
|
2885
|
{
|
2886
|
|
- add_homing[0] = code_value() ;
|
|
2886
|
+ add_homing[X_AXIS] = code_value() ;
|
2887
|
2887
|
}
|
2888
|
2888
|
if(code_seen('P')) // Psi
|
2889
|
2889
|
{
|
2890
|
|
- add_homing[1] = code_value() ;
|
|
2890
|
+ add_homing[Y_AXIS] = code_value() ;
|
2891
|
2891
|
}
|
2892
|
2892
|
#endif
|
2893
|
2893
|
break;
|
|
@@ -3275,11 +3275,11 @@ Sigma_Exit:
|
3275
|
3275
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
3276
|
3276
|
if(Stopped == false) {
|
3277
|
3277
|
//get_coordinates(); // For X Y Z E F
|
3278
|
|
- delta[0] = 0;
|
3279
|
|
- delta[1] = 120;
|
|
3278
|
+ delta[X_AXIS] = 0;
|
|
3279
|
+ delta[Y_AXIS] = 120;
|
3280
|
3280
|
calculate_SCARA_forward_Transform(delta);
|
3281
|
|
- destination[0] = delta[0]/axis_scaling[X_AXIS];
|
3282
|
|
- destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
3281
|
+ destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
3282
|
+ destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
3283
|
3283
|
|
3284
|
3284
|
prepare_move();
|
3285
|
3285
|
//ClearToSend();
|
|
@@ -3293,11 +3293,11 @@ Sigma_Exit:
|
3293
|
3293
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
3294
|
3294
|
if(Stopped == false) {
|
3295
|
3295
|
//get_coordinates(); // For X Y Z E F
|
3296
|
|
- delta[0] = 90;
|
3297
|
|
- delta[1] = 130;
|
|
3296
|
+ delta[X_AXIS] = 90;
|
|
3297
|
+ delta[Y_AXIS] = 130;
|
3298
|
3298
|
calculate_SCARA_forward_Transform(delta);
|
3299
|
|
- destination[0] = delta[0]/axis_scaling[X_AXIS];
|
3300
|
|
- destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
3299
|
+ destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
3300
|
+ destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
3301
|
3301
|
|
3302
|
3302
|
prepare_move();
|
3303
|
3303
|
//ClearToSend();
|
|
@@ -3310,11 +3310,11 @@ Sigma_Exit:
|
3310
|
3310
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
3311
|
3311
|
if(Stopped == false) {
|
3312
|
3312
|
//get_coordinates(); // For X Y Z E F
|
3313
|
|
- delta[0] = 60;
|
3314
|
|
- delta[1] = 180;
|
|
3313
|
+ delta[X_AXIS] = 60;
|
|
3314
|
+ delta[Y_AXIS] = 180;
|
3315
|
3315
|
calculate_SCARA_forward_Transform(delta);
|
3316
|
|
- destination[0] = delta[0]/axis_scaling[X_AXIS];
|
3317
|
|
- destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
3316
|
+ destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
3317
|
+ destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
3318
|
3318
|
|
3319
|
3319
|
prepare_move();
|
3320
|
3320
|
//ClearToSend();
|
|
@@ -3327,11 +3327,11 @@ Sigma_Exit:
|
3327
|
3327
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
3328
|
3328
|
if(Stopped == false) {
|
3329
|
3329
|
//get_coordinates(); // For X Y Z E F
|
3330
|
|
- delta[0] = 50;
|
3331
|
|
- delta[1] = 90;
|
|
3330
|
+ delta[X_AXIS] = 50;
|
|
3331
|
+ delta[Y_AXIS] = 90;
|
3332
|
3332
|
calculate_SCARA_forward_Transform(delta);
|
3333
|
|
- destination[0] = delta[0]/axis_scaling[X_AXIS];
|
3334
|
|
- destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
3333
|
+ destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
3334
|
+ destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
3335
|
3335
|
|
3336
|
3336
|
prepare_move();
|
3337
|
3337
|
//ClearToSend();
|
|
@@ -3344,11 +3344,11 @@ Sigma_Exit:
|
3344
|
3344
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
3345
|
3345
|
if(Stopped == false) {
|
3346
|
3346
|
//get_coordinates(); // For X Y Z E F
|
3347
|
|
- delta[0] = 45;
|
3348
|
|
- delta[1] = 135;
|
|
3347
|
+ delta[X_AXIS] = 45;
|
|
3348
|
+ delta[Y_AXIS] = 135;
|
3349
|
3349
|
calculate_SCARA_forward_Transform(delta);
|
3350
|
|
- destination[0] = delta[0]/axis_scaling[X_AXIS];
|
3351
|
|
- destination[1] = delta[1]/axis_scaling[Y_AXIS];
|
|
3350
|
+ destination[X_AXIS] = delta[X_AXIS]/axis_scaling[X_AXIS];
|
|
3351
|
+ destination[Y_AXIS] = delta[Y_AXIS]/axis_scaling[Y_AXIS];
|
3352
|
3352
|
|
3353
|
3353
|
prepare_move();
|
3354
|
3354
|
//ClearToSend();
|
|
@@ -4020,9 +4020,9 @@ for (int s = 1; s <= steps; s++) {
|
4020
|
4020
|
|
4021
|
4021
|
|
4022
|
4022
|
calculate_delta(destination);
|
4023
|
|
- //SERIAL_ECHOPGM("destination[0]="); SERIAL_ECHOLN(destination[0]);
|
4024
|
|
- //SERIAL_ECHOPGM("destination[1]="); SERIAL_ECHOLN(destination[1]);
|
4025
|
|
- //SERIAL_ECHOPGM("destination[2]="); SERIAL_ECHOLN(destination[2]);
|
|
4023
|
+ //SERIAL_ECHOPGM("destination[X_AXIS]="); SERIAL_ECHOLN(destination[X_AXIS]);
|
|
4024
|
+ //SERIAL_ECHOPGM("destination[Y_AXIS]="); SERIAL_ECHOLN(destination[Y_AXIS]);
|
|
4025
|
+ //SERIAL_ECHOPGM("destination[Z_AXIS]="); SERIAL_ECHOLN(destination[Z_AXIS]);
|
4026
|
4026
|
//SERIAL_ECHOPGM("delta[X_AXIS]="); SERIAL_ECHOLN(delta[X_AXIS]);
|
4027
|
4027
|
//SERIAL_ECHOPGM("delta[Y_AXIS]="); SERIAL_ECHOLN(delta[Y_AXIS]);
|
4028
|
4028
|
//SERIAL_ECHOPGM("delta[Z_AXIS]="); SERIAL_ECHOLN(delta[Z_AXIS]);
|