hitch_estimation_apriltag_array

A package that estimates the hitch joint state between a robot and a

trailer by optical recognition of an array of April tags mounted at the front of the trailer by the rear camera of the robot

README

hitch_estimation_apriltag_array

The hitch_estimation_apriltag_array package is intended to estimate the angle between a mobile base and a cart that is hitched to its rear. The calculation is performed by estimating the 6DOF transform between a rear-facing RGB camera assumed to be mounted at the rear of the mobile base and an array of forward-facing April tags mounted at the front of the cart.

Parameters

April tag sizes, frames, topics, etc are set in the launchers

  • apriltag_ros.launch.xml

  • apriltag_array_pose_estimation.launch.xml

  • hitch_joint_state_estimation.launch.xml

Launch

Estimate the angle between the mobile base and the trailer with

ros2 launch hitch_estimation_apriltag_array hitch_estimation_apriltag_array.launch.xml

Instead, if you wish to estimate only the transform of the April tag array with respect to the RGB camera, comment out the last include, namely

<include file="$(find-pkg-share hitch_estimation_apriltag_array)/launch/hitch_joint_state_estimation.launch.xml"/>

In action

The utility of this package is to facilitate motion planning and control during autonomous navigation of articulated vehicles. See video:

hitch_estimation_apriltag_array in action

ROS 2 buildfarm build status

Build Status