Day before bag day (kinda)

now irrelevant arm PID tuning, added smartdashboard stuffs and yet to be
tested drive to distance function for auton