High-Precision Docking of Differential-Drive Mobile Robots Through LiDAR and Vision Collaboration
Organizations: Beijing Institute of Technology
Abstract
Precise docking requires a differential-drive robot to correct lateral offset through coupled rotation and translation within a short approach distance. We combine global navigation with terminal control using complementary LiDAR and visual observations. A line fitted to the cabinet front gives normal distance and heading. An AprilTag identifies the workstation; intersecting its center ray with the LiDAR plane determines tangential position. Taught observations define the docking reference and can cancel repeatable fixed biases under unchanged mounting and geometry. Lateral pre-alignment and continuous visual servoing coordinate the approach, with predictive stopping to account for low-speed actuation lag. Across two sessions using the same navigation and docking code at five workstations on Robot 2, all 111 tasks completed, including 101 on the first attempt. Relative to the taught observations, onboard longitudinal, lateral and heading residual root-mean-square values were 1.51 mm, 5.93 mm and 0.238 degrees, respectively. Joint acceptance within plus or minus 10 mm per position axis and plus or minus 1 degree heading was 96.4% (107/111), or 95.5% (106/111) with a plus or minus 0.5 degree heading limit.
Figures & tables
| Method | Sensors | Extra hardware / target | Reported result and measurement |
| V-shaped features [ 6 ] | LiDAR | V-shaped workstation profile | Approx. mm ( ), ; two-stage physical tests; independent instrument and RMSE not specified |
| Intensity markers [ 7 ] | LiDAR, odometry, ultrasound | Reflective markers | 200 trials per scenario; docking success 99.5% / 98.5%; charging-bar positions inspected; no terminal pose-error statistics |
| Jia et al. [ 13 ] | Camera, LiDAR | Visually recognized charging station | No terminal error reported; 95% is charging-station image recognition accuracy; Gazebo and Husky demonstrations |
| Dai and Lee [ 14 ] | Camera, depth, LiDAR | AprilTag | No terminal error statistics; ruler used for pixel-to-3-D validation; docking convergence shown in Gazebo |
| This work | IR camera, 2-D LiDAR | Ordinary cabinet front and fixed AprilTag | Onboard planar residual root-mean-square error (RMSE) 6.12 mm; 111 taught-observation reproduction tasks |
| Symbol | Definition |
| M | Global map frame |
| O | Odometry frame |
| B | Robot body frame base_link |
| C | Infrared camera frame |
| F | Workstation surface frame |
| G | Taught goal frame |
| Component | Configuration |
| Drive and odometry | Differential drive; wheel–IMU fusion, Hz |
| LiDAR | LDS-E210-E; Hz; 180 ∘ ; 0.15 ∘ per beam |
| Cameras | Two Orbbec DaBai Max cameras; left IR 640 400, Hz |
| Tags | tag36h11; 150 mm side; P1–P5 correspond to IDs 20–24 |
| Computing | Thor and ECU; gigabit Ethernet |
| Software | ROS 2 Jazzy; slam_toolbox; Nav2 RPP |
| Group | Records | Rejected | Executed | Completed |
| 2 Nov startup | 9 | 0 | 9 | 9 |
| 2 Nov pressure | 131 | 29 | 102 | 102 |
| 28 Oct robustness | 22 | 0 | 22 | 18 |
| 28 Oct platform | 14 | 0 | 14 | 8 |
| 30 Oct platform | 146 | 96 | 50 | 44 |
| 30 Oct stability | 20 | 0 | 20 | 18 |
| Point | N | Accepted (95% CI) | x mean SD (mm) | y mean SD (mm) | Heading mean SD ( ∘ ) |
| P1 | 27 | 27/27 (87.5–100.0%) | -1.68 0.97 | -0.00 6.04 | -0.17 0.19 |
| P2 | 28 | 28/28 (87.9–100.0%) | -0.37 0.46 | -5.21 2.15 | -0.07 0.17 |
| P3 | 28 | 28/28 (87.9–100.0%) | -1.23 0.92 | +4.24 3.66 | -0.13 0.25 |
| P4 | 1 | 1/1 (20.7–100.0%) | -2.20 / — | +5.89 / — | -0.06 / — |
| P5 | 27 | 23/27 (67.5–94.1%) | -1.38 0.90 | +1.67 6.49 | -0.17 0.16 |
| All | 111 | 107/111 (91.1–98.6%) | -1.17 0.96 | +0.21 5.95 | -0.14 0.20 |
| Point | One attempt | RMSE (mm) | P95 (mm) | Maximum (mm) | Time mean SD (s) |
| P1 | 26/27 | 6.24 | 8.60 | 10.27 | 44.4 12.8 |
| P2 | 28/28 | 5.65 | 8.61 | 9.56 | 52.3 8.4 |
| P3 | 21/28 | 5.76 | 8.47 | 9.15 | 62.2 25.7 |
| P4 | 1/1 | 6.28 | 6.28 | 6.28 | 36.4 / — |
| P5 | 25/27 | 6.79 | 11.35 | 14.86 | 46.7 13.6 |
| All | 101/111 | 6.12 | 9.97 | 14.86 | 51.4 17.6 |
Appendix figures & tables1 asset
Supplementary material from the paper’s appendix.
Appendix
| Item | Value |
| Image offset / matching | / s |
| Staging setback | m |
| Control rate | 10 Hz |
| Heading floor / slope | ; rad/m |
| Predictive stopping | mm; s |
| Observation age / outage | / s |
Mobile Robotics
Mobile robotics studies how ground, aerial, and aquatic robots perceive, navigate, and act in changing real-world environments.
See all 151 papers