Sz_Insper / Mbed 2 deprecated Line_follow

Dependencies:   mbed

Committer:
Marcelocostanzo
Date:
Mon Nov 18 13:37:36 2019 +0000
Revision:
3:e327153b2aa4
Parent:
2:482c3ed45884
Teste da shield L293D

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Marcelocostanzo 3:e327153b2aa4 1 #include "mbed.h"
Marcelocostanzo 1:fe4f6f2d9ca6 2
Marcelocostanzo 3:e327153b2aa4 3 DigitalIn BT(BUTTON1);
Marcelocostanzo 3:e327153b2aa4 4 //DigitalOut led(LED1);
Marcelocostanzo 1:fe4f6f2d9ca6 5
Marcelocostanzo 3:e327153b2aa4 6 DigitalOut IN1_MOTOR1(D13);
Marcelocostanzo 3:e327153b2aa4 7 DigitalOut IN2_MOTOR1(D12);
Marcelocostanzo 3:e327153b2aa4 8 DigitalOut EN_MOTOR1(D11);
Marcelocostanzo 0:0d443d0229c9 9
Marcelocostanzo 3:e327153b2aa4 10 DigitalOut IN1_MOTOR2(D8);
Marcelocostanzo 3:e327153b2aa4 11 DigitalOut IN2_MOTOR2(D10);
Marcelocostanzo 3:e327153b2aa4 12 DigitalOut EN_MOTOR2(D9);
Marcelocostanzo 3:e327153b2aa4 13
Marcelocostanzo 0:0d443d0229c9 14 Serial pc(USBTX, USBRX); // tx, rx
Marcelocostanzo 0:0d443d0229c9 15
Marcelocostanzo 0:0d443d0229c9 16
Marcelocostanzo 0:0d443d0229c9 17 int main()
Marcelocostanzo 0:0d443d0229c9 18 {
Marcelocostanzo 3:e327153b2aa4 19 pc.printf("Iniciando...\n\r");
Marcelocostanzo 3:e327153b2aa4 20 IN1_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 21 IN2_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 22 IN1_MOTOR2 = 0;
Marcelocostanzo 3:e327153b2aa4 23 IN2_MOTOR2 = 0;
Marcelocostanzo 0:0d443d0229c9 24
Marcelocostanzo 3:e327153b2aa4 25 EN_MOTOR1 = 1;
Marcelocostanzo 3:e327153b2aa4 26 EN_MOTOR2 = 1;
Marcelocostanzo 3:e327153b2aa4 27
Marcelocostanzo 3:e327153b2aa4 28 wait_ms(2000);
Marcelocostanzo 0:0d443d0229c9 29
Marcelocostanzo 0:0d443d0229c9 30 while(1)
Marcelocostanzo 0:0d443d0229c9 31 {
Marcelocostanzo 3:e327153b2aa4 32 pc.printf("CW\n\r");
Marcelocostanzo 3:e327153b2aa4 33 IN1_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 34 IN2_MOTOR1 = 1;
Marcelocostanzo 3:e327153b2aa4 35 IN1_MOTOR2 = 0;
Marcelocostanzo 3:e327153b2aa4 36 IN2_MOTOR2 = 1;
Marcelocostanzo 3:e327153b2aa4 37 wait_ms(4000);
Marcelocostanzo 0:0d443d0229c9 38
Marcelocostanzo 3:e327153b2aa4 39 IN1_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 40 IN2_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 41 IN1_MOTOR2 = 0;
Marcelocostanzo 3:e327153b2aa4 42 IN2_MOTOR2 = 0;
Marcelocostanzo 3:e327153b2aa4 43 wait_ms(500);
Marcelocostanzo 0:0d443d0229c9 44
Marcelocostanzo 3:e327153b2aa4 45 pc.printf("CCW\n\r");
Marcelocostanzo 3:e327153b2aa4 46 IN1_MOTOR1 = 1;
Marcelocostanzo 3:e327153b2aa4 47 IN2_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 48 IN1_MOTOR2 = 1;
Marcelocostanzo 3:e327153b2aa4 49 IN2_MOTOR2 = 0;
Marcelocostanzo 3:e327153b2aa4 50 wait_ms(4000);
Marcelocostanzo 0:0d443d0229c9 51
Marcelocostanzo 3:e327153b2aa4 52 IN1_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 53 IN2_MOTOR1 = 0;
Marcelocostanzo 3:e327153b2aa4 54 IN1_MOTOR2 = 0;
Marcelocostanzo 3:e327153b2aa4 55 IN2_MOTOR2 = 0;
Marcelocostanzo 3:e327153b2aa4 56 wait_ms(500);
Marcelocostanzo 0:0d443d0229c9 57 }
Marcelocostanzo 0:0d443d0229c9 58 }