[187] | 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/><stdio.h></highlight><highlight class="normal"></highlight></codeline> |
---|
| 832 | <codeline lineno="15"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/><math.h></highlight><highlight class="normal"></highlight></codeline> |
---|
| 833 | <codeline lineno="16"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"pmsm_mod.h"</highlight><highlight class="normal"></highlight></codeline> |
---|
| 834 | <codeline lineno="17"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"pwm.h"</highlight><highlight class="normal"></highlight></codeline> |
---|
| 835 | <codeline lineno="18"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"regulace.h"</highlight><highlight class="normal"></highlight></codeline> |
---|
| 836 | <codeline lineno="19"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"ekf.h"</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">"data/graf1.txt"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"w"</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<=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,&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>=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>-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/>=><sp/>reg_counter>-1,<sp/>jinak<sp/>jako<sp/>u<sp/>ASM<sp/>reg_counter>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>.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>30.)<sp/>{Iqwf=30.;<sp/>if<sp/>(k_rampa_tmp<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<-30.)<sp/>{Iqwf=-30.;<sp/>if<sp/>(k_rampa_tmp<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>3.)<sp/>&&<sp/>(Iqwf>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>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<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>-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>2.*M_PI*150.)<sp/>{Ww=2.*M_PI*150.;<sp/>if<sp/>(k_rampa_tmp<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<-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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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>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]>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]<-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]>1615)<sp/>{x[2]=1615;<sp/>if<sp/>(k_rampa_tmp<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]<-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>=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>199)</highlight></codeline> |
---|
| 1063 | <codeline lineno="246"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/>{<sp/>fprintf(fw,</highlight><highlight class="stringliteral">"%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"</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>0.2)</highlight></codeline> |
---|
| 1070 | <codeline lineno="253"><highlight class="normal"><sp/><sp/><sp/><sp/>{<sp/>printf(</highlight><highlight class="stringliteral">"%f<sp/>\n"</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("***<sp/>\n\n");</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> |
---|