13 KiB
+++ title = "Simultaneous, fault-tolerant vibration isolation and pointing control of flexure jointed hexapods" author = ["Thomas Dehaeze"] draft = false +++
- Tags
- [Stewart Platforms]({{<relref "stewart_platforms.md#" >}}), [Vibration Isolation]({{<relref "vibration_isolation.md#" >}}), [Cubic Architecture]({{<relref "cubic_architecture.md#" >}}), [Flexible Joints]({{<relref "flexible_joints.md#" >}}), [Multivariable Control]({{<relref "multivariable_control.md#" >}})
- Reference
- (Li 2001)
- Author(s)
- Li, X.
- Year
- 2001
Introduction
Flexure Jointed Hexapods
A general flexible jointed hexapod is shown in Figure 1.
{{< figure src="/ox-hugo/li01_flexure_hexapod_model.png" caption="Figure 1: A flexure jointed hexapod. {P} is a cartesian coordinate frame located at, and rigidly attached to the payload's center of mass. {B} is the frame attached to the base, and {U} is a universal inertial frame of reference" >}}
Flexure jointed hexapods have been developed to meet two needs illustrated in Figure 2.
{{< figure src="/ox-hugo/li01_quet_dirty_box.png" caption="Figure 2: (left) Vibration machinery must be isolated from a precision bus. (right) A precision paylaod must be manipulated in the presence of base vibrations and/or exogenous forces." >}}
Since only small movements are considered in flexure jointed hexapod, the Jacobian matrix, which relates changes in the Cartesian pose to changes in the strut lengths, can be considered constant. Thus a static kinematic decoupling algorithm can be implemented for both vibration isolation and pointed controls on flexible jointed hexapods.
On the other hand, the flexures add some complexity to the hexapod dynamics. Although the flexure joints do eliminate friction and backlash, they add spring dynamics and severely limit the workspace. Moreover, base and/or payload vibrations become significant contributors to the motion.
The University of Wyoming hexapods (example in Figure 3) are:
- Cubic (mutually orthogonal)
- Flexure Jointed
{{< figure src="/ox-hugo/li01_stewart_platform.png" caption="Figure 3: Flexure jointed Stewart platform used for analysis and control" >}}
The objectives of the hexapods are:
- Precise pointing in two axes (sub micro-radians)
- simultaneously, providing both passive and active vibration isolation in six axes
Jacobian matrix, Dynamic model, and decoupling algorithms
Jacobian Matrix
The Jacobian matrix \(J\) relates changes in the cartesian pose \(\mathcal{X}\) to changes in the strut lengths \(l\):
\begin{equation} \delta l = J \delta \mathcal{X} \end{equation}
where \(\mathcal{X}\) is a 6x1 vector of payload plate translations and rotations
\begin{equation} \mathcal{X} = \begin{bmatrix} p_x & p_y & p_z & \theta_x & \theta_y & \theta_z \end{bmatrix} \end{equation}
\(J\) is given by:
\begin{equation} J = \begin{bmatrix} {}^B\hat{u}_1^T & [({}^B_PR^P p_1) \times {}^B\hat{u}_1]^T \\\ \vdots & \vdots \\\ {}^B\hat{u}_6^T & [({}^B_PR^P p_6) \times {}^B\hat{u}_6]^T \end{bmatrix} \end{equation}
where (see Figure 1) \(p_i\) denotes the payload attachment point of strut \(i\), the prescripts denote the frame of reference, and \(\hat{u}_i\) denotes a unit vector along strut \(i\). To make the dynamic model as simple as possible, the origin of {P} is located at the payload's center of mass. Thus all \({}^Pp_i\) are found with respect to the center of mass.
Dynamic model of flexure jointed hexapods
The dynamics of a flexure jointed hexapod can be written in joint space:
\begin{equation} \begin{split} & \left( J^{-T} {}^B_PR^P M_x {}^B_PR^T J^{-1} + M_s \right) \ddot{l} + B \dot{l} + K (l - l_r) = \\\ &\quad f_m - \left( M_s + J^{-T} {}^B_PR^P M_x {}^U_PR^T J_c J_b^{-1} \right) \ddot{q}_u + J^{-T} {}^U_BR_T(\mathcal{F}_e + \mathcal{G} + \mathcal{C}) \end{split} \end{equation}
Test
Jacobian Analysis: \[ \delta \mathcal{L} = J \delta \mathcal{X} \] The origin of \(\{P\}\) is taken as the center of mass of the payload.
Decoupling: If we refine the (force) inputs and (displacement) outputs as shown in Figure 4 or in Figure 5, we obtain a decoupled plant provided that:
- the payload mass/inertia matrix must be diagonal (the CoM is coincident with the origin of frame \(\{P\}\))
- the geometry of the hexapod and the attachment of the payload to the hexapod must be carefully chosen
For instance, if the hexapod has a mutually orthogonal geometry (cubic configuration), the payload's center of mass must coincide with the center of the cube formed by the orthogonal struts.
{{< figure src="/ox-hugo/li01_decoupling_conf.png" caption="Figure 4: Decoupling the dynamics of the Stewart Platform using the Jacobians" >}}
{{< figure src="/ox-hugo/li01_decoupling_conf_bis.png" caption="Figure 5: Decoupling the dynamics of the Stewart Platform using the Jacobians" >}}
Simultaneous Vibration Isolation and Pointing Control
Basic idea:
- acceleration feedback is used to provide high-frequency vibration isolation
- cartesian pointing feedback can be used to provide low-frequency pointing
The compensation is divided in frequency because:
- pointing sensors often have low bandwidth
- acceleration sensors often have a poor low frequency response
The control bandwidth is divided as follows:
- low-frequency disturbances as attenuated and tracking is accomplished by feedback from low bandwidth pointing sensors
- mid-frequency disturbances are attenuated by feedback from band-pass sensors like accelerometer or load cells
- high-frequency disturbances are attenuated by passive isolation techniques
Vibration Isolation
The system is decoupled into six independent SISO subsystems using the architecture shown in Figure 6.
{{< figure src="/ox-hugo/li01_vibration_isolation_control.png" caption="Figure 6: Figure caption" >}}
One of the subsystem plant transfer function is shown in Figure 6
{{< figure src="/ox-hugo/li01_vibration_control_plant.png" caption="Figure 7: Plant transfer function of one of the SISO subsystem for Vibration Control" >}}
Each compensator is designed using simple loop-shaping techniques.
The unity control bandwidth of the isolation loop is designed to be from 5Hz to 50Hz.
Despite a reasonably good match between the modeled and the measured transfer functions, the model based decoupling algorithm does not produce the expected decoupling. Only about 20 dB separation is achieve between the diagonal and off-diagonal responses.
Pointing Control
A block diagram of the pointing control system is shown in Figure 8.
{{< figure src="/ox-hugo/li01_pointing_control.png" caption="Figure 8: Figure caption" >}}
The plant is decoupled into two independent SISO subsystems. The compensators are design with inverse-dynamics methods.
The unity control bandwidth of the pointing loop is designed to be from 0Hz to 20Hz.
A feedforward control is added as shown in Figure 9.
{{< figure src="/ox-hugo/li01_feedforward_control.png" caption="Figure 9: Feedforward control" >}}
Simultaneous Control
The simultaneous vibration isolation and pointing control is approached in two ways:
- design and implement the vibration isolation control first, identify the pointing plant when the isolation loops are closed, then implement the pointing compensators
- the reverse design order
Figure 10 shows a parallel control structure where \(G_1(s)\) is the dynamics from input force to output strut length.
{{< figure src="/ox-hugo/li01_parallel_control.png" caption="Figure 10: A parallel scheme" >}}
The transfer function matrix for the pointing loop after the vibration isolation is closed is still decoupled. The same happens when closing the pointing loop first and looking at the transfer function matrix of the vibration isolation.
The effect of the isolation loop on the pointing loop is large around the natural frequency of the plant as shown in Figure 11.
{{< figure src="/ox-hugo/li01_effect_isolation_loop_closed.png" caption="Figure 11: \(\theta_x/\theta_{x_d}\) transfer function with the isolation loop closed (simulation)" >}}
The effect of pointing control on the isolation plant has not much effect.
The interaction between loops may affect the transfer functions of the first closed loop, and thus affect its relative stability.
The dynamic interaction effect:
- only happens in the unity bandwidth of the loop transmission of the first closed loop.
- affect the closed loop transmission of the loop first closed (see Figures 12 and 13)
As shown in Figure 12, the peak resonance of the pointing loop increase after the isolation loop is closed. The resonances happen at both crossovers of the isolation loop (15Hz and 50Hz) and they may show of loss of robustness.
{{< figure src="/ox-hugo/li01_closed_loop_pointing.png" caption="Figure 12: Closed-loop transfer functions \(\theta_y/\theta_{y_d}\) of the pointing loop before and after the vibration isolation loop is closed" >}}
The same happens when first closing the vibration isolation loop and after the pointing loop (Figure 13). The first peak resonance of the vibration isolation loop at 15Hz is increased when closing the pointing loop.
{{< figure src="/ox-hugo/li01_closed_loop_vibration.png" caption="Figure 13: Closed-loop transfer functions of the vibration isolation loop before and after the pointing control loop is closed" >}}
The isolation loop adds a second resonance peak at its high-frequency crossover in the pointing closed-loop transfer function, which may cause instability. Thus, it is recommended to design and implement the isolation control system first, and then identify the pointing plant with the isolation loop closed.
Experimental results
Two hexapods are stacked (Figure 14):
- the bottom hexapod is used to generate disturbances matching candidate applications
- the top hexapod provide simultaneous vibration isolation and pointing control
{{< figure src="/ox-hugo/li01_test_bench.png" caption="Figure 14: Stacked Hexapods" >}}
Using the vibration isolation control alone, no attenuation is achieved below 1Hz as shown in figure 15.
{{< figure src="/ox-hugo/li01_vibration_isolation_control_results.png" caption="Figure 15: Vibration isolation control: open-loop (solid) vs. closed-loop (dashed)" >}}
The simultaneous control is of dual use:
- it provide simultaneous pointing and isolation control
- it can also be used to expand the bandwidth of the isolation control to low frequencies because the pointing loops suppress pointing errors due to both base vibrations and tracking
The results of simultaneous control is shown in Figure 16 where the bandwidth of the isolation control is expanded to very low frequency.
{{< figure src="/ox-hugo/li01_simultaneous_control_results.png" caption="Figure 16: Simultaneous control: open-loop (solid) vs. closed-loop (dashed)" >}}
Future research areas
Proposed future research areas include:
- Include base dynamics in the control: The base dynamics is here neglected since the movements of the base are very small. The base dynamics could be measured by mounting accelerometers at the bottom of each strut or by using force sensors. It then could be included in the feedforward path.
- Robust control and MIMO design
- New decoupling method: The proposed decoupling algorithm do not produce the expected decoupling, despite a reasonably good match between the modeled and the measured transfer functions. Incomplete decoupling increases the difficulty in designing the controller. New decoupling methods are needed. These methods must be static in order to be implemented practically on precision hexapods
- Identification: Many advanced control methods require a more accurate model or identified plant. A closed-loop identification method is propose to solve some problems with the current identification methods used.
- Other possible sensors:
Many sensors can be used to expand the utility of the Stewart platform:
- 3-axis load cells to investigate the Coriolis and centripetal terms and new decoupling methods
- LVDT to provide differential position of the hexapod payload with respect to the base
- Geophones to provide payload and base velocity information
Bibliography
Li, Xiaochun. 2001. “Simultaneous, Fault-Tolerant Vibration Isolation and Pointing Control of Flexure Jointed Hexapods.” University of Wyoming.