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; }
时间: 2024-04-19 21:24:31 浏览: 321
这段代码是一个 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 控制算法实现可能会根据实际需求有所不同。
相关问题
解释这段代码:#include "delay.h" #include "LED.h" #include "BEEP.h" #include "IIC.h" #include "OLED.h" #include "ADC.h" #include "stdio.h" #include "0_20OUT.h" #include "KEY.h" int limit_High_MAX = 300; int limit_High_MIN = 50; struct _pid{ int SetHigh;//定义设定值 int ActualHigh;//定义实际值 int err;//定义偏差值 int err_next;//定义上一个偏差值 int err_last;//定义最上前的偏差值 float Kp, Ki, Kd;//定义比例、积分、微分系数 }pid; void PID_init(){ pid.SetHigh = 0; pid.ActualHigh = 0; pid.err = 0; pid.err_last = 0; pid.err_next = 0; pid.Kp = 0.4; pid.Ki = 0.08; pid.Kd = 0.4; } int PID_realize(int high){ int incrementHigh; pid.SetHigh = high; pid.err = pid.SetHigh - pid.ActualHigh; incrementHigh = 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 incrementHigh; } int main(void) { u16 AD_Value; float ADv1; int KEY,FLAG=1; delay_init(); IIC_GPIO_Config(); //IIC引脚初始化 OLED_Init(); AD_Init(); LED_GPIO_Config(); //LED引脚初始化(用于提示) BEEP_GPIO_Config(); //蜂鸣器引脚初始化(用于提示) KEY_GPIO_CONFIG(); while(1) { AD_Value = Get_ADC_Value(ADC_Channel_1,20); //获取ADC的通道1数值 ADv1=(float)AD_Value / 4095 *3.3; pid.ActualHigh = ADv1*150;//实际高度 MCP4725_WriteData_Volatge(PID_realize(pid.ActualHigh));//输出对应的控制电流 OLED_ShowNum(0,0,pid.ActualHigh,5,1); //显示实际高度 OLED_ShowNum(0,2,PID_realize(pid.ActualHigh),5,1); //开度大小 OLED_ShowNum(0,4,limit_High_MIN,3,1); //高度最小值 OLED_ShowNum(20,4,limit_High_MAX,3,1);//高度最大值 LED(ON); KEY = KEY_SCAN(); switch (KEY) { case 1: if(FLAG == 1) limit_High_MAX -= 10; else limit_High_MIN -= 10;break; case 2: if(FLAG == 1) limit_High_MAX += 10; else limit_High_MIN += 10;break; case 3: pid.SetHigh -= 10;break; case 4: pid.SetHigh += 10;break; case 5: FLAG = (FLAG+1)%2;break;//控制加减最大值还是最小值 } //报警提示 if(pid.ActualHigh>limit_High_MAX) { BEEP(ON); } else if(pid.ActualHigh<limit_High_MIN) { LED(ON); } else { BEEP(OFF); LED(OFF); } } return 0; }
这段代码是一个PID控制器的实现,用于控制一个高度的设定值和实际值之间的偏差,通过调整输出的控制电流来实现对设备的控制。代码中包含了一些头文件的引用,定义了一些变量和结构体,以及一些函数的定义和调用。
首先,在`main`函数中,进行了一些初始化操作,包括延时初始化、IIC引脚初始化、OLED初始化、AD初始化、LED引脚初始化和蜂鸣器引脚初始化。
然后,在一个无限循环中,通过获取ADC通道1的数值来获取实际高度,并根据实际高度计算出控制电流的增量。然后将实际高度、增量、高度最小值和高度最大值显示在OLED屏幕上。根据按键的输入,可以改变设定值、最小值和最大值,并根据实际高度和设定值的比较来控制蜂鸣器和LED的状态。
整个代码的核心是PID控制器的实现,其中`PID_init`函数用于初始化PID控制器的参数,`PID_realize`函数用于计算增量,`main`函数中的循环中不断调用`PID_realize`函数来计算增量,并输出对应的控制电流。
解释这段代码#include "qemu/osdep.h" #include "qapi/error.h" #include "ui/console.h" #include "hw/hw.h" #include "hw/boards.h" #include "hw/loader.h" #include "hw/display/framebuffer.h" #include "hw/arm/fsl-imx6ul.h" #include "ui/pixel_ops.h" //#include "hw/m68k/next-cube.h" #include "hw/gpio/imx_gpio.h" #include "hw/gpio/100ask_imx6ull_buttons.h" #include "ui/console.h" #include "ui/file.h" #include "ui/pic_operation.h" #include "ui/picfmt_manager.h" #include "ui/fonts.h" #include "ui/input.h" #include "ui/button_ui.h" /* * button1 : GPIO05_01 * button2 : GPIO01_18 * */ static int pin_to_button_map[][3] = { /* group, pin, button(0-button1, 1-button2) */ {5, 1, 0}, {1, 18, 1}, }; void notify_board_button_change(int index) { int group = pin_to_button_map[index][0]; int pin = pin_to_button_map[index][1]; int level = is_button_pressed(index); notify_imx_gpio_change(group, pin, level); } static void imx6ull_gpio_button_realize(DeviceState *dev, Error **errp) { button_ui_create(dev); } static void imx6ull_gpio_button_class_init(ObjectClass *klass, void *data) { DeviceClass *dc = DEVICE_CLASS(klass); set_bit(DEVICE_CATEGORY_DISPLAY, dc->categories); dc->realize = imx6ull_gpio_button_realize; } static const TypeInfo imx6ull_gpio_button_info = { .name = TYPE_BUTTON, .parent = TYPE_SYS_BUS_DEVICE, .instance_size = sizeof(ButtonState), .class_init = imx6ull_gpio_button_class_init, }; void create_imx6ull_buttons(void) { DeviceState *dev; dev = qdev_create(NULL, TYPE_BUTTON); qdev_init_nofail(dev); } static void imx6ull_gpio_button_register_types(void) { type_register_static(&imx6ull_gpio_button_info); } type_init(imx6ull_gpio_button_register_types)
这段代码的功能是生成一个长度为10的由随机数字组成的数组,然后再将这个数组中的数字按照从小到大的顺序排列并输出。首先定义了一个名为random_array的函数,该函数使用了python的内置模块random来生成随机数,并返回一个含有10个随机数的列表。然后在主程序中调用该函数并将其结果存储在变量nums中,接着使用了python的内置方法sorted对nums进行排序,最后用for循环遍历排好序的数组,并逐一输出每一个数字。
阅读全文