中国机械工程 ›› 2024, Vol. 35 ›› Issue (02): 293-304.DOI: 10.3969/j.issn.1004-132X.2024.02.014

• 智能制造 • 上一篇    下一篇

基于改进量子粒子群优化算法的机器人逆运动学求解#br#
#br#

陈卓凡;周坤;秦菲菲;王斌锐   

  1. 中国计量大学机电工程学院,杭州,310018

  • 出版日期:2024-02-25 发布日期:2024-04-12
  • 通讯作者: 王斌锐(通信作者),男,1978年生,教授、博士研究生导师。研究方向为仿生机器人智能控制。E-mail:wangbrpaper@163.com。
  • 作者简介:陈卓凡,男,1999年生,硕士研究生。研究方向为工业机器人运动控制。E-mail:958002697@qq.com。
  • 基金资助:
    浙江省重点研发计划(2021C01069)

Inverse Kinematics Solution of Robots Based on IQPSO Algorithm

CHEN Zhuofan;ZHOU Kun;QIN Feifei;WANG Binrui   

  1. School of Mechanical and Electrical Engineering,China Jiliang University,Hangzhou,310018

  • Online:2024-02-25 Published:2024-04-12

摘要: 针对工业机器人在逆运动学求解过程中存在的位姿奇异、解不唯一、求解精度低等问题,提出了一种改进量子粒子群算法。首先,利用D-H参数法建立机器人运动学模型,以机械臂末端最小位姿误差为主要优化目标,加入运动前后关节角变化最小、行程平稳连续的约束条件,设计了目标函数;其次,通过采用Levy飞行策略改进粒子更新方式、非线性地动态调整收缩膨胀因子、采用变权重方法计算最优平均位置等方法设计了一种改进量子粒子群优化(IQPSO)算法;然后,模拟单点位姿和连续轨迹两种不同的求解情况进行三种算法(IQPSO、APSO、QPSO)的仿真对比实验,结果表明IQPSO算法具有收敛速度快、求解精度高等优点;最后,将IQPSO算法用于机械臂本体进行实物验证,实验结果表明IQPSO算法求解出的插值点所组成的轨迹连续且平滑,进一步证明了该算法应用于实际运动控制中的稳定性和可行性。

关键词: 工业机器人, 逆运动学求解, 目标函数, 改进量子粒子群优化算法

Abstract: Aiming at the problems of singular pose, non-unique solution and low solution precision in the inverse kinematics solution processes of general robots, an improved quantum particle swarm optimization algorithm was proposed. Firstly, the robot kinematics model was established by using the D-H parameter method, and the minimum pose errors at the end of the manipulators were the main optimization goal, and the constraints of the minimum joint angle changes before and after the movement and the smooth and continuous stroke were added, and the objective function was designed. Secondly, an IQPSO algorithm was designed by using the Levy flight strategy to improve the particle update method, nonlinear dynamic adjust the shrinkage and expansion factors, and using the variable weight method to calculate the optimal average position. Then, the simulation and comparison experiments of three algorithms(IQPSO,APSO,QPSO) were carried out by simulating two different solutions of single point pose and continuous trajectory. The results show that the IQPSO algorithm has the advantages of fast convergence speed and high solution accuracy; finally, the IQPSO algorithm was used in the body of the robot arm for physical verification. The results show that the trajectory composed of interpolation points obtained by the IQPSO algorithm is continuous and smooth, which further proves the stability and feasibility of the algorithm in practical motion control.

Key words: industrial robot, inverse kinematics solution, objective function, improved quantum particle swarm optimization(IQPSO) algorithm

中图分类号: