servo_test Nucleo-f303K8

Dependencies:   mbed

main.cpp

Committer:
sashida_h
Date:
2019-03-09
Revision:
0:7da591ec2935
Child:
1:2e6087aa66e3

File content as of revision 0:7da591ec2935:

#include "mbed.h"

//DigitalOut myled(LED1);
//DigitalIn  sw(p11);
PwmOut     servo1(PB_4);
PwmOut     servo2(PB_5);
DigitalOut servo1_signal(PA_0);
DigitalOut servo2_signal(PA_1);
Serial pc(PA_2, PA_3);
bool sw_tf = true;

int main(){
    pc.baud(38400);
    wait(2.0);
    pc.printf("Hello world\r\n");
    servo1_signal = 0;
    servo2_signal = 0;
    while(1){
            wait(2);
            servo2.pulsewidth(0.0015);
            servo1.pulsewidth(0.0024);
            pc.printf("1\r\n");
            wait(2);
            servo2.pulsewidth(0.0024);
            servo1.pulsewidth(0.0006);
            pc.printf("2\r\n");
            wait(2);
            servo2.pulsewidth(0.0006);
            servo1.pulsewidth(0.0015);
            pc.printf("3\r\n");
            
    }              
    return 0;  
}