
Ping Pong robot
Revision 0:c37e4d7f1f56, committed 2014-10-10
- Comitter:
- JKleinRot
- Date:
- Fri Oct 10 13:20:35 2014 +0000
- Child:
- 1:7066a6113fbe
- Commit message:
- 2014-10-10 eerste begin
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
mbed.bld | Show annotated file Show diff for this revision Revisions of this file |
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Fri Oct 10 13:20:35 2014 +0000 @@ -0,0 +1,90 @@ +#include "mbed.h" //Mbed bibliotheek inladen, standaard functies +#include "MODSERIAL.h" //MODSERIAL bibliotheek inladen, communicatie met PC +#include "encoder.h" //Encoder bibliotheek inladen, communicatie met encoder + +#define BLABLA waarde //Constanten definiëren en een waarde toekennen + +//Pinverdeling +Encoder motor_arm1( +Encoder motor_arm2( // + +PwmOut pwm_motor_arm1 +PwmOut pwm_motor_arm2 + +DigitalOut dir_motor_arm1 +DigitalOut dir_motor_arm2 + +AnalogIn emg_bi +AnalogIn emg_tri + +Ticker sample_EMG + +//Floats, bools +bool rust = false +bool kalibratie_positie = false +bool kalibratie_EMG = false +char lcd_r1 = new char[16]; //LCD regel 1, 16 karakters +char lcd_r2 = new char[16]; //LCD regel 2, 16 karakters + +//Beginwaarden voor variabelen + +int main{ + //pc baudrate + pc.baud(//opzoeken!!) + + //ticker maken die iedere zoveel seconden de EMG data inlaadt + sample_EMG.attach(setsample_EMGflag,0.005); + + while (1){ + if (rust = false && kalibratie_positie = false && kalibratie_EMG = false){ + lcd_r1 = " BMT M9 GR. 4 "; + lcd_r2 = "Hoi! Ik ben PIPO"; + wait(2); + rust = true + } + + + if (rust = true && kalibratie_positie = false && kalibratie_EMG = false){ + wait(1); + + pwm_motor_arm1 = 0.02036 + dir_motor_arm1 = // 1 of 0 + + while(motor_arm1 < 363){ + pwm_motor_arm1 = 0.02036 + } + + pwm_motor_arm1 = 0 + motor_arm1 = 0 + + pwm_motor_arm2 = 0.02398 + dir_motor_arm2 = // 1 of 0 + + while(motor_arm_2 < 787){ + pwm_motor_arm2 = 0.02398 + } + + pwm_motor_arm2 = 0 + motor_arm2 = 0 + + lcd_r1 = " Beginpositie " + lcd_r2 = " ingesteld " + wait(2); + kalibratie_positie = true + } + + if (rust = true && kalibratie_positie = true && kalibratie_EMG = false){ + wait(1); + + ybk = emg_bi.read(); + ytk = emg_tri.read(); + + //detrend + + + //hoogdoorlaatfilter + + + + +
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Fri Oct 10 13:20:35 2014 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/552587b429a1 \ No newline at end of file