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$\\ Input: Force $u(t)=F$\\
Output: Position $y(t)=x_1(t)$\\ Output: Position $y(t)=x_1(t)$\\
total mass $m=m_1+m_2+\ldots+m_n$\\ mass $m=m_1+m_2+\ldots+m_n$\\
damping: $d_1 \ldots d_n$\\ damping: $d=d_1+d_2+\ldots+d_n$\\
springs: $k_1 \ldots k_n$\\ springs: $k=k_1+k_2+\ldots+k_n$\\
\eqref{mech1} shows the mechanical differential equations: \eqref{mech1} shows the mechanical differential equations:
\begin{equation} \begin{equation}
\begin{aligned} \begin{aligned}
m_1\ddot{x}_1 = & u(t) -k_1x_1-d_1\dot{x}_1\\ m_1\ddot{x}_1 = & u(t) -k_1x_1-d_1\dot{x}_1\\
& + k_2x_2+d_2\dot{x}_2 & + k_2(x_2-x_1)+d_2(\dot{x}_2-\dot{x}_1)
+ k_3x_3+d_3\dot{x}_3 + k_3(x_3-x_1)+d_3(\dot{x}_3-\dot{x}_1)
+ k_4x_4+d_4\dot{x}_4\\ + k_4(x_4-x_1)+d_4(\dot{x}_4-\dot{x}_1)\\
m_2\ddot{x}_2= & -k_2x_2-d_2\dot{x}_2\\ 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_3x_3-d_3\dot{x}_3\\ 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_4x_4-d_4\dot{x}_4\\ m_4\ddot{x}_4= & k_4(x_4-x_1)+d_4(\dot{x}_4-\dot{x}_1)\\
\end{aligned}\label{mech1} \end{aligned}\label{mech1}
\end{equation} \end{equation}
@@ -230,19 +230,19 @@ x_4\\
A= A=
\begin{bmatrix} \begin{bmatrix}
0 & 1 & 0 & 0 & 0 & 0 & 0 & 0\\ 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 & 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 & 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 & 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 \end{bmatrix},\quad
B=\begin{bmatrix} 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} \end{bmatrix}
%,\quad %,\quad
%C=\begin{bmatrix} %C=\begin{bmatrix}
@@ -252,10 +252,51 @@ B=\begin{bmatrix}
\label{mech2} \label{mech2}
\end{equation} \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} \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 Simulink simulation \verb|stage_closed_loop.slx| with \verb|ServoDeltaTau_z G(z)| showed similar response
Therefore the model seems good enough Therefore the model seems good enough

46
python/MXTuningDoc/model.svg
View File

@@ -484,11 +484,11 @@
borderopacity="1.0" borderopacity="1.0"
inkscape:pageopacity="0.0" inkscape:pageopacity="0.0"
inkscape:pageshadow="2" inkscape:pageshadow="2"
inkscape:zoom="1.3997821" inkscape:zoom="1.9795908"
inkscape:cx="159.66739" inkscape:cx="227.4925"
inkscape:cy="505.01076" inkscape:cy="145.89617"
inkscape:document-units="mm" inkscape:document-units="mm"
inkscape:current-layer="layer1" inkscape:current-layer="g4751"
showgrid="true" showgrid="true"
inkscape:snap-grids="false" inkscape:snap-grids="false"
inkscape:snap-nodes="true" inkscape:snap-nodes="true"
@@ -836,8 +836,9 @@
<path <path
inkscape:connector-curvature="0" inkscape:connector-curvature="0"
id="path5980" id="path5980"
d="m 254.80827,948.57917 0,67.49783" 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" /> style="fill:none;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
sodipodi:nodetypes="cc" />
<path <path
inkscape:connector-curvature="0" inkscape:connector-curvature="0"
id="path4470" id="path4470"
@@ -846,19 +847,21 @@
<path <path
inkscape:connector-curvature="0" inkscape:connector-curvature="0"
id="path4484" id="path4484"
d="m 191.75406,967.95427 62.55421,0" 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" /> 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 <path
sodipodi:nodetypes="cc" 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" 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" id="path4969"
inkscape:connector-curvature="0" /> inkscape:connector-curvature="0" />
<path <path
style="fill:none;fill-rule:evenodd;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1" 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,943.38767 0,67.49793" d="m 392.94434,726.17106 0,284.71454"
id="path4971" id="path4971"
inkscape:connector-curvature="0" /> inkscape:connector-curvature="0"
sodipodi:nodetypes="cc" />
<text <text
sodipodi:linespacing="125%" sodipodi:linespacing="125%"
id="text4973" id="text4973"
@@ -885,21 +888,26 @@
id="tspan4987">1</tspan></tspan></text> id="tspan4987">1</tspan></tspan></text>
<text <text
xml:space="preserve" 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" x="305.91394"
y="993.18329" y="1006.3173"
id="text4989" id="text4989"
sodipodi:linespacing="125%"><tspan sodipodi:linespacing="125%"><tspan
sodipodi:role="line" sodipodi:role="line"
id="tspan4991" id="tspan4991"
x="305.91394" x="305.91394"
y="993.18329">x<tspan y="1006.3173">x<tspan
id="tspan5012" style="font-size:64.99999762%;baseline-shift:sub"
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 id="tspan4540">2</tspan>, x<tspan
id="tspan5010" 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" 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> </g>
<text <text
xml:space="preserve" 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 %!PS-Adobe-3.0 EPSF-3.0
%%Creator: cairo 1.14.6 (http://cairographics.org) %%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 %%Pages: 1
%%DocumentData: Clean7Bit %%DocumentData: Clean7Bit
%%LanguageLevel: 2 %%LanguageLevel: 2
@@ -330,7 +330,7 @@ q 1 0 0 -1 0 260.706024 cm
0.8 w 0.8 w
0 J 0 J
q 1 0 0 -1 0 260.706024 cm 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 q 1 0 0 -1 0 260.706024 cm
0 48.539 m 65.656 48.539 l S Q 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 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 h
59.223 214.241 m f* 59.223 214.241 m f*
q 1 0 0 -1 0 260.706024 cm 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 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 36.421 l 110.543 38.112 l 110.934 38.218 110.934 38.776 110.543 38.886
c h c h
104.234 40.573 m f* 104.234 40.573 m f*
q 1 0 0 -1 0 260.706024 cm q 1 0 0 -1 0 260.706024 cm
111.066 231.629 m 221.406 231.629 l S Q 31.055 242.137 m 221.406 242.137 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 214.973 20.644 m 214.766 19.874 l 219.633 18.569 l 214.766 17.265 l 214.973
26.999 l 221.281 28.69 l 221.672 28.796 221.672 29.354 221.281 29.46 c 16.491 l 221.281 18.183 l 221.672 18.288 221.672 18.847 221.281 18.956
h c h
214.973 31.151 m f* 214.973 20.644 m f*
0.79937 w
[ 1.59874 0.79937] 0 d
q 1 0 0 -1 0 260.706024 cm 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 BT
12 0 0 12 26.25318 216.363219 Tm 12 0 0 12 26.25318 216.363219 Tm
/f-0-0 1 Tf /f-0-0 1 Tf
@@ -359,19 +361,23 @@ BT
(x)Tj (x)Tj
7.8 0 0 7.8 81.486835 27.459117 Tm 7.8 0 0 7.8 81.486835 27.459117 Tm
(1)Tj (1)Tj
12 0 0 12 151.950616 18.314977 Tm 12 0 0 12 151.950616 7.80775 Tm
(x)Tj (x)Tj
7.8 0 0 7.8 159.052179 15.914977 Tm 7.8 0 0 7.8 159.052179 5.40775 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
(2)Tj (2)Tj
12 0 0 12 183.727179 18.314977 Tm 12 0 0 12 164.018585 7.80775 Tm
(, x)Tj (, 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 (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 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 Q Q
showpage showpage
%%Trailer %%Trailer