10/25/2015
Dependencies: PID mbed MaxSonar eeprom iSerial Fork_Boss_Communication_Robot
UNTRASONIC.cpp@11:9df7ada37d31, 2016-03-02 (annotated)
- Committer:
- palmdotax
- Date:
- Wed Mar 02 23:10:18 2016 +0000
- Revision:
- 11:9df7ada37d31
- Parent:
- 10:4bc59f8bfa18
3-3-2016
Who changed what in which revision?
User | Revision | Line number | New 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 | } |