Zhilin He / Mbed 2 deprecated TDPS-COM1

UNFINISHED

Dependencies:   HCSR04 SRF05 mbed

main.cpp

Committer:
Charlie_He
Date:
2018-06-08
Revision:
1:60c79e942c98
Parent:
0:4ca3e247b86a

File content as of revision 1:60c79e942c98:

#include "mbed.h"
#include "gyro.h"
#include "motor.h"
#include "colorsensor.h"

Serial Rasp(USBTX,USBRX);

Ticker tim;
Motor M1(p19,p20,p21);
Motor M2(p17,p18,p22);
void ddd()
{
   
    if(started == true)
    {
        tim.detach();
        
        M1=0.3;M2=0.3;  //直走识别色块
        wait(6.75);
        M1=-1;M2=1; //90度
        wait(0.75);
        M1=0;M2=0;
        
        Rasp.printf("8");
        Rasp.attach(&colorsensor, Rasp.RxIrq);  
        }
    }

int main()
{
    Rasp.baud(9600);
    init_gyro();
    tim.attach(&ddd,0.1);
    
}