Betago / Mbed 2 deprecated BETAGO

10/25/2015

Dependencies:   PID mbed MaxSonar eeprom iSerial Fork_Boss_Communication_Robot

UNTRASONIC.cpp@12:8a06a803e373, 2016-03-03 (annotated)

Committer:
palmdotax
Date:
Thu Mar 03 09:07:22 2016 +0000
Revision:
12:8a06a803e373
Parent:
11:9df7ada37d31 
LOL

Who changed what in which revision?

UserRevisionLine numberNew contents of line
palmdotax 9:86701fec3f79 1 #include "mbed.h"
palmdotax 9:86701fec3f79 2 #include "MaxSonar.h"
palmdotax 9:86701fec3f79 3 #include "UNTRASONIC.h"
palmdotax 10:4bc59f8bfa18 4 MaxSonar *range1;
palmdotax 10:4bc59f8bfa18 5 MaxSonar *range2;
palmdotax 10:4bc59f8bfa18 6 MaxSonar *range3;
palmdotax 10:4bc59f8bfa18 7 MaxSonar *range4;
palmdotax 10:4bc59f8bfa18 8 MaxSonar *range5;
palmdotax 10:4bc59f8bfa18 9 MaxSonar *range6;
palmdotax 10:4bc59f8bfa18 10 MaxSonar *range7;
palmdotax 10:4bc59f8bfa18 11 MaxSonar *range8;
palmdotax 10:4bc59f8bfa18 12 MaxSonar *range9;
palmdotax 10:4bc59f8bfa18 13 MaxSonar *range10;
palmdotax 9:86701fec3f79 14 sensor::sensor()
palmdotax 9:86701fec3f79 15 {
palmdotax 9:86701fec3f79 16 sen_1=0;
palmdotax 9:86701fec3f79 17 sen_2=0;
palmdotax 9:86701fec3f79 18 sen_3=0;
palmdotax 9:86701fec3f79 19 sen_4=0;
palmdotax 9:86701fec3f79 20 sen_5=0;
palmdotax 9:86701fec3f79 21 sen_6=0;
palmdotax 9:86701fec3f79 22 sen_7=0;
palmdotax 9:86701fec3f79 23 sen_8=0;
palmdotax 9:86701fec3f79 24 sen_9=0;
palmdotax 9:86701fec3f79 25 sen_10=0;
palmdotax 9:86701fec3f79 26
palmdotax 9:86701fec3f79 27
palmdotax 9:86701fec3f79 28 }
palmdotax 9:86701fec3f79 29 void sensor::get_sen()
palmdotax 9:86701fec3f79 30 {
palmdotax 10:4bc59f8bfa18 31 range1->triggerRead();
palmdotax 10:4bc59f8bfa18 32 sen_1 = range1->read();
palmdotax 11:9df7ada37d31 33 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 34 range2->triggerRead();
palmdotax 10:4bc59f8bfa18 35 sen_2 = range1->read();
palmdotax 11:9df7ada37d31 36 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 37 range3->triggerRead();
palmdotax 10:4bc59f8bfa18 38 sen_3 = range1->read();
palmdotax 11:9df7ada37d31 39 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 40 range4->triggerRead();
palmdotax 10:4bc59f8bfa18 41 sen_4 = range1->read();
palmdotax 11:9df7ada37d31 42 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 43 range5->triggerRead();
palmdotax 10:4bc59f8bfa18 44 sen_5 = range1->read();
palmdotax 11:9df7ada37d31 45 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 46 range6->triggerRead();
palmdotax 10:4bc59f8bfa18 47 sen_6 = range1->read();
palmdotax 11:9df7ada37d31 48 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 49 range7->triggerRead();
palmdotax 10:4bc59f8bfa18 50 sen_7 = range1->read();
palmdotax 11:9df7ada37d31 51 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 52 range8->triggerRead();
palmdotax 10:4bc59f8bfa18 53 sen_8 = range1->read();
palmdotax 11:9df7ada37d31 54 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 55 range9->triggerRead();
palmdotax 10:4bc59f8bfa18 56 sen_9 = range1->read();
palmdotax 11:9df7ada37d31 57 //ส่งค่sensor
palmdotax 10:4bc59f8bfa18 58 range10->triggerRead();
palmdotax 10:4bc59f8bfa18 59 sen_10 = range1->read();
palmdotax 11:9df7ada37d31 60 //ส่งค่sensor
palmdotax 9:86701fec3f79 61 }
palmdotax 9:86701fec3f79 62 void sensor::inti()
palmdotax 9:86701fec3f79 63 {
palmdotax 10:4bc59f8bfa18 64 //MaxSonar *range1;
palmdotax 11:9df7ada37d31 65 range1 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_0);
palmdotax 9:86701fec3f79 66 range1->setVoltage(3.3);
palmdotax 9:86701fec3f79 67 range1->setUnits(MS_CM);
palmdotax 9:86701fec3f79 68
palmdotax 10:4bc59f8bfa18 69 //MaxSonar *range2;
palmdotax 11:9df7ada37d31 70 range2 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_1);
palmdotax 9:86701fec3f79 71 range2->setVoltage(3.3);
palmdotax 9:86701fec3f79 72 range2->setUnits(MS_CM);
palmdotax 9:86701fec3f79 73
palmdotax 10:4bc59f8bfa18 74 // MaxSonar *range3;
palmdotax 11:9df7ada37d31 75 range3 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PA_4);
palmdotax 9:86701fec3f79 76 range3->setVoltage(3.3);
palmdotax 9:86701fec3f79 77 range3->setUnits(MS_CM);
palmdotax 9:86701fec3f79 78
palmdotax 10:4bc59f8bfa18 79 //MaxSonar *range4;
palmdotax 11:9df7ada37d31 80 range4 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PB_0);
palmdotax 9:86701fec3f79 81 range4->setVoltage(3.3);
palmdotax 9:86701fec3f79 82 range4->setUnits(MS_CM);
palmdotax 9:86701fec3f79 83
palmdotax 10:4bc59f8bfa18 84 //MaxSonar *range5;
palmdotax 11:9df7ada37d31 85 range5 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_1);
palmdotax 9:86701fec3f79 86 range5->setVoltage(3.3);
palmdotax 9:86701fec3f79 87 range5->setUnits(MS_CM);
palmdotax 9:86701fec3f79 88
palmdotax 10:4bc59f8bfa18 89 // MaxSonar *range6;
palmdotax 11:9df7ada37d31 90 range6 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_0);
palmdotax 9:86701fec3f79 91 range6->setVoltage(3.3);
palmdotax 9:86701fec3f79 92 range6->setUnits(MS_CM);
palmdotax 9:86701fec3f79 93
palmdotax 10:4bc59f8bfa18 94 //MaxSonar *range7;
palmdotax 11:9df7ada37d31 95 range7 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_2);
palmdotax 9:86701fec3f79 96 range7->setVoltage(3.3);
palmdotax 9:86701fec3f79 97 range7->setUnits(MS_CM);
palmdotax 9:86701fec3f79 98
palmdotax 10:4bc59f8bfa18 99 // MaxSonar *range8;
palmdotax 11:9df7ada37d31 100 range8 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_3);
palmdotax 9:86701fec3f79 101 range8->setVoltage(3.3);
palmdotax 9:86701fec3f79 102 range8->setUnits(MS_CM);
palmdotax 9:86701fec3f79 103
palmdotax 10:4bc59f8bfa18 104 // MaxSonar *range9;
palmdotax 11:9df7ada37d31 105 range9 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_4);
palmdotax 9:86701fec3f79 106 range9->setVoltage(3.3);
palmdotax 9:86701fec3f79 107 range9->setUnits(MS_CM);
palmdotax 9:86701fec3f79 108
palmdotax 10:4bc59f8bfa18 109 // MaxSonar *range10;
palmdotax 11:9df7ada37d31 110 range10 = new MaxSonar(MS_LV, MS_ANALOG, PC_7, PC_5);
palmdotax 9:86701fec3f79 111 range10->setVoltage(3.3);
palmdotax 9:86701fec3f79 112 range10->setUnits(MS_CM);
palmdotax 11:9df7ada37d31 113 }
palmdotax 11:9df7ada37d31 114 void sensor::readbat()
palmdotax 11:9df7ada37d31 115 {
palmdotax 9:86701fec3f79 116
palmdotax 9:86701fec3f79 117 }