位移。腾空段过程是运用MATLAB中的fmincon函数寻优,以下各段均与此相同。 站立段的优化模型与此类似,考虑到跳跃过 程中的碰撞现象和周期性特点,站立段开始时刻状态就是机器人脚与地面发生碰撞之后的状态,站立段终了时刻状态就是机器人腾空前一时刻的状态,所以当腾空段的状态确定以后,这两个时刻的状态也就被确定了,即已知Θst 站立段是全驱动状态,假设三个关节角都按 式(10)的规律变化,目标函数与腾空段相同,优化模型的约束如下: 不等式约束: τ1l≤τ1 ≤τ1u τ2l≤τ2 ≤τ2uτ3l≤τ3 ≤τ3u θil≤θi ≤θiu i=1,2,3θ23l≤θ23 ≤θ23u -lf1 ≤xp ≤lf2Fy ≥0 Fx ≤μFy 其中,lf1 和lf2 分别是脚后跟和脚尖到踝关节的距 离,μ是地面滑动摩擦因数,文中取μ=2/3。 周期跳跃过程中三个关节角、角速度、关节力 矩、ZMP随时间变化关系如图3~图6所示,从图中可以看出,整个过程中关节角连续变化,在碰撞时刻关节角速度产生突变。 2.3 开始段以及停止段轨迹优化 开始段和停止段优化方法以及约束条件与周 期过程的站立段相似,值得强调的一点是腾空段前向速度为vcx 的取值不宜过大。从开始段来看, 若vcx 选取过大,机器人从静止直立状态到腾空前 的状态,踝关节需要施加更大的力矩,容易导致机器人失稳。 图7~图10所示为开始段三个关节角、角速 度、关节力矩、ZMP随时间的变化曲线,图11~图14为停止段各量的变化规律图。 对比站立段、开始段以及停止段的ZMP轨 迹可知,在站立段和停止段ZMP变化范围较小,而开始段变化较大,特别是开始段取得的负值很大,一个可能的解释是开始段从静止加速到起跳状态,需要的踝关节力矩较大,导致ZMP负值很大。 图13 周期过程的关节角速度变化 机器人跳跃过程的棒状图如图15所示,依次 包含开始段、腾空段、站立段、腾空段、停止段,图中一些点组成的一条从左至右的深色曲线表示质心轨迹。 3 结语 本文将单腿跳跃机器人的跳跃过程分为开始 段、腾空段和站立段或停止段,采用参数化优化方法规划出了每个阶段的最优关节轨迹。与直接规划运动轨迹的方法相比,优化方法保证了运动过程中机器人关节控制势的最优;而参数化优化方法相对于非参数化优化方法大大减少了优化变 量,提高了运算效率。以往关于轨迹规划的文献只是局限于在直接给定起跳状态和着地状态的情况实现轨迹的规划,既没有考虑机器人从静止状态能否达到需要起跳状态,也没有考虑机器人能否从给定的着地状态达到静止状态。本文则考虑了跳跃的全过程,采用参数化优化规划了机器人开始段和停止段的关节轨迹,实现了机器人从静止直立状态到起跳状态以及从碰地后状态到静止直立状态的过渡。 参考文献: [1] 郭小强,裴忠才.跳跃机器人的研究现状与发展趋势[J].机械设计与制造,2011(11):173-175.Guo Xiaoqiang,Pei Zhongcai.Study Status and DevelopingTreud of Hopping Robots[J].MachineryDesign & Manufacture,2011(11):173-175.[2] Chen Diansheng,Yin Junmao,Huang Yu,et al.AHopping-righting Mechanism Analysis and Designof the Mobile Robot[J].Journal of the Brazilian Societyof Mechanical Sciences and Engineering,2013,4:469-478. [3] 詹望,葛文杰.仿袋鼠跳跃机器人着地阶段的动力特性研究[J].机械设计,2007,24(6):23-25.Zhan Wang,Ge Wenjie.Study on the Dynamic Propertyin the Touchdown Phase of Kangaroo SimulativeJumping Robot[J].Journal of Machine Design,2007,24(6):23-25. [4] Hyon S H,Emura T,Mita T.Dynamics-based Controlof a One-legged Hopping Robot[J].Proceedingsof the Institution of Mechanical Engineers.Part I: Journal of Systems and Control Engineering,2003,2:83-98. [5] Cherouvim N,Papadopoulos E.Control of HoppingSpeed and Height Over Unknown Rough Terrain Usinga Single Actuator[C]//9th International Conferenceon Robotics and Automation.Kobe,Japan,2009:2743-2748. [6] Vermeulen J,Lefeber D,Verrelst B.Control of FootPlacement,Forward Velocity and Body Orientationof a One-legged Hopping Robot[J].Robotica,2003,1:45-57. [7] Ugurlu B,Kawamura~肘[10] Hasaneini S J,Macnab C J B,Bertram J E A,et al.Global Optimum Human-Like Gaits for anArticulated One-Legged Hopper[C]//ASME InternationalConference on Advanced IntelligentMechatronics (AIM).Montréal,Canada,2010: 391-396. [11] Wu TingYing,Yeh T J,Hsu Bing-Hung.TrajectoryPlanning of a One-legged Robot PerformingStable Hop[C]//International Conference on IntelligentRobots and Systems (IROS).Taipei,2010:4922-4927. |
核心期刊网(www.hexinqk.com)秉承“诚以为基,信以为本”的宗旨,为广大学者老师提供投稿辅导、写作指导、核心期刊推荐等服务。 核心期刊网专业期刊发表机构,为学术研究工作者解决北大核心、CSSCI核心、统计源核心、EI核心等投稿辅导咨询与写作指导的问题。 投稿辅导咨询电话:18915033935 投稿辅导客服QQ: 投稿辅导投稿邮箱:1003158336@qq.com |