Control of Flexible Manipulator Robots Based on Dynamic Confined Space of Velocities: Dynamic Programming Approach

摘要

Linear Parameter Varying models-based Model Predictive Control (LPV-MPC) has stood out in manipulator robots because it presents well-rejection to dynamic uncertainties in flexible joints. However, it has become too weak when the MPC's optimization problem does not include kinematic constraints-based conditions. This paper uses dynamic confined space of velocities (DCSV) to include these conditions as a recursive polytopic constraint, guaranteeing optimal dependency on a simplex scheduling parameter. To this end, the local frame's velocities and torque/force preload of joints (related to violation of kinematic constraints) are associated with different time scale dynamics such that DCSV correlates them as a polytope. So, a classical LPV-MPC will be updated using a dynamic programming approach according to the DCSV-based polytope. As a result, one lemma about DCSV-based recursive polytope and a five-step procedure for two decoupled close-loop schemes with different time scales compose the LPV-MPC proposed method. Numerical validation shows that even for relevant flexibility situations, trajectory tracking performance is improved by tuning finite horizons and optimization problem constraints regarding DCSV's behavior.