Software to run a motor driver
Embed:
(wiki syntax)
Show/hide line numbers
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 }
Generated on Mon Jul 18 2022 19:16:29 by
1.7.2