Clean up PID
Reverse wheel axis for more logical behavior