[yongkimleng]

I think the lookup table as JimWright949 suggested is the right way to go. You could put the values in an Excel sheet and tweak it until it gives you the graph you want, and then put it back into your code.

As a side note, this would go in before any PID, accel/decel, limiting code you may have.