Fix bug in ScenePublisher.computeRobotPositionPlanar.