You might look at this answer to a similar question: Anybody linearized the motor power yet? - #9 by callen