[Oromus]

I'll just say, as the poster of the "if (distance != 6)" line, that I wrote it with the fact that unless the double is exactly 6 that it will run in mind. That's because it led to a PID loop that contained a double-based deadzone, so I didn't write see the point in writing a deadzone for 6 when the PID already had a deadzone.