diff --git a/Planner Simulation/Planner2/planner_v4.pde b/Planner Simulation/Planner2/planner_v4.pde index dae625d..1d53620 100644 --- a/Planner Simulation/Planner2/planner_v4.pde +++ b/Planner Simulation/Planner2/planner_v4.pde @@ -110,7 +110,7 @@ class Planner_v4 { if (status > 1 && millis() - tmr >= us/1000) { tmr = millis(); tickManual(); - + // ВЫВОД МАРШРУТА int vel = us==0 ? 0 : 1000000/us; int hue = int(map(vel, 0, V, 0, 70)); @@ -220,7 +220,10 @@ class Planner_v4 { bufS.set(i, s1); if (bufL.get(i + 1) == 1) break; - + if (a == 0) { + bufV.set(i + 1, int(V)); + continue; + } if (i < bufV.available() - 2) { int multSum = 0; diff --git a/src/GyverPlanner2.h b/src/GyverPlanner2.h index 767d979..3681270 100644 --- a/src/GyverPlanner2.h +++ b/src/GyverPlanner2.h @@ -307,8 +307,12 @@ class GPlanner2 { } uint32_t s1 = sqrt(sqSum); bufS.set(i, s1); - if (s1 == 0) continue; if (bufL.get(i + 1) == 1) break; + if (a == 0) { + bufV.set(i + 1, uint16_t(V)); + continue; + } + if (s1 == 0) continue; if (i < bufV.available() - 2) { int32_t multSum = 0;