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
Diff: main.cpp
- Revision:
- 0:8fab2b18d87d
- Child:
- 1:86868f4b226a
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed Feb 03 14:25:51 2010 +0000 @@ -0,0 +1,44 @@ +#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); + + } +}