55+

Dependencies:   BEAR_Protocol_Edited BufferedSerial Debug MaxSonar PID Process QEI UI iSerial mbed

Fork of CleaningMachine_Betago by Betago

UNTRASONIC.cpp

Committer:
palmdotax
Date:
2016-05-24
Revision:
3:edaab92dbd2f
Parent:
1:45f1573d65a1

File content as of revision 3:edaab92dbd2f:

#include "mbed.h"
#include "MaxSonar.h"
#include "UNTRASONIC.h"
MaxSonar *range1;
MaxSonar *range2;
MaxSonar *range3;
MaxSonar *range4;
MaxSonar *range5;
MaxSonar *range6;
MaxSonar *range7;
MaxSonar *range8;
MaxSonar *range9;
MaxSonar *range10;
sensor::sensor()
{
    sen_1=0;
    sen_2=0;
    sen_3=0;
    sen_4=0;
    sen_5=0;
    sen_6=0;
    sen_7=0;
    sen_8=0;
    sen_9=0;
    sen_10=0;
    
    
}
void sensor::get_sen()
{
    range1->triggerRead();
    sen_1 = range1->read();
    //ส่งค่sensor
    range2->triggerRead();
    sen_2 = range1->read();
     //ส่งค่sensor
    range3->triggerRead();
    sen_3 = range1->read();
     //ส่งค่sensor
    range4->triggerRead();
    sen_4 = range1->read();
     //ส่งค่sensor
    range5->triggerRead();
    sen_5 = range1->read();
     //ส่งค่sensor
    range6->triggerRead();
    sen_6 = range1->read();
     //ส่งค่sensor
    range7->triggerRead();
    sen_7 = range1->read();
     //ส่งค่sensor
    range8->triggerRead();
    sen_8 = range1->read();
     //ส่งค่sensor
    range9->triggerRead();
    sen_9 = range1->read();
     //ส่งค่sensor
    range10->triggerRead();
    sen_10 = range1->read();
     //ส่งค่sensor
}
void sensor::inti()
{
    //MaxSonar *range1;
    range1 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_0);
    range1->setVoltage(3.3);
    range1->setUnits(MS_CM);
    
    //MaxSonar *range2;
    range2 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_1);
    range2->setVoltage(3.3);
    range2->setUnits(MS_CM);
    
   // MaxSonar *range3;
    range3 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_4);
    range3->setVoltage(3.3);
    range3->setUnits(MS_CM);
    
    //MaxSonar *range4;
    range4 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PB_0);
    range4->setVoltage(3.3);
    range4->setUnits(MS_CM);
    
    //MaxSonar *range5;
    range5 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_1);
    range5->setVoltage(3.3);
    range5->setUnits(MS_CM);
    
   // MaxSonar *range6;
    range6 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_0);
    range6->setVoltage(3.3);
    range6->setUnits(MS_CM);
    
    //MaxSonar *range7;
    range7 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_2);
    range7->setVoltage(3.3);
    range7->setUnits(MS_CM);
    
   // MaxSonar *range8;
    range8 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_3);
    range8->setVoltage(3.3);
    range8->setUnits(MS_CM);
    
   // MaxSonar *range9;
    range9 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_4);
    range9->setVoltage(3.3);
    range9->setUnits(MS_CM);
    
   // MaxSonar *range10;
    range10 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_5);
    range10->setVoltage(3.3);
    range10->setUnits(MS_CM);
}
void sensor::readbat()
{
    
}