upd

GyverLibs · Sep 18, 2021 · 225d17b · 225d17b
1 parent 71ee91f
commit 225d17b
Show file tree

Hide file tree

Showing 2 changed files with 10 additions and 3 deletions.
diff --git 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
@@ -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;