-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathkalman_processdrawio
602 lines (602 loc) · 59.8 KB
/
kalman_processdrawio
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
<mxfile host="app.diagrams.net" agent="Mozilla/5.0 (Windows NT 10.0; Win64; x64) AppleWebKit/537.36 (KHTML, like Gecko) Chrome/128.0.0.0 Safari/537.36" version="24.7.10">
<diagram name="第 1 页" id="XWhpTU_hz3vh_mSnnv8q">
<mxGraphModel dx="2901" dy="2275" grid="0" gridSize="10" guides="1" tooltips="1" connect="1" arrows="1" fold="1" page="1" pageScale="1" pageWidth="827" pageHeight="1169" math="1" shadow="0">
<root>
<mxCell id="0" />
<mxCell id="1" parent="0" />
<mxCell id="w9xME0fOv28JvxVaqb8G-86" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#A9B8C6;" parent="1" vertex="1">
<mxGeometry x="506.86" y="436.14" width="149" height="34" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-49" value="<span style="forced-color-adjust: none; color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; float: none; display: inline !important; background-color: rgb(169, 184, 198);">输出：系统状态估计</span>" style="text;whiteSpace=wrap;html=1;opacity=0;" parent="1" vertex="1">
<mxGeometry x="514.08" y="436.14" width="132.42" height="25" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-104" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#bac8d3;strokeColor=#23445d;" parent="1" vertex="1">
<mxGeometry x="157" y="202" width="130" height="25" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-17" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" parent="1" vertex="1">
<mxGeometry x="-11" y="240" width="473" height="166" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-85" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#A9B8C6;" parent="1" vertex="1">
<mxGeometry x="405" y="474.5" width="149" height="34" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-12" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#d0cee2;strokeColor=#56517e;" parent="1" vertex="1">
<mxGeometry x="560" y="247.75" width="214" height="140" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-73" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#d5e8d4;strokeColor=#82b366;" parent="1" vertex="1">
<mxGeometry x="579.08" y="305.25" width="171" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-74" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#dae8fc;strokeColor=#6c8ebf;" parent="1" vertex="1">
<mxGeometry x="579.08" y="358.25" width="171" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-90" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=-0.005;entryY=0.628;entryDx=0;entryDy=0;entryPerimeter=0;strokeColor=#6C8EBF;" parent="1" source="w9xME0fOv28JvxVaqb8G-72" target="w9xME0fOv28JvxVaqb8G-22" edge="1">
<mxGeometry relative="1" as="geometry">
<mxPoint x="95" y="534" as="targetPoint" />
<Array as="points">
<mxPoint x="863" y="346" />
<mxPoint x="863" y="424" />
<mxPoint x="-25" y="424" />
<mxPoint x="-25" y="287" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-72" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#dae8fc;strokeColor=#6c8ebf;" parent="1" vertex="1">
<mxGeometry x="593.58" y="334.25" width="137" height="21" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-7" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#eeeeee;strokeColor=#36393d;" parent="1" vertex="1">
<mxGeometry x="494.15" y="94.13999999999999" width="287.42" height="79.78" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-67" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#fad9d5;strokeColor=#ae4132;" parent="1" vertex="1">
<mxGeometry x="506.5" y="133.35" width="141" height="32" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-68" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#fad9d5;strokeColor=#ae4132;" parent="1" vertex="1">
<mxGeometry x="656.5" y="133.35" width="116.42" height="32" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-2" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#eeeeee;strokeColor=#36393d;" parent="1" vertex="1">
<mxGeometry x="50" y="93" width="291" height="71" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-65" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#bac8d3;strokeColor=#23445d;" parent="1" vertex="1">
<mxGeometry x="64" y="124" width="104" height="32" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-66" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#bac8d3;strokeColor=#23445d;" parent="1" vertex="1">
<mxGeometry x="230" y="124" width="104" height="32" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-59" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#f5f5f5;fontColor=#333333;strokeColor=#666666;" parent="1" vertex="1">
<mxGeometry x="-4" y="316" width="229" height="29" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-61" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#b0e3e6;strokeColor=#0e8088;" parent="1" vertex="1">
<mxGeometry x="156" y="375.5" width="297" height="22.5" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-62" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#e1d5e7;strokeColor=#9673a6;" parent="1" vertex="1">
<mxGeometry x="245" y="297.5" width="202" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-82" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;exitX=1;exitY=0.5;exitDx=0;exitDy=0;strokeColor=#0E8088;entryX=-0.005;entryY=0.545;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" source="w9xME0fOv28JvxVaqb8G-58" target="w9xME0fOv28JvxVaqb8G-72" edge="1">
<mxGeometry relative="1" as="geometry">
<mxPoint x="588" y="345" as="targetPoint" />
<Array as="points">
<mxPoint x="388" y="346" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-58" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#b0e3e6;strokeColor=#0e8088;" parent="1" vertex="1">
<mxGeometry x="268" y="330" width="120" height="35" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-83" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;fillColor=#e1d5e7;strokeColor=#9673A6;entryX=-0.001;entryY=0.336;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" source="w9xME0fOv28JvxVaqb8G-57" target="w9xME0fOv28JvxVaqb8G-14" edge="1">
<mxGeometry relative="1" as="geometry">
<Array as="points">
<mxPoint x="521" y="279" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-57" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#e1d5e7;strokeColor=#9673a6;" parent="1" vertex="1">
<mxGeometry x="268" y="263" width="120" height="32" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-56" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#f5f5f5;strokeColor=#666666;fontColor=#333333;" parent="1" vertex="1">
<mxGeometry x="46" y="269.5" width="104" height="32" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-3" value="测量" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="61" y="89.78" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-4" value="输入：<div>测量不确定性</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="66" y="125" width="94" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-5" value="输入：<div>测量值</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="230" y="124" width="91" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-6" value="步骤1" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" parent="1" vertex="1">
<mxGeometry x="301" y="80.57" width="78" height="28" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-8" value="初始化" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="505.78" y="96.57" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-9" value="输入：<div>估计不确定性的初始猜测</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="506.5" y="134.35" width="135" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-10" value="输入：<div>系统状态的初始猜测</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="656.5" y="134.35" width="120" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-11" value="步骤0" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" parent="1" vertex="1">
<mxGeometry x="748.9999999999999" y="80.57" width="64" height="28" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-13" value="预测" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="556" y="243" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-96" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;exitX=1;exitY=0.5;exitDx=0;exitDy=0;entryX=0.539;entryY=0.025;entryDx=0;entryDy=0;entryPerimeter=0;strokeColor=#82B366;" parent="1" source="w9xME0fOv28JvxVaqb8G-14" target="w9xME0fOv28JvxVaqb8G-57" edge="1">
<mxGeometry relative="1" as="geometry">
<mxPoint x="611" y="207" as="targetPoint" />
<Array as="points">
<mxPoint x="731" y="286" />
<mxPoint x="862" y="286" />
<mxPoint x="862" y="207" />
<mxPoint x="333" y="207" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-14" value="利用系统动态模型计算下一次迭代的预测状态" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;fillColor=#d5e8d4;strokeColor=#82b366;" parent="1" vertex="1">
<mxGeometry x="590.58" y="269.25" width="140" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-15" value="外推估计不确定性" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="601.94" y="331.25" width="120" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-16" value="步骤3" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" parent="1" vertex="1">
<mxGeometry x="735" y="227" width="78" height="41" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-18" value="更新" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="-10" y="240.5" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-19" value="使用状态更新方程估计当前状态" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="276.5" y="265" width="96" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-20" value="更新当前估计不确定性" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="291.5" y="332.5" width="81" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-21" value="步骤2" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" parent="1" vertex="1">
<mxGeometry x="422" y="218" width="80" height="45" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-78" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;strokeColor=#666666;" parent="1" edge="1">
<mxGeometry relative="1" as="geometry">
<mxPoint x="150" y="278" as="sourcePoint" />
<mxPoint x="267" y="278" as="targetPoint" />
<Array as="points">
<mxPoint x="150" y="278" />
<mxPoint x="209" y="278" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-79" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=-0.009;entryY=0.534;entryDx=0;entryDy=0;entryPerimeter=0;strokeColor=#666666;" parent="1" edge="1">
<mxGeometry relative="1" as="geometry">
<mxPoint x="150" y="293" as="sourcePoint" />
<mxPoint x="267.99999999999983" y="347.48999999999995" as="targetPoint" />
<Array as="points">
<mxPoint x="236.08" y="292.8" />
<mxPoint x="236.08" y="347.8" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-22" value="计算卡尔曼增益" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" parent="1" vertex="1">
<mxGeometry x="46" y="268" width="102.5" height="30" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-29" value="$$P_{k,k}=(I-K_{k}H)P_{k,k-1}(I-K_{k}H)^{T}+K_{k}R_{k}K_{k}^{T}$$" style="text;whiteSpace=wrap;" parent="1" vertex="1">
<mxGeometry x="156" y="360.5" width="293" height="44" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-31" value="$$K_{k}=P_{k,k-1}H^{T}(HP_{k,k-1}{H}^{T}+R_{k})^{-1}$$" style="text;whiteSpace=wrap;" parent="1" vertex="1">
<mxGeometry x="-4" y="301.5" width="224" height="36" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-32" value="$$Z_k=H\times x_{k,k}+v_k$$" style="text;whiteSpace=wrap;" parent="1" vertex="1">
<mxGeometry x="162" y="186.86" width="120" height="36" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-33" value="$$\hat{x}_{k,k}={{\hat{x}_{k,k-1}+K_{k}(z_{k}-H\hat{x}_{k,k-1})}}$$" style="text;whiteSpace=wrap;" parent="1" vertex="1">
<mxGeometry x="245" y="284" width="201" height="35" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-34" value="$${{P_{k+1,k}=FP_{k,k}F^{T}+Q}}$$" style="text;whiteSpace=wrap;" parent="1" vertex="1">
<mxGeometry x="599.08" y="348.25" width="140" height="36" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-35" value="$$\hat{x}_{k+1,k}=F\hat{x}_{k,k}+Gu_{k}$$" style="text;whiteSpace=wrap;" parent="1" vertex="1">
<mxGeometry x="593.3000000000001" y="291.25" width="137.28" height="36" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-36" value="$$p_{0,0}$$" style="text;whiteSpace=wrap;" parent="1" vertex="1">
<mxGeometry x="580" y="164" width="54.84" height="35.86" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-37" value="$$\hat{x}_{0,0}$$" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="661.5" y="176" width="110" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-38" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$Z_k$$</span>" style="text;whiteSpace=wrap;html=1;" parent="1" vertex="1">
<mxGeometry x="266.5" y="164" width="25" height="36" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-39" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$R_k$$</span>" style="text;whiteSpace=wrap;html=1;" parent="1" vertex="1">
<mxGeometry x="74.5" y="174" width="25" height="36" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-40" value="$$K_k$$" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="174" y="256" width="65" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-41" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$p_{k,k}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="440" y="321.5" width="81" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-42" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$\hat{x}_{k,k}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="384" y="254" width="109" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-43" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$p_{k,k-1}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="781.57" y="375.75" width="92" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-44" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$p_{k,k}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="499" y="474.5" width="81" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-45" value="<div><br></div>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="625" y="445.14" width="18" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-50" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$\hat{x}_{k,k}$$</span>" style="text;whiteSpace=wrap;html=1;" parent="1" vertex="1">
<mxGeometry x="628.86" y="424" width="29" height="37.14" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-52" value="输出：估计不确定性" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="402" y="474.5" width="126" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-53" value="单步迭代延迟" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#d0cee2;strokeColor=#56517e;" parent="1" vertex="1">
<mxGeometry x="838.6500000000001" y="266.25" width="48" height="100.5" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-54" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$\hat{x}_{k,k-1}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" parent="1" vertex="1">
<mxGeometry x="788" y="240" width="119" height="26" as="geometry" />
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-75" value="" style="endArrow=classic;html=1;rounded=0;exitX=0.374;exitY=1.002;exitDx=0;exitDy=0;exitPerimeter=0;" parent="1" source="w9xME0fOv28JvxVaqb8G-65" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="102.77999999999997" y="121.38000000000002" as="sourcePoint" />
<mxPoint x="102" y="269" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-76" value="" style="endArrow=classic;html=1;rounded=0;entryX=0.228;entryY=0.018;entryDx=0;entryDy=0;entryPerimeter=0;exitX=0.632;exitY=1.008;exitDx=0;exitDy=0;exitPerimeter=0;" parent="1" source="w9xME0fOv28JvxVaqb8G-66" target="w9xME0fOv28JvxVaqb8G-57" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="296" y="157" as="sourcePoint" />
<mxPoint x="267.72" y="278.12" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-84" value="" style="endArrow=classic;html=1;rounded=0;exitX=0.381;exitY=0.963;exitDx=0;exitDy=0;exitPerimeter=0;strokeColor=#0E8088;entryX=0.549;entryY=-0.006;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="469.0010000000003" y="346.69800000000004" as="sourcePoint" />
<mxPoint x="469.31399999999996" y="474.50399999999985" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-87" value="" style="endArrow=classic;html=1;rounded=0;strokeColor=#9673A6;entryX=0.17;entryY=-0.02;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="533" y="280" as="sourcePoint" />
<mxPoint x="533.5913999999998" y="436.1399999999999" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-91" value="" style="endArrow=classic;html=1;rounded=0;entryX=0;entryY=0.75;entryDx=0;entryDy=0;strokeColor=#6C8EBF;" parent="1" target="w9xME0fOv28JvxVaqb8G-58" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="83" y="424" as="sourcePoint" />
<mxPoint x="131" y="514" as="targetPoint" />
<Array as="points">
<mxPoint x="83" y="356" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-95" value="" style="endArrow=none;dashed=1;html=1;rounded=0;entryX=0.001;entryY=0.793;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" target="w9xME0fOv28JvxVaqb8G-53" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="863" y="367" as="sourcePoint" />
<mxPoint x="838.6500000000001" y="344.9999999999998" as="targetPoint" />
<Array as="points">
<mxPoint x="863" y="346" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-98" value="" style="endArrow=none;dashed=1;html=1;rounded=0;exitX=0.007;exitY=0.198;exitDx=0;exitDy=0;exitPerimeter=0;entryX=0.622;entryY=0.999;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" source="w9xME0fOv28JvxVaqb8G-53" target="w9xME0fOv28JvxVaqb8G-54" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="838.6480000000004" y="285.34549999999996" as="sourcePoint" />
<mxPoint x="861.4000000000001" y="266.25049999999993" as="targetPoint" />
<Array as="points">
<mxPoint x="862" y="286" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-102" value="" style="endArrow=none;dashed=1;html=1;rounded=0;exitX=0.17;exitY=-0.015;exitDx=0;exitDy=0;exitPerimeter=0;entryX=0.786;entryY=1.003;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" target="w9xME0fOv28JvxVaqb8G-9" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="613.1600000000001" y="267.99999999999994" as="sourcePoint" />
<mxPoint x="613" y="191" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="w9xME0fOv28JvxVaqb8G-103" value="" style="endArrow=none;dashed=1;html=1;rounded=0;entryX=0.321;entryY=1.018;entryDx=0;entryDy=0;entryPerimeter=0;" parent="1" target="w9xME0fOv28JvxVaqb8G-10" edge="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="695" y="267" as="sourcePoint" />
<mxPoint x="694.6599999999999" y="150.89000000000007" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-1" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#A9B8C6;" vertex="1" parent="1">
<mxGeometry x="378.29" y="998.14" width="155.14" height="31.86" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-2" value="<span style="forced-color-adjust: none; color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; float: none; display: inline !important; background-color: rgb(169, 184, 198);">输出：系统状态估计</span>" style="text;whiteSpace=wrap;html=1;opacity=0;" vertex="1" parent="1">
<mxGeometry x="385.51000000000005" y="998.14" width="132.42" height="28.86" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-3" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#bac8d3;strokeColor=#23445d;" vertex="1" parent="1">
<mxGeometry x="32.93000000000001" y="764" width="130" height="25" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-4" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" vertex="1" parent="1">
<mxGeometry x="-139.57" y="802" width="473" height="166" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-5" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#A9B8C6;" vertex="1" parent="1">
<mxGeometry x="276.43" y="1036.5" width="149" height="32.5" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-6" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#d0cee2;strokeColor=#56517e;" vertex="1" parent="1">
<mxGeometry x="431.43" y="809.75" width="214" height="140" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-7" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#d5e8d4;strokeColor=#82b366;" vertex="1" parent="1">
<mxGeometry x="450.51000000000005" y="867.25" width="171" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-8" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#dae8fc;strokeColor=#6c8ebf;" vertex="1" parent="1">
<mxGeometry x="450.51000000000005" y="920.25" width="171" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-9" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=-0.005;entryY=0.628;entryDx=0;entryDy=0;entryPerimeter=0;strokeColor=#6C8EBF;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-10" target="fHBM8FORYuvSWJG8g_dD-43">
<mxGeometry relative="1" as="geometry">
<mxPoint x="-33.56999999999999" y="1096" as="targetPoint" />
<Array as="points">
<mxPoint x="734.4300000000001" y="908" />
<mxPoint x="734.4300000000001" y="986" />
<mxPoint x="-153.57" y="986" />
<mxPoint x="-153.57" y="849" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-10" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#dae8fc;strokeColor=#6c8ebf;" vertex="1" parent="1">
<mxGeometry x="465.01000000000005" y="896.25" width="137" height="21" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-11" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#eeeeee;strokeColor=#36393d;" vertex="1" parent="1">
<mxGeometry x="365.58" y="656.14" width="287.42" height="79.78" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-12" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#fad9d5;strokeColor=#ae4132;" vertex="1" parent="1">
<mxGeometry x="377.93" y="695.35" width="141" height="32" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-13" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#fad9d5;strokeColor=#ae4132;" vertex="1" parent="1">
<mxGeometry x="527.9300000000001" y="695.35" width="116.42" height="32" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-14" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#eeeeee;strokeColor=#36393d;" vertex="1" parent="1">
<mxGeometry x="-78.57" y="655" width="291" height="71" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-15" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#bac8d3;strokeColor=#23445d;" vertex="1" parent="1">
<mxGeometry x="-64.57" y="686" width="104" height="32" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-16" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#bac8d3;strokeColor=#23445d;" vertex="1" parent="1">
<mxGeometry x="101.43" y="686" width="104" height="32" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-17" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#f5f5f5;fontColor=#333333;strokeColor=#666666;" vertex="1" parent="1">
<mxGeometry x="-132.57" y="878" width="229" height="29" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-18" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#b0e3e6;strokeColor=#0e8088;" vertex="1" parent="1">
<mxGeometry x="27.430000000000007" y="937.5" width="297" height="22.5" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-19" value="" style="rounded=1;whiteSpace=wrap;html=1;fillColor=#e1d5e7;strokeColor=#9673a6;" vertex="1" parent="1">
<mxGeometry x="116.43" y="859.5" width="215" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-20" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;exitX=1;exitY=0.5;exitDx=0;exitDy=0;strokeColor=#0E8088;entryX=-0.005;entryY=0.545;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-21" target="fHBM8FORYuvSWJG8g_dD-10">
<mxGeometry relative="1" as="geometry">
<mxPoint x="459.43" y="907" as="targetPoint" />
<Array as="points">
<mxPoint x="259.43" y="908" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-21" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#b0e3e6;strokeColor=#0e8088;" vertex="1" parent="1">
<mxGeometry x="139.43" y="892" width="120" height="35" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-22" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;fillColor=#e1d5e7;strokeColor=#9673A6;entryX=-0.001;entryY=0.336;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-23" target="fHBM8FORYuvSWJG8g_dD-35">
<mxGeometry relative="1" as="geometry">
<Array as="points">
<mxPoint x="392.43" y="841" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-23" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#e1d5e7;strokeColor=#9673a6;" vertex="1" parent="1">
<mxGeometry x="139.43" y="825" width="120" height="32" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-24" value="" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#f5f5f5;strokeColor=#666666;fontColor=#333333;" vertex="1" parent="1">
<mxGeometry x="-82.57" y="831.5" width="104" height="32" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-25" value="测量" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="-67.57" y="651.78" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-26" value="输入：<div>测量不确定性</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="-62.56999999999999" y="687" width="94" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-27" value="输入：<div>测量值</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="101.43" y="686" width="91" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-28" value="步骤1" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" vertex="1" parent="1">
<mxGeometry x="172.43" y="640" width="79" height="30.57" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-29" value="初始化" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="377.21" y="658.5699999999999" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-30" value="输入：<div>估计不确定性的初始猜测</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="377.93" y="696.35" width="135" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-31" value="输入：<div>系统状态的初始猜测</div>" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="527.9300000000001" y="696.35" width="120" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-32" value="步骤0" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" vertex="1" parent="1">
<mxGeometry x="620.4299999999998" y="642.5699999999999" width="64" height="28" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-33" value="预测" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="427.43" y="805" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-34" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;exitX=1;exitY=0.5;exitDx=0;exitDy=0;entryX=0.539;entryY=0.025;entryDx=0;entryDy=0;entryPerimeter=0;strokeColor=#82B366;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-35" target="fHBM8FORYuvSWJG8g_dD-23">
<mxGeometry relative="1" as="geometry">
<mxPoint x="482.43" y="769" as="targetPoint" />
<Array as="points">
<mxPoint x="602.4300000000001" y="848" />
<mxPoint x="733.4300000000001" y="848" />
<mxPoint x="733.4300000000001" y="769" />
<mxPoint x="204.43" y="769" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-35" value="利用系统动态模型计算下一次迭代的预测状态" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;fillColor=#d5e8d4;strokeColor=#82b366;" vertex="1" parent="1">
<mxGeometry x="462.01000000000005" y="831.25" width="140" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-36" value="外推估计不确定性" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="473.37000000000006" y="893.25" width="120" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-37" value="步骤3" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" vertex="1" parent="1">
<mxGeometry x="606.4300000000001" y="789" width="78" height="41" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-38" value="更新" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="-138.57" y="802.5" width="60" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-39" value="使用状态更新方程估计当前状态" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="147.93" y="827" width="96" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-40" value="更新当前估计不确定性" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="162.93" y="894.5" width="81" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-41" value="步骤2" style="rhombus;whiteSpace=wrap;html=1;fillColor=#f9f7ed;strokeColor=#36393d;" vertex="1" parent="1">
<mxGeometry x="293.43" y="780" width="80" height="45" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-42" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=-0.009;entryY=0.534;entryDx=0;entryDy=0;entryPerimeter=0;strokeColor=#666666;" edge="1" parent="1">
<mxGeometry relative="1" as="geometry">
<mxPoint x="21.430000000000007" y="855" as="sourcePoint" />
<mxPoint x="139.42999999999984" y="909.49" as="targetPoint" />
<Array as="points">
<mxPoint x="107.51000000000005" y="854.8" />
<mxPoint x="107.51000000000005" y="909.8" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-43" value="计算卡尔曼增益&nbsp;" style="text;html=1;align=center;verticalAlign=middle;whiteSpace=wrap;rounded=0;" vertex="1" parent="1">
<mxGeometry x="-82.57" y="830" width="102.5" height="30" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-44" value="$$P_{k/k}=(I-K_{k}H)P_{k/k-1}(I-K_{k}H)^{T}+K_{k}R_{k}K_{k}^{T}$$" style="text;whiteSpace=wrap;" vertex="1" parent="1">
<mxGeometry x="27.430000000000007" y="922.5" width="293" height="44" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-45" value="$$K_{k}=P_{k/k-1}H^{T}(HP_{k/k-1}{H}^{T}+R_{k})^{-1}$$" style="text;whiteSpace=wrap;" vertex="1" parent="1">
<mxGeometry x="-132.57" y="863.5" width="224" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-46" value="$$Z_k=H\times X_{k}+v_k$$" style="text;whiteSpace=wrap;" vertex="1" parent="1">
<mxGeometry x="35.43000000000001" y="750" width="120" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-47" value="$$\hat{X}_{k/k}={{\hat{X}_{k/k-1}+K_{k}(Z_{k}-H\hat{X}_{k/k-1})}}$$" style="text;whiteSpace=wrap;" vertex="1" parent="1">
<mxGeometry x="114.43" y="844" width="190" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-48" value="$${{P_{k+1/k}=FP_{k,k}F^{T}+Q}}$$" style="text;whiteSpace=wrap;" vertex="1" parent="1">
<mxGeometry x="470.51000000000005" y="910.25" width="140" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-49" value="$$\hat{X}_{k+1/k}=F\hat{X}_{k,k}+Gu_{k}$$" style="text;whiteSpace=wrap;" vertex="1" parent="1">
<mxGeometry x="464.7300000000001" y="853.25" width="137.28" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-50" value="$$P_{0/0}$$" style="text;whiteSpace=wrap;" vertex="1" parent="1">
<mxGeometry x="451.43" y="726" width="54.84" height="35.86" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-51" value="$$\hat{X}_{0/0}$$" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="531.9300000000001" y="738" width="112" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-52" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$Z_k$$</span>" style="text;whiteSpace=wrap;html=1;" vertex="1" parent="1">
<mxGeometry x="137.93" y="726" width="25" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-53" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$R_k$$</span>" style="text;whiteSpace=wrap;html=1;" vertex="1" parent="1">
<mxGeometry x="-54.06999999999999" y="736" width="25" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-54" value="$$K_k$$" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="45.43000000000001" y="818" width="65" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-55" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$P_{k/k}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="310.43" y="883.5" width="83" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-56" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$\hat{X}_{k/k}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="313.43" y="815" width="111" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-57" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$P_{k/k-1}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="653" y="937.75" width="93" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-58" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$P_{k,k}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="362.43" y="1036.5" width="83" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-59" value="<div><br></div>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="496.43" y="1007.14" width="18" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-60" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$\hat{X}_{k,k}$$</span>" style="text;whiteSpace=wrap;html=1;" vertex="1" parent="1">
<mxGeometry x="500.29" y="986" width="29" height="37.14" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-61" value="输出：估计不确定性" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="273.43" y="1036.5" width="126" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-62" value="单步迭代延迟" style="rounded=0;whiteSpace=wrap;html=1;fillColor=#d0cee2;strokeColor=#56517e;" vertex="1" parent="1">
<mxGeometry x="710.0800000000002" y="828.25" width="48" height="100.5" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-63" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: left; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(251, 251, 251); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$\hat{X}_{k/k-1}$$</span>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="653" y="801" width="121" height="26" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-64" value="" style="endArrow=classic;html=1;rounded=0;exitX=0.374;exitY=1.002;exitDx=0;exitDy=0;exitPerimeter=0;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-15">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="-25.79000000000002" y="683.38" as="sourcePoint" />
<mxPoint x="-26.569999999999993" y="831" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-65" value="" style="endArrow=classic;html=1;rounded=0;entryX=0.228;entryY=0.018;entryDx=0;entryDy=0;entryPerimeter=0;exitX=0.632;exitY=1.008;exitDx=0;exitDy=0;exitPerimeter=0;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-16" target="fHBM8FORYuvSWJG8g_dD-23">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="167.43" y="719" as="sourcePoint" />
<mxPoint x="139.15000000000003" y="840.12" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-66" value="" style="endArrow=classic;html=1;rounded=0;exitX=0.381;exitY=0.963;exitDx=0;exitDy=0;exitPerimeter=0;strokeColor=#0E8088;entryX=0.549;entryY=-0.006;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="340.4310000000003" y="908.6980000000001" as="sourcePoint" />
<mxPoint x="340.74399999999997" y="1036.504" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-67" value="" style="endArrow=classic;html=1;rounded=0;strokeColor=#9673A6;entryX=0.17;entryY=-0.02;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="404.43" y="842" as="sourcePoint" />
<mxPoint x="405.0213999999998" y="998.1399999999999" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-68" value="" style="endArrow=classic;html=1;rounded=0;entryX=0;entryY=0.75;entryDx=0;entryDy=0;strokeColor=#6C8EBF;" edge="1" parent="1" target="fHBM8FORYuvSWJG8g_dD-21">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="-45.56999999999999" y="986" as="sourcePoint" />
<mxPoint x="2.430000000000007" y="1076" as="targetPoint" />
<Array as="points">
<mxPoint x="-45.56999999999999" y="918" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-69" value="" style="endArrow=none;dashed=1;html=1;rounded=0;entryX=0.001;entryY=0.793;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1" target="fHBM8FORYuvSWJG8g_dD-62">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="734.4300000000001" y="929" as="sourcePoint" />
<mxPoint x="710.0800000000002" y="906.9999999999998" as="targetPoint" />
<Array as="points">
<mxPoint x="734.4300000000001" y="908" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-70" value="" style="endArrow=none;dashed=1;html=1;rounded=0;exitX=0.007;exitY=0.198;exitDx=0;exitDy=0;exitPerimeter=0;entryX=0.486;entryY=0;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-62" target="fHBM8FORYuvSWJG8g_dD-62">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="710.0780000000004" y="847.3454999999999" as="sourcePoint" />
<mxPoint x="732.8300000000002" y="828.2504999999999" as="targetPoint" />
<Array as="points">
<mxPoint x="733.4300000000001" y="848" />
</Array>
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-71" value="" style="endArrow=none;dashed=1;html=1;rounded=0;exitX=0.17;exitY=-0.015;exitDx=0;exitDy=0;exitPerimeter=0;entryX=0.786;entryY=1.003;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1" target="fHBM8FORYuvSWJG8g_dD-30">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="484.5900000000001" y="830" as="sourcePoint" />
<mxPoint x="484.43" y="753" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-72" value="" style="endArrow=none;dashed=1;html=1;rounded=0;entryX=0.321;entryY=1.018;entryDx=0;entryDy=0;entryPerimeter=0;" edge="1" parent="1" target="fHBM8FORYuvSWJG8g_dD-31">
<mxGeometry width="50" height="50" relative="1" as="geometry">
<mxPoint x="566.4300000000001" y="829" as="sourcePoint" />
<mxPoint x="566.0899999999999" y="712.8900000000001" as="targetPoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-73" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=0.005;entryY=0.47;entryDx=0;entryDy=0;entryPerimeter=0;exitX=1;exitY=0.422;exitDx=0;exitDy=0;exitPerimeter=0;strokeColor=#666666;" edge="1" parent="1" source="fHBM8FORYuvSWJG8g_dD-24" target="fHBM8FORYuvSWJG8g_dD-23">
<mxGeometry relative="1" as="geometry">
<mxPoint x="22.430000000000007" y="845" as="sourcePoint" />
</mxGeometry>
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-74" value="<span style="color: rgb(0, 0, 0); font-family: Helvetica; font-size: 12px; font-style: normal; font-variant-ligatures: normal; font-variant-caps: normal; font-weight: 400; letter-spacing: normal; orphans: 2; text-align: center; text-indent: 0px; text-transform: none; widows: 2; word-spacing: 0px; -webkit-text-stroke-width: 0px; white-space: normal; background-color: rgb(255, 255, 255); text-decoration-thickness: initial; text-decoration-style: initial; text-decoration-color: initial; display: inline !important; float: none;">$$K_k$$</span>" style="text;whiteSpace=wrap;html=1;" vertex="1" parent="1">
<mxGeometry x="-84.07" y="1093.33" width="27.5" height="36" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-75" value="<font style="font-size: 48px;">old</font>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="266" y="-9" width="82" height="70" as="geometry" />
</mxCell>
<mxCell id="fHBM8FORYuvSWJG8g_dD-76" value="<font style="font-size: 36px;">new</font>" style="text;html=1;align=center;verticalAlign=middle;resizable=0;points=[];autosize=1;strokeColor=none;fillColor=none;" vertex="1" parent="1">
<mxGeometry x="182" y="533" width="84" height="55" as="geometry" />
</mxCell>
</root>
</mxGraphModel>
</diagram>
</mxfile>