Carlo Collodi / kangaroo

Dependencies:   QEI mbed

include/dynamics.hpp

Committer:
calamaridudeman
Date:
2013-11-24
Revision:
26:53b793b7a82f
Parent:
25:8a34b8d6cc6e
Child:
28:21773a6fb6df

File content as of revision 26:53b793b7a82f:

#include "mbed.h"

#include "QEI.h"
#include "include/motor.hpp"

#ifndef DYNAMICS_HPP
#define DYNAMICS_HPP

#define l1 1 //gantry point to hip joint
#define l2 1 //hip length
#define l3 1 //leg length
#define l4 1 //foot length

class Kangaroo {

    public:
        Kangaroo(Motor M1, Motor M2, QEI e1, QEI e2);
        void zero();
        void start();
        void run();
        void stop();
        void updatePose();
        void testEncoders(Serial pc);
        
    private:
        QEI enc1;
        QEI enc2;
        Motor m1;
        Motor m2;
};

#endif