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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › 基于STM32F103的简易倒立摆KEIL5工程下载
返回列表 发新帖
查看: 3386|回复: 0
打印 上一主题 下一主题
收起左侧

基于STM32F103的简易倒立摆KEIL5工程下载

[复制链接]
跳转到指定楼层
楼主
ID:359202 发表于 2018-6-26 11:40 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
   2013电子设计竞赛控制类题目

单片机源程序如下:
  1. #include "sys.h"
  2. int flag=0,key=0;
  3. int Bias=0;                                      //本次偏差
  4. int Last_Bias=0;                                                        //上一次偏差                    
  5. int angel,G0=0; //摆杆角度
  6. int Encoderdata;                //电机速度
  7. //float Encoder_Least,Encoder=0;
  8. //float Encoder_Integral;
  9. int pwm;                                                          //pwm输出量

  11. int main(void)
  12. {
  13.         int i;                                                 
  14.         delay_init();                                                        //延时初始化  
  15.         uart_init(115200);                     //串口初始化为
  16.   LED_Init();                                              //初始化与LED连接的硬件接口
  17.         Balance_Motor_Init();     //电机控制端口初始化
  18.         KEY_Init();                                                          //按键端口初始化
  19.         LCDx_Init();                                             //初始化LCD         
  20.   Adc_Init();                                                          //ADC初始化
  21.         TIM2_Base_Init(50);       //10Khz的计数频率，计数到50为5ms
  22.         TIM4_PWM_Init(999,6);            //72000000/(6*1000)=12Khz
  23.         Encoder_Init();                                                //TIM3 PA6 PA7
  24.         delay_ms(200);            //=====延时等待稳定       
  25.         POINT_COLOR=BLUE;                                       
  26.         LCD_ShowString(60,110,200,16,16,"Encoder VAL:");
  27.         LCD_ShowString(60,130,200,16,16,"ADC_CH1_VAL:");             
  28.         LCD_ShowString(100,190,200,16,16,"Press Key_x");
  29.         while(1)
  30.         {
  31.                 LED2_REV;
  32.     delay_ms(100);               
  33.                 //angel=Get_Adc(ADC_Channel_1);
  34.                 //Read_Encoder();
  35.                 //LCD_ShowxNum(156,130,angel,4,16,0);
  36.                 //LCD_ShowxNum(156,110,Encoderdata,4,16,0);
  37.                 key=KEY_Scan(0);       
  38.                    if(key)
  39.                 {                                                  
  40.                         switch(key)
  41.                         {                                 
  42.                                 case WKUP_PRES:        flag=4;break;                        //完成基本要求3和抗干扰
  43.                                 case KEY2_PRES:        flag=3;break;                        //完成保持倒立旋转臂圆周
  44.                                 case KEY1_PRES:        flag=2;break;                        //完成自起摆
  45.                                 case KEY0_PRES:        flag=1;break;     //完成基本要求1、2
  46.                         }
  47.                 }
  48.                
  49. if(flag==1)                    //按键1         
  50. {
  51.         for(i=0;i<3;i++)
  52.         {
  53.         Zheng(650);
  54.         delay_ms(400);
  55.         Fan(650);
  56.         delay_ms(400);}
  57.         for(i=0;i<2;i++)
  58.         {Zheng(800);
  59.         delay_ms(200);
  60.         Fan(800);
  61.         delay_ms(200);}
  62.         stop();
  63.         flag=0;
  64. }
  65. if(flag==2)                                                                                        //按键2
  66. {
  67.         Zheng(700);
  68.         delay_ms(400);
  69.         Fan(650);
  70.         delay_ms(400);
  71.         Zheng(950);
  72.         delay_ms(300);
  73.         Fan(950);
  74.         delay_ms(200);
  75.         stop();
  76.         flag=4;                        //进入PID调节
  77. }
  78. if(flag==3)                       //按键3
  79. {
  80.         G0=30;
  81.         flag=4;                                                                                                        //        进入PID调节
  82. }
  83.         }
  84. }       
  85. void TIM2_IRQHandler(void)   //TIM2中断
  86. {
  87.         if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) //检查指定的TIM中断发生与否:TIM 中断源
  88.                 {
  89.                 TIM_ClearITPendingBit(TIM2, TIM_IT_Update  );    //清除TIMx的中断待处理位:TIM 中断
  90.                         Read_Encoder();
  91.                         LCD_ShowxNum(156,110,Encoderdata,4,16,0);
  92.                         //LED2_REV;
  93.         if(flag==4)
  94.                         {
  95.                                 angel=Get_Adc(ADC_Channel_1)+G0;            //更新摆杆状态
  96.                                
  97.                                 Bias=angel-3210;                                                                                                                //本次偏差=adc值-平衡中值       
  98.              pwm=26.0*Bias+8.0*(Bias-Last_Bias);                                        //PD控制器                                                        
  99.                    if(pwm > 0)                                  //26 16
  100.                                                 {
  101.                                                         if(pwm>=1000)
  102.                                                         {
  103.                                                                 pwm=1000;
  104.                                                         }
  105.                                                          Fan(pwm);                                                                                                         //控制电机反转 逆时针
  106.                                                 }
  107.                                                 else
  108.                                                 {
  109.                                                         if(pwm<=-1000)                        //限制幅度
  110.                                                         {
  111.                                                                 pwm=-1000;
  112.                                                         }
  113.                                                         pwm=-pwm;
  114.                                                         Zheng(pwm);                                                                                                                //控制电机正转 顺时针       
  115.                                                 }Last_Bias=Bias;                                                           
  116.                         }
  117.                 }
  118. }

  120. //encoder=Read_Encoder();
  121. //                                Encoder_Least =encoder-0;                    //===获取最新速度偏差==测量速度-目标速度（此处为零）
  122. //                Encoder *= 0.7;                                                                //===一阶低通滤波器      
  123. //                Encoder += Encoder_Least*0.3;                                            //===一阶低通滤波器   
  124. //                Encoder_Integral +=Encoder;                                       //===积分出位移 积分时间：5ms
  125. //          if(Encoder_Integral>500)          Encoder_Integral=500;          //===积分限幅
  126. //                if(Encoder_Integral<-500)        Encoder_Integral=-500;
复制代码

所有资料51hei提供下载:
简易倒立摆 最终版 - 副本.rar (405.51 KB, 下载次数: 71)


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

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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