Movimiento de Motor DC y Servo
Dependencies: Motor Servo mbed
Diff: main.cpp
- Revision:
- 0:996a30882975
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Sat Oct 11 20:49:52 2014 +0000 @@ -0,0 +1,35 @@ +/*Borrador 1: realizar un recorrido formando un cuadrado. Las vueltas se harán cada cierto tiempo. +11 de octubre de 2014 - Daniela Plascencia */ +//--------LIBRARIES-------- +#include "mbed.h" +#include "Servo.h" +#include "Motor.h" +//--------I/O PINS------- +DigitalOut myled(LED1); +PwmOut servo(PTD4); +Motor motor(D3, D8, D9); +Timer timer; +//------VARIABLES------- +float i = 0.0; +//-------MAIN PROGRAM------ +int main () +{ + timer.start(); + do { + float tiempo = timer.read(); + if(tiempo <= 5) { + motor.speed(1.0); + } else { + if(i<=2.0) { + i+= 1.0; + motor.speed(0.5); + servo.write(0.075); + wait(0.2); + servo.write(0.0); + wait(0.2); + timer.reset(); + } + } + } while(i<=3.0); + timer.stop(); +} \ No newline at end of file