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

Master.cpp@52:b168d1194819, 2013-12-02 (annotated)

Committer:
calamaridudeman
Date:
Mon Dec 02 04:29:58 2013 +0000
Revision:
52:b168d1194819
Parent:
44:3566c5699ba6 
no idea

Who changed what in which revision?

UserRevisionLine numberNew contents of line
calamaridudeman 23:112c0be5a7f3 1 #include "mbed.h"
calamaridudeman 37:bf257a0154db 2
calamaridudeman 37:bf257a0154db 3 #include "Master.hpp"
calamaridudeman 22:4d85d989af08 4
calamaridudeman 23:112c0be5a7f3 5 Serial pc(USBTX, USBRX);
calamaridudeman 23:112c0be5a7f3 6
calamaridudeman 37:bf257a0154db 7 QEI mEnc1(p25, p26, NC, 1200, QEI::X4_ENCODING); //hip
calamaridudeman 52:b168d1194819 8 QEI mEnc2(p23, p24, NC, 1200, QEI::X4_ENCODING); //knee
calamaridudeman 37:bf257a0154db 9
calamaridudeman 43:68faf056ed5c 10 Motor m1(p15,p17,p18,p21,mEnc2);//hip p17 high is CCW
calamaridudeman 43:68faf056ed5c 11 Motor m2(p16,p19,p20,p22,mEnc1);//knee p19 high is CCW
calamaridudeman 25:8a34b8d6cc6e 12
calamaridudeman 52:b168d1194819 13 QEI bEnc1(p27, p28, p29, 500, QEI::X4_ENCODING); //track offset: -2.236814
calamaridudeman 52:b168d1194819 14 QEI bEnc2(p5, p6, p7, 500, QEI::X4_ENCODING); //body offset: 1.770973
calamaridudeman 37:bf257a0154db 15
calamaridudeman 37:bf257a0154db 16 Kangaroo kankan(m1,m2,bEnc1,bEnc2);
calamaridudeman 37:bf257a0154db 17
calamaridudeman 37:bf257a0154db 18 int main() {
calamaridudeman 43:68faf056ed5c 19
calamaridudeman 43:68faf056ed5c 20 Point p1(0,-.1,0);
calamaridudeman 43:68faf056ed5c 21 Point p2(0,-.6,0);
calamaridudeman 43:68faf056ed5c 22 Point p3(0,-.1,0);
calamaridudeman 43:68faf056ed5c 23 Point p[3]={p1, p2, p3};
calamaridudeman 43:68faf056ed5c 24 BezCurve curve(p, 3);
calamaridudeman 43:68faf056ed5c 25
calamaridudeman 43:68faf056ed5c 26 curve.startCurve();
calamaridudeman 44:3566c5699ba6 27 m1.setTorque(3);
calamaridudeman 43:68faf056ed5c 28 m2.setPos(0);
calamaridudeman 43:68faf056ed5c 29 kankan.start();
calamaridudeman 43:68faf056ed5c 30 wait(3);
calamaridudeman 43:68faf056ed5c 31
calamaridudeman 43:68faf056ed5c 32 /*while(!curve.isDone()){
calamaridudeman 43:68faf056ed5c 33 //kankan.testEncoders(pc);
calamaridudeman 43:68faf056ed5c 34 curve.incrementAlpha();
calamaridudeman 43:68faf056ed5c 35 Point end = curve.getPoint();
calamaridudeman 43:68faf056ed5c 36
calamaridudeman 43:68faf056ed5c 37 Joints motorset = invKinBody(end);
calamaridudeman 43:68faf056ed5c 38 //pc.printf("%f, %f, %f, %f\n", motorset.t1, motorset.t2, end.x, end.y);
calamaridudeman 43:68faf056ed5c 39
calamaridudeman 43:68faf056ed5c 40 m1.setPos(motorset.t1);
calamaridudeman 43:68faf056ed5c 41 m2.setPos(motorset.t2);
calamaridudeman 43:68faf056ed5c 42
calamaridudeman 43:68faf056ed5c 43 wait(.05);
calamaridudeman 43:68faf056ed5c 44 }
calamaridudeman 43:68faf056ed5c 45 */
calamaridudeman 23:112c0be5a7f3 46
calamaridudeman 43:68faf056ed5c 47 /*
calamaridudeman 43:68faf056ed5c 48 kankan.start();
calamaridudeman 43:68faf056ed5c 49 wait(1);
calamaridudeman 43:68faf056ed5c 50 //m1.setPos(-3.1415/6);
calamaridudeman 43:68faf056ed5c 51 //m2.setPos(3.1415/6);
calamaridudeman 43:68faf056ed5c 52 //m1.setTorque(2);
calamaridudeman 37:bf257a0154db 53
calamaridudeman 43:68faf056ed5c 54 //kankan.setPoint(Point(0,-.3,0));
calamaridudeman 43:68faf056ed5c 55 wait(5);
calamaridudeman 43:68faf056ed5c 56 */
calamaridudeman 43:68faf056ed5c 57 m1.stop();
calamaridudeman 43:68faf056ed5c 58 m2.stop();
calamaridudeman 52:b168d1194819 59
calamaridudeman 22:4d85d989af08 60 }