fixing broken tests for changes in robot_state

Fixing one of the ompl tests for changes in robot state - all tests should now compile although all tests are not running.