增加了通信协议,增加了IAP保存PID和Angle_Set等参数,卡尔曼滤波出现滞后,只有到车上再调试了.