4 files changed, 4169 insertions, 0 deletions

diff --git a/SD-VBS/benchmarks/localization/data/sim/1.txt b/SD-VBS/benchmarks/localization/data/sim/1.txt
new file mode 100644
index 0000000..45e0aa5
--- /dev/null
+++ b/SD-VBS/benchmarks/localization/data/sim/1.txt
@@ -0,0 +1,89 @@
+5 88
+1116844391.040066 4 4422626.016689 483672.632936 33.995049 
+-0.000663 -0.000692 0.021303 9.463761 21.130848
+1116844391.227129 3 -0.093291 0.256632 9.634049
+1116844391.227129 2 0.010578 -0.007365 -0.001416
+1116844391.227168 1 -0.000000 0.000000 0.000000
+1116844391.237148 3 -0.096652 0.272799 9.624180
+1116844391.237148 2 0.015798 -0.008073 -0.007254
+1116844391.247181 3 -0.090515 0.261556 9.615353
+1116844391.247181 2 0.002099 0.000225 -0.007616
+1116844391.257148 3 -0.085976 0.240636 9.597824
+1116844391.257148 2 0.012628 0.005128 0.006299
+1116844391.267143 3 -0.104367 0.255003 9.615442
+1116844391.267143 2 0.017556 0.011023 -0.006589
+1116844391.277133 3 -0.112190 0.274331 9.618944
+1116844391.277133 2 0.025863 -0.013523 -0.002331
+1116844391.277173 1 -0.000000 0.000000 0.000000
+1116844391.287135 3 -0.093472 0.250217 9.618351
+1116844391.287135 2 0.024307 0.015800 -0.008811
+1116844391.297185 3 -0.094906 0.259862 9.630996
+1116844391.297185 2 0.002086 0.020161 0.005693
+1116844391.307142 3 -0.107477 0.275957 9.625149
+1116844391.307142 2 0.007412 -0.007638 0.003438
+1116844391.317280 3 -0.087117 0.266351 9.638790
+1116844391.317280 2 0.007944 0.002905 0.009063
+1116844391.327142 3 -0.083806 0.232450 9.635920
+1116844391.327142 2 -0.002186 -0.007303 -0.002470
+1116844391.327195 1 -0.000000 0.000000 0.000000
+1116844391.337139 3 -0.088611 0.256652 9.637110
+1116844391.337139 2 0.018712 -0.009002 0.000068
+1116844391.347169 3 -0.119894 0.283955 9.625427
+1116844391.347169 2 0.008961 -0.020078 -0.005236
+1116844391.357151 3 -0.093643 0.245413 9.604237
+1116844391.357151 2 -0.007274 0.004253 0.003544
+1116844391.367134 3 -0.109132 0.242096 9.599711
+1116844391.367134 2 0.010254 -0.001354 -0.007168
+1116844391.377130 3 -0.098272 0.261513 9.613113
+1116844391.377130 2 0.024695 0.003973 -0.010004
+1116844391.377335 1 -0.000000 0.000000 0.000000
+1116844391.387136 3 -0.085493 0.242148 9.631398
+1116844391.387136 2 0.018667 -0.014620 -0.001184
+1116844391.397172 3 -0.080866 0.230888 9.624932
+1116844391.397172 2 0.001064 0.020162 0.005671
+1116844391.407155 3 -0.087562 0.255152 9.602736
+1116844391.407155 2 0.007214 0.007715 -0.002903
+1116844391.417139 3 -0.098358 0.247013 9.599640
+1116844391.417139 2 0.020322 -0.001303 0.001078
+1116844391.427133 3 -0.085717 0.229291 9.609365
+1116844391.427133 2 0.016397 -0.004758 0.016558
+1116844391.427175 1 -0.000000 0.000000 0.000000
+1116844391.437139 3 -0.079424 0.253503 9.629919
+1116844391.437139 2 0.000389 0.000235 0.001411
+1116844391.447169 3 -0.102437 0.243642 9.635546
+1116844391.447169 2 0.024045 -0.007895 -0.010443
+1116844391.457145 3 -0.105676 0.245266 9.626246
+1116844391.457145 2 0.007637 0.005470 0.000232
+1116844391.467146 3 -0.079413 0.230918 9.618670
+1116844391.467146 2 0.002375 -0.000431 0.004049
+1116844391.477142 3 -0.096475 0.263084 9.631063
+1116844391.477142 2 0.009385 0.006065 -0.010352
+1116844391.487134 3 -0.112058 0.287208 9.634735
+1116844391.487134 2 0.002942 0.005215 0.004793
+1116844391.497175 3 -0.082458 0.235728 9.624242
+1116844391.497175 2 0.012165 -0.002726 -0.001159
+1116844391.507136 3 -0.104136 0.254955 9.631047
+1116844391.507136 2 0.011057 0.000532 0.005265
+1116844391.517304 3 -0.114911 0.251651 9.631923
+1116844391.517304 2 0.012523 0.006833 0.012757
+1116844391.527140 3 -0.088748 0.253455 9.626140
+1116844391.527140 2 0.013050 -0.005606 0.004062
+1116844391.527211 1 -0.000000 0.000000 0.000000
+1116844391.537137 3 -0.089157 0.264831 9.604456
+1116844391.537137 2 0.019766 -0.004421 0.001349
+1116844391.547164 3 -0.104299 0.258215 9.621731
+1116844391.547164 2 0.017782 0.017719 0.012267
+1116844391.557149 3 -0.104582 0.272792 9.610237
+1116844391.557149 2 0.009933 -0.004741 0.007095
+1116844391.567137 3 -0.104419 0.267919 9.618750
+1116844391.567137 2 0.015320 -0.009478 -0.009842
+1116844391.577132 3 -0.112248 0.274343 9.615043
+1116844391.577132 2 0.014851 -0.011780 0.012695
+1116844391.577349 1 -0.000000 0.000000 0.000000
+1116844391.587134 3 -0.099579 0.271132 9.634340
+1116844391.587134 2 0.004095 0.005577 -0.001659
+1116844391.597172 3 -0.096420 0.267911 9.637374
+1116844391.597172 2 0.013570 -0.000091 0.007137
+1116844391.607140 3 -0.122865 0.253262 9.617223
+1116844391.607140 2 0.007069 0.009807 0.005882
+1116844391.617132 3 -0.094853 0.245334 9.626884
diff --git a/SD-VBS/benchmarks/localization/data/sim/2.txt b/SD-VBS/benchmarks/localization/data/sim/2.txt
new file mode 100644
index 0000000..a89bc4e
--- /dev/null
+++ b/SD-VBS/benchmarks/localization/data/sim/2.txt
@@ -0,0 +1,4077 @@
+5 4076
+1116844391.040066 4 4422626.016689 483672.632936 33.995049 
+-0.000663 -0.000692 0.021303 9.463761 21.130848
+1116844391.227129 3 -0.093291 0.256632 9.634049
+1116844391.227129 2 0.010578 -0.007365 -0.001416
+1116844391.227168 1 -0.000000 0.000000 0.000000
+1116844391.237148 3 -0.096652 0.272799 9.624180
+1116844391.237148 2 0.015798 -0.008073 -0.007254
+1116844391.247181 3 -0.090515 0.261556 9.615353
+1116844391.247181 2 0.002099 0.000225 -0.007616
+1116844391.257148 3 -0.085976 0.240636 9.597824
+1116844391.257148 2 0.012628 0.005128 0.006299
+1116844391.267143 3 -0.104367 0.255003 9.615442
+1116844391.267143 2 0.017556 0.011023 -0.006589
+1116844391.277133 3 -0.112190 0.274331 9.618944
+1116844391.277133 2 0.025863 -0.013523 -0.002331
+1116844391.277173 1 -0.000000 0.000000 0.000000
+1116844391.287135 3 -0.093472 0.250217 9.618351
+1116844391.287135 2 0.024307 0.015800 -0.008811
+1116844391.297185 3 -0.094906 0.259862 9.630996
+1116844391.297185 2 0.002086 0.020161 0.005693
+1116844391.307142 3 -0.107477 0.275957 9.625149
+1116844391.307142 2 0.007412 -0.007638 0.003438
+1116844391.317280 3 -0.087117 0.266351 9.638790
+1116844391.317280 2 0.007944 0.002905 0.009063
+1116844391.327142 3 -0.083806 0.232450 9.635920
+1116844391.327142 2 -0.002186 -0.007303 -0.002470
+1116844391.327195 1 -0.000000 0.000000 0.000000
+1116844391.337139 3 -0.088611 0.256652 9.637110
+1116844391.337139 2 0.018712 -0.009002 0.000068
+1116844391.347169 3 -0.119894 0.283955 9.625427
+1116844391.347169 2 0.008961 -0.020078 -0.005236
+1116844391.357151 3 -0.093643 0.245413 9.604237
+1116844391.357151 2 -0.007274 0.004253 0.003544
+1116844391.367134 3 -0.109132 0.242096 9.599711
+1116844391.367134 2 0.010254 -0.001354 -0.007168
+1116844391.377130 3 -0.098272 0.261513 9.613113
+1116844391.377130 2 0.024695 0.003973 -0.010004
+1116844391.377335 1 -0.000000 0.000000 0.000000
+1116844391.387136 3 -0.085493 0.242148 9.631398
+1116844391.387136 2 0.018667 -0.014620 -0.001184
+1116844391.397172 3 -0.080866 0.230888 9.624932
+1116844391.397172 2 0.001064 0.020162 0.005671
+1116844391.407155 3 -0.087562 0.255152 9.602736
+1116844391.407155 2 0.007214 0.007715 -0.002903
+1116844391.417139 3 -0.098358 0.247013 9.599640
+1116844391.417139 2 0.020322 -0.001303 0.001078
+1116844391.427133 3 -0.085717 0.229291 9.609365
+1116844391.427133 2 0.016397 -0.004758 0.016558
+1116844391.427175 1 -0.000000 0.000000 0.000000
+1116844391.437139 3 -0.079424 0.253503 9.629919
+1116844391.437139 2 0.000389 0.000235 0.001411
+1116844391.447169 3 -0.102437 0.243642 9.635546
+1116844391.447169 2 0.024045 -0.007895 -0.010443
+1116844391.457145 3 -0.105676 0.245266 9.626246
+1116844391.457145 2 0.007637 0.005470 0.000232
+1116844391.467146 3 -0.079413 0.230918 9.618670
+1116844391.467146 2 0.002375 -0.000431 0.004049
+1116844391.477142 3 -0.096475 0.263084 9.631063
+1116844391.477142 2 0.009385 0.006065 -0.010352
+1116844391.487134 3 -0.112058 0.287208 9.634735
+1116844391.487134 2 0.002942 0.005215 0.004793
+1116844391.497175 3 -0.082458 0.235728 9.624242
+1116844391.497175 2 0.012165 -0.002726 -0.001159
+1116844391.507136 3 -0.104136 0.254955 9.631047
+1116844391.507136 2 0.011057 0.000532 0.005265
+1116844391.517304 3 -0.114911 0.251651 9.631923
+1116844391.517304 2 0.012523 0.006833 0.012757
+1116844391.527140 3 -0.088748 0.253455 9.626140
+1116844391.527140 2 0.013050 -0.005606 0.004062
+1116844391.527211 1 -0.000000 0.000000 0.000000
+1116844391.537137 3 -0.089157 0.264831 9.604456
+1116844391.537137 2 0.019766 -0.004421 0.001349
+1116844391.547164 3 -0.104299 0.258215 9.621731
+1116844391.547164 2 0.017782 0.017719 0.012267
+1116844391.557149 3 -0.104582 0.272792 9.610237
+1116844391.557149 2 0.009933 -0.004741 0.007095
+1116844391.567137 3 -0.104419 0.267919 9.618750
+1116844391.567137 2 0.015320 -0.009478 -0.009842
+1116844391.577132 3 -0.112248 0.274343 9.615043
+1116844391.577132 2 0.014851 -0.011780 0.012695
+1116844391.577349 1 -0.000000 0.000000 0.000000
+1116844391.587134 3 -0.099579 0.271132 9.634340
+1116844391.587134 2 0.004095 0.005577 -0.001659
+1116844391.597172 3 -0.096420 0.267911 9.637374
+1116844391.597172 2 0.013570 -0.000091 0.007137
+1116844391.607140 3 -0.122865 0.253262 9.617223
+1116844391.607140 2 0.007069 0.009807 0.005882
+1116844391.617132 3 -0.094853 0.245334 9.626884
+1116844391.617132 2 0.007970 0.004974 0.009047