CK-SLAM, Crop-Row and Kinematics-Constrained SLAM for Quadruped Robots Under Corn Canopies

To address the localization and mapping challenges for quadruped robots autonomously scouting under corn canopies, this paper proposes CK-SLAM, a SLAM algorithm integrating robot motion constraints and crop row features. The algorithm is implemented on the Jueying Mini quadruped robot, fusing data from 3D LiDAR, IMU, and joint sensors. First, an Invariant Extended Kalman Filter (InEKF) fuses multi-source motion information, dynamically adjusting observation noise via a foot contact probability model (derived from joint torque data) to achieve initial motion state estimation and reliable pose references for point cloud deskewing. Second, three feature extraction schemes are designed, inheriting line/plane features from LeGO-LOAM and adding an innovative crop plane feature extraction module, which uses grid filtering, differential evolution for crop row detection, and RANSAC plane fitting to capture corn plant structural features. Finally, a two-step Levenberg–Marquardt iteration realizes feature matching and pose optimization, with factor graph optimization fusing motion constraints and laser odometry for global trajectory and map refinement. CK-SLAM effectively adapts to gait-induced measurement noise and enhances feature matching stability under canopies. Experimental validation across four corn growth stages shows it achieves an average Absolute Pose Error (APE) RMSE of 2.0939 m (15.7%/56.4%/72.2% lower than A-LOAM/LeGO-LOAM/Point-LIO) and an average Relative Pose Error (RPE) RMSE of 0.0946 m, providing high-precision navigation support for automated field monitoring.