Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: mbed QEI HIDScope biquadFilter MODSERIAL FastPWM
Revision 9:6537eead1241, committed 2019-10-05
- Comitter:
- PatrickZieverink
- Date:
- Sat Oct 05 16:38:45 2019 +0000
- Parent:
- 8:6f6a4dc12036
- Commit message:
- Niets veranderd wat aanstaat, alleen heel veel in concept erin gezet waarvan ik denk dat het wel handig is.
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r 6f6a4dc12036 -r 6537eead1241 main.cpp --- a/main.cpp Fri Oct 04 17:44:30 2019 +0000 +++ b/main.cpp Sat Oct 05 16:38:45 2019 +0000 @@ -37,8 +37,64 @@ float pot_1 = 0; float pot_2 = 0; +/* +float x_movement = 0; +float y_movement = 0; +float angle = 0; +float extention = 0; + +void calibration() { //kalibratie van de sensoren (de nulstand invoeren) + letter = pc.getc() // krijg de letter vanuit de keyboard + while (letter == w){ // of hier een while loop moet ja of nee, geen idee, lijkt me beter dan een if naar mijn mening. Eigenlijk wil je iets op de rising en falling edge hebben om zo het begin en het eind erin te kunne zetten. + y_movement = 1; + } + while (letter == a) { + x_movement = -1; + } + while (letter == s){ + y_movement = -1; + } + while (letter == d) { + x_movement = 1; + } + robot_kinematics() // hoe dat dit precies moet geen idee. Dit lijkt me een goed begin of iig een begin + x_movement = 0; + y_movement = 0; + + + +} +void robot_kinematics() { //hoe de motoren moeten draaien als er een x of y richting als input is. + [motor.dir1, motor.dir2; motor.speed1, motor.speed2] = H^-1 *[x_movement, y_movement; angle] // Zoiets + + +} +*/ + // the funtions needed to run the program void measure_signals() { + + /* + letter = pc.getc() // krijg de letter vanuit de keyboard + if (letter == w){ + y_movement = 1; + } + if (letter == a) { + x_movement = -1; + } + if (letter == s){ + y_movement = -1; + } + if (letter == d) { + x_movement = 1; + } + + angle = (encoder1.getPulses()-angle_0)/8400*360; //kijkt op welke stand encoder 1 nu staat (dat hoort dus de basis motor te zijn!) /8400 signalen per rotatie * 360 graden + extention = encoder2.getPulses()-extention_0/8400*8*5.05; //kijkt hoever de arm is uitgeschoven (/8400 per rotatie *8mm per rotatie aan verschuiving * 5.05 de gear ratio) + + + */ + pot_1 = Pot1.read(); pc.printf("pot_1 = %f",pot_1); // Dit doet hij niet, waarom niet? Er scheelt niet veel aan, maar toch motor.speed1 = pot_1*0.75; //pod_read * 0.75 (dus max 75%) @@ -162,7 +218,7 @@ but1.fall(&but1_interrupt); but2.fall(&but2_interrupt); - loop_ticker.attach(&main_loop, 0.1f); //main loop at 1kHz + loop_ticker.attach(&main_loop, 0.1f); //main loop at 1kHz (niet per tiende seconde?) pc.printf("Main_loop is running\n \r"); while (true) {} } \ No newline at end of file