cansat_B 2019 / Mbed 2 deprecated US015sb612Completed_renewal

Dependencies:   mbed

main.cpp

Committer:
YUPPY
Date:
2019-11-27
Revision:
2:d3675b786834
Parent:
1:d174c4427e69
Child:
3:f7f92004d3ac

File content as of revision 2:d3675b786834:

#include "mbed.h"
#include "us015.h"
DigitalOut myled(LED1);
US015 hs(p12,p11);
DigitalOut thermo(p20);
DigitalOut Ultra(p12);
Serial pc(USBTX,USBRX); // tx, rx

int main(){
  float th;
  Timer tm;
  pc.printf("start\r\n");
  thermo=0; //焦電off
  printf("焦電Off\r\n");
  Ultra=1;//超音波on
  printf("超音波On\r\n");
   
    while(1) {
         hs.TrigerOut();
         wait(1);
         int distance;
         distance = hs.GetDistance();
         printf("distance=%d\r\n",distance);//距離出力
        
        if(distance<=2000){//超音波反応
         Ultra=0;//超音波off

         thermo=1;//焦電on
          bool detected=false;
          if(true){
             th = thermo;
             if(th=1 && !detected) {//焦電反応ありの場合
               detected=true;
             pc.printf("human\r\n");
             tm.reset();
             tm.start();
            }
            else if(tm.read_ms()>5000){//焦電反応なしの場合
             printf("not found\r\n");
             detected=false;
             }
           
          }
        }if(distance>2000){//超音波反応遠い
        printf("distance>2000だぞ\r\n");
        }
  //if(true)
  }
 
  
   return 0;
}