![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
tes ir atas semua
Dependencies: mbed ADS1115 StepperMotor SRF05 TPA81new
main.cpp@13:0c5942931cad, 2019-01-04 (annotated)
- Committer:
- hisyamfs
- Date:
- Fri Jan 04 11:58:19 2019 +0000
- Revision:
- 13:0c5942931cad
- Parent:
- 12:1e3227a6fcd7
- Child:
- 14:207770fefedf
Test terakhir, 17 des 2018
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
hisyamfs | 12:1e3227a6fcd7 | 1 | #include "mbed.h" |
hisyamfs | 12:1e3227a6fcd7 | 2 | #include "Stepper.h" |
hisyamfs | 12:1e3227a6fcd7 | 3 | #include "AX12.h" |
hisyamfs | 12:1e3227a6fcd7 | 4 | #include "Uvtron.h" |
hisyamfs | 12:1e3227a6fcd7 | 5 | #include "TPA81new.h" |
hisyamfs | 13:0c5942931cad | 6 | #include "SRF05.h" |
Ezeuz | 4:9932af380e56 | 7 | |
hisyamfs | 12:1e3227a6fcd7 | 8 | #define WAIT_TIME 0.02 |
Ezeuz | 6:69c59bcab6ea | 9 | |
hisyamfs | 12:1e3227a6fcd7 | 10 | Serial pc(USBTX, USBRX); |
hisyamfs | 13:0c5942931cad | 11 | AnalogIn IR(PA_0); |
hisyamfs | 12:1e3227a6fcd7 | 12 | // stepper(PinName _en, PinName ms1, PinName ms2, PinName ms3, PinName _stepPin, PinName dir); |
hisyamfs | 12:1e3227a6fcd7 | 13 | stepper s(PC_6, PC_8, PA_12, PC_7, PA_11, PB_12); |
hisyamfs | 12:1e3227a6fcd7 | 14 | Uvtron uv(PC_12); |
hisyamfs | 13:0c5942931cad | 15 | AX12 servo1(PC_10, PC_11, PA_13, 1, 1000000); // tx, rx, tx_enable, servo ID, baud rate |
hisyamfs | 13:0c5942931cad | 16 | TPA81 tpay(PB_9,PB_8, 0xDE); |
hisyamfs | 13:0c5942931cad | 17 | SRF05 srf(PA_15, PA_14); // trigger, echo |
hisyamfs | 12:1e3227a6fcd7 | 18 | DigitalOut led(LED1); |
dmgongora | 0:79e2a8171b16 | 19 | |
dmgongora | 0:79e2a8171b16 | 20 | int main() |
hisyamfs | 12:1e3227a6fcd7 | 21 | { |
hisyamfs | 13:0c5942931cad | 22 | // s.enable(); |
hisyamfs | 12:1e3227a6fcd7 | 23 | while (1) |
hisyamfs | 12:1e3227a6fcd7 | 24 | { |
hisyamfs | 13:0c5942931cad | 25 | // Ultrasonik |
hisyamfs | 13:0c5942931cad | 26 | pc.printf("Distance = %.1f\n", srf.read()); |
hisyamfs | 13:0c5942931cad | 27 | |
hisyamfs | 13:0c5942931cad | 28 | // TPA |
hisyamfs | 12:1e3227a6fcd7 | 29 | pc.printf("%d", tpay.getTemp(0)); |
hisyamfs | 12:1e3227a6fcd7 | 30 | int i; |
hisyamfs | 12:1e3227a6fcd7 | 31 | pc.printf("\nTPA Y \n"); |
hisyamfs | 12:1e3227a6fcd7 | 32 | tpay.Read(); |
hisyamfs | 12:1e3227a6fcd7 | 33 | for (i=2; i<=9; i++) { |
hisyamfs | 12:1e3227a6fcd7 | 34 | pc.printf("%d ",tpay.getTemp(i)); |
Ezeuz | 8:5e1854c119ba | 35 | } |
Ezeuz | 6:69c59bcab6ea | 36 | |
hisyamfs | 13:0c5942931cad | 37 | // Stepper |
hisyamfs | 13:0c5942931cad | 38 | pc.printf("\n stepper \n"); |
hisyamfs | 12:1e3227a6fcd7 | 39 | s.step(1, 1, 1/WAIT_TIME); |
Ezeuz | 8:5e1854c119ba | 40 | |
hisyamfs | 12:1e3227a6fcd7 | 41 | // Servo |
hisyamfs | 13:0c5942931cad | 42 | float degrees2 = 150; |
hisyamfs | 13:0c5942931cad | 43 | float speed1 = 1.0; |
hisyamfs | 13:0c5942931cad | 44 | servo1.MultSetGoal( |
hisyamfs | 13:0c5942931cad | 45 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 46 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 47 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 48 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 49 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 50 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 51 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 52 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 53 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 54 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 55 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 56 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 57 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 58 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 59 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 60 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 61 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 62 | degrees2, speed1 |
hisyamfs | 13:0c5942931cad | 63 | ); |
hisyamfs | 13:0c5942931cad | 64 | |
hisyamfs | 13:0c5942931cad | 65 | pc.printf("Servo 150\n"); |
hisyamfs | 12:1e3227a6fcd7 | 66 | wait(1); |
hisyamfs | 13:0c5942931cad | 67 | |
hisyamfs | 13:0c5942931cad | 68 | degrees2 = 240; |
hisyamfs | 13:0c5942931cad | 69 | |
hisyamfs | 13:0c5942931cad | 70 | servo1.MultSetGoal( |
hisyamfs | 13:0c5942931cad | 71 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 72 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 73 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 74 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 75 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 76 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 77 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 78 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 79 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 80 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 81 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 82 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 83 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 84 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 85 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 86 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 87 | degrees2, speed1, |
hisyamfs | 13:0c5942931cad | 88 | degrees2, speed1 |
hisyamfs | 13:0c5942931cad | 89 | ); |
hisyamfs | 13:0c5942931cad | 90 | |
hisyamfs | 13:0c5942931cad | 91 | pc.printf("Servo 240\n"); |
hisyamfs | 12:1e3227a6fcd7 | 92 | wait(1); |
Ezeuz | 8:5e1854c119ba | 93 | |
hisyamfs | 12:1e3227a6fcd7 | 94 | // Uvtron |
hisyamfs | 12:1e3227a6fcd7 | 95 | uv.Read(); |
hisyamfs | 12:1e3227a6fcd7 | 96 | int read = uv.Flag; |
hisyamfs | 12:1e3227a6fcd7 | 97 | if (read) pc.printf("FIRE DETECTED\n"); |
hisyamfs | 12:1e3227a6fcd7 | 98 | else pc.printf("NOT DETECTED\n"); |
hisyamfs | 13:0c5942931cad | 99 | |
hisyamfs | 13:0c5942931cad | 100 | // IR |
hisyamfs | 13:0c5942931cad | 101 | float meas = IR.read(); // Converts and read the analog input value (value from 0.0 to 1.0) |
hisyamfs | 13:0c5942931cad | 102 | meas = meas * 3300; // Change the value to be in the 0 to 3300 range |
hisyamfs | 13:0c5942931cad | 103 | float ir_dist = (330377) * (pow(meas , (-1.349f))); |
hisyamfs | 13:0c5942931cad | 104 | printf("IR : %.4f\n", ir_dist); |
hisyamfs | 12:1e3227a6fcd7 | 105 | } |
hisyamfs | 12:1e3227a6fcd7 | 106 | } |