|
@@ -2304,7 +2304,7 @@ bool Planner::_populate_block(block_t * const block, bool split_move,
|
2304
|
2304
|
const float junction_acceleration = limit_value_by_axis_maximum(block->acceleration, junction_unit_vec),
|
2305
|
2305
|
sin_theta_d2 = SQRT(0.5f * (1.0f - junction_cos_theta)); // Trig half angle identity. Always positive.
|
2306
|
2306
|
|
2307
|
|
- vmax_junction_sqr = JUNC_SQ(junction_acceleration, sin_theta_d2);
|
|
2307
|
+ vmax_junction_sqr = junction_acceleration * junction_deviation_mm * sin_theta_d2 / (1.0f - sin_theta_d2);
|
2308
|
2308
|
|
2309
|
2309
|
if (block->millimeters < 1) {
|
2310
|
2310
|
const float neg = junction_cos_theta < 0 ? -1 : 1,
|
|
@@ -2340,8 +2340,8 @@ bool Planner::_populate_block(block_t * const block, bool split_move,
|
2340
|
2340
|
* for (float t = 0; t <= 1; t += 0.0003f) {
|
2341
|
2341
|
* const float e = acos(t) / approx(t);
|
2342
|
2342
|
* if (isfinite(e)) {
|
2343
|
|
- * NOMORE(min, e);
|
2344
|
|
- * NOLESS(max, e);
|
|
2343
|
+ * if (e < min) min = e;
|
|
2344
|
+ * if (e > max) max = e;
|
2345
|
2345
|
* }
|
2346
|
2346
|
* }
|
2347
|
2347
|
* fprintf(stderr, "%.9gf, ", (min + max) / 2);
|