added selecting the actual robot location and yaw (maybe the yaw is not necessary)