1010 lines
76 KiB
TeX
1010 lines
76 KiB
TeX
% Created 2025-02-19 Wed 19:45
|
|
% Intended LaTeX compiler: pdflatex
|
|
\documentclass[a4paper, 10pt, DIV=12, parskip=full, bibliography=totoc]{scrreprt}
|
|
|
|
\input{preamble.tex}
|
|
\input{preamble_extra.tex}
|
|
\bibliography{simscape-nano-hexapod.bib}
|
|
\author{Dehaeze Thomas}
|
|
\date{\today}
|
|
\title{Simscape Model - Nano Hexapod}
|
|
\hypersetup{
|
|
pdfauthor={Dehaeze Thomas},
|
|
pdftitle={Simscape Model - Nano Hexapod},
|
|
pdfkeywords={},
|
|
pdfsubject={},
|
|
pdfcreator={Emacs 29.4 (Org mode 9.6)},
|
|
pdflang={English}}
|
|
\usepackage{biblatex}
|
|
|
|
\begin{document}
|
|
|
|
\maketitle
|
|
\tableofcontents
|
|
|
|
\clearpage
|
|
|
|
Building upon the validated multi-body model of the micro-station presented in previous sections, this section focuses on the development and integration of an active vibration platform model.
|
|
|
|
A review of existing active vibration platforms is given in Section \ref{sec:nhexa_platform_review}, leading to the selection of the Stewart platform architecture.
|
|
This parallel manipulator architecture, described in Section \ref{sec:nhexa_stewart_platform}, requires specialized analytical tools for kinematic analysis.
|
|
However, the complexity of its dynamic behavior poses significant challenges for purely analytical approaches.
|
|
|
|
Consequently, a multi-body modeling approach was adopted (Section \ref{sec:nhexa_model}), facilitating seamless integration with the existing micro-station model.
|
|
|
|
The control of the Stewart platform introduces additional complexity due to its multi-input multi-output (MIMO) nature.
|
|
Section \ref{sec:nhexa_control} explores how the High Authority Control/Low Authority Control (HAC-LAC) strategy, previously validated on the uniaxial model, can be adapted to address the coupled dynamics of the Stewart platform.
|
|
This adaptation requires fundamental decisions regarding both the control architecture (centralized versus decentralized) and the control frame (Cartesian versus strut space).
|
|
Through careful analysis of system interactions and plant characteristics in different frames, a control architecture combining decentralized Integral Force Feedback for active damping with a centralized high authority controller for positioning was developed, with both controllers implemented in the frame of the struts.
|
|
|
|
\chapter{Active Vibration Platforms}
|
|
\label{sec:nhexa_platform_review}
|
|
The conceptual phase started with the use of simplified models, such as uniaxial and three-degree-of-freedom rotating systems.
|
|
These models were chosen for their ease of analysis, and despite their simplicity, the principles derived from them usually apply to more complex systems.
|
|
However, the development of the Nano Active Stabilization System (NASS) now requires the use of a more accurate model that will be integrated with the multi-body representation of the micro-station.
|
|
To develop this model, the architecture of the active platform must first be determined.
|
|
|
|
The selection of an appropriate architecture begins with a review of existing positioning stages that incorporate active platforms similar to NASS (Section \ref{ssec:nhexa_sample_stages}).
|
|
This review reveals two distinctive features of the NASS that set it apart from existing systems: the fact that the active platform is continuously rotating and its requirement to accommodate high payload masses.
|
|
In existing systems, the sample mass is typically negligible compared to the stage mass, whereas in NASS, the sample mass significantly influences the system's dynamic behavior.
|
|
|
|
These distinctive requirements drive the selection of the active platform architecture.
|
|
In Section \ref{ssec:nhexa_active_platforms}, different active platform configurations, including serial and parallel configurations, are evaluated, ultimately leading to the choice of a Stewart platform architecture.
|
|
\section{Sample Stages with Active Control}
|
|
\label{ssec:nhexa_sample_stages}
|
|
|
|
The positioning of samples with respect to to X-ray beam, that can be focused to sizes below 100 nanometers, presents significant challenges, because mechanical positioning systems are typically limited to micron-scale accuracy.
|
|
To overcome this limitation, external metrology systems have been implemented to measure sample positions with nanometer accuracy, enabling real-time feedback control for sample stabilization.
|
|
|
|
A review of existing sample stages with active vibration control reveals various approaches to implementing such feedback systems.
|
|
In many cases, sample position control is limited to translational degrees of freedom.
|
|
At NSLS-II, for instance, a system capable of \(100\,\mu m\) stroke has been developed for payloads up to 500g, utilizing interferometric measurements for position feedback (Figure \ref{fig:nhexa_stages_nazaretski}).
|
|
Similarly, at the Sirius facility, a tripod configuration based on voice coil actuators has been implemented for XYZ position control, achieving feedback bandwidths of approximately 100 Hz (Figure \ref{fig:nhexa_stages_sapoti}).
|
|
|
|
\begin{figure}[h!tbp]
|
|
\begin{subfigure}{0.36\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=6.5cm]{figs/nhexa_stages_nazaretski.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_stages_nazaretski} MLL microscope}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.60\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=6.5cm]{figs/nhexa_stages_sapoti.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_stages_sapoti} SAPOTI sample stage}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_stages_translations}Example of sample stage with active XYZ corrections based on external metrology. The MLL microscope \cite{nazaretski15_pushin_limit} at NSLS-II (\subref{fig:nhexa_stages_nazaretski}). Sample stage on SAPOTI beamline \cite{geraldes23_sapot_carnaub_sirius_lnls} at Sirius facility (\subref{fig:nhexa_stages_sapoti})}
|
|
\end{figure}
|
|
|
|
The integration of \(R_z\) rotational capability, which is necessary for tomography experiments, introduces additional complexity.
|
|
At ESRF's ID16A beamline, a Stewart platform (whose architecture will be presented in Section \ref{sec:nhexa_stewart_platform}) using piezoelectric actuators has been positioned below the spindle (Figure \ref{fig:nhexa_stages_villar}).
|
|
While this configuration enables the correction of spindle motion errors through 5-DoF control based on capacitive sensor measurements, the stroke is limited to \(50\,\mu m\) due to the inherent constraints of piezoelectric actuators.
|
|
In contrast, at PETRA III, an alternative approach places a XYZ-stacked stage above the spindle, offering \(100\,\mu m\) stroke (Figure \ref{fig:nhexa_stages_schroer}).
|
|
However, attempts to implement real-time feedback using YZ external metrology proved challenging, possibly due to the poor dynamical response of the serial stage configuration.
|
|
|
|
\begin{figure}[h!tbp]
|
|
\begin{subfigure}{0.54\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=6cm]{figs/nhexa_stages_villar.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_stages_villar} Simplified schematic of ID16a end-station}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.40\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=6cm]{figs/nhexa_stages_schroer.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_stages_schroer} PtyNAMi microscope}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_stages_spindle}Example of two sample stages for tomography experiments. ID16a endstation \cite{villar18_nanop_esrf_id16a_nano_imagin_beaml} at the ESRF (\subref{fig:nhexa_stages_villar}). PtyNAMi microscope \cite{schropp20_ptynam,schroer17_ptynam} at PETRA III (\subref{fig:nhexa_stages_schroer})}
|
|
\end{figure}
|
|
|
|
Table \ref{tab:nhexa_sample_stages} provides an overview of existing end-stations that incorporate feedback loops based on online metrology for sample positioning.
|
|
Although direct performance comparisons between these systems are challenging due to their varying experimental requirements, scanning velocities, and specific use cases, several distinctive characteristics of the NASS can be identified.
|
|
|
|
\begin{table}[!ht]
|
|
\caption{\label{tab:nhexa_sample_stages}End-Stations with integrated feedback loops based on online metrology. The stages used for feedback are indicated in bold font. Stages not used for scanning purposes are ommited or indicated between parentheses. The specifications for the NASS are indicated in the last row.}
|
|
\centering
|
|
\scriptsize
|
|
\begin{tabularx}{0.8\linewidth}{ccccc}
|
|
\toprule
|
|
\textbf{Stacked Stages} & \textbf{Specifications} & \textbf{Measured DoFs} & \textbf{Bandwidth} & \textbf{Reference}\\
|
|
\midrule
|
|
Sample & light & Interferometers & 3 PID, n/a & APS\\
|
|
\textbf{XYZ stage (piezo)} & \(D_{xyz}: 0.05\,mm\) & \(D_{xyz}\) & & \cite{nazaretski15_pushin_limit}\\
|
|
\midrule
|
|
Sample & light & Capacitive sensors & \(\approx 10\,\text{Hz}\) & ESRF\\
|
|
Spindle & \(R_z: \pm 90\,\text{deg}\) & \(D_{xyz},\ R_{xy}\) & & ID16a\\
|
|
\textbf{Hexapod (piezo)} & \(D_{xyz}: 0.05\,mm\) & & & \cite{villar18_nanop_esrf_id16a_nano_imagin_beaml}\\
|
|
& \(R_{xy}: 500\,\mu\text{rad}\) & & & \\
|
|
\midrule
|
|
Sample & light & Interferometers & n/a & PETRA III\\
|
|
\textbf{XYZ stage (piezo)} & \(D_{xyz}: 0.1\,mm\) & \(D_{yz}\) & & P06\\
|
|
Spindle & \(R_z: 180\,\text{deg}\) & & & \cite{schroer17_ptynam,schropp20_ptynam}\\
|
|
\midrule
|
|
Sample & light & Interferometers & PID, n/a & PSI\\
|
|
Spindle & \(R_z: \pm 182\,\text{deg}\) & \(D_{yz},\ R_x\) & & OMNY\\
|
|
\textbf{Tripod (piezo)} & \(D_{xyz}: 0.4\,mm\) & & & \cite{holler17_omny_pin_versat_sampl_holder,holler18_omny_tomog_nano_cryo_stage}\\
|
|
\midrule
|
|
Sample & light & Interferometers & n/a & Soleil\\
|
|
(XY stage) & & \(D_{xyz},\ R_{xy}\) & & Nanoprobe\\
|
|
Spindle & \(R_z: 360\,\text{deg}\) & & & \cite{stankevic17_inter_charac_rotat_stages_x_ray_nanot,engblom18_nanop_resul}\\
|
|
\textbf{XYZ linear motors} & \(D_{xyz}: 0.4\,mm\) & & & \\
|
|
\midrule
|
|
Sample & up to 0.5kg & Interferometers & n/a & NSLS\\
|
|
Spindle & \(R_z: 360\,\text{deg}\) & \(D_{xyz}\) & & SRX\\
|
|
\textbf{XYZ stage (piezo)} & \(D_{xyz}: 0.1\,mm\) & & & \cite{nazaretski22_new_kirkp_baez_based_scann}\\
|
|
\midrule
|
|
Sample & up to 0.35kg & Interferometers & \(\approx 100\,\text{Hz}\) & Diamond, I14\\
|
|
\textbf{Parallel XYZ VC} & \(D_{xyz}: 3\,mm\) & \(D_{xyz}\) & & \cite{kelly22_delta_robot_long_travel_nano}\\
|
|
\midrule
|
|
Sample & light & Capacitive sensors & \(\approx 100\,\text{Hz}\) & LNLS\\
|
|
\textbf{Parallel XYZ VC} & \(D_{xyz}: 3\,mm\) & and interferometers & & CARNAUBA\\
|
|
(Spindle) & \(R_z: \pm 110 \,\text{deg}\) & \(D_{xyz}\) & & \cite{geraldes23_sapot_carnaub_sirius_lnls}\\
|
|
\midrule
|
|
Sample & up to 50kg & \(D_{xyz},\ R_{xy}\) & & ESRF\\
|
|
\textbf{Active Platform} & & & & ID31\\
|
|
(Micro-Hexapod) & & & & \cite{dehaeze18_sampl_stabil_for_tomog_exper,dehaeze21_mechat_approac_devel_nano_activ_stabil_system}\\
|
|
Spindle & \(R_z: 360\,\text{deg}\) & & & \\
|
|
Tilt-Stage & \(R_y: \pm 3\,\text{deg}\) & & & \\
|
|
Translation Stage & \(D_y: \pm 10\,mm\) & & & \\
|
|
\bottomrule
|
|
\end{tabularx}
|
|
\end{table}
|
|
|
|
|
|
The first key distinction of the NASS is in the continuous rotation of the active vibration platform.
|
|
This feature introduces significant complexity through gyroscopic effects and real-time changes in the platform orientation, which substantially impact both the system's kinematics and dynamics.
|
|
In addition, NASS implements a unique Long-Stroke/Short-Stroke architecture.
|
|
In conventional systems, active platforms typically correct spindle positioning errors - for example, unwanted translations or tilts that occur during rotation, whereas the intended rotational motion (\(R_z\)) is performed by the spindle itself and is not corrected.
|
|
The NASS, however, faces a more complex task: it must compensate for positioning errors of the translation and tilt stages in real time during their operation, including corrections along their primary axes of motion.
|
|
For instance, when the translation stage moves along Y, the active platform must not only correct for unwanted motions in other directions but also correct the position along Y, which necessitate some synchronization between the control of the long stroke stages and the control of the active platform.
|
|
|
|
The second major distinguishing feature of the NASS is its capability to handle payload masses up to 50 kg, exceeding typical capacities in the literature by two orders of magnitude.
|
|
This substantial increase in payload mass fundamentally alters the system's dynamic behavior, as the sample mass significantly influences the overall system dynamics, in contrast to conventional systems where sample masses are negligible relative to the stage mass.
|
|
This characteristic introduces significant control challenges, as the feedback system must remain stable and maintain performance across a wide range of payload masses (from a few kilograms to 50 kg), requiring robust control strategies to handle such large plant variations.
|
|
|
|
The NASS also distinguishes itself through its high mobility and versatility, which are achieved through the use of multiple stacked stages (translation stage, tilt stage, spindle, positioning hexapod) that enable a wide range of experimental configurations.
|
|
The resulting mechanical structure exhibits complex dynamics with multiple resonance modes in the low frequency range.
|
|
This dynamic complexity poses significant challenges for the design and control of the active platform.
|
|
|
|
The primary control requirements focus on \([D_y,\ D_z,\ R_y]\) motions; however, the continuous rotation of the active platform requires the control of \([D_x,\ D_y,\ D_z,\ R_x,\ R_y]\) in the active platform's reference frame.
|
|
|
|
\section{Active Vibration Platform}
|
|
\label{ssec:nhexa_active_platforms}
|
|
|
|
The choice of the active platform architecture for the NASS requires careful consideration of several critical specifications.
|
|
The platform must provide control over five degrees of freedom (\(D_x\), \(D_y\), \(D_z\), \(R_x\), and \(R_y\)), with strokes exceeding \(100\,\mu m\) to correct for micro-station positioning errors, while fitting within a cylindrical envelope of 300 mm diameter and 95 mm height.
|
|
It must accommodate payloads up to 50 kg while maintaining high dynamical performance.
|
|
For light samples, the typical design strategy of maximizing actuator stiffness works well because resonance frequencies in the kilohertz range can be achieved, enabling control bandwidths up to 100 Hz.
|
|
However, achieving such resonance frequencies with a 50 kg payload would require unrealistic stiffness values of approximately \(2000\,N/\mu m\).
|
|
This limitation necessitates alternative control approaches, and the High Authority Control/Low Authority Control (HAC-LAC) strategy is proposed to address this challenge.
|
|
Consequently, the design must incorporate force sensors for active damping.
|
|
Compliant mechanisms must also be used to eliminate friction and backlash, which would otherwise compromise the nano-positioning capabilities.
|
|
|
|
Two primary categories of positioning platform architectures are considered: serial and parallel mechanisms.
|
|
Serial robots, characterized by open-loop kinematic chains, typically dedicate one actuator per degree of freedom as shown in Figure \ref{fig:nhexa_serial_architecture_kenton}.
|
|
While offering large workspaces and high maneuverability, serial mechanisms suffer from several inherent limitations.
|
|
These include low structural stiffness, cumulative positioning errors along the kinematic chain, high mass-to-payload ratios due to actuator placement, and limited payload capacity \cite{taghirad13_paral}.
|
|
These limitations generally make serial architectures unsuitable for nano-positioning applications, except when handling very light samples, as was used in \cite{nazaretski15_pushin_limit} and shown in Figure \ref{fig:nhexa_stages_nazaretski}.
|
|
|
|
In contrast, parallel mechanisms, which connect the mobile platform to the fixed base through multiple parallel struts, offer several advantages for precision positioning.
|
|
Their closed-loop kinematic structure provides inherently higher structural stiffness, as the platform is simultaneously supported by multiple struts \cite{taghirad13_paral}.
|
|
Although parallel mechanisms typically exhibit limited workspace compared to serial architectures, this limitation is not critical for NASS given its modest stroke requirements.
|
|
Numerous parallel kinematic architectures have been developed \cite{dong07_desig_precis_compl_paral_posit} to address various positioning requirements, with designs varying based on the desired degrees of freedom and specific application constraints.
|
|
Furthermore, hybrid architectures combining both serial and parallel elements have been proposed \cite{shen19_dynam_analy_flexur_nanop_stage}, as illustrated in Figure \ref{fig:nhexa_serial_parallel_examples}, offering potential compromises between the advantages of both approaches.
|
|
|
|
\begin{figure}[h!tbp]
|
|
\begin{subfigure}{0.41\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=5cm]{figs/nhexa_serial_architecture_kenton.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_serial_architecture_kenton} Serial positioning stage}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.55\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=5cm]{figs/nhexa_parallel_architecture_shen.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_parallel_architecture_shen} Hybrid 5-DoF stage}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_serial_parallel_examples}Examples of an XYZ serial positioning stage \cite{kenton12_desig_contr_three_axis_serial} (\subref{fig:nhexa_serial_architecture_kenton}) and of a 5-DoF hybrid (parallel/serial) positioning platform \cite{shen19_dynam_analy_flexur_nanop_stage} (\subref{fig:nhexa_parallel_architecture_shen}).}
|
|
\end{figure}
|
|
|
|
After evaluating the different options, the Stewart platform architecture was selected for several reasons.
|
|
In addition to providing control over all required degrees of freedom, its compact design and predictable dynamic characteristics make it particularly suitable for nano-positioning when combined with flexible joints.
|
|
Stewart platforms have been implemented in a wide variety of configurations, as illustrated in Figure \ref{fig:nhexa_stewart_examples}, which shows two distinct implementations: one utilizing piezoelectric actuators for nano-positioning applications, and another based on voice coil actuators for vibration isolation.
|
|
These examples demonstrate the architecture's versatility in terms of geometry, actuator selection, and scale, all of which can be optimized for specific applications.
|
|
Furthermore, the successful implementation of Integral Force Feedback (IFF) control on Stewart platforms has been well documented \cite{abu02_stiff_soft_stewar_platf_activ,hanieh03_activ_stewar,preumont07_six_axis_singl_stage_activ}, and the extensive body of research on this architecture enables thorough optimization specifically for the NASS.
|
|
|
|
\begin{figure}[h!tbp]
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/nhexa_stewart_piezo_furutani.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_stewart_piezo_furutani} Stewart platform for Nano-positioning}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/nhexa_stewart_vc_preumont.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_stewart_vc_preumont} Stewart platform for vibration isolation}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_stewart_examples}Two examples of Stewart platform. A Stewart platform based on piezoelectric stack actuators and used for nano-positioning is shown in (\subref{fig:nhexa_stewart_piezo_furutani}) \cite{furutani04_nanom_cuttin_machin_using_stewar}. A Stewart platform based on voice coil actuators and used for vibration isolation is shown in (\subref{fig:nhexa_stewart_vc_preumont}) \cite{preumont07_six_axis_singl_stage_activ,preumont18_vibrat_contr_activ_struc_fourt_edition}}
|
|
\end{figure}
|
|
|
|
\chapter{The Stewart platform}
|
|
\label{sec:nhexa_stewart_platform}
|
|
The Stewart platform, first introduced by Stewart in 1965 \cite{stewart65_platf_with_six_degrees_freed} for flight simulation applications, represents a significant milestone in parallel manipulator design.
|
|
This mechanical architecture has evolved far beyond its original purpose, and has been applied across diverse field, from precision positioning systems to robotic surgery.
|
|
The fundamental design consists of two platforms connected by six adjustable struts in parallel, creating a fully parallel manipulator capable of six degrees of freedom motion.
|
|
|
|
Unlike serial manipulators, in which errors worsen through the kinematic chain, parallel architectures distribute loads across multiple actuators, leading to enhanced mechanical stiffness and improved positioning accuracy.
|
|
This parallel configuration also results in superior dynamic performance because the actuators directly contribute to the platform's motion without intermediate linkages.
|
|
These characteristics make the Stewart platforms particularly valuable in applications requiring high precision and stiffness.
|
|
|
|
For the NASS application, the Stewart platform architecture offers three key advantages.
|
|
First, as a fully parallel manipulator, all the motion errors of the micro-station can be compensated through the coordinated action of the six actuators.
|
|
Second, its compact design compared to serial manipulators makes it ideal for integration on top micro-station where only \(95\,mm\) of height is available.
|
|
Third, the good dynamical properties should enable high-bandwidth positioning control.
|
|
|
|
While Stewart platforms excel in precision and stiffness, they typically exhibit a relatively limited workspace compared to serial manipulators.
|
|
However, this limitation is not significant for the NASS application, as the required motion range corresponds to the positioning errors of the micro-station, which are in the order of \(10\,\mu m\).
|
|
|
|
This section provides a comprehensive analysis of the Stewart platform's properties, focusing on aspects crucial for precision positioning applications.
|
|
The analysis encompasses the platform's kinematic relationships (Section \ref{ssec:nhexa_stewart_platform_kinematics}), the use of the Jacobian matrix (Section \ref{ssec:nhexa_stewart_platform_jacobian}), static behavior (Section \ref{ssec:nhexa_stewart_platform_static}), and dynamic characteristics (Section \ref{ssec:nhexa_stewart_platform_dynamics}).
|
|
These theoretical foundations form the basis for subsequent design decisions and control strategies, which will be elaborated in later sections.
|
|
\section{Mechanical Architecture}
|
|
\label{ssec:nhexa_stewart_platform_architecture}
|
|
|
|
The Stewart platform consists of two rigid platforms connected by six parallel struts (Figure \ref{fig:nhexa_stewart_architecture}).
|
|
Each strut incorporates an active prismatic joint that allows for controlled length variation, with its ends attached to the fixed and mobile platforms through joints.
|
|
The typical configuration consists of a universal joint at one end and a spherical joint at the other, providing the necessary degrees of freedom\footnote{Different architecture exists, typically referred as ``6-SPS'' (Spherical, Prismatic, Spherical) or ``6-UPS'' (Universal, Prismatic, Spherical)}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_stewart_architecture.png}
|
|
\caption{\label{fig:nhexa_stewart_architecture}Schematical representation of the Stewart platform architecture.}
|
|
\end{figure}
|
|
|
|
To facilitate the rigorous analysis of the Stewart platform, four reference frames were defined:
|
|
\begin{itemize}
|
|
\item The fixed base frame \(\{F\}\), which is located at the center of the base platform's bottom surface, serves as the mounting reference for the support structure.
|
|
\item The mobile frame \(\{M\}\), which is located at the center of the top platform's upper platform, provides a reference for payload mounting.
|
|
\item The point-of-interest frame \(\{A\}\), fixed to the base but positioned at the workspace center.
|
|
\item The moving point-of-interest frame \(\{B\}\), attached to the mobile platform coincides with frame \(\{A\}\) in the home position.
|
|
\end{itemize}
|
|
|
|
Frames \(\{F\}\) and \(\{M\}\) serve primarily to define the joint locations.
|
|
In contrast, frames \(\{A\}\) and \(\{B\}\) are used to describe the relative motion of the two platforms through the position vector \({}^A\bm{P}_B\) of frame \(\{B\}\) expressed in frame \(\{A\}\) and the rotation matrix \({}^A\bm{R}_B\) expressing the orientation of \(\{B\}\) with respect to \(\{A\}\).
|
|
For the nano-hexapod, frames \(\{A\}\) and \(\{B\}\) are chosen to be located at the theoretical focus point of the X-ray light which is \(150\,mm\) above the top platform, i.e. above \(\{M\}\).
|
|
|
|
The location of the joints and the orientation and length of the struts are crucial for subsequent kinematic, static, and dynamic analyses of the Stewart platform.
|
|
The center of rotation for the joint fixed to the base is noted \(\bm{a}_i\), while \(\bm{b}_i\) is used for the top platform joints.
|
|
The struts' orientations are represented by the unit vectors \(\hat{\bm{s}}_i\) and their lengths are represented by the scalars \(l_i\).
|
|
This is summarized in Figure \ref{fig:nhexa_stewart_notations}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_stewart_notations.png}
|
|
\caption{\label{fig:nhexa_stewart_notations}Frame and key notations for the Stewart platform}
|
|
\end{figure}
|
|
|
|
\section{Kinematic Analysis}
|
|
\label{ssec:nhexa_stewart_platform_kinematics}
|
|
The kinematic analysis of the Stewart platform involves understanding the geometric relationships between the platform position/orientation and the actuator lengths without considering the forces involved.
|
|
\paragraph{Loop Closure}
|
|
|
|
The foundation of the kinematic analysis lies in the geometric constraints imposed by each strut, which can be expressed using loop closure equations.
|
|
For each strut \(i\) (illustrated in Figure \ref{fig:nhexa_stewart_loop_closure}), the loop closure equation \eqref{eq:nhexa_loop_closure} can be written.
|
|
|
|
\begin{equation}\label{eq:nhexa_loop_closure}
|
|
{}^A\bm{P}_B = {}^A\bm{a}_i + l_i{}^A\hat{\bm{s}}_i - \underbrace{{}^B\bm{b}_i}_{{}^A\bm{R}_B {}^B\bm{b}_i} \quad \text{for } i=1 \text{ to } 6
|
|
\end{equation}
|
|
|
|
This equation links the pose variables \({}^A\bm{P}\) and \({}^A\bm{R}_B\), the position vectors describing the known geometry of the base and the moving platform, \(\bm{a}_i\) and \(\bm{b}_i\), and the strut vector \(l_i {}^A\hat{\bm{s}}_i\):
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_stewart_loop_closure.png}
|
|
\caption{\label{fig:nhexa_stewart_loop_closure}Notations to compute the kinematic loop closure}
|
|
\end{figure}
|
|
|
|
\paragraph{Inverse Kinematics}
|
|
|
|
The inverse kinematic problem involves determining the required strut lengths \(\bm{\mathcal{L}} = \left[ l_1, l_2, \ldots, l_6 \right]^T\) for a desired platform pose \(\bm{\mathcal{X}}\) (i.e. position \({}^A\bm{P}\) and orientation \({}^A\bm{R}_B\)).
|
|
This problem can be solved analytically using the loop closure equations \eqref{eq:nhexa_loop_closure}.
|
|
The obtained strut lengths are given by \eqref{eq:nhexa_inverse_kinematics}.
|
|
|
|
\begin{equation}\label{eq:nhexa_inverse_kinematics}
|
|
l_i = \sqrt{{}^A\bm{P}^T {}^A\bm{P} + {}^B\bm{b}_i^T {}^B\bm{b}_i + {}^A\bm{a}_i^T {}^A\bm{a}_i - 2 {}^A\bm{P}^T {}^A\bm{a}_i + 2 {}^A\bm{P}^T \left[{}^A\bm{R}_B {}^B\bm{b}_i\right] - 2 \left[{}^A\bm{R}_B {}^B\bm{b}_i\right]^T {}^A\bm{a}_i}
|
|
\end{equation}
|
|
|
|
If the position and orientation of the platform lie in the feasible workspace, the solution is unique.
|
|
While configurations outside this workspace yield complex numbers, this only becomes relevant for large displacements that far exceed the nano-hexapod's operating range.
|
|
|
|
\paragraph{Forward Kinematics}
|
|
|
|
The forward kinematic problem seeks to determine the platform pose \(\bm{\mathcal{X}}\) given a set of strut lengths \(\bm{\mathcal{L}}\).
|
|
Unlike inverse kinematics, this presents a significant challenge because it requires solving a system of nonlinear equations.
|
|
Although various numerical methods exist for solving this problem, they can be computationally intensive and may not guarantee convergence to the correct solution.
|
|
|
|
For the nano-hexapod application, where displacements are typically small, an approximate solution based on linearization around the operating point provides a practical alternative.
|
|
This approximation, which is developed in subsequent sections through the Jacobian matrix analysis, is particularly useful for real-time control applications.
|
|
|
|
|
|
\section{The Jacobian Matrix}
|
|
\label{ssec:nhexa_stewart_platform_jacobian}
|
|
The Jacobian matrix plays a central role in analyzing the Stewart platform's behavior, providing a linear mapping between the platform and actuator velocities.
|
|
While the previously derived kinematic relationships are essential for position analysis, the Jacobian enables velocity analysis and forms the foundation for both static and dynamic studies.
|
|
\paragraph{Jacobian Computation - Velocity Loop Closure}
|
|
|
|
As discussed in Section \ref{ssec:nhexa_stewart_platform_kinematics}, the strut lengths \(\bm{\mathcal{L}}\) and the platform pose \(\bm{\mathcal{X}}\) are related through a system of nonlinear algebraic equations representing the kinematic constraints imposed by the struts.
|
|
|
|
By taking the time derivative of the position loop close \eqref{eq:nhexa_loop_closure}, the \emph{velocity loop closure} is obtained \eqref{eq:nhexa_loop_closure_velocity}.
|
|
|
|
\begin{equation}\label{eq:nhexa_loop_closure_velocity}
|
|
{}^A\bm{v}_p + {}^A \dot{\bm{R}}_B {}^B\bm{b}_i + {}^A\bm{R}_B \underbrace{{}^B\dot{\bm{b}_i}}_{=0} = \dot{l}_i {}^A\hat{\bm{s}}_i + l_i {}^A\dot{\hat{\bm{s}}}_i + \underbrace{{}^A\dot{\bm{a}}_i}_{=0}
|
|
\end{equation}
|
|
|
|
Moreover, we have:
|
|
\begin{itemize}
|
|
\item \({}^A\dot{\bm{R}}_B {}^B\bm{b}_i = {}^A\bm{\omega} \times {}^A\bm{R}_B {}^B\bm{b}_i = {}^A\bm{\omega} \times {}^A\bm{b}_i\) in which \({}^A\bm{\omega}\) denotes the angular velocity of the moving platform expressed in the fixed frame \(\{\bm{A}\}\).
|
|
\item \(l_i {}^A\dot{\hat{\bm{s}}}_i = l_i \left( {}^A\bm{\omega}_i \times \hat{\bm{s}}_i \right)\) in which \({}^A\bm{\omega}_i\) is the angular velocity of strut \(i\) express in fixed frame \(\{\bm{A}\}\).
|
|
\end{itemize}
|
|
|
|
By multiplying both sides by \({}^A\hat{\bm{s}}_i\), \eqref{eq:nhexa_loop_closure_velocity_bis} is obtained.
|
|
|
|
\begin{equation}\label{eq:nhexa_loop_closure_velocity_bis}
|
|
{}^A\hat{\bm{s}}_i {}^A\bm{v}_p + \underbrace{{}^A\hat{\bm{s}}_i ({}^A\bm{\omega} \times {}^A\bm{b}_i)}_{=({}^A\bm{b}_i \times {}^A\hat{\bm{s}}_i) {}^A\bm{\omega}} = \dot{l}_i + \underbrace{{}^A\hat{s}_i l_i \left( {}^A\bm{\omega}_i \times {}^A\hat{\bm{s}}_i \right)}_{=0}
|
|
\end{equation}
|
|
|
|
Equation \eqref{eq:nhexa_loop_closure_velocity_bis} can be rearranged in matrix form to obtain \eqref{eq:nhexa_jacobian_velocities}, with \(\dot{\bm{\mathcal{L}}} = [ \dot{l}_1 \ \dots \ \dot{l}_6 ]^T\) the vector of strut velocities, and \(\dot{\bm{\mathcal{X}}} = [{}^A\bm{v}_p ,\ {}^A\bm{\omega}]^T\) the vector of platform velocity and angular velocity.
|
|
|
|
\begin{equation}\label{eq:nhexa_jacobian_velocities}
|
|
\boxed{\dot{\bm{\mathcal{L}}} = \bm{J} \dot{\bm{\mathcal{X}}}}
|
|
\end{equation}
|
|
|
|
The matrix \(\bm{J}\) is called the Jacobian matrix and is defined by \eqref{eq:nhexa_jacobian}, with \({}^A\hat{\bm{s}}_i\) the orientation of the struts expressed in \(\{A\}\) and \({}^A\bm{b}_i\) the position of the joints with respect to \(O_B\) and express in \(\{A\}\).
|
|
|
|
\begin{equation}\label{eq:nhexa_jacobian}
|
|
\bm{J} = \begin{bmatrix}
|
|
{{}^A\hat{\bm{s}}_1}^T & ({}^A\bm{b}_1 \times {}^A\hat{\bm{s}}_1)^T \\
|
|
{{}^A\hat{\bm{s}}_2}^T & ({}^A\bm{b}_2 \times {}^A\hat{\bm{s}}_2)^T \\
|
|
{{}^A\hat{\bm{s}}_3}^T & ({}^A\bm{b}_3 \times {}^A\hat{\bm{s}}_3)^T \\
|
|
{{}^A\hat{\bm{s}}_4}^T & ({}^A\bm{b}_4 \times {}^A\hat{\bm{s}}_4)^T \\
|
|
{{}^A\hat{\bm{s}}_5}^T & ({}^A\bm{b}_5 \times {}^A\hat{\bm{s}}_5)^T \\
|
|
{{}^A\hat{\bm{s}}_6}^T & ({}^A\bm{b}_6 \times {}^A\hat{\bm{s}}_6)^T
|
|
\end{bmatrix}
|
|
\end{equation}
|
|
|
|
Therefore, the Jacobian matrix \(\bm{J}\) links the rate of change of the strut length to the velocity and angular velocity of the top platform with respect to the fixed base through a set of linear equations.
|
|
However, \(\bm{J}\) needs to be recomputed for every Stewart platform pose because it depends on the actual pose of the manipulator.
|
|
|
|
\paragraph{Approximate solution to the Forward and Inverse Kinematic problems}
|
|
|
|
For small displacements \(\delta \bm{\mathcal{X}} = [\delta x, \delta y, \delta z, \delta \theta_x, \delta \theta_y, \delta \theta_z ]^T\) around an operating point \(\bm{\mathcal{X}}_0\) (for which the Jacobian was computed), the associated joint displacement \(\delta\bm{\mathcal{L}} = [\delta l_1,\,\delta l_2,\,\delta l_3,\,\delta l_4,\,\delta l_5,\,\delta l_6]^T\) can be computed using the Jacobian \eqref{eq:nhexa_inverse_kinematics_approximate}.
|
|
|
|
\begin{equation}\label{eq:nhexa_inverse_kinematics_approximate}
|
|
\boxed{\delta\bm{\mathcal{L}} = \bm{J} \delta\bm{\mathcal{X}}}
|
|
\end{equation}
|
|
|
|
Similarly, for small joint displacements \(\delta\bm{\mathcal{L}}\), it is possible to find the induced small displacement of the mobile platform \eqref{eq:nhexa_forward_kinematics_approximate}.
|
|
|
|
\begin{equation}\label{eq:nhexa_forward_kinematics_approximate}
|
|
\boxed{\delta\bm{\mathcal{X}} = \bm{J}^{-1} \delta\bm{\mathcal{L}}}
|
|
\end{equation}
|
|
|
|
These two relations solve the forward and inverse kinematic problems for small displacement in a \emph{approximate} way.
|
|
While this approximation offers limited value for inverse kinematics, which can be solved analytically, it proves particularly useful for the forward kinematic problem where exact analytical solutions are difficult to obtain.
|
|
|
|
\paragraph{Range validity of the approximate inverse kinematics}
|
|
|
|
The accuracy of the Jacobian-based forward kinematics solution was estimated by a simple analysis.
|
|
For a series of platform positions along the \(x\text{-axis}\), the exact strut lengths are computed using the analytical inverse kinematics equation \eqref{eq:nhexa_inverse_kinematics}.
|
|
These strut lengths are then used with the Jacobian to estimate the platform pose, from which the error between the estimated and true poses can be calculated.
|
|
|
|
The estimation errors in the \(x\), \(y\), and \(z\) directions are shown in Figure \ref{fig:nhexa_forward_kinematics_approximate_errors}.
|
|
The results demonstrate that for displacements up to approximately \(1\,\%\) of the hexapod's size (which corresponds to \(100\,\mu m\) as the size of the Stewart platform is here \(\approx 100\,mm\)), the Jacobian approximation provides excellent accuracy.
|
|
|
|
Since the maximum required stroke of the nano-hexapod (\(\approx 100\,\mu m\)) is three orders of magnitude smaller than its overall size (\(\approx 100\,mm\)), the Jacobian matrix can be considered constant throughout the workspace.
|
|
It can be computed once at the rest position and used for both forward and inverse kinematics with high accuracy.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_forward_kinematics_approximate_errors.png}
|
|
\caption{\label{fig:nhexa_forward_kinematics_approximate_errors}Errors associated with the use of the Jacobian matrix to solve the forward kinematic problem. A Stewart platform with a height of \(100\,mm\) was used to perform this analysis}
|
|
\end{figure}
|
|
|
|
\paragraph{Static Forces}
|
|
|
|
The static force analysis of the Stewart platform can be performed using the principle of virtual work.
|
|
This principle states that for a system in static equilibrium, the total virtual work of all forces acting on the system must be zero for any virtual displacement compatible with the system's constraints.
|
|
|
|
Let \(\bm{f} = [f_1, f_2, \cdots, f_6]^T\) represent the vector of actuator forces applied in each strut, and \(\bm{\mathcal{F}} = [\bm{F}, \bm{n}]^T\) denote the external wrench (combined force \(\bm{F}\) and torque \(\bm{n}\)) acting on the mobile platform at point \(\bm{O}_B\).
|
|
The virtual work \(\delta W\) consists of two contributions:
|
|
\begin{itemize}
|
|
\item The work performed by the actuator forces through virtual strut displacements \(\delta \bm{\mathcal{L}}\): \(\bm{f}^T \delta \bm{\mathcal{L}}\)
|
|
\item The work performed by the external wrench through virtual platform displacements \(\delta \bm{\mathcal{X}}\): \(-\bm{\mathcal{F}}^T \delta \bm{\mathcal{X}}\)
|
|
\end{itemize}
|
|
|
|
Thus, the principle of virtual work can be expressed as:
|
|
\begin{equation}
|
|
\delta W = \bm{f}^T \delta \bm{\mathcal{L}} - \bm{\mathcal{F}}^T \delta \bm{\mathcal{X}} = 0
|
|
\end{equation}
|
|
|
|
Using the Jacobian relationship that links virtual displacements \eqref{eq:nhexa_inverse_kinematics_approximate}, this equation becomes:
|
|
\begin{equation}
|
|
\left( \bm{f}^T \bm{J} - \bm{\mathcal{F}}^T \right) \delta \bm{\mathcal{X}} = 0
|
|
\end{equation}
|
|
|
|
Because this equation must hold for any virtual displacement \(\delta \bm{\mathcal{X}}\), the force mapping relationships \eqref{eq:nhexa_jacobian_forces} can be derived.
|
|
|
|
\begin{equation}\label{eq:nhexa_jacobian_forces}
|
|
\bm{f}^T \bm{J} - \bm{\mathcal{F}}^T = 0 \quad \Rightarrow \quad \boxed{\bm{\mathcal{F}} = \bm{J}^T \bm{f}} \quad \text{and} \quad \boxed{\bm{f} = \bm{J}^{-T} \bm{\mathcal{F}}}
|
|
\end{equation}
|
|
|
|
These equations establish that the transpose of the Jacobian matrix maps actuator forces to platform forces and torques, while its inverse transpose maps platform forces and torques to required actuator forces.
|
|
|
|
\section{Static Analysis}
|
|
\label{ssec:nhexa_stewart_platform_static}
|
|
|
|
The static stiffness characteristics of the Stewart platform play a crucial role in its performance, particularly for precision positioning applications.
|
|
These characteristics are fundamentally determined by both the actuator properties and the platform geometry.
|
|
|
|
Starting from the individual actuators, the relationship between applied force \(f_i\) and resulting displacement \(\delta l_i\) for each strut \(i\) is characterized by its stiffness \(k_i\):
|
|
\begin{equation}
|
|
f_i = k_i \delta l_i, \quad i = 1,\ \dots,\ 6
|
|
\end{equation}
|
|
|
|
These individual relationships can be combined into a matrix form using the diagonal stiffness matrix \(\bm{\mathcal{K}}\):
|
|
\begin{equation}
|
|
\bm{f} = \bm{\mathcal{K}} \cdot \delta \bm{\mathcal{L}}, \quad \bm{\mathcal{K}} = \text{diag}\left[ k_1,\ \dots,\ k_6 \right]
|
|
\end{equation}
|
|
|
|
By applying the force mapping relationships \eqref{eq:nhexa_jacobian_forces} derived in the previous section and the Jacobian relationship for small displacements \eqref{eq:nhexa_forward_kinematics_approximate}, the relationship between applied wrench \(\bm{\mathcal{F}}\) and resulting platform displacement \(\delta \bm{\mathcal{X}}\) is obtained \eqref{eq:nhexa_stiffness_matrix}.
|
|
|
|
\begin{equation}\label{eq:nhexa_stiffness_matrix}
|
|
\bm{\mathcal{F}} = \underbrace{\bm{J}^T \bm{\mathcal{K}} \bm{J}}_{\bm{K}} \cdot \delta \bm{\mathcal{X}}
|
|
\end{equation}
|
|
where \(\bm{K} = \bm{J}^T \bm{\mathcal{K}} \bm{J}\) is identified as the platform stiffness matrix.
|
|
|
|
The inverse relationship is given by the compliance matrix \(\bm{C}\):
|
|
|
|
\begin{equation}
|
|
\delta \bm{\mathcal{X}} = \underbrace{(\bm{J}^T \bm{\mathcal{K}} \bm{J})^{-1}}_{\bm{C}} \bm{\mathcal{F}}
|
|
\end{equation}
|
|
|
|
These relationships reveal that the overall platform stiffness and compliance characteristics are determined by two factors:
|
|
\begin{itemize}
|
|
\item The individual actuator stiffnesses represented by \(\bm{\mathcal{K}}\)
|
|
\item The geometric configuration embodied in the Jacobian matrix \(\bm{J}\)
|
|
\end{itemize}
|
|
|
|
This geometric dependency means that the platform's stiffness varies throughout its workspace, as the Jacobian matrix changes with the platform's position and orientation.
|
|
For the NASS application, where the workspace is small compared to the platform dimensions, these variations can be considered minimal.
|
|
However, the initial geometric configuration significantly affects the overall stiffness characteristics.
|
|
The relationship between maximum stroke and stiffness presents another important design consideration.
|
|
As both parameters are influenced by the geometric configuration, their optimization involves inherent trade-offs that must be carefully balanced based on the application requirements.
|
|
The optimization of this configuration to achieve the desired stiffness while having sufficient stroke will be addressed during the detailed design phase.
|
|
|
|
\section{Dynamical Analysis}
|
|
\label{ssec:nhexa_stewart_platform_dynamics}
|
|
|
|
The dynamic behavior of a Stewart platform can be analyzed using various approaches depending on the desired level of model fidelity.
|
|
For initial analysis, a simplified representation of the system has been developed.
|
|
This model assumes perfectly rigid bodies for both the platform and base, connected by massless struts through ideal joints that exhibit neither friction nor compliance.
|
|
|
|
Under these assumptions, the system dynamics can be expressed in Cartesian space as:
|
|
\begin{equation}
|
|
\bm{M} s^2 \bm{\mathcal{X}} = \Sigma \bm{\mathcal{F}}
|
|
\end{equation}
|
|
where \(\bm{M}\) represents the platform mass matrix, \(\bm{\mathcal{X}}\) the platform pose, and \(\Sigma \bm{\mathcal{F}}\) the sum of forces acting on the platform.
|
|
|
|
The primary forces acting on the system are actuator forces \(\bm{f}\), elastic forces due to strut stiffness \(-\bm{\mathcal{K}} \bm{\mathcal{L}}\) and damping forces in the struts \(\bm{\mathcal{C}} \dot{\bm{\mathcal{L}}}\).
|
|
|
|
\begin{equation}
|
|
\Sigma \bm{\mathcal{F}} = \bm{J}^T (\bm{f} - \bm{\mathcal{K}} \bm{\mathcal{L}} - s \bm{\mathcal{C}} \bm{\mathcal{L}}), \quad \bm{\mathcal{K}} = \text{diag}(k_1\,\dots\,k_6),\ \bm{\mathcal{C}} = \text{diag}(c_1\,\dots\,c_6)
|
|
\end{equation}
|
|
|
|
Combining these forces and using \eqref{eq:nhexa_forward_kinematics_approximate} yields the complete dynamic equation \eqref{eq:nhexa_dynamical_equations}.
|
|
|
|
\begin{equation}\label{eq:nhexa_dynamical_equations}
|
|
\bm{M} s^2 \bm{\mathcal{X}} = \bm{\mathcal{F}} - \bm{J}^T \bm{\mathcal{K}} \bm{J} \bm{\mathcal{X}} - \bm{J}^T \bm{\mathcal{C}} \bm{J} s \bm{\mathcal{X}}
|
|
\end{equation}
|
|
|
|
The transfer function matrix in the Cartesian frame becomes \eqref{eq:nhexa_transfer_function_cart}.
|
|
|
|
\begin{equation}\label{eq:nhexa_transfer_function_cart}
|
|
\frac{{\mathcal{X}}}{\bm{\mathcal{F}}}(s) = ( \bm{M} s^2 + \bm{J}^{T} \bm{\mathcal{C}} \bm{J} s + \bm{J}^{T} \bm{\mathcal{K}} \bm{J} )^{-1}
|
|
\end{equation}
|
|
|
|
Through coordinate transformation using the Jacobian matrix, the dynamics in the actuator space is obtained \eqref{eq:nhexa_transfer_function_struts}.
|
|
|
|
\begin{equation}\label{eq:nhexa_transfer_function_struts}
|
|
\frac{\bm{\mathcal{L}}}{\bm{f}}(s) = ( \bm{J}^{-T} \bm{M} \bm{J}^{-1} s^2 + \bm{\mathcal{C}} + \bm{\mathcal{K}} )^{-1}
|
|
\end{equation}
|
|
|
|
Although this simplified model provides useful insights, real Stewart platforms exhibit more complex behaviors.
|
|
Several factors can significantly increase the model complexity, such as:
|
|
\begin{itemize}
|
|
\item Strut dynamics, including mass distribution and internal resonances \cite{afzali-far16_inert_matrix_hexap_strut_joint_space,chen04_decoup_contr_flexur_joint_hexap}
|
|
\item Joint compliance and friction effects \cite{mcinroy00_desig_contr_flexur_joint_hexap,mcinroy02_model_desig_flexur_joint_stewar}
|
|
\item Supporting structure dynamics and payload dynamics, which are both very critical for NASS
|
|
\end{itemize}
|
|
|
|
These additional effects render analytical modeling impractical for complete system analysis.
|
|
|
|
\section*{Conclusion}
|
|
The fundamental characteristics of the Stewart platform have been analyzed in this chapter.
|
|
Essential kinematic relationships were developed through loop closure equations, from which both exact and approximate solutions for the inverse and forward kinematic problems were derived.
|
|
The Jacobian matrix was established as a central mathematical tool through which crucial insights into velocity relationships, static force transmission, and dynamic behavior of the platform were obtained.
|
|
|
|
For the NASS application, where displacements are typically limited to the micrometer range, the accuracy of linearized models using a constant Jacobian matrix has been demonstrated, by which both analysis and control can be significantly simplified.
|
|
However, additional complexities such as strut masses, joint compliance, and supporting structure dynamics must be considered in the full dynamic behavior.
|
|
This will be performed in the next section using a multi-body model.
|
|
|
|
All these characteristics (maneuverability, stiffness, dynamics, etc.) are fundamentally determined by the platform's geometry.
|
|
While a reasonable geometric configuration will be used to validate the NASS during the conceptual phase, the optimization of these geometric parameters will be explored during the detailed design phase.
|
|
|
|
\chapter{Multi-Body Model}
|
|
\label{sec:nhexa_model}
|
|
The dynamic modeling of Stewart platforms has traditionally relied on analytical approaches.
|
|
However, these analytical models become increasingly complex when the dynamical behaviors of struts and joints must be captured.
|
|
To overcome these limitations, a flexible multi-body approach was developed that can be readily integrated into the broader NASS model.
|
|
Through this multi-body modeling approach, each component model (including joints, actuators, and sensors) can be progressively refined.
|
|
|
|
The analysis is structured as follows.
|
|
First, the multi-body model is developed, and the geometric parameters, inertial properties, and actuator characteristics are established (Section \ref{ssec:nhexa_model_def}).
|
|
The model was then validated through comparison with the analytical equations in a simplified configuration (Section \ref{ssec:nhexa_model_validation}).
|
|
Finally, the validated model is employed to analyze the nano-hexapod dynamics, from which insights for the control system design are derived (Section \ref{ssec:nhexa_model_dynamics}).
|
|
\section{Model Definition}
|
|
\label{ssec:nhexa_model_def}
|
|
\paragraph{Geometry}
|
|
|
|
The Stewart platform's geometry is defined by two principal coordinate frames (Figure \ref{fig:nhexa_stewart_model_def}): a fixed base frame \(\{F\}\) and a moving platform frame \(\{M\}\).
|
|
The joints connecting the actuators to these frames are located at positions \({}^F\bm{a}_i\) and \({}^M\bm{b}_i\) respectively.
|
|
The point of interest, denoted by frame \(\{A\}\), is situated \(150\,mm\) above the moving platform frame \(\{M\}\).
|
|
|
|
The geometric parameters of the nano-hexapod are summarized in Table \ref{tab:nhexa_stewart_model_geometry}.
|
|
These parameters define the positions of all connection points in their respective coordinate frames.
|
|
From these parameters, key kinematic properties can be derived: the strut orientations \(\hat{\bm{s}}_i\), strut lengths \(l_i\), and the system's Jacobian matrix \(\bm{J}\).
|
|
|
|
\begin{minipage}[b]{0.6\linewidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=1]{figs/nhexa_stewart_model_def.png}
|
|
\captionof{figure}{\label{fig:nhexa_stewart_model_def}Geometry of the stewart platform}
|
|
\end{center}
|
|
\end{minipage}
|
|
\hfill
|
|
\begin{minipage}[b]{0.38\linewidth}
|
|
\begin{scriptsize}
|
|
\centering
|
|
\begin{tabularx}{0.75\linewidth}{Xrrr}
|
|
\toprule
|
|
& \(\bm{x}\) & \(\bm{y}\) & \(\bm{z}\)\\
|
|
\midrule
|
|
\({}^M\bm{O}_B\) & \(0\) & \(0\) & \(150\)\\
|
|
\({}^F\bm{O}_M\) & \(0\) & \(0\) & \(95\)\\
|
|
\({}^F\bm{a}_1\) & \(-92\) & \(-77\) & \(20\)\\
|
|
\({}^F\bm{a}_2\) & \(92\) & \(-77\) & \(20\)\\
|
|
\({}^F\bm{a}_3\) & \(113\) & \(-41\) & \(20\)\\
|
|
\({}^F\bm{a}_4\) & \(21\) & \(118\) & \(20\)\\
|
|
\({}^F\bm{a}_5\) & \(-21\) & \(118\) & \(20\)\\
|
|
\({}^F\bm{a}_6\) & \(-113\) & \(-41\) & \(20\)\\
|
|
\({}^M\bm{b}_1\) & \(-28\) & \(-106\) & \(-20\)\\
|
|
\({}^M\bm{b}_2\) & \(28\) & \(-106\) & \(-20\)\\
|
|
\({}^M\bm{b}_3\) & \(106\) & \(28\) & \(-20\)\\
|
|
\({}^M\bm{b}_4\) & \(78\) & \(78\) & \(-20\)\\
|
|
\({}^M\bm{b}_5\) & \(-78\) & \(78\) & \(-20\)\\
|
|
\({}^M\bm{b}_6\) & \(-106\) & \(28\) & \(-20\)\\
|
|
\bottomrule
|
|
\end{tabularx}
|
|
\captionof{table}{\label{tab:nhexa_stewart_model_geometry}Parameter values in [mm]}
|
|
\end{scriptsize}
|
|
\end{minipage}
|
|
|
|
\paragraph{Inertia of Plates}
|
|
|
|
The fixed base and moving platform were modeled as solid cylindrical bodies.
|
|
The base platform was characterized by a radius of \(120\,mm\) and thickness of \(15\,mm\), matching the dimensions of the micro-hexapod's top platform.
|
|
The moving platform was similarly modeled with a radius of \(110\,mm\) and thickness of \(15\,mm\).
|
|
Both platforms were assigned a mass of \(5\,kg\).
|
|
|
|
\paragraph{Joints}
|
|
|
|
The platform's joints play a crucial role in its dynamic behavior.
|
|
At both the upper and lower connection points, various degrees of freedom can be modeled, including universal joints, spherical joints, and configurations with additional axial and lateral stiffness components.
|
|
For each degree of freedom, stiffness characteristics can be incorporated into the model.
|
|
|
|
In the conceptual design phase, a simplified joint configuration is employed: the bottom joints are modeled as two-degree-of-freedom universal joints, while the top joints are represented as three-degree-of-freedom spherical joints.
|
|
These joints are considered massless and exhibit no stiffness along their degrees of freedom.
|
|
|
|
\paragraph{Actuators}
|
|
|
|
The actuator model comprises several key elements (Figure \ref{fig:nhexa_actuator_model}).
|
|
At its core, each actuator is modeled as a prismatic joint with internal stiffness \(k_a\) and damping \(c_a\), driven by a force source \(f\).
|
|
Similarly to what was found using the rotating 3-DoF model, a parallel stiffness \(k_p\) is added in parallel with the force sensor to ensure stability when considering spindle rotation effects.
|
|
|
|
Each actuator is equipped with two sensors: a force sensor providing measurements \(f_n\) and a relative motion sensor that measures the strut length \(l_i\).
|
|
The actuator parameters used in the conceptual phase are listed in Table \ref{tab:nhexa_actuator_parameters}.
|
|
|
|
This modular approach to actuator modeling allows for future refinements as the design evolves, enabling the incorporation of additional dynamic effects or sensor characteristics as needed.
|
|
|
|
\begin{minipage}[b]{0.6\linewidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=1]{figs/nhexa_actuator_model.png}
|
|
\captionof{figure}{\label{fig:nhexa_actuator_model}Model of the nano-hexapod actuators}
|
|
\end{center}
|
|
\end{minipage}
|
|
\hfill
|
|
\begin{minipage}[b]{0.38\linewidth}
|
|
\begin{scriptsize}
|
|
\centering
|
|
\begin{tabularx}{0.4\linewidth}{Xl}
|
|
\toprule
|
|
& Value\\
|
|
\midrule
|
|
\(k_a\) & \(1\,N/\mu m\)\\
|
|
\(c_a\) & \(50\,N/(m/s)\)\\
|
|
\(k_p\) & \(0.05\,N/\mu m\)\\
|
|
\bottomrule
|
|
\end{tabularx}
|
|
\captionof{table}{\label{tab:nhexa_actuator_parameters}Actuator parameters}
|
|
\end{scriptsize}
|
|
\end{minipage}
|
|
|
|
\section{Validation of the multi-body model}
|
|
\label{ssec:nhexa_model_validation}
|
|
|
|
The developed multi-body model of the Stewart platform is represented schematically in Figure \ref{fig:nhexa_stewart_model_input_outputs}, highlighting the key inputs and outputs: actuator forces \(\bm{f}\), force sensor measurements \(\bm{f}_n\), and relative displacement measurements \(\bm{\mathcal{L}}\).
|
|
The frames \(\{F\}\) and \(\{M\}\) serve as interfaces for integration with other elements in the multi-body system.
|
|
A three-dimensional visualization of the model is presented in Figure \ref{fig:nhexa_simscape_screenshot}.
|
|
|
|
\begin{minipage}[b]{0.6\linewidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=1]{figs/nhexa_stewart_model_input_outputs.png}
|
|
\captionof{figure}{\label{fig:nhexa_stewart_model_input_outputs}Nano-Hexapod plant with inputs and outputs. Frames \(\{F\}\) and \(\{M\}\) can be connected to other elements in the multi-body models.}
|
|
\end{center}
|
|
\end{minipage}
|
|
\hfill
|
|
\begin{minipage}[b]{0.35\linewidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.90\linewidth]{figs/nhexa_simscape_screenshot.jpg}
|
|
\captionof{figure}{\label{fig:nhexa_simscape_screenshot}3D representation of the multi-body model}
|
|
\end{center}
|
|
\end{minipage}
|
|
|
|
The validation of the multi-body model was performed using the simplest Stewart platform configuration, enabling direct comparison with the analytical transfer functions derived in Section \ref{ssec:nhexa_stewart_platform_dynamics}.
|
|
This configuration consists of massless universal joints at the base, massless spherical joints at the top platform, and massless struts with stiffness \(k_a = 1\,\text{N}/\mu\text{m}\) and damping \(c_a = 10\,\text{N}/({\text{m}/\text{s}})\).
|
|
The geometric parameters remain as specified in Table \ref{tab:nhexa_actuator_parameters}.
|
|
|
|
While the moving platform itself is considered massless, a \(10\,\text{kg}\) cylindrical payload is mounted on top with a radius of \(r = 110\,mm\) and a height \(h = 300\,mm\).
|
|
|
|
For the analytical model, the stiffness, damping, and mass matrices are defined in \eqref{eq:nhexa_analytical_matrices}.
|
|
|
|
\begin{subequations}\label{eq:nhexa_analytical_matrices}
|
|
\begin{align}
|
|
\bm{\mathcal{K}} &= \text{diag}(k_a,\ k_a,\ k_a,\ k_a,\ k_a,\ k_a) \\
|
|
\bm{\mathcal{C}} &= \text{diag}(c_a,\ c_a,\ c_a,\ c_a,\ c_a,\ c_a) \\
|
|
\bm{M} &= \text{diag}\left(m,\ m,\ m,\ \frac{1}{12}m(3r^2 + h^2),\ \frac{1}{12}m(3r^2 + h^2),\ \frac{1}{2}mr^2\right)
|
|
\end{align}
|
|
\end{subequations}
|
|
|
|
The transfer functions from the actuator forces to the strut displacements are computed using these matrices according to equation \eqref{eq:nhexa_transfer_function_struts}.
|
|
These analytical transfer functions are then compared with those extracted from the multi-body model.
|
|
The developed multi-body model yields a state-space representation with 12 states, corresponding to the six degrees of freedom of the moving platform.
|
|
|
|
Figure \ref{fig:nhexa_comp_multi_body_analytical} presents a comparison between the analytical and multi-body transfer functions, specifically showing the response from the first actuator force to all six strut displacements.
|
|
The close agreement between both approaches across the frequency spectrum validates the multi-body model's accuracy in capturing the system's dynamic behavior.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_comp_multi_body_analytical.png}
|
|
\caption{\label{fig:nhexa_comp_multi_body_analytical}Comparison of the analytical transfer functions and the multi-body model}
|
|
\end{figure}
|
|
|
|
\section{Nano Hexapod Dynamics}
|
|
\label{ssec:nhexa_model_dynamics}
|
|
|
|
Following the validation of the multi-body model, a detailed analysis of the nano-hexapod dynamics was performed.
|
|
The model parameters were set according to the specifications outlined in Section \ref{ssec:nhexa_model_def}, with a payload mass of \(10\,kg\).
|
|
The transfer functions from actuator forces \(\bm{f}\) to both strut displacements \(\bm{\mathcal{L}}\) and force measurements \(\bm{f}_n\) were derived from the multi-body model.
|
|
|
|
The transfer functions relating actuator forces to strut displacements are presented in Figure \ref{fig:nhexa_multi_body_plant_dL}.
|
|
Due to the system's symmetrical design and identical strut configurations, all diagonal terms (transfer functions from force \(f_i\) to displacement \(l_i\) of the same strut) exhibit identical behavior.
|
|
While the system has six degrees of freedom, only four distinct resonance frequencies were observed in the frequency response.
|
|
This reduction from six to four observable modes is attributed to the system's symmetry, where two pairs of resonances occur at identical frequencies.
|
|
|
|
The system's behavior can be characterized in three frequency regions.
|
|
At low frequencies, well below the first resonance, the plant demonstrates good decoupling between actuators, with the response dominated by the strut stiffness: \(\bm{G}(j\omega) \xrightarrow[\omega \to 0]{} \bm{\mathcal{K}}^{-1}\).
|
|
In the mid-frequency range, the system exhibits coupled dynamics through its resonant modes, reflecting the complex interactions between the platform's degrees of freedom.
|
|
At high frequencies, above the highest resonance, the response is governed by the payload's inertia mapped to the strut coordinates: \(\bm{G}(j\omega) \xrightarrow[\omega \to \infty]{} \bm{J} \bm{M}^{-T} \bm{J}^T \frac{-1}{\omega^2}\)
|
|
|
|
The force sensor transfer functions, shown in Figure \ref{fig:nhexa_multi_body_plant_fm}, display characteristics typical of collocated actuator-sensor pairs.
|
|
Each actuator's transfer function to its associated force sensor exhibits alternating complex conjugate poles and zeros.
|
|
The inclusion of parallel stiffness introduces an additional complex conjugate zero at low frequency, which was previously observed in the three-degree-of-freedom rotating model.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/nhexa_multi_body_plant_dL.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_multi_body_plant_dL}$\bm{f}$ to $\bm{\mathcal{L}}$}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/nhexa_multi_body_plant_fm.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_multi_body_plant_fm}$\bm{f}$ to $\bm{f}_{n}$}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_multi_body_plant}Bode plot of the transfer functions computed from the nano-hexapod multi-body model}
|
|
\end{figure}
|
|
|
|
\section*{Conclusion}
|
|
The multi-body modeling approach presented in this section provides a comprehensive framework for analyzing the dynamics of the nano-hexapod system.
|
|
Through comparison with analytical solutions in a simplified configuration, the model's accuracy has been validated, demonstrating its ability to capture the essential dynamic behavior of the Stewart platform.
|
|
|
|
A key advantage of this modeling approach lies in its flexibility for future refinements.
|
|
While the current implementation employs idealized joints for the conceptual design phase, the framework readily accommodates the incorporation of joint stiffness and other non-ideal effects.
|
|
The joint stiffness, which is known to impact the performance of decentralized IFF control strategy \cite{preumont07_six_axis_singl_stage_activ}, will be studied and optimized during the detailed design phase.
|
|
The validated multi-body model will serve as a valuable tool for predicting system behavior and evaluating control performance throughout the design process.
|
|
|
|
\chapter{Control of Stewart Platforms}
|
|
\label{sec:nhexa_control}
|
|
The control of Stewart platforms presents distinct challenges compared to the uniaxial model due to their multi-input multi-output nature.
|
|
Although the uniaxial model demonstrated the effectiveness of the HAC-LAC strategy, its extension to Stewart platforms requires careful considerations discussed in this section.
|
|
|
|
First, the distinction between centralized and decentralized control approaches is discussed in Section \ref{ssec:nhexa_control_centralized_decentralized}.
|
|
The impact of the control space selection - either Cartesian or strut space - is then analyzed in Section \ref{ssec:nhexa_control_space}, highlighting the trade-offs between direction-specific tuning and implementation simplicity.
|
|
|
|
Building on these analyses, a decentralized active damping strategy using Integral Force Feedback is developed in Section \ref{ssec:nhexa_control_iff}, followed by the implementation of a centralized High Authority Control for positioning in Section \ref{ssec:nhexa_control_hac_lac}.
|
|
This architecture, while simple, will be used to demonstrate the feasibility of the NASS concept and will provide a foundation for more sophisticated control strategies to be developed during the detailed design phase.
|
|
\section{Centralized and Decentralized Control}
|
|
\label{ssec:nhexa_control_centralized_decentralized}
|
|
|
|
In the control of MIMO systems, and more specifically of Stewart platforms, a fundamental architectural decision lies in the choice between centralized and decentralized control strategies.
|
|
|
|
In decentralized control, each actuator operates based on feedback from its associated sensor only, creating independent control loops, as illustrated in Figure \ref{fig:nhexa_stewart_decentralized_control}.
|
|
While mechanical coupling between the struts exists, control decisions are made locally, with each controller processing information from a single sensor-actuator pair.
|
|
This approach offers simplicity in implementation and reduces computational requirements.
|
|
|
|
Conversely, centralized control uses information from all sensors to determine the control action of each actuator.
|
|
This strategy potentially enables better performance by explicitly accounting for the mechanical coupling between the struts, though at the cost of increased complexity in both design and implementation.
|
|
|
|
The choice between these approaches depends significantly on the degree of interaction between the different control channels, and also on the available sensors and actuators.
|
|
For instance, when using external metrology systems that measure the platform's global position, centralized control becomes necessary because each sensor measurement depends on all actuator inputs.
|
|
|
|
In the context of the nano-hexapod, two distinct control strategies were examined during the conceptual phase:
|
|
\begin{itemize}
|
|
\item Decentralized Integral Force Feedback (IFF), which utilizes collocated force sensors to implement independent control loops for each strut (Section \ref{ssec:nhexa_control_iff})
|
|
\item High-Authority Control (HAC), which employs a centralized approach to achieve precise positioning based on external metrology measurements (Section \ref{ssec:nhexa_control_hac_lac})
|
|
\end{itemize}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_stewart_decentralized_control.png}
|
|
\caption{\label{fig:nhexa_stewart_decentralized_control}Decentralized control strategy using the encoders. The two controllers for the struts on the back are not shown for simplicity.}
|
|
\end{figure}
|
|
|
|
\section{Choice of the Control Space}
|
|
\label{ssec:nhexa_control_space}
|
|
|
|
When controlling a Stewart platform using external metrology that measures the pose of frame \(\{B\}\) with respect to \(\{A\}\), denoted as \(\bm{\mathcal{X}}\), the control architecture can be implemented in either Cartesian or strut space.
|
|
This choice affects both the control design and the obtained performance.
|
|
|
|
\paragraph{Control in the Strut space}
|
|
|
|
In this approach, as illustrated in Figure \ref{fig:nhexa_control_strut}, the control is performed in the space of the struts.
|
|
The Jacobian matrix is used to solve the inverse kinematics in real-time by mapping position errors from Cartesian space \(\bm{\epsilon}_{\mathcal{X}}\) to strut space \(\bm{\epsilon}_{\mathcal{L}}\).
|
|
A diagonal controller then processes these strut-space errors to generate force commands for each actuator.
|
|
|
|
The main advantage of this approach emerges from the plant characteristics in the strut space, as shown in Figure \ref{fig:nhexa_plant_frame_struts}.
|
|
The diagonal terms of the plant (transfer functions from force to displacement of the same strut, as measured by the external metrology) are identical due to the system's symmetry.
|
|
This simplifies the control design because only one controller needs to be tuned.
|
|
Furthermore, at low frequencies, the plant exhibits good decoupling between the struts, allowing for effective independent control of each axis.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.98\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=1]{figs/nhexa_control_strut.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_control_strut}Control in the frame of the struts. $\bm{J}$ is used to project errors in the frame of the struts}
|
|
\end{subfigure}
|
|
|
|
\bigskip
|
|
\begin{subfigure}{0.98\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=1]{figs/nhexa_control_cartesian.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_control_cartesian}Control in the Cartesian frame. $\bm{J}^{-T}$ is used to project force and torques on each strut}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_control_frame}Two control strategies}
|
|
\end{figure}
|
|
|
|
\paragraph{Control in Cartesian Space}
|
|
|
|
Alternatively, control can be implemented directly in Cartesian space, as illustrated in Figure \ref{fig:nhexa_control_cartesian}.
|
|
Here, the controller processes Cartesian errors \(\bm{\epsilon}_{\mathcal{X}}\) to generate forces and torques \(\bm{\mathcal{F}}\), which are then mapped to actuator forces using the transpose of the inverse Jacobian matrix \eqref{eq:nhexa_jacobian_forces}.
|
|
|
|
The plant behavior in Cartesian space, illustrated in Figure \ref{fig:nhexa_plant_frame_cartesian}, reveals interesting characteristics.
|
|
Some degrees of freedom, particularly the vertical translation and rotation about the vertical axis, exhibit simpler second-order dynamics.
|
|
A key advantage of this approach is that the control performance can be tuned individually for each direction.
|
|
This is particularly valuable when performance requirements differ between degrees of freedom - for instance, when higher positioning accuracy is required vertically than horizontally, or when certain rotational degrees of freedom can tolerate larger errors than others.
|
|
|
|
However, significant coupling exists between certain degrees of freedom, particularly between rotations and translations (e.g., \(\epsilon_{R_x}/\mathcal{F}_y\) or \(\epsilon_{D_y}/\bm\mathcal{M}_x\)).
|
|
|
|
For the conceptual validation of the nano-hexapod, control in the strut space was selected due to its simpler implementation and the beneficial decoupling properties observed at low frequencies.
|
|
More sophisticated control strategies will be explored during the detailed design phase.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/nhexa_plant_frame_struts.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_plant_frame_struts}Plant in the frame of the struts}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/nhexa_plant_frame_cartesian.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_plant_frame_cartesian}Plant in the Cartesian Frame}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_plant_frame}Bode plot of the transfer functions computed from the nano-hexapod multi-body model}
|
|
\end{figure}
|
|
|
|
\section{Active Damping with Decentralized IFF}
|
|
\label{ssec:nhexa_control_iff}
|
|
|
|
The decentralized Integral Force Feedback (IFF) control strategy is implemented using independent control loops for each strut, similarly to what is shown in Figure \ref{fig:nhexa_stewart_decentralized_control}, but using force sensors instead of relative motion sensors.
|
|
|
|
The corresponding block diagram of the control loop is shown in Figure \ref{fig:nhexa_decentralized_iff_schematic}, in which the controller \(\bm{K}_{\text{IFF}}(s)\) is a diagonal matrix, where each diagonal element is a pure integrator \eqref{eq:nhexa_kiff}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_decentralized_iff_schematic.png}
|
|
\caption{\label{fig:nhexa_decentralized_iff_schematic}Schematic of the implemented decentralized IFF controller. The damped plant has a new inputs \(\bm{f}^{\prime}\)}
|
|
\end{figure}
|
|
|
|
|
|
\begin{equation}\label{eq:nhexa_kiff}
|
|
\bm{K}_{\text{IFF}}(s) = g \cdot \begin{bmatrix}
|
|
K_{\text{IFF}}(s) & & 0 \\
|
|
& \ddots & \\
|
|
0 & & K_{\text{IFF}}(s)
|
|
\end{bmatrix}, \quad K_{\text{IFF}}(s) = \frac{1}{s}
|
|
\end{equation}
|
|
|
|
|
|
In this section, the stiffness in parallel with the force sensor was omitted since the Stewart platform is not subjected to rotation.
|
|
The effect of this parallel stiffness is examined in the next section when the platform is integrated into the complete NASS.
|
|
|
|
Root Locus analysis, shown in Figure \ref{fig:nhexa_decentralized_iff_root_locus}, reveals the evolution of the closed-loop poles as the controller gain \(g\) varies from \(0\) to \(\infty\).
|
|
A key characteristic of force feedback control with collocated sensor-actuator pairs is observed: all closed-loop poles are bounded to the left-half plane, indicating guaranteed stability \cite{preumont08_trans_zeros_struc_contr_with}.
|
|
This property is particularly valuable because the coupling is very large around resonance frequencies, enabling control of modes that would be difficult to include within the bandwidth using position feedback alone.
|
|
|
|
The bode plot of an individual loop gain (i.e. the loop gain of \(K_{\text{IFF}}(s) \cdot \frac{f_{ni}}{f_i}(s)\)), presented in Figure \ref{fig:nhexa_decentralized_iff_loop_gain}, exhibits the typical characteristics of integral force feedback of having a phase bounded between \(-90^o\) and \(+90^o\).
|
|
The loop-gain is high around the resonance frequencies, indicating that the decentralized IFF provides significant control authority over these modes.
|
|
This high gain, combined with the bounded phase, enables effective damping of the resonant modes while maintaining stability.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=0.85]{figs/nhexa_decentralized_iff_loop_gain.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_decentralized_iff_loop_gain}Loop Gain: bode plot of $K_{\text{IFF}}(s) \frac{f_{n1}}{f_1}(s)$}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=0.85]{figs/nhexa_decentralized_iff_root_locus.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_decentralized_iff_root_locus}Root Locus}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_decentralized_iff_results}Decentralized IFF}
|
|
\end{figure}
|
|
|
|
\section{MIMO High-Authority Control - Low-Authority Control}
|
|
\label{ssec:nhexa_control_hac_lac}
|
|
|
|
The design of the High Authority Control positioning loop is now examined.
|
|
The complete HAC-IFF control architecture is illustrated in Figure \ref{fig:nhexa_hac_iff_schematic}, where the reference signal \(\bm{r}_{\mathcal{X}}\) represents the desired pose, and \(\bm{\mathcal{X}}\) is the measured pose by the external metrology system.
|
|
|
|
Following the analysis from Section \ref{ssec:nhexa_control_space}, the control is implemented in the strut space.
|
|
The Jacobian matrix \(\bm{J}^{-1}\) performs (approximate) real-time approximate inverse kinematics to map position errors from Cartesian space \(\bm{\epsilon}_{\mathcal{X}}\) to strut space \(\bm{\epsilon}_{\mathcal{L}}\).
|
|
A diagonal High Authority Controller \(\bm{K}_{\text{HAC}}\) then processes these errors in the frame of the struts.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/nhexa_hac_iff_schematic.png}
|
|
\caption{\label{fig:nhexa_hac_iff_schematic}HAC-IFF control architecture with the High Authority Controller being implemented in the frame of the struts}
|
|
\end{figure}
|
|
|
|
The effect of decentralized IFF on the plant dynamics can be observed by comparing two sets of transfer functions.
|
|
Figure \ref{fig:nhexa_decentralized_hac_iff_plant_undamped} shows the original transfer functions from actuator forces \(\bm{f}\) to strut errors \(\bm{\epsilon}_{\mathcal{L}}\), which are characterized by pronounced resonant peaks.
|
|
When the decentralized IFF is implemented, the transfer functions from modified inputs \(\bm{f}^{\prime}\) to strut errors \(\bm{\epsilon}_{\mathcal{L}}\) exhibit significantly attenuated resonances (Figure \ref{fig:nhexa_decentralized_hac_iff_plant_damped}).
|
|
This damping of structural resonances serves two purposes: it reduces vibrations near resonances and simplifies the design of the high authority controller by providing simpler plant dynamics.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.95\linewidth]{figs/nhexa_decentralized_hac_iff_plant_undamped.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_decentralized_hac_iff_plant_undamped}Undamped plant in the frame of the struts}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.95\linewidth]{figs/nhexa_decentralized_hac_iff_plant_damped.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_decentralized_hac_iff_plant_damped}Damped plant with Decentralized IFF}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_decentralized_hac_iff_plant}Plant in the frame of the strut for the High Authority Controller.}
|
|
\end{figure}
|
|
|
|
Based upon the damped plant dynamics shown in Figure \ref{fig:nhexa_decentralized_hac_iff_plant_damped}, a high authority controller was designed with the structure given in \eqref{eq:nhexa_khac}.
|
|
The controller combines three elements: an integrator providing high gain at low frequencies, a lead compensator improving stability margins, and a low-pass filter for robustness against unmodeled high-frequency dynamics.
|
|
The loop gain of an individual control channel is shown in Figure \ref{fig:nhexa_decentralized_hac_iff_loop_gain}.
|
|
|
|
\begin{equation}\label{eq:nhexa_khac}
|
|
\bm{K}_{\text{HAC}}(s) = \begin{bmatrix}
|
|
K_{\text{HAC}}(s) & & 0 \\
|
|
& \ddots & \\
|
|
0 & & K_{\text{HAC}}(s)
|
|
\end{bmatrix}, \quad K_{\text{HAC}}(s) = g_0 \cdot \underbrace{\frac{\omega_c}{s}}_{\text{int}} \cdot \underbrace{\frac{1}{\sqrt{\alpha}}\frac{1 + \frac{s}{\omega_c/\sqrt{\alpha}}}{1 + \frac{s}{\omega_c\sqrt{\alpha}}}}_{\text{lead}} \cdot \underbrace{\frac{1}{1 + \frac{s}{\omega_0}}}_{\text{LPF}}
|
|
\end{equation}
|
|
|
|
The stability of the MIMO feedback loop is analyzed through the \emph{characteristic loci} method.
|
|
Such characteristic loci represent the eigenvalues of the loop gain matrix \(\bm{G}(j\omega)\bm{K}(j\omega)\) plotted in the complex plane as the frequency varies from \(0\) to \(\infty\).
|
|
For MIMO systems, this method generalizes the classical Nyquist stability criterion: with the open-loop system being stable, the closed-loop system is stable if none of the characteristic loci encircle the -1 point \cite{skogestad07_multiv_feedb_contr}.
|
|
As shown in Figure \ref{fig:nhexa_decentralized_hac_iff_root_locus}, all loci remain to the right of the \(-1\) point, validating the stability of the closed-loop system.
|
|
Additionally, the distance of the loci from the \(-1\) point provides information about stability margins of the coupled system.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=0.85]{figs/nhexa_decentralized_hac_iff_loop_gain.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_decentralized_hac_iff_loop_gain}Loop Gain}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.48\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,scale=0.85]{figs/nhexa_decentralized_hac_iff_root_locus.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:nhexa_decentralized_hac_iff_root_locus}Characteristic Loci}
|
|
\end{subfigure}
|
|
\caption{\label{fig:nhexa_decentralized_hac_iff_results}Decentralized HAC-IFF}
|
|
\end{figure}
|
|
|
|
\section*{Conclusion}
|
|
The control architecture developed for the uniaxial and the rotating models was adapted for the Stewart platform.
|
|
|
|
Two fundamental choices were first addressed: the selection between centralized and decentralized approaches and the choice of control space.
|
|
While control in Cartesian space enables direction-specific performance tuning, implementation in strut space was selected for the conceptual design phase due to two key advantages: good decoupling at low frequencies and identical diagonal terms in the plant transfer functions, allowing a single controller design to be replicated across all struts.
|
|
|
|
The HAC-LAC strategy was then implemented.
|
|
The inner loop implements decentralized Integral Force Feedback for active damping.
|
|
The collocated nature of the force sensors ensures stability despite strong coupling between struts at resonance frequencies, enabling effective damping of structural modes.
|
|
The outer loop implements High Authority Control, enabling precise positioning of the mobile platform.
|
|
|
|
\chapter*{Conclusion}
|
|
\label{sec:nhexa_conclusion}
|
|
|
|
After evaluating various architectures, the Stewart platform was selected for the active platform.
|
|
The parallel kinematic structure offers superior dynamical characteristics, and its compact design satisfies the strict space constraints of the NASS.
|
|
The extensive literature on Stewart platforms, including kinematic analysis, dynamic modeling and control, provides a robust theoretical foundation for this choice.
|
|
|
|
A configurable multi-body model of the Stewart platform was developed and validated against analytical equations.
|
|
The modular nature of the model allows for progressive refinement of individual components (plates, joints and actuators) and geometry, making it a valuable tool throughout the development process.
|
|
The validated model will be integrated into the broader multi-body representation of the micro-station, enabling comprehensive analysis of the complete NASS.
|
|
|
|
The use of this model extends beyond the current conceptual phase.
|
|
It will serve as a crucial tool during the detailed design phase, where it will be used to optimize the design and guide the development of sophisticated control strategies.
|
|
Furthermore, during the experimental phase, it will provide a theoretical framework for comparing and understanding measured dynamics.
|
|
|
|
The control aspects of the Stewart platform were addressed with particular attention to the challenges posed by its multi-input multi-output nature.
|
|
Although the coupled dynamics of the system suggest the potential benefit of advanced control strategies, a simplified architecture was proposed for the validation of the NASS concept.
|
|
This approach combines decentralized Integral Force Feedback for active damping with High Authority Control for positioning, which was implemented in the strut space to leverage the natural decoupling observed at low frequencies.
|
|
|
|
This study establishes the theoretical framework necessary for the subsequent development and validation of the NASS.
|
|
|
|
\printbibliography[heading=bibintoc,title={Bibliography}]
|
|
\end{document}
|