729 lines
32 KiB
HTML
729 lines
32 KiB
HTML
<?xml version="1.0" encoding="utf-8"?>
|
|
<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Strict//EN"
|
|
"http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd">
|
|
<html xmlns="http://www.w3.org/1999/xhtml" lang="en" xml:lang="en">
|
|
<head>
|
|
<!-- 2020-11-12 jeu. 10:29 -->
|
|
<meta http-equiv="Content-Type" content="text/html;charset=utf-8" />
|
|
<title>Modal Analysis - Processing of FRF</title>
|
|
<meta name="generator" content="Org mode" />
|
|
<meta name="author" content="Dehaeze Thomas" />
|
|
<link rel="stylesheet" type="text/css" href="https://research.tdehaeze.xyz/css/style.css"/>
|
|
<script type="text/javascript" src="https://research.tdehaeze.xyz/js/script.js"></script>
|
|
<script>MathJax = {
|
|
tex: {
|
|
tags: 'ams',
|
|
macros: {bm: ["\\boldsymbol{#1}",1],}
|
|
}
|
|
};
|
|
</script>
|
|
<script type="text/javascript" src="https://cdn.jsdelivr.net/npm/mathjax@3/es5/tex-mml-chtml.js"></script>
|
|
</head>
|
|
<body>
|
|
<div id="org-div-home-and-up">
|
|
<a accesskey="h" href="../index.html"> UP </a>
|
|
|
|
|
<a accesskey="H" href="../index.html"> HOME </a>
|
|
</div><div id="content">
|
|
<h1 class="title">Modal Analysis - Processing of FRF</h1>
|
|
<div id="table-of-contents">
|
|
<h2>Table of Contents</h2>
|
|
<div id="text-table-of-contents">
|
|
<ul>
|
|
<li><a href="#orgf7cf1c8">1. Importation of measured FRF curves</a></li>
|
|
<li><a href="#orgc506a92">2. From accelerometer DOFs to solid body DOFs - Mathematics</a></li>
|
|
<li><a href="#org681033c">3. What reference frame to choose?</a></li>
|
|
<li><a href="#org964462f">4. FRF expressed in a common frame</a>
|
|
<ul>
|
|
<li><a href="#orga50f5f9">4.1. From accelerometer DOFs to solid body DOFs - Matlab Implementation</a></li>
|
|
<li><a href="#org3164705">4.2. Analysis of some FRF in the global coordinates</a></li>
|
|
<li><a href="#org2faadba">4.3. Comparison of the relative motion of solid bodies</a></li>
|
|
<li><a href="#orgefe4113">4.4. Verify that we find the original FRF from the FRF in the global coordinates</a></li>
|
|
<li><a href="#orgc0f4ff6">4.5. Saving of the FRF expressed in the global coordinates</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org6014915">5. FRF expressed in a frame centered at the CoM of each solid body</a>
|
|
<ul>
|
|
<li><a href="#orgc5b91ab">5.1. Center of Mass of each solid body</a></li>
|
|
<li><a href="#org9ea4330">5.2. From accelerometer DOFs to solid body DOFs - Expressed at the CoM</a></li>
|
|
<li><a href="#orga333d35">5.3. Analysis of some FRF</a></li>
|
|
<li><a href="#org52ce77b">5.4. Save the FRF</a></li>
|
|
</ul>
|
|
</li>
|
|
</ul>
|
|
</div>
|
|
</div>
|
|
|
|
<p>
|
|
The measurements have been conducted and we have computed the \(n \times p \times q\) Frequency Response Functions Matrix with:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(n\): the number of measurements: \(23 \times 3 = 69\) (23 accelerometers measuring 3 directions each)</li>
|
|
<li>\(p\): the number of excitation inputs: \(3\)</li>
|
|
<li>\(q\): the number of frequency points \(\omega_i\)</li>
|
|
</ul>
|
|
|
|
<p>
|
|
However, in our model, we only consider 6 solid bodies, namely:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>Bottom Granite</li>
|
|
<li>Top Granite</li>
|
|
<li>Translation Stage</li>
|
|
<li>Tilt Stage</li>
|
|
<li>Spindle</li>
|
|
<li>Hexapod</li>
|
|
</ul>
|
|
|
|
<p>
|
|
Thus, we are only interested in \(6 \times 6 = 36\) degrees of freedom.
|
|
</p>
|
|
|
|
<p>
|
|
We here process the FRF matrix to go from the 69 measured DOFs to the wanted 36 DOFs.
|
|
</p>
|
|
|
|
<div class="note" id="orgdcd560d">
|
|
<p>
|
|
All the files (data and Matlab scripts) are accessible <a href="data/frf_processing.zip">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
|
|
<div id="outline-container-orgf7cf1c8" class="outline-2">
|
|
<h2 id="orgf7cf1c8"><span class="section-number-2">1</span> Importation of measured FRF curves</h2>
|
|
<div class="outline-text-2" id="text-1">
|
|
<p>
|
|
We load the measured FRF and Coherence matrices.
|
|
We also load the geometric parameters of the station: solid bodies considered and the position of the accelerometers.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">load(<span class="org-string">'mat/frf_coh_matrices.mat'</span>, <span class="org-string">'FRFs'</span>, <span class="org-string">'COHs'</span>, <span class="org-string">'freqs'</span>);
|
|
load(<span class="org-string">'mat/geometry.mat'</span>, <span class="org-string">'solids'</span>, <span class="org-string">'solid_names'</span>, <span class="org-string">'acc_pos'</span>);
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgc506a92" class="outline-2">
|
|
<h2 id="orgc506a92"><span class="section-number-2">2</span> From accelerometer DOFs to solid body DOFs - Mathematics</h2>
|
|
<div class="outline-text-2" id="text-2">
|
|
<p>
|
|
Let’s consider the schematic shown on figure <a href="#orgabbad6c">1</a> where we are measuring the motion of a (supposed) solid body at 4 distinct points in x-y-z.
|
|
</p>
|
|
|
|
<p>
|
|
The goal here is to link these \(4 \times 3 = 12\) measurements to the 6 DOFs of the solid body expressed in the frame \(\{O\}\).
|
|
</p>
|
|
|
|
|
|
<div id="orgabbad6c" class="figure">
|
|
<p><img src="figs/local_to_global_coordinates.png" alt="local_to_global_coordinates.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 1: </span>Schematic of the measured motions of a solid body</p>
|
|
</div>
|
|
|
|
<p>
|
|
We consider the motion of the rigid body defined by its displacement \(\delta p\) and rotation \(\vec{\Omega}\) with respect to the reference frame \(\{O\}\).
|
|
</p>
|
|
|
|
<p>
|
|
From the figure <a href="#orgabbad6c">1</a>, we can write:
|
|
</p>
|
|
\begin{align*}
|
|
\delta p_1 &= \delta p + \delta\Omega p_1\\
|
|
\delta p_2 &= \delta p + \delta\Omega p_2\\
|
|
\delta p_3 &= \delta p + \delta\Omega p_3\\
|
|
\delta p_4 &= \delta p + \delta\Omega p_4
|
|
\end{align*}
|
|
<p>
|
|
With
|
|
</p>
|
|
\begin{equation}
|
|
\delta\Omega = \begin{bmatrix}
|
|
0 & -\delta\Omega_z & \delta\Omega_y \\
|
|
\delta\Omega_z & 0 & -\delta\Omega_x \\
|
|
-\delta\Omega_y & \delta\Omega_x & 0
|
|
\end{bmatrix}
|
|
\end{equation}
|
|
|
|
<p>
|
|
We can rearrange the equations in a matrix form:
|
|
</p>
|
|
|
|
\begin{equation}
|
|
\left[\begin{array}{ccc|ccc}
|
|
1 & 0 & 0 & 0 & p_{1z} & -p_{1y} \\
|
|
0 & 1 & 0 & -p_{1z} & 0 & p_{1x} \\
|
|
0 & 0 & 1 & p_{1y} & -p_{1x} & 0 \\ \hline
|
|
& \vdots & & & \vdots & \\ \hline
|
|
1 & 0 & 0 & 0 & p_{4z} & -p_{4y} \\
|
|
0 & 1 & 0 & -p_{4z} & 0 & p_{4x} \\
|
|
0 & 0 & 1 & p_{4y} & -p_{4x} & 0
|
|
\end{array}\right] \begin{bmatrix}
|
|
\delta p_x \\ \delta p_y \\ \delta p_z \\ \hline \delta\Omega_x \\ \delta\Omega_y \\ \delta\Omega_z
|
|
\end{bmatrix} = \begin{bmatrix}
|
|
\delta p_{1x} \\ \delta p_{1y} \\ \delta p_{1z} \\\hline \vdots \\\hline \delta p_{4x} \\ \delta p_{4y} \\ \delta p_{4z}
|
|
\end{bmatrix}
|
|
\end{equation}
|
|
|
|
<p>
|
|
and then we obtain the velocity and rotation of the solid in the wanted frame \(\{O\}\):
|
|
</p>
|
|
\begin{equation}
|
|
\begin{bmatrix}
|
|
\delta p_x \\ \delta p_y \\ \delta p_z \\ \hline \delta\Omega_x \\ \delta\Omega_y \\ \delta\Omega_z
|
|
\end{bmatrix} =
|
|
\left[\begin{array}{ccc|ccc}
|
|
1 & 0 & 0 & 0 & p_{1z} & -p_{1y} \\
|
|
0 & 1 & 0 & -p_{1z} & 0 & p_{1x} \\
|
|
0 & 0 & 1 & p_{1y} & -p_{1x} & 0 \\ \hline
|
|
& \vdots & & & \vdots & \\ \hline
|
|
1 & 0 & 0 & 0 & p_{4z} & -p_{4y} \\
|
|
0 & 1 & 0 & -p_{4z} & 0 & p_{4x} \\
|
|
0 & 0 & 1 & p_{4y} & -p_{4x} & 0
|
|
\end{array}\right]^{-1} \begin{bmatrix}
|
|
\delta p_{1x} \\ \delta p_{1y} \\ \delta p_{1z} \\\hline \vdots \\\hline \delta p_{4x} \\ \delta p_{4y} \\ \delta p_{4z}
|
|
\end{bmatrix} \label{eq:determine_global_disp}
|
|
\end{equation}
|
|
|
|
<div class="important" id="orgf0f0c51">
|
|
<p>
|
|
Using equation \eqref{eq:determine_global_disp}, we can determine the motion of the solid body expressed in a chosen frame \(\{O\}\) using the accelerometers attached to it.
|
|
The inversion is equivalent to resolving a mean square problem.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org681033c" class="outline-2">
|
|
<h2 id="org681033c"><span class="section-number-2">3</span> What reference frame to choose?</h2>
|
|
<div class="outline-text-2" id="text-3">
|
|
<p>
|
|
The question we wish here to answer is how to choose the reference frame \(\{O\}\) in which the DOFs of the solid bodies are defined.
|
|
</p>
|
|
|
|
<p>
|
|
The possibles choices are:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li><b>One frame for each solid body</b> which is located at its center of mass</li>
|
|
<li><b>One common frame</b>, for instance located at the point of interest (\(270mm\) above the Hexapod)</li>
|
|
<li><b>Base located at the joint position</b>: this is where we want to see the motion and estimate stiffness</li>
|
|
</ul>
|
|
|
|
<table id="org1b39281" border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
<caption class="t-above"><span class="table-number">Table 1:</span> Advantages and disadvantages for the choice of reference frame</caption>
|
|
|
|
<colgroup>
|
|
<col class="org-left" />
|
|
|
|
<col class="org-left" />
|
|
|
|
<col class="org-left" />
|
|
</colgroup>
|
|
<thead>
|
|
<tr>
|
|
<th scope="col" class="org-left">Chosen Frame</th>
|
|
<th scope="col" class="org-left">Advantages</th>
|
|
<th scope="col" class="org-left">Disadvantages</th>
|
|
</tr>
|
|
</thead>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">Frames at CoM</td>
|
|
<td class="org-left">Physically, it makes more sense</td>
|
|
<td class="org-left">How to compare the motion of the solid bodies?</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Common Frame</td>
|
|
<td class="org-left">We can compare the motion of each solid body</td>
|
|
<td class="org-left">Small \(\theta_{x, y}\) may result in large \(T_{x, y}\)</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Frames at joint position</td>
|
|
<td class="org-left">Directly gives which joint direction can be blocked</td>
|
|
<td class="org-left">How to choose the joint position?</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
|
|
<p>
|
|
The choice of the frame depends of what we want to do with the data.
|
|
</p>
|
|
|
|
<p>
|
|
One of the goals is to compare the motion of each solid body to see which relative DOFs between solid bodies can be neglected, that is to say, which joint between solid bodies can be regarded as perfect (and this in all the frequency range of interest).
|
|
Ideally, we would like to have the same number of degrees of freedom than the number of identified modes.
|
|
</p>
|
|
|
|
<p>
|
|
In the next sections, we will express the FRF matrix in the different frames.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org964462f" class="outline-2">
|
|
<h2 id="org964462f"><span class="section-number-2">4</span> FRF expressed in a common frame</h2>
|
|
<div class="outline-text-2" id="text-4">
|
|
</div>
|
|
<div id="outline-container-orga50f5f9" class="outline-3">
|
|
<h3 id="orga50f5f9"><span class="section-number-3">4.1</span> From accelerometer DOFs to solid body DOFs - Matlab Implementation</h3>
|
|
<div class="outline-text-3" id="text-4-1">
|
|
<p>
|
|
First, we initialize a new FRF matrix <code>FRFs_O</code> which is an \(n \times p \times q\) with:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(n\) is the number of DOFs of the considered 6 solid-bodies: \(6 \times 6 = 36\)</li>
|
|
<li>\(p\) is the number of excitation inputs: \(3\)</li>
|
|
<li>\(q\) is the number of frequency points \(\omega_i\)</li>
|
|
</ul>
|
|
|
|
<div class="important" id="org6359915">
|
|
<p>
|
|
For each frequency point \(\omega_i\), the FRF matrix <code>FRFs_O</code> is a \(n\times p\) matrix:
|
|
</p>
|
|
\begin{equation}
|
|
\text{FRF}_\text{O}(\omega_i) = \begin{bmatrix}
|
|
\frac{D_{1,T_x}}{F_x}(\omega_i) & \frac{D_{1,T_x}}{F_y}(\omega_i) & \frac{D_{1,T_x}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,T_y}}{F_x}(\omega_i) & \frac{D_{1,T_y}}{F_y}(\omega_i) & \frac{D_{1,T_y}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,T_z}}{F_x}(\omega_i) & \frac{D_{1,T_z}}{F_y}(\omega_i) & \frac{D_{1,T_z}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,R_x}}{F_x}(\omega_i) & \frac{D_{1,R_x}}{F_y}(\omega_i) & \frac{D_{1,R_x}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,R_y}}{F_x}(\omega_i) & \frac{D_{1,R_y}}{F_y}(\omega_i) & \frac{D_{1,R_y}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,R_z}}{F_x}(\omega_i) & \frac{D_{1,R_z}}{F_y}(\omega_i) & \frac{D_{1,R_z}}{F_z}(\omega_i) \\
|
|
\frac{D_{2,T_x}}{F_x}(\omega_i) & \frac{D_{2,T_x}}{F_y}(\omega_i) & \frac{D_{2,T_x}}{F_z}(\omega_i) \\
|
|
\vdots & \vdots & \vdots \\
|
|
\frac{D_{6,R_z}}{F_x}(\omega_i) & \frac{D_{6,R_z}}{F_y}(\omega_i) & \frac{D_{6,R_z}}{F_z}(\omega_i)
|
|
\end{bmatrix}
|
|
\end{equation}
|
|
<p>
|
|
where \(D_i\) corresponds to the solid body number i.
|
|
</p>
|
|
|
|
</div>
|
|
|
|
<p>
|
|
Then, as we know the positions of the accelerometers on each solid body, and we have the response of those accelerometers, we can use the equations derived in the previous section to determine the response of each solid body expressed in the frame \(\{O\}\).
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">FRFs_O = zeros(length(solid_names)<span class="org-type">*</span>6, 3, 801);
|
|
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">solid_i</span> = <span class="org-constant">1:length(solid_names)</span>
|
|
solids_i = solids.(solid_names{solid_i});
|
|
|
|
A = zeros(3<span class="org-type">*</span>length(solids_i), 6);
|
|
<span class="org-keyword">for</span> <span class="org-variable-name"><span class="org-constant">i</span></span> = <span class="org-constant">1:length(solids_i)</span>
|
|
acc_i = solids_i(<span class="org-constant">i</span>);
|
|
|
|
A(3<span class="org-type">*</span>(<span class="org-constant">i</span><span class="org-type">-</span>1)<span class="org-type">+</span>1<span class="org-type">:</span>3<span class="org-type">*</span><span class="org-constant">i</span>, 1<span class="org-type">:</span>3) = eye(3);
|
|
A(3<span class="org-type">*</span>(<span class="org-constant">i</span><span class="org-type">-</span>1)<span class="org-type">+</span>1<span class="org-type">:</span>3<span class="org-type">*</span><span class="org-constant">i</span>, 4<span class="org-type">:</span>6) = [ 0 acc_pos(acc_i, 3) <span class="org-type">-</span>acc_pos(acc_i, 2) ;
|
|
<span class="org-type">-</span>acc_pos(acc_i, 3) 0 acc_pos(acc_i, 1) ;
|
|
acc_pos(acc_i, 2) <span class="org-type">-</span>acc_pos(acc_i, 1) 0];
|
|
<span class="org-keyword">end</span>
|
|
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">exc_dir</span> = <span class="org-constant">1:3</span>
|
|
FRFs_O((solid_i<span class="org-type">-</span>1)<span class="org-type">*</span>6<span class="org-type">+</span>1<span class="org-type">:</span>solid_i<span class="org-type">*</span>6, exc_dir, <span class="org-type">:</span>) = A<span class="org-type">\</span>squeeze(FRFs((solids_i(1)<span class="org-type">-</span>1)<span class="org-type">*</span>3<span class="org-type">+</span>1<span class="org-type">:</span>solids_i(end)<span class="org-type">*</span>3, exc_dir, <span class="org-type">:</span>));
|
|
<span class="org-keyword">end</span>
|
|
<span class="org-keyword">end</span>
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3164705" class="outline-3">
|
|
<h3 id="org3164705"><span class="section-number-3">4.2</span> Analysis of some FRF in the global coordinates</h3>
|
|
<div class="outline-text-3" id="text-4-2">
|
|
<p>
|
|
First, we can compare the motions of the 6 solid bodies in one direction (figure <a href="#orgcfb02aa">2</a>)
|
|
</p>
|
|
|
|
<p>
|
|
We can also compare all the DOFs of one solid body (figure <a href="#orga3b7df3">3</a>).
|
|
</p>
|
|
|
|
|
|
<div id="orgcfb02aa" class="figure">
|
|
<p><img src="figs/frf_all_bodies_one_direction.png" alt="frf_all_bodies_one_direction.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 2: </span>FRFs of all the 6 solid bodies in one direction</p>
|
|
</div>
|
|
|
|
|
|
<div id="orga3b7df3" class="figure">
|
|
<p><img src="figs/frf_one_body_all_directions.png" alt="frf_one_body_all_directions.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 3: </span>FRFs of one solid body in all its DOFs</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org2faadba" class="outline-3">
|
|
<h3 id="org2faadba"><span class="section-number-3">4.3</span> Comparison of the relative motion of solid bodies</h3>
|
|
<div class="outline-text-3" id="text-4-3">
|
|
<p>
|
|
Now that the motion of all the solid bodies are expressed in the same frame, we should be able to <b>compare them</b>.
|
|
This can be used to determine what joints direction between two solid bodies is stiff enough that we can fix this DoF.
|
|
This could help reduce the order of the model and simplify the extraction of the model parameters from the measurements.
|
|
</p>
|
|
|
|
<p>
|
|
We decide to plot the “normalized relative motion” between solid bodies \(i\) and \(j\):
|
|
\[ 0 < \Delta_{ij, x} = \frac{\left| |D_{i,x}| - |D_{j,x}| \right|}{|D_{i,x}| + |D_{j,x}|} < 1 \]
|
|
</p>
|
|
|
|
<p>
|
|
Then, if \(\Delta_{ij,x} \ll 1\) in the frequency band of interest, we have that \(D_{ix} \approx D_{jx}\) and we can neglect that DOF between the two solid bodies \(i\) and \(j\).
|
|
</p>
|
|
|
|
<p>
|
|
This normalized relative motion is shown on figure <a href="#org37e640c">4</a> for all the directions and for all the adjacent pair of solid bodies.
|
|
</p>
|
|
|
|
|
|
<div id="org37e640c" class="figure">
|
|
<p><img src="figs/relative_motion_comparison.png" alt="relative_motion_comparison.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 4: </span>Relative motion between each stage</p>
|
|
</div>
|
|
|
|
<div class="warning" id="org2160a28">
|
|
<p>
|
|
Can we really compare the motion of two solid bodies from Frequency Response Functions that clearly depends on the excitation point and direction?
|
|
The relative motion of two solid bodies may be negligible when exciting the structure at on point and but at another point.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgefe4113" class="outline-3">
|
|
<h3 id="orgefe4113"><span class="section-number-3">4.4</span> Verify that we find the original FRF from the FRF in the global coordinates</h3>
|
|
<div class="outline-text-3" id="text-4-4">
|
|
<p>
|
|
We have computed the Frequency Response Functions Matrix <code>FRFs_O</code> representing the response of the 6 solid bodies in their 6 DOFs with respect to the frame \(\{O\}\).
|
|
</p>
|
|
|
|
<p>
|
|
From the response of one body in its 6 DOFs, we should be able to compute the FRF of each of its accelerometer fixed to it during the measurement, supposing that the stage is a solid body.
|
|
</p>
|
|
|
|
<p>
|
|
We can then compare the result with the original measurements.
|
|
This will help us to determine if:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>the previous inversion used is correct</li>
|
|
<li>the solid body assumption is correct in the frequency band of interest</li>
|
|
</ul>
|
|
|
|
<p>
|
|
From the translation \(\delta p\) and rotation \(\delta \Omega\) of a solid body and the positions \(p_i\) of the accelerometers attached to it, we can compute the response that would have been measured by the accelerometers using the following formula:
|
|
</p>
|
|
\begin{align*}
|
|
\delta p_1 &= \delta p + \delta\Omega p_1\\
|
|
\delta p_2 &= \delta p + \delta\Omega p_2\\
|
|
\delta p_3 &= \delta p + \delta\Omega p_3\\
|
|
\delta p_4 &= \delta p + \delta\Omega p_4
|
|
\end{align*}
|
|
|
|
<p>
|
|
Thus, we can obtain the FRF matrix <code>FRFs_A</code> that gives the responses of the accelerometers to the forces applied by the hammer.
|
|
</p>
|
|
|
|
<p>
|
|
It is implemented in matlab as follow:
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">FRFs_A = zeros(size(FRFs));
|
|
|
|
<span class="org-comment">% For each excitation direction</span>
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">exc_dir</span> = <span class="org-constant">1:3</span>
|
|
<span class="org-comment">% For each solid</span>
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">solid_i</span> = <span class="org-constant">1:length(solid_names)</span>
|
|
v0 = squeeze(FRFs_O((solid_i<span class="org-type">-</span>1)<span class="org-type">*</span>6<span class="org-type">+</span>1<span class="org-type">:</span>(solid_i<span class="org-type">-</span>1)<span class="org-type">*</span>6<span class="org-type">+</span>3, exc_dir, <span class="org-type">:</span>));
|
|
W0 = squeeze(FRFs_O((solid_i<span class="org-type">-</span>1)<span class="org-type">*</span>6<span class="org-type">+</span>4<span class="org-type">:</span>(solid_i<span class="org-type">-</span>1)<span class="org-type">*</span>6<span class="org-type">+</span>6, exc_dir, <span class="org-type">:</span>));
|
|
|
|
<span class="org-comment">% For each accelerometer attached to the current solid</span>
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">acc_i</span> = <span class="org-constant">solids.(solid_names{solid_i})</span>
|
|
<span class="org-comment">% We get the position of the accelerometer expressed in frame O</span>
|
|
pos = acc_pos(acc_i, <span class="org-type">:</span>)<span class="org-type">.'</span>;
|
|
posX = [0 pos(3) <span class="org-type">-</span>pos(2); <span class="org-type">-</span>pos(3) 0 pos(1) ; pos(2) <span class="org-type">-</span>pos(1) 0];
|
|
|
|
FRFs_A(3<span class="org-type">*</span>(acc_i<span class="org-type">-</span>1)<span class="org-type">+</span>1<span class="org-type">:</span>3<span class="org-type">*</span>(acc_i<span class="org-type">-</span>1)<span class="org-type">+</span>3, exc_dir, <span class="org-type">:</span>) = v0 <span class="org-type">+</span> posX<span class="org-type">*</span>W0;
|
|
<span class="org-keyword">end</span>
|
|
<span class="org-keyword">end</span>
|
|
<span class="org-keyword">end</span>
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
We then compare the original FRF measured for each accelerometer <code>FRFs</code> with the “recovered” FRF <code>FRFs_A</code> from the global FRF matrix in the common frame.
|
|
</p>
|
|
|
|
<p>
|
|
The FRF for the 4 accelerometers on the Hexapod are compared on figure <a href="#orgbfa953f">5</a>.
|
|
All the FRF are matching very well in all the frequency range displayed.
|
|
</p>
|
|
|
|
<p>
|
|
The FRF for accelerometers located on the translation stage are compared on figure <a href="#orgeae40b9">6</a>.
|
|
The FRF are matching well until 100Hz.
|
|
</p>
|
|
|
|
|
|
<div id="orgbfa953f" class="figure">
|
|
<p><img src="figs/recovered_frf_comparison_hexa.png" alt="recovered_frf_comparison_hexa.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 5: </span>Comparison of the original FRF with the recovered ones - Hexapod</p>
|
|
</div>
|
|
|
|
|
|
<div id="orgeae40b9" class="figure">
|
|
<p><img src="figs/recovered_frf_comparison_ty.png" alt="recovered_frf_comparison_ty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 6: </span>Comparison of the original FRF with the recovered ones - Ty</p>
|
|
</div>
|
|
|
|
|
|
<div class="important" id="org8db91c3">
|
|
<p>
|
|
The reduction of the number of degrees of freedom from 69 (23 accelerometers with each 3DOF) to 36 (6 solid bodies with 6 DOF) seems to work well.
|
|
</p>
|
|
|
|
<p>
|
|
This confirms the fact that the stages are indeed behaving as a solid body in the frequency band of interest.
|
|
This valid the fact that a multi-body model can be used to represent the dynamics of the micro-station.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgc0f4ff6" class="outline-3">
|
|
<h3 id="orgc0f4ff6"><span class="section-number-3">4.5</span> Saving of the FRF expressed in the global coordinates</h3>
|
|
<div class="outline-text-3" id="text-4-5">
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">save(<span class="org-string">'mat/frf_o.mat'</span>, <span class="org-string">'FRFs_O'</span>);
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org6014915" class="outline-2">
|
|
<h2 id="org6014915"><span class="section-number-2">5</span> FRF expressed in a frame centered at the CoM of each solid body</h2>
|
|
<div class="outline-text-2" id="text-5">
|
|
</div>
|
|
<div id="outline-container-orgc5b91ab" class="outline-3">
|
|
<h3 id="orgc5b91ab"><span class="section-number-3">5.1</span> Center of Mass of each solid body</h3>
|
|
<div class="outline-text-3" id="text-5-1">
|
|
<p>
|
|
From solidworks, we can export the position of the center of mass of each solid body considered.
|
|
</p>
|
|
|
|
<p>
|
|
For that, we have to suppose density of the materials.
|
|
We then process the exported file.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-bash">sed -e <span class="org-string">'1,/^Center of mass/ d'</span> mat/1_granite_bot.txt | sed 3q | sed <span class="org-string">'s/^\s*\t*[XYZ] = \([-0-9.]*\)\r/\1/'</span> > mat/model_solidworks_com.txt
|
|
sed -e <span class="org-string">'1,/^Center of mass/ d'</span> mat/2_granite_top.txt | sed 3q | sed <span class="org-string">'s/^\s*\t*[XYZ] = \([-0-9.]*\)\r/\1/'</span> >> mat/model_solidworks_com.txt
|
|
sed -e <span class="org-string">'1,/^Center of mass/ d'</span> mat/3_ty.txt | sed 3q | sed <span class="org-string">'s/^\s*\t*[XYZ] = \([-0-9.]*\)\r/\1/'</span> >> mat/model_solidworks_com.txt
|
|
sed -e <span class="org-string">'1,/^Center of mass/ d'</span> mat/4_ry.txt | sed 3q | sed <span class="org-string">'s/^\s*\t*[XYZ] = \([-0-9.]*\)\r/\1/'</span> >> mat/model_solidworks_com.txt
|
|
sed -e <span class="org-string">'1,/^Center of mass/ d'</span> mat/5_rz.txt | sed 3q | sed <span class="org-string">'s/^\s*\t*[XYZ] = \([-0-9.]*\)\r/\1/'</span> >> mat/model_solidworks_com.txt
|
|
sed -e <span class="org-string">'1,/^Center of mass/ d'</span> mat/6_hexa.txt | sed 3q | sed <span class="org-string">'s/^\s*\t*[XYZ] = \([-0-9.]*\)\r/\1/'</span> >> mat/model_solidworks_com.txt
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we import the Center of mass on Matlab.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">model_com = table2array(readtable(<span class="org-string">'mat/model_solidworks_com.txt'</span>, <span class="org-string">'ReadVariableNames'</span>, <span class="org-constant">false</span>));
|
|
</pre>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">model_com = reshape(model_com , [3, 6]);
|
|
</pre>
|
|
</div>
|
|
|
|
<table border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
|
|
|
|
<colgroup>
|
|
<col class="org-left" />
|
|
|
|
<col class="org-right" />
|
|
|
|
<col class="org-right" />
|
|
|
|
<col class="org-right" />
|
|
|
|
<col class="org-right" />
|
|
|
|
<col class="org-right" />
|
|
|
|
<col class="org-right" />
|
|
</colgroup>
|
|
<thead>
|
|
<tr>
|
|
<th scope="col" class="org-left"> </th>
|
|
<th scope="col" class="org-right">granite bot</th>
|
|
<th scope="col" class="org-right">granite top</th>
|
|
<th scope="col" class="org-right">ty</th>
|
|
<th scope="col" class="org-right">ry</th>
|
|
<th scope="col" class="org-right">rz</th>
|
|
<th scope="col" class="org-right">hexa</th>
|
|
</tr>
|
|
</thead>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">X [mm]</td>
|
|
<td class="org-right">45</td>
|
|
<td class="org-right">52</td>
|
|
<td class="org-right">0</td>
|
|
<td class="org-right">0</td>
|
|
<td class="org-right">0</td>
|
|
<td class="org-right">-4</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Y [mm]</td>
|
|
<td class="org-right">144</td>
|
|
<td class="org-right">258</td>
|
|
<td class="org-right">14</td>
|
|
<td class="org-right">-5</td>
|
|
<td class="org-right">0</td>
|
|
<td class="org-right">6</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Z [mm]</td>
|
|
<td class="org-right">-1251</td>
|
|
<td class="org-right">-778</td>
|
|
<td class="org-right">-600</td>
|
|
<td class="org-right">-628</td>
|
|
<td class="org-right">-580</td>
|
|
<td class="org-right">-319</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org9ea4330" class="outline-3">
|
|
<h3 id="org9ea4330"><span class="section-number-3">5.2</span> From accelerometer DOFs to solid body DOFs - Expressed at the CoM</h3>
|
|
<div class="outline-text-3" id="text-5-2">
|
|
<p>
|
|
First, we initialize a new FRF matrix <code>FRFs_CoM</code> which is an \(n \times p \times q\) with:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(n\) is the number of DOFs of the considered 6 solid-bodies: \(6 \times 6 = 36\)</li>
|
|
<li>\(p\) is the number of excitation inputs: \(3\)</li>
|
|
<li>\(q\) is the number of frequency points \(\omega_i\)</li>
|
|
</ul>
|
|
|
|
<div class="important" id="org273c410">
|
|
<p>
|
|
For each frequency point \(\omega_i\), the FRF matrix <code>FRFs_CoM</code> is a \(n\times p\) matrix:
|
|
</p>
|
|
\begin{equation}
|
|
\text{FRF}_\text{CoM}(\omega_i) = \begin{bmatrix}
|
|
\frac{D_{1,T_x}}{F_x}(\omega_i) & \frac{D_{1,T_x}}{F_y}(\omega_i) & \frac{D_{1,T_x}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,T_y}}{F_x}(\omega_i) & \frac{D_{1,T_y}}{F_y}(\omega_i) & \frac{D_{1,T_y}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,T_z}}{F_x}(\omega_i) & \frac{D_{1,T_z}}{F_y}(\omega_i) & \frac{D_{1,T_z}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,R_x}}{F_x}(\omega_i) & \frac{D_{1,R_x}}{F_y}(\omega_i) & \frac{D_{1,R_x}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,R_y}}{F_x}(\omega_i) & \frac{D_{1,R_y}}{F_y}(\omega_i) & \frac{D_{1,R_y}}{F_z}(\omega_i) \\
|
|
\frac{D_{1,R_z}}{F_x}(\omega_i) & \frac{D_{1,R_z}}{F_y}(\omega_i) & \frac{D_{1,R_z}}{F_z}(\omega_i) \\
|
|
\frac{D_{2,T_x}}{F_x}(\omega_i) & \frac{D_{2,T_x}}{F_y}(\omega_i) & \frac{D_{2,T_x}}{F_z}(\omega_i) \\
|
|
\vdots & \vdots & \vdots \\
|
|
\frac{D_{6,R_z}}{F_x}(\omega_i) & \frac{D_{6,R_z}}{F_y}(\omega_i) & \frac{D_{6,R_z}}{F_z}(\omega_i)
|
|
\end{bmatrix}
|
|
\end{equation}
|
|
<p>
|
|
where 1, 2, …, 6 corresponds to the 6 solid bodies.
|
|
</p>
|
|
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">FRFs_CoM = zeros(length(solid_names)<span class="org-type">*</span>6, 3, 801);
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Then, as we know the positions of the accelerometers on each solid body, and we have the response of those accelerometers, we can use the equations derived in the previous section to determine the response of each solid body expressed in the frame \(\{O\}\).
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-keyword">for</span> <span class="org-variable-name">solid_i</span> = <span class="org-constant">1:length(solid_names)</span>
|
|
solids_i = solids.(solid_names{solid_i});
|
|
|
|
A = zeros(3<span class="org-type">*</span>length(solids_i), 6);
|
|
<span class="org-keyword">for</span> <span class="org-variable-name"><span class="org-constant">i</span></span> = <span class="org-constant">1:length(solids_i)</span>
|
|
acc_i = solids_i(<span class="org-constant">i</span>);
|
|
|
|
acc_pos_com = acc_pos(acc_i, <span class="org-type">:</span>)<span class="org-type">.'</span> <span class="org-type">-</span> model_com(<span class="org-type">:</span>, solid_i);
|
|
|
|
A(3<span class="org-type">*</span>(<span class="org-constant">i</span><span class="org-type">-</span>1)<span class="org-type">+</span>1<span class="org-type">:</span>3<span class="org-type">*</span><span class="org-constant">i</span>, 1<span class="org-type">:</span>3) = eye(3);
|
|
A(3<span class="org-type">*</span>(<span class="org-constant">i</span><span class="org-type">-</span>1)<span class="org-type">+</span>1<span class="org-type">:</span>3<span class="org-type">*</span><span class="org-constant">i</span>, 4<span class="org-type">:</span>6) = [ 0 acc_pos_com(3) <span class="org-type">-</span>acc_pos_com(2) ;
|
|
<span class="org-type">-</span>acc_pos_com(3) 0 acc_pos_com(1) ;
|
|
acc_pos_com<span class="org-type">(2) -acc_pos_com(1) 0];</span>
|
|
<span class="org-keyword">end</span>
|
|
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">exc_dir</span> = <span class="org-constant">1:3</span>
|
|
FRFs_CoM((solid_i<span class="org-type">-</span>1)<span class="org-type">*</span>6<span class="org-type">+</span>1<span class="org-type">:</span>solid_i<span class="org-type">*</span>6, exc_dir, <span class="org-type">:</span>) = A<span class="org-type">\</span>squeeze(FRFs((solids_i(1)<span class="org-type">-</span>1)<span class="org-type">*</span>3<span class="org-type">+</span>1<span class="org-type">:</span>solids_i(end)<span class="org-type">*</span>3, exc_dir, <span class="org-type">:</span>));
|
|
<span class="org-keyword">end</span>
|
|
<span class="org-keyword">end</span>
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orga333d35" class="outline-3">
|
|
<h3 id="orga333d35"><span class="section-number-3">5.3</span> Analysis of some FRF</h3>
|
|
<div class="outline-text-3" id="text-5-3">
|
|
|
|
<div id="org5b77e73" class="figure">
|
|
<p><img src="figs/frf_com_all_bodies_one_direction.png" alt="frf_com_all_bodies_one_direction.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 7: </span>FRFs of all the 6 solid bodies in one direction</p>
|
|
</div>
|
|
|
|
|
|
<div id="org9db1fa9" class="figure">
|
|
<p><img src="figs/frf_com_one_body_all_directions.png" alt="frf_com_one_body_all_directions.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 8: </span>FRFs of one solid body in all its DOFs (expressed with a frame centered with its center of mass)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org52ce77b" class="outline-3">
|
|
<h3 id="org52ce77b"><span class="section-number-3">5.4</span> Save the FRF</h3>
|
|
<div class="outline-text-3" id="text-5-4">
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">save(<span class="org-string">'mat/frf_com.mat'</span>, <span class="org-string">'FRFs_CoM'</span>);
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
<p>
|
|
|
|
<a href="ref.bib">ref.bib</a>
|
|
</p>
|
|
</div>
|
|
<div id="postamble" class="status">
|
|
<p class="author">Author: Dehaeze Thomas</p>
|
|
<p class="date">Created: 2020-11-12 jeu. 10:29</p>
|
|
</div>
|
|
</body>
|
|
</html>
|