[发明专利]一种机械臂运动路径的确定方法及确定系统

摘要

本发明公开一种机械臂运动路径的确定方法及确定系统。本发明建立机械臂运动学模型后，根据运动学模型、机械臂末端理论坐标和支臂长构造多目标优化函数。然后判断进化种群中使优化函数中的横向误差优化函数和纵向误差优化函数的单调性均为递增或递减的个体数量是否达到阈值，若是，采用单目标进化算法确定最优解；否则，采用多目标进化算法确定最优解。本发明能够根据种群中使优化函数中的横向误差优化函数和纵向误差优化函数的单调性均为递增或递减的个体数量自适应选择采用多目标进化算法还是单目标进化算法求解优化函数，因此，本发明结合了单目标进化算法耗时短，多目标进化算法精确度高的优点，能够快速精确地规划机械臂的运动路径。

主权项

1.一种机械臂运动路径的确定方法，其特征在于，所述确定方法包括：获取机械臂的末端理论坐标、机械臂的支臂长及机械臂的底座关节转角；根据所述底座关节转角建立所述机械臂的运动学模型；根据所述运动学模型、所述末端理论坐标和所述支臂长构造优化函数，所述优化函数包括以所述机械臂的横向投影长度误差最小为优化目标的横向误差优化函数和以所述机械臂的竖向投影长度误差最小为优化目标的纵向误差优化函数；获取第t代进化种群Pt，所述种群中包括多个个体，每个个体为所述机械臂的一组支臂关节转角，0＜t≤T，T表示进化代数阈值；判断所述种群中使所述优化函数的单调性为递增或递减的个体数量是否大于或者等于预设的单调性阈值，获得第一判断结果；当所述第一判断结果表示所述种群中使所述优化函数的单调性为递增或递减的个体数量大于或者等于单调性阈值时，采用单目标进化算法确定所述优化函数的最优解；当所述第一判断结果表示所述种群中使所述优化函数的单调性为递增或递减的个体数量小于单调性阈值时，采用多目标进化算法确定所述优化函数的最优解；根据所述最优解确定所述机械臂的运动路径。