以卡尔曼滤波,通过车辆纵向运动学,加速度传感器的读数是实际加速度和重力加速度沿着坡道方向的加速度的和,以此原理估算道路坡度。详细的matlab程序,注释很清楚,一看就懂。