空间两刚体滚动约束系统在线运动规划  

Online Motion Planning for Two Space Rigid Bodies with Rolling Constraints

作　　者：任书锋 杨丹[1] 余海东[1] 王皓[1,2] REN Shufeng;YANG Dan;YU Haidong;Wang Hao(Shanghai Key Laboratory of Digital Manufacture for Thin-Walled Structures,Shanghai Jiao Tong University,Shanghai 200240,China;State Key Laboratory of Mechanical System and Vibration,Shanghai Jiao Tong University,Shanghai 200240,China)

机构地区：[1]上海交通大学上海市复杂薄板结构数字化制造重点实验室,上海200240 [2]上海交通大学机械系统与振动国家重点实验室,上海200240

出　　处：《上海交通大学学报》2021年第8期1009-1017,共9页Journal of Shanghai Jiaotong University

基　　金：国家科技重大专项(2017ZX04005001)。

摘　　要：空间两刚体间的滚动约束系统是一种典型的非完整系统,非完整的特性可以用于简化机械结构,提高系统可靠性.针对纯滚动约束非完整系统的状态变量之间相互耦合难以控制、已有的控制方法局限于特定的模型且缺少对在线控制研究等问题,建立了适用于一般滚动约束系统在线运动规划的求解方法.该方法基于滚动约束一阶运动模型,首先通过配点法实现离线运动规划获得参考轨迹,然后在实时控制中结合滚动优化框架运用最优动作控制(SAC)算法,实现滚动系统的在线运动规划.将算法运用于球-平面滚动模型和两个球体间滚动模型的实时运动规划,仿真结果表明该方法在拓宽球形机器人控制和灵巧机械手操作方面具有实际应用价值.The rolling restraint system between two space rigid bodies is a typical non-holonomic system.The incomplete characteristics can be used to simplify the mechanical structure and improve the reliability of the system.Aimed at the problems that the state variables of the pure rolling constraint non-holonomic system are difficult to control,the existing control methods are limited to specific models,and there is a lack of online control research,a solution method suitable for the online motion planning of the general rolling constraint system is established based on the rolling constraint first-order motion model.First,the offline motion planning is achieved by using the collocation method to obtain the reference trajectory.Then,the sequential action control(SAC)algorithm is used in real-time control combined with the rolling optimization framework to realize the online motion planning of the rolling system.The algorithm is applied to the real-time motion planning of the ball-plane rolling model and the rolling model between two spheres.The simulation results show that the method has a practical application value in broadening the control of the spherical robot and the operation of the dexterous manipulator.

关 键 词：滚动约束 非完整系统 运动规划 直接配点法 最优动作控制 

分 类 号：TP242[自动化与计算机技术—检测技术与自动化装置]