Final updates for June 20th demo and fixed speeds for moveit interface to help avoid collisions.