585 lines
33 KiB
TeX
585 lines
33 KiB
TeX
% Created 2024-10-27 Sun 14:49
|
|
% Intended LaTeX compiler: pdflatex
|
|
\documentclass[a4paper, 10pt, DIV=12, parskip=full, bibliography=totoc]{scrreprt}
|
|
|
|
\input{preamble.tex}
|
|
\input{preamble_extra.tex}
|
|
\bibliography{test-bench-nano-hexapod.bib}
|
|
\author{Dehaeze Thomas}
|
|
\date{\today}
|
|
\title{Nano-Hexapod - Test Bench}
|
|
\hypersetup{
|
|
pdfauthor={Dehaeze Thomas},
|
|
pdftitle={Nano-Hexapod - Test Bench},
|
|
pdfkeywords={},
|
|
pdfsubject={},
|
|
pdfcreator={Emacs 29.4 (Org mode 9.6)},
|
|
pdflang={English}}
|
|
\usepackage{biblatex}
|
|
|
|
\begin{document}
|
|
|
|
\maketitle
|
|
\tableofcontents
|
|
|
|
\clearpage
|
|
|
|
In the previous section, all the struts were mounted and individually characterized.
|
|
Now the nano-hexapod is assembled using a mounting procedure described in Section \ref{sec:test_nhexa_mounting}.
|
|
|
|
In order to identify the dynamics of the nano-hexapod, a special suspended table is developed which consists of a stiff ``optical breadboard'' suspended on top of four soft springs.
|
|
The Nano-Hexapod is then fixed on top of the suspended table, such that its dynamics is not affected by complex dynamics except from the suspension modes of the table that can be well characterized and modelled (Section \ref{sec:test_nhexa_table}).
|
|
|
|
The obtained nano-hexapod dynamics is analyzed in Section \ref{sec:test_nhexa_dynamics}, and compared with the Simscape model in Section \ref{sec:test_nhexa_model}.
|
|
|
|
\chapter{Nano-Hexapod Assembly Procedure}
|
|
\label{sec:test_nhexa_mounting}
|
|
The assembly of the nano-hexapod is quite critical to both avoid additional stress in the flexible joints (that would result in a loss of stroke) and for the precise determination of the Jacobian matrix.
|
|
The goal is to fix the six struts to the two nano-hexapod plates (shown in Figure \ref{fig:test_nhexa_nano_hexapod_plates}) while the two plates are parallel, aligned vertically, and such that all the flexible joints do not experience any stress.
|
|
Do to so, a precisely machined mounting tool (Figure \ref{fig:test_nhexa_center_part_hexapod_mounting}) is used to position the two nano-hexapod plates during the assembly procedure.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.59\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=4cm]{figs/test_nhexa_nano_hexapod_plates.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_nano_hexapod_plates}Received top and bottom plates}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.39\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,height=4cm]{figs/test_nhexa_center_part_hexapod_mounting.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_center_part_hexapod_mounting}Mounting tool}
|
|
\end{subfigure}
|
|
\caption{\label{fig:test_nhexa_received_parts}Received Nano-Hexapod plates (\subref{fig:test_nhexa_nano_hexapod_plates}) and mounting tool used to position the two plates during assembly (\subref{fig:test_nhexa_center_part_hexapod_mounting})}
|
|
\end{figure}
|
|
|
|
The mechanical tolerances of the received plates are checked using a FARO arm\footnote{Faro Arm Platinum 4ft, specified accuracy of \(\pm 13\mu m\)} (Figure \ref{fig:test_nhexa_plates_tolerances}) and are found to comply with the requirements\footnote{Location of all the interface surfaces with the flexible joints are checked. The fits (182H7 and 24H8) with the interface element are checked.}.
|
|
The same is done for the mounting tool\footnote{The height dimension is better than \(40\,\mu m\). The diameter fit of 182g6 and 24g6 with the two plates is verified.}
|
|
The two plates are then fixed to the mounting tool as shown in Figure \ref{fig:test_nhexa_mounting_tool_hexapod_top_view}.
|
|
The main goal of this ``mounting tool'' is to position the flexible joint interfaces (the ``V'' shapes) of both plates such that a cylinder can rest on the 4 flat interfaces at the same time.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.49\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.95\linewidth]{figs/test_nhexa_plates_tolerances.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_plates_tolerances}Dimensional check of the bottom plate}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.49\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.95\linewidth]{figs/test_nhexa_mounting_tool_hexapod_top_view.png}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_mounting_tool_hexapod_top_view}Wanted coaxiality between interfaces}
|
|
\end{subfigure}
|
|
\caption{\label{fig:test_nhexa_dimensional_check}A Faro arm is used to dimensionally check the received parts (\subref{fig:test_nhexa_plates_tolerances}) and after mounting the two plates with the mounting part (\subref{fig:test_nhexa_mounting_tool_hexapod_top_view})}
|
|
\end{figure}
|
|
|
|
The quality of the positioning can be estimated by measuring the ``straightness'' of the top and bottom ``V'' interfaces.
|
|
This corresponds to the diameter of the smallest cylinder that contains all points of the measured axis.
|
|
This is again done using the FARO arm, and the results for all the six struts are summarized in Table \ref{tab:measured_straightness}.
|
|
The straightness is found to be better than \(15\,\mu m\) for all the struts\footnote{As the accuracy of the FARO arm is \(\pm 13\,\mu m\), the true straightness is probably better than the values indicated. The limitation of the instrument is here reached.}, which is sufficiently good to not induce significant stress of the flexible joint during the assembly.
|
|
|
|
\begin{table}[htbp]
|
|
\centering
|
|
\begin{tabularx}{0.35\linewidth}{Xcc}
|
|
\toprule
|
|
\textbf{Strut} & \textbf{Meas 1} & \textbf{Meas 2}\\
|
|
\midrule
|
|
1 & \(7\,\mu m\) & \(3\, \mu m\)\\
|
|
2 & \(11\, \mu m\) & \(11\, \mu m\)\\
|
|
3 & \(15\, \mu m\) & \(14\, \mu m\)\\
|
|
4 & \(6\, \mu m\) & \(6\, \mu m\)\\
|
|
5 & \(7\, \mu m\) & \(5\, \mu m\)\\
|
|
6 & \(6\, \mu m\) & \(7\, \mu m\)\\
|
|
\bottomrule
|
|
\end{tabularx}
|
|
\caption{\label{tab:measured_straightness}Measured straightness between the two ``V'' for the six struts. These measurements are performed two times for each strut.}
|
|
|
|
\end{table}
|
|
|
|
The encoder rulers and heads are then fixed to the top and bottom plates respectively (Figure \ref{fig:test_nhexa_mount_encoder}).
|
|
The encoder heads are then aligned to maximize the received contrast.
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{0.49\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.95\linewidth]{figs/test_nhexa_mount_encoder_rulers.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_mount_encoder_rulers}Encoder rulers}
|
|
\end{subfigure}
|
|
\begin{subfigure}{0.49\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.95\linewidth]{figs/test_nhexa_mount_encoder_heads.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_mount_encoder_heads}Encoder heads}
|
|
\end{subfigure}
|
|
\caption{\label{fig:test_nhexa_mount_encoder}Mounting of the encoders to the Nano-hexapod. The rulers are fixed to the top plate (\subref{fig:test_nhexa_mount_encoder_rulers}) while the encoders heads are fixed to the botom plate (\subref{fig:test_nhexa_mount_encoder_heads})}
|
|
\end{figure}
|
|
|
|
The six struts are then fixed to the bottom and top plates one by one.
|
|
First the top flexible joint is fixed such that its flat reference surface is in contact with the top plate.
|
|
This is to precisely known the position of the flexible joint with respect to the top plate.
|
|
Then the bottom flexible joint is fixed.
|
|
After all six struts are mounted, the mounting tool (Figure \ref{fig:test_nhexa_center_part_hexapod_mounting}) can be disassembled, and the fully mounted nano-hexapod as shown in Figure \ref{fig:test_nhexa_nano_hexapod_mounted} is obtained.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1,width=\linewidth]{figs/test_nhexa_mounted_hexapod.jpg}
|
|
\caption{\label{fig:test_nhexa_nano_hexapod_mounted}Mounted Nano-Hexapod}
|
|
\end{figure}
|
|
|
|
\chapter{Suspended Table}
|
|
\label{sec:test_nhexa_table}
|
|
\section{Introduction}
|
|
|
|
When a dynamical system is fixed to a support (such as a granite or an optical table), its dynamics will couple to the support dynamics.
|
|
This may results in additional modes appearing in the system dynamics, which are difficult to predict and model.
|
|
Two prevent this issue, strategy adopted here is to mount the nano-hexapod on top a suspended table with low frequency suspension modes.
|
|
|
|
In such a case, the modes of the suspended table are chosen to be at much lower frequency than those of the nano-hexapod such that they are well decoupled.
|
|
An other key advantage is that the suspension modes of the suspended table can be easily modelled using Simscape.
|
|
Therefore, the measured dynamics of the nano-hexapod on top of the suspended table can be compared to a simscape model representing the same experimental conditions.
|
|
The model of the Nano-Hexapod can thus be precisely tuned to match the measured dynamics.
|
|
|
|
The developed suspended table is presented in Section \ref{ssec:test_nhexa_table_setup}.
|
|
The modal analysis of the table is done in \ref{ssec:test_nhexa_table_identification}.
|
|
Finally, the Simscape model representing the suspended table is tuned to match the measured modes (Section \ref{ssec:test_nhexa_table_model}).
|
|
|
|
\section{Experimental Setup}
|
|
\label{ssec:test_nhexa_table_setup}
|
|
|
|
The design of the suspended table is quite straightforward.
|
|
First, an optical table with high frequency flexible mode was selected\footnote{The 450 mm x 450 mm x 60 mm Nexus B4545A from Thorlabs.}.
|
|
Then, four springs\footnote{``SZ8005 20 x 044'' from Steinel. The spring rate is specified at \(17.8\,N/mm\)} were selected with low enough spring rate such that the suspension modes are below 10Hz.
|
|
Finally, some interface elements were designed, and mechanical lateral mechanical stops were added (Figure \ref{fig:test_nhexa_suspended_table_cad}).
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1,width=0.7\linewidth]{figs/test_nhexa_suspended_table_cad.jpg}
|
|
\caption{\label{fig:test_nhexa_suspended_table_cad}CAD View of the vibration table. Purple cylinders are representing the soft springs.}
|
|
\end{figure}
|
|
|
|
\section{Modal analysis of the suspended table}
|
|
\label{ssec:test_nhexa_table_identification}
|
|
|
|
In order to perform a modal analysis of the suspended table, a total of 15 3-axis accelerometers\footnote{PCB 356B18. Sensitivity is \(1\,V/g\), measurement range is \(\pm 5\,g\) and bandwidth is \(0.5\) to \(5\,\text{kHz}\).} were fixed to the breadboard.
|
|
Using an instrumented hammer, the first 9 modes could be identified and are summarized in Table \ref{tab:test_nhexa_suspended_table_modes}.
|
|
The first 6 modes are suspension modes (i.e. rigid body mode of the breadboard) and are located below 10Hz.
|
|
The next modes are flexible modes of the breadboard as shown in Figure \ref{fig:test_nhexa_table_flexible_modes}, and located above 700Hz.
|
|
|
|
\begin{minipage}[t]{0.45\linewidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=0.99\linewidth]{figs/test_nhexa_suspended_table.jpg}
|
|
\captionof{figure}{\label{fig:test_nhexa_suspended_table}Mounted suspended table. Only 1 or the 15 accelerometer is mounted on top}
|
|
\end{center}
|
|
\end{minipage}
|
|
\hfill
|
|
\begin{minipage}[b]{0.45\linewidth}
|
|
\begin{scriptsize}
|
|
\begin{center}
|
|
\begin{tabularx}{0.9\linewidth}{clX}
|
|
\toprule
|
|
\textbf{Modes} & \textbf{Frequency} & \textbf{Description}\\
|
|
\midrule
|
|
1,2 & 1.3 Hz & X-Y translations\\
|
|
3 & 2.0 Hz & Z rotation\\
|
|
4 & 6.9 Hz & Z translation\\
|
|
5,6 & 9.5 Hz & X-Y rotations\\
|
|
\midrule
|
|
7 & 701 Hz & ``Membrane'' Mode\\
|
|
8 & 989 Hz & Complex mode\\
|
|
9 & 1025 Hz & Complex mode\\
|
|
\bottomrule
|
|
\end{tabularx}
|
|
\captionof{table}{\label{tab:test_nhexa_suspended_table_modes}Obtained modes of the suspended table}
|
|
|
|
\end{center}
|
|
\end{scriptsize}
|
|
\end{minipage}
|
|
|
|
|
|
\begin{figure}[htbp]
|
|
\begin{subfigure}{\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/test_nhexa_table_flexible_mode_1.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_table_flexible_mode_1}Flexible mode at 701Hz}
|
|
\end{subfigure}
|
|
\begin{subfigure}{\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/test_nhexa_table_flexible_mode_2.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_table_flexible_mode_2}Flexible mode at 989Hz}
|
|
\end{subfigure}
|
|
\begin{subfigure}{\textwidth}
|
|
\begin{center}
|
|
\includegraphics[scale=1,width=\linewidth]{figs/test_nhexa_table_flexible_mode_3.jpg}
|
|
\end{center}
|
|
\subcaption{\label{fig:test_nhexa_table_flexible_mode_3}Flexible mode at 1025Hz}
|
|
\end{subfigure}
|
|
\caption{\label{fig:test_nhexa_table_flexible_modes}Three identified flexible modes of the suspended table}
|
|
\end{figure}
|
|
|
|
\section{Simscape Model of the suspended table}
|
|
\label{ssec:test_nhexa_table_model}
|
|
|
|
The Simscape model of the suspended table simply consists of two solid bodies connected by 4 springs.
|
|
The 4 springs are here modelled with ``bushing joints'' that have stiffness and damping properties in x, y and z directions.
|
|
The 3D representation of the model is displayed in Figure \ref{fig:test_nhexa_suspended_table_simscape} where the 4 ``bushing joints'' are represented by the blue cylinders.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1,width=0.8\linewidth]{figs/test_nhexa_suspended_table_simscape.png}
|
|
\caption{\label{fig:test_nhexa_suspended_table_simscape}3D representation of the simscape model}
|
|
\end{figure}
|
|
|
|
The model order is 12, and it represents the 6 suspension modes.
|
|
The inertia properties of the parts are set from the geometry and material densities.
|
|
The stiffness of the springs was initially set from the datasheet nominal value of \(17.8\,N/mm\) and then reduced down to \(14\,N/mm\) to better match the measured suspension modes.
|
|
The stiffness of the springs in the horizontal plane is set at \(0.5\,N/mm\).
|
|
The obtained suspension modes of the simscape model are compared with the measured ones in Table \ref{tab:test_nhexa_suspended_table_simscape_modes}.
|
|
|
|
\begin{table}[htbp]
|
|
\centering
|
|
\begin{tabularx}{0.6\linewidth}{Xcccc}
|
|
\toprule
|
|
Directions & \(D_x\), \(D_y\) & \(R_z\) & \(D_z\) & \(R_x\), \(R_y\)\\
|
|
\midrule
|
|
Experimental & 1.3 Hz & 2.0 Hz & 6.9 Hz & 9.5 Hz\\
|
|
Simscape & 1.3 Hz & 1.8 Hz & 6.8 Hz & 9.5 Hz\\
|
|
\bottomrule
|
|
\end{tabularx}
|
|
\caption{\label{tab:test_nhexa_suspended_table_simscape_modes}Comparison of the identified suspension modes with the Simscape model and measured experimentally}
|
|
|
|
\end{table}
|
|
|
|
\chapter{Nano-Hexapod Dynamics}
|
|
\label{sec:test_nhexa_dynamics}
|
|
In Figure \ref{fig:test_nhexa_nano_hexapod_signals} is shown a block diagram of the experimental setup.
|
|
When possible, the notations are consistent with this diagram and summarized in Table \ref{tab:list_signals}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1,scale=1]{figs/test_nhexa_nano_hexapod_signals.png}
|
|
\caption{\label{fig:test_nhexa_nano_hexapod_signals}Block diagram of the system with named signals}
|
|
\end{figure}
|
|
|
|
\begin{table}[htbp]
|
|
\centering
|
|
\begin{tabularx}{\linewidth}{Xllll}
|
|
\toprule
|
|
& \textbf{Unit} & \textbf{Matlab} & \textbf{Vector} & \textbf{Elements}\\
|
|
\midrule
|
|
Control Input (wanted DAC voltage) & \texttt{[V]} & \texttt{u} & \(\bm{u}\) & \(u_i\)\\
|
|
DAC Output Voltage & \texttt{[V]} & \texttt{u} & \(\tilde{\bm{u}}\) & \(\tilde{u}_i\)\\
|
|
PD200 Output Voltage & \texttt{[V]} & \texttt{ua} & \(\bm{u}_a\) & \(u_{a,i}\)\\
|
|
Actuator applied force & \texttt{[N]} & \texttt{tau} & \(\bm{\tau}\) & \(\tau_i\)\\
|
|
\midrule
|
|
Strut motion & \texttt{[m]} & \texttt{dL} & \(d\bm{\mathcal{L}}\) & \(d\mathcal{L}_i\)\\
|
|
Encoder measured displacement & \texttt{[m]} & \texttt{dLm} & \(d\bm{\mathcal{L}}_m\) & \(d\mathcal{L}_{m,i}\)\\
|
|
\midrule
|
|
Force Sensor strain & \texttt{[m]} & \texttt{epsilon} & \(\bm{\epsilon}\) & \(\epsilon_i\)\\
|
|
Force Sensor Generated Voltage & \texttt{[V]} & \texttt{taum} & \(\tilde{\bm{\tau}}_m\) & \(\tilde{\tau}_{m,i}\)\\
|
|
Measured Generated Voltage & \texttt{[V]} & \texttt{taum} & \(\bm{\tau}_m\) & \(\tau_{m,i}\)\\
|
|
\midrule
|
|
Motion of the top platform & \texttt{[m,rad]} & \texttt{dX} & \(d\bm{\mathcal{X}}\) & \(d\mathcal{X}_i\)\\
|
|
Metrology measured displacement & \texttt{[m,rad]} & \texttt{dXm} & \(d\bm{\mathcal{X}}_m\) & \(d\mathcal{X}_{m,i}\)\\
|
|
\bottomrule
|
|
\end{tabularx}
|
|
\caption{\label{tab:list_signals}List of signals}
|
|
|
|
\end{table}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1,width=\linewidth]{figs/test_nhexa_IMG_20210625_083801.jpg}
|
|
\caption{\label{fig:test_nhexa_enc_fixed_to_struts}Nano-Hexapod with encoders fixed to the struts}
|
|
\end{figure}
|
|
|
|
It is structured as follow:
|
|
\begin{itemize}
|
|
\item Section \ref{sec:test_nhexa_enc_plates_plant_id}: The dynamics of the nano-hexapod is identified.
|
|
\item Section \ref{sec:test_nhexa_enc_plates_comp_simscape}: The identified dynamics is compared with the Simscape model.
|
|
\end{itemize}
|
|
|
|
\section{Identification of the dynamics}
|
|
\label{sec:test_nhexa_enc_plates_plant_id}
|
|
In this section, the dynamics of the nano-hexapod with the encoders fixed to the plates is identified.
|
|
|
|
First, the measurement data are loaded in Section \ref{sec:test_nhexa_enc_plates_plant_id_setup}, then the transfer function matrix from the actuators to the encoders are estimated in Section \ref{sec:test_nhexa_enc_plates_plant_id_dvf}.
|
|
Finally, the transfer function matrix from the actuators to the force sensors is estimated in Section \ref{sec:test_nhexa_enc_plates_plant_id_iff}.
|
|
\subsection{Data Loading and Spectral Analysis Setup}
|
|
\label{sec:test_nhexa_enc_plates_plant_id_setup}
|
|
|
|
The actuators are excited one by one using a low pass filtered white noise.
|
|
For each excitation, the 6 force sensors and 6 encoders are measured and saved.
|
|
\subsection{Transfer function from Actuator to Encoder}
|
|
\label{sec:test_nhexa_enc_plates_plant_id_dvf}
|
|
|
|
The 6x6 transfer function matrix from the excitation voltage \(\bm{u}\) and the displacement \(d\bm{\mathcal{L}}_m\) as measured by the encoders is estimated.
|
|
|
|
The diagonal and off-diagonal terms of this transfer function matrix are shown in Figure \ref{fig:test_nhexa_enc_plates_dvf_frf}.
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/enc_plates_dvf_frf.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_dvf_frf}Measured FRF for the transfer function from \(\bm{u}\) to \(d\bm{\mathcal{L}}_m\)}
|
|
\end{figure}
|
|
|
|
\begin{important}
|
|
From Figure \ref{fig:test_nhexa_enc_plates_dvf_frf}, we can draw few conclusions on the transfer functions from \(\bm{u}\) to \(d\bm{\mathcal{L}}_m\) when the encoders are fixed to the plates:
|
|
\begin{itemize}
|
|
\item the decoupling is rather good at low frequency (below the first suspension mode).
|
|
The low frequency gain is constant for the off diagonal terms, whereas when the encoders where fixed to the struts, the low frequency gain of the off-diagonal terms were going to zero (Figure \ref{fig:test_nhexa_enc_struts_dvf_frf}).
|
|
\item the flexible modes of the struts at 226Hz and 337Hz are indeed shown in the transfer functions, but their amplitudes are rather low.
|
|
\item the diagonal terms have alternating poles and zeros up to at least 600Hz: the flexible modes of the struts are not affecting the alternating pole/zero pattern. This what not the case when the encoders were fixed to the struts (Figure \ref{fig:test_nhexa_enc_struts_dvf_frf}).
|
|
\end{itemize}
|
|
\end{important}
|
|
|
|
\subsection{Transfer function from Actuator to Force Sensor}
|
|
\label{sec:test_nhexa_enc_plates_plant_id_iff}
|
|
Then the 6x6 transfer function matrix from the excitation voltage \(\bm{u}\) and the voltage \(\bm{\tau}_m\) generated by the Force senors is estimated.
|
|
The bode plot of the diagonal and off-diagonal terms are shown in Figure \ref{fig:test_nhexa_enc_plates_iff_frf}.
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/enc_plates_iff_frf.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_iff_frf}Measured FRF for the IFF plant}
|
|
\end{figure}
|
|
|
|
\begin{important}
|
|
It is shown in Figure \ref{fig:test_nhexa_enc_plates_iff_comp_simscape_all} that:
|
|
\begin{itemize}
|
|
\item The IFF plant has alternating poles and zeros
|
|
\item The first flexible mode of the struts as 235Hz is appearing, and therefore is should be possible to add some damping to this mode using IFF
|
|
\item The decoupling is quite good at low frequency (below the first model) as well as high frequency (above the last suspension mode, except near the flexible modes of the top plate)
|
|
\end{itemize}
|
|
\end{important}
|
|
|
|
\subsection{Save Identified Plants}
|
|
The identified dynamics is saved for further use.
|
|
\section{Effect of Payload mass on the Dynamics}
|
|
\label{sec:test_nhexa_added_mass}
|
|
In this section, the encoders are fixed to the plates, and we identify the dynamics for several payloads.
|
|
The added payload are half cylinders, and three layers can be added for a total of around 40kg (Figure \ref{fig:test_nhexa_picture_added_3_masses}).
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1,width=\linewidth]{figs/test_nhexa_picture_added_3_masses.jpg}
|
|
\caption{\label{fig:test_nhexa_picture_added_3_masses}Picture of the nano-hexapod with added mass}
|
|
\end{figure}
|
|
|
|
First the dynamics from \(\bm{u}\) to \(d\mathcal{L}_m\) and \(\bm{\tau}_m\) is identified.
|
|
Then, the Integral Force Feedback controller is developed and applied as shown in Figure \ref{fig:test_nhexa_nano_hexapod_signals_iff}.
|
|
Finally, the dynamics from \(\bm{u}^\prime\) to \(d\mathcal{L}_m\) is identified and the added damping can be estimated.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_nano_hexapod_signals_iff.png}
|
|
\caption{\label{fig:test_nhexa_nano_hexapod_signals_iff}Block Diagram of the experimental setup and model}
|
|
\end{figure}
|
|
\subsection{Measured Frequency Response Functions}
|
|
The following data are loaded:
|
|
\begin{itemize}
|
|
\item \texttt{Va}: the excitation voltage (corresponding to \(u_i\))
|
|
\item \texttt{Vs}: the generated voltage by the 6 force sensors (corresponding to \(\bm{\tau}_m\))
|
|
\item \texttt{de}: the measured motion by the 6 encoders (corresponding to \(d\bm{\mathcal{L}}_m\))
|
|
\end{itemize}
|
|
The window \texttt{win} and the frequency vector \texttt{f} are defined.
|
|
Finally the \(6 \times 6\) transfer function matrices from \(\bm{u}\) to \(d\bm{\mathcal{L}}_m\) and from \(\bm{u}\) to \(\bm{\tau}_m\) are identified:
|
|
The identified dynamics are then saved for further use.
|
|
\subsection{Transfer function from Actuators to Encoders}
|
|
The transfer functions from \(\bm{u}\) to \(d\bm{\mathcal{L}}_{m}\) are shown in Figure \ref{fig:test_nhexa_comp_plant_payloads_dvf}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_comp_plant_payloads_dvf.png}
|
|
\caption{\label{fig:test_nhexa_comp_plant_payloads_dvf}Measured Frequency Response Functions from \(u_i\) to \(d\mathcal{L}_{m,i}\) for all 4 payload conditions. Diagonal terms are solid lines, and shaded lines are off-diagonal terms.}
|
|
\end{figure}
|
|
|
|
|
|
\begin{important}
|
|
From Figure \ref{fig:test_nhexa_comp_plant_payloads_dvf}, we can observe few things:
|
|
\begin{itemize}
|
|
\item The obtained dynamics is changing a lot between the case without mass and when there is at least one added mass.
|
|
\item Between 1, 2 and 3 added masses, the dynamics is not much different, and it would be easier to design a controller only for these cases.
|
|
\item The flexible modes of the top plate is first decreased a lot when the first mass is added (from 700Hz to 400Hz).
|
|
This is due to the fact that the added mass is composed of two half cylinders which are not fixed together.
|
|
Therefore is adds a lot of mass to the top plate without adding a lot of rigidity in one direction.
|
|
When more than 1 mass layer is added, the half cylinders are added with some angles such that rigidity are added in all directions (see Figure \ref{fig:test_nhexa_picture_added_3_masses}).
|
|
In that case, the frequency of these flexible modes are increased.
|
|
In practice, the payload should be one solid body, and we should not see a massive decrease of the frequency of this flexible mode.
|
|
\item Flexible modes of the top plate are becoming less problematic as masses are added.
|
|
\item First flexible mode of the strut at 230Hz is not much decreased when mass is added.
|
|
However, its apparent amplitude is much decreased.
|
|
\end{itemize}
|
|
\end{important}
|
|
|
|
\subsection{Transfer function from Actuators to Force Sensors}
|
|
The transfer functions from \(\bm{u}\) to \(\bm{\tau}_{m}\) are shown in Figure \ref{fig:test_nhexa_comp_plant_payloads_iff}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_comp_plant_payloads_iff.png}
|
|
\caption{\label{fig:test_nhexa_comp_plant_payloads_iff}Measured Frequency Response Functions from \(u_i\) to \(\tau_{m,i}\) for all 4 payload conditions. Diagonal terms are solid lines, and shaded lines are off-diagonal terms.}
|
|
\end{figure}
|
|
|
|
\begin{important}
|
|
From Figure \ref{fig:test_nhexa_comp_plant_payloads_iff}, we can see that for all added payloads, the transfer function from \(\bm{u}\) to \(\bm{\tau}_{m}\) always has alternating poles and zeros.
|
|
\end{important}
|
|
|
|
\subsection{Coupling of the transfer function from Actuator to Encoders}
|
|
The RGA-number, which is a measure of the interaction in the system, is computed for the transfer function matrix from \(\bm{u}\) to \(d\bm{\mathcal{L}}_m\) for all the payloads.
|
|
The obtained numbers are compared in Figure \ref{fig:test_nhexa_rga_num_ol_masses}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_rga_num_ol_masses.png}
|
|
\caption{\label{fig:test_nhexa_rga_num_ol_masses}RGA-number for the open-loop transfer function from \(\bm{u}\) to \(d\bm{\mathcal{L}}_m\)}
|
|
\end{figure}
|
|
|
|
\begin{important}
|
|
From Figure \ref{fig:test_nhexa_rga_num_ol_masses}, it is clear that the coupling is quite large starting from the first suspension mode of the nano-hexapod.
|
|
Therefore, is the payload's mass is increase, the coupling in the system start to become unacceptably large at lower frequencies.
|
|
\end{important}
|
|
|
|
\section{Conclusion}
|
|
\begin{important}
|
|
In this section, the dynamics of the nano-hexapod with the encoders fixed to the plates is studied.
|
|
|
|
It has been found that:
|
|
\begin{itemize}
|
|
\item The measured dynamics is in agreement with the dynamics of the simscape model, up to the flexible modes of the top plate.
|
|
See figures \ref{fig:test_nhexa_enc_plates_iff_comp_simscape} and \ref{fig:test_nhexa_enc_plates_iff_comp_offdiag_simscape} for the transfer function to the force sensors and Figures \ref{fig:test_nhexa_enc_plates_dvf_comp_simscape} and \ref{fig:test_nhexa_enc_plates_dvf_comp_offdiag_simscape} for the transfer functions to the encoders
|
|
\item The Integral Force Feedback strategy is very effective in damping the suspension modes of the nano-hexapod (Figure \ref{fig:test_nhexa_enc_plant_plates_effect_iff}).
|
|
\item The transfer function from \(\bm{u}^\prime\) to \(d\bm{\mathcal{L}}_m\) show nice dynamical properties and is a much better candidate for the high-authority-control than when the encoders were fixed to the struts.
|
|
At least up to the flexible modes of the top plate, the diagonal elements of the transfer function matrix have alternating poles and zeros, and the phase is moving smoothly.
|
|
Only the flexible modes of the top plates seems to be problematic for control.
|
|
\end{itemize}
|
|
\end{important}
|
|
|
|
\chapter{Comparison with the Nano-Hexapod model?}
|
|
\label{sec:test_nhexa_model}
|
|
\section{Comparison with the Simscape Model}
|
|
\label{sec:test_nhexa_enc_plates_comp_simscape}
|
|
In this section, the measured dynamics done in Section \ref{sec:test_nhexa_enc_plates_plant_id} is compared with the dynamics estimated from the Simscape model.
|
|
|
|
A configuration is added to be able to put the nano-hexapod on top of the vibration table as shown in Figure \ref{fig:simscape_vibration_table}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1,width=0.8\linewidth]{figs/vibration_table_nano_hexapod_simscape.png}
|
|
\caption{\label{fig:simscape_vibration_table}3D representation of the simscape model with the nano-hexapod}
|
|
\end{figure}
|
|
\subsection{Identification with the Simscape Model}
|
|
The nano-hexapod is initialized with the APA taken as 2dof models.
|
|
Now, the dynamics from the DAC voltage \(\bm{u}\) to the encoders \(d\bm{\mathcal{L}}_m\) is estimated using the Simscape model.
|
|
Then the transfer function from \(\bm{u}\) to \(\bm{\tau}_m\) is identified using the Simscape model.
|
|
The identified dynamics is saved for further use.
|
|
\subsection{Dynamics from Actuator to Force Sensors}
|
|
The identified dynamics is compared with the measured FRF:
|
|
\begin{itemize}
|
|
\item Figure \ref{fig:test_nhexa_enc_plates_iff_comp_simscape_all}: the individual transfer function from \(u_1\) (the DAC voltage for the first actuator) to the force sensors of all 6 struts are compared
|
|
\item Figure \ref{fig:test_nhexa_enc_plates_iff_comp_simscape}: all the diagonal elements are compared
|
|
\item Figure \ref{fig:test_nhexa_enc_plates_iff_comp_offdiag_simscape}: all the off-diagonal elements are compared
|
|
\end{itemize}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_enc_plates_iff_comp_simscape_all.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_iff_comp_simscape_all}IFF Plant for the first actuator input and all the force senosrs}
|
|
\end{figure}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_enc_plates_iff_comp_simscape.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_iff_comp_simscape}Diagonal elements of the IFF Plant}
|
|
\end{figure}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_enc_plates_iff_comp_offdiag_simscape.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_iff_comp_offdiag_simscape}Off diagonal elements of the IFF Plant}
|
|
\end{figure}
|
|
|
|
\subsection{Dynamics from Actuator to Encoder}
|
|
The identified dynamics is compared with the measured FRF:
|
|
\begin{itemize}
|
|
\item Figure \ref{fig:test_nhexa_enc_plates_dvf_comp_simscape_all}: the individual transfer function from \(u_3\) (the DAC voltage for the actuator number 3) to the six encoders
|
|
\item Figure \ref{fig:test_nhexa_enc_plates_dvf_comp_simscape}: all the diagonal elements are compared
|
|
\item Figure \ref{fig:test_nhexa_enc_plates_dvf_comp_offdiag_simscape}: all the off-diagonal elements are compared
|
|
\end{itemize}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_enc_plates_dvf_comp_simscape_all.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_dvf_comp_simscape_all}DVF Plant for the first actuator input and all the encoders}
|
|
\end{figure}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_enc_plates_dvf_comp_simscape.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_dvf_comp_simscape}Diagonal elements of the DVF Plant}
|
|
\end{figure}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_enc_plates_dvf_comp_offdiag_simscape.png}
|
|
\caption{\label{fig:test_nhexa_enc_plates_dvf_comp_offdiag_simscape}Off diagonal elements of the DVF Plant}
|
|
\end{figure}
|
|
|
|
\subsection{Conclusion}
|
|
\begin{important}
|
|
The Simscape model is quite accurate for the transfer function matrices from \(\bm{u}\) to \(\bm{\tau}_m\) and from \(\bm{u}\) to \(d\bm{\mathcal{L}}_m\) except at frequencies of the flexible modes of the top-plate.
|
|
The Simscape model can therefore be used to develop the control strategies.
|
|
\end{important}
|
|
|
|
\section{Comparison with the Simscape model}
|
|
\label{sec:test_nhexa_added_mass_simscape}
|
|
Let's now compare the identified dynamics with the Simscape model.
|
|
We wish to verify if the Simscape model is still accurate for all the tested payloads.
|
|
\subsection{System Identification}
|
|
Let's initialize the simscape model with the nano-hexapod fixed on top of the vibration table.
|
|
First perform the identification for the transfer functions from \(\bm{u}\) to \(d\bm{\mathcal{L}}_m\):
|
|
The identified dynamics are then saved for further use.
|
|
\subsection{Transfer function from Actuators to Encoders}
|
|
The measured FRF and the identified dynamics from \(u_i\) to \(d\mathcal{L}_{m,i}\) are compared in Figure \ref{fig:test_nhexa_comp_masses_model_exp_dvf}.
|
|
A zoom near the ``suspension'' modes is shown in Figure \ref{fig:test_nhexa_comp_masses_model_exp_dvf_zoom}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/comp_masses_model_exp_dvf.png}
|
|
\caption{\label{fig:test_nhexa_comp_masses_model_exp_dvf}Comparison of the transfer functions from \(u_i\) to \(d\mathcal{L}_{m,i}\) - measured FRF and identification from the Simscape model}
|
|
\end{figure}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_comp_masses_model_exp_dvf_zoom.png}
|
|
\caption{\label{fig:test_nhexa_comp_masses_model_exp_dvf_zoom}Comparison of the transfer functions from \(u_i\) to \(d\mathcal{L}_{m,i}\) - measured FRF and identification from the Simscape model (Zoom)}
|
|
\end{figure}
|
|
|
|
\begin{important}
|
|
The Simscape model is very accurately representing the measured dynamics up.
|
|
Only the flexible modes of the struts and of the top plate are not represented here as these elements are modelled as rigid bodies.
|
|
\end{important}
|
|
|
|
\subsection{Transfer function from Actuators to Force Sensors}
|
|
The measured FRF and the identified dynamics from \(u_i\) to \(\tau_{m,i}\) are compared in Figure \ref{fig:test_nhexa_comp_masses_model_exp_iff}.
|
|
A zoom near the ``suspension'' modes is shown in Figure \ref{fig:test_nhexa_comp_masses_model_exp_iff_zoom}.
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_comp_masses_model_exp_iff.png}
|
|
\caption{\label{fig:test_nhexa_comp_masses_model_exp_iff}Comparison of the transfer functions from \(u_i\) to \(\tau_{m,i}\) - measured FRF and identification from the Simscape model}
|
|
\end{figure}
|
|
|
|
\begin{figure}[htbp]
|
|
\centering
|
|
\includegraphics[scale=1]{figs/test_nhexa_comp_masses_model_exp_iff_zoom.png}
|
|
\caption{\label{fig:test_nhexa_comp_masses_model_exp_iff_zoom}Comparison of the transfer functions from \(u_i\) to \(\tau_{m,i}\) - measured FRF and identification from the Simscape model (Zoom)}
|
|
\end{figure}
|
|
|
|
\printbibliography[heading=bibintoc,title={Bibliography}]
|
|
|
|
\printglossaries
|
|
\end{document}
|