In this note, we investigate a continuous-time distributed optimization problem with time-varying cost functions and affine formation constraints, which are described by the stress matrices rather than the standard Laplacians. The objective is to minimize the sum of local time-varying cost functions, each of which is known by only one individual agent. The optimal solution is a time-varying affine transformation of a nominal configuration rather than some constants. To tackle the difficulty caused by the dynamic aspect of the local cost functions and handle affine formation constraints, the fixed-time distributed estimator and distributed gradient tracking technique are developed respectively to compensate the time variation of solution trajectory and calculate the weighted sum of local gradients to eliminate the tracking error. The time-varying optimal solution trajectory is thus accurately tracked with the proposed estimator-based gradient tracking algorithm. Using appropriately chosen coefficients, the tracking error is guaranteed to vanish at an exponential rate. The proposed estimator-based gradient tracking algorithm is further validated through numerical simulations.
30 August 2021 in IEEE Transactions on Cybernetics
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.
In this paper, we discussed the simultaneous intervention problem that arises from human-robot teams. The problem concerns with the case that one human operator has to intervene with several robots at almost the same time and it cannot be handled properly by existing methods. A model predictive control(MPC) based mixed initiative controller was proposed to solve this problem by embedding an intention model into the optimization problem. This method is in essence suitable for general MPC based mixed initiative controllers. The embedded intention model may cause the robot to deviate from its desired trajectory, for which conditions were developed to guarantee that the task completeness is not be affected. A comparison experiment was conducted and results showed that the proposed controller is more efficient and helpful in shortening the intervention time and allowing more robots to be successfully intervened in a simultaneous intervention scenario.