Carlo Collodi / kangaroo

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:   QEI mbed

src/dynamics.cpp@26:53b793b7a82f, 2013-11-24 (annotated)

Committer:
calamaridudeman
Date:
Sun Nov 24 06:00:21 2013 +0000
Revision:
26:53b793b7a82f
Parent:
25:8a34b8d6cc6e
Child:
28:21773a6fb6df
ready to test sensors and code up to motors and sensors.  Still need path planning and higher-level control

Who changed what in which revision?

UserRevisionLine numberNew contents of line
calamaridudeman 21:a9569c7b4379 1 #include "mbed.h"
calamaridudeman 23:112c0be5a7f3 2 #include "include/dynamics.hpp"
calamaridudeman 25:8a34b8d6cc6e 3 #include "include/motor.hpp"
calamaridudeman 16:c21df8c0c458 4
calamaridudeman 26:53b793b7a82f 5 Kangaroo::Kangaroo(Motor M1, Motor M2, QEI e1, QEI e2):enc1(e1),enc2(e2),m1(M1),m2(M2){
calamaridudeman 25:8a34b8d6cc6e 6
calamaridudeman 25:8a34b8d6cc6e 7 }
calamaridudeman 25:8a34b8d6cc6e 8
calamaridudeman 26:53b793b7a82f 9 void Kangaroo::zero(){
calamaridudeman 25:8a34b8d6cc6e 10 m1.setVel(-.002);//wait for the legs to go to stopping points
calamaridudeman 25:8a34b8d6cc6e 11 m2.setVel(-.002);
calamaridudeman 25:8a34b8d6cc6e 12 wait(1);
calamaridudeman 25:8a34b8d6cc6e 13
calamaridudeman 25:8a34b8d6cc6e 14 m1.zero();
calamaridudeman 25:8a34b8d6cc6e 15 m2.zero();
calamaridudeman 25:8a34b8d6cc6e 16
calamaridudeman 25:8a34b8d6cc6e 17 enc1.reset();
calamaridudeman 25:8a34b8d6cc6e 18 enc2.reset();
calamaridudeman 25:8a34b8d6cc6e 19
calamaridudeman 25:8a34b8d6cc6e 20 while((enc1.getRevolutions()==0)&&(enc2.getRevolutions()==0)){
calamaridudeman 25:8a34b8d6cc6e 21 wait(0.1);
calamaridudeman 25:8a34b8d6cc6e 22 }
calamaridudeman 25:8a34b8d6cc6e 23
calamaridudeman 25:8a34b8d6cc6e 24
calamaridudeman 26:53b793b7a82f 25 }
calamaridudeman 26:53b793b7a82f 26
calamaridudeman 26:53b793b7a82f 27 void Kangaroo::testEncoders(Serial pc){
calamaridudeman 26:53b793b7a82f 28 pc.printf("hello world\n");
calamaridudeman 26:53b793b7a82f 29 /*
calamaridudeman 26:53b793b7a82f 30 pc.printf("clix: %i, rots: %i\n",enc1.getPulses(), enc1.getRevolutions());
calamaridudeman 26:53b793b7a82f 31 */
calamaridudeman 26:53b793b7a82f 32
calamaridudeman 26:53b793b7a82f 33 //pc.printf("clix: %i, rots: %i\n",enc2.getPulses(), enc2.getRevolutions());
calamaridudeman 25:8a34b8d6cc6e 34 }