maintain constant curvature when scaling

[mikeferguson]

Still needs to be tested, but should make robots more predictable when the invoke the safety scaling