diff --git a/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_tx_first_scan/align_int_enc_Rz_tx_first_scan.h5 b/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_tx_first_scan/align_int_enc_Rz_tx_first_scan.h5
new file mode 100644
index 0000000..17fd420
Binary files /dev/null and b/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_tx_first_scan/align_int_enc_Rz_tx_first_scan.h5 differ
diff --git a/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_verif-after-correct-offset/align_int_enc_Rz_verif-after-correct-offset.h5 b/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_verif-after-correct-offset/align_int_enc_Rz_verif-after-correct-offset.h5
new file mode 100644
index 0000000..078aae5
Binary files /dev/null and b/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_verif-after-correct-offset/align_int_enc_Rz_verif-after-correct-offset.h5 differ
diff --git a/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_verif-after-offset/align_int_enc_Rz_verif-after-offset.h5 b/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_verif-after-offset/align_int_enc_Rz_verif-after-offset.h5
new file mode 100644
index 0000000..7248fbd
Binary files /dev/null and b/matlab/mat/align_int_enc_Rz/align_int_enc_Rz_verif-after-offset/align_int_enc_Rz_verif-after-offset.h5 differ
diff --git a/matlab/mat/align_int_enc_Rz/id31nass_align_int_enc_Rz.h5 b/matlab/mat/align_int_enc_Rz/id31nass_align_int_enc_Rz.h5
new file mode 100644
index 0000000..e912d80
Binary files /dev/null and b/matlab/mat/align_int_enc_Rz/id31nass_align_int_enc_Rz.h5 differ
diff --git a/matlab/mat/alignment/alignment_h1dx_h1dy/alignment_h1dx_h1dy.h5 b/matlab/mat/alignment/alignment_h1dx_h1dy/alignment_h1dx_h1dy.h5
new file mode 100644
index 0000000..32b7b37
Binary files /dev/null and b/matlab/mat/alignment/alignment_h1dx_h1dy/alignment_h1dx_h1dy.h5 differ
diff --git a/matlab/mat/alignment/alignment_h1rx_h1ry/alignment_h1rx_h1ry.h5 b/matlab/mat/alignment/alignment_h1rx_h1ry/alignment_h1rx_h1ry.h5
new file mode 100644
index 0000000..3330102
Binary files /dev/null and b/matlab/mat/alignment/alignment_h1rx_h1ry/alignment_h1rx_h1ry.h5 differ
diff --git a/matlab/mat/alignment/alignment_h1rx_h1ry_0002/alignment_h1rx_h1ry_0002.h5 b/matlab/mat/alignment/alignment_h1rx_h1ry_0002/alignment_h1rx_h1ry_0002.h5
new file mode 100644
index 0000000..2d7f8af
Binary files /dev/null and b/matlab/mat/alignment/alignment_h1rx_h1ry_0002/alignment_h1rx_h1ry_0002.h5 differ
diff --git a/matlab/mat/alignment/alignment_verify_metrology_using_h1/alignment_verify_metrology_using_h1.h5 b/matlab/mat/alignment/alignment_verify_metrology_using_h1/alignment_verify_metrology_using_h1.h5
new file mode 100644
index 0000000..d76cf9c
Binary files /dev/null and b/matlab/mat/alignment/alignment_verify_metrology_using_h1/alignment_verify_metrology_using_h1.h5 differ
diff --git a/matlab/mat/alignment/id31nass_alignment.h5 b/matlab/mat/alignment/id31nass_alignment.h5
new file mode 100644
index 0000000..3ee90ed
Binary files /dev/null and b/matlab/mat/alignment/id31nass_alignment.h5 differ
diff --git a/matlab/mat/metrology_acceptance/id31nass_metrology_acceptance.h5 b/matlab/mat/metrology_acceptance/id31nass_metrology_acceptance.h5
new file mode 100644
index 0000000..62447c6
Binary files /dev/null and b/matlab/mat/metrology_acceptance/id31nass_metrology_acceptance.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshXY/metrology_acceptance_after_int_align_meshXY.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshXY/metrology_acceptance_after_int_align_meshXY.h5
new file mode 100644
index 0000000..9a87127
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshXY/metrology_acceptance_after_int_align_meshXY.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshXZ/metrology_acceptance_after_int_align_meshXZ.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshXZ/metrology_acceptance_after_int_align_meshXZ.h5
new file mode 100644
index 0000000..84bb03e
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshXZ/metrology_acceptance_after_int_align_meshXZ.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshYZ/metrology_acceptance_after_int_align_meshYZ.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshYZ/metrology_acceptance_after_int_align_meshYZ.h5
new file mode 100644
index 0000000..c88bbe5
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshYZ/metrology_acceptance_after_int_align_meshYZ.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshYZ_larger/metrology_acceptance_after_int_align_meshYZ_larger.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshYZ_larger/metrology_acceptance_after_int_align_meshYZ_larger.h5
new file mode 100644
index 0000000..c93de1b
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_after_int_align_meshYZ_larger/metrology_acceptance_after_int_align_meshYZ_larger.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_align_ny_sphere_center/metrology_acceptance_align_ny_sphere_center.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_align_ny_sphere_center/metrology_acceptance_align_ny_sphere_center.h5
new file mode 100644
index 0000000..93eeea3
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_align_ny_sphere_center/metrology_acceptance_align_ny_sphere_center.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx/metrology_acceptance_dx.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx/metrology_acceptance_dx.h5
new file mode 100644
index 0000000..dcca022
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx/metrology_acceptance_dx.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0002/metrology_acceptance_dx_0002.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0002/metrology_acceptance_dx_0002.h5
new file mode 100644
index 0000000..49e0e34
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0002/metrology_acceptance_dx_0002.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0003/metrology_acceptance_dx_0003.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0003/metrology_acceptance_dx_0003.h5
new file mode 100644
index 0000000..bcb3b33
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0003/metrology_acceptance_dx_0003.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0004/metrology_acceptance_dx_0004.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0004/metrology_acceptance_dx_0004.h5
new file mode 100644
index 0000000..c4f5fdf
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0004/metrology_acceptance_dx_0004.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0005/metrology_acceptance_dx_0005.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0005/metrology_acceptance_dx_0005.h5
new file mode 100644
index 0000000..f4364f4
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0005/metrology_acceptance_dx_0005.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0006/metrology_acceptance_dx_0006.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0006/metrology_acceptance_dx_0006.h5
new file mode 100644
index 0000000..e244ec5
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0006/metrology_acceptance_dx_0006.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0007/metrology_acceptance_dx_0007.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0007/metrology_acceptance_dx_0007.h5
new file mode 100644
index 0000000..9516b9a
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0007/metrology_acceptance_dx_0007.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0008/metrology_acceptance_dx_0008.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0008/metrology_acceptance_dx_0008.h5
new file mode 100644
index 0000000..714875d
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0008/metrology_acceptance_dx_0008.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0009/metrology_acceptance_dx_0009.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0009/metrology_acceptance_dx_0009.h5
new file mode 100644
index 0000000..66b3afc
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dx_0009/metrology_acceptance_dx_0009.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy/metrology_acceptance_dy.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy/metrology_acceptance_dy.h5
new file mode 100644
index 0000000..d636a3a
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy/metrology_acceptance_dy.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0002/metrology_acceptance_dy_0002.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0002/metrology_acceptance_dy_0002.h5
new file mode 100644
index 0000000..5e36668
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0002/metrology_acceptance_dy_0002.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0003/metrology_acceptance_dy_0003.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0003/metrology_acceptance_dy_0003.h5
new file mode 100644
index 0000000..c62d954
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0003/metrology_acceptance_dy_0003.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0004/metrology_acceptance_dy_0004.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0004/metrology_acceptance_dy_0004.h5
new file mode 100644
index 0000000..bc12314
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0004/metrology_acceptance_dy_0004.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0005/metrology_acceptance_dy_0005.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0005/metrology_acceptance_dy_0005.h5
new file mode 100644
index 0000000..b8ff96b
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0005/metrology_acceptance_dy_0005.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0006/metrology_acceptance_dy_0006.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0006/metrology_acceptance_dy_0006.h5
new file mode 100644
index 0000000..addc031
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0006/metrology_acceptance_dy_0006.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0007/metrology_acceptance_dy_0007.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0007/metrology_acceptance_dy_0007.h5
new file mode 100644
index 0000000..b78d997
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0007/metrology_acceptance_dy_0007.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0008/metrology_acceptance_dy_0008.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0008/metrology_acceptance_dy_0008.h5
new file mode 100644
index 0000000..b401f3f
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0008/metrology_acceptance_dy_0008.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0009/metrology_acceptance_dy_0009.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0009/metrology_acceptance_dy_0009.h5
new file mode 100644
index 0000000..798c64d
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0009/metrology_acceptance_dy_0009.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0010/metrology_acceptance_dy_0010.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0010/metrology_acceptance_dy_0010.h5
new file mode 100644
index 0000000..178b38d
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dy_0010/metrology_acceptance_dy_0010.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_dz/metrology_acceptance_dz.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_dz/metrology_acceptance_dz.h5
new file mode 100644
index 0000000..40b8ffb
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_dz/metrology_acceptance_dz.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_meshXY/metrology_acceptance_meshXY.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_meshXY/metrology_acceptance_meshXY.h5
new file mode 100644
index 0000000..91cf2cc
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_meshXY/metrology_acceptance_meshXY.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_meshXZ/metrology_acceptance_meshXZ.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_meshXZ/metrology_acceptance_meshXZ.h5
new file mode 100644
index 0000000..7869d26
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_meshXZ/metrology_acceptance_meshXZ.h5 differ
diff --git a/matlab/mat/metrology_acceptance/metrology_acceptance_meshYZ/metrology_acceptance_meshYZ.h5 b/matlab/mat/metrology_acceptance/metrology_acceptance_meshYZ/metrology_acceptance_meshYZ.h5
new file mode 100644
index 0000000..8a51535
Binary files /dev/null and b/matlab/mat/metrology_acceptance/metrology_acceptance_meshYZ/metrology_acceptance_meshYZ.h5 differ
diff --git a/matlab/mat/metrology_acceptance_new_align/id31nass_metrology_acceptance_new_align.h5 b/matlab/mat/metrology_acceptance_new_align/id31nass_metrology_acceptance_new_align.h5
new file mode 100644
index 0000000..120861e
Binary files /dev/null and b/matlab/mat/metrology_acceptance_new_align/id31nass_metrology_acceptance_new_align.h5 differ
diff --git a/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dx/metrology_acceptance_new_align_dx.h5 b/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dx/metrology_acceptance_new_align_dx.h5
new file mode 100644
index 0000000..b28ffc5
Binary files /dev/null and b/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dx/metrology_acceptance_new_align_dx.h5 differ
diff --git a/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dy/metrology_acceptance_new_align_dy.h5 b/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dy/metrology_acceptance_new_align_dy.h5
new file mode 100644
index 0000000..dea9f1a
Binary files /dev/null and b/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dy/metrology_acceptance_new_align_dy.h5 differ
diff --git a/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dz/metrology_acceptance_new_align_dz.h5 b/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dz/metrology_acceptance_new_align_dz.h5
new file mode 100644
index 0000000..4bf4f5b
Binary files /dev/null and b/matlab/mat/metrology_acceptance_new_align/metrology_acceptance_new_align_dz/metrology_acceptance_new_align_dz.h5 differ
diff --git a/matlab/mat/nass_model_conf_log.mat b/matlab/mat/nass_model_conf_log.mat
new file mode 100644
index 0000000..14a67ea
Binary files /dev/null and b/matlab/mat/nass_model_conf_log.mat differ
diff --git a/matlab/mat/nass_model_conf_simscape.mat b/matlab/mat/nass_model_conf_simscape.mat
new file mode 100644
index 0000000..e0cb862
Binary files /dev/null and b/matlab/mat/nass_model_conf_simscape.mat differ
diff --git a/matlab/mat/nass_model_conf_simulink.mat b/matlab/mat/nass_model_conf_simulink.mat
new file mode 100644
index 0000000..6d01d43
Binary files /dev/null and b/matlab/mat/nass_model_conf_simulink.mat differ
diff --git a/matlab/mat/nass_model_controller.mat b/matlab/mat/nass_model_controller.mat
new file mode 100644
index 0000000..5f8e547
Binary files /dev/null and b/matlab/mat/nass_model_controller.mat differ
diff --git a/matlab/mat/nass_model_disturbances.mat b/matlab/mat/nass_model_disturbances.mat
new file mode 100644
index 0000000..5937cbb
Binary files /dev/null and b/matlab/mat/nass_model_disturbances.mat differ
diff --git a/matlab/mat/nass_model_references.mat b/matlab/mat/nass_model_references.mat
new file mode 100644
index 0000000..bb82251
Binary files /dev/null and b/matlab/mat/nass_model_references.mat differ
diff --git a/matlab/mat/nass_model_stages.mat b/matlab/mat/nass_model_stages.mat
new file mode 100644
index 0000000..46783c6
Binary files /dev/null and b/matlab/mat/nass_model_stages.mat differ
diff --git a/matlab/mat/test_id31_interf_noise.mat b/matlab/mat/test_id31_interf_noise.mat
new file mode 100644
index 0000000..6886a00
Binary files /dev/null and b/matlab/mat/test_id31_interf_noise.mat differ
diff --git a/matlab/mat/test_id31_simscape_open_loop_plants.mat b/matlab/mat/test_id31_simscape_open_loop_plants.mat
new file mode 100644
index 0000000..162767b
Binary files /dev/null and b/matlab/mat/test_id31_simscape_open_loop_plants.mat differ