Carlo Collodi / kangaroo

Dependencies:   QEI mbed

Master.cpp

Committer:
calamaridudeman
Date:
2013-11-24
Revision:
37:bf257a0154db
Parent:
35:a4e89e78d034
Child:
38:922f2584bdfd
Child:
43:68faf056ed5c

File content as of revision 37:bf257a0154db:

#include "mbed.h"

#include "Master.hpp"

Serial pc(USBTX, USBRX);

QEI mEnc1(p25, p26, NC, 1200, QEI::X4_ENCODING); //hip
QEI mEnc2(p23, p24, NC, 1200, QEI::X4_ENCODING);//knee

Motor m1(p15,p17,p18,p21,mEnc1);//hip
Motor m2(p16,p19,p20,p22,mEnc2);//knee

QEI bEnc1(p27, p28, p29, 1200, QEI::X4_ENCODING);  //track
QEI bEnc2(p8, p9, p10, 1200, QEI::X4_ENCODING); //body

Kangaroo kankan(m1,m2,bEnc1,bEnc2);

int main() {
    
    while(1){
        kankan.testEncoders(pc);
        wait(.25);
    }
    
    
    //kankan.zero();
}