四自由度串联机器人逆运动学求解方法和系统

摘要

本发明提供了一种四自由度串联机器人逆运动学求解方法和系统，包括建立各连杆坐标系、求机器人的运动学正解、根据机器人末端位姿求解机器人各关节转角/位移，对关节超程错误进行报警，对机器人各关节进行行程约束。本发明能够根据机器人的位形唯一确定机器人的逆解，并判断目标位姿的可达性，能够根据期望的机器人位形求解对应的逆解，在多解的情况下实现逆解可控，有利于进行路径规划及避障。