|
@@ -204,7 +204,7 @@ float segments_per_second = TERN(AXEL_TPARA, TPARA_SEGMENTS_PER_SECOND, SCARA_SE
|
204
|
204
|
y = r * sin(RADIANS(a)),
|
205
|
205
|
rho2 = L1_2 + L2_2 - 2.0f * L1 * L2 * cos(RADIANS(w));
|
206
|
206
|
|
207
|
|
- cartes = robot_offset + xyz_pos_t({ x, y, SQRT(rho2 - x * x - y * y) });
|
|
207
|
+ cartes = robot_offset + xyz_pos_t({ x, y, SQRT(rho2 - sq(x) - sq(y)) });
|
208
|
208
|
}
|
209
|
209
|
|
210
|
210
|
// Home YZ together, then X (or all at once). Based on quick_home_xy & home_delta
|