robot S2 pour CE2 avec ROS

Dependencies:   mbed rosserial_mbed_lib

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 
00003 DigitalOut myled(LED1);
00004 DigitalOut av_ar_G(p12);
00005 DigitalOut av_ar_D(p11);
00006 PwmOut pwm_G(p23);
00007 PwmOut pwm_D(p22);
00008 Serial serial(p13,p14);
00009 
00010 void InitMot(){
00011     av_ar_G=av_ar_D=0;
00012     pwm_G.pulsewidth_us(0);
00013     pwm_G.period_us(100);   
00014     pwm_D.pulsewidth_us(0);
00015     pwm_D.period_us(100);  
00016 }
00017 
00018 int main() {
00019     InitMot();
00020     while(1) {
00021         serial.printf("A\n");
00022         myled = 1;
00023         wait(0.2);
00024         myled = 0;
00025         wait(0.2);
00026     }
00027 }