![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
tes ir atas semua
Dependencies: mbed ADS1115 StepperMotor SRF05 TPA81new
main.cpp@36:85c0bf43f4a4, 2019-02-06 (annotated)
- Committer:
- hisyamfs
- Date:
- Wed Feb 06 17:20:43 2019 +0000
- Revision:
- 36:85c0bf43f4a4
- Parent:
- 35:c2af31894a91
tpa aja
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 "TPA81new.h" |
hisyamfs | 16:771d84a80e3d | 3 | #include "SRF05.h" |
hisyamfs | 19:9a7b34bedc6c | 4 | #include "Uvtron.h" |
hisyamfs | 30:5efd59a0226f | 5 | #include "Stepper.h" |
hisyamfs | 16:771d84a80e3d | 6 | |
hisyamfs | 16:771d84a80e3d | 7 | #define LCD_D4_DIG PA_15 |
hisyamfs | 16:771d84a80e3d | 8 | #define LCD_D5_DIG PA_14 |
hisyamfs | 16:771d84a80e3d | 9 | #define LCD_E_DIG PC_15 |
hisyamfs | 16:771d84a80e3d | 10 | #define LCD_RS_DIG PB_7 |
hisyamfs | 14:207770fefedf | 11 | |
hisyamfs | 15:da7a15289893 | 12 | Serial pc(USBTX,USBRX); |
hisyamfs | 17:fd06e8104835 | 13 | |
hisyamfs | 17:fd06e8104835 | 14 | // TPA |
hisyamfs | 36:85c0bf43f4a4 | 15 | TPA81 tpax(D14, D15, 0xDC); |
hisyamfs | 36:85c0bf43f4a4 | 16 | TPA81 tpay(D14, D15, 0xDE); |
dmgongora | 0:79e2a8171b16 | 17 | |
hisyamfs | 17:fd06e8104835 | 18 | // Ultrasonik |
hisyamfs | 25:a75d6875cb55 | 19 | //SRF05 srf1(PC_13, PA_14); // trigger, echo |
hisyamfs | 25:a75d6875cb55 | 20 | //SRF05 srf1(PA_11, PB_12); |
hisyamfs | 25:a75d6875cb55 | 21 | //SRF05 srf1(PB_12, PA_11); |
hisyamfs | 25:a75d6875cb55 | 22 | SRF05 srf1(PB_3, PB_10); |
hisyamfs | 16:771d84a80e3d | 23 | SRF05 srf2(PA_15, PB_7); // trigger, echo |
hisyamfs | 16:771d84a80e3d | 24 | |
hisyamfs | 18:f3b23331090f | 25 | DigitalOut relay(PB_2); |
hisyamfs | 18:f3b23331090f | 26 | |
hisyamfs | 17:fd06e8104835 | 27 | // UVTron |
hisyamfs | 17:fd06e8104835 | 28 | Uvtron uv(PC_12); |
hisyamfs | 17:fd06e8104835 | 29 | |
hisyamfs | 19:9a7b34bedc6c | 30 | // Sound |
hisyamfs | 26:9c7f39e21df4 | 31 | DigitalIn sound(PA_9); |
hisyamfs | 19:9a7b34bedc6c | 32 | |
hisyamfs | 21:bfb064f77f88 | 33 | // Line |
hisyamfs | 21:bfb064f77f88 | 34 | AnalogIn line(PC_1); |
hisyamfs | 21:bfb064f77f88 | 35 | |
hisyamfs | 27:4d79aba70fe8 | 36 | // infrared |
hisyamfs | 27:4d79aba70fe8 | 37 | #define a_depan 5000000 |
hisyamfs | 27:4d79aba70fe8 | 38 | #define b_depan 1.229 |
hisyamfs | 27:4d79aba70fe8 | 39 | // atas |
hisyamfs | 27:4d79aba70fe8 | 40 | AnalogIn ira1(PC_5); |
hisyamfs | 27:4d79aba70fe8 | 41 | AnalogIn ira2(PA_5); |
hisyamfs | 27:4d79aba70fe8 | 42 | AnalogIn ira3(PC_2); |
hisyamfs | 27:4d79aba70fe8 | 43 | AnalogIn ira4(PC_3); |
hisyamfs | 27:4d79aba70fe8 | 44 | AnalogIn ira5(PB_1); |
hisyamfs | 27:4d79aba70fe8 | 45 | AnalogIn ira6(PC_4); |
hisyamfs | 27:4d79aba70fe8 | 46 | AnalogIn ira7(PA_6); |
hisyamfs | 27:4d79aba70fe8 | 47 | AnalogIn ira8(PA_7); |
hisyamfs | 27:4d79aba70fe8 | 48 | // bawah |
hisyamfs | 27:4d79aba70fe8 | 49 | AnalogIn irb1(PA_0); |
hisyamfs | 27:4d79aba70fe8 | 50 | AnalogIn irb2(PA_1); |
hisyamfs | 27:4d79aba70fe8 | 51 | AnalogIn irb3(PA_4); |
hisyamfs | 27:4d79aba70fe8 | 52 | AnalogIn irb4(PB_0); |
hisyamfs | 27:4d79aba70fe8 | 53 | |
hisyamfs | 30:5efd59a0226f | 54 | #define WAIT_TIME 0.02 |
hisyamfs | 30:5efd59a0226f | 55 | |
hisyamfs | 30:5efd59a0226f | 56 | // stepper(PinName _en, PinName ms1, PinName ms2, PinName ms3, PinName _stepPin, PinName dir); |
hisyamfs | 30:5efd59a0226f | 57 | stepper s(PC_6, PC_8, PA_12, PC_7, PA_11, PB_12); |
hisyamfs | 30:5efd59a0226f | 58 | |
hisyamfs | 27:4d79aba70fe8 | 59 | float call_depan(uint16_t x){ |
hisyamfs | 27:4d79aba70fe8 | 60 | float side_distance = a_depan/pow(x,b_depan)+1; |
hisyamfs | 27:4d79aba70fe8 | 61 | return side_distance; |
hisyamfs | 27:4d79aba70fe8 | 62 | } |
hisyamfs | 27:4d79aba70fe8 | 63 | |
dmgongora | 0:79e2a8171b16 | 64 | int main() |
hisyamfs | 12:1e3227a6fcd7 | 65 | { |
hisyamfs | 15:da7a15289893 | 66 | while(1) { |
hisyamfs | 15:da7a15289893 | 67 | pc.printf("%d", tpay.getTemp(0)); |
hisyamfs | 15:da7a15289893 | 68 | int i; |
hisyamfs | 15:da7a15289893 | 69 | pc.printf("\nTPA Y \n"); |
hisyamfs | 15:da7a15289893 | 70 | tpay.Read(); |
hisyamfs | 15:da7a15289893 | 71 | for (i=2; i<=9; i++) { |
hisyamfs | 15:da7a15289893 | 72 | pc.printf("%d ",tpay.getTemp(i)); |
Ezeuz | 8:5e1854c119ba | 73 | } |
hisyamfs | 15:da7a15289893 | 74 | |
hisyamfs | 15:da7a15289893 | 75 | pc.printf("\nTPA X \n"); |
hisyamfs | 15:da7a15289893 | 76 | tpax.Read(); |
hisyamfs | 15:da7a15289893 | 77 | for (i=2; i<=9; i++) { |
hisyamfs | 15:da7a15289893 | 78 | pc.printf("%d ",tpax.getTemp(i)); |
hisyamfs | 15:da7a15289893 | 79 | } |
hisyamfs | 15:da7a15289893 | 80 | pc.printf("\n"); |
hisyamfs | 17:fd06e8104835 | 81 | |
hisyamfs | 36:85c0bf43f4a4 | 82 | wait(0.5); |
hisyamfs | 36:85c0bf43f4a4 | 83 | |
hisyamfs | 35:c2af31894a91 | 84 | // for (int i=0; i<200; i++) |
hisyamfs | 35:c2af31894a91 | 85 | // { |
hisyamfs | 35:c2af31894a91 | 86 | // s.step(1, 1, 1/WAIT_TIME); |
hisyamfs | 35:c2af31894a91 | 87 | // } |
hisyamfs | 14:207770fefedf | 88 | } |
hisyamfs | 15:da7a15289893 | 89 | } |