part1

Dependencies:   mbed

main.cpp

Committer:
shibulal
Date:
2015-10-08
Revision:
0:ef586a6b33e5

File content as of revision 0:ef586a6b33e5:

#include "mbed.h"


PwmOut servo1(p26);
PwmOut servo2(p25);
PwmOut dcMotor(p24);
DigitalOut out1(p18);
DigitalOut out2(p19);
DigitalIn in1(p14);
DigitalIn in2(p15);
DigitalIn in3(p16);
DigitalIn in4(p17);
Serial pc(USBTX, USBRX);

int main() {
    
    
    servo1.period(0.02);
    servo2.period(0.02);
    servo1.pulsewidth(0.00225);                                                                                                                                                                                                                                                                                                                  
    servo2.pulsewidth(0.00075);
    dcMotor.period(0.02f);
    dcMotor.write(0.5f);
    out2=1.0f;
    out1=0.0f;
    while(1) {
        if (in1){
            servo2.period(0.02f);
            servo2.pulsewidth(0.00075);
            }
    }
}