10/25/2015

Dependencies:   PID mbed MaxSonar eeprom iSerial Fork_Boss_Communication_Robot

Revision:
10:4bc59f8bfa18
Parent:
9:86701fec3f79
Child:
11:9df7ada37d31
--- a/UNTRASONIC.cpp	Sun Jan 17 20:34:12 2016 +0000
+++ b/UNTRASONIC.cpp	Sun Jan 17 21:28:54 2016 +0000
@@ -1,6 +1,16 @@
 #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;
@@ -18,57 +28,85 @@
 }
 void sensor::get_sen()
 {
+    range1->triggerRead();
+    sen_1 = range1->read();
     
+    range2->triggerRead();
+    sen_2 = range1->read();
+    
+    range3->triggerRead();
+    sen_3 = range1->read();
+    
+    range4->triggerRead();
+    sen_4 = range1->read();
+    
+    range5->triggerRead();
+    sen_5 = range1->read();
+    
+    range6->triggerRead();
+    sen_6 = range1->read();
+    
+    range7->triggerRead();
+    sen_7 = range1->read();
+    
+    range8->triggerRead();
+    sen_8 = range1->read();
+    
+    range9->triggerRead();
+    sen_9 = range1->read();
+    
+    range10->triggerRead();
+    sen_10 = range1->read();
     
 }
 void sensor::inti()
 {
-    MaxSonar *range1;
+    //MaxSonar *range1;
     range1 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PA_0);
     range1->setVoltage(3.3);
     range1->setUnits(MS_CM);
     
-    MaxSonar *range2;
+    //MaxSonar *range2;
     range2 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PA_1);
     range2->setVoltage(3.3);
     range2->setUnits(MS_CM);
     
-    MaxSonar *range3;
+   // MaxSonar *range3;
     range3 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PA_4);
     range3->setVoltage(3.3);
     range3->setUnits(MS_CM);
     
-    MaxSonar *range4;
+    //MaxSonar *range4;
     range4 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PB_0);
     range4->setVoltage(3.3);
     range4->setUnits(MS_CM);
     
-    MaxSonar *range5;
+    //MaxSonar *range5;
     range5 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PC_1);
     range5->setVoltage(3.3);
     range5->setUnits(MS_CM);
     
-    MaxSonar *range6;
+   // MaxSonar *range6;
     range6 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PC_0);
     range6->setVoltage(3.3);
     range6->setUnits(MS_CM);
     
-    MaxSonar *range7;
+    //MaxSonar *range7;
     range7 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PC_2);
     range7->setVoltage(3.3);
     range7->setUnits(MS_CM);
     
-    MaxSonar *range8;
+   // MaxSonar *range8;
     range8 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PC_3);
     range8->setVoltage(3.3);
     range8->setUnits(MS_CM);
     
-    MaxSonar *range9;
+   // MaxSonar *range9;
     range9 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PC_4);
     range9->setVoltage(3.3);
     range9->setUnits(MS_CM);
     
-    MaxSonar *range10;
+   // MaxSonar *range10;
     range10 = new MaxSonar(MS_LV, MS_ANALOG, PA_10, PC_5);
     range10->setVoltage(3.3);
     range10->setUnits(MS_CM);