Autonomous, teleop assist, cleanup

autoAlign() is very important.
Ultrasonic sensors fully implemented.