Finalized one ball autonomous

Found an issue initializing the camera. also added an extra action for
vision called WaitIfAction
Tested the two ball autonomous and it works

Changed the default values for the CDM and the drive time's on
smartdashboard