Fix depth mapping, don't connect to port if no robot