cleaning
Merge branch 'B_init_hw' into F_fix_urdf_ex