设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › stm32f407进行直流电机pid调速源程序
返回列表 发新帖
查看: 4454|回复: 2
打印 上一主题 下一主题
收起左侧

stm32f407进行直流电机pid调速源程序

  [复制链接]
跳转到指定楼层
#
ID:373139 发表于 2020-3-2 11:51 | 只看该作者 |只看大图 回帖奖励 |正序浏览 |阅读模式
stm32f407驱动电机进行pid调速。

单片机源程序如下:
  1. #include "sys.h"
  2. #include "delay.h"
  3. #include "usart.h"
  4. #include "led.h"
  5. #include "lcd.h"
  6. #include "adc.h"
  7. #include "key.h"
  8. #include "encoder.h"
  9. #include "moter.h"
  10. #include "pwm.h"
  11. #include "tim.h"

  13. #define BYTE0(dwTemp)       ( *( (char *)(&dwTemp)          ) )
  14. #define BYTE1(dwTemp)       ( *( (char *)(&dwTemp) + 1) )
  15. #define BYTE2(dwTemp)       ( *( (char *)(&dwTemp) + 2) )
  16. #define BYTE3(dwTemp)       ( *( (char *)(&dwTemp) + 3) )
  17.    
  18. u8 testdatatosend[50];
  19. void Test_Send_User(uint16_t data1, uint16_t data2, uint16_t data3,uint16_t data4,uint16_t data5,uint16_t data6,uint16_t data7,uint16_t data8,uint16_t data9,uint16_t data10)        ;
  20. void UART1_Send_Str(unsigned char *s);
  21. u8 temp[50];
  22. char i=0;
  23. int now;
  24. int aim=50000;
  25. int error,last_error;
  26. int error_sum;
  27. int pwm=200;
  28. float KP=3.0
  29.        ,KI=0.32 //0.34
  30.         ,KD=50.0; //55.0
  31.   
  32. int main(void)
  33. {

  35.         u8 key;
  36.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//设置系统中断优先级分组2
  37.         delay_init(168);    //初始化延时函数
  38.         uart_init(115200);        //初始化串口波特率为115200
  39.         LED_Init();                                        //初始化LED
  40.          LCD_Init();                                        //LCD初始化KEY_Init();                                 //按键初始化
  41.     TIM3_ENC_Init();
  42.     KEY_Init();
  43.     MOTER_Init();
  44.     LED_Init();
  45.     PWM_TIM4_Init(1000-1,84-1); //1000HZ
  46.     setPWM(pwm);
  47.     POINT_COLOR=RED;
  48.         LCD_ShowString(30,50,200,16,16,"Explorer STM32F4");        
  49.         LCD_ShowString(30,70,200,16,16,"---PID---");        
  50.         LCD_ShowString(30,90,200,16,16,"MOTER:");
  51.         LCD_ShowString(30,110,200,16,16,"2014/5/6");         
  52.     TIM6_Int_Init(499,1679);
  53.                
  54.         while(1)
  55.         {
  56.         key=KEY_Scan(0);        
  57.         switch(key){
  58.             case 1: aim+=500;break;
  59.             case 2: aim-=500;break;
  60.         }
  61.         sprintf((char*)temp,"pwm:=%d    ",pwm);
  62.                 LCD_ShowString(30,130,200,16,16,temp);
  63.         sprintf((char*)temp,"encoder:=%d    ",read_TIM3_position());
  64.                 LCD_ShowString(30,150,200,16,16,temp);
  65.         sprintf((char*)temp,"aim:=%d    ",aim);
  66.                 LCD_ShowString(30,170,200,16,16,temp);
  67.         sprintf((char*)temp,"error:=%d    ",error);
  68.                 LCD_ShowString(30,190,200,16,16,temp);
  69.         Test_Send_User(now,aim,0,0,0,0,0,0,0,0);
  70.       
  71.                
  72.             
  73.                
  74.         }
  75. }
  76. void TIM6_DAC_IRQHandler(void)  //100HZ 中断函数
  77. {

  79.     if(TIM_GetITStatus(TIM6,TIM_IT_Update)==SET)
  80.     {
  81.         if(++i==5)
  82.         {
  83.             i=0;
  84.             GPIO_ToggleBits(GPIOF,GPIO_Pin_9 );    //闪灯代表正在工作
  85.         }
  86.       
  87.         now=read_TIM3_position();   //get现在位置
  88.         error=now-aim;               //获取误差
  89.         if(error>=0)                 //如果error大于0 正转动
  90.            { MOTER_CW();
  91.                LCD_ShowString(30,90,200,16,16,"++++++++++++++++");  //表示正转动
  92.            }
  93.         else
  94.            { MOTER_CCW();
  95.                LCD_ShowString(30,90,200,16,16,"----------------");//表示反转动
  96.            }            //如果error大于0 正转动
  97.         error_sum+=error;      //误差累计和
  98.        if(error_sum>1000)error_sum=1000;  //积分限幅
  99.        if(error_sum<-1000)error_sum=-1000;
  100.         pwm=error*KP+error_sum*KI+(error-last_error)*KD;  //pwm= 当前误差*比例项 + 误差累计*积分项 + 两次误差之差*微分项
  101.         last_error=error;           //误差冲洗赋值
  102.         setPWM(pwm);         //设定PWM
  103.         
  104.             
  105.     }

  107.         
  108.         
  109.   TIM_ClearITPendingBit(TIM6,TIM_IT_Update);

  111. }


  114. void Test_Send_User(uint16_t data1, uint16_t data2, uint16_t data3,uint16_t data4,uint16_t data5,uint16_t data6,uint16_t data7,uint16_t data8,uint16_t data9,uint16_t data10)        
  115. {
  116.         u8 _cnt=0;
  117.     u8 i;
  118.     u8 sum = 0;
  119.         
  120.         testdatatosend[_cnt++]=0xAA;
  121.         testdatatosend[_cnt++]=0x05;
  122.         testdatatosend[_cnt++]=0xAF;
  123.         testdatatosend[_cnt++]=0xF1;
  124.         testdatatosend[_cnt++]=0;

  126.         testdatatosend[_cnt++]=BYTE1(data1);
  127.         testdatatosend[_cnt++]=BYTE0(data1);
  128.         
  129.         testdatatosend[_cnt++]=BYTE1(data2);
  130.         testdatatosend[_cnt++]=BYTE0(data2);
  131.         
  132.         testdatatosend[_cnt++]=BYTE1(data3);
  133.         testdatatosend[_cnt++]=BYTE0(data3);
  134.         
  135.         testdatatosend[_cnt++]=BYTE1(data4);
  136.         testdatatosend[_cnt++]=BYTE0(data4);
  137.         
  138.         testdatatosend[_cnt++]=BYTE1(data5);
  139.         testdatatosend[_cnt++]=BYTE0(data5);
  140.         
  141.         testdatatosend[_cnt++]=BYTE1(data6);
  142.         testdatatosend[_cnt++]=BYTE0(data6);
  143.         
  144.         testdatatosend[_cnt++]=BYTE1(data7);
  145.         testdatatosend[_cnt++]=BYTE0(data7);
  146.         
  147.         testdatatosend[_cnt++]=BYTE1(data8);
  148.         testdatatosend[_cnt++]=BYTE0(data8);
  149.         
  150.         testdatatosend[_cnt++]=BYTE1(data9);
  151.         testdatatosend[_cnt++]=BYTE0(data9);
  152.         
  153.         testdatatosend[_cnt++]=BYTE1(data10);
  154.         testdatatosend[_cnt++]=BYTE0(data10);
  155.         
  156.         

  158.         testdatatosend[4] = _cnt-5;
  159.         
  160.                
  161.         for( i=0;i<_cnt;i++)
  162.                 sum += testdatatosend[i];
  163.         
  164.         testdatatosend[_cnt++]=sum;        

  166.         UART1_Send_Str(testdatatosend);
  167. }

  169. void UART1_Send_Str(unsigned char *s)//发送字符串 函数   应用指针 方法
  170. {
  171.         unsigned char i=0;  //定义一个局部变量  用来 发送字符串 ++运算

  173.         while(s[i]!=' ')  // 每个字符串结尾 都是以   结尾的
  174.         {
  175.                 USART_SendData(USART1,s[i]);        //通过库函数  发送数据
  176.                 while( USART_GetFlagStatus(USART1,USART_FLAG_TC)!= SET);  
  177.                 //等待发送完成。   检测 USART_FLAG_TC 是否置1；    //见库函数 P359 介绍

  179.                 i++;                 //i++一次
  180.         }

  182. }
复制代码

所有资料51hei提供下载:
PID教程视频对应代码.7z (343.65 KB, 下载次数: 123)


评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励！

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏7 分享淘帖 顶顶1 踩踩
回复

使用道具 举报

沙发
ID:1089424 发表于 2023-7-27 21:31 | 只看该作者
我的好哥哥，视频在哪里呀
回复

使用道具 举报

楼主
ID:1080782 发表于 2023-7-13 19:22 | 只看该作者
视频在哪里
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表