datasheet

STM32上实现增量式PID

2018-10-05来源: eefocus 关键字:STM32  增量式  PID

目录:

一、什么是增量式PID

二、硬件部分

三、软件部分


---------------------------------------------------------------------------------------------------------------

一、什么是增量式PID

虽然PID不是什么牛逼的东西,但是真心希望以后刚刚接触这块的人能尽快进入状态。特地分享一些自己如何实现的过程。PID控制算法介绍与C程序实现
首先说说增量式PID的公式,这个关系到MCU算法公式的书写,实际上两个公式的写法是同一个公式变换来的,不同的是系数的差异。http://bbs.elecfans.com/jishu_484125_1_1.html

资料上比较多的是:


还有一种的算法是:


这里主要介绍第二种,具体会分析比例、积分、微分三个环节的作用。


---------------------------------------------------------------------------------------------------------------
二、硬件部分
控制系统的控制对象是4个空心杯直流电机,电机带光电编码器,可以反馈转速大小的波形。电机驱动模块是普通的L298N模块。芯片:STM32F103ZET6

---------------------------------------------------------------------------------------------------------------
三、软件部分
PWM输出:

TIM3,可以直接输出4路不同占空比的PWM波
PWM捕获:

STM32除TIM6、TIM7其余的都有捕获功能,本处使用TIM1、TIM2、TIM4、TIM5四个定时器捕获四个反馈信号
PID的采样和处理:

使用了基本定时器TIM6,溢出时间就是我的采样周期,理论上T越小效果会越好,这里我取20ms,依据控制对象吧,如果控制水温什么的采样周期会是几秒几分钟什么的。

上面的PWM输出和捕获关于定时器的设置都有例程,我这里是这样的:
TIM3输出四路PWM,在引脚 C 的 GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9输出
四路捕获分别是TIM4、TIM1、TIM2、TIM5 ,对应引脚是:  PB7、PE11、PB3、PA1
高级定时器tim1的初始化略不同,它的中断”名称“和通用定时器不同。具体的内容,请大家看一下我分享的代码就明白了。

void TIM3_PWM_Init(u16 arr,u16 psc)

{  

        GPIO_InitTypeDef GPIO_InitStructure;

        TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;

        TIM_OCInitTypeDef  TIM_OCInitStructure;

        


        RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);

        RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC  | RCC_APB2Periph_AFIO, ENABLE);  

//使能GPIO外设和AFIO复用功能模块时钟使能

        

  GPIO_PinRemapConfig(GPIO_FullRemap_TIM3, ENABLE); //Timer3全映射 GPIOC-> 6,7,8,9                 //用于TIM3的CH2输出的PWM通过该LED显示


//设置该引脚为复用输出功能,输出TIM3 CH1 CH2 CH3 CH4 的PWM脉冲波形

        GPIO_InitStructure.GPIO_Pin =GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9; //初始化GPIO

        GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;  //复用推挽输出

        GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;

        GPIO_Init(GPIOC, &GPIO_InitStructure);

        GPIO_ResetBits(GPIOC,GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9);

//默认电机使能端状态:不使能 


        TIM_TimeBaseStructure.TIM_Period = arr;

 //设置在下一个更新事件装入活动的自动重装载寄存器周期的值

        TIM_TimeBaseStructure.TIM_Prescaler =psc; 

//设置用来作为TIMx时钟频率除数的预分频值  这里是72分频,那么时钟频率就是1M 

        TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim

        TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式

        TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); 

//根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位

        

        TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; //选择定时器模式:TIM脉冲宽度调制模式1

        TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能

        TIM_OCInitStructure.TIM_Pulse = 0; //设置待装入捕获比较寄存器的脉冲值

        TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性:TIM输出比较极性高

        

        TIM_OC1Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx

        TIM_OC1PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR1上的预装载寄存器


        TIM_OC2Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx

        TIM_OC2PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR2上的预装载寄存器

        

        TIM_OC3Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx

        TIM_OC3PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR3上的预装载寄存器

        

        TIM_OC4Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx

        TIM_OC4PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR4上的预装载寄存器

        

        TIM_ARRPreloadConfig(TIM3, ENABLE); //使能TIMx在ARR上的预装载寄存器


        TIM_Cmd(TIM3, ENABLE);  //使能TIMx外设

}


void TIM4_PWMINPUT_INIT(u16 arr,u16 psc)

{

  

        TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure; //TIM的初始化结构体

        NVIC_InitTypeDef NVIC_InitStructure;                        //中断配置

        TIM_ICInitTypeDef  TIM4_ICInitStructure;                 //TIM4  PWM配置结构体

        GPIO_InitTypeDef GPIO_InitStructure;                      //IO口配置结构体


        RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);     //Open TIM4 clock

  RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);  //open gpioB clock


        GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7;             //GPIO 7

  GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;          //上拉输入

  GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;

  GPIO_Init(GPIOB, &GPIO_InitStructure);


        TIM_TimeBaseStructure.TIM_Period = arr; 

//设置在下一个更新事件装入活动的自动重装载寄存器周期的值  

        TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值  

        TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim

        TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式

        TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); 

//根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位


       

        NVIC_InitStructure.NVIC_IRQChannel = TIM4_IRQn;                     

  NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;

  NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;

  NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;

  NVIC_Init(&NVIC_InitStructure);


  TIM4_ICInitStructure.TIM_Channel = TIM_Channel_2;                   

  TIM4_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;       

TIM4_ICInitStructure.TIM_ICSelection = TIM_ICSe

[1] [2] [3] [4] [5]

关键字:STM32  增量式  PID

编辑:什么鱼 引用地址:http://www.eeworld.com.cn/mcu/2018/ic-news100541472.html
本网站转载的所有的文章、图片、音频视频文件等资料的版权归版权所有人所有,本站采用的非本站原创文章及图片等内容无法一一联系确认版权者。如果本网所选内容的文章作者及编辑认为其作品不宜公开自由传播,或不应无偿使用,请及时通过电子邮件或电话通知我们,以迅速采取适当措施,避免给双方造成不必要的经济损失。

上一篇:STM32F4时钟初始化配置
下一篇:最后一页

关注eeworld公众号 快捷获取更多信息
关注eeworld公众号
快捷获取更多信息
关注eeworld服务号 享受更多官方福利
关注eeworld服务号
享受更多官方福利

推荐阅读

STM32F4时钟初始化配置

STM32F4 时钟系统初始化是在system_stm32f4xx.c中的 SystemInit()函数中完成的。 对于系统时钟关键寄存器设置主要是在 SystemInit 函数中调用 SetSysClock()函数来设置的。我们可以先看看 SystemInit ()函数体:void SystemInit(void){     #if (__FPU_PRESENT == 1) && (__FPU_USED == 1)     SCB->
发表于 2018-09-29

STM32F4时钟使能和配置

;STM32F4 有 5 大类时钟源。这里我们列出来几种重要的时钟源使能函数:         void   RCC_HSICmd(FunctionalState NewState);void   RCC_LSICmd(FunctionalState NewState);void   RCC_PLLCmd(FunctionalState NewState);void   RCC_PLLI2SCmd
发表于 2018-09-29

STM32f4---跑马灯实验代码

就包含了一个函数 void LED_Init(void),该函数的功能就是用来实现配置 PF9和PF10 为推挽输出。这里需要注意的是:在配置STM32 外设的时候,任何时候都要先使能该外设的时钟!GPIO 是挂载在AHB1 总线上的外设,在固件库中对挂载在 AHB1 总线上的外设时钟使能是通过函数RCC_AHB1PeriphClockCmd ()来实现的。对于这个入口参数设置,看看我们的代码:RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOF, ENABLE);//使能 GPIOF时钟这行代码的作用是使能
发表于 2018-09-29

STM32f4---外部中断实验代码(01)

;       EXTI_ClearITPendingBit(EXTI_Line4);//清除 LINE4上的中断标志位   }      //外部中断初始化程序//初始化PE2~4,PA0为中断输入.void EXTIX_Init(void){NVIC_InitTypeDef   NVIC_InitStructure;EXTI_InitTypeDef    EXTI_InitStructure; 
发表于 2018-09-29

STM32f4---PWM输出实验代码

pwm.c源文件代码如下:  //TIM14 PWM部分初始化  //PWM输出初始化//arr:自动重装值   psc:时钟预分频数void TIM14_PWM_Init(u32 arr,u32 psc){                    GPIO_InitTypeDef GPIO_InitStructure;  
发表于 2018-09-29

STM32f4---输入捕获实验代码(02)

此部分代码包含两个函数,其中TIM5_CH1_Cap_Init函数用于 TIM5通道 1的输入捕获设置,其设置和我们上面讲的步骤是一样的,这里就不多说,特别注意:TIM5 是 32 位定时器,所以 arr是u32 类型的。接下来,重点来看看第二个函数。TIM5_IRQHandler 是 TIM5 的中断服务函数,该函数用到了两个全局变量,用于辅助实现高电平捕获。其中TIM5CH1_CAPTURE_STA,是用来记录捕获状态,该变量类似我们在usart.c里面自行定义的USART_RX_STA 寄存器(其实就是个变量
发表于 2018-09-29

小广播

何立民专栏

单片机及嵌入式宝典

北京航空航天大学教授,20余年来致力于单片机与嵌入式系统推广工作。

电子工程世界版权所有 京ICP证060456号 京ICP备10001474号 电信业务审批[2006]字第258号函 京公海网安备110108001534 Copyright © 2005-2018 EEWORLD.com.cn, Inc. All rights reserved