UNTRASONIC.cpp

00001 #include "mbed.h"
00002 #include "MaxSonar.h"
00003 #include "UNTRASONIC.h"
00004 MaxSonar *range1;
00005 MaxSonar *range2;
00006 MaxSonar *range3;
00007 MaxSonar *range4;
00008 MaxSonar *range5;
00009 MaxSonar *range6;
00010 MaxSonar *range7;
00011 MaxSonar *range8;
00012 MaxSonar *range9;
00013 MaxSonar *range10;
00014 sensor::sensor()
00015 {
00016     sen_1=0;
00017     sen_2=0;
00018     sen_3=0;
00019     sen_4=0;
00020     sen_5=0;
00021     sen_6=0;
00022     sen_7=0;
00023     sen_8=0;
00024     sen_9=0;
00025     sen_10=0;
00026     
00027     
00028 }
00029 void sensor::get_sen()
00030 {
00031     range1->triggerRead();
00032     sen_1 = range1->read();
00033     //ส่งค่sensor
00034     range2->triggerRead();
00035     sen_2 = range1->read();
00036      //ส่งค่sensor
00037     range3->triggerRead();
00038     sen_3 = range1->read();
00039      //ส่งค่sensor
00040     range4->triggerRead();
00041     sen_4 = range1->read();
00042      //ส่งค่sensor
00043     range5->triggerRead();
00044     sen_5 = range1->read();
00045      //ส่งค่sensor
00046     range6->triggerRead();
00047     sen_6 = range1->read();
00048      //ส่งค่sensor
00049     range7->triggerRead();
00050     sen_7 = range1->read();
00051      //ส่งค่sensor
00052     range8->triggerRead();
00053     sen_8 = range1->read();
00054      //ส่งค่sensor
00055     range9->triggerRead();
00056     sen_9 = range1->read();
00057      //ส่งค่sensor
00058     range10->triggerRead();
00059     sen_10 = range1->read();
00060      //ส่งค่sensor
00061 }
00062 void sensor::inti()
00063 {
00064     //MaxSonar *range1;
00065     range1 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_0);
00066     range1->setVoltage(3.3);
00067     range1->setUnits(MS_CM);
00068     
00069     //MaxSonar *range2;
00070     range2 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_1);
00071     range2->setVoltage(3.3);
00072     range2->setUnits(MS_CM);
00073     
00074    // MaxSonar *range3;
00075     range3 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_4);
00076     range3->setVoltage(3.3);
00077     range3->setUnits(MS_CM);
00078     
00079     //MaxSonar *range4;
00080     range4 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PB_0);
00081     range4->setVoltage(3.3);
00082     range4->setUnits(MS_CM);
00083     
00084     //MaxSonar *range5;
00085     range5 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_1);
00086     range5->setVoltage(3.3);
00087     range5->setUnits(MS_CM);
00088     
00089    // MaxSonar *range6;
00090     range6 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_0);
00091     range6->setVoltage(3.3);
00092     range6->setUnits(MS_CM);
00093     
00094     //MaxSonar *range7;
00095     range7 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_2);
00096     range7->setVoltage(3.3);
00097     range7->setUnits(MS_CM);
00098     
00099    // MaxSonar *range8;
00100     range8 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_3);
00101     range8->setVoltage(3.3);
00102     range8->setUnits(MS_CM);
00103     
00104    // MaxSonar *range9;
00105     range9 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_4);
00106     range9->setVoltage(3.3);
00107     range9->setUnits(MS_CM);
00108     
00109    // MaxSonar *range10;
00110     range10 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_5);
00111     range10->setVoltage(3.3);
00112     range10->setUnits(MS_CM);
00113 }
00114 void sensor::readbat()
00115 {
00116     
00117 }