Re-factor base inertial parameters computation
Modify to save the new robot with base parameters