A quadruped robot positioning and mapping method and device in a complex terrain environment, a terminal and a medium
By constructing a state estimation observation model and a confidence-aware planar constraint update mechanism, the instability of state estimation and elevation drift in the localization and mapping of quadruped robots under complex terrain are solved, achieving high-precision 3D mapping and robust pose estimation.
Patent Information
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- SHENZHEN UNIV
- Filing Date
- 2026-04-03
- Publication Date
- 2026-07-14
AI Technical Summary
Existing technologies for localization and mapping of quadruped robots in complex terrain environments suffer from state estimation instability, sensor data distortion, and elevation drift, making it particularly difficult to achieve high-precision 3D mapping in highly dynamic and unstructured environments.
By constructing a state estimation observation model and combining inertial measurement data and leg motor data, motion state estimation is performed. Based on a confidence-aware planar constraint update mechanism, the state estimation process of the quadruped robot is optimized. Motion compensation and point cloud registration are performed by combining LiDAR point cloud data, and a three-dimensional voxel map is output.
It improves the stability of pose estimation and the accuracy of 3D mapping for quadruped robots in complex terrain, and can provide reliable short-time pose estimation and high-quality 3D mapping under irregular motion conditions, thus enhancing the robustness and consistency of the system.
Smart Images

Figure CN121977535B_ABST