float PID_Left1(int16_t speed1,int16_t tar1) { static float err = 0, err_last = 0, err_last_last = 0, add = 0; speed1 = absolute_value_speed(speed1); tar1 = absolute_value_speed(tar1); err = tar1-speed1; add = P * (err - err_last) + I * err + D * (err + err_last_last - 2 * err_last); out_left1 += add; out_left1 = pwm_control(out_left1); err_last_last = err_last; err_last = err; return out_left1; }

时间: 2024-04-18 13:31:31 浏览: 13
这段代码实现了一个 PID 控制器的左侧计算。函数名为 PID_Left1,接收两个参数 speed1 和 tar1,分别表示当前速度和目标速度。其中,P、I、D 是三个控制参数,err、err_last、err_last_last 和 add 是静态变量。 代码首先对 speed1 和 tar1 取绝对值,然后计算误差 err = tar1 - speed1。接着,根据 PID 控制器的公式计算增量 add = P * (err - err_last) + I * err + D * (err + err_last_last - 2 * err_last)。 增量 add 被累加到 out_left1 变量上,并通过 pwm_control 函数进行限幅处理。最后,更新 err_last_last、err_last 的值为当前的 err 和 err_last,并返回 out_left1。 需要注意的是,这段代码中的变量 out_left1 和 P、I、D 的定义没有提供,可能是在其他地方定义的全局变量。另外,pwm_control 函数的具体实现也没有在这段代码中给出。
相关问题

MCU1_ERR11_CUR_UNBALANCE

根据提供的引用内容,MCU1_ERR11_CUR_UNBALANCE可能是一个错误码。在Linux内核中,常见的错误码是以负数形式表示的,例如-EBUSY、-EINVAL等[^1]。这些错误码对应着不同的错误情况,用于在内核中标识和处理错误。根据引用,Linux内核中最大的错误号不会超过4095,因此MCU1_ERR11_CUR_UNBALANCE可能是一个自定义的错误码。 请注意,具体的错误码含义需要参考相关文档或代码来确定。根据提供的引用内容,无法确定MCU1_ERR11_CUR_UNBALANCE的具体含义。如果您需要进一步了解该错误码的含义,请参考相关文档或代码。

float PID_realize(float temp_val) { /*传入实际值*/ pid.actual_val = temp_val; /*计算目标值与实际值的误差*/ pid.err=pid.target_val-pid.actual_val; /*PID算法实现*/ float increment_val = pid.Kp*(pid.err - pid.err_next) + pid.Ki*pid.err + pid.Kd*(pid.err - 2 * pid.err_next + pid.err_last); /*传递误差*/ pid.err_last = pid.err_next; pid.err_next = pid.err; /*返回增量值*/ return increment_val; }

这段代码是一个 PID 控制器的实现函数。它接受一个实际值 `temp_val` 作为参数,并返回一个增量值。 在函数中,发生了以下操作: 1. `pid.actual_val = temp_val;` 将传入的实际值存储到 `pid` 对象的 `actual_val` 成员变量中。 2. `pid.err = pid.target_val - pid.actual_val;` 计算目标值与实际值之间的误差,将结果存储到 `pid` 对象的 `err` 成员变量中。 3. 根据 PID 控制算法,计算出一个增量值 `increment_val`。这个增量值是根据当前误差、上一次误差和上上次误差以及对应的 PID 系数(`Kp`, `Ki`, `Kd`)进行计算得到的。 4. `pid.err_last = pid.err_next;` 将当前误差 `pid.err` 存储到 `pid` 对象的 `err_last` 成员变量中,以备下一次计算使用。 5. `pid.err_next = pid.err;` 将当前误差 `pid.err` 存储到 `pid` 对象的 `err_next` 成员变量中,以备下一次计算使用。 6. 最后,函数返回计算得到的增量值 `increment_val`。 这段代码实现了一个简单的 PID 控制器,用于根据给定的目标值和实际值计算出一个增量值,用于调节控制系统的输出。具体的 PID 控制算法实现可能会根据实际需求有所不同。

相关推荐

最新推荐

recommend-type

解决vue net :ERR_CONNECTION_REFUSED报错问题

主要介绍了解决vue net :ERR_CONNECTION_REFUSED报错问题,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧
recommend-type

解决安装wordpress时出现ERR_TOO_MANY_REDIRECTS重定向次数过多问题 原创

本文主要介绍了如何解决安装wordpress时出现ERR_TOO_MANY_REDIRECTS重定向次数过多导致无法安装的问题
recommend-type

MySQL复制出错 Last_SQL_Errno:1146的解决方法

主要介绍了MySQL复制出错 Last_SQL_Errno:1146的解决方法,需要的朋友可以参考下
recommend-type

zigbee-cluster-library-specification

最新的zigbee-cluster-library-specification说明文档。
recommend-type

管理建模和仿真的文件

管理Boualem Benatallah引用此版本:布阿利姆·贝纳塔拉。管理建模和仿真。约瑟夫-傅立叶大学-格勒诺布尔第一大学,1996年。法语。NNT:电话:00345357HAL ID:电话:00345357https://theses.hal.science/tel-003453572008年12月9日提交HAL是一个多学科的开放存取档案馆,用于存放和传播科学研究论文,无论它们是否被公开。论文可以来自法国或国外的教学和研究机构,也可以来自公共或私人研究中心。L’archive ouverte pluridisciplinaire
recommend-type

MATLAB柱状图在信号处理中的应用:可视化信号特征和频谱分析

![matlab画柱状图](https://img-blog.csdnimg.cn/3f32348f1c9c4481a6f5931993732f97.png) # 1. MATLAB柱状图概述** MATLAB柱状图是一种图形化工具,用于可视化数据中不同类别或组的分布情况。它通过绘制垂直条形来表示每个类别或组中的数据值。柱状图在信号处理中广泛用于可视化信号特征和进行频谱分析。 柱状图的优点在于其简单易懂,能够直观地展示数据分布。在信号处理中,柱状图可以帮助工程师识别信号中的模式、趋势和异常情况,从而为信号分析和处理提供有价值的见解。 # 2. 柱状图在信号处理中的应用 柱状图在信号处理
recommend-type

HSV转为RGB的计算公式

HSV (Hue, Saturation, Value) 和 RGB (Red, Green, Blue) 是两种表示颜色的方式。下面是将 HSV 转换为 RGB 的计算公式: 1. 将 HSV 中的 S 和 V 值除以 100,得到范围在 0~1 之间的值。 2. 计算色相 H 在 RGB 中的值。如果 H 的范围在 0~60 或者 300~360 之间,则 R = V,G = (H/60)×V,B = 0。如果 H 的范围在 60~120 之间,则 R = ((120-H)/60)×V,G = V,B = 0。如果 H 的范围在 120~180 之间,则 R = 0,G = V,B =
recommend-type

JSBSim Reference Manual

JSBSim参考手册,其中包含JSBSim简介,JSBSim配置文件xml的编写语法,编程手册以及一些应用实例等。其中有部分内容还没有写完,估计有生之年很难看到完整版了,但是内容还是很有参考价值的。
recommend-type

"互动学习:行动中的多样性与论文攻读经历"

多样性她- 事实上SCI NCES你的时间表ECOLEDO C Tora SC和NCESPOUR l’Ingén学习互动,互动学习以行动为中心的强化学习学会互动,互动学习,以行动为中心的强化学习计算机科学博士论文于2021年9月28日在Villeneuve d'Asq公开支持马修·瑟林评审团主席法布里斯·勒菲弗尔阿维尼翁大学教授论文指导奥利维尔·皮耶昆谷歌研究教授:智囊团论文联合主任菲利普·普雷教授,大学。里尔/CRISTAL/因里亚报告员奥利维耶·西格德索邦大学报告员卢多维奇·德诺耶教授,Facebook /索邦大学审查员越南圣迈IMT Atlantic高级讲师邀请弗洛里安·斯特鲁布博士,Deepmind对于那些及时看到自己错误的人...3谢谢你首先,我要感谢我的两位博士生导师Olivier和Philippe。奥利维尔,"站在巨人的肩膀上"这句话对你来说完全有意义了。从科学上讲,你知道在这篇论文的(许多)错误中,你是我可以依
recommend-type

MATLAB柱状图在数据分析中的作用:从可视化到洞察

![MATLAB柱状图在数据分析中的作用:从可视化到洞察](https://img-blog.csdnimg.cn/img_convert/1a36558cefc0339f7836cca7680c0aef.png) # 1. MATLAB柱状图概述** 柱状图是一种广泛用于数据可视化的图表类型,它使用垂直条形来表示数据中不同类别或组别的值。在MATLAB中,柱状图通过`bar`函数创建,该函数接受数据向量或矩阵作为输入,并生成相应的高度条形。 柱状图的优点在于其简单性和易于理解性。它们可以快速有效地传达数据分布和组别之间的比较。此外,MATLAB提供了广泛的定制选项,允许用户调整条形颜色、