基于MPSP算法的自由漂浮空间机器人路径规划.pdf

《基于MPSP算法的自由漂浮空间机器人路径规划.pdf》由会员上传分享，免费在线阅读，更多相关内容在学术论文-天天文库。

1、中国科技论文在线http://www.paper.edu.cn基于MPSP算法的自由漂浮空间机器人路径#规划11112**武耀发，宁昕，岳晓奎，袁建平，张敬敏5（1.西北工业大学航天飞行动力学技术国家重点实验室；2.中国兵器工业第二〇八研究所）摘要：由于自由漂浮空间机器人系统的非完整特性，使得我们不能像地面固定基座机器人一样通过逆运动学的方法对其进行路径规划，而且传统的自由漂浮空间机器人路径规划方法并10不能很好地考虑控制力矩的大小。因此，本文针对自由漂浮空间机器人的路径规划问题，提出了基于MPSP（模型预测静态规划）算法的自由漂浮空间机器人路径

2、规划方法。首先，通过齐次坐标转换和拉格朗日法分别建立了自由漂浮空间机器人的运动学模型和动力学模型，在此基础上推导得到了系统的状态空间模型，给定初始状态以及末端期望位姿，选取关节力矩最小作为性能指标，将自由漂浮空间机器人的路径规划问题转化为带有终端约束的优化问15题。然后，应用MPSP算法，将PD控制产生的控制量作为初始猜想，并利用最优控制的原理推导得到了控制偏差与末端位置误差之间的函数关系，通过对控制量的不断修正和状态方程的迭代求解，使得末端到达期望位置。最后，以平面2DOF自由漂浮空间机器人为例进行数值仿真。仿真结果表明，应用MPSP算法对自由

3、漂浮空间机器人进行路径规划，得到的关节轨迹平滑，并且在满足末端位置约束的同时，还能将关节力矩减小。20关键词：自由漂浮空间机器人；动力学模型；MPSP；路径规划中图分类号：V42PathPlanningforFree-floatingSpaceRobotBasedonMPSPAlgorithm1111225WuYaofa,NingXin,YueXiaokui,YuanJianping,ZhangJingmin(1.ScienceandTechnologyonAerospaceFlightDynamicsLaboratory,Northwester

4、nPolytechnicalUniversity;2.NO.208ResearchInstituteofChinaOrdnanceIdustries)Abstract:DuetothenonholonomicnatureofFFSR(free-floatingspacerobot),itisunabletoperforma30pathplanningforFFSRasafixed-baserobotthroughinversekinematics,andthetraditionalpathplanningmethodsforFFSRdon’tpr

5、eferablyconsiderthefollow-upcontroltorquerequired.Therefore,thispaperproposesapathplanningmethodbasedonmodel-predictionstaticprogramming(MPSP)forFFSR.Firstly,thekinematicmodelofFFSRisderivedfromthemethodofhomogeneouscoordinatetransformation,andthedynamicmodelofFFSRisestablish

6、edbyLagrangianmethod.Thepath35planningproblemofFFSRisconsideredastheoptimizationproblemwithterminalconstraintswhenthedesiredendpositionwassetandthetorquewasselectedasperformanceindex.Then,theMPSPalgorithmareintroducedtosolvetheoptimizationproblem.ThecontrolhistoryproducedbyPD

7、controlistakenastheinitialguess,andtherelationshipbetweenthecontroldeviationandtheendpositionerrorisderivedbytheprincipleofoptimalcontrol.Sotheendcanreachthedesiredposition40throughconstantmodificationofthecontrolhistoryanditerativelysolutionofthestateequation.Finally,thenume

8、ricalsimulationiscarriedoutwithaplanar2-DOFFFSRasanexample.Thesimula