大季 矢花 / Mbed 2 deprecated MB2019_main_ver3-lidar

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Diff: System/Process/Process.cpp

Revision:
40:461a08f581b6
Parent:
39:784552c26163
--- a/System/Process/Process.cpp	Tue Nov 05 08:38:32 2019 +0000
+++ b/System/Process/Process.cpp	Tue Nov 05 20:42:28 2019 +0000
@@ -279,7 +279,7 @@
             if(ZoneSW) {
                 countss=0;
                 mode=1;
-                current = 4;//10GATU30変更した
+                current = 3;//10GATU30変更した
 
             } else {
                 countss = 0;
@@ -1915,6 +1915,35 @@
 //Clearly 赤ゾーン
     LED::LED::TapeledMode(3);
     countss++;
+    if(mode==1) {
+        motor[TIRE_FR].pwm = fast;
+        motor[TIRE_FR].dir = BACK;
+        motor[TIRE_FL].pwm = fast;
+        motor[TIRE_FL].dir = FOR;
+        motor[TIRE_BR].pwm = fast;
+        motor[TIRE_BR].dir = BACK;
+        motor[TIRE_BL].pwm = fast;
+        motor[TIRE_BL].dir = FOR;
+        if(LIDAR) {
+            mode=2;
+        }
+    }
+    if(mode==2) {
+        motor[TIRE_FR].pwm = slow;
+        motor[TIRE_FR].dir = BACK;
+        motor[TIRE_FL].pwm = slow;
+        motor[TIRE_FL].dir = FOR;
+        motor[TIRE_BR].pwm = slow;
+        motor[TIRE_BR].dir = BACK;
+        motor[TIRE_BL].pwm = slow;
+        motor[TIRE_BL].dir = FOR;
+        if(g[2]==0) {
+            countss=0;
+            cross=0;
+            mode=20;
+        }
+    }
+    /*
     if(mode==1) {//スタートゾーンから白線検知
         fast=40;
         normal=30;
@@ -2092,7 +2121,9 @@
             cross=0;
             mode=20;
         }
-    } else if(mode==20) {
+    }
+    */
+    if(mode==20) {
         solenoid.solenoid4= SOLENOID_ON;
         switch(g[2]) {
             case 98: