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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › stm32f103的自动调节角度的源程序
返回列表 发新帖
查看: 2273|回复: 0
打印 上一主题 下一主题
收起左侧

stm32f103的自动调节角度的源程序

[复制链接]
跳转到指定楼层
楼主
ID:346849 发表于 2018-6-23 19:21 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
用电位器读取角度，通过小车的加速度来控制下面摆杆

单片机源程序如下:
  1. #include "stm32f10x.h"
  2. #include "sys.h"
  3. #include "usart.h"
  4. #include "adc.h"
  5. #include "Ultrasonic.h"
  6. #include "control.h"
  7. //u32 Distance1,Distance2;  
  8. float Set_Angle;
  9. //角速度和角度向左为正，向右为负
  10. extern u32 TIM1_CH1_Time;        //CH1测量方波1的高电平时间，用于计算占空比
  11. extern u32 TIM1_CH4_Time;        //CH4测量方波2的两个上升沿间隔时间，用于计算周期
  12. extern u16 TIM1CH1_CAPTURE_STA ;        //通道1输入捕获标志，15位做捕获标志，低15位做溢出标志               
  13. extern u16 TIM1CH1_CAPTURE_UPVAL,TIM1CH1_CAPTURE_DOWNVAL;
  14. extern u16 TIM1CH4_CAPTURE_STA;        //通道1输入捕获标志，15位做捕获标志，低15位做溢出标志                       
  15. extern u16 TIM1CH4_CAPTURE_UPVAL,TIM1CH4_CAPTURE_DOWNVAL;

  17. int KEY1_Num,KEY2_Num,KEY3_Num,KEY4_Num;
  18. int m;
  19. int n=0;
  20. int a=0;
  21. float Place;
  22. float Angle;
  23. float Speed_Left,Speed_Right;   
  24. float angle1;               //角度传感器所得角度
  25. float temp;
  26. u8 dir=1;
  27. u8 d[15];
  28. int main(void)
  29. {
  30.             vu8 key=0;
  31.             delay_init();
  32.                   NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
  33.             LED_Init();
  34.             OLED_Init();
  35.       KEY_Init();
  36. //           uart_init(9600);
  37.            PWM_Init(7199,0);                   //10KHZ
  38.            Ultrasonic_Init();
  39.      TIM3_Cap_Init(0XFFFF,72-1);                //=====超声波初始化       
  40.            TIM5_Time_Init(4999,7199);
  41.            Adc_Init();       
  42.            BEEP_Init();
  43.            while(1)
  44.                 {
  45.                         angle1=Get_angle1_Average(4,5);
  46.                         Ultrasonic_Dis_Turn();         
  47.                         Ultrasonic_Trig();
  48. //                         Place=Dis_FIR.FRONT;
  49. //      Place=Dis_FIR.FRONT;
  50. //                        Angle1_PID(angle1,2000);
  51. //                        SetSpeed=Place_PID(Place);
  52.                         OLED_ShowString(0,0,"Dis_FIR");
  53.                         OLED_ShowNum(60,0,Dis_FIR.FRONT,5,12);
  54.                         OLED_ShowString(0,1,"Dis_BACK");
  55.       OLED_ShowNum(60,1,Dis_FIR.BACK,5,12);
  56.                         OLED_ShowString(0,2,"angle1");
  57.                         OLED_ShowNum(60,2,angle1,5,12);
  58.                         OLED_ShowString(0,3,"PWMA");
  59.                         OLED_Float(60,3,PWMA,1);
  60.                         OLED_ShowString(0,4,"PWMB");
  61.                         OLED_Float(60,4,PWMB,1);
  62.                                 Angle1_PID(angle1,2235);
  63.                          Angle_PWM=Angle1_PID(angle1,2190);
  64.                          Set_Pwm(Angle_PWM,Angle_PWM);
  65. //                                Angle1_PID(angle1,2235);
  66. //                         Angle_PWM=Angle1_PID(angle1,2235);
  67. //                         Set_Pwm(Angle_PWM,Angle_PWM);
  68.                         delay_ms(10);
  69.                          key=KEY_Scan(0);        //得到键值
  70.                    if(key)
  71.                 {                                                  
  72.                         switch(key)
  73.                 {                                 
  74.                          case KEY0_PRES:        //控制LED0翻转
  75.                          Set_Pwm(1500,1500);
  76.                          break;
  77.        case KEY1_PRES:        //控制LED0翻转
  78. //                         Angle1_PID(angle1,2235);
  79. //                         Angle_PWM=Angle1_PID(angle1,2235);
  80. //                         Set_Pwm(Angle_PWM,Angle_PWM);
  81.                          delay_ms(10);
  82.                          break;
  83.                          case KEY2_PRES:        //控制LED0翻转
  84.                                  Turn_Off();
  85.                          break;
  86. //                         case KEY3_PRES:        //控制LED1翻转         
  87. //                                        LED1=!LED1;
  88.                        

  90.                 }
  91. }
  92. }
  93. }
  94. //                 key=KEY_Scan(0);        //得到键值
  95. //                   if(key)
  96. //                {                                                  
  97. //                        switch(key)
  98. //                        {                                 
  99. //                         case KEY1_PRES:        //控制LED0翻转
  100. //                                         Turn_Off();
  101. //                         break;
  102. //                         case KEY2_PRES:        //控制LED0翻转
  103. //                                        LED1=!LED1;
  104. //                         break;
  105. //                         case KEY3_PRES:        //控制LED1翻转         
  106. //                                        LED1=!LED1;
  107. //                         break;
  108. //                         case KEY0_PRES:        //同时控制LED0,LED1翻转
  109. //                                        LED2=!LED2;
  110. //                                        LED1=!LED1;
  111. //                         break;
复制代码

所有资料51hei提供下载:
F1小车.rar (317.32 KB, 下载次数: 7)


stm32智能小车, 调节下部杠杆角度

评分

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

查看全部评分

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

相关帖子
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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