Accurate Pose Prediction on Signed Distance Fields for Mobile Ground Robots in Rough Terrain (2405.02121v1)
Abstract: Autonomous locomotion for mobile ground robots in unstructured environments such as waypoint navigation or flipper control requires a sufficiently accurate prediction of the robot-terrain interaction. Heuristics like occupancy grids or traversability maps are widely used but limit actions available to robots with active flippers as joint positions are not taken into account. We present a novel iterative geometric method to predict the 3D pose of mobile ground robots with active flippers on uneven ground with high accuracy and online planning capabilities. This is achieved by utilizing the ability of signed distance fields to represent surfaces with sub-voxel accuracy. The effectiveness of the presented approach is demonstrated on two different tracked robots in simulation and on a real platform. Compared to a tracking system as ground truth, our method predicts the robot position and orientation with an average accuracy of 3.11 cm and 3.91{\deg}, outperforming a recent heightmap-based approach. The implementation is made available as an open-source ROS package.
- I. Kruijff-Korbayová, R. Grafe, N. Heidemann, A. Berrang, C. Hussung, C. Willms, P. Fettke, M. Beul, J. Quenzel, D. Schleich, et al., “German rescue robotics center (drz): A holistic approach for robotic systems assisting in emergency response,” in SSRR. IEEE, 2021, pp. 138–145.
- K. Otsu, G. Matheron, S. Ghosh, O. Toupet, and M. Ono, “Fast approximate clearance evaluation for rovers with articulated suspension systems,” J. Field Robot., vol. 37, no. 5, pp. 768–785, 2020.
- K. Becker, M. Oehler, and O. Von Stryk, “3d coverage path planning for efficient construction progress monitoring,” in SSRR. IEEE, 2022, pp. 174–179.
- M. Norouzi, J. V. Miro, and G. Dissanayake, “Planning stable and efficient paths for reconfigurable robots on uneven terrain,” JINT, vol. 87, pp. 291–312, 2017.
- M. Oehler, S. Kohlbrecher, and O. von Stryk, “Optimization-based planning for autonomous traversal of obstacles with mobile ground robots,” Int. J. Mech. Control., no. 1, pp. 33–40, 2020.
- A. Elfes, “Using occupancy grids for mobile robot perception and navigation,” Computer, vol. 22, no. 6, pp. 46–57, 1989.
- M. Wermelinger, P. Fankhauser, R. Diethelm, P. Krüsi, R. Siegwart, and M. Hutter, “Navigation planning for legged robots in challenging terrain,” in IROS. IEEE, 2016, pp. 1184–1189.
- H. Oleynikova, Z. Taylor, M. Fehr, R. Siegwart, and J. Nieto, “Voxblox: Incremental 3d euclidean signed distance fields for on-board mav planning,” in IROS. IEEE, 2017, pp. 1366–1373.
- P. Papadakis, “Terrain traversability analysis methods for unmanned ground vehicles: A survey,” Eng. Appl. Artif. Intell., vol. 26, no. 4, pp. 1373–1385, 2013.
- M. Brunner, T. Fiolka, D. Schulz, and C. M. Schlick, “Design and comparative evaluation of an iterative contact point estimation method for static stability estimation of mobile actively reconfigurable robots,” Robot. Auton. Syst., vol. 63, pp. 89–107, 2015.
- J.-Y. Jun, J.-P. Saut, and F. Benamar, “Pose estimation-based path planning for a tracked mobile robot traversing uneven terrains,” Robot. Auton. Syst., vol. 75, pp. 325–339, 2016.
- Y. Ma and Z. Shiller, “Pose estimation of vehicles over uneven terrain,” arXiv preprint arXiv:1903.02052, 2019.
- R. Thakker, N. Alatur, D. D. Fan, J. Tordesillas, M. Paton, K. Otsu, O. Toupet, and A.-a. Agha-mohammadi, “Autonomous off-road navigation over extreme terrains with perceptually-challenging conditions,” in ISER. Springer, 2021, pp. 161–173.
- S. Fabian, S. Kohlbrecher, and O. Von Stryk, “Pose prediction for mobile ground robots in uneven terrain based on difference of heightmaps,” in SSRR. IEEE, 2020, pp. 49–56.
- V. Šalanskỳ, K. Zimmermann, T. Petříček, and T. Svoboda, “Pose consistency kkt-loss for weakly supervised learning of robot-terrain interaction model,” IEEE RA-L, vol. 6, no. 3, pp. 5477–5484, 2021.
- A. M. Andrew, “Another efficient algorithm for convex hulls in two dimensions,” Inf. Process. Lett., vol. 9, no. 5, pp. 216–219, 1979.
- E. Papadopoulos and D. A. Rey, “The force-angle measure of tipover stability margin for mobile manipulators,” Veh. Syst. Dyn., vol. 33, no. 1, pp. 29–48, 2000.
- P. Fankhauser, M. Bloesch, and M. Hutter, “Probabilistic terrain mapping for mobile robots with uncertain localization,” IEEE RA-L, vol. 3, no. 4, pp. 3019–3026, 2018.
- K. Daun, M. Schnaubelt, S. Kohlbrecher, and O. von Stryk, “Hectorgrapher: Continuous-time Lidar SLAM with multi-resolution signed distance function registration for challenging terrain,” in SSRR, 2021, pp. 152–159.