enable PID + smartdashboard
ports, enabling, printouts, etc.
manual 'distance' calculation
WORKING PID!!!

BOOM ! ROASTED!!!!!
velocity?