[Don Reid]

Here is a more complex PID version. I won't claim its perfect, but it works fairly well. This uses integer math, and it divides by the constants to make them less than 1.0. The "JERK" part is a kludge that we needed to get past the problem of too much friction in out drive train.