大功率PID控温

news/2024/7/7 21:28:16 
#include "rtthread.h"
#ifdef FRYER_TEMP_PID       //PID控温
#include "pid.h"
#include "string.h"

#define DBG_TAG "app.pid"
#define DBG_LVL DBG_INFO
#include <rtdbg.h>

/** 
* PID运算. 
* U(k)+KP*[E(k)-E(k-1)]+KI*E(k)+KD*[E(k)-2E(k-1)+E(k-2)].
* @param[in]   无
* @param[out]  无
* @retval  无
* @par 标识符 
*      保留 
* @par 其它 
*      无 
* @par 修改日志 
*      kun于2021-08-16创建 
*/
void pid_operation(pid_value_t *pid_ptr)
{
    if( pid_ptr->iSetVal > pid_ptr->iCurVal ){      //设定值大于实际值否
        if( pid_ptr->iSetVal - pid_ptr->iCurVal > 30 ){
            pid_ptr->iPriVal = 100;                 //偏差大于20为上限幅值全输出（全速加热）
        }
        else{                                       //否则慢慢来
            pid_ptr->Temp[0] = pid_ptr->iSetVal - pid_ptr->iCurVal;    //偏差<=20,计算E(k)
            pid_ptr->uEkFlag[1] = 0;                //E(k)为正数，因为设定值大于实际值
            //数值进行移位
            pid_ptr->liEkVal[2] = pid_ptr->liEkVal[1];
            pid_ptr->liEkVal[1] = pid_ptr->liEkVal[0];
            pid_ptr->liEkVal[0] = pid_ptr->Temp[0];
            
            /*==================================*/
            if( pid_ptr->liEkVal[0] > pid_ptr->liEkVal[1] ){
                pid_ptr->Temp[0] = pid_ptr->liEkVal[0] - pid_ptr->liEkVal[1];
                pid_ptr->uEkFlag[0] = 0;
            }
            else{
                pid_ptr->Temp[0] = pid_ptr->liEkVal[1] - pid_ptr->liEkVal[0];
                pid_ptr->uEkFlag[0] = 1;
            }
            
            /*==================================*/
            pid_ptr->Temp[2] = pid_ptr->liEkVal[1]*2;
            if( (pid_ptr->liEkVal[0] + pid_ptr->liEkVal[2]) > pid_ptr->Temp[2] ){
                pid_ptr->Temp[2] = (pid_ptr->liEkVal[0] + pid_ptr->liEkVal[2]) - pid_ptr->Temp[2];
                pid_ptr->uEkFlag[2] = 0;
            }
            else{
                pid_ptr->Temp[2] = pid_ptr->Temp[2] - (pid_ptr->liEkVal[0] + pid_ptr->liEkVal[2]);
                pid_ptr->uEkFlag[2] = 1;
            }
            
            pid_ptr->Temp[0] = (uint32_t)(pid_ptr->uKP_Coe*pid_ptr->Temp[0]);         //KP*[E(k)-E(k-1)]
            pid_ptr->Temp[1] = (uint32_t)(pid_ptr->uKI_Coe*pid_ptr->liEkVal[0]);      //KI*E(k)
//            pid_ptr->Temp[1] = (uint32_t)(0.5*pid_ptr->liEkVal[0]);      //KI*E(k)
            pid_ptr->Temp[2] = (uint32_t)(pid_ptr->uKD_Coe*pid_ptr->Temp[2]);         //KD*[E(k-2)+E(k)-2E(k-1)]
                        
            /*===========计算KP*[E(k)-E(k-1)]的值=============*/
            if( pid_ptr->uEkFlag[0] == 0 )
                pid_ptr->PostSum += pid_ptr->Temp[0];
            else
                pid_ptr->NegSum  += pid_ptr->Temp[0];
            
            /*===========计算KI*E(k)==========================*/
            if( pid_ptr->uEkFlag[1]==0 )
                pid_ptr->PostSum += pid_ptr->Temp[1];
            else{
            }
            
            /*===========计算KD*[E(k-2)+E(k)-2E(k-1)]的值======*/
            if( pid_ptr->uEkFlag[2]==0 )
                pid_ptr->PostSum += pid_ptr->Temp[2];
            else
                pid_ptr->NegSum  += pid_ptr->Temp[2];
                        
            /*============计算U(k)================*/
            if( pid_ptr->PostSum > pid_ptr->NegSum ){
                pid_ptr->Temp[0] = pid_ptr->PostSum - pid_ptr->NegSum;
                if( pid_ptr->Temp[0] < 100 )                            //小于上限幅值为计算输出
                    pid_ptr->iPriVal = (uint16_t)pid_ptr->Temp[0];
                else
                    pid_ptr->iPriVal = 100;                             //否则上限幅值输出
            }
            else                                                        //控制量输出为负数，则输出0（下限幅值输出）
                pid_ptr->iPriVal = 0;
        }
    }
    else{
        pid_ptr->iPriVal = 0;
        pid_ptr->NegSum = 0;
        pid_ptr->PostSum = 0;
        pid_ptr->liEkVal[0] = 0;
        pid_ptr->liEkVal[1] = 0;
        pid_ptr->liEkVal[2] = 0;
        pid_ptr->Temp[0] = 0;
        pid_ptr->Temp[1] = 0;
        pid_ptr->Temp[2] = 0;
    }
}

void pid_set_target(pid_value_t *pid_ptr, uint16_t target)
{
    pid_ptr->iSetVal = target;
}

uint16_t pid_get_ctrl(pid_value_t *pid_ptr)
{
    return pid_ptr->iPriVal;
}

void pid_set_current(pid_value_t *pid_ptr,uint16_t value)
{
    pid_ptr->iCurVal = value;
}

void pid_var_rst(pid_value_t *pid_ptr)
{
    pid_ptr->NegSum = 0;
    pid_ptr->PostSum = 0;
    pid_ptr->liEkVal[0] = 0;
    pid_ptr->liEkVal[1] = 0;
    pid_ptr->liEkVal[2] = 0;
    pid_ptr->Temp[0] = 0;
    pid_ptr->Temp[1] = 0;
    pid_ptr->Temp[2] = 0;
}

void pid_set(pid_value_t *pid_ptr,float p,float i, float d)
{
    pid_ptr->uKP_Coe = p;
    pid_ptr->uKI_Coe = i;
    pid_ptr->uKD_Coe = d;
}

void pid_init(pid_value_t *pid_ptr,float p,float i, float d)
{
    rt_memset(pid_ptr,0,sizeof(pid_value_t));
    pid_ptr->uKP_Coe = p;
    pid_ptr->uKI_Coe = i;
    pid_ptr->uKD_Coe = d;
}
#endif

typedef struct PID
{
    float P,I,D,limit;
}PID;
typedef struct Error
{
    float Current_Error;//当前误差

    float Last_Error;//上一次误差

    float Previous_Error;//上上次误差
}Error;

/** 
* 位置式PID. 
* U(k)+KP*[E(k)-E(k-1)]+KI*E(k)+KD*[E(k)-2E(k-1)+E(k-2)].
* @param[in]   sptr ：误差参数，pid: PID参数，NowPlace：当前位置，Point：预期位置
* @param[out]  无
* @retval  输出控制值
* @par 标识符 
*      保留 
* @par 其它 
*      无 
* @par 修改日志 
*      kun于2022-01-14创建 
*/
int32_t pid_realize(Error *sptr,PID *pid, int32_t now_place, int32_t point)
{	
	int32_t iError, // 当前误差
    Realize;//实际输出

	iError = point - now_place; // 计算当前误差

	sptr->Current_Error += pid->I * iError; // 误差积分

	sptr->Current_Error = sptr->Current_Error > pid->limit ? pid->limit:sptr->Current_Error;//积分限幅

	sptr->Current_Error = sptr->Current_Error < -pid->limit? -pid->limit:sptr->Current_Error;

	Realize = pid->P * iError//比例P

	+ sptr->Current_Error//积分I

	+ pid->D * (iError - sptr->Last_Error);//微分D

	sptr->Last_Error = iError;// 更新上次误差

	return Realize; // 返回实际值
}

/** 
* 增量式PID. 
* U(k)+KP*[E(k)-E(k-1)]+KI*E(k)+KD*[E(k)-2E(k-1)+E(k-2)].
* @param[in]   sptr ：误差参数，pid: PID参数，NowPlace：当前位置，Point：预期位置
* @param[out]  无
* @retval  输出控制值
* @par 标识符 
*      保留 
* @par 其它 
*      无 
* @par 修改日志 
*      kun于2022-01-14创建 
*/
int32_t pid_increase(Error *sptr, PID *pid, int32_t now_place, int32_t point)
{
    int32_t iError, //当前误差

    Increase; //最后得出的实际增量

    iError = point - now_place; // 计算当前误差

    Increase = pid->P * (iError - sptr->Last_Error)//比例P

    + pid->I * iError //积分I

    + pid->D * (iError - 2 * sptr->Last_Error + sptr->Previous_Error); //微分D

    sptr->Previous_Error = sptr->Last_Error; // 更新前次误差

    sptr->Last_Error = iError; // 更新上次误差

    return Increase; // 返回增量
}

 	pid_set_current( &fryer_ptr->pid,fryer_ptr->temp );	//设置目标温度
	pid_operation( &fryer_ptr->pid );					//PID计算
	ctrl = pid_get_ctrl(&fryer_ptr->pid);				//获取控制输出值百分比

ctrl为百分比输出值，用于控制大功率设置不能频率启动与停止，设置为10秒一个控制周期


http://lihuaxi.xjx100.cn/news/1570283.html

相关文章

使用ElementUI完成登入注册的跨域请求提高开发效率

使用ElementUI完成登入注册的跨域请求提高开发效率

&#x1f3ac; 艳艳耶✌️&#xff1a;个人主页 &#x1f525; 个人专栏 &#xff1a;《Spring与Mybatis集成整合》​​​​​​​ ⛺️ 生活的理想&#xff0c;为了不断更新自己 ! 目录 ​编辑 1、前言 1.1.什么是ELementUI 2、完成登陆注册前端页面 2.1环境搭建 运行…
阅读更多...
Spring MVC 九：Context层级（基于配置）

Spring MVC 九：Context层级（基于配置）

Context层级的问题&#xff0c;前面文章应该已经说清楚了。 只不过&#xff0c;前面文章是以注解方式举例说明的&#xff0c;通过配置方式怎么体现Context层级呢&#xff1f;有必要也说一下&#xff0c;毕竟现在很多项目都是基于xml配置实现的。 web.xml 基于配置的Spring M…
阅读更多...
十、补码朴素贝叶斯算法(Complement NB，Complement Naive Bayes)（有监督学习）

十、补码朴素贝叶斯算法(Complement NB，Complement Naive Bayes)（有监督学习）

Rennie 等人&#xff08;2003 年&#xff09;所描述的补码朴素贝叶斯分类器Complement Naive Bayes 分类器 该分类器旨在纠正标准多项式直觉贝叶斯分类器的 “严重假设” 它特别适用于不平衡数据集。 一、算法思路 二、官网API 官网API 导包&#xff1a;from sklearn.naive_…
阅读更多...
2023 年KPI (KPI:Key Performance Indicator) review

2023 年KPI (KPI:Key Performance Indicator) review

文章大纲 1. 总体情况2. 回顾与总结2.1 基础巩固2.2 工作内容充实计算机视觉coursera 2.3 AI 兴趣: NLP & AIGC2.4 面试、笔试题常读常新 (0%)2.5 读书笔记 参考文献与学习路径 2023 年的 kpi 本身就订的低&#xff0c;结果发现定的低也完不成&#xff0c;距离年底还有3个月…
阅读更多...
java面试题-设计模式基础

java面试题-设计模式基础

面试专题-设计模式 前言 在平时的开发中&#xff0c;涉及到设计模式的有两块内容&#xff0c;第一个是我们平时使用的框架&#xff08;比如spring、mybatis等&#xff09;&#xff0c;第二个是我们自己开发业务使用的设计模式。 面试官一般比较关心的是你在开发过程中&#…
阅读更多...
VB结合数据库实现-登录注册增删改查刷新

VB结合数据库实现-登录注册增删改查刷新

文章目录: 一&#xff1a;效果演示 二&#xff1a;实现思路 三&#xff1a;代码实现 form1 效果图 代码 form2 效果图 代码 form3 效果图 代码 一&#xff1a;效果演示 效果图◕‿◕✌✌✌ VB结合数据库实现-登录注册增删改查刷新 代码下载 数据库建表 外接程序—…
阅读更多...
Go语言关于协程何时退出的问题

Go语言关于协程何时退出的问题

启动一个新的协程时&#xff0c;协程的调用会立即返回。与函数不同&#xff0c;程序控制不会去等待 Go 协程执行完毕。在调用 Go 协程之后&#xff0c;程序控制会立即返回到代码的下一行&#xff0c;忽略该协程的任何返回值。在程序启动时&#xff0c;Go程序就会为main()函数创…
阅读更多...
如何使用Go与MQTT进行通信

如何使用Go与MQTT进行通信

简介 本文介绍了如何使用 Go 编程语言与 MQTT&#xff08;Message Queuing Telemetry Transport&#xff09;进行通信。MQTT 是一种轻量级的消息传输协议&#xff0c;广泛应用于物联网和实时通信场景。通过本文的指导&#xff0c;您将学习如何使用 Go 语言创建 MQTT 客户端&am…
阅读更多...
最新文章

Copyright @ 2022~2023