From 3194b1a6135bb1787d8a6ee0e3fea842d87b0f95 Mon Sep 17 00:00:00 2001 From: Guilhem Saurel <guilhem.saurel@laas.fr> Date: Thu, 31 Oct 2019 17:55:00 +0100 Subject: [PATCH] Format --- src/SpringPlugin.cc | 31 ++++++++------------------- src/SpringPlugin.hh | 51 +++++++++++++++++++++++++++------------------ 2 files changed, 40 insertions(+), 42 deletions(-) diff --git a/src/SpringPlugin.cc b/src/SpringPlugin.cc index 487dd25..452b09b 100644 --- a/src/SpringPlugin.cc +++ b/src/SpringPlugin.cc @@ -13,7 +13,7 @@ * See the License for the specific language governing permissions and * limitations under the License. * -*/ + */ #include "gazebo/physics/physics.hh" #include "SpringPlugin.hh" @@ -24,19 +24,15 @@ using namespace gazebo; GZ_REGISTER_MODEL_PLUGIN(SpringPlugin) ///////////////////////////////////////////////// -SpringPlugin::SpringPlugin() -{ -} +SpringPlugin::SpringPlugin() {} ///////////////////////////////////////////////// -void SpringPlugin::Load(physics::ModelPtr lmodel, - sdf::ElementPtr lsdf) -{ +void SpringPlugin::Load(physics::ModelPtr lmodel, sdf::ElementPtr lsdf) { this->model = lmodel; // hardcoded params for this test if (!lsdf->HasElement("joint_spring")) - ROS_ERROR_NAMED("SpringPlugin","No field joint_spring for SpringPlugin"); + ROS_ERROR_NAMED("SpringPlugin", "No field joint_spring for SpringPlugin"); else this->jointExplicitName = lsdf->Get<std::string>("joint_spring"); @@ -44,30 +40,22 @@ void SpringPlugin::Load(physics::ModelPtr lmodel, this->kdExplicit = lsdf->Get<double>("kd"); - ROS_INFO_NAMED("SpringPlugin", - "Loading joint : %s kp: %f kd: %f", - this->jointExplicitName.c_str(), - this->kpExplicit, + ROS_INFO_NAMED("SpringPlugin", "Loading joint : %s kp: %f kd: %f", this->jointExplicitName.c_str(), this->kpExplicit, this->kdExplicit); } ///////////////////////////////////////////////// -void SpringPlugin::Init() -{ +void SpringPlugin::Init() { this->jointExplicit = this->model->GetJoint(this->jointExplicitName); /* this->jointImplicit->SetStiffnessDamping(0, this->kpImplicit, this->kdImplicit); */ - this->updateConnection = event::Events::ConnectWorldUpdateBegin( - boost::bind(&SpringPlugin::ExplicitUpdate, this)); + this->updateConnection = event::Events::ConnectWorldUpdateBegin(boost::bind(&SpringPlugin::ExplicitUpdate, this)); } - - ///////////////////////////////////////////////// -void SpringPlugin::ExplicitUpdate() -{ +void SpringPlugin::ExplicitUpdate() { #if GAZEBO_MAJOR_VERSION < 9 common::Time currTime = this->model->GetWorld()->GetSimTime(); #else @@ -79,7 +67,6 @@ void SpringPlugin::ExplicitUpdate() double pos = this->jointExplicit->GetAngle(0).Radian(); double vel = this->jointExplicit->GetVelocity(0); - double force = -this->kpExplicit * pos - -this->kdExplicit * vel; + double force = -this->kpExplicit * pos - this->kdExplicit * vel; this->jointExplicit->SetForce(0, force); } diff --git a/src/SpringPlugin.hh b/src/SpringPlugin.hh index 586fa21..19d5bbd 100644 --- a/src/SpringPlugin.hh +++ b/src/SpringPlugin.hh @@ -13,7 +13,7 @@ * See the License for the specific language governing permissions and * limitations under the License. * -*/ + */ #ifndef __GAZEBO_SPRING_TEST_PLUGIN_HH__ #define __GAZEBO_SPRING_TEST_PLUGIN_HH__ @@ -23,31 +23,42 @@ #include "gazebo/physics/physics.hh" #include "gazebo/util/system.hh" -namespace gazebo -{ - class GAZEBO_VISIBLE SpringPlugin : public ModelPlugin - { - public: SpringPlugin(); - public: virtual void Load(physics::ModelPtr _model, sdf::ElementPtr _sdf); - public: virtual void Init(); +namespace gazebo { +class GAZEBO_VISIBLE SpringPlugin : public ModelPlugin { + public: + SpringPlugin(); - private: void ExplicitUpdate(); + public: + virtual void Load(physics::ModelPtr _model, sdf::ElementPtr _sdf); - private: event::ConnectionPtr updateConnection; + public: + virtual void Init(); - private: physics::ModelPtr model; + private: + void ExplicitUpdate(); - private: common::Time prevUpdateTime; + private: + event::ConnectionPtr updateConnection; - private: physics::JointPtr jointExplicit; - private: std::string jointExplicitName; + private: + physics::ModelPtr model; - /// \brief simulate spring/damper with ExplicitUpdate function - private: double kpExplicit; + private: + common::Time prevUpdateTime; - /// \brief simulate spring/damper with ExplicitUpdate function - private: double kdExplicit; + private: + physics::JointPtr jointExplicit; - }; -} + private: + std::string jointExplicitName; + + /// \brief simulate spring/damper with ExplicitUpdate function + private: + double kpExplicit; + + /// \brief simulate spring/damper with ExplicitUpdate function + private: + double kdExplicit; +}; +} // namespace gazebo #endif -- GitLab