Point cloud registration is the basis of real-time environment perception for robots using 3D LiDAR and is also the key to robust simultaneous localization and mapping (SLAM) for robots. Because LiDAR point clouds are characterized by local sparseness and motion distortion, the point cloud features of coal mine roadway environments show a weak texture and degradation. Therefore, for these environments, the traditional point cloud registration method to register directly will lead to problems, such as a decline in registration accuracy, z-axis drift, and map ghosting. To solve the above problems, we propose a point cloud registration method based on IMU preintegration with the sensor characteristics of LiDAR and IMU. The system framework of this method mainly consists of four modules: IMU preintegration, point cloud preprocessing, point cloud frame matching and point cloud registration. First, IMU sensor data are introduced, and IMU linear interpolation is used to correct the motion distortion in LiDAR scanning, and the IMU preintegration error function is constructed. Second, the point cloud segmentation is performed using the ground segmentation method of RANSAC to provide additional ground constraints for the z-axis displacement and to remove the unstable flawed points from the point cloud. On this basis, the LiDAR point cloud registration error function is constructed by extracting the feature corner points and feature plane points. Finally, the Gaussian Newton solution is used to optimize the constraint relationship between the LiDAR odometry frames to minimize the error function, complete the LiDAR point cloud registration and better estimate the position and pose of the mobile robot. The experimental results show that compared with the traditional point cloud registration method, the proposed method has a higher point cloud registration accuracy, success rate and computational efficiency. The LiDAR odometry constructed using this method can better reflect the authenticity of the robot trajectory and has higher trajectory accuracy and smaller absolute position and pose error.
The separation of gangues from coals with robots is an effective and practicable means. Therefore, a cable-suspended gangue-sorting robot (CSGSR) with an end-grab was developed in our early work. Due to the unidirectional characteristic, the flexibility of cables, and the dynamic impact of pick-and-place gangues, one of the significant issues with the robots is robustness under internal and external disturbances. Cable tensions, being the end-grab’s constraints, have a crucial effect on the robustness of the CSGSR while disturbances are on. Two main issues related to the CSGSR, as a result, are addressed in the present paper: minimum dynamic cable tension workspace generation and a sensitivity analysis method for the dynamic cable tensions. Firstly, the four cable tensions and minimum dynamic cable tension while the end-grab was located at an arbitrary position of the task space were obtained with the dynamics of the CSGSR. In addition, with the dynamics of the CSGSR, a minimum dynamic cable tension workspace (MDCTW) generating approach is presented, where the minimum dynamic cable tensions are greater than a preset value, therefore ensuring the robustness of the end-grab under the disturbances. Secondly, a method for dynamic cable tension sensitivity (DCTS) of the robots is proposed with grey relational analysis, by which the influence degree of the end-grab’s positions on the four dynamic cable tensions and the minimum dynamic cable tensions was considered. Finally, the effectiveness of the proposed MDCTW generation algorithm and the DCTS analysis method were examined through simulation on the CSGSR, and it was indicated that the proposed MDCTW generation algorithm and the DCTS analysis method were able to provide theoretical guidance for pick-and-place trajectory planning and generation of the end-grab in practice.
Equipped with one degree of freedom in one-dimensional translation of the base, a mobile dual-arm robot (MDAR) is proposed in this paper, and the two arms and the base move simultaneously. As a result, the motion of the base has a significant influence on the motion of both end-effectors at the same time, and the relative positions of the two end-effectors change all the time. Therefore, this paper focuses on the main issues related to the presented MDAR in two key areas: the relative dynamics and relative force/position hybrid control. First, based on the D-H parametric method, the relative kinematics of the proposed MDAR is established, and the relative Jacobian matrix of the robot is derived. Secondly, the dynamic model of the proposed MDAR is constructed using the Lagrangian method. Furthermore, a closed-loop control strategy for relative force/position hybrid control of the MDAR based on the relative dynamics is proposed to enable the two end-effectors of the MDAR to track the planned trajectory accurately. Finally, a simulation is carried out on a dual-arm cutting robot (DACR) for a coal mine to prove the effectiveness of the proposed relative dynamics and the proposed relative force/position hybrid control law in terms of the absolute error (AE) and root mean square error (RMSE). The results show that the proposed relative dynamic model and relative force/position hybrid control can significantly reduce error of the DACR, effectively improve the adaptability and operation accuracy of the system to complex environment, and verify the feasibility and superiority of the method in practical application.