Distributed Cooperative Control of Redundant Mobile Manipulators With Safety Constraints
提出一种将编队控制与约束优化相结合的方法,解决冗余移动机械臂在安全约束下的分布式协同操作问题,通过不连续投影原对偶算法和有限时间控制律实现物体搬运与避碰。
In this article, the distributed cooperative control problem of redundant mobile manipulators is investigated. A novel method is proposed to solve the problem by integrating formation control with constrained optimization, which not only transports the object along a reference trajectory in a distributed manner but also obtains the dexterous joint postures and end-effector displacements under safety constraints for collision avoidance. For the constrained optimization, the cost function and safety constraints are designed to quantify the mobility and manipulability of mobile manipulators, and collision-free working ranges with the object and obstacles, respectively. A discontinuous projected primal-dual algorithm with damping terms is proposed to solve the constrained optimization problem, providing the joint postures and end-effector displacements, which minimize the cost function and satisfy safety constraints. For the formation control, a finite-time control law, guided by end-effector displacements from the primal-dual algorithm, is developed in order to transport the object by establishing a prescribed formation and moving its centroid to track the reference trajectory. The cooperative manipulation is therefore achieved by the proposed method, which is further validated through numerical simulations.