autonomous still broken
Working autonomous code.

Change Smartdashboard current display scale to 0 to 5.0 amps instead of 20.0.