-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmodel_controller.h
65 lines (41 loc) · 1.31 KB
/
model_controller.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
#ifndef MODEL_PUSH_H
#define MODEL_PUSH_H
#include <boost/bind.hpp>
#include <gazebo/gazebo.hh>
#include <gazebo/physics/physics.hh>
#include <gazebo/common/common.hh>
#include <stdio.h>
#include <vector>
#include<iostream>
#include<iomanip>
#include<iterator>
#include<cmath>
#include<math.h>
namespace gazebo
{
class ModelPush : public ModelPlugin
{
public: ModelPush();
public: ~ModelPush();
public: void Load(physics::ModelPtr _parent, sdf::ElementPtr /*_sdf*/);
public: void OnUpdate(const common::UpdateInfo & /*_info*/); //virtual?
private: physics::ModelPtr model;
private: event::ConnectionPtr updateConnection;
private: physics::Joint_V vectorofJoints;
private: std::map<std::string, double> jointAngles;
private: std::map<std::string, double> jointVelocity;
private: std::map<std::string, double> jointForce;
private: physics::Joint_V activeJoints;
private: common::Time simTime;
private: common::Time realTime;
private: std::string motorJointName01;
private: std::string motorJointName02;
private: std::string motorJointName03;
private : physics::JointPtr motorJoint01;
private: physics::JointPtr motorJoint02;
private: physics::JointPtr motorJoint03;
private: std::string robotName;
private: int attempt;
};
}
#endif // MODEL_PUSH_H