Human in the loop autonomy

TODO: The UI should show the reconstruction of the pointcloud and the robot. An intuitive high level controls sceme should translate user commands to trajectories. UI should explain what the robot is doing to the user