-
Notifications
You must be signed in to change notification settings - Fork 7
/
Copy pathkalman_analyse.py
executable file
·77 lines (70 loc) · 1.55 KB
/
kalman_analyse.py
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
#!/usr/bin/env python3
# -*- coding: utf-8 -*-
"""
Created on Tue Apr 12 15:53:02 2022
@author: yagmur
"""
import numpy as np
X1 = [[ 4.27363818e+01],
[ 6.35122464e+00],
[-5.32955389e-01],
[ 1.99697400e+00],
[ 3.77840710e+00],
[ 1.62410456e+00],
[ 1.54700295e+00],
[-6.12285297e-01],
[ 7.81320300e-02],
[ 5.38330069e-02],
[-1.06181081e-03]]
X2 = [[ 4.18774179e+01],
[ 6.30660468e+00],
[-6.51948888e-01],
[ 1.77286984e+00],
[ 3.76783180e+00],
[ 1.62502725e+00],
[ 1.55075733e+00],
[-4.83454716e-01],
[ 7.34556443e-03],
[-2.60360914e-02],
[-7.92821563e-02]]
X3 = [[ 4.06304344e+01],
[ 6.29968197e+00],
[-8.53415670e-01],
[ 1.88526684e+00],
[ 3.77606759e+00],
[ 1.62020162e+00],
[ 1.53737282e+00],
[-5.61451059e-01],
[ 1.32644129e-03],
[-6.76402095e-02],
[-3.82356298e-03]]
X4 = [[ 4.00025132e+01],
[ 6.39305548e+00],
[-9.41264060e-01],
[ 1.92070033e+00],
[ 3.80413504e+00],
[ 1.61211564e+00],
[ 1.52441172e+00],
[-5.82129886e-01],
[ 2.99622191e-02],
[-7.39269606e-02],
[ 8.38927963e-03]]
X5 = [[3.94390907e+01],
[6.42394946e+00],
[-9.41959896e-01],
[ 1.93084726e+00],
[ 3.88001355e+00],
[ 1.62483916e+00],
[ 1.53022490e+00],
[-5.75692093e-01],
[ 3.02828680e-02],
[-4.87259033e-02],
[ 8.99414182e-03]]
dist = np.linalg.norm(np.array(X1)-np.array(X2)) # 0.9156551594261944
print(dist)
dist = np.linalg.norm(np.array(X3)-np.array(X2)) # 1.2735982664905163
print(dist)
dist = np.linalg.norm(np.array(X4)-np.array(X3)) # 0.6437654627071023
print(dist)
dist = np.linalg.norm(np.array(X5)-np.array(X4)) # 0.5702043776814709
print(dist)