Software to run a motor driver

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 
00003 DigitalOut IN1(D8);
00004 DigitalOut IN2(D9);
00005 PwmOut ENA(D3);
00006 
00007 DigitalOut IN3(D6);
00008 DigitalOut IN4(D7);
00009 PwmOut ENB(D5);
00010 
00011 void Init();
00012 void Sortir();
00013 void Entrer();
00014 void Stop();
00015 
00016 int main() 
00017 {
00018     Init();
00019     
00020     Sortir();
00021     wait(2);
00022     Entrer();
00023     wait(2);
00024     
00025     ENB = 1;
00026     IN3 = 0;
00027     IN4 = 1;
00028 }
00029 
00030 void Init()
00031 {
00032     wait_ms(500);
00033     IN1 = 0;
00034     IN2 = 0;
00035     IN3 = 0;
00036     IN4 = 0;
00037 }
00038 
00039 void Sortir()
00040 {
00041     ENA = 0.2;
00042     IN1 = 1;
00043     IN2 = 0;
00044     wait(2.5);
00045     Stop();
00046 }
00047 
00048 void Entrer()
00049 {
00050     ENA = 0.2;
00051     IN1 = 0;
00052     IN2 = 1;
00053     wait(1.7);
00054     Stop();
00055 }
00056 
00057 void Stop()
00058 {
00059     IN1 = 0;
00060     IN2 = 0;
00061 }