tes ir atas semua

Dependencies:   mbed ADS1115 StepperMotor SRF05 TPA81new

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?

UserRevisionLine numberNew 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 }