diff --git a/data and figure/CMM.mat b/data and figure/CMM.mat
new file mode 100644
index 0000000..3909a1e
Binary files /dev/null and b/data and figure/CMM.mat differ
diff --git a/data and figure/complexity_error.fig b/data and figure/complexity_error.fig
new file mode 100644
index 0000000..bece1ab
Binary files /dev/null and b/data and figure/complexity_error.fig differ
diff --git a/data and figure/distance_and_gradient.mat b/data and figure/distance_and_gradient.mat
new file mode 100644
index 0000000..be2af85
Binary files /dev/null and b/data and figure/distance_and_gradient.mat differ
diff --git a/data and figure/histogram.fig b/data and figure/histogram.fig
new file mode 100644
index 0000000..0b3ad4e
Binary files /dev/null and b/data and figure/histogram.fig differ
diff --git a/data and figure/mp.mat b/data and figure/mp.mat
new file mode 100644
index 0000000..2f7f1a0
Binary files /dev/null and b/data and figure/mp.mat differ
diff --git a/data and figure/mp_0.mat b/data and figure/mp_0.mat
new file mode 100644
index 0000000..75e846b
Binary files /dev/null and b/data and figure/mp_0.mat differ
diff --git a/data and figure/mp_10.mat b/data and figure/mp_10.mat
new file mode 100644
index 0000000..d8e3049
Binary files /dev/null and b/data and figure/mp_10.mat differ
diff --git a/data and figure/mp_15.mat b/data and figure/mp_15.mat
new file mode 100644
index 0000000..f18c8e8
Binary files /dev/null and b/data and figure/mp_15.mat differ
diff --git a/data and figure/mp_20.mat b/data and figure/mp_20.mat
new file mode 100644
index 0000000..0b9f297
Binary files /dev/null and b/data and figure/mp_20.mat differ
diff --git a/data and figure/mp_25.mat b/data and figure/mp_25.mat
new file mode 100644
index 0000000..b1642d3
Binary files /dev/null and b/data and figure/mp_25.mat differ
diff --git a/data and figure/mp_30.mat b/data and figure/mp_30.mat
new file mode 100644
index 0000000..833e7ae
Binary files /dev/null and b/data and figure/mp_30.mat differ
diff --git a/data and figure/mp_x.mat b/data and figure/mp_x.mat
new file mode 100644
index 0000000..6acc586
Binary files /dev/null and b/data and figure/mp_x.mat differ
diff --git a/data and figure/mp_y.mat b/data and figure/mp_y.mat
new file mode 100644
index 0000000..780ffb3
Binary files /dev/null and b/data and figure/mp_y.mat differ
diff --git a/data and figure/position_5sv.fig b/data and figure/position_5sv.fig
new file mode 100644
index 0000000..7bf13db
Binary files /dev/null and b/data and figure/position_5sv.fig differ
diff --git a/data and figure/position_ego_rohani_RBPF.fig b/data and figure/position_ego_rohani_RBPF.fig
new file mode 100644
index 0000000..1f54bd6
Binary files /dev/null and b/data and figure/position_ego_rohani_RBPF.fig differ