STM32使用PID调速

这篇具有很好参考价值的文章主要介绍了STM32使用PID调速。希望对大家有所帮助。如果存在错误或未考虑完全的地方,请大家不吝赐教,您也可以点击"举报违法"按钮提交疑问。

STM32使用PID调速

PID原理

STM32使用PID调速,stm32,嵌入式硬件,单片机

PID算法是一种闭环控制系统中常用的算法,它结合了比例(P)、积分(I)和微分(D)三个环节,以实现对系统的控制。它的目的是使

控制系统的输出值尽可能接近预期的目标值。

在PID算法中,控制器通过不断地测量实际输出值和目标值之间的误差,并使用比例、积分和微分部分的控制参数来调整控制系统的输出

值。比例部分根据误差的大小进行控制,其输出与误差成正比。积分部分根据误差的历史累积值进行控制,其输出与误差积分的结果成正

比。微分部分根据误差的变化率进行控制,其输出与误差变化率成正比。

将这三个部分组合起来,就得到了PID算法。PID控制器不断地对系统进行测量和调整,直到实际输出值接近目标值为止。

连续性公式
u ( t ) = K p ∗ e ( t ) + K i ∗ ∫ 0 t e ( t ) d t + k d ∗ d e ( t ) d t u(t)=K_{p}*e(t)+K_{i}*\int_{0}^{t} e(t)dt+k{d}*\frac{de(t)}{dt} u(t)=Kpe(t)+Ki0te(t)dt+kddtde(t)
离散性公式
u ( t ) = K p ∗ e ( t ) + K i ∗ ∑ n = 0 t e ( n ) + k d ∗ [ e ( t ) − e ( t − 1 ) ] u(t)=K_{p}*e(t)+K_{i}*\sum_{n=0}^{t} e(n)+k{d}*[e(t)-e(t-1)] u(t)=Kpe(t)+Kin=0te(n)+kd[e(t)e(t1)]

  • 比例系数Kp:
    比例系数Kp的作用是根据当前误差的大小来调整控制器的输出。Kp越大,控制器对误差的灵敏度越高,系统的响应速度越快,但可能会出现过大的超调。Kp越小,控制器对误差的灵敏度越低,系统的响应速度越慢,但系统的稳定性较好。(快)
  • 积分系数Ki:
    积分系数Ki的作用是根据误差的历史累积值来调整控制器的输出。Ki越大,控制器对误差的累积量越大,系统的稳态误差消除越快,但可能会出现过大的超调。Ki越小,控制器对误差的累积量越小,系统的稳态误差消除越慢,但系统的稳定性较好。(准)
  • 微分系数Kd:
    微分系数Kd的作用是根据误差的变化率来调整控制器的输出。Kd越大,控制器对误差变化率的灵敏度越高,系统的响应速度越快,但可能会出现过大的超调。Kd越小,控制器对误差变化率的灵敏度越低,系统的响应速度越慢,但系统的稳定性较好。(稳)

PID使用

在工程文件中新建

pid.h

//pid.h
#ifndef __BSP_PID_H
#define	__BSP_PID_H
#include "stm32f1xx.h"
#include "usart.h"
#include <stdio.h>
#include <stdlib.h>
#include "tim.h"

/*pid*/
typedef struct
{
    float target_val;
    float actual_val;
    float err;
    float err_last;
    float err_sum;
    float Kp,Ki,Kd;
}PID_struct;

void PID_Init(PID_struct *pid);
float P_realize(PID_struct * pid, float actual_val);
float PI_realize(PID_struct * pid, float actual_val);
float PID_realize(PID_struct * pid, float actual_val);

#endif

结构体中储存pid的参数目标值、当前值、误差、kp、ki、kd等等

pid.c

//pid.c
#include "pid.h"

void PID_Init(PID_struct *pid)
{
    printf("PID_Init begin \n");
    pid->target_val=1.0;
    pid->actual_val=0.0;
    //误差
    pid->err=0.0;
    pid->err_last=0.0;
    pid->err_sum=0.0;
    //需要自己调节
    pid->Kp = 120.0;  //快
    pid->Ki = 5.0;   //准
    pid->Kd = 0.3;	//稳
}
float P_realize(PID_struct * pid, float actual_val)
{
    pid->actual_val = actual_val;
    pid->err = pid->target_val - pid->actual_val;
    pid->actual_val = pid->Kp * pid->err;
    return pid->actual_val;
}

float PI_realize(PID_struct * pid, float actual_val)
{
    pid->actual_val = actual_val;
    pid->err = pid->target_val - pid->actual_val;
    pid->actual_val = pid->Kp*pid->err + pid->Ki*pid->err_sum;
    return pid->actual_val;
}

float PID_realize(PID_struct * pid, float actual_val)
{
    pid->actual_val = actual_val;
    pid->err = pid->target_val - pid->actual_val;
    pid->err_sum += pid->err;
    pid->actual_val = pid->Kp*pid->err + pid->Ki*pid->err_sum + pid->Kd*(pid->err-pid->err_last);
    pid->err_last = pid->err;
    return pid->actual_val;
}

一共有四个函数分别为PID初始化、P调节、PI调节、PID调节

传入参数为PID结构体,和编码器测的速度

返回值为实际PWM值

使用main.c

#include "main.h"
#include "tim.h"
#include "usart.h"
#include "gpio.h"

/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */
#include "string.h"
#include "stdio.h"
#include "motor.h"
#include "pid.h"
#include "oled.h"
/* USER CODE END Includes */

short Enc1_cnt = 0;
short Enc2_cnt = 0;
float motor1_speed = 0.00;
float motor2_speed = 0.00;
int PWM_MAX = 1000, PWM_MIN = -1000;
PID_struct motor1_pid;
PID_struct motor2_pid;
int motor1_pwm, motor2_pwm;
char oledBuf[20];


void SystemClock_Config(void);

int main(void)
{
  HAL_Init();
  SystemClock_Config();
  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_TIM3_Init();
  MX_USART1_UART_Init();
  MX_TIM2_Init();
  MX_TIM4_Init();
  /* USER CODE BEGIN 2 */
  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
  HAL_TIM_Encoder_Start(&htim2, TIM_CHANNEL_ALL);
  HAL_TIM_Encoder_Start(&htim4, TIM_CHANNEL_ALL);
  HAL_TIM_Base_Start_IT(&htim2);
  HAL_TIM_Base_Start_IT(&htim4);
  //PID初始化
  PID_Init(&motor1_pid);
  PID_Init(&motor2_pid);
  OLED_Init();
  OLED_ColorTurn(0);
  OLED_DisplayTurn(0);
  OLED_Clear();


  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
      motor1_pwm = PID_realize(&motor1_pid, motor1_speed);
      motor2_pwm = PID_realize(&motor2_pid, motor2_speed);
      Load_PWM(motor1_pwm, motor2_pwm);
      
      Enc1_cnt = -(short)__HAL_TIM_GET_COUNTER(&htim2);
      Enc2_cnt = (short)__HAL_TIM_GET_COUNTER(&htim4);
      motor1_speed = (float)Enc1_cnt*100/45/11/4;
      motor2_speed = (float)Enc2_cnt*100/45/11/4;
      printf("Enc1_cnt: %d\r\n", Enc1_cnt);
      printf("Enc2_cnt: %d\r\n", Enc2_cnt);
      printf("motor1_speed: %.3f\r\n", motor1_speed);
      printf("motor2_speed: %.3f\r\n", motor2_speed);
      //OLED显示
      sprintf(oledBuf, "left_speed :%.3f",motor1_speed);
      OLED_ShowString(0, 40, (u8*)oledBuf, 12);
      sprintf(oledBuf, "right_speed:%.3f",motor2_speed);
      OLED_ShowString(0, 52, (u8*)oledBuf, 12);
      OLED_Refresh();
      __HAL_TIM_SET_COUNTER(&htim2, 0);
      __HAL_TIM_SET_COUNTER(&htim4, 0);
      HAL_Delay(10);
  }}

匿名上位机显示波形

匿名上位机下载

匿名上位机通信协议可参考这篇文章匿名上位机V7.12协议编程(基于STM32F407+CubeMX+UART外设通信)

使用

新建ano_upper.h

#ifndef STM32_ANO_UPPER_H
#define STM32_ANO_UPPER_H
#include "main.h"
#include "usart.h"

//数据拆分宏定义,在发送大于1字节的数据类型时,比如int16、float等,需要把数据拆分成单独字节进行发送

#define BYTE0(dwTemp) ( *( (char *)(&dwTemp) ) ) /*!< uint32_t 数据拆分 byte0 */
#define BYTE1(dwTemp) ( *( (char *)(&dwTemp) + 1) ) /*!< uint32_t 数据拆分 byte1 */
#define BYTE2(dwTemp) ( *( (char *)(&dwTemp) + 2) ) /*!< uint32_t 数据拆分 byte2 */
#define BYTE3(dwTemp) ( *( (char *)(&dwTemp) + 3) ) /*!< uint32_t 数据拆分 byte3 */


void ANO_DT_Send_F1(uint16_t data1, uint16_t data2, uint16_t data3, uint16_t data4);
void ANO_DT_Send_F2(int16_t data1, int16_t data2, int16_t data3, int16_t data4);
void ANO_DT_Send_F3(int16_t data1, int16_t data2, int32_t data3);
#endif //STM32_ANO_UPPER_H

ano_upper.c

#include "ano_upper.h"
/** 发送数据缓存 */

unsigned char data_to_send[50]; //用于绘图

/*
* @brief 向上位机发送发送4个uint16_t数据
* @param data1: 发送给上位机显示波形 (可以自己加)
* @return 无
* @note 通过F1帧发送4个uint16类型数据
* @see ANO_DT_Send_F1
*/
void ANO_DT_Send_F1(uint16_t data1, uint16_t data2, uint16_t data3, uint16_t data4)
{
    unsigned char _cnt=0; //计数值
    unsigned char i = 0;
    unsigned char sumcheck = 0; //和校验
    unsigned char addcheck = 0; //附加和校验
    data_to_send[_cnt++] = 0xAA; //帧头 0xAA
    data_to_send[_cnt++] = 0xFF; //目标地址
    data_to_send[_cnt++] = 0xF1; //功能码0xF1
    data_to_send[_cnt++] = 8; //数据长度8个字节
    //单片机为小端模式-低地址存放低位数据 匿名上位机要求先发低位数据, 所以先发低地址
    data_to_send[_cnt++]=BYTE0(data1);
    data_to_send[_cnt++]=BYTE1(data1);

    data_to_send[_cnt++]=BYTE0(data2);
    data_to_send[_cnt++]=BYTE1(data2);

    data_to_send[_cnt++]=BYTE0(data3);
    data_to_send[_cnt++]=BYTE1(data3);

    data_to_send[_cnt++]=BYTE0(data4);
    data_to_send[_cnt++]=BYTE1(data4);

    for(i=0; i < (data_to_send[3]+4); i++) //数据校验
    {
        sumcheck += data_to_send[i]; //从帧头开始,对每一字节进行求和,直到DATA区结束
        addcheck += sumcheck; //每一字节的求和操作,进行一次sumcheck的累加
    };
    data_to_send[_cnt++]=sumcheck;
    data_to_send[_cnt++]=addcheck;
    HAL_UART_Transmit(&huart1, data_to_send,_cnt,0xFFFF);
}
/*
* @brief 向上位机发送发送4个int16_t数据
* @param data1: 发送给上位机显示波形 (可以自己加)
* @return 无
* @note 通过F2帧发送4个int16类型数据
* @see ANO_DT_Send_F2
*/
void ANO_DT_Send_F2(int16_t data1, int16_t data2, int16_t data3, int16_t data4)
{
    unsigned char _cnt=0; //计数值
    unsigned char i = 0;
    unsigned char sumcheck = 0; //和校验
    unsigned char addcheck = 0; //附加和校验
    data_to_send[_cnt++] = 0xAA; //帧头 0xAA
    data_to_send[_cnt++] = 0xFF; //目标地址
    data_to_send[_cnt++] = 0xF2; //功能码0xF2
    data_to_send[_cnt++] = 8; //数据长度8个字节
    //单片机为小端模式-低地址存放低位数据 匿名上位机要求先发低位数据, 所以先发低地址
    data_to_send[_cnt++]=BYTE0(data1);
    data_to_send[_cnt++]=BYTE1(data1);

    data_to_send[_cnt++]=BYTE0(data2);
    data_to_send[_cnt++]=BYTE1(data2);

    data_to_send[_cnt++]=BYTE0(data3);
    data_to_send[_cnt++]=BYTE1(data3);

    data_to_send[_cnt++]=BYTE0(data4);
    data_to_send[_cnt++]=BYTE1(data4);

    for(i=0; i < (data_to_send[3]+4); i++) //数据校验
    {
        sumcheck += data_to_send[i]; //从帧头开始,对每一字节进行求和,直到DATA区结束
        addcheck += sumcheck; //每一字节的求和操作,进行一次sumcheck的累加
    };
    data_to_send[_cnt++]=sumcheck;
    data_to_send[_cnt++]=addcheck;
    HAL_UART_Transmit(&huart1, data_to_send,_cnt,0xFFFF);
}
/*
* @brief 向上位机发送发送2个int16_t和1个int32_t数据
* @param data1: 发送给上位机显示波形 (可以自己加)
* @return 无
* @note 通过F3帧发送2个int16_t和1个int32_t数据
* @see ANO_DT_Send_F3
*/
void ANO_DT_Send_F3(int16_t data1, int16_t data2, int32_t data3)
{
    unsigned char _cnt=0; //计数值
    unsigned char i = 0;
    unsigned char sumcheck = 0; //和校验
    unsigned char addcheck = 0; //附加和校验
    data_to_send[_cnt++] = 0xAA; //帧头 0xAA
    data_to_send[_cnt++] = 0xFF; //目标地址
    data_to_send[_cnt++] = 0xF3; //功能码0xF2
    data_to_send[_cnt++] = 8; //数据长度8个字节
    //单片机为小端模式-低地址存放低位数据 匿名上位机要求先发低位数据, 所以先发低地址
    data_to_send[_cnt++]=BYTE0(data1);
    data_to_send[_cnt++]=BYTE1(data1);

    data_to_send[_cnt++]=BYTE0(data2);
    data_to_send[_cnt++]=BYTE1(data2);

    data_to_send[_cnt++]=BYTE0(data3);
    data_to_send[_cnt++]=BYTE1(data3);
    data_to_send[_cnt++]=BYTE2(data3);

    for(i=0; i < (data_to_send[3]+4); i++) //数据校验
    {
        sumcheck += data_to_send[i]; //从帧头开始,对每一字节进行求和,直到DATA区结束
        addcheck += sumcheck; //每一字节的求和操作,进行一次sumcheck的累加
    };
    data_to_send[_cnt++]=sumcheck;
    data_to_send[_cnt++]=addcheck;
    HAL_UART_Transmit(&huart1, data_to_send,_cnt,0xFFFF);
}

main.c

//使用F2帧模式发送4个int16类型数据
ANO_DT_Send_F2(motor1_speed*100, motor2_speed*100, 1.0*100, 1.0*100);

显示
目标值为1.0
STM32使用PID调速,stm32,嵌入式硬件,单片机最终

STM32使用PID调速,stm32,嵌入式硬件,单片机文章来源地址https://www.toymoban.com/news/detail-681820.html

到了这里,关于STM32使用PID调速的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处: 如若内容造成侵权/违法违规/事实不符,请点击违法举报进行投诉反馈,一经查实,立即删除!

领支付宝红包 赞助服务器费用

相关文章

  • STM32使用PID调速

    PID算法是一种闭环控制系统中常用的算法,它结合了比例(P)、积分(I)和微分(D)三个环节,以实现对系统的控制。它的目的是使 控制系统的输出值尽可能接近预期的目标值。 在PID算法中,控制器通过不断地测量实际输出值和目标值之间的误差,并使用比例、积分和微

    2024年02月11日
    浏览(33)
  • 【嵌入式】STM32计时器编码器接口模式使用

    使用STM32调试电机或传感器时经常会使用到计数器的编码器接口模式,本文主要记录该模式的固件库配置方法,并给出使用该模式获取光栅测距值的实例。 硬件: STM32F103C8T6 光栅测距传感器 编码器接口模式为STM32计时器的一种特殊使用模式,该模式下可对编码器输出的脉冲信

    2024年02月20日
    浏览(49)
  • 【嵌入式学习笔记】嵌入式基础9——STM32启动过程

    程序段交叉引用关系(Section Cross References):描述各文件之间函数调用关系 删除映像未使用的程序段(Removing Unused input sections from the image):描述工程中未用到被删除的冗余程序段(函数/数据) 映像符号表(Image Symbol Table):描述各符号(程序段/数据)在存储器中的地址、类

    2024年02月15日
    浏览(87)
  • stm32嵌入式实验考核

    STM32 实验考核题目 1. 利用 STM32 小板实现:控制外接 LED 灯每隔 3 秒钟亮暗变换,同 时在 PC 机上显示 MCU 的计时时间,MCU 的初始时间由 PC 机 方设置。 2. 利用 STM32 小板实现:利用导线外接 GPIO 口模拟 2 个按键输入, 根据输入组合的四种情况,分别控制三色灯四种流水灯效果

    2024年02月03日
    浏览(53)
  • 从零开始教你使用Clion优雅开发STM32(三)Clion嵌入式开发必备插件

    (一)软件安装与环境配置 (二)移植工程文件到其他芯片 (三)Clion嵌入式开发必备插件 文章目录 前言 1)Chinese(simplified) 2)CodeGlance Pro 3)File Watchers  4)Key Promoter X 5)CodeGlance Pro 6)Monokai Pro Theme 7)Rainbow Brackets Lite 8)Serial Port  Monitor 总结 前段时间,稚晖君用 Cl

    2024年02月06日
    浏览(62)
  • 【Mac+CLion+STM32+ST-Link】Mac(apple sillicon)上使用STM32CubeMX和CLion搭建嵌入式开发环境

    Clion 官网安装或者brew安装,我用的是2023.2版本。 stlink server https://www.st.com/en/development-tools/st-link-server.html 不安装的话检测不到stlink。 STM32CubeMX https://www.st.com/en/development-tools/stm32cubeide.html#overviewsecondary=st-get-software 用来快速搭建一个工程。 Arm-toolchain 用来编译和debug的组件。

    2024年02月08日
    浏览(45)
  • 嵌入式 STM32 通讯协议--MODBUS

    目录 一、自定义通信协议 1、协议介绍 2、网络协议 3、自定义的通信协议  二、MODBUS通信协议 1、概述 2、MODBUS帧结构  协议描述 3、MODBUS数据模型   4、MODBUS事务处理的定义 5、MODBUS功能码  6、功能码定义   7、MODBUS数据链路层 8、MODBUS地址规则  9、MODBUS帧描述 10、MODBUS两种

    2024年02月11日
    浏览(66)
  • STM32的时钟系统(嵌入式学习)

    时钟是指用于计量和同步时间的装置或系统。时钟是嵌入式系统的脉搏,处理器内核在时钟驱动下完成指令执行,状态变换等动作,外设部件在时钟的驱动下完成各种工作,例如:串口数据的发送、AD转换、定时器计数等。因此时钟对于计算机系统是至关重要的,通常时钟系

    2024年02月16日
    浏览(50)
  • 嵌入式——新建STM32工程(标准库)

    目录 一、初识标准库 1.CMSIS标准及库层级关系 2.库文件介绍 (1)Libraries文件夹 ①CMSIS文件夹 ②STM32F10x_Std_Periph_Driver文件夹 ③ 在用库建立一个完整的工程时,还需要添加stm32f10x_it.c、 stm32f10x_conf.h 和 system_stm32f10x.c文件 (2)Project文件夹 (3)Utilities文件夹 3.库各文件之间的关

    2024年01月23日
    浏览(59)
  • STM32串口通信详解(嵌入式学习)

    时钟信号在电子领域中是指用于同步和定时电路操作的周期性信号。它在数字系统和通信系统中起着至关重要的作用,用于协调各个组件之间的数据传输和操作。 时钟信号有以下几个重要的方面: 频率:时钟信号的频率是指单位时间内信号周期的数量。它通常以赫兹(Hz)为

    2024年02月09日
    浏览(69)

觉得文章有用就打赏一下文章作者

支付宝扫一扫打赏

博客赞助

微信扫一扫打赏

请作者喝杯咖啡吧~博客赞助

支付宝扫一扫领取红包,优惠每天领

二维码1

领取红包

二维码2

领红包