Improved error output for state converstion
Merge branch 'robot_state_error_msg' into kinematic_base_non_chains
Backwards compatibility changes