CN110543727B - 一种基于改进粒子群算法的全向移动智能轮椅机器人参数辨识方法 - Google Patents

Abstract

本发明涉及一种基于改进粒子群算法的全向移动智能轮椅机器人参数辨识方法，属于智能机器人技术领域，用于解决传统方法在处理复杂问题时容易产生早熟收敛现象以及搜索能力相对不足的问题。首先分析得到全向移动智能轮椅机器人运动学模型表达式；然后分别识别横向、纵向和姿态运动的参数，具体识别方法相同，即仅控制轮椅机器人在待识别方向上运动；根据目标函数计算每个粒子的适应度，并记录当前所有的粒子位置；更新群体中所有粒子的位置和速度；根据目标函数计算更新后粒子的适应度，寻找每个粒子的局部最优解，并从局部最优解中寻找截至目前所有粒子的全局最优解；达到最大迭代次数时即得到的全局最优解。

Description

一种基于改进粒子群算法的全向移动智能轮椅机器人参数辨 识方法

技术领域

本发明是一种基于改进粒子群算法的全向移动智能轮椅机器人参数辨识方法，属于智能机器人技术领域。

背景技术

机器人参数辨识是机器人控制领域的一个重要课题，其根据机器人系统的响应数据来确定机器人动力学和运动学特性的数学模型。对于许多的机器人领域，由于结构比较复杂，不能用传统的建模分析法获得精确的数学模型，只能通过系统辨识技术来估计出较为准确的模型。参数辨识是系统辨识中的重要组成部分，在已知机器人动力学和运动学模型的结构之后，可以通过输入与输出数据之间的关系确定已知模型结构中的未知参数。目前，辨识技术已经推广到工程和非工程的许多领域，如化学化工过程、核反应堆、电力系统、航空航天飞行器、生物医学系统、社会经济系统、环境系统、生态系统等。

系统辨识方法主要包括经典系统辨识方法和现代系统辨识方法。其中经典系统辨识方法已经发展比较成熟和完善，主要包括阶跃响应法、脉冲响应法、频率响应法、相关分析法、谱分析法、最小二乘法和极大似然法等。但是由于实际系统很多都是具有不确定性的复杂系统，经典的辨识方法在此方面还存在一定的不足，其对于某些复杂系统在一些情况下无能为力。现代系统辨识方法主要包括集员系统辨识法、神经网络系统辨识法、模糊逻辑系统辨识法、智能算法系统辨识法等。其中，智能算法主要包括遗传算法、蚁群算法、粒子群算法、差分进化算法等，是解决传统系统辨识问题的新方法。由于智能算法不依赖于问题模型本身的特性，能够快速有效地搜索复杂、高度非线性和多维空间，非常适合于辨识系统参数，是系统辨识研究与应用中的重要途径。

粒子群优化算法(Particle Swarm Optimization,PSO)是一种进化计算技术，1995年由Eberhart博士和Kennedy博士提出。该算法源于对鸟群捕食的行为研究，是通过模拟鸟群觅食过程中迁徙和协同合作行为而提出的一种智能随机优化算法。其基本思想在于：从随机解出发，通过迭代的方式不断更新粒子个体的位置和速度，同时根据目标函数来判断粒子的适应性，进而寻找最优解。粒子群优化算法以实现容易、精度高、收敛快等优点引起了学术界的重视，并且在解决系统辨识问题中展示了其特殊的优越性。但是，粒子群优化算法在处理复杂问题时容易陷入局部最优解上而停止不动，即所谓的早熟收敛现象。

遗传算法(Genetic Algorithm,GA)是20世纪70年代初由美国密西根大学的J.Holland教授和他的学生提出的一种新型的优化算法。其基本思想在于模仿生物进化论过程当中基因(染色体)的生存过程。此过程中的染色体充当了种群当中的个体，因此每一个个体都可以作为问题的一个解。个体在衍生的过程中不断地复制、交叉和变异，产生新的个体。进而通过设定的适应度来衡量个体，对新产生的个体进行筛选，在保持种群数量恒定的同时，经过一代代的不断变化，选出最好的个体，得出问题的最优解。遗传算法拥有极强的探索精度和求变功能，在解空间全局寻优上具有优势，但在局部搜索能力上相对不足。

发明内容

为了解决上述问题，本发明提出了一种基于改进粒子群算法的全向移动智能轮椅机器人运动学参数辨识方法。将粒子群优化算法与遗传算法进行融合，将遗传算法中的遗传继承的思想引入粒子群优化算法中，并对粒子群优化算法的惯性权重进行动态调整，即具有遗传性能的权重调整粒子群算法(Weight-adjusted Particle Swarm Optimizationalgorithm with Genetic performance,GWPSO)。与粒子群优化算法和遗传算法相比，改进的粒子群算法表现出了更好的优化性能，提高了全局搜索能力，加快了算法的收敛速度。将改进的粒子群算法应用于确定全向移动智能轮椅机器人运动学的相关参数，是一种有效的参数辨识方法。

本发明的主要应用对象为一种安装有四个麦克纳姆轮(又叫全向轮)的智能轮椅床式机器人，这是一种典型的能够为机器人提供全向运动能力的移动底盘结构，如附图1所示。本发明的目的在于提供一种对全向移动智能轮椅床式机器人运动学相关参数进行辨识的有效方法，进而得到的能够真实描述轮椅机器人运动学特性的数学模型。

具体技术方案：

本发明根据改进粒子群算法全局搜索能力强、收敛速度快等特点，将其应用于全向移动智能轮椅机器人运动学模型相关参数的优化问题中，得到更接近于实际的全向移动智能轮椅机器人运动学模型，该方法的步骤如下：

准备工作：利用数学推导及运动学特性分析得到全向移动智能轮椅机器人运动学模型表达式。设置粒子群算法的最大迭代次数t_pmax、最小惯性权重系数ω_pmin∈(0,1)、最大惯性权重系数ω_pmax∈(ω_pmin,1)。

步骤一：给轮椅机器人一定的横向运动输入指令V_x，纵向运动及姿态输入为零，即控制轮椅机器人横向运动，利用视觉传感器采集到轮椅机器人产生的运动位置及姿态信息。

步骤二：设迭代次数t_p＝1，初始化粒子群，设定粒子个数N，即每个粒子位置对应一个参数辨识结果，每个粒子速度对应一次迭代参数辨识结果中参数值的变化值，每一个粒子的维数D，即每个粒子对应D个需要辨识的参数，设定参数搜索范围、速度限制，并随机确定每个粒子的初始位置和速度，即生成N个参数辨识结果和对应的参数变化值，每个结果中的D个参数值为参数搜索范围中的随机值，其对应的参数变化值为速度限制中的随机值。

步骤三：根据目标函数计算每个粒子的适应度J_x，将当前粒子的位置存储在pbest_id(t_p)中，将其中最优粒子的位置存储在gbest_id(t_p)中，所述的最优粒子是指适应度值最小的粒子。

适应度即参数辨识结果和实际参数值的一致程度，适应度值越小，参数辨识结果越好，适应度值越大，参数辨识结果越差。

步骤四：更新群体中所有粒子的位置和速度。

步骤五：根据目标函数计算更新后粒子的适应度J_x，对于每个粒子，将粒子更新后的适应度值与存储在pbest_id(t_p)中的粒子的适应度值进行比较，并用更优的粒子更新得到局部最优解pbest_id(t_p+1)，所述的更优的粒子指适应度值更小的粒子，即更新得到每个粒子目前搜索到的最优的参数辨识结果，并从pbest_id(t_p+1)中选取最优粒子更新得到全局最优解gbest_id(t_p+1)，即更新得到所有粒子目前搜索到的最优的参数辨识结果。

步骤六：根据适应度值对更新后的粒子进行排序，找出最优粒子，并且所有其他粒子都继承最优粒子的位置和速度，即使所有其他粒子的位置和速度均与最优粒子的位置和速度相同，保持pbest_id(t_p+1)与gbest_id(t_p+1)不变。

步骤七：令t_p＝t_p+1，判断是否满足t_p>t_pmax，如果满足，则停止搜索并保存得到的横向运动辨识参数最优值，否则返回步骤四继续搜索。

步骤八：给轮椅机器人一定的纵向运动输入指令V_y，横向运动及姿态输入为零，即控制轮椅机器人纵向运动，利用视觉传感器采集轮椅机器人产生的运动位置及姿态信息。重复步骤二到步骤七过程，并更新其中的一些参数设置和目标函数J_y，即得到轮椅机器人纵向运动辨识参数最优值。

步骤九：给轮椅机器人一定的姿态输入指令V_θ，横向运动及纵向运动输入为零，即控制轮椅机器人的姿态，利用视觉传感器采集轮椅机器人产生的运动位置及姿态信息。重复步骤二到步骤七过程，并更新其中的一些参数设置和目标函数J_θ，即得到轮椅机器人姿态运动辨识参数最优值。

步骤十：输出所有参数辨识结果，即横向运动、纵向运动及姿态运动辨识参数的最优值。

补充说明：

其中，准备工作中，全向移动智能轮椅机器人运动学模型如下所示：

上式(1)中，R为麦克纳姆轮的半径。

为轮椅机器人在车体坐标系O_r(x_r,y_r)中的速度向量。V_x,V_y,V_θ分别为轮椅机器人横向运动、纵向运动及姿态运动对应的速度值。O_r(x_r,y_r)是以轮椅机器人底盘几何中心作为原点的车体坐标系。ω_i(i＝1,2,3,4)为麦克纳姆轮i绕轮毂旋转的角速度，l和w分别为麦克纳姆轮在车体坐标系O_r(x_r,y_r)中到x_r轴和y_r轴的距离，如附图1所示。

由于轮子打滑及外界扰动等因素，全向移动智能轮椅机器人运动学模型并非理想状态，于是将其写为如下形式进行参数辨识：

上式中，k₁₁,k₁₂,k₁₃,k₁₄,k₂₁,k₂₂,k₂₃,k₂₄,k₃₁,k₃₂,k₃₃,k₃₄即为需要辨识的参数。k₁＝[k₁₁,k₁₂,k₁₃,k₁₄]^T为轮椅机器人横向运动时需要辨识的参数，k₁₁,k₁₂,k₁₃,k₁₄分别对应麦克纳姆轮1,2,3,4的角速度系数。k₂＝[k₂₁,k₂₂,k₂₃,k₂₄]^T为轮椅机器人纵向运动时需要辨识的参数，k₂₁,k₂₂,k₂₃,k₂₄分别对应麦克纳姆轮1,2,3,4的角速度系数。k₃＝[k₃₁,k₃₂,k₃₃,k₃₄]^T为轮椅机器人姿态运动时需要辨识的参数，k₃₁,k₃₂,k₃₃,k₃₄分别对应麦克纳姆轮1,2,3,4的角速度系数。

其中，步骤一中，横向运动输入指令V_x为轮椅机器人的横向运动速度值，将速度值按理想运动学模型先转化为四个轮子的转速，再输入到实际系统和辨识系统。

其中，步骤二中，粒子群为X＝[X₁,X₂,…,X_N]，其中粒子i的位置表示为x_id(t_p)＝[x_i1,x_i2,…,x_iD]，即对应D个辨识参数的参数值，速度表示为v_id(t_p)＝[v_i1,v_i2,…,v_iD]，即对应D个辨识参数参数值的变化值，i＝1,2,…,N。速度最大值V_max∈[0.001,0.1]、最小值V_min∈[-0.1,-0.001]，参数搜索范围上界k_1max＝[k_11max,k_12max,k_13max,k_14max]^T、下界k_1min＝[k_11min,k_12min,k_13min,k_14min]^T。

其中，步骤三和步骤五中，目标函数如下所示：

上式中，n为视觉传感器采集到的样本数据总量，x_i表示视觉传感器采集的轮椅机器人的第i个运动位置，

表示根据第i个粒子预测的运动位置。在辨识轮椅机器人横向运动参数最优值阶段时，运动位置指横向位置，另外两个阶段则分别对应为纵向位置和角度位置。

其中，步骤三和步骤五中，pbest_id(t_p)＝[pbest_i1,pbest_i2,…,pbest_iD]表示截至第t_p代i(i＝1,2,…,N)粒子的最优解，即截至第t_p代i粒子对应的适应度值最小的参数辨识结果，gbest_id(t_p)＝[gbest_i1,gbest_i2,…,gbest_iD]表示截至第t_p代的全局最优解，即截至第t_p代适应度值最小的粒子i对应的参数辨识结果。

其中，步骤四中，粒子的位置和速度更新公式如下所示：

上式中c₁∈[1,2]、c₂∈[1,2]表示加速度常数，ω_p表示惯性权重，rand()表示(0,1)之间的随机数。惯性权重ω_p计算公式如下：

其中，步骤八中，重复步骤二时，参数搜索范围更改为k_2max＝[k_21max,k_22max,k_23max,k_24max]^T，k_2min＝[k_21min,k_22min,k_23min,k_24min]^T。重复步骤三和步骤五时，目标函数更改为如下形式：

上式中，n为视觉传感器采集到的样本数据总量，y_i表示实际系统输出的样本数据，

表示辨识模型输出的数据。

其中，步骤九中，重复步骤二时，参数搜索范围更改为k_3max＝[k_31max,k_32max,k_33max,k_34max]^T，k_3min＝[k_31min,k_32min,k_33min,k_34min]^T。重复步骤三和步骤五时，目标函数更改为如下形式：

上式中n为视觉传感器采集到的样本数据总量，θ_i表示实际系统输出的样本数据，

表示辨识模型输出的数据。

有益效果

本发明提出了一种基于改进粒子群算法的全向移动智能轮椅机器人参数辨识方法。改进粒子群算法将粒子群优化算法与遗传算法进行融合，取长补短，将遗传算法中遗传继承的思想引入粒子群优化算法中，弥补了遗传算法在局部搜索能力上相对不足的缺点。同时对粒子群优化算法的惯性权重进行动态调整，较好地平衡了算法的全局搜索能力和局部搜索能力，使算法具有更优越的寻优性能，既能得到质量高的最优解，又能保持很高的搜索速度。与粒子群优化算法和遗传算法相比，改进的粒子群算法具有更好的优化性能，能够提高算法的全局搜索能力，加快算法的收敛速度，是一种有效的参数辨识方法。将其应用于全向移动智能轮椅机器人运动学模型的参数辨识问题中，可以得到更接近于实际的全向移动智能轮椅机器人运动学模型。

附图说明

图1是轮椅机器人结构及运动状态量示意图。

图2是轮椅机器人的运动学模型参数辨识原理图。

图3是改进粒子群算法对轮椅机器人横向运动的相关参数辨识流程图。

图4是横向运动目标函数优化过程图。

图5是横向运动辨识模型输出曲线图。

图6是x方向参数辨识结果表。

图7是纵向运动目标函数优化过程图。

图8是纵向运动辨识模型输出曲线图。

图9是y方向参数辨识结果表。

图10是姿态运动目标函数优化过程图。

图11是姿态运动辨识模型输出曲线图。

图12是姿态参数辨识结果表。

具体实施方式

下面结合具体实施过程对本发明进行进一步描述：

准备工作：利用数学推导及运动学特性分析得到的全向移动智能轮椅机器人运动学模型已知如公式(1)所示，将其写为公式(2)的形式进行参数辨识。设置粒子群算法的最大迭代次数t_pmax＝200，最大惯性权重系数ω_pmax＝0.9，最小惯性权重系数ω_pmin＝0.1。

步骤一：给轮椅机器人一定的横向运动输入指令V_x如下所示，纵向运动及姿态输入为零，即控制轮椅机器人横向运动，并利用视觉传感器采集到轮椅机器人产生的运动位置及姿态信息。

上式中，横向运动输入指令V_x为轮椅机器人的横向运动速度值，将其按理想运动学模型先转化为四个轮子的转速，再输入到实际系统和辨识系统。

步骤二：令迭代次数t_p＝1，初始化粒子群，设定粒子个数N＝30，每一个粒子的维数D＝4，参数搜索范围k_1max＝[1,1,1,1]^T，k_1min＝[0.5,0.5,0.5,0.5]^T，速度限制V_max＝0.01，V_min＝-0.01，并随机确定每个粒子的初始位置和速度。

步骤三：根据目标函数计算每个粒子的适应度J_x，将当前粒子的位置存储在pbest_id(t_p)中，将其中最优粒子的位置存储在gbest_id(t_p)中。目标函数如下所示：

上式中，n为视觉传感器采集到的样本数据总量，x_i表示实际系统输出的样本数据，

表示辨识模型输出的数据。

步骤四：更新群体中所有粒子的位置和速度。粒子的位置和速度更新公式如下所示：

上式中，rand()表示(0,1)之间的随机数，惯性权重ω_p计算公式如下：

步骤五：根据公式(9)计算更新后粒子的适应度值，将粒子更新后的适应度值与存储在pbest_id(t_p)中的粒子的适应度值进行比较，用更优的粒子更新得到局部最优解pbest_id(t_p+1)，并从pbest_id(t_p+1)中选取最优粒子更新得到全局最优解gbest_id(t_p+1)。

步骤六：根据适应度值对更新后的粒子进行排序，找出最优粒子，并且所有其他粒子都继承最优粒子的位置和速度，即使所有其他粒子的位置和速度均与最优粒子的位置和速度相同，保持pbest_id(t_p+1)与gbest_id(t_p+1)不变。

步骤七：令t_p＝t_p+1，判断是否满足t_p>t_pmax，如果满足，则停止搜索并保存得到的参数辨识结果，否则返回步骤四继续搜索。

步骤八：给轮椅机器人一定的纵向运动输入指令V_y如下所示，横向运动及姿态输入为零，即控制轮椅机器人纵向运动，利用视觉传感器采集轮椅机器人产生的运动位置及姿态信息。

上式中，纵向运动输入指令V_y为轮椅机器人的纵向运动速度值，将其按理想运动学模型先转化为四个轮子的转速，再输入到实际系统和辨识系统。

重复步骤二到步骤七过程，参数搜索范围更改为k_2max＝[1,1,1,1]^T，k_2min＝[0.5,0.5,0.5,0.5]^T。目标函数更改为如下形式：

上式中，n为视觉传感器采集到的样本数据总量，y_i表示实际系统输出的样本数据，

表示辨识模型输出的数据。

步骤九：给轮椅机器人一定的姿态输入指令V_θ如下所示，横向运动及纵向运动输入为零，即控制轮椅机器人的姿态，利用视觉传感器采集轮椅机器人产生的运动位置及姿态信息。

V_θ＝0.025rad/s (14)

上式中，姿态输入指令V_θ为轮椅机器人的姿态运动速度值，将其按理想运动学模型先转化为四个轮子的转速，再输入到实际系统和辨识系统。

重复步骤二到步骤七过程，参数搜索范围更改为k_3max＝[1,1,1,1]^T，k_3min＝[0.5,0.5,0.5,0.5]^T。目标函数更改为如下形式：

上式中n为视觉传感器采集到的样本数据总量，θ_i表示实际系统输出的样本数据，

表示辨识模型输出的数据。

步骤十：输出所有参数辨识结果，即横向运动、纵向运动及姿态运动辨识参数的最优值。

附图4、7、10表明了横向运动、纵向运动、姿态运动中目标函数的优化过程。可以看出本发明提出的改进粒子群算法(GWPSO)相比于传统的粒子群优化算法(PSO)和遗传算法(GA)，具有更好的优化性能，在保持最优解质量的同时，算法的收敛速度更快。附图5、8、11是横向运动、纵向运动、姿态运动辨识模型输出曲线图，其表明了算法优化得到的全向移动智能轮椅机器人运动学模型，很接近实际应用中全向移动智能轮椅机器人的运动学模型。附图6、9、12表明了全向移动智能轮椅机器人运动学模型参数辨识结果。其中建模值为利用数学推导及运动学特性分析得到的全向移动智能轮椅机器人运动学模型的相关参数值。表中第3、4、5行分别为粒子群优化算法(PSO)、遗传算法(GA)和改进粒子群算法(GWPSO)优化得到的轮椅机器人相关参数值及目标函数的最优值。由参数辨识结果可以看出，改进粒子群算法得到的最优解在三种算法中是最好的。由附图4到附图12说明了改进粒子群算法能够提高全局搜索能力，加快收敛速度，是一种有效的参数辨识方法。将其应用于全向移动智能轮椅机器人运动学模型的优化问题中，可以得到更接近于实际的全向移动智能轮椅机器人运动学模型。

Claims (6)

1.一种基于改进粒子群算法的智能轮椅机器人参数辨识方法，包括准备阶段和辨识阶段，

准备阶段包括：

利用数学推导及运动学特性分析得到全向移动智能轮椅机器人运动学模型表达式；

其特征在于包括以下辨识阶段：

辨识轮椅机器人横向运动参数最优值阶段

步骤一：仅控制轮椅机器人横向运动，并利用视觉传感器采集轮椅机器人产生的横向运动位置及姿态信息；

步骤二：系统参数初始化；

步骤三：根据目标函数计算每个粒子的适应度J_x，并记录当前所有的粒子位置；

步骤四：更新群体中所有粒子的位置和速度；

步骤五：根据目标函数计算更新后粒子的适应度J_x，寻找每个粒子的局部最优解，并从局部最优解中寻找截至目前所有粒子的全局最优解；所述的局部最优解指当前迭代与前次迭代相比，每个粒子中适应度小的粒子位置；所述的全局最优解是指所有迭代过程中，所有粒子里适应度值最小的粒子位置；

步骤六：根据适应度值对更新后的粒子进行排序，找出适应度最小的粒子，并且所有其他粒子都继承该粒子的位置和速度；

步骤七：判断是否达到最大迭代次数，如果达到，则停止搜索，此时得到的全局最优解即为横向运动辨识参数最优值，否则返回步骤四继续搜索；

辨识轮椅机器人纵向运动参数最优值阶段

仅控制轮椅机器人纵向运动，并利用视觉传感器采集轮椅机器人产生的纵向运动位置及姿态信息；重复步骤二到步骤七过程，即得到轮椅机器人纵向运动辨识参数最优值；

辨识轮椅机器人姿态运动参数最优值阶段

仅控制轮椅机器人的姿态，利用视觉传感器采集轮椅机器人产生的运动位置及姿态信息，重复步骤二到步骤七过程，即得到轮椅机器人姿态运动辨识参数最优值；

输出所有参数辨识结果，即横向运动、纵向运动及姿态运动辨识参数的最优值；

其中：

所述的准备阶段中，全向移动智能轮椅机器人运动学模型如下所示：

其中，R为麦克纳姆轮的半径，

为轮椅机器人在车体坐标系O_r(x_r,y_r)中的速度向量，V_x,V_y,V_θ分别为轮椅机器人横向运动、纵向运动及姿态运动对应的速度值，O_r(x_r,y_r)是以轮椅机器人底盘几何中心作为原点的车体坐标系，ω_i(i＝1,2,3,4)为麦克纳姆轮i绕轮毂旋转的角速度，l和w分别为麦克纳姆轮在车体坐标系O_r(x_r,y_r)中到x_r轴和y_r轴的距离，k₁₁,k₁₂,k₁₃,k₁₄,k₂₁,k₂₂,k₂₃,k₂₄,k₃₁,k₃₂,k₃₃,k₃₄即为需要辨识的参数，k₁＝[k₁₁,k₁₂,k₁₃,k₁₄]^T为轮椅机器人横向运动时需要辨识的参数，k₁₁,k₁₂,k₁₃,k₁₄分别对应麦克纳姆轮1,2,3,4的角速度系数；k₂＝[k₂₁,k₂₂,k₂₃,k₂₄]^T为轮椅机器人纵向运动时需要辨识的参数，k₂₁,k₂₂,k₂₃,k₂₄分别对应麦克纳姆轮1,2,3,4的角速度系数，k₃＝[k₃₁,k₃₂,k₃₃,k₃₄]^T为轮椅机器人姿态运动时需要辨识的参数，k₃₁,k₃₂,k₃₃,k₃₄分别对应麦克纳姆轮1,2,3,4的角速度系数。

2.根据权利要求1所述的一种基于改进粒子群算法的智能轮椅机器人参数辨识方法，其特征在于：所述的目标函数如下所示：

上式中，n为视觉传感器采集到的样本数据总量，x_i表示视觉传感器采集的轮椅机器人的第i个横向运动位置，

表示根据第i个粒子预测的横向运动位置。

3.根据权利要求1所述的一种基于改进粒子群算法的智能轮椅机器人参数辨识方法，其特征在于：步骤四中，粒子的位置和速度更新公式如下所示：

上式中c₁∈[1,2]、c₂∈[1,2]表示加速度常数，ω_p表示惯性权重，rand()表示(0,1)之间的随机数，截至第t_p次迭代的所有粒子的局部最优解pbest_id(t_p)，截至目前粒子的全局最优解gbest_id(t_p)，惯性权重ω_p计算公式如下：

其中，最小惯性权重系数ω_pmin∈(0,1)、最大惯性权重系数ω_pmax∈(ω_pmin,1)，最大迭代次数t_pmax，当前迭代次数t_p。

4.根据权利要求1所述的一种基于改进粒子群算法的智能轮椅机器人参数辨识方法，其特征在于：

纵向运动参数最优值阶段，参数搜索范围更改为k_2max＝[k_21max,k_22max,k_23max,k_24max]^T，k_2min＝[k_21min,k_22min,k_23min,k_24min]^T，目标函数更改为如下形式：

上式中，n为视觉传感器采集到的样本数据总量，y_i表示视觉传感器采集的轮椅机器人的第i个纵向运动位置，

表示辨识模型根据第i个粒子预测的纵向运动位置。

5.根据权利要求1所述的一种基于改进粒子群算法的智能轮椅机器人参数辨识方法，其特征在于：

其中，步骤九中，重复步骤二时，参数搜索范围更改为k_3max＝[k_31max,k_32max,k_33max,k_34max]^T，k_3min＝[k_31min,k_32min,k_33min,k_34min]^T；重复步骤三和步骤五时，目标函数更改为如下形式：

上式中n为视觉传感器采集到的样本数据总量，θ_i表示视觉传感器采集的轮椅机器人的第i个角度位置，

表示辨识模型根据第i个粒子预测的角度位置。

6.根据权利要求1所述的一种基于改进粒子群算法的智能轮椅机器人参数辨识方法，其特征在于：

步骤二所述的系统参数具体指：粒子群算法的最大迭代次数t_pmax、最小惯性权重系数ω_pmin∈(0,1)、最大惯性权重系数ω_pmax∈(ω_pmin,1)，初始化粒子群，设定粒子个数N，粒子维数D，参数搜索范围、速度限制，随机确定每个粒子的初始位置和速度，每个结果中的D个参数值为参数搜索范围中的随机值，其对应的参数变化值为速度限制中的随机值。

Images