[Gimablrotor] add an attribute of control loop duration to initialize…

… basenavigator
sugihara-16 · Nov 26, 2023 · 64de36c · 64de36c
1 parent 149cbca
commit 64de36c
Show file tree

Hide file tree

Showing 2 changed files with 5 additions and 3 deletions.
diff --git a/robots/gimbalrotor/include/gimbalrotor/gimbalrotor_navigation.h b/robots/gimbalrotor/include/gimbalrotor/gimbalrotor_navigation.h
@@ -15,7 +15,8 @@ namespace aerial_robot_navigation
 
     void initialize(ros::NodeHandle nh, ros::NodeHandle nhp,
                     boost::shared_ptr<aerial_robot_model::RobotModel> robot_model,
-                    boost::shared_ptr<aerial_robot_estimation::StateEstimator> estimator) override;
+                    boost::shared_ptr<aerial_robot_estimation::StateEstimator> estimator,
+                    double loop_du) override;
 
     void update() override;
 

diff --git a/robots/gimbalrotor/src/gimbalrotor_navigation.cpp b/robots/gimbalrotor/src/gimbalrotor_navigation.cpp
@@ -14,10 +14,11 @@ GimbalrotorNavigator::GimbalrotorNavigator():
 
 void GimbalrotorNavigator::initialize(ros::NodeHandle nh, ros::NodeHandle nhp,
                                    boost::shared_ptr<aerial_robot_model::RobotModel> robot_model,
-                                   boost::shared_ptr<aerial_robot_estimation::StateEstimator> estimator)
+                                      boost::shared_ptr<aerial_robot_estimation::StateEstimator> estimator,
+                                      double loop_du)
 {
   /* initialize the flight control */
-  BaseNavigator::initialize(nh, nhp, robot_model, estimator);
+  BaseNavigator::initialize(nh, nhp, robot_model, estimator, loop_du);
 
   curr_target_baselink_rot_pub_ = nh_.advertise<spinal::DesireCoord>("desire_coordinate", 1);
   final_target_baselink_rot_sub_ = nh_.subscribe("final_target_baselink_rot", 1, &GimbalrotorNavigator::setFinalTargetBaselinkRotCallback, this);