part1 in progress

Dependencies:   Motordriver Servo mbed

main.cpp

Committer:
yifeng021
Date:
2015-03-24
Revision:
0:306c3cd7fc05

File content as of revision 0:306c3cd7fc05:

// test code, this demonstrates working motor drivers. 
// full reverse to full stop, dynamicaly brake and switch off.
#include "mbed.h"
#include "motordriver.h"
#include "Servo.h"
DigitalOut myled(LED1);
//PwmOut servo1(p23);
Motor A(p22, p11, p12, 1); // pwm, fwd, rev, can brake 
//Motor B(p21, p7, p8, 1); // pwm, fwd, rev, can brake
Servo s1(p23);

int main() {
    //PWMout1.period(1.0/50.0);
    int i = 0;
    bool up = true;
    s1.calibrate(0.02, 180); //myServo.calibrate(x,y)
                              //x sets servo rotate speed
                              //y sets full range of rotation
                              //in reality, even though we set range to 180deg, the actual range
                              //the servo reaches is slightly less than 180deg
    while(1) {
          s1 = i/100.0;
          wait(0.01);
          //Sensor moves from one extreme position to the other
          if (up) {
            i++;
            if (i == 100) {up = false;}
          }
          //Sensor moves from one extreme position to the other
          else {
            i--;
            if (i == 0) {up = true;}
          }
        A.speed(-0.8);
        wait(0.01);
    }
        
/*
while (1) {
    
    //for (float s= -1.0; s < 0.0 ; s += 0.01) {
        //A.speed(s);
        //B.speed(s);
        //wait(0.02);
    //}
    
    while (1) {
        A.speed(-0.8);
        wait(0.01);
    }
    A.stop(0.5);
    wait(1);
    A.coast();
}
*/
}