Maybe fixed curvature computation
Fixed angular rate computation