本程序是使用C写的一个飞控系统中通用的增量型PID算法