ExoRobot.h

Go to the documentation of this file.

#ifndef EXOROBOT_H_INCLUDED
#define EXOROBOT_H_INCLUDED

#include <time.h>

#include <map>

#include "CopleyDrive.h"
#include "DummyActJoint.h"
#include "DummyTrajectoryGenerator.h"
#include "Keyboard.h"
#include "Robot.h"
#include "RobotParams.h"

class ExoRobot : public Robot {
   private:
    // \todo Load in paramaters and dictionary entries from JSON file.

    double currTrajProgress = 0;
    timespec prevTime;
    motorProfile posControlMotorProfile{4000000, 240000, 240000};

   public:
    ExoRobot(TrajectoryGenerator *tj);
    ~ExoRobot();
    Keyboard keyboard;
    vector<CopleyDrive *> copleyDrives;

    // /**
    //  * \brief Timer Variables for moving through trajectories
    //  *
    //  */
    struct timeval tv, tv_diff, moving_tv, tv_changed, stationary_tv, start_traj, last_tv;

    bool initPositionControl();

    bool moveThroughTraj();

    void startNewTraj();

    bool isTrajFinished();

    bool initialiseJoints();

    bool initialiseNetwork();
    bool initialiseInputs();
    void freeMemory();
    void updateRobot();
    std::map<int, double> jointMinMap = {{LEFT_HIP, 70},
                                         {RIGHT_HIP, 70},
                                         {LEFT_KNEE, 0},
                                         {RIGHT_KNEE, 0},
                                         {LEFT_ANKLE, 75},
                                         {RIGHT_ANKLE, 75}};
    std::map<int, double> jointMaxMap = {{LEFT_HIP, 210},
                                         {RIGHT_HIP, 210},
                                         {LEFT_KNEE, 120},
                                         {RIGHT_KNEE, 120},
                                         {LEFT_ANKLE, 105},
                                         {RIGHT_ANKLE, 105}};
};
#endif /*EXOROBOT_H*/