|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |
Launch files
Messages
Services
Plugins
Recent questions tagged mrpt_trajectory_follower at Robotics Stack Exchange
|
mrpt_trajectory_follower package from mrpt_navigation repomrpt_map_server mrpt_msgs_bridge mrpt_nav_interfaces mrpt_navigation mrpt_pf_localization mrpt_pointcloud_pipeline mrpt_reactivenav2d mrpt_tps_astar_planner mrpt_trajectory_follower mrpt_tutorials |
ROS Distro
|
Package Summary
| Version | 2.9.0 |
| License | BSD |
| Build type | AMENT_CMAKE |
| Use | RECOMMENDED |
Repository Summary
| Description | |
| Checkout URI | https://github.com/mrpt-ros-pkg/mrpt_navigation.git |
| VCS Type | git |
| VCS Version | ros2 |
| Last Updated | 2026-11-22 |
| Dev Status | DEVELOPED |
| Released | RELEASED |
| Contributing |
Help Wanted (-)
Good First Issues (-) Pull Requests to Review (-) |
Package Description
Additional Links
Maintainers
- Jose-Luis Blanco-Claraco
Authors
- Jose-Luis Blanco-Claraco
mrpt_trajectory_follower
Overview
This package provides a ROS 2 node (also available as a composable node) that
makes a wheeled robot (differential drive or Ackermann) follow a path, usually
one computed by mrpt_tps_astar_planner. It is a
wrapper of mpp::TrajectoryFollower from
mrpt_path_planning:
- Curvature-adaptive pure-pursuit tracking, with a speed profile that respects the robot kinematic limits (speed, acceleration, lateral acceleration, angular speed).
- Predictive safety: if a footprint and an obstacle source are available, the
commanded motion is forecast, and the robot slows down or stops before any
contact. Staying stopped longer than
block_timeoutreportsBlocked. - An optional last-resort collision guard (
collision_guard), applied to every command using only the latest obstacles in the robot frame: the speed is limited so the robot can always brake before touching an obstacle, and missing or stale obstacle data stop the robot. - Optional replanning on failure (off the path, blocked), by calling the
planner
make_plan_toservice (replan_on_failure). Paths received asReferencePathare not replanned here: their planner does it, watching this node status. - A run-time speed limit (
speed_limitparameter or~/speed_limittopic).
The robot footprint is taken from the PTG INI file (ptg_ini, the same file
used by the planner), or from robot_radius as a fallback. If it differs
from the footprint published by the planner, paths are rejected (status
Failed).
Demos
ros2 launch mrpt_tutorials demo_astar_trajectory_follower_gridmap.launch.py \
robot:=ackermann speed_limit:=1.0
See the repository README and
mrpt_tutorials for this and the other demos
(demo_astar_trajectory_follower_street.launch.py,
demo_astar_trajectory_follower_mvsim_3d.launch.py).
Node: mrpt_trajectory_follower_node
Subscribed topics
-
<topic_path_sub>(nav_msgs/Path): path to follow. An empty path cancels the current navigation. -
<topic_reference_path_sub>(mrpt_nav_interfaces/ReferencePath): path from a planner that keeps updating it while the robot moves (goal id, revision, and whether it is partial). Disabled if empty. -
<topic_odom_sub>(nav_msgs/Odometry): robot odometry. -
<topic_obstacles_sub>(sensor_msgs/PointCloud2): obstacles, e.g. from mrpt_pointcloud_pipeline. Disabled if empty. -
<topic_robot_shape_sub>(geometry_msgs/PolygonStamped): the planner footprint, to check it matches this node one. Disabled if empty. -
~/speed_limit(std_msgs/Float64): run-time speed limit [m/s] (<=0: none). -
/tf: robot pose inframe_id_map.
Published topics
-
<topic_cmd_vel_pub>(geometry_msgs/Twist, orgeometry_msgs/TwistStampedinframe_id_robotifcmd_vel_stampedis true): velocity commands. -
~/status(std_msgs/String, latched): follower status:Idle,Running,ReachedGoal,Blocked,OffPathExceeded,MissedGoal,WaitingForPath,Replanning,Canceled, orFailed. -
~/status_ex(mrpt_nav_interfaces/FollowerStatus, latched): the same status, with the goal id and revision of the path it refers to. -
~/predicted_trajectory(nav_msgs/Path): the predicted short-term motion. -
~/reference_path(nav_msgs/Path, latched): the path being followed.
Service clients
-
<planner_service>(mrpt_nav_interfaces/MakePlanTo): only ifreplan_on_failureis true.
Parameters
| Name | Default | Description |
|---|---|---|
frame_id_map |
"map" |
Map frame. |
frame_id_robot |
"base_link" |
Robot frame. |
topic_path_sub |
"/waypoints_path" |
Input path topic. |
topic_reference_path_sub |
"/waypoints_reference" |
Input ReferencePath topic. |
topic_odom_sub |
"/odom" |
Odometry topic. |
topic_obstacles_sub |
"" |
Obstacles topic. |
topic_cmd_vel_pub |
"/cmd_vel" |
Output velocity command topic. |
cmd_vel_stamped |
false |
Publish TwistStamped instead of Twist. |
ptg_ini |
"" |
PTG INI file, to take the robot footprint from. |
robot_radius |
0.0 |
Circular footprint [m], if no ptg_ini is given. |
follower_parameters |
"" |
YAML file with the follower parameters (see below). |
follower_parameters_overrides |
"" |
YAML file overriding some of them, e.g. per robot. |
speed_limit |
0.0 |
Run-time speed limit [m/s] (<=0: none). Can be changed with ros2 param set. |
obstacle_z_min, obstacle_z_max
|
-1e6, 1e6
|
Height band [m] (robot frame) of obstacle points, e.g. to use a raw 3D LiDAR. |
self_filter_radius |
0.0 |
Drop obstacle points within this radius [m] of the robot (<=0: disabled). |
collision_guard |
true |
Enable the last-resort collision guard (needs topic_obstacles_sub). |
replan_on_failure |
false |
Request a new plan when off the path or blocked. |
max_replan_attempts |
3 |
Max replans since the last externally given path. |
planner_service |
"/mrpt_tps_astar_planner_node/make_plan_to" |
Planner service for replanning. |
topic_robot_shape_sub |
"/mrpt_tps_astar_planner_node/robot_shape" |
Planner footprint topic. |
follower_debug_trace |
false |
Print the follower internal per-cycle trace. |
File truncated at 100 lines see the full file
Changelog for package mrpt_trajectory_follower
2.9.0 (2026-11-14)
- Integration test: stale obstacle data stop the robot, which drives on once the data are back.
- Contributors: Jose Luis Blanco-Claraco
2.8.0 (2026-11-01)
- Aisle maneuvers test: relax the cross-track bound to 0.25 m for loaded CI runners (#213)
- Contributors: Jose Luis Blanco-Claraco
2.7.0 (2026-10-29)
- Stop when off path, collision guard (slowing down to its limit in advance), speed limit, replanning support.
- Follow ReferencePath updates from the planner; never resume a path once its goal is reached.
- Report and hold Blocked when the robot does not move although commanded to.
- Fresh robot pose, ROS-clock control loop, parallel obstacle processing.
- Optional geometry_msgs/TwistStamped output (cmd_vel_stamped); composable node.
- Integration tests for aisle maneuvers and blocked robots in mvsim.
- Contributors: Jose Luis Blanco-Claraco
2.6.1 (2026-10-02)
2.6.0 (2026-10-01)
- Merge pull request #175 from mrpt-ros-pkg/mrpt3
- Merge ros2 into mrpt3
- trajectory_follower: update sample config comments for the vehicle-centered control-pose filter
- trajectory_follower: document tight anchor_max_ang_divergence for jittery localization
- mrpt_trajectory_follower: document new TrajectoryFollower params
- trajectory_follower: wire follower_debug_trace param to logger verbosity
- add new upstream params
- follower params: switch to curvature-adaptive lookahead knobs
- Merge pull request #172 from mrpt-ros-pkg/fix/follower-cmd-vel-idle-silence
- trajectory_follower: only publish cmd_vel while actively driving
- update to use new mpp lib structure
- fix: mpp follow lib header reorganization
- Merge pull request #171 from mrpt-ros-pkg/feat/follower-arrival-radius
- feat(trajectory_follower): expose arrival_radius param
- Merge pull request #170 from mrpt-ros-pkg/feat/trajectory-follower-node
- fix cmake linter and tolerances
- fix(trajectory_follower): address code review
- build(trajectory_follower): guard node on mpp::TrajectoryFollower header
- feat(trajectory_follower): 3D-lidar obstacle conditioning, path dedup
- feat(trajectory_follower): new node wrapping mpp::TrajectoryFollower
- Contributors: Jose Luis Blanco-Claraco
Package Dependencies
System Dependencies
Dependant Packages
| Name | Deps |
|---|---|
| mrpt_navigation |