代码解读三文件名“Ano_Pid.c”

最新推荐文章于 2021-05-31 16:55:59 发布

Yohaoa

最新推荐文章于 2021-05-31 16:55:59 发布

阅读量2.5k

点赞数 8

CC 4.0 BY-SA版权

分类专栏：无人机随笔文章标签： PID 匿名飞控代码解读

本文链接：https://blog.youkuaiyun.com/zhiyu_buliang/article/details/89187437

本文解析了名为'Ano_Pid.c'的文件，该文件实现了基础的单级PID控制器。虽然代码中存在一些优化和难以理解的部分，但核心仍遵循PID的基本原理。分析方法是从模块入手，理解其整体结构。对于难以解读的细节，作者建议用经典PID公式替换，并通过ADT（抽象数据类型）将实现封装。有兴趣的读者可以对比优化效果，至少应达到相同的功能水平。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

关于PID这部分匿名代码里面有很多，此文件是最基础的即单级PID的实现，后面的关于速度和角速度环的串级PID及高度和高度速度环的串级PID都是以此为基础的，所以此文件内容务必搞懂。

/******************** (C) COPYRIGHT 2016 ANO Tech ***************************
 * 作者		 ：匿名科创
 * 文件名  ：ANO_PID.c
 * 描述    ：PID函数
 * 官网    ：www.anotc.com
 * 淘宝    ：anotc.taobao.com
 * 技术Q群 ：190169595
*****************************************************************************/
#include "Ano_Pid.h"
#include "Ano_Math.h"
#include "Ano_Filter.h"

/*

不难看出匿名使用的并不是大家推崇的增量式PID，而是位置式PID
至于为什么我也不是很清楚


简单列下关于位置式PID和增量式PID的公式

//位置式PID（匿名使用）
ux = kp * ex + ki * ex_sum + kd * (ex - ex_prior);



//增量式PID
dux = kp(ex - ex_prior) + ki * ex + kd * (ex - 2 * ex_prior + ex_prior_prior);

ux = dux + ux;


*/




float PID_calculate( 
										float dT_s,            				//周期（单位：秒）
										float in_ff,						//前馈值
										float expect,						//期望值（设定值）
										float feedback,						//反馈值（）
										_PID_arg_st *pid_arg, 				//PID参数结构体
										_PID_val_st *pid_val,				//PID数据结构体
										fl