AccelerationSceneTSID.hpp

Go to the documentation of this file.

#ifndef WBCACCELERATIONSCENETSID_HPP
#define WBCACCELERATIONSCENETSID_HPP
 
#include "../../core/Scene.hpp"
#include <base/samples/Wrenches.hpp>
 
namespace wbc{
 
class AccelerationSceneTSID : public Scene{
protected:
    static SceneRegistry<AccelerationSceneTSID> reg;
 
    // Helper variables
    base::VectorXd robot_acc, solver_output_acc;
    base::samples::Wrenches contact_wrenches;
    double hessian_regularizer;
 
    virtual TaskPtr createTask(const TaskConfig &config);
 
    base::Time stamp;
 
public:
    AccelerationSceneTSID(RobotModelPtr robot_model, QPSolverPtr solver, const double dt);
    virtual ~AccelerationSceneTSID(){
    }
 
    virtual const HierarchicalQP& update();
 
    virtual const base::commands::Joints& solve(const HierarchicalQP& hqp);
 
    virtual const TasksStatus &updateTasksStatus();
 
    const base::samples::Wrenches& getContactWrenches(){return contact_wrenches;}
 
    void setHessianRegularizer(const double reg){hessian_regularizer=reg;}
 
    double getHessianRegularizer(){return hessian_regularizer;}
};
 
} // namespace wbc
 
#endif