弯道限速 设置初值与当前速度平方与预瞄点曲率乘积比较小于 则限速130大于 根据当前阈值求得当前曲率下的速度阈值,与当前值做差,并通过每一周期最大制动减速度相比较,若小于,则减小 横摆角+质心侧偏角=航向角