Ryu Kaz / Mbed OS 767zi

t6est

Dependencies:   Pulse

lim.md@4:9ba47e5db1e2, 2019-10-05 (annotated)

Committer:
kazuryu
Date:
Sat Oct 05 01:41:37 2019 +0000
Revision:
4:9ba47e5db1e2
Parent:
1:bbf776e6c792 
B

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kazuryu 1:bbf776e6c792 1 #include "mbed.h"
kazuryu 1:bbf776e6c792 2
kazuryu 1:bbf776e6c792 3 DigitalIn lim_left();
kazuryu 1:bbf776e6c792 4 DigitalIn lim_right();
kazuryu 1:bbf776e6c792 5
kazuryu 1:bbf776e6c792 6 int l_r = 0;
kazuryu 1:bbf776e6c792 7 int l_l = 0;
kazuryu 1:bbf776e6c792 8 bool finish_lim = false;
kazuryu 1:bbf776e6c792 9 int from_end = 0;
kazuryu 1:bbf776e6c792 10 int lim_color = 0;//0 = blue
kazuryu 1:bbf776e6c792 11 bool lim_flag = false;
kazuryu 1:bbf776e6c792 12 int distance = 0;
kazuryu 1:bbf776e6c792 13 double all = 0;
kazuryu 1:bbf776e6c792 14 l_r = lim_right.read();
kazuryu 1:bbf776e6c792 15 l_l = lim_left.read();
kazuryu 1:bbf776e6c792 16
kazuryu 1:bbf776e6c792 17 if(!finish_lim){
kazuryu 1:bbf776e6c792 18 if(l_r && l_l){
kazuryu 1:bbf776e6c792 19 finish_lim = true;
kazuryu 1:bbf776e6c792 20 all = 0;
kazuryu 1:bbf776e6c792 21 }else if(!l_r && l_l){
kazuryu 1:bbf776e6c792 22 Move2(LROLL,0.1f);
kazuryu 1:bbf776e6c792 23 }else if(l_r && !l_l){
kazuryu 1:bbf776e6c792 24 Move2(RROLL,0.1f);
kazuryu 1:bbf776e6c792 25 }else{
kazuryu 1:bbf776e6c792 26 Move2(UP,0.1f);
kazuryu 1:bbf776e6c792 27 }
kazuryu 1:bbf776e6c792 28 }else{
kazuryu 1:bbf776e6c792 29 //color選択の関数入れる
kazuryu 1:bbf776e6c792 30 if(!l_r && !l_l && !lim_flag){
kazuryu 1:bbf776e6c792 31 lim_flag = true;
kazuryu 1:bbf776e6c792 32 distance = C + from_end
kazuryu 1:bbf776e6c792 33 }
kazuryu 1:bbf776e6c792 34 }