实现了机器人机械爪抓取和放置物体的demo。实现了物体的自动识别与机械臂的运动规划,实现了机器人的即时导航与定位功能。在仿真平台上实现了机械爪的抓取和放置,并实现了人机协同。最终的机器人既可独立完成抓取任务,也可以在人工辅助下完成抓取任务。
整个过程包括相机标定、物体识别和位姿估计、导航、运动规划和抓取五个步骤。相机标定的目的是获取机器人坐标系和世界坐标系的变换矩阵,让机器人能够准确识别目标物体的位置。物体识别和位姿估计是采用LINEMOD和ICP算法相结合的方式,确定物体的位置和合适的抓取位姿。导航是利用SLAM算法,动态建立地图,使机器人从起始位置到达目标物体所在位置附近。运动规划是采用RRT及RRTconnect算法生成机械臂末端执行器从起始姿态到终点抓取姿态的运动轨迹。运动规划完成后,即可驱动机械臂抓取目标物体。