The controller consists of an inner-loop DOB, a PESA modal-feedback layer, and a pose-dependent gain-scheduling mechanism.
3.2. Establishment of the Linear Nominal Model and the Lumped Disturbance of the System
Within the prescribed workspace and small-deformation range, the flexible-joint dynamics in Equations (16) and (17) are separated into a local nominal component for controller synthesis and an equivalent disturbance component. The nominal inertia, stiffness, and damping characteristics are constructed from the available CAD-based mass distribution, equivalent inertial information, joint flexibility, and retained modal characteristics at the selected reference or scheduling posture, while the reducer transmission is represented by N. Nonlinear friction, parameter mismatch, dynamic coupling, and external disturbances are incorporated into the lumped-disturbance channel. This controller-oriented representation is not intended as a complete joint-level system identification of the Aubo i5 manipulator; the numerical quantities directly used for controller synthesis, including the retained modal frequencies, Q-filter parameter, target damping ratio, desired PESA pole locations, and comparative-controller gains, are reported in the corresponding design and validation sections.
After normalizing the motor-side variables to the link side, Equation (16) is written as
where
includes the Coriolis and centrifugal terms.
is the gravity term.
is the nonlinear friction torque at the motor side.
is the external environmental disturbance torque acting on the link side (mainly caused by emergency stops).
is the normalized control input torque.
Introducing the nominal inertia matrix yields the link-side nominal/disturbance decomposition as follows:
where
denotes the equivalent link-side lumped disturbance containing model mismatch, nonlinear coupling, and external loading.
Including the joint-flexibility term in the nominal dynamics yields
The same nominalization procedure is applied to the motor side, yielding Equation (21), while the motor-side friction and parameter uncertainty are incorporated into the equivalent lumped disturbance in Equation (22).
The corresponding motor-side lumped disturbance is defined by
Within the effective Q-filter bandwidth, DOB compensation reduces the equivalent disturbance so that the low-frequency plant behavior is approximated by the following nominal linear model:
The matrices in Equation (23) are constructed from the nominal inertia, stiffness, and damping quantities defined above. This local approximation is used for DOB and PESA synthesis within the prescribed operating range and small-deformation assumption; it is not intended as a global exact linearization of the complete nonlinear manipulator.
The remaining nonlinear, uncertain, and externally excited terms are collected into the equivalent motor-side lumped disturbance:
where
denotes the total lumped disturbance equivalent to the motor-side torque channel, and
denotes the mapping from the link-side disturbance to the motor-side torque channel through the flexible-joint transmission. The lumped disturbance combines inertia and damping mismatch, nonlinear friction, multi-axis coupling, unmodeled nonlinear dynamics, and the mapped external disturbance. Within the prescribed workspace and payload range,
is assumed to be bounded, and its dominant low- and medium-frequency components are compensated within the effective Q-filter bandwidth. High-frequency unmodeled flexible dynamics, measurement-noise-induced components, and disturbances outside this bandwidth are not assumed to be fully rejected and remain as bounded residual uncertainty in the robustness analysis.
3.3. General DOB Principle and Enhanced Inner-Loop DOB Design
The DOB follows the standard nominal-model-based disturbance-estimation framework, in which the deviation between the actual plant and its nominal model is interpreted as an equivalent disturbance and compensated through a Q-filtered inverse-model channel. In this study, the DOB is used specifically as the inner-loop nominalization layer for the flexible-joint manipulator, while selective flexible-mode damping is performed by the outer-loop PESA controller.
Based on the nominal model and lumped-disturbance definition in
Section 3.2, the motor-side dynamics used for DOB synthesis are written as
where
and
denote the nominal motor-side inertia and viscous-damping coefficients, respectively;
is the applied motor torque; and
is the equivalent motor-side disturbance defined in
Section 3.2. Its principal components are summarized as
Equation (26) combines the inertia and damping mismatch, nonlinear friction, multi-axis coupling, and mapped external disturbance defined in
Section 3.2. Transforming Equation (25) to the Laplace domain yields
Using the nominal inverse model, the equivalent disturbance estimate is written as
where
denotes the inverse of the nominal plant model and
denotes the reconstructed equivalent disturbance. Because direct use of
is non-proper and sensitive to high-frequency measurement noise, a low-pass Q-filter
is introduced to regularize the inverse-model channel and limit the effective disturbance observation bandwidth. The realizable disturbance estimate is therefore written as.
Because direct nominal-model inversion is non-proper and noise-sensitive, the inverse channel is regularized by the Q-filter, yielding the realizable disturbance estimate:
Based on the compensation principle, the composite control law is designed as
where
denotes the outer-loop virtual control input. Substitution into the motor-side dynamics gives the compensated input–output relation:
Here,
dres denotes the residual disturbance after DOB compensation. When
≈ 1, within the effective observation bandwidth, the corresponding disturbance component is attenuated, and the compensated plant approaches the local nominal dynamics defined in
Section 3.2. The DOB structure is shown in
Figure 1.
The actual plant P(s) is driven by the compensated control input, while the equivalent lumped disturbance dtot(s) is estimated through the nominal inverse model P−1n(s) and the Q-filter. The estimated disturbance is fed back for disturbance compensation.
3.4. Filter Parameter Constraints and Robustness Analysis Based on the Small-Gain Theorem
The DOB observation bandwidth is constrained by unmodeled high-frequency dynamics and measurement noise. Accordingly, the Q-filter is selected using a small-gain robustness condition. A second-order binomial filter is adopted as
where
is the filter time constant; decreasing
increases the effective observation bandwidth but also increases sensitivity to measurement noise and unmodeled high-frequency dynamics.
To evaluate the robustness of the DOB inner loop, the multiplicative model uncertainty between the actual plant and the nominal model is defined as
where
P(
s) is the transfer function of the actual manipulator plant,
Pn(
s) is the nominal plant used in the DOB design, and Δ(
s) represents normalized model uncertainty. This uncertainty includes the effects of parameter mismatch, neglected flexible modes, unmodeled high-frequency dynamics, and digital implementation delay.
According to the small-gain theorem, a sufficient condition for robust internal stability of the DOB inner loop is
For the prescribed plant set, the corresponding worst-case uncertainty bound is defined as
where
denotes the set of plants generated by the considered joint configurations, payload variations, parameter perturbations, and implementation conditions. Thus, a conservative Q-filter selection should satisfy
at every considered frequency. For the second-order binomial Q-filter adopted in this study,
Q(
s), its frequency-response magnitude is
Substituting Equation (37) into Equation (36) yields
When
> 1, the corresponding lower bound of the filter time constant is
Accordingly,
is selected above the maximum lower bound obtained from Equation (39), with an additional robustness margin. The resulting condition applies to the prescribed uncertainty set and does not imply robust stability for arbitrary unmodeled dynamics, payloads, or operating conditions outside the considered range.
where P(s) denotes the actual manipulator plant, P_n(s) denotes the nominal plant used in the DOB design, and Δ(s) denotes the multiplicative uncertainty. For the DOB inner loop, a sufficient small-gain condition for robust internal stability is
or, equivalently,
Since the exact uncertainty is not known for all operating conditions, the worst-case uncertainty bound is introduced as
over the considered frequency range. For the second-order binomial Q-filter adopted in this study,
, its frequency-response magnitude is
. Thus, the sufficient robustness condition becomes
. When
> 1, this inequality gives the lower bound of the filter time constant as
In implementation, λ is selected above the maximum lower bound obtained from the considered frequency range with an additional robustness margin. Under this condition, the DOB satisfies the small-gain requirement within the prescribed uncertainty set, while high-frequency unmodeled dynamics, measurement noise, and neglected flexible modes remain as bounded residual uncertainties outside the effective observation bandwidth.
3.5. Outer-Loop Active Vibration Suppression Based on Eigenstructure Assignment
PESA is synthesized on a controller-oriented reduced-order model rather than on the complete six-joint structural model. Based on the retained-mode selection described in
Section 4.1, the controller states consist of one equivalent rigid-body coordinate
, one retained flexible modal coordinate
, and their corresponding velocities. The reduced state is therefore defined as
, resulting in the fourth-order local representation given in Equation (46). The retained flexible coordinate represents the low-frequency modal component selected for residual-vibration suppression, whereas the effects of the unretained higher-order modes are treated as residual flexible dynamics in the robustness analysis:
Matrix A denotes the reduced-order state matrix, and matrix B represents the input matrix associated with the outer-loop virtual control input. Since the DOB compensates for lumped disturbances and provides a nominalized model, PESA treats the outer-loop input as a virtual excitation applied to the reduced-order system. The matrices A and B are obtained by projecting the nominal rigid–flexible dynamics onto the retained modal subspace, including the equivalent inertia, modal stiffness, damping, and modal input mapping.
Because these parameters vary with manipulator configuration, A and B are posture-dependent. Therefore, the reduced-order matrices are calculated offline at representative scheduling postures, and the corresponding PESA gains are stored in the lookup table. The unretained higher-order modes are considered as residual flexible dynamics in the robustness analysis.
The fourth-order model is used for dominant-mode PESA synthesis rather than representing the complete six-joint flexible dynamics. The retained eigenvector subspace defines the modal direction for eigenstructure assignment, enabling selective modification of the targeted flexible modes. The eigen decomposition of the reduced-order system matrix is given as
where
Ir and
If denote the index sets of the retained rigid-body and flexible modes, respectively. The revised modal partition is not determined by a single natural-frequency threshold. Instead, the retained flexible-mode set is defined according to the modal analysis and the control objective, including the relevant natural frequencies, modal damping requirement, deformation distribution, and coupling with the targeted vibration direction. In the subsequent PESA design, damping is imposed explicitly through the desired closed-loop pole locations and target modal damping ratio rather than through a frequency-only classification criterion.
The rigid-body subspace Vr is retained explicitly because the objective of PESA is selective eigenstructure modification rather than full-state pole reassignment. The eigenstructure associated with the retained flexible subspace Vf is modified to increase modal damping, whereas the eigenstructure associated with Vr is preserved so that the baseline rigid-body trajectory-tracking dynamics are not intentionally altered by the vibration controller. Thus, Vr serves as the preservation constraint in the partial eigenstructure-assignment problem.
Since the system matrix A is structurally symmetric in the decoupled coordinate system, the eigenvectors corresponding to different modes satisfy the generalized orthogonality property, i.e.,
. This ensures that the configuration of
does not mathematically interfere with the characteristics of
. A full-state feedback control law,
, is designed so that the closed-loop system matrix
satisfies specific spectral configuration requirements:
remains unchanged, while
is moved to a high-damping region. For each desired closed-loop eigenvalue
, the following algebraic constraint is satisfied:
Equation (51) is rewritten in matrix form:
Define matrix
. For each desired eigenvalue
, compute the null space basis
of
as follows:
where
is the feasible space of the eigenvector, and
is the feasible space of the input vector. This means that any closed-loop eigenvector
must be a linear combination of the column vectors
. For rigid-body modes, the open-loop eigenvector is directly selected as the closed-loop eigenvector, i.e.,
. The corresponding input vector must be
. For vibration modes,
is selected in the
space to minimize the feedback gain norm or to satisfy specific decoupling conditions. Finally, the modal matrix
and the input matrix
are assembled. If
is nonsingular, the feedback gain matrix
is uniquely determined as
.
To provide a clearer theoretical justification of the DOB–PESA closed-loop system, the stability analysis is reorganized as follows. The closed-loop system after DOB compensation and PESA feedback can be written as
where
A and
B are the reduced-order state matrix and input matrix used for PESA synthesis, K is the PESA feedback gain, and
denotes the residual disturbance after DOB compensation. When the DOB compensation is ideal within the effective bandwidth of the Q-filter,
approaches zero, and Equation (54) reduces to the nominal closed-loop system. Therefore, the disturbance-free closed-loop form corresponds to the nominal compensated system
, while the revised expression explicitly retains the DOB residual disturbance term.
The following assumptions are introduced for the stability analysis. The manipulator operates within the prescribed workspace and payload range used for nominal modeling and controller design. Second, the retained dominant flexible modes are controllable and observable in the reduced-order model. Third, the multiplicative uncertainty satisfies the small-gain condition of the DOB inner loop. Fourth, the residual disturbance after DOB compensation is bounded, namely .
For the nominal compensated system, the PESA feedback gain K is designed such that the selected flexible-mode poles are placed in the open left-half complex plane, while the retained rigid-body dynamics remain stable under the baseline tracking loop. Therefore, the nominal closed-loop matrix is defined as
, and
is Hurwitz. For any positive definite matrix
, there exists a unique symmetric positive-definite matrix
satisfying the Lyapunov equation:
Choose the Lyapunov function:
Since
P is positive definite,
V(
x) is positive definite. Along the trajectory of the nominal compensated system, the derivative of
V(
x) is
Thus, the nominal DOB–PESA closed-loop system is asymptotically stable.
For the actual system, the DOB residual disturbance and unmodeled dynamics are not assumed to be zero. With the bounded residual disturbance
, the derivative of the Lyapunov function satisfies
Assume that the DOB residual disturbance is bounded, namely
, where
is the upper bound of the residual disturbance. Then, the derivative of the Lyapunov function satisfies
. The first term on the right-hand side is a negative quadratic term, while the second term is caused by the bounded DOB residual disturbance. When the state norm is larger than
, the negative quadratic term dominates the residual-disturbance term. Therefore,
is guaranteed outside this bounded neighborhood. This indicates that the closed-loop state will converge toward and remain within a bounded neighborhood of the equilibrium point. Hence, under a bounded DOB residual disturbance, the actual DOB–PESA closed-loop system is uniformly ultimately bounded in the standard Lyapunov sense [
32].
It should be noted that, inside this bounded neighborhood, the upper-bound estimate of may become nonnegative. However, this does not mean that the actual value of must be positive. It only means that strict negativity of cannot be guaranteed by this upper-bound estimate in that region.
In the nominal compensated case, the residual disturbance is zero, namely . Then, Equation (57) becomes . Therefore, the nominal DOB–PESA closed-loop system is asymptotically stable.
According to the DOB robustness analysis in
Section 3.4, the Q-filter satisfies the small-gain condition within the prescribed uncertainty range, ensuring bounded DOB residual disturbances and stable inner-loop compensation.
For gain scheduling, the PESA gains are computed offline at representative scheduling points, where the corresponding closed-loop matrices are verified to be Hurwitz. During online operation, the gains are updated through interpolation within the prescribed scheduling range, preserving local stability over the considered operating conditions.
The state vector
at any time can be expressed as a linear combination of the closed-loop eigenvectors:
This section presents the modal decomposition of the feedback control input. The control input
can also be decomposed into modal components:
For rigid-body modes, the input coupling vector is explicitly constrained. According to the relation , we obtain . When the system undergoes only rigid-body motion, lies entirely in the subspace . In this case, the feedback torque is zero. For an ideal state component lying entirely in the retained rigid-body subspace, the PESA feedback contribution associated with the flexible-mode channel is zero by construction. The controller is therefore designed not to intentionally relocate the retained rigid-body eigenstructure, while practical coupling and modeling uncertainty remain subject to the robustness analysis. For the vibration mode , the term appears. This means that once the sensor detects that the state variable contains flexible modal components, the controller will immediately generate an opposite suppression torque, achieving precise vibration suppression.
The modal decomposition enables PESA to selectively modify flexible-mode dynamics without uniformly increasing the position-loop gain. The rigid-body modes associated with trajectory tracking are preserved, while the selected flexible-mode poles are shifted toward higher damping, resulting in faster vibration decay with limited influence on tracking performance.
3.6. Gain Scheduling Mechanism
To compensate for pose-dependent modal-frequency variation, a joint-pose-driven gain scheduling mechanism is introduced to update the PESA feedback gain according to the current manipulator configuration.
The scheduling variables are selected according to the sensitivity of the dominant modal frequencies to joint-angle variation. For the r-th dominant flexible mode, the frequency sensitivity with respect to the i-th joint angle is evaluated by
where
denotes the r-th modal frequency at configuration q. In implementation, the derivative is calculated using finite differences at representative operating postures. To compare the overall influence of each joint on the retained dominant modes, the normalized sensitivity index is defined as
where
Nm is the number of retained flexible modes and
denotes the normalized modal-frequency sensitivity associated with the i-th joint. The index is used as a relative screening criterion for scheduling-variable selection rather than as an independent controller-performance metric. A larger
indicates a stronger influence of the corresponding joint-angle variation on the retained modal frequencies.
The sensitivity screening identifies Joint 2 and Joint 3 as the primary scheduling variables within the considered posture set. This selection is also consistent with the manipulator geometry: Joint 2 and Joint 3 correspond to the shoulder and elbow axes, whose variations directly modify the manipulator configuration, effective inertia distribution, and flexible-mode characteristics. Joint 1 mainly changes the base azimuth, whereas Joints 4–6 primarily modify the wrist orientation with shorter effective moment arms. Accordingly, q2 and q3 are used to parameterize the offline PESA gain schedule, while the influence of the remaining joints is included in the residual model uncertainty.
The system adopts an offline computation combined with an online lookup table scheduling strategy. In the offline stage, the controller design is completed in advance for typical joint configurations, and the feedback gain matrix is generated. In the online stage, the current gain is obtained in real time through simple interpolation lookup:
Equation (63) is the composite control law for the entire system, where
is the pose feedback matrix. During online operation, linear interpolation is performed between adjacent feature points based on the current joint angle
to calculate the currently required feedback gain matrix:
where
denotes the offline preset gain matrix at the i-th pose. The weight
is determined according to the inverse Euclidean distance between the current configuration and the preset pose points, where N represents the total number of scheduling points. The interpolation-based gain update provides a smooth transition between neighboring PESA gains during configuration changes.
The operator
in Equation (24) represents the mapping of link-side disturbances to the motor-side equivalent disturbance through the flexible-joint dynamics. The DOB estimates and compensates for this equivalent disturbance, thereby reducing the influence of external disturbances on the motor-side dynamics.
Figure 2 illustrates the overall DOB–PESA composite control framework with modal scheduling.
The DOB provides disturbance compensation, while the PESA layer generates the modal-feedback input and the scheduling mechanism updates the PESA gain according to manipulator configuration. For implementation, the PESA gains are calculated offline at representative scheduling points, where the corresponding closed-loop matrices are verified to be Hurwitz. During operation, the gain is obtained by interpolation within the prescribed scheduling range, preserving local closed-loop stability over the validated configurations. This conclusion is limited to the considered scheduling range and does not imply global stability for arbitrary configurations.