sf-mx/PBSwissMX
0
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

wip

Browse Source
This commit is contained in:
zamofing_t
2019-01-31 16:36:05 +01:00
parent 0d0eb2fe7a
commit 5e9bc4e4c0
3 changed files with 105 additions and 50 deletions
Download Patch File Download Diff File Expand all files Collapse all files

69
python/MXTuningDoc/fastStageTune.tex
View File

@@ -177,21 +177,21 @@ $s \cdot iqMeas =\frac{1}{L}iqVolts - \frac{R}{L}iqMeas$\\
Input: Force $u(t)=F$\\
Output: Position $y(t)=x_1(t)$\\
total mass $m=m_1+m_2+\ldots+m_n$\\
damping: $d_1 \ldots d_n$\\
springs: $k_1 \ldots k_n$\\
mass $m=m_1+m_2+\ldots+m_n$\\
damping: $d=d_1+d_2+\ldots+d_n$\\
springs: $k=k_1+k_2+\ldots+k_n$\\
\eqref{mech1} shows the mechanical differential equations:
\begin{equation}
\begin{aligned}
m_1\ddot{x}_1 = & u(t) -k_1x_1-d_1\dot{x}_1\\
& + k_2x_2+d_2\dot{x}_2
+ k_3x_3+d_3\dot{x}_3
+ k_4x_4+d_4\dot{x}_4\\
m_2\ddot{x}_2= & -k_2x_2-d_2\dot{x}_2\\
m_3\ddot{x}_3= & -k_3x_3-d_3\dot{x}_3\\
m_4\ddot{x}_4= & -k_4x_4-d_4\dot{x}_4\\
& + k_2(x_2-x_1)+d_2(\dot{x}_2-\dot{x}_1)
+ k_3(x_3-x_1)+d_3(\dot{x}_3-\dot{x}_1)
+ k_4(x_4-x_1)+d_4(\dot{x}_4-\dot{x}_1)\\
m_2\ddot{x}_2= & k_2(x_2-x_1)+d_2(\dot{x}_2-\dot{x}_1)\\
m_3\ddot{x}_3= & k_3(x_3-x_1)+d_3(\dot{x}_3-\dot{x}_1)\\
m_4\ddot{x}_4= & k_4(x_4-x_1)+d_4(\dot{x}_4-\dot{x}_1)\\
\end{aligned}\label{mech1}
\end{equation}
@@ -230,19 +230,19 @@ x_4\\
A=
\begin{bmatrix}
0 & 1 & 0 & 0 & 0 & 0 & 0 & 0\\
-\frac{k_1}{m_1} & -\frac{d_1}{m_1} & -\frac{k_2}{m_1} & -\frac{d_2}{m_1} & -\frac{k_3}{m_1} & -\frac{d_3}{m_1} & -\frac{k_4}{m_1} & -\frac{d_4}{m_1}\\
-\frac{k}{m_1} & -\frac{d}{m_1} & \frac{k_2}{m_1} & \frac{d_2}{m_1} & \frac{k_3}{m_1} & \frac{d_3}{m_1} & \frac{k_4}{m_1} & \frac{d_4}{m_1}\\
0 & 0 & 0 & 1 & 0 & 0 & 0 & 0\\
0 & 0 & -\frac{k_2}{m_1} & -\frac{d_2}{m_2} & 0 & 0 & 0 & 0 \\
-\frac{k_1}{m_2} & -\frac{d_1}{m_2} & \frac{k_2}{m_2} & \frac{d_2}{m_2} & 0 & 0 & 0 & 0 \\
0 & 0 & 0 & 0 & 0 & 1 & 0 & 0\\
0 & 0 & 0 & 0 & -\frac{k_3}{m_1} & -\frac{d_3}{m_3} & 0 & 0 \\
-\frac{k_1}{m_3} & -\frac{d_1}{m_3} & 0 & 0 & \frac{k_3}{m_1} & \frac{d_3}{m_3} & 0 & 0 \\
0 & 0 & 0 & 0 & 0 & 0 & 0 & 1\\
0 & 0 & 0 & 0 & 0 & 0 & -\frac{k_4}{m_1} & -\frac{d_4}{m_4} \\
-\frac{k_1}{m_4} & -\frac{d_1}{m_4} & 0 & 0 & 0 & 0 & \frac{k_4}{m_1} & \frac{d_4}{m_4} \\
\end{bmatrix},\quad
B=\begin{bmatrix}
\frac{1}{m} \\ 0 \\ 0 \\ 0 \\ 0 \\ 0 \\ 0 \\ 0\\
\frac{1}{m_1} \\ 0 \\ 0 \\ 0 \\ 0 \\ 0 \\ 0 \\ 0\\
\end{bmatrix}
%,\quad
%C=\begin{bmatrix}
@@ -252,10 +252,51 @@ B=\begin{bmatrix}
\label{mech2}
\end{equation}
\subsection{Stage data}
This data comes from datasheets and construction information [biblio: 'Dynamics of Parker Stage', Wayne Glettig 5.12.2018].
\begin{tabular}{|r|l|}
\hline
Stage Y mass& 340g \\
Stage X mass& 950g \\
Interferometer mirrors & 51g (additional)\\
Aluminun (instead ABS) & 42g (additional)\\
\hline
\end{tabular}
\vspace{1pc}
\begin{tabular}{|r|c|l|}
\hline
Continous force && 5.51N \\
Peak force && 12N \\
Static friction && 1N\\
Viscose damping && 0.5N$\cdot$s/m\\
Motor constant &Km& 1.46N/$\sqrt{watt}$\\
Resistance &R&8.8$\Omega$\\
Inductance &L& 2.4mH\\
\hline
\end{tabular}
\vspace{1pc}
The data in the data sheet are quite confusing. But lets check the motor Konstant Km.\\
The data sheet says:\\
Stall Current Continous 0.92A, Stall force Continous 4N
\[
U=R\cdot I \qquad P=U \cdot I \quad \rightarrow \quad P=R \cdot I^2\\
\]
at a constant current of 0.92A we have $ 8.8 \cdot 0.92^2 = 7.44 $W the resulting force will be:\\
$1.46N \cdot \sqrt{7.44} = 3.98 N$
\section{Simulink/MATLAB simulations}
TODO: describe the identification process to get a model out of the bode plots. identifyFxFyStage.m\\
Simulink simulation \verb|stage_closed_loop.slx| with \verb|ServoDeltaTau_z G(z)| showed similar response
Therefore the model seems good enough

46
python/MXTuningDoc/model.svg
View File

@@ -484,11 +484,11 @@
borderopacity="1.0"
inkscape:pageopacity="0.0"
inkscape:pageshadow="2"
inkscape:zoom="1.3997821"
inkscape:cx="159.66739"
inkscape:cy="505.01076"
inkscape:zoom="1.9795908"
inkscape:cx="227.4925"
inkscape:cy="145.89617"
inkscape:document-units="mm"
inkscape:current-layer="layer1"
inkscape:current-layer="g4751"
showgrid="true"
inkscape:snap-grids="false"
inkscape:snap-nodes="true"
@@ -836,8 +836,9 @@
<path
inkscape:connector-curvature="0"
id="path5980"
d="m 254.80827,948.57917 0,67.49783"
style="fill:none;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1" />
d="m 254.80827,948.57917 0,24.08103"
style="fill:none;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
sodipodi:nodetypes="cc" />
<path
inkscape:connector-curvature="0"
id="path4470"
@@ -846,19 +847,21 @@
<path
inkscape:connector-curvature="0"
id="path4484"
d="m 191.75406,967.95427 62.55421,0"
style="color:#000000;clip-rule:nonzero;display:inline;overflow:visible;visibility:visible;opacity:1;isolation:auto;mix-blend-mode:normal;color-interpolation:sRGB;color-interpolation-filters:linearRGB;solid-color:#000000;solid-opacity:1;fill:none;fill-opacity:1;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-dasharray:none;stroke-dashoffset:0;stroke-opacity:1;marker-end:url(#arrowSimple-3);color-rendering:auto;image-rendering:auto;shape-rendering:auto;text-rendering:auto;enable-background:accumulate" />
d="m 154.7927,967.95427 99.51557,0"
style="color:#000000;clip-rule:nonzero;display:inline;overflow:visible;visibility:visible;opacity:1;isolation:auto;mix-blend-mode:normal;color-interpolation:sRGB;color-interpolation-filters:linearRGB;solid-color:#000000;solid-opacity:1;fill:none;fill-opacity:1;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-dasharray:none;stroke-dashoffset:0;stroke-opacity:1;marker-end:url(#arrowSimple-3);color-rendering:auto;image-rendering:auto;shape-rendering:auto;text-rendering:auto;enable-background:accumulate"
sodipodi:nodetypes="cc" />
<path
sodipodi:nodetypes="cc"
style="color:#000000;clip-rule:nonzero;display:inline;overflow:visible;visibility:visible;opacity:1;isolation:auto;mix-blend-mode:normal;color-interpolation:sRGB;color-interpolation-filters:linearRGB;solid-color:#000000;solid-opacity:1;fill:none;fill-opacity:1;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-dasharray:none;stroke-dashoffset:0;stroke-opacity:1;marker-end:url(#arrowSimple-3);color-rendering:auto;image-rendering:auto;shape-rendering:auto;text-rendering:auto;enable-background:accumulate"
d="m 254.80827,979.73237 137.92308,0"
d="m 154.7927,992.8664 237.93865,0"
id="path4969"
inkscape:connector-curvature="0" />
<path
style="fill:none;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
d="m 392.94434,943.38767 0,67.49793"
style="fill:none;fill-rule:evenodd;stroke:#000000;stroke-width:0.99921262;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1;stroke-miterlimit:4;stroke-dasharray:1.99842525,0.99921262;stroke-dashoffset:0"
d="m 392.94434,726.17106 0,284.71454"
id="path4971"
inkscape:connector-curvature="0" />
inkscape:connector-curvature="0"
sodipodi:nodetypes="cc" />
<text
sodipodi:linespacing="125%"
id="text4973"
@@ -885,21 +888,26 @@
id="tspan4987">1</tspan></tspan></text>
<text
xml:space="preserve"
style="font-style:normal;font-weight:normal;font-size:15px;line-height:125%;font-family:sans-serif;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1;-inkscape-font-specification:sans-serif;font-stretch:normal;font-variant:normal;"
style="font-style:normal;font-variant:normal;font-weight:normal;font-stretch:normal;font-size:15px;line-height:125%;font-family:sans-serif;-inkscape-font-specification:sans-serif;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
x="305.91394"
y="993.18329"
y="1006.3173"
id="text4989"
sodipodi:linespacing="125%"><tspan
sodipodi:role="line"
id="tspan4991"
x="305.91394"
y="993.18329">x<tspan
id="tspan5012"
style="font-size:64.99999762%;baseline-shift:sub;-inkscape-font-specification:sans-serif;font-family:sans-serif;font-weight:normal;font-style:normal;font-stretch:normal;font-variant:normal;">1</tspan>, x<tspan
y="1006.3173">x<tspan
style="font-size:64.99999762%;baseline-shift:sub"
id="tspan4540">2</tspan>, x<tspan
id="tspan5010"
style="font-size:64.99999762%;baseline-shift:sub;-inkscape-font-specification:sans-serif;font-family:sans-serif;font-weight:normal;font-style:normal;font-stretch:normal;font-variant:normal;">2</tspan>, x<tspan
style="font-style:normal;font-variant:normal;font-weight:normal;font-stretch:normal;font-size:64.99999762%;font-family:sans-serif;-inkscape-font-specification:sans-serif;baseline-shift:sub">3</tspan>, x<tspan
id="tspan5007"
style="font-size:64.99999762%;baseline-shift:sub;-inkscape-font-specification:sans-serif;font-family:sans-serif;font-weight:normal;font-style:normal;font-stretch:normal;font-variant:normal;">3</tspan></tspan></text>
style="font-style:normal;font-variant:normal;font-weight:normal;font-stretch:normal;font-size:64.99999762%;font-family:sans-serif;-inkscape-font-specification:sans-serif;baseline-shift:sub">4</tspan></tspan></text>
<path
style="fill:none;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
d="m 154.7927,948.57917 0,67.49783"
id="path4542"
inkscape:connector-curvature="0" />
</g>
<text
xml:space="preserve"
Side by Side Swipe Overlay

Before

Width:  |  Height:  |  Size: 92 KiB

After

Width:  |  Height:  |  Size: 92 KiB

40
python/MXTuningDoc/model3.eps
View File

@@ -1,6 +1,6 @@
%!PS-Adobe-3.0 EPSF-3.0
%%Creator: cairo 1.14.6 (http://cairographics.org)
%%CreationDate: Thu Jan 31 11:12:41 2019
%%CreationDate: Thu Jan 31 14:55:02 2019
%%Pages: 1
%%DocumentData: Clean7Bit
%%LanguageLevel: 2
@@ -330,7 +330,7 @@ q 1 0 0 -1 0 260.706024 cm
0.8 w
0 J
q 1 0 0 -1 0 260.706024 cm
111.066 206.707 m 111.066 260.707 l S Q
111.066 206.707 m 111.066 225.973 l S Q
q 1 0 0 -1 0 260.706024 cm
0 48.539 m 65.656 48.539 l S Q
59.223 214.241 m 59.016 213.472 l 63.887 212.167 l 59.016 210.862 l 59.223
@@ -338,19 +338,21 @@ q 1 0 0 -1 0 260.706024 cm
h
59.223 214.241 m f*
q 1 0 0 -1 0 260.706024 cm
60.621 222.207 m 110.668 222.207 l S Q
31.055 222.207 m 110.668 222.207 l S Q
104.234 40.573 m 104.027 39.804 l 108.895 38.499 l 104.027 37.194 l 104.234
36.421 l 110.543 38.112 l 110.934 38.218 110.934 38.776 110.543 38.886
c h
104.234 40.573 m f*
q 1 0 0 -1 0 260.706024 cm
111.066 231.629 m 221.406 231.629 l S Q
214.973 31.151 m 214.766 30.382 l 219.633 29.077 l 214.766 27.772 l 214.973
26.999 l 221.281 28.69 l 221.672 28.796 221.672 29.354 221.281 29.46 c
h
214.973 31.151 m f*
31.055 242.137 m 221.406 242.137 l S Q
214.973 20.644 m 214.766 19.874 l 219.633 18.569 l 214.766 17.265 l 214.973
16.491 l 221.281 18.183 l 221.672 18.288 221.672 18.847 221.281 18.956
c h
214.973 20.644 m f*
0.79937 w
[ 1.59874 0.79937] 0 d
q 1 0 0 -1 0 260.706024 cm
221.574 202.555 m 221.574 256.555 l S Q
221.574 28.781 m 221.574 256.555 l S Q
BT
12 0 0 12 26.25318 216.363219 Tm
/f-0-0 1 Tf
@@ -359,19 +361,23 @@ BT
(x)Tj
7.8 0 0 7.8 81.486835 27.459117 Tm
(1)Tj
12 0 0 12 151.950616 18.314977 Tm
12 0 0 12 151.950616 7.80775 Tm
(x)Tj
7.8 0 0 7.8 159.052179 15.914977 Tm
(1)Tj
12 0 0 12 164.018585 18.314977 Tm
(, x)Tj
7.8 0 0 7.8 178.760773 15.914977 Tm
7.8 0 0 7.8 159.052179 5.40775 Tm
(2)Tj
12 0 0 12 183.727179 18.314977 Tm
12 0 0 12 164.018585 7.80775 Tm
(, x)Tj
7.8 0 0 7.8 198.469366 15.914977 Tm
7.8 0 0 7.8 178.760773 5.40775 Tm
(3)Tj
12 0 0 12 183.727179 7.80775 Tm
(, x)Tj
7.8 0 0 7.8 198.469366 5.40775 Tm
(4)Tj
ET
0.8 w
[] 0.0 d
q 1 0 0 -1 0 260.706024 cm
31.055 206.707 m 31.055 260.707 l S Q
Q Q
showpage
%%Trailer