ROS2极简总结-Nav2-概述(中)控制器

举报
zhangrelay 发表于 2021/09/02 23:13:27 2021/09/02
【摘要】 上一节,主要介绍导航功能包Nav2的规划部分,本节为控制部分: 控制器概述  Controller 注意黄色部分,具体看下图。   插件 Plugins 控制器过程检查目标检查  控制器服务器 Controller Server [nav2_contro...

上一节,主要介绍导航功能包Nav2的规划部分,本节为控制部分:

控制器概述  Controller

注意黄色部分,具体看下图。

 


插件 Plugins

  • 控制器
  • 过程检查
  • 目标检查 

控制器服务器 Controller Server

[nav2_controller_server]

  • 输入:全局路径,代价地图
  • 输出:速度指令

默认为 DWB 控制器

发布速度:~/cmd_vel (geometry_msgs/Twist)

包含多个插件:

  • 轨迹生成器插件
  • 评分插件
  • 目标检查器插件

DWB控制器 DWB Controller

轨迹生成器插件

负责生成局部轨迹并输出指令速度。

目前有两个插件(一次只能加载一个):

  • 标准轨迹生成器
  • 有限加速器

  
  1. FollowPath:
  2. plugin: "dwb_core::DWBLocalPlanner"
  3. debug_trajectory_details: True
  4. min_vel_x: 0.0
  5. min_vel_y: 0.0
  6. max_vel_x: 0.22
  7. max_vel_y: 0.0
  8. max_vel_theta: 1.0
  9. min_speed_xy: 0.0
  10. max_speed_xy: 0.22
  11. min_speed_theta: 0.0

评分插件 Critic Plugins

对轨迹生成器生成的轨迹进行评分。 可以加载多个插件并将它们的分数添加到每个轨迹的最终分数中。

示例:

  • BaseObstacle:基于路径经过代价地图的位置
  • ObstacleFootprint:基于验证机器人足迹上的所有点都没有接触到代价地图中标记的障碍物。
  • GoalDist:基于轨迹使机器人与目标姿势的接近程度。
  • ...
 critics: ["RotateToGoal", "Oscillation", "BaseObstacle", "GoalAlign", "PathAlign", "PathDist", "GoalDist"]
 

目标检查器 Goal Checker

验证机器人是否达到了目标

目前有两个插件(一次只能加载一个):

  • SimpleGoalChecker - 检查位置以查看机器人是否已达到目标。
  • StoppedGoalChecker - 检查位置以及机器人是否已停止。

可以参数化目标“范围”(位置、旋转等...)。


  
  1. goal_checker:
  2. plugin: "nav2_controller::SimpleGoalChecker"
  3. xy_goal_tolerance: 0.25
  4. yaw_goal_tolerance: 0.25
  5. stateful: True


  
  1. controller_server:
  2. ros__parameters:
  3. use_sim_time: False
  4. controller_frequency: 20.0
  5. min_x_velocity_threshold: 0.001
  6. min_y_velocity_threshold: 0.5
  7. min_theta_velocity_threshold: 0.001
  8. controller_plugins: ["FollowPath"]
  9. # DWB parameters
  10. FollowPath:
  11. plugin: "dwb_core::DWBLocalPlanner"
  12. debug_trajectory_details: True
  13. min_vel_x: 0.0
  14. min_vel_y: 0.0
  15. max_vel_x: 0.22
  16. max_vel_y: 0.0
  17. max_vel_theta: 1.0
  18. min_speed_xy: 0.0
  19. max_speed_xy: 0.22
  20. min_speed_theta: 0.0
  21. # Add high threshold velocity for turtlebot 3 issue.
  22. # https://github.com/ROBOTIS-GIT/turtlebot3_simulations/issues/75
  23. acc_lim_x: 2.5
  24. acc_lim_y: 0.0
  25. acc_lim_theta: 3.2
  26. decel_lim_x: -2.5
  27. decel_lim_y: 0.0
  28. decel_lim_theta: -3.2
  29. vx_samples: 20
  30. vy_samples: 5
  31. vtheta_samples: 20
  32. sim_time: 1.7
  33. linear_granularity: 0.05
  34. angular_granularity: 0.025
  35. transform_tolerance: 0.2
  36. xy_goal_tolerance: 0.25
  37. trans_stopped_velocity: 0.25
  38. short_circuit_trajectory_evaluation: True
  39. stateful: True
  40. critics: ["RotateToGoal", "Oscillation", "BaseObstacle", "GoalAlign", "PathAlign", "PathDist", "GoalDist"]
  41. BaseObstacle.scale: 0.02
  42. PathAlign.scale: 32.0
  43. PathAlign.forward_point_distance: 0.1
  44. GoalAlign.scale: 24.0
  45. GoalAlign.forward_point_distance: 0.1
  46. PathDist.scale: 32.0
  47. GoalDist.scale: 24.0
  48. RotateToGoal.scale: 32.0
  49. RotateToGoal.slowing_factor: 5.0
  50. RotateToGoal.lookahead_time: -1.0
  51. controller_server_rclcpp_node:
  52. ros__parameters:
  53. use_sim_time: False

下一节介绍恢复器。


文章来源: zhangrelay.blog.csdn.net,作者:zhangrelay,版权归原作者所有,如需转载,请联系作者。

原文链接:zhangrelay.blog.csdn.net/article/details/120049188

【版权声明】本文为华为云社区用户转载文章,如果您发现本社区中有涉嫌抄袭的内容,欢迎发送邮件进行举报,并提供相关证据,一经查实,本社区将立刻删除涉嫌侵权内容,举报邮箱: cloudbbs@huaweicloud.com
  • 点赞
  • 收藏
  • 关注作者

评论(0

0/1000
抱歉,系统识别当前为高风险访问,暂不支持该操作

全部回复

上滑加载中

设置昵称

在此一键设置昵称,即可参与社区互动!

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。