Potentially fixed PID issue

Made PID control speed-invariant
Added a bunch of comments
Negated PID correction values so that correction terms will be positive.
Divided inputted SmartDashboard PID values by 1000 to allow for finer
PID tuning (because SmartDashboard only allows for up to 3 places past
the decimal, for some odd reason)