soem emergency works, not correctly implemented. base_controller corrected wheel radius