David Buck / Mbed 2 deprecated car_wheel_sens

v1.1 of orig program, slowly speeds up motor to find the poit at witch it gets stuck in the trigger or reaches top speed

Dependencies:   mbed

main.cpp

Committer:
Kaikestu
Date:
2010-02-03
Revision:
0:8fab2b18d87d
Child:
1:86868f4b226a

File content as of revision 0:8fab2b18d87d:

#include "mbed.h"
#include "Servo.h"

Serial pc(USBTX, USBRX);
DigitalOut myled(LED1);
DigitalOut myled2(LED2);
InterruptIn w(p16);
Timer timer;

Servo serv (p21);

int count,begin,end;
int single_spin;
const int wheel = 257; //in mm 
int Tdist=0;


void trigger()
{
count = count + 1;
begin = timer.read_ms();
single_spin = begin - end;
myled2 = !myled2;
pc.printf("turn %d \n",single_spin);
end = timer.read_ms();


}


int main() {
timer.start();
w.rise(&trigger);

    while(1) {
    serv.write(0);
    myled = !myled;
wait(0.3);
    Tdist = wheel * count; //o/p in mm for now

pc.printf("dist %d \n",Tdist);
   
    }
}