|
@@ -2254,15 +2254,15 @@ void clamp_to_software_endstops(float target[3])
|
2254
|
2254
|
#ifdef DELTA
|
2255
|
2255
|
void calculate_delta(float cartesian[3])
|
2256
|
2256
|
{
|
2257
|
|
- delta[X_AXIS] = sqrt(sq(DELTA_DIAGONAL_ROD)
|
|
2257
|
+ delta[X_AXIS] = sqrt(DELTA_DIAGONAL_ROD_2
|
2258
|
2258
|
- sq(DELTA_TOWER1_X-cartesian[X_AXIS])
|
2259
|
2259
|
- sq(DELTA_TOWER1_Y-cartesian[Y_AXIS])
|
2260
|
2260
|
) + cartesian[Z_AXIS];
|
2261
|
|
- delta[Y_AXIS] = sqrt(sq(DELTA_DIAGONAL_ROD)
|
|
2261
|
+ delta[Y_AXIS] = sqrt(DELTA_DIAGONAL_ROD_2
|
2262
|
2262
|
- sq(DELTA_TOWER2_X-cartesian[X_AXIS])
|
2263
|
2263
|
- sq(DELTA_TOWER2_Y-cartesian[Y_AXIS])
|
2264
|
2264
|
) + cartesian[Z_AXIS];
|
2265
|
|
- delta[Z_AXIS] = sqrt(sq(DELTA_DIAGONAL_ROD)
|
|
2265
|
+ delta[Z_AXIS] = sqrt(DELTA_DIAGONAL_ROD_2
|
2266
|
2266
|
- sq(DELTA_TOWER3_X-cartesian[X_AXIS])
|
2267
|
2267
|
- sq(DELTA_TOWER3_Y-cartesian[Y_AXIS])
|
2268
|
2268
|
) + cartesian[Z_AXIS];
|