root/doc/xml/simul_8cpp.xml @ 224

Revision 187, 93.2 kB (checked in by smidl, 16 years ago)

doc

Line 
1<?xml version='1.0' encoding='UTF-8' standalone='no'?>
2<doxygen xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance" xsi:noNamespaceSchemaLocation="compound.xsd" version="1.5.6">
3  <compounddef id="simul_8cpp" kind="file">
4    <compoundname>simul.cpp</compoundname>
5    <includes local="no">stdio.h</includes>
6    <includes local="no">math.h</includes>
7    <includes refid="pmsm__mod_8h" local="yes">pmsm_mod.h</includes>
8    <includes refid="pwm_8h" local="yes">pwm.h</includes>
9    <includes refid="ekf__example_2regulace_8h" local="yes">regulace.h</includes>
10    <includes refid="ekf_8h" local="yes">ekf.h</includes>
11    <incdepgraph>
12      <node id="796">
13        <label>pwm.h</label>
14        <link refid="pwm_8h-source"/>
15      </node>
16      <node id="792">
17        <label>work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp</label>
18        <link refid="simul.cpp"/>
19        <childnode refid="793" relation="include">
20        </childnode>
21        <childnode refid="794" relation="include">
22        </childnode>
23        <childnode refid="795" relation="include">
24        </childnode>
25        <childnode refid="796" relation="include">
26        </childnode>
27        <childnode refid="797" relation="include">
28        </childnode>
29        <childnode refid="798" relation="include">
30        </childnode>
31      </node>
32      <node id="798">
33        <label>ekf.h</label>
34        <link refid="ekf_8h-source"/>
35      </node>
36      <node id="794">
37        <label>math.h</label>
38      </node>
39      <node id="797">
40        <label>regulace.h</label>
41        <link refid="ekf__example_2regulace_8h-source"/>
42      </node>
43      <node id="793">
44        <label>stdio.h</label>
45      </node>
46      <node id="795">
47        <label>pmsm_mod.h</label>
48        <link refid="pmsm__mod_8h-source"/>
49      </node>
50    </incdepgraph>
51      <sectiondef kind="define">
52      <memberdef kind="define" id="simul_8cpp_1c7349dbe5aa058842fbdb920d3d72573" prot="public" static="no">
53        <name>Qm</name>
54        <initializer>13</initializer>
55        <briefdescription>
56        </briefdescription>
57        <detaileddescription>
58        </detaileddescription>
59        <inbodydescription>
60        </inbodydescription>
61        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="21" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="21" bodyend="-1"/>
62      </memberdef>
63      <memberdef kind="define" id="simul_8cpp_1f83c88e49505c9c48e0aa425fb8dfa65" prot="public" static="no">
64        <name>CHYBA_POLOHY</name>
65        <initializer>(0./180.*M_PI)</initializer>
66        <briefdescription>
67        </briefdescription>
68        <detaileddescription>
69        </detaileddescription>
70        <inbodydescription>
71        </inbodydescription>
72        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="22" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="22" bodyend="-1"/>
73      </memberdef>
74      <memberdef kind="define" id="simul_8cpp_1e66bdf1fe9394f2b669d2b51e9ebb938" prot="public" static="no">
75        <name>MODULACE</name>
76        <initializer>1</initializer>
77        <briefdescription>
78        </briefdescription>
79        <detaileddescription>
80        </detaileddescription>
81        <inbodydescription>
82        </inbodydescription>
83        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="24" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="24" bodyend="-1"/>
84      </memberdef>
85      <memberdef kind="define" id="simul_8cpp_19cd91cdba17e9621f425b31a3662b484" prot="public" static="no">
86        <name>REZIM_REGULACE</name>
87        <initializer>1</initializer>
88        <briefdescription>
89        </briefdescription>
90        <detaileddescription>
91        </detaileddescription>
92        <inbodydescription>
93        </inbodydescription>
94        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="25" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="25" bodyend="-1"/>
95      </memberdef>
96      </sectiondef>
97      <sectiondef kind="var">
98      <memberdef kind="variable" id="simul_8cpp_1ec0f886b27a618f9672865d7c877af87" prot="public" static="yes" mutable="no">
99        <type>double</type>
100        <definition>double param[7]</definition>
101        <argsstring>[7]</argsstring>
102        <name>param</name>
103        <initializer>{0.28,0.003465,0.1989,0.0,4,1.5,0.04}</initializer>
104        <briefdescription>
105        </briefdescription>
106        <detaileddescription>
107        </detaileddescription>
108        <inbodydescription>
109        </inbodydescription>
110        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="27" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="27" bodyend="-1"/>
111      </memberdef>
112      <memberdef kind="variable" id="simul_8cpp_1a3d0fec955d6b30478141693fe43eb1e" prot="public" static="yes" mutable="no">
113        <type>double</type>
114        <definition>double REL[6]</definition>
115        <argsstring>[6]</argsstring>
116        <name>REL</name>
117        <briefdescription>
118        </briefdescription>
119        <detaileddescription>
120        </detaileddescription>
121        <inbodydescription>
122        </inbodydescription>
123        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="29" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="29" bodyend="-1"/>
124      </memberdef>
125      <memberdef kind="variable" id="simul_8cpp_1ffc0e5059019bf550a6604abb0835e05" prot="public" static="yes" mutable="no">
126        <type>double</type>
127        <definition>double REL1[6]</definition>
128        <argsstring>[6]</argsstring>
129        <name>REL1</name>
130        <initializer>{1.,1.,1.,1.,1.,1.}</initializer>
131        <briefdescription>
132        </briefdescription>
133        <detaileddescription>
134        </detaileddescription>
135        <inbodydescription>
136        </inbodydescription>
137        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="29" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="29" bodyend="-1"/>
138      </memberdef>
139      <memberdef kind="variable" id="simul_8cpp_19b78bd462526152199b0e0812eb3fdd7" prot="public" static="yes" mutable="no">
140        <type>double</type>
141        <definition>double DT</definition>
142        <argsstring></argsstring>
143        <name>DT</name>
144        <initializer>3e-6</initializer>
145        <briefdescription>
146        </briefdescription>
147        <detaileddescription>
148        </detaileddescription>
149        <inbodydescription>
150        </inbodydescription>
151        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="31" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="31" bodyend="-1"/>
152      </memberdef>
153      <memberdef kind="variable" id="simul_8cpp_1766e9ead6f2e850ae806a6da85590460" prot="public" static="yes" mutable="no">
154        <type>double</type>
155        <definition>double va_char[16]</definition>
156        <argsstring>[16]</argsstring>
157        <name>va_char</name>
158        <initializer>{0,10,50,100,200,300,500,1000, 0,1,1.8,2.4,3.2,3.8,4.8,6.8}</initializer>
159        <briefdescription>
160        </briefdescription>
161        <detaileddescription>
162        </detaileddescription>
163        <inbodydescription>
164        </inbodydescription>
165        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="32" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="32" bodyend="-1"/>
166      </memberdef>
167      <memberdef kind="variable" id="simul_8cpp_144d11750d10193af7944b7dc2eaa2f45" prot="public" static="yes" mutable="no">
168        <type>unsigned int</type>
169        <definition>unsigned int pocet</definition>
170        <argsstring></argsstring>
171        <name>pocet</name>
172        <initializer>8</initializer>
173        <briefdescription>
174        </briefdescription>
175        <detaileddescription>
176        </detaileddescription>
177        <inbodydescription>
178        </inbodydescription>
179        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="33" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="33" bodyend="-1"/>
180      </memberdef>
181      <memberdef kind="variable" id="simul_8cpp_12277fdb1ab96741cc3888fc395a988db" prot="public" static="yes" mutable="no">
182        <type>double</type>
183        <definition>double Rf</definition>
184        <argsstring></argsstring>
185        <name>Rf</name>
186        <initializer>5e-3</initializer>
187        <briefdescription>
188        </briefdescription>
189        <detaileddescription>
190        </detaileddescription>
191        <inbodydescription>
192        </inbodydescription>
193        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="37" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="37" bodyend="-1"/>
194      </memberdef>
195      <memberdef kind="variable" id="simul_8cpp_1d7cf8efa01a94a8846945e23f0f82585" prot="public" static="yes" mutable="no">
196        <type>double</type>
197        <definition>double Lf</definition>
198        <argsstring></argsstring>
199        <name>Lf</name>
200        <initializer>1e-3</initializer>
201        <briefdescription>
202        </briefdescription>
203        <detaileddescription>
204        </detaileddescription>
205        <inbodydescription>
206        </inbodydescription>
207        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="37" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="37" bodyend="-1"/>
208      </memberdef>
209      <memberdef kind="variable" id="simul_8cpp_17538375d5f06d9915f7c9086b06b0343" prot="public" static="yes" mutable="no">
210        <type>double</type>
211        <definition>double Cf</definition>
212        <argsstring></argsstring>
213        <name>Cf</name>
214        <initializer>1e-3</initializer>
215        <briefdescription>
216        </briefdescription>
217        <detaileddescription>
218        </detaileddescription>
219        <inbodydescription>
220        </inbodydescription>
221        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="37" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="37" bodyend="-1"/>
222      </memberdef>
223      <memberdef kind="variable" id="simul_8cpp_1456fddf8fd69637dc58ec00271128171" prot="public" static="yes" mutable="no">
224        <type>double</type>
225        <definition>double Ut</definition>
226        <argsstring></argsstring>
227        <name>Ut</name>
228        <briefdescription>
229        </briefdescription>
230        <detaileddescription>
231        </detaileddescription>
232        <inbodydescription>
233        </inbodydescription>
234        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="39" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="39" bodyend="-1"/>
235      </memberdef>
236      <memberdef kind="variable" id="simul_8cpp_16b1aef16f2bb55279eadae60bf2e558a" prot="public" static="yes" mutable="no">
237        <type>double</type>
238        <definition>double Uc</definition>
239        <argsstring></argsstring>
240        <name>Uc</name>
241        <briefdescription>
242        </briefdescription>
243        <detaileddescription>
244        </detaileddescription>
245        <inbodydescription>
246        </inbodydescription>
247        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="39" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="39" bodyend="-1"/>
248      </memberdef>
249      <memberdef kind="variable" id="simul_8cpp_1b3ea1f9133a9fd391d578911a5ff4c35" prot="public" static="yes" mutable="no">
250        <type>double</type>
251        <definition>double Ucn</definition>
252        <argsstring></argsstring>
253        <name>Ucn</name>
254        <briefdescription>
255        </briefdescription>
256        <detaileddescription>
257        </detaileddescription>
258        <inbodydescription>
259        </inbodydescription>
260        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="39" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="39" bodyend="-1"/>
261      </memberdef>
262      <memberdef kind="variable" id="simul_8cpp_1c8f8a23612ab040c9f26181e5dbf0c91" prot="public" static="yes" mutable="no">
263        <type>double</type>
264        <definition>double It</definition>
265        <argsstring></argsstring>
266        <name>It</name>
267        <briefdescription>
268        </briefdescription>
269        <detaileddescription>
270        </detaileddescription>
271        <inbodydescription>
272        </inbodydescription>
273        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="39" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="39" bodyend="-1"/>
274      </memberdef>
275      <memberdef kind="variable" id="simul_8cpp_1236ba22acc200be1dd1975755a6964bc" prot="public" static="yes" mutable="no">
276        <type>double</type>
277        <definition>double Iz</definition>
278        <argsstring></argsstring>
279        <name>Iz</name>
280        <briefdescription>
281        </briefdescription>
282        <detaileddescription>
283        </detaileddescription>
284        <inbodydescription>
285        </inbodydescription>
286        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="39" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="39" bodyend="-1"/>
287      </memberdef>
288      <memberdef kind="variable" id="simul_8cpp_1689f18157c425f52c5028d408c365616" prot="public" static="no" mutable="no">
289        <type>double</type>
290        <definition>double fc</definition>
291        <argsstring></argsstring>
292        <name>fc</name>
293        <briefdescription>
294        </briefdescription>
295        <detaileddescription>
296        </detaileddescription>
297        <inbodydescription>
298        </inbodydescription>
299        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="41" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="41" bodyend="-1"/>
300      </memberdef>
301      <memberdef kind="variable" id="simul_8cpp_1841f0181b4aed1cf0428dccfbb4a9b42" prot="public" static="no" mutable="no">
302        <type>double</type>
303        <definition>double fr</definition>
304        <argsstring></argsstring>
305        <name>fr</name>
306        <briefdescription>
307        </briefdescription>
308        <detaileddescription>
309        </detaileddescription>
310        <inbodydescription>
311        </inbodydescription>
312        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="41" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="41" bodyend="-1"/>
313      </memberdef>
314      <memberdef kind="variable" id="simul_8cpp_1c0c69854be0f25918d8cfaaa932feda9" prot="public" static="no" mutable="no">
315        <type>double</type>
316        <definition>double fs</definition>
317        <argsstring></argsstring>
318        <name>fs</name>
319        <briefdescription>
320        </briefdescription>
321        <detaileddescription>
322        </detaileddescription>
323        <inbodydescription>
324        </inbodydescription>
325        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="41" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="41" bodyend="-1"/>
326      </memberdef>
327      <memberdef kind="variable" id="simul_8cpp_187accd1af8e0aff4b818d891374f7cec" prot="public" static="no" mutable="no">
328        <type>double</type>
329        <definition>double t</definition>
330        <argsstring></argsstring>
331        <name>t</name>
332        <briefdescription>
333        </briefdescription>
334        <detaileddescription>
335        </detaileddescription>
336        <inbodydescription>
337        </inbodydescription>
338        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="43" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="43" bodyend="-1"/>
339      </memberdef>
340      <memberdef kind="variable" id="simul_8cpp_14b637c5fff609e604a3b2b2787f4a9fa" prot="public" static="no" mutable="no">
341        <type>double</type>
342        <definition>double t_end</definition>
343        <argsstring></argsstring>
344        <name>t_end</name>
345        <briefdescription>
346        </briefdescription>
347        <detaileddescription>
348        </detaileddescription>
349        <inbodydescription>
350        </inbodydescription>
351        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="43" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="43" bodyend="-1"/>
352      </memberdef>
353      <memberdef kind="variable" id="simul_8cpp_1b7ef7ef011d07aaa53569f4e65b7a9c8" prot="public" static="no" mutable="no">
354        <type>double</type>
355        <definition>double t_sense</definition>
356        <argsstring></argsstring>
357        <name>t_sense</name>
358        <briefdescription>
359        </briefdescription>
360        <detaileddescription>
361        </detaileddescription>
362        <inbodydescription>
363        </inbodydescription>
364        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="43" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="43" bodyend="-1"/>
365      </memberdef>
366      <memberdef kind="variable" id="simul_8cpp_18ee9be1b5aa75abae556de3088cba6d9" prot="public" static="no" mutable="no">
367        <type>double</type>
368        <definition>double h</definition>
369        <argsstring></argsstring>
370        <name>h</name>
371        <briefdescription>
372        </briefdescription>
373        <detaileddescription>
374        </detaileddescription>
375        <inbodydescription>
376        </inbodydescription>
377        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="44" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="44" bodyend="-1"/>
378      </memberdef>
379      <memberdef kind="variable" id="simul_8cpp_109cc6059a12cdba15210ace9262ba0d8" prot="public" static="no" mutable="no">
380        <type>double</type>
381        <definition>double hx</definition>
382        <argsstring></argsstring>
383        <name>hx</name>
384        <briefdescription>
385        </briefdescription>
386        <detaileddescription>
387        </detaileddescription>
388        <inbodydescription>
389        </inbodydescription>
390        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="44" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="44" bodyend="-1"/>
391      </memberdef>
392      <memberdef kind="variable" id="simul_8cpp_18bc096c61a3315b99615d676a67f758e" prot="public" static="no" mutable="no">
393        <type>double</type>
394        <definition>double h_disp</definition>
395        <argsstring></argsstring>
396        <name>h_disp</name>
397        <initializer>0</initializer>
398        <briefdescription>
399        </briefdescription>
400        <detaileddescription>
401        </detaileddescription>
402        <inbodydescription>
403        </inbodydescription>
404        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="44" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="44" bodyend="-1"/>
405      </memberdef>
406      <memberdef kind="variable" id="simul_8cpp_1004e965b93a1858dcaf662b220edb147" prot="public" static="no" mutable="no">
407        <type>double</type>
408        <definition>double h_reg</definition>
409        <argsstring></argsstring>
410        <name>h_reg</name>
411        <briefdescription>
412        </briefdescription>
413        <detaileddescription>
414        </detaileddescription>
415        <inbodydescription>
416        </inbodydescription>
417        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="45" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="45" bodyend="-1"/>
418      </memberdef>
419      <memberdef kind="variable" id="simul_8cpp_1aaf35fca628d0f6267260f545e9af729" prot="public" static="no" mutable="no">
420        <type>double</type>
421        <definition>double h_model</definition>
422        <argsstring></argsstring>
423        <name>h_model</name>
424        <briefdescription>
425        </briefdescription>
426        <detaileddescription>
427        </detaileddescription>
428        <inbodydescription>
429        </inbodydescription>
430        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="45" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="45" bodyend="-1"/>
431      </memberdef>
432      <memberdef kind="variable" id="simul_8cpp_15676aea66a53119b645c998fb6ff151c" prot="public" static="no" mutable="no">
433        <type>double</type>
434        <definition>double hpom</definition>
435        <argsstring></argsstring>
436        <name>hpom</name>
437        <briefdescription>
438        </briefdescription>
439        <detaileddescription>
440        </detaileddescription>
441        <inbodydescription>
442        </inbodydescription>
443        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="45" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="45" bodyend="-1"/>
444      </memberdef>
445      <memberdef kind="variable" id="simul_8cpp_1a202c44c441c61c1da0105091188e8a3" prot="public" static="no" mutable="no">
446        <type>double</type>
447        <definition>double hpom_model</definition>
448        <argsstring></argsstring>
449        <name>hpom_model</name>
450        <briefdescription>
451        </briefdescription>
452        <detaileddescription>
453        </detaileddescription>
454        <inbodydescription>
455        </inbodydescription>
456        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="45" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="45" bodyend="-1"/>
457      </memberdef>
458      <memberdef kind="variable" id="simul_8cpp_17b3e5bc332840c0eaed14baa9c75898b" prot="public" static="no" mutable="no">
459        <type>unsigned int</type>
460        <definition>unsigned int h_model_counter</definition>
461        <argsstring></argsstring>
462        <name>h_model_counter</name>
463        <briefdescription>
464        </briefdescription>
465        <detaileddescription>
466        </detaileddescription>
467        <inbodydescription>
468        </inbodydescription>
469        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="46" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="46" bodyend="-1"/>
470      </memberdef>
471      <memberdef kind="variable" id="simul_8cpp_1c2c4cdb6b240bd1c6e53933987a33a27" prot="public" static="no" mutable="no">
472        <type>unsigned int</type>
473        <definition>unsigned int h_model_counter_mez</definition>
474        <argsstring></argsstring>
475        <name>h_model_counter_mez</name>
476        <briefdescription>
477        </briefdescription>
478        <detaileddescription>
479        </detaileddescription>
480        <inbodydescription>
481        </inbodydescription>
482        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="46" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="46" bodyend="-1"/>
483      </memberdef>
484      <memberdef kind="variable" id="simul_8cpp_13ece956ca424ebed99b0796b14a98374" prot="public" static="yes" mutable="no">
485        <type>double</type>
486        <definition>double u[2]</definition>
487        <argsstring>[2]</argsstring>
488        <name>u</name>
489        <initializer>{0.,0.}</initializer>
490        <briefdescription>
491        </briefdescription>
492        <detaileddescription>
493        </detaileddescription>
494        <inbodydescription>
495        </inbodydescription>
496        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="48" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="48" bodyend="-1"/>
497      </memberdef>
498      <memberdef kind="variable" id="simul_8cpp_1a99b7cd727bdf0b27735f124f671b5ec" prot="public" static="yes" mutable="no">
499        <type>double</type>
500        <definition>double us[2]</definition>
501        <argsstring>[2]</argsstring>
502        <name>us</name>
503        <initializer>{0.,0.}</initializer>
504        <briefdescription>
505        </briefdescription>
506        <detaileddescription>
507        </detaileddescription>
508        <inbodydescription>
509        </inbodydescription>
510        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="49" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="49" bodyend="-1"/>
511      </memberdef>
512      <memberdef kind="variable" id="simul_8cpp_1d900a67bffe289dfbb015b908a2d1685" prot="public" static="no" mutable="no">
513        <type>double</type>
514        <definition>double Isd</definition>
515        <argsstring></argsstring>
516        <name>Isd</name>
517        <briefdescription>
518        </briefdescription>
519        <detaileddescription>
520        </detaileddescription>
521        <inbodydescription>
522        </inbodydescription>
523        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="50" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="50" bodyend="-1"/>
524      </memberdef>
525      <memberdef kind="variable" id="simul_8cpp_11c6d368fcf2a6b1c92e39c124d25d737" prot="public" static="no" mutable="no">
526        <type>double</type>
527        <definition>double Isq</definition>
528        <argsstring></argsstring>
529        <name>Isq</name>
530        <briefdescription>
531        </briefdescription>
532        <detaileddescription>
533        </detaileddescription>
534        <inbodydescription>
535        </inbodydescription>
536        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="50" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="50" bodyend="-1"/>
537      </memberdef>
538      <memberdef kind="variable" id="simul_8cpp_12e4ec74a755b968c3b0fde1843fbf371" prot="public" static="no" mutable="no">
539        <type>double</type>
540        <definition>double Fr</definition>
541        <argsstring></argsstring>
542        <name>Fr</name>
543        <briefdescription>
544        </briefdescription>
545        <detaileddescription>
546        </detaileddescription>
547        <inbodydescription>
548        </inbodydescription>
549        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="50" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="50" bodyend="-1"/>
550      </memberdef>
551      <memberdef kind="variable" id="simul_8cpp_1faeae9ee7305d7ca47b2707b9e1823ca" prot="public" static="no" mutable="no">
552        <type>double</type>
553        <definition>double Fs</definition>
554        <argsstring></argsstring>
555        <name>Fs</name>
556        <briefdescription>
557        </briefdescription>
558        <detaileddescription>
559        </detaileddescription>
560        <inbodydescription>
561        </inbodydescription>
562        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="50" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="50" bodyend="-1"/>
563      </memberdef>
564      <memberdef kind="variable" id="simul_8cpp_1c2a7fbd007ce8428f38711c0197ba84f" prot="public" static="yes" mutable="no">
565        <type>int</type>
566        <definition>int reg_counter</definition>
567        <argsstring></argsstring>
568        <name>reg_counter</name>
569        <initializer>1</initializer>
570        <briefdescription>
571        </briefdescription>
572        <detaileddescription>
573        </detaileddescription>
574        <inbodydescription>
575        </inbodydescription>
576        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="52" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="52" bodyend="-1"/>
577      </memberdef>
578      <memberdef kind="variable" id="simul_8cpp_17e46b90c8a18eff476d6b48039da9604" prot="public" static="yes" mutable="no">
579        <type>int</type>
580        <definition>int print_counter</definition>
581        <argsstring></argsstring>
582        <name>print_counter</name>
583        <initializer>0</initializer>
584        <briefdescription>
585        </briefdescription>
586        <detaileddescription>
587        </detaileddescription>
588        <inbodydescription>
589        </inbodydescription>
590        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="52" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="52" bodyend="-1"/>
591      </memberdef>
592      <memberdef kind="variable" id="simul_8cpp_1064de958d18436493182e197377134a4" prot="public" static="yes" mutable="no">
593        <type>double</type>
594        <definition>double Idwf</definition>
595        <argsstring></argsstring>
596        <name>Idwf</name>
597        <briefdescription>
598        </briefdescription>
599        <detaileddescription>
600        </detaileddescription>
601        <inbodydescription>
602        </inbodydescription>
603        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="53" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="53" bodyend="-1"/>
604      </memberdef>
605      <memberdef kind="variable" id="simul_8cpp_140336490db2f9186be499886926f0e3b" prot="public" static="yes" mutable="no">
606        <type>double</type>
607        <definition>double Iqwf</definition>
608        <argsstring></argsstring>
609        <name>Iqwf</name>
610        <briefdescription>
611        </briefdescription>
612        <detaileddescription>
613        </detaileddescription>
614        <inbodydescription>
615        </inbodydescription>
616        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="53" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="53" bodyend="-1"/>
617      </memberdef>
618      <memberdef kind="variable" id="simul_8cpp_1f828dddefd5bf343c700078edbfe976b" prot="public" static="yes" mutable="no">
619        <type>double</type>
620        <definition>double Urm_max</definition>
621        <argsstring></argsstring>
622        <name>Urm_max</name>
623        <briefdescription>
624        </briefdescription>
625        <detaileddescription>
626        </detaileddescription>
627        <inbodydescription>
628        </inbodydescription>
629        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="53" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="53" bodyend="-1"/>
630      </memberdef>
631      <memberdef kind="variable" id="simul_8cpp_16aeb156dc0caed63358169c7a12fce45" prot="public" static="yes" mutable="no">
632        <type>double</type>
633        <definition>double Ww</definition>
634        <argsstring></argsstring>
635        <name>Ww</name>
636        <briefdescription>
637        </briefdescription>
638        <detaileddescription>
639        </detaileddescription>
640        <inbodydescription>
641        </inbodydescription>
642        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="53" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="53" bodyend="-1"/>
643      </memberdef>
644      <memberdef kind="variable" id="simul_8cpp_18dbbdf63080ba5ad2d5da148ae6fcd9b" prot="public" static="yes" mutable="no">
645        <type>double</type>
646        <definition>double rychlost</definition>
647        <argsstring></argsstring>
648        <name>rychlost</name>
649        <briefdescription>
650        </briefdescription>
651        <detaileddescription>
652        </detaileddescription>
653        <inbodydescription>
654        </inbodydescription>
655        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="55" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="55" bodyend="-1"/>
656      </memberdef>
657      <memberdef kind="variable" id="simul_8cpp_1639a3957145f3b5dd034811cb4b4cf3f" prot="public" static="yes" mutable="no">
658        <type>double</type>
659        <definition>double Isx</definition>
660        <argsstring></argsstring>
661        <name>Isx</name>
662        <briefdescription>
663        </briefdescription>
664        <detaileddescription>
665        </detaileddescription>
666        <inbodydescription>
667        </inbodydescription>
668        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="57" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="57" bodyend="-1"/>
669      </memberdef>
670      <memberdef kind="variable" id="simul_8cpp_109325d9dd09d541bdd3f9e9ff27a05d5" prot="public" static="yes" mutable="no">
671        <type>double</type>
672        <definition>double Isy</definition>
673        <argsstring></argsstring>
674        <name>Isy</name>
675        <briefdescription>
676        </briefdescription>
677        <detaileddescription>
678        </detaileddescription>
679        <inbodydescription>
680        </inbodydescription>
681        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="57" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="57" bodyend="-1"/>
682      </memberdef>
683      <memberdef kind="variable" id="simul_8cpp_1ca81c35c21e3a5f7f3a8d24504e76664" prot="public" static="yes" mutable="no">
684        <type>double</type>
685        <definition>double theta</definition>
686        <argsstring></argsstring>
687        <name>theta</name>
688        <briefdescription>
689        </briefdescription>
690        <detaileddescription>
691        </detaileddescription>
692        <inbodydescription>
693        </inbodydescription>
694        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="58" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="58" bodyend="-1"/>
695      </memberdef>
696      <memberdef kind="variable" id="simul_8cpp_1de1d5111a11820d46acfc64a452ab2c5" prot="public" static="yes" mutable="no">
697        <type>double</type>
698        <definition>double Uc_mer</definition>
699        <argsstring></argsstring>
700        <name>Uc_mer</name>
701        <briefdescription>
702        </briefdescription>
703        <detaileddescription>
704        </detaileddescription>
705        <inbodydescription>
706        </inbodydescription>
707        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="59" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="59" bodyend="-1"/>
708      </memberdef>
709      <memberdef kind="variable" id="simul_8cpp_1a730fb3f3d8a7cdb3f85df0db34c5a31" prot="public" static="yes" mutable="no">
710        <type>int</type>
711        <definition>int k_rampa</definition>
712        <argsstring></argsstring>
713        <name>k_rampa</name>
714        <initializer>1</initializer>
715        <briefdescription>
716        </briefdescription>
717        <detaileddescription>
718        </detaileddescription>
719        <inbodydescription>
720        </inbodydescription>
721        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="61" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="61" bodyend="-1"/>
722      </memberdef>
723      <memberdef kind="variable" id="simul_8cpp_149d61e5563ddd4badfa3395bbf7a61a9" prot="public" static="yes" mutable="no">
724        <type>int</type>
725        <definition>int k_rampa_tmp</definition>
726        <argsstring></argsstring>
727        <name>k_rampa_tmp</name>
728        <initializer>0</initializer>
729        <briefdescription>
730        </briefdescription>
731        <detaileddescription>
732        </detaileddescription>
733        <inbodydescription>
734        </inbodydescription>
735        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="61" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="61" bodyend="-1"/>
736      </memberdef>
737      <memberdef kind="variable" id="simul_8cpp_1cfe22be9f0bdae5786d82ef3af196b96" prot="public" static="yes" mutable="no">
738        <type>double</type>
739        <definition>double tmp_uhel</definition>
740        <argsstring></argsstring>
741        <name>tmp_uhel</name>
742        <initializer>0</initializer>
743        <briefdescription>
744        </briefdescription>
745        <detaileddescription>
746        </detaileddescription>
747        <inbodydescription>
748        </inbodydescription>
749        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="63" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="63" bodyend="-1"/>
750      </memberdef>
751      <memberdef kind="variable" id="simul_8cpp_1b6913f657dfd030fb7aa579f91373a56" prot="public" static="yes" mutable="no">
752        <type>double</type>
753        <definition>double ekf_estim[2]</definition>
754        <argsstring>[2]</argsstring>
755        <name>ekf_estim</name>
756        <initializer>{0.,0.}</initializer>
757        <briefdescription>
758        </briefdescription>
759        <detaileddescription>
760        </detaileddescription>
761        <inbodydescription>
762        </inbodydescription>
763        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="66" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="66" bodyend="-1"/>
764      </memberdef>
765      <memberdef kind="variable" id="simul_8cpp_111ee841a5cbfa0e9d39dc9d7ba004e24" prot="public" static="no" mutable="no">
766        <type>FILE *</type>
767        <definition>FILE* fw</definition>
768        <argsstring></argsstring>
769        <name>fw</name>
770        <briefdescription>
771        </briefdescription>
772        <detaileddescription>
773        </detaileddescription>
774        <inbodydescription>
775        </inbodydescription>
776        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="68" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="68" bodyend="-1"/>
777      </memberdef>
778      </sectiondef>
779      <sectiondef kind="func">
780      <memberdef kind="function" id="simul_8cpp_1800fae1adc0ea6fe215865c3708c4d7a" prot="public" static="yes" const="no" explicit="no" inline="no" virt="non-virtual">
781        <type>void</type>
782        <definition>static void sim_init</definition>
783        <argsstring>(void)</argsstring>
784        <name>sim_init</name>
785        <param>
786          <type>void</type>
787        </param>
788        <briefdescription>
789        </briefdescription>
790        <detaileddescription>
791        </detaileddescription>
792        <inbodydescription>
793        </inbodydescription>
794        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="70" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="72" bodyend="99"/>
795      </memberdef>
796      <memberdef kind="function" id="simul_8cpp_1840291bc02cba5474a4cb46a9b9566fe" prot="public" static="no" const="no" explicit="no" inline="no" virt="non-virtual">
797        <type>int</type>
798        <definition>int main</definition>
799        <argsstring>(void)</argsstring>
800        <name>main</name>
801        <param>
802          <type>void</type>
803        </param>
804        <briefdescription>
805        </briefdescription>
806        <detaileddescription>
807        </detaileddescription>
808        <inbodydescription>
809        </inbodydescription>
810        <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" line="102" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp" bodystart="101" bodyend="268"/>
811      </memberdef>
812      </sectiondef>
813    <briefdescription>
814    </briefdescription>
815    <detaileddescription>
816    </detaileddescription>
817    <programlisting>
818<codeline lineno="1"><highlight class="comment">/*<sp/>Hlavni<sp/>simulacni<sp/>program</highlight></codeline>
819<codeline lineno="2"><highlight class="comment"></highlight></codeline>
820<codeline lineno="3"><highlight class="comment"><sp/><sp/><sp/>Simulace<sp/>tramvaje<sp/>s<sp/>PMSM<sp/>v<sp/>plovouci<sp/>radove<sp/>carce</highlight></codeline>
821<codeline lineno="4"><highlight class="comment"></highlight></codeline>
822<codeline lineno="5"><highlight class="comment"><sp/><sp/><sp/>Presne<sp/>parametry<sp/>tramvaje<sp/>Skoda<sp/>15T</highlight></codeline>
823<codeline lineno="6"><highlight class="comment"></highlight></codeline>
824<codeline lineno="7"><highlight class="comment"><sp/><sp/><sp/>31.5.2007</highlight></codeline>
825<codeline lineno="8"><highlight class="comment"></highlight></codeline>
826<codeline lineno="9"><highlight class="comment">REV.<sp/><sp/><sp/></highlight></codeline>
827<codeline lineno="10"><highlight class="comment">31.5.<sp/>2007<sp/><sp/><sp/><sp/><sp/><sp/>Doplnena<sp/>moznost<sp/>provozu<sp/>PWM<sp/>se<sp/>3.<sp/>harmonickou<sp/>-<sp/>konstanta<sp/>MODULACE<sp/>nastavuje<sp/>typ<sp/>modulace</highlight></codeline>
828<codeline lineno="11"><highlight class="comment">25.6.<sp/>2007<sp/><sp/><sp/><sp/><sp/><sp/>Vyrazen<sp/>ss<sp/>obvod<sp/>a<sp/>trolej<sp/>(uvazovano<sp/>konst.<sp/>napeti<sp/>na<sp/>troleji)<sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight></codeline>
829<codeline lineno="12"><highlight class="comment">*/</highlight><highlight class="normal"></highlight></codeline>
830<codeline lineno="13"><highlight class="normal"></highlight></codeline>
831<codeline lineno="14"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>&lt;stdio.h&gt;</highlight><highlight class="normal"></highlight></codeline>
832<codeline lineno="15"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>&lt;math.h&gt;</highlight><highlight class="normal"></highlight></codeline>
833<codeline lineno="16"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>&quot;pmsm_mod.h&quot;</highlight><highlight class="normal"></highlight></codeline>
834<codeline lineno="17"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>&quot;pwm.h&quot;</highlight><highlight class="normal"></highlight></codeline>
835<codeline lineno="18"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>&quot;regulace.h&quot;</highlight><highlight class="normal"></highlight></codeline>
836<codeline lineno="19"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>&quot;ekf.h&quot;</highlight><highlight class="normal"></highlight></codeline>
837<codeline lineno="20"><highlight class="normal"></highlight></codeline>
838<codeline lineno="21"><highlight class="normal"></highlight><highlight class="preprocessor">#define<sp/>Qm<sp/><sp/><sp/><sp/><sp/><sp/>13</highlight></codeline>
839<codeline lineno="22"><highlight class="preprocessor"></highlight><highlight class="preprocessor">#define<sp/>CHYBA_POLOHY<sp/><sp/><sp/><sp/>(0./180.*M_PI)<sp/><sp/>//<sp/>chyba<sp/>+/-8<sp/>stupnu<sp/>elektrickych<sp/>pro<sp/>senzorovany<sp/>loziskovy<sp/>stit</highlight></codeline>
840<codeline lineno="23"><highlight class="preprocessor"></highlight><highlight class="normal"></highlight></codeline>
841<codeline lineno="24"><highlight class="normal"></highlight><highlight class="preprocessor">#define<sp/>MODULACE<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>1<sp/><sp/><sp/><sp/><sp/><sp/><sp/>//<sp/>0...sinusova<sp/>PWM,<sp/>1...PWM<sp/>se<sp/>3.harmonickou</highlight></codeline>
842<codeline lineno="25"><highlight class="preprocessor"></highlight><highlight class="preprocessor">#define<sp/>REZIM_REGULACE<sp/><sp/>1<sp/><sp/><sp/><sp/><sp/><sp/><sp/>//<sp/>0...reg.<sp/>momentu,<sp/>1...reg.rychlosti,<sp/>2...<sp/>Isqw=sqrt(Imax^2-Id^2)<sp/>-<sp/>max.<sp/>moment</highlight></codeline>
843<codeline lineno="26"><highlight class="preprocessor"></highlight><highlight class="normal"></highlight></codeline>
844<codeline lineno="27"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>param[7]={0.28,0.003465,0.1989,0.0,4,1.5,0.04};</highlight></codeline>
845<codeline lineno="28"><highlight class="normal"></highlight><highlight class="comment">//<sp/>[Rs,<sp/>Ls,<sp/>Fmag,<sp/>Bf,<sp/>p,<sp/>kp,<sp/>J<sp/>=<sp/>0.04?];</highlight><highlight class="normal"></highlight></codeline>
846<codeline lineno="29"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>REL[6],<sp/>REL1[6]={1.,1.,1.,1.,1.,1.};</highlight></codeline>
847<codeline lineno="30"><highlight class="normal"></highlight><highlight class="comment">//<sp/>REL<sp/>=<sp/>[Ur,<sp/>Ir,<sp/>wr,<sp/>thetar,<sp/>Mr,<sp/>Fr];</highlight><highlight class="normal"></highlight></codeline>
848<codeline lineno="31"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>DT=3e-6;<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>mrtve<sp/>casy</highlight><highlight class="normal"></highlight></codeline>
849<codeline lineno="32"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>va_char[16]={0,10,50,100,200,300,500,1000,<sp/>0,1,1.8,2.4,3.2,3.8,4.8,6.8};<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>ubytky</highlight><highlight class="normal"></highlight></codeline>
850<codeline lineno="33"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">unsigned</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>pocet=8;<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>velikost<sp/>VA-charky</highlight><highlight class="normal"></highlight></codeline>
851<codeline lineno="34"><highlight class="normal"></highlight></codeline>
852<codeline lineno="35"><highlight class="normal"></highlight><highlight class="comment">//<sp/>trolejovy<sp/>filtr</highlight><highlight class="normal"></highlight></codeline>
853<codeline lineno="36"><highlight class="normal"></highlight><highlight class="comment">//static<sp/>double<sp/>Rf=22e-3,Lf=1.8e-3,Cf=10e-3;<sp/><sp/><sp/><sp/>//<sp/>filtr<sp/>VEKTRA</highlight><highlight class="normal"></highlight></codeline>
854<codeline lineno="37"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Rf=5e-3,Lf=1e-3,Cf=1e-3;<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>filtr<sp/>15T</highlight><highlight class="normal"></highlight></codeline>
855<codeline lineno="38"><highlight class="normal"></highlight><highlight class="comment">//<sp/>parametry<sp/>ss<sp/>obvodu</highlight><highlight class="normal"></highlight></codeline>
856<codeline lineno="39"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Ut,Uc,Ucn,It,Iz;</highlight></codeline>
857<codeline lineno="40"><highlight class="normal"></highlight><highlight class="comment">//<sp/>modulace<sp/>a<sp/>skalarni<sp/>rizeni</highlight><highlight class="normal"></highlight></codeline>
858<codeline lineno="41"><highlight class="normal"></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>fc,fr,fs;</highlight></codeline>
859<codeline lineno="42"><highlight class="normal"></highlight></codeline>
860<codeline lineno="43"><highlight class="normal"></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>t,<sp/>t_end,<sp/>t_sense;</highlight></codeline>
861<codeline lineno="44"><highlight class="normal"></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>h,hx,h_disp=0;</highlight></codeline>
862<codeline lineno="45"><highlight class="normal"></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>h_reg,h_model,hpom,hpom_model;</highlight></codeline>
863<codeline lineno="46"><highlight class="normal"></highlight><highlight class="keywordtype">unsigned</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>h_model_counter,h_model_counter_mez;</highlight></codeline>
864<codeline lineno="47"><highlight class="normal"></highlight></codeline>
865<codeline lineno="48"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>u[2]={0.,0.};<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>format<sp/>u={Um,<sp/>beta}</highlight><highlight class="normal"></highlight></codeline>
866<codeline lineno="49"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>us[2]={0.,0.};<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>format<sp/>us={us_alfa,<sp/>us_beta}</highlight><highlight class="normal"></highlight></codeline>
867<codeline lineno="50"><highlight class="normal"></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Isd,<sp/>Isq,<sp/>Fr,<sp/>Fs;</highlight></codeline>
868<codeline lineno="51"><highlight class="normal"></highlight></codeline>
869<codeline lineno="52"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>reg_counter=1,<sp/>print_counter=0;</highlight></codeline>
870<codeline lineno="53"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Idwf,Iqwf,Urm_max,Ww;</highlight></codeline>
871<codeline lineno="54"><highlight class="normal"></highlight></codeline>
872<codeline lineno="55"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>rychlost;</highlight></codeline>
873<codeline lineno="56"><highlight class="normal"></highlight></codeline>
874<codeline lineno="57"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Isx,<sp/>Isy;</highlight></codeline>
875<codeline lineno="58"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>theta;</highlight></codeline>
876<codeline lineno="59"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Uc_mer;</highlight></codeline>
877<codeline lineno="60"><highlight class="normal"></highlight></codeline>
878<codeline lineno="61"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>k_rampa=1,<sp/>k_rampa_tmp=0;</highlight></codeline>
879<codeline lineno="62"><highlight class="normal"></highlight></codeline>
880<codeline lineno="63"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>tmp_uhel=0;</highlight></codeline>
881<codeline lineno="64"><highlight class="normal"></highlight></codeline>
882<codeline lineno="65"><highlight class="normal"></highlight><highlight class="comment">//<sp/>EKF<sp/>-<sp/>vysledek<sp/>estimace</highlight><highlight class="normal"></highlight></codeline>
883<codeline lineno="66"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>ekf_estim[2]={0.,0.};<sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>w_est,<sp/>theta_est</highlight><highlight class="normal"></highlight></codeline>
884<codeline lineno="67"><highlight class="normal"></highlight></codeline>
885<codeline lineno="68"><highlight class="normal">FILE<sp/>*fw;</highlight></codeline>
886<codeline lineno="69"><highlight class="normal"></highlight></codeline>
887<codeline lineno="70"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>sim_init(</highlight><highlight class="keywordtype">void</highlight><highlight class="normal">);</highlight></codeline>
888<codeline lineno="71"><highlight class="normal"></highlight></codeline>
889<codeline lineno="72"><highlight class="normal"></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>sim_init(</highlight><highlight class="keywordtype">void</highlight><highlight class="normal">)</highlight></codeline>
890<codeline lineno="73"><highlight class="normal">{</highlight></codeline>
891<codeline lineno="74"><highlight class="normal"><sp/><sp/></highlight><highlight class="comment">//<sp/>parametry<sp/>troleje<sp/>a<sp/>modulator</highlight><highlight class="normal"></highlight></codeline>
892<codeline lineno="75"><highlight class="normal"><sp/><sp/>Ucn=600.;Ut=200.;Uc=Ut;It=0.;Iz=0.;</highlight></codeline>
893<codeline lineno="76"><highlight class="normal"><sp/><sp/>fc=4000.;</highlight></codeline>
894<codeline lineno="77"><highlight class="normal"></highlight></codeline>
895<codeline lineno="78"><highlight class="normal"><sp/><sp/></highlight><highlight class="comment">//<sp/>vzorkovani</highlight><highlight class="normal"></highlight></codeline>
896<codeline lineno="79"><highlight class="normal"><sp/><sp/>h_reg=1./2./fc;</highlight></codeline>
897<codeline lineno="80"><highlight class="normal"><sp/><sp/>h_model=h_reg;</highlight></codeline>
898<codeline lineno="81"><highlight class="normal"><sp/><sp/>hpom=h;hpom_model=h;</highlight></codeline>
899<codeline lineno="82"><highlight class="normal"></highlight></codeline>
900<codeline lineno="83"><highlight class="normal"><sp/><sp/></highlight><highlight class="comment">//<sp/>vzorkovani<sp/>pomoci<sp/>citacu</highlight><highlight class="normal"></highlight></codeline>
901<codeline lineno="84"><highlight class="normal"><sp/><sp/>h_model_counter_mez=(int)(h_model/h);</highlight></codeline>
902<codeline lineno="85"><highlight class="normal"><sp/><sp/>h_model_counter=h_model_counter_mez;</highlight></codeline>
903<codeline lineno="86"><highlight class="normal"></highlight></codeline>
904<codeline lineno="87"><highlight class="normal"><sp/><sp/>fs=0.;<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>zadani<sp/>primo<sp/>v<sp/>Hz</highlight><highlight class="normal"></highlight></codeline>
905<codeline lineno="88"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/>fs=700.1*(param[4]/60.);<sp/><sp/><sp/><sp/>//<sp/>zadani<sp/>pres<sp/>mechanicke<sp/>otacky<sp/>fs=n*pp/60</highlight><highlight class="normal"></highlight></codeline>
906<codeline lineno="89"><highlight class="normal"></highlight></codeline>
907<codeline lineno="90"><highlight class="normal"><sp/><sp/></highlight><highlight class="comment">//<sp/>pocatecni<sp/>stav<sp/>motoru</highlight><highlight class="normal"></highlight></codeline>
908<codeline lineno="91"><highlight class="normal"><sp/><sp/>x[0]=0.;x[1]=0.;x[3]=0.;x[4]=0.;x[5]=0.;x[6]=0.;x[7]=0.;x[8]=0.;</highlight></codeline>
909<codeline lineno="92"><highlight class="normal"><sp/><sp/>x[2]=2.*M_PI*fs;<sp/><sp/></highlight><highlight class="comment">//<sp/>konstantni<sp/>rychlost</highlight><highlight class="normal"></highlight></codeline>
910<codeline lineno="93"><highlight class="normal"><sp/><sp/>x[3]=M_PI/10.;</highlight></codeline>
911<codeline lineno="94"><highlight class="normal"></highlight></codeline>
912<codeline lineno="95"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/>REL[0]=600;<sp/>REL[1]=12.0*sqrt(2);<sp/>REL[2]=2*M_PI*200;<sp/>REL[3]=3.14159;</highlight><highlight class="normal"></highlight></codeline>
913<codeline lineno="96"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/>REL[4]=17.8;REL[5]=1.0;<sp/><sp/><sp/><sp/><sp/><sp/><sp/>//<sp/>parametry<sp/>pro<sp/>v�kon<sp/>PMSM<sp/>6kW!!!</highlight><highlight class="normal"></highlight></codeline>
914<codeline lineno="97"><highlight class="normal"></highlight></codeline>
915<codeline lineno="98"><highlight class="normal"><sp/><sp/>Isx=0.;Isy=0.;theta=x[3];rychlost=x[2];Uc_mer=Uc;</highlight></codeline>
916<codeline lineno="99"><highlight class="normal">}</highlight></codeline>
917<codeline lineno="100"><highlight class="normal"></highlight></codeline>
918<codeline lineno="101"><highlight class="normal"></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/><ref refid="sim__var_8cpp_1e66f6b31b5ad750f1fe042a706a4e3d4" kindref="member" tooltip="Extended Kalman filter with unknown Q.">main</ref>(</highlight><highlight class="keywordtype">void</highlight><highlight class="normal">)</highlight></codeline>
919<codeline lineno="102"><highlight class="normal">{</highlight></codeline>
920<codeline lineno="103"><highlight class="normal"><sp/><sp/>h=1e-6;</highlight></codeline>
921<codeline lineno="104"><highlight class="normal"></highlight></codeline>
922<codeline lineno="105"><highlight class="normal"><sp/><sp/>t_end=9.;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>profil<sp/>Isq<sp/>5s,<sp/>rozbeh<sp/>12s,<sp/>rozbeh<sp/>+/-<sp/>20s,<sp/>reverzace<sp/>12s</highlight><highlight class="normal"></highlight></codeline>
923<codeline lineno="106"><highlight class="normal"><sp/><sp/>t_sense=0.0;<sp/></highlight><highlight class="comment">//<sp/>1.</highlight><highlight class="normal"></highlight></codeline>
924<codeline lineno="107"><highlight class="normal"><sp/><sp/>t=h;</highlight></codeline>
925<codeline lineno="108"><highlight class="normal"></highlight></codeline>
926<codeline lineno="109"><highlight class="normal"><sp/><sp/>sim_init();</highlight></codeline>
927<codeline lineno="110"><highlight class="normal"></highlight></codeline>
928<codeline lineno="111"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/>pwm_full_new_init(h,fc,DT,0,1,1);</highlight><highlight class="normal"></highlight></codeline>
929<codeline lineno="112"><highlight class="normal"><sp/><sp/>pwm_full_new_init_3h(h,fc,DT,0,-1,-1);</highlight></codeline>
930<codeline lineno="113"><highlight class="normal"><sp/><sp/>init_pmsm(param,<sp/>REL1);</highlight></codeline>
931<codeline lineno="114"><highlight class="normal"><sp/><sp/>init_regulace(param,h_reg);</highlight></codeline>
932<codeline lineno="115"><highlight class="normal"><sp/><sp/>init_ekf(h_reg,param);</highlight></codeline>
933<codeline lineno="116"><highlight class="normal"></highlight></codeline>
934<codeline lineno="117"><highlight class="normal"><sp/><sp/>fw=fopen(</highlight><highlight class="stringliteral">&quot;data/graf1.txt&quot;</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">&quot;w&quot;</highlight><highlight class="normal">);</highlight></codeline>
935<codeline lineno="118"><highlight class="normal"></highlight></codeline>
936<codeline lineno="119"><highlight class="normal"><sp/><sp/>Idwf=0.;</highlight></codeline>
937<codeline lineno="120"><highlight class="normal"><sp/><sp/>Ww=0.;</highlight></codeline>
938<codeline lineno="121"><highlight class="normal"><sp/><sp/>Iqwf=0.;</highlight></codeline>
939<codeline lineno="122"><highlight class="normal"></highlight></codeline>
940<codeline lineno="123"><highlight class="normal"><sp/><sp/></highlight><highlight class="keywordflow">while</highlight><highlight class="normal"><sp/>(t&lt;=t_end)</highlight></codeline>
941<codeline lineno="124"><highlight class="normal"><sp/><sp/>{</highlight></codeline>
942<codeline lineno="125"><highlight class="normal"><sp/><sp/><sp/><sp/>pwm_full_new_3h(us,u,&amp;Iz,Ucn,Uc,x,va_char,pocet,MODULACE);<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>mod=0<sp/>...<sp/>sinusova<sp/>PWM,<sp/>mod=1<sp/>...<sp/>3.<sp/>harmonicka</highlight><highlight class="normal"></highlight></codeline>
943<codeline lineno="126"><highlight class="normal"><sp/><sp/><sp/><sp/>pmsm_double(*us,*(us+1),h,5);</highlight></codeline>
944<codeline lineno="127"><highlight class="normal"></highlight></codeline>
945<codeline lineno="128"><highlight class="normal"><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(h_model_counter&gt;=h_model_counter_mez)<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>pocatek<sp/>ISR</highlight><highlight class="normal"></highlight></codeline>
946<codeline lineno="129"><highlight class="normal"><sp/><sp/><sp/><sp/>{</highlight></codeline>
947<codeline lineno="130"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(reg_counter&gt;-1)<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>reg.<sp/>smycka<sp/>jede<sp/>v<sp/>kazdem<sp/>ISR<sp/>=&gt;<sp/>reg_counter&gt;-1,<sp/>jinak<sp/>jako<sp/>u<sp/>ASM<sp/>reg_counter&gt;1</highlight><highlight class="normal"></highlight></codeline>
948<codeline lineno="131"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>{</highlight></codeline>
949<codeline lineno="132"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;.05)<sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>0.05</highlight><highlight class="normal"></highlight></codeline>
950<codeline lineno="133"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>{</highlight></codeline>
951<codeline lineno="134"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>skokova<sp/>zmena<sp/>Isqw</highlight><highlight class="normal"></highlight></codeline>
952<codeline lineno="135"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Iqwf=30.;</highlight><highlight class="normal"></highlight></codeline>
953<codeline lineno="136"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>zmena<sp/>Isqw<sp/>po<sp/>rampa<sp/>-<sp/>profil</highlight><highlight class="normal"></highlight></codeline>
954<codeline lineno="137"><highlight class="normal"></highlight><highlight class="comment">/*<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Iqwf+=k_rampa*0.0125;<sp/>//<sp/>0.055</highlight></codeline>
955<codeline lineno="138"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(Iqwf&gt;30.)<sp/>{Iqwf=30.;<sp/>if<sp/>(k_rampa_tmp&lt;8000)<sp/>k_rampa_tmp++;<sp/>else<sp/>{k_rampa=-1;k_rampa_tmp=0;}}</highlight></codeline>
956<codeline lineno="139"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(Iqwf&lt;-30.)<sp/>{Iqwf=-30.;<sp/>if<sp/>(k_rampa_tmp&lt;8000)<sp/>k_rampa_tmp++;<sp/>else<sp/>{k_rampa=1;k_rampa_tmp=0;}}</highlight></codeline>
957<codeline lineno="140"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>((t&gt;3.)<sp/>&amp;&amp;<sp/>(Iqwf&gt;0))<sp/>Iqwf=0;<sp/>/*<sp/>konec<sp/>profilu<sp/>Isqw<sp/>*/</highlight><highlight class="normal"></highlight></codeline>
958<codeline lineno="141"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(Iqwf&gt;0)<sp/>Iqwf=0;</highlight><highlight class="normal"></highlight></codeline>
959<codeline lineno="142"><highlight class="normal"></highlight></codeline>
960<codeline lineno="143"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(Ww&lt;2.*M_PI*275.)<sp/>Ww+=2.*M_PI*0.0125;</highlight><highlight class="normal"></highlight></codeline>
961<codeline lineno="144"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(Ww&gt;-2.*M_PI*275.)<sp/>Ww-=2.*M_PI*0.0125;</highlight><highlight class="normal"></highlight></codeline>
962<codeline lineno="145"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Ww=2.*M_PI*180;</highlight><highlight class="normal"></highlight></codeline>
963<codeline lineno="146"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>jednoducha<sp/>reverzace<sp/>-<sp/>cely<sp/>dej<sp/>cca<sp/>11s</highlight><highlight class="normal"></highlight></codeline>
964<codeline lineno="147"><highlight class="normal"></highlight><highlight class="comment">/*<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Ww+=k_rampa*2.*M_PI*0.125/2.;<sp/><sp/><sp/><sp/>//1000Hz/s</highlight></codeline>
965<codeline lineno="148"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(Ww&gt;2.*M_PI*150.)<sp/>{Ww=2.*M_PI*150.;<sp/>if<sp/>(k_rampa_tmp&lt;8000)<sp/>k_rampa_tmp++;<sp/>else<sp/>{k_rampa=-1;k_rampa_tmp=0;}}</highlight></codeline>
966<codeline lineno="149"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(Ww&lt;-2.*M_PI*150.)<sp/>Ww=-2.*M_PI*150.;<sp/><sp/><sp/>/*<sp/>*/</highlight><highlight class="normal"></highlight></codeline>
967<codeline lineno="150"><highlight class="normal"></highlight></codeline>
968<codeline lineno="151"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>skokova<sp/>zmena<sp/>napeti<sp/>troleje</highlight><highlight class="normal"></highlight></codeline>
969<codeline lineno="152"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Ut=500;<sp/><sp/><sp/><sp/><sp/><sp/><sp/>//<sp/>nutno<sp/>zadat<sp/>konstantni<sp/>Isdw<sp/>pri<sp/>startu</highlight><highlight class="normal"></highlight></codeline>
970<codeline lineno="153"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>}</highlight></codeline>
971<codeline lineno="154"><highlight class="normal"></highlight></codeline>
972<codeline lineno="155"><highlight class="normal"></highlight></codeline>
973<codeline lineno="156"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;0.2)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
974<codeline lineno="157"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;0.4)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
975<codeline lineno="158"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;0.6)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
976<codeline lineno="159"><highlight class="normal"></highlight></codeline>
977<codeline lineno="160"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;0.7)<sp/>Ww=2.*M_PI*10.;</highlight></codeline>
978<codeline lineno="161"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;1.0)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
979<codeline lineno="162"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;1.2)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
980<codeline lineno="163"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;1.4)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
981<codeline lineno="164"><highlight class="normal"></highlight></codeline>
982<codeline lineno="165"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;1.6)<sp/>Ww=2.*M_PI*50.;</highlight></codeline>
983<codeline lineno="166"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;1.9)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
984<codeline lineno="167"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;2.1)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
985<codeline lineno="168"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;2.3)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
986<codeline lineno="169"><highlight class="normal"></highlight></codeline>
987<codeline lineno="170"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;2.5)<sp/>Ww=2.*M_PI*100;</highlight></codeline>
988<codeline lineno="171"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;2.8)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
989<codeline lineno="172"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;3.0)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
990<codeline lineno="173"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;3.2)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
991<codeline lineno="174"><highlight class="normal"></highlight></codeline>
992<codeline lineno="175"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;3.4)<sp/>Ww=2.*M_PI*150;</highlight></codeline>
993<codeline lineno="176"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;3.7)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
994<codeline lineno="177"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;3.9)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
995<codeline lineno="178"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;4.1)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
996<codeline lineno="179"><highlight class="normal"></highlight></codeline>
997<codeline lineno="180"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;4.3)<sp/>Ww=2.*M_PI*0;</highlight></codeline>
998<codeline lineno="181"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;4.8)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
999<codeline lineno="182"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;5.0)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
1000<codeline lineno="183"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;5.2)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
1001<codeline lineno="184"><highlight class="normal"></highlight></codeline>
1002<codeline lineno="185"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;5.4)<sp/>Ww=2.*M_PI*(-10.);</highlight></codeline>
1003<codeline lineno="186"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;5.7)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
1004<codeline lineno="187"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;5.9)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
1005<codeline lineno="188"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;6.1)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
1006<codeline lineno="189"><highlight class="normal"></highlight></codeline>
1007<codeline lineno="190"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;6.3)<sp/>Ww=2.*M_PI*(-50.);</highlight></codeline>
1008<codeline lineno="191"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;6.7)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
1009<codeline lineno="192"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;6.9)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
1010<codeline lineno="193"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;7.1)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
1011<codeline lineno="194"><highlight class="normal"></highlight></codeline>
1012<codeline lineno="195"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;7.3)<sp/>Ww=2.*M_PI*(-100.);</highlight></codeline>
1013<codeline lineno="196"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;7.7)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline>
1014<codeline lineno="197"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;7.9)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
1015<codeline lineno="198"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;8.1)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
1016<codeline lineno="199"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;8.3)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline>
1017<codeline lineno="200"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;8.5)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline>
1018<codeline lineno="201"><highlight class="normal"></highlight></codeline>
1019<codeline lineno="202"><highlight class="normal"></highlight></codeline>
1020<codeline lineno="203"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>letmy<sp/>start<sp/>s<sp/>nenulovym<sp/>momentem</highlight><highlight class="normal"></highlight></codeline>
1021<codeline lineno="204"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Iqwf=149.*sqrt(2.);</highlight><highlight class="normal"></highlight></codeline>
1022<codeline lineno="205"><highlight class="normal"></highlight></codeline>
1023<codeline lineno="206"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>pomal�<sp/>rozjezd<sp/>10s<sp/>do<sp/>max.<sp/>rychlosti<sp/>700rpm</highlight><highlight class="normal"></highlight></codeline>
1024<codeline lineno="207"><highlight class="normal"></highlight><highlight class="comment">/*<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Iqwf=149.*sqrt(2.);<sp/><sp/><sp/><sp/><sp/>//<sp/>konst.<sp/>Isqw<sp/>=<sp/>Imax</highlight></codeline>
1025<codeline lineno="208"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>x[2]+=2.*M_PI*0.004;</highlight></codeline>
1026<codeline lineno="209"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(x[2]&gt;1615)<sp/>x[2]=1615;</highlight></codeline>
1027<codeline lineno="210"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(x[2]&lt;-1615)<sp/>x[2]=-1615;<sp/><sp/><sp/><sp/><sp/>/*<sp/>osetreni<sp/>pro<sp/>test<sp/>rozjezdu<sp/>do<sp/>zapornych<sp/>otacek<sp/>*/</highlight><highlight class="normal"></highlight></codeline>
1028<codeline lineno="211"><highlight class="normal"></highlight></codeline>
1029<codeline lineno="212"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>rampa<sp/>rozjezd<sp/>5s<sp/>do<sp/>max.<sp/>rychlosti<sp/>700rpm<sp/>a<sp/>10s<sp/>do<sp/>-700rpm</highlight><highlight class="normal"></highlight></codeline>
1030<codeline lineno="213"><highlight class="normal"></highlight><highlight class="comment">/*<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Iqwf=149.*sqrt(2.);<sp/><sp/><sp/><sp/><sp/>//<sp/>konst.<sp/>Isqw<sp/>=<sp/>Imax</highlight></codeline>
1031<codeline lineno="214"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>x[2]+=k_rampa*2.*M_PI*0.008;</highlight></codeline>
1032<codeline lineno="215"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(x[2]&gt;1615)<sp/>{x[2]=1615;<sp/>if<sp/>(k_rampa_tmp&lt;24000)<sp/>k_rampa_tmp++;<sp/>else<sp/>{k_rampa=-1;k_rampa_tmp=0;}}</highlight></codeline>
1033<codeline lineno="216"><highlight class="comment"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>if<sp/>(x[2]&lt;-1615)<sp/>x[2]=-1615;<sp/><sp/>/**/</highlight><highlight class="normal"></highlight></codeline>
1034<codeline lineno="217"><highlight class="normal"></highlight></codeline>
1035<codeline lineno="218"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>KALMAN</highlight><highlight class="normal"></highlight></codeline>
1036<codeline lineno="219"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>ekf(ekf_estim,*u,*(u+1),Ucn,Uc_mer,Isx,Isy);</highlight></codeline>
1037<codeline lineno="220"><highlight class="normal"></highlight></codeline>
1038<codeline lineno="221"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>vystup<sp/>z<sp/>EKF<sp/>zaveden<sp/>do<sp/>regulatoru</highlight><highlight class="normal"></highlight></codeline>
1039<codeline lineno="222"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>rychlost=ekf_estim[0];<sp/>theta=ekf_estim[1];<sp/>//VS</highlight><highlight class="normal"></highlight></codeline>
1040<codeline lineno="223"><highlight class="normal"></highlight></codeline>
1041<codeline lineno="224"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Urm_max=1.0;</highlight></codeline>
1042<codeline lineno="225"><highlight class="normal"></highlight></codeline>
1043<codeline lineno="226"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>idealni<sp/>vzorkovani<sp/>-<sp/>test<sp/>vlivu</highlight><highlight class="normal"></highlight></codeline>
1044<codeline lineno="227"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Isx=x[0];Isy=x[1];rychlost=x[2];theta=x[3];Uc_mer=Uc;</highlight><highlight class="normal"></highlight></codeline>
1045<codeline lineno="228"><highlight class="normal"></highlight></codeline>
1046<codeline lineno="229"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(MODULACE==0)<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>sinusova<sp/>PWM</highlight><highlight class="normal"></highlight></codeline>
1047<codeline lineno="230"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>vektor_regulace(Idwf,Iqwf,Urm_max,Ww,u,Isx,Isy,theta,rychlost,Ucn/2.,Uc_mer,Ucn,REZIM_REGULACE);<sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>rezim=1<sp/>...<sp/>reg.<sp/>rychlosti,<sp/>rezim=0<sp/>...<sp/>reg.<sp/>momentu</highlight><highlight class="normal"></highlight></codeline>
1048<codeline lineno="231"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>rezim=2<sp/>...<sp/>Iqw=sqrt(Imax^2-Idw^2)</highlight><highlight class="normal"></highlight></codeline>
1049<codeline lineno="232"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">else</highlight><highlight class="normal"></highlight></codeline>
1050<codeline lineno="233"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>vektor_regulace(Idwf,Iqwf,Urm_max,Ww,u,Isx,Isy,theta,rychlost,Ucn/sqrt(3.),Uc_mer,Ucn,REZIM_REGULACE);</highlight><highlight class="comment">//<sp/>rezim=1<sp/>...<sp/>reg.<sp/>rychlosti,<sp/>rezim=0<sp/>...<sp/>reg.<sp/>momentu</highlight><highlight class="normal"></highlight></codeline>
1051<codeline lineno="234"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>rezim=2<sp/>...<sp/>Iqw=sqrt(Imax^2-Idw^2)</highlight><highlight class="normal"></highlight></codeline>
1052<codeline lineno="235"><highlight class="normal"></highlight></codeline>
1053<codeline lineno="236"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>reg_counter=0;</highlight></codeline>
1054<codeline lineno="237"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Isx=x[0];Isy=x[1];rychlost=x[2];theta=x[3]+CHYBA_POLOHY;Uc_mer=Uc;<sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>re�ln�<sp/>vzorkov�n�</highlight><highlight class="normal"></highlight></codeline>
1055<codeline lineno="238"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>}</highlight></codeline>
1056<codeline lineno="239"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>hpom_model=0;</highlight></codeline>
1057<codeline lineno="240"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>h_model_counter=0;</highlight></codeline>
1058<codeline lineno="241"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>reg_counter++;</highlight></codeline>
1059<codeline lineno="242"><highlight class="normal"><sp/><sp/><sp/><sp/>}</highlight></codeline>
1060<codeline lineno="243"><highlight class="normal"></highlight></codeline>
1061<codeline lineno="244"><highlight class="normal"><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t&gt;=t_sense)</highlight></codeline>
1062<codeline lineno="245"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(print_counter&gt;199)</highlight></codeline>
1063<codeline lineno="246"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>{<sp/>fprintf(fw,</highlight><highlight class="stringliteral">&quot;%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>%f<sp/>\n&quot;</highlight><highlight class="normal">,t,x[0],x[1],x[6],*ladeni_regulace,x[7],*(ladeni_regulace+2),x[4],x[5],x[3],x[2],Ww,*(ladeni_regulace+1),Urm_max,*(ladeni_regulace+4),*(ladeni_regulace+5),x[10],*(ladeni_regulace+6),Uc,<sp/>*(ladeni_regulace+7),ladeni_pila,ladeni_ur,*(ladeni_regulace+8),*(ladeni_regulace+9),ekf_estim[0],ekf_estim[1]);</highlight></codeline>
1064<codeline lineno="247"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>t,<sp/>Isx,<sp/>Isy,<sp/>Isd,<sp/>Isdw,<sp/>Isq,<sp/>Isqw,<sp/>M,<sp/>Fs,<sp/>poloha,<sp/>rychlost,<sp/>rychlost_w,<sp/>Urm,<sp/>Urm_max,</highlight><highlight class="normal"></highlight></codeline>
1065<codeline lineno="248"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>Fs_model,<sp/>M_model,<sp/>zatezny<sp/>uhel<sp/>(beta),<sp/>zatezny<sp/>uhel<sp/>vypocteny<sp/>z<sp/>napeti<sp/>(zbeta),<sp/>Uc</highlight><highlight class="normal"></highlight></codeline>
1066<codeline lineno="249"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>print_counter=0;</highlight></codeline>
1067<codeline lineno="250"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>}</highlight></codeline>
1068<codeline lineno="251"><highlight class="normal"></highlight></codeline>
1069<codeline lineno="252"><highlight class="normal"><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(h_disp&gt;0.2)</highlight></codeline>
1070<codeline lineno="253"><highlight class="normal"><sp/><sp/><sp/><sp/>{<sp/>printf(</highlight><highlight class="stringliteral">&quot;%f<sp/>\n&quot;</highlight><highlight class="normal">,t);</highlight></codeline>
1071<codeline lineno="254"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>h_disp=0;</highlight></codeline>
1072<codeline lineno="255"><highlight class="normal"><sp/><sp/><sp/><sp/>}</highlight></codeline>
1073<codeline lineno="256"><highlight class="normal"></highlight></codeline>
1074<codeline lineno="257"><highlight class="normal"><sp/><sp/><sp/><sp/>t+=h;</highlight></codeline>
1075<codeline lineno="258"><highlight class="normal"><sp/><sp/><sp/><sp/>hpom+=h;</highlight></codeline>
1076<codeline lineno="259"><highlight class="normal"><sp/><sp/><sp/><sp/>hpom_model+=h;</highlight></codeline>
1077<codeline lineno="260"><highlight class="normal"><sp/><sp/><sp/><sp/>h_model_counter++;</highlight></codeline>
1078<codeline lineno="261"><highlight class="normal"><sp/><sp/><sp/><sp/>h_disp+=h;</highlight></codeline>
1079<codeline lineno="262"><highlight class="normal"><sp/><sp/><sp/><sp/>print_counter++;</highlight></codeline>
1080<codeline lineno="263"><highlight class="normal"><sp/><sp/>}</highlight></codeline>
1081<codeline lineno="264"><highlight class="normal"></highlight></codeline>
1082<codeline lineno="265"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/>printf(&quot;***<sp/>\n\n&quot;);</highlight><highlight class="normal"></highlight></codeline>
1083<codeline lineno="266"><highlight class="normal"><sp/><sp/>fclose(fw);</highlight></codeline>
1084<codeline lineno="267"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">return</highlight><highlight class="normal"><sp/>0;</highlight></codeline>
1085<codeline lineno="268"><highlight class="normal"><sp/>}</highlight></codeline>
1086    </programlisting>
1087    <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/simul.cpp"/>
1088  </compounddef>
1089</doxygen>
Note: See TracBrowser for help on using the browser.