fixed a bug that caused twice the torque to be calculated (range is -16k .. 16k, NOT -32k...32k)