porting to new robot state
update to new robot_state
bugfixes
updates due to changes in bounds representation