基于优化人工势场法的血凝仪动态避障路径规划方法技术

本发明专利技术公开了一种基于优化人工势场法的血凝仪动态避障路径规划方法，该方法包括：采用人工势场法对血凝仪机械臂的移动进行实时避障路径规划；实时检测血凝仪机械臂所到达的位置点是否为局部稳定点；若是局部稳定点，则将引力场、吸引力、斥力场、斥力分别进行更新，从而打破稳定状态，使机械臂沿正确路径运行，并与目标保持相同的运动趋势。本发明专利技术适用于动态环境中的路径规划。

【技术实现步骤摘要】

本专利技术涉及血凝仪路径规划方法，尤其涉及一种基于优化人工势场法的血凝仪动态避障路径规划方法。
技术介绍
20世纪以来，随着人类文明得到的飞速发展，促进了人类在生命科学和生物工程领域的深入研究，尤其在医学方面，如何有效快速的对疾病进行检测和治疗，是当今人类发展进程中的重要研究课题，因此研究先进的医学检验仪器对促进检验医学的发展有着重要意义，而血凝仪[王雪峰，王宏利，血液凝固分析仪[J]，现代医学仪器与应用.2000.12(3)：7-10]大大方便了医护人员的工作任务。机器人的运动规划传统上被看作是一个优化问题，其中机器人的位置在一个参数空间表示。通过尝试在参数空间中搜索满足预定义的成本函数(如机器人与目标位置的距离)的参数来寻找解决问题的方案。该方法的局限时在处理涉及不可预料的障碍的动态环境时，产生一个新的方案的计算代价太高。作为机械臂与移动机器人的一个更实际的无碰撞运动的实时规划算法，人工势场法[姜德，谢勇.人工势场法规划方法[J].西南大学学报：科学版，2013，29(5):128-132]将动态感知到的反馈结合到机器人的控制中，从而克服了扩充低级运动控制器的反应能力局限。人工势场法是实现机器人路径规划的一种重要算法，它的基本思想是将机器人在周围环境中的运动，设计成一种抽象的人造引力场中的运动，目标点对移动机器人产生“引力”，障碍物对移动机器人产生“斥力”，最后通过求合力来控制移动机器人的运动。应用势场法规划出来的路径一般是比较平滑并且安全。但是人工势场法存在两个问题：(1)存在局部稳定点(或局部最小点、局部最优点)问题，是指移动机器人机械臂由于一些因素导致机械臂受到的引力和斥力平衡，达到稳定，此时，机器人会产生死锁现象，但这时机械臂并没有达到目标点。(2)当目标附近有障碍物时，移动机器人将永远也到达不了目的地，具体是由于在以前的许多研究中，目标和障碍物都离的很远，当机器人逼近目标时，障碍物的斥力变的很小，甚至可以忽略，机器人将只受到吸引力的作用而直达目标，但在许多实际环境中，往往至少有一个障碍物与目标点离的很近，在这种情况下，当移动机器人逼近目标的同时，它也将向障碍物靠近，如果利用以前对引力场函数和斥力场函数的定义，斥力将比引力大的多，这
样目标点将不是整个势场的局部稳定点，因此移动机器人将不可能到达目标。另外，在过去的研究中，很多路径规划都是将人工势场法应用于静态环境中，即目标和障碍物为静止不动的，然而，在实际应用中，机器人所处的环境大多是动态的，且不仅障碍物是运动的，甚至目标也是运动的。
技术实现思路
专利技术目的：本专利技术针对现有技术存在的问题，提供一种基于优化人工势场法的血凝仪动态避障路径规划方法，该方法尤其适用于动态环境中的路径规划。技术方案：本专利技术所述的基于优化人工势场法的血凝仪动态避障路径规划方法包括：采用人工势场法对血凝仪机械臂的移动进行实时避障路径规划；实时检测血凝仪机械臂所到达的位置点是否为局部稳定点；若是局部稳定点，则将引力场、吸引力、斥力场、斥力分别进行更新，从而打破稳定状态，使机械臂沿正确路径运行，并与目标保持相同的运动趋势；其中，更新后的引力场、吸引力、斥力场、斥力分别为：引力场为：Uatt(q)＝0.5ξq||q-qg||2+0.5ξv||v-vg||2+0.5ξa||a-ag||2吸引力为：斥力场为：斥力为：式中，ξa、ξv、ξq为比例系数，q、v、a分别指机械臂的位置、速度和加速度，qg、vg、ag分别指目标的位置、速度和加速度，qobs、vobs、aobs分别指障碍物的位置、速度和加速度，||q-qg||是机械臂与目标之间的相对距离，||v-vg||是机械臂与目标之间的相对速度，||a-ag||是机械臂与目标之间的相对加速度，为哈密顿算子，η1、η2、η3、η4、η5、η6为比例系数，ρ0指障碍物的排斥力的最大范围，ρ(q)＝||q-qobs||
是机械臂与障碍物的最小距离，xgoal为目标的位置，(x-xgoal)为机械臂与目标之间的距离，vro＝(v-vobs)Tero为机械臂与障碍物的相对速度在二者连线上的分量，aro＝(a-aobs)Tero为机械臂与障碍物的相对加速在二者连线上的分量，ero为从机械臂指向障碍物的单位向量。进一步的，所述实时检测血凝仪机械臂所到达的位置点是否为局部稳定点，具体采用以下方法实现：根据机械臂的移动步长以及斥力的作用范围设定局部稳定点的影响区域圆半径为Rl，根据机械臂的移动速度设定检测时间为t；每隔t时间检测一次机械臂，获取机械臂上一次的位置坐标(xbefore,ybefore)和当前位置坐标(xcurrent,ycurrent)；计算位置坐标(xbefore,ybefore)和位置坐标(xcurrent,ycurrent)之间的距离；若计算得到的距离小于Rl，则认为机械臂当前的位置点为局部稳定点。有益效果：本专利技术与现有技术相比，其显著优点是：本专利技术中研究的障碍物以动态障碍物为主，在这种人工势场的作用下，移动机械臂所受的虚拟力不仅与运动之间相对位置有关，而且与相对速度，甚至相对加速度都有关，因此将引力场和斥力场都进行改进更新，使得机器人时刻趋向于保持与目标相同的运动趋势，同时保持与障碍物相悖的运动趋势，还可以解决局部稳定点问题。另外，采用本专利技术，机械臂运动更加平滑，速度更加稳定，提高精度的同时降低成本。附图说明图1是本专利技术的一个实施例的系统框图；图2是机械臂进入局部稳定点的区域图；图3是计算吸引力过程各向量之间的关系；图4是本专利技术排斥力过程中各向量之间的关系。具体实施方式如图1所示，本实施例的基于优化人工势场法的血凝仪动态避障路径规划方法包括以下步骤：S1、采用人工势场法对血凝仪机械臂的移动进行实时避障路径规划。传统势场的函数为：引力场为：斥力场为：引力为：Fatt(q)＝-ζ(q-qg)斥力为：其中，ρg(q)＝||q-qg||指机械臂到目标的距离，q、qg分别指机械臂和目标的位置，ζ、η为比例系数，ρ0指障碍物的排斥力的最大范围，ρ(q)指障碍物与机械臂的最小距离，S2、实时检测血凝仪机械臂所到达的位置点是否为局部稳定点。尽管人工势场法中将移动机械臂可看成是一个可移动的质点，但当机械臂陷入局部稳定点问题时，机械臂并不会停在一个固定的点上，更多的情况是，机械臂停留在某一个很小的区域内徘徊或者打转，机械臂可以原点打转，也可以是以某一个半径做圆周运动，如图2所示。因此，采用的检测方法具体为：(1)根据机械臂的移动步长以及斥力的作用范围设定局部稳定点的影响区域圆半径为Rl，根据机械臂的移动速度设定检测时间为t；(2)每隔t时间检测一次机械臂，获取机械臂上一次的位置坐标(xbefore,ybefore)和当前位置坐标(xcurrent,ycurrent)；(3)计算位置坐标(xbefore,ybefore)和位置坐标(xcurrent,ycurrent)之间的距离；(4)若计算得到的距离小于Rl，则认为机械臂当前的位置点为局部稳定点。S3、若是局部稳定点，则将引力场、吸引力、斥力场、斥力分别进行更新，从而打破稳定状态，使机械臂沿正确路径运行，并与目标保持相同的运动趋势。(1)更新后的引力场为：Uatt(q)＝本文档来自技高网...

【技术保护点】
一种基于优化人工势场法的血凝仪动态避障路径规划方法，其特征在于该方法包括：采用人工势场法对血凝仪机械臂的移动进行实时避障路径规划；实时检测血凝仪机械臂所到达的位置点是否为局部稳定点；若机械臂到达局部稳定点，则将引力场、吸引力、斥力场、斥力分别进行更新，从而打破稳定状态，使机械臂沿正确路径运行，并与目标保持相同的运动趋势；其中，更新后的引力场、吸引力、斥力场、斥力分别为：引力场为：Uatt(q)＝0.5ξq||q‑qg||2+0.5ξv||v‑vg||2+0.5ξa||a‑ag||2吸引力为：斥力场为：斥力为：式中，ξa、ξv、ξq为比例系数，q、v、a分别指机械臂的位置、速度和加速度，qg、vg、ag分别指目标的位置、速度和加速度，qobs、vobs、aobs分别指障碍物的位置、速度和加速度，||q‑qg||是机械臂与目标之间的相对距离，||v‑vg||是机械臂与目标之间的相对速度，||a‑ag||是机械臂与目标之间的相对加速度，为哈密顿算子，η1、η2、η3、η4、η5、η6为比例系数，ρ0指障碍物的排斥力的最大范围，ρ(q)＝||q‑qobs||是机械臂与障碍物的最小距离，xgoal为目标的位置，(x‑xgoal)为机械臂与目标之间的距离，vro＝(v‑vobs)Tero为机械臂与障碍物的相对速度在二者连线上的分量，aro＝(a‑aobs)Tero为机械臂与障碍物的相对加速在二者连线上的分量，ero为从机械臂指向障碍物的单位向量。...

【技术特征摘要】
1.一种基于优化人工势场法的血凝仪动态避障路径规划方法，其特征在于该方法包括：采用人工势场法对血凝仪机械臂的移动进行实时避障路径规划；实时检测血凝仪机械臂所到达的位置点是否为局部稳定点；若机械臂到达局部稳定点，则将引力场、吸引力、斥力场、斥力分别进行更新，从而打破稳定状态，使机械臂沿正确路径运行，并与目标保持相同的运动趋势；其中，更新后的引力场、吸引力、斥力场、斥力分别为：引力场为：Uatt(q)＝0.5ξq||q-qg||2+0.5ξv||v-vg||2+0.5ξa||a-ag||2吸引力为：斥力场为：斥力为：式中，ξa、ξv、ξq为比例系数，q、v、a分别指机械臂的位置、速度和加速度，qg、vg、ag分别指目标的位置、速度和加速度，qobs、vobs、aobs分别指障碍物的位置、速度和加速度，||q-qg||是机械臂与目标之间的相对距离，||v-vg||是机械臂与目标之间的相对速度，||a-ag||是机械臂与目标之间的相对加速度，为哈密顿算子，η1、η2、η3、η4、η5、η6为比例系数，ρ0指障碍物的排斥力的...

【专利技术属性】
技术研发人员：王直，付青，
申请(专利权)人：江苏科技大学，
类型：发明
国别省市：江苏;32