adapt names to final PR

PX4 · Oct 18, 2019 · de271fb · de271fb
1 parent 86e3484
commit de271fb
Show file tree

Hide file tree

Showing 4 changed files with 7 additions and 7 deletions.
diff --git a/avoidance/include/avoidance/common.h b/avoidance/include/avoidance/common.h
@@ -96,7 +96,7 @@ struct ModelParameters {
 
   // TODO: add estimator limitations for max speed and height
 
-  float param_mpc_cp_dist = NAN; // Collision Prevention distance to keep from obstacle. -1 for disabled
+  float param_cp_dist = NAN; // Collision Prevention distance to keep from obstacle. -1 for disabled
   // clang-format on
 };
 

diff --git a/avoidance/src/avoidance_node.cpp b/avoidance/src/avoidance_node.cpp
@@ -115,7 +115,7 @@ void AvoidanceNode::px4ParamsCallback(const mavros_msgs::Param& msg) {
   parse_param_f("MPC_XY_CRUISE", px4_.param_mpc_xy_cruise) ||
   parse_param_f("MPC_Z_VEL_MAX_DN", px4_.param_mpc_vel_max_dn) ||
   parse_param_f("MPC_Z_VEL_MAX_UP", px4_.param_mpc_z_vel_max_up) ||
-  parse_param_f("MPC_CP_DIST", px4_.param_mpc_cp_dist) ||
+  parse_param_f("CP_DIST", px4_.param_cp_dist) ||
   parse_param_f("NAV_ACC_RAD", px4_.param_nav_acc_rad);
   // clang-format on
 }
@@ -131,11 +131,11 @@ void AvoidanceNode::checkPx4Parameters() {
   };
   while (!should_exit_) {
     request_param("MPC_XY_CRUISE", px4_.param_mpc_xy_cruise);
-    request_param("MPC_CP_DIST", px4_.param_mpc_cp_dist);
+    request_param("CP_DIST", px4_.param_cp_dist);
     request_param("MPC_LAND_SPEED", px4_.param_mpc_land_speed);
     request_param("NAV_ACC_RAD", px4_.param_nav_acc_rad);
 
-    if (!std::isfinite(px4_.param_mpc_xy_cruise) || !std::isfinite(px4_.param_mpc_cp_dist) ||
+    if (!std::isfinite(px4_.param_mpc_xy_cruise) || !std::isfinite(px4_.param_cp_dist) ||
         !std::isfinite(px4_.param_mpc_land_speed) || !std::isfinite(px4_.param_nav_acc_rad)) {
       std::this_thread::sleep_for(std::chrono::seconds(5));
     } else {

diff --git a/local_planner/src/nodes/local_planner.cpp b/local_planner/src/nodes/local_planner.cpp
@@ -118,7 +118,7 @@ void LocalPlanner::determineStrategy() {
   cost_image_data_.clear();
   cost_image_data_.resize(3 * GRID_LENGTH_E * GRID_LENGTH_Z, 0);
 
-  create2DObstacleRepresentation(px4_.param_mpc_cp_dist > 0.f);
+  create2DObstacleRepresentation(px4_.param_cp_dist > 0.f);
 
   // calculate the vehicle projected position on the line between the previous and current goal
   Eigen::Vector2f u_prev_to_goal = (goal_ - prev_goal_).head<2>().normalized();
@@ -198,7 +198,7 @@ void LocalPlanner::setDefaultPx4Parameters() {
   px4_.param_mpc_xy_cruise = 3.f;
   px4_.param_mpc_tko_speed = 1.f;
   px4_.param_mpc_land_speed = 0.7f;
-  px4_.param_mpc_cp_dist = 4.f;
+  px4_.param_cp_dist = 4.f;
 }
 
 void LocalPlanner::getTree(std::vector<TreeNode>& tree, std::vector<int>& closed_set,

diff --git a/local_planner/src/nodes/local_planner_node.cpp b/local_planner/src/nodes/local_planner_node.cpp
@@ -425,7 +425,7 @@ void LocalPlannerNode::dynamicReconfigureCallback(avoidance::LocalPlannerNodeCon
 
 void LocalPlannerNode::publishLaserScan() const {
   // inverted logic to make sure values like NAN default to sending the message
-  if (!(local_planner_->px4_.param_mpc_cp_dist < 0)) {
+  if (!(local_planner_->px4_.param_cp_dist < 0)) {
     sensor_msgs::LaserScan distance_data_to_fcu;
     local_planner_->getObstacleDistanceData(distance_data_to_fcu);