Debugging auton and stuffs

also PID tuning