hisyam fs / Mbed 2 deprecated Test_all

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?

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