
A comprehensive ROS-based project that involved developing and implementing a pose-based SLAM algorithm for the robot (in simulation and in the real world) where the iterative closest point (ICP) algorithm was used for registering LiDAR scans. By fusing the registration outcome with data from the robot’s IMU, the robot’s pose was updated in a timely manner. Additionally, we developed an algorithmic method of constraining the size of the state vector while maintaining the fidelity of the robot’s entire trajectory.
The aforementioned algorithms were first implemented and evaluated extensively in different Stonefish simulation environments to verify their robustness. Finally, the overall SLAM pipeline was deployed on the actual hardware (alongside perception, planning, exploration, and manipulation modules) for fully autonomous pick-transport-and-place applications.