Skip to content

Commit

Permalink
Update planning/behavior_path_planner/src/scene_module/dynamic_avoida…
Browse files Browse the repository at this point in the history
…nce/dynamic_avoidance_module.cpp
  • Loading branch information
takayuki5168 committed Aug 19, 2023
1 parent dde50c6 commit 0d81c72
Showing 1 changed file with 2 additions and 2 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -108,8 +108,8 @@ std::pair<double, double> projectObstacleVelocityToTrajectory(
const size_t obj_idx = motion_utils::findNearestIndex(path_points, obj_pose.position);

const double obj_vel_yaw = std::atan2(
object.kinematics.initial_twist_with_covariance.twist.linear.x,
object.kinematics.initial_twist_with_covariance.twist.linear.y);
object.kinematics.initial_twist_with_covariance.twist.linear.y,
object.kinematics.initial_twist_with_covariance.twist.linear.x);
const double path_yaw = tf2::getYaw(path_points.at(obj_idx).point.pose.orientation);

return std::make_pair(
Expand Down

0 comments on commit 0d81c72

Please sign in to comment.