robot S2 pour CE2 avec ROS

Dependencies:   mbed rosserial_mbed_lib

main.cpp

Committer:
jlsalvat
Date:
2019-10-09
Revision:
0:939d180d8f7f

File content as of revision 0:939d180d8f7f:

#include "mbed.h"

DigitalOut myled(LED1);
DigitalOut av_ar_G(p12);
DigitalOut av_ar_D(p11);
PwmOut pwm_G(p23);
PwmOut pwm_D(p22);
Serial serial(p13,p14);

void InitMot(){
    av_ar_G=av_ar_D=0;
    pwm_G.pulsewidth_us(0);
    pwm_G.period_us(100);   
    pwm_D.pulsewidth_us(0);
    pwm_D.period_us(100);  
}

int main() {
    InitMot();
    while(1) {
        serial.printf("A\n");
        myled = 1;
        wait(0.2);
        myled = 0;
        wait(0.2);
    }
}