Implemented demo code. Can now drive to black line and interact with ball