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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › stm32单片机控制水位源程序
返回列表 发新帖
查看: 4535|回复: 1
打印 上一主题 下一主题
收起左侧

stm32单片机控制水位源程序

[复制链接]
跳转到指定楼层
楼主
ID:310039 发表于 2018-4-17 14:34 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
这是一个利用stm32单片机控制水位的程序


单片机源程序如下:
  1. /********************************* 深圳市航太电子 *******************************
  2. * 实 验 名 ：小车超声波+红外跟踪实验
  3. * 实验说明 ：使用超声波判断前方引导物的距离，使用红外来判断引导物的移动方向
  4. * 实验平台 ：航太ARM单片机开发板
  5. * 连接方式 ：请参考interface.h文件
  6. * 注    意 ：1.因地面和轮子的差异，左右转向时需要根据实际需要调节差速的差值
  7. *            2.需要耐心调节红外避障的感应距离以及超声波控制距离
  8. *            3.建议使用不反光的书本作为引导物
  9. * 作    者 ：航太电子产品研发部
  10. ****************************************************************************************/
  11. #include "stm32f10x.h"
  12. #include "interface.h"
  13. #include "LCD1602.h"
  14. #include "IRCtrol.h"
  15. #include "motor.h"
  16. #include "UltrasonicCtrol.h"

  18. //全局变量定义
  19. volatile unsigned int speed_count=0;//占空比计数器 50次一周期
  20. char front_left_speed_duty=SPEED_DUTY;
  21. char front_right_speed_duty=SPEED_DUTY;
  22. char behind_left_speed_duty=SPEED_DUTY;
  23. char behind_right_speed_duty=SPEED_DUTY;

  25. unsigned char tick_5ms = 0;//5ms计数器，作为主函数的基本周期
  26. unsigned char tick_1ms = 0;//1ms计数器，作为电机的基本计数器
  27. unsigned char tick_200ms = 0;//刷新显示

  29. char ctrl_comm = COMM_STOP;//控制指令
  30. char ctrl_comm_last = COMM_STOP;//上一次的指令
  31. unsigned char continue_time=0;

  33. volatile unsigned int target_mm=0;
  34. unsigned int shift        =        0;
  35. volatile unsigned int height_mm        =        0;

  37. int i;
  38. unsigned int avg_dis;
  39. int flag;

  41. unsigned int Avg_Distance()
  42. {
  43.         unsigned int sum=0;
  44.         unsigned int max=0,min=10000;

  46.         sum=0;
  47.         Distance();
  48.         max        =         distance_cm;
  49.         min        =        distance_cm;
  50.         sum +=  distance_cm;
  51.         Distance();
  52.         if(max<distance_cm)
  53.                 max        =         distance_cm;
  54.         if(min>distance_cm)
  55.                 min        =        distance_cm;
  56.         sum +=  distance_cm;
  57.         Distance();
  58.         if(max<distance_cm)
  59.                 max        =         distance_cm;
  60.         if(min>distance_cm)
  61.                 min        =        distance_cm;
  62.         sum +=  distance_cm;
  63.         Distance();
  64.         if(max<distance_cm)
  65.                 max        =         distance_cm;
  66.         if(min>distance_cm)
  67.                 min        =        distance_cm;
  68.         sum +=  distance_cm;
  69.         Distance();
  70.         if(max<distance_cm)
  71.                 max        =         distance_cm;
  72.         if(min>distance_cm)
  73.                 min        =        distance_cm;
  74.         sum +=  distance_cm;
  75.         Distance();
  76.         if(max<distance_cm)
  77.                 max        =         distance_cm;
  78.         if(min>distance_cm)
  79.                 min        =        distance_cm;
  80.         sum +=  distance_cm;
  81.         Distance();
  82.         if(max<distance_cm)
  83.                 max        =         distance_cm;
  84.         if(min>distance_cm)
  85.                 min        =        distance_cm;
  86.         sum +=  distance_cm;

  88.         sum-=max;
  89.         sum-=min;
  90.         return sum/5;
  91. }

  93. void BarrierProc(void)
  94. {
  95.         return;
  96. }

  98. void GoToTarget()
  99. {
  100.         //停止注水
  101.         while(1)
  102.         {
  103.                 if(height_mm -1 >         target_mm)
  104.                 {
  105.                         //while(height_mm > target_mm)
  106.                         {       
  107.                                 //Distance();
  108.                                 avg_dis = Avg_Distance();
  109.                                 if(        avg_dis> shift )
  110.                                         avg_dis = shift;
  111.                                 else if( avg_dis ==0 )//可能返回错误数据，跳过
  112.                                         continue;               
  113.                                 height_mm        =        shift - avg_dis;
  114.                
  115.                                 front_right_speed_duty = 30;//Stop motor
  116.                
  117.                                 LEDToggle(LED_PIN);
  118.                                 LCD1602WriteDistance(height_mm);//更新距离
  119.                                 LCD1602WriteCommand(target_mm);
  120.                
  121.                                 Delayms(200);                          
  122.                         }
  123.                 }
  124.                 else if(height_mm+1 < target_mm) //水位不够，增加注水
  125.                 {
  126.                         while(height_mm < target_mm)
  127.                         {       
  128.                                 //Distance();
  129.                                 avg_dis = Avg_Distance();
  130.                                 if(        avg_dis> shift )
  131.                                         avg_dis = shift;
  132.                                 else if( avg_dis ==0 )//可能返回错误数据，跳过
  133.                                         continue;               
  134.                                 height_mm        =        shift - avg_dis;
  135.                
  136.                                 front_right_speed_duty =50;//Stop motor
  137.                
  138.                                 LEDToggle(LED_PIN);
  139.                                 LCD1602WriteDistance(height_mm);//更新距离
  140.                                 LCD1602WriteCommand(target_mm);
  141.                
  142.                                 Delayms(200);                          
  143.                         }
  144.                 }
  145.                 else  if( height_mm<target_mm+1 && height_mm > target_mm-1 )
  146.                 {       
  147.                         front_right_speed_duty = 0;
  148.                         return;
  149.                 }
  150.         }

  152. }

  154. void Keep3Min()
  155. {
  156.         front_right_speed_duty = 30;//控制PWM与流出速度一致，保持3分钟
  157.         for(i=0;i<60*3;i++)
  158.         {
  159.                 avg_dis = Avg_Distance();
  160.                 if(        avg_dis> shift )
  161.                         avg_dis = shift;
  162.                 else if( avg_dis ==0 )//可能返回错误数据，跳过
  163.                         continue;
  164.                 height_mm        =        shift - avg_dis;

  166.                 if(        height_mm +1 < target_mm )
  167.                         front_right_speed_duty += 5;
  168.                 else if( height_mm-1 > target_mm )
  169.                         front_right_speed_duty -= 5;

  171.                 LEDToggle(LED_PIN);
  172.                 LCD1602WriteDistance(height_mm);//更新距离
  173.                 LCD1602WriteCommand(target_mm);

  175.                 Delayms(500);

  177.                 avg_dis = Avg_Distance();
  178.                 if(        avg_dis> shift )
  179.                         avg_dis = shift;
  180.                 else if( avg_dis ==0 )//可能返回错误数据，跳过
  181.                         continue;
  182.                 height_mm        =        shift - avg_dis;

  184.                 if(        height_mm +1 < target_mm )
  185.                         front_right_speed_duty += 5;
  186.                 else if( height_mm-1 > target_mm )
  187.                         front_right_speed_duty -= 5;

  189.                 Delayms(500);
  190.         }
  191. }


  194. int main(void)
  195. {
  196.         //功率最大，注水
  197.         distance_cm =         0;
  198.         shift                =        276;       
  199.         height_mm        =        0;
  200.         avg_dis                =        0;

  202.         delay_init();
  203.         GPIOCLKInit();
  204.         UserLEDInit();
  205.         LCD1602Init();
  206.         IRCtrolInit();
  207.         TIM2_Init();
  208.         MotorInit();
  209.         UltraSoundInit();
  210.         RedRayInit();
  211.         ServoInit();

  213.        
  214.         while(1)
  215.         {
  216.                 Distance();
  217.                 if (  distance_cm < 10 )
  218.                 {
  219.                         CarGo();       
  220.                         Delayms(500);
  221.                         CarStop();
  222.                         Delayms(500);
  223.                 }
  224.                 else
  225.                 {
  226.                         CarBack();
  227.                         Delayms(500);
  228.                         CarStop();
  229.                         Delayms(500);
  230.                 }
  231.         }

  233.         target_mm        =         100;
  234.            //基本要求，先注水到100mm
  235.         GoToTarget();

  237.         flag=0;
  238.         while(1)
  239.         {       
  240.                  if(tick_5ms >= 5)
  241.                 {
  242.                         tick_5ms = 0;
  243.                         tick_200ms++;
  244.                         if(tick_200ms >= 40)
  245.                         {
  246.                                 tick_200ms = 0;
  247.                                 LEDToggle(LED_PIN);
  248.                                 LCD1602WriteDistance(height_mm);//更新距离
  249.                                 LCD1602WriteCommand(target_mm);       
  250.                         }
  251.                         //do something
  252.                         avg_dis = Avg_Distance();
  253.                         if(        avg_dis> shift )
  254.                                 avg_dis = shift;
  255.                         else if( avg_dis ==0 )//可能返回错误数据，跳过
  256.                                 continue;               
  257.                         height_mm        =        shift - avg_dis;                                 
  258.                 }
  259.                
  260.                 if(ir_rec_flag == 1)//接收到红外信号
  261.                 {
  262.                                 ir_rec_flag = 0;
  263.                                 switch(ctrl_comm)
  264.                                 {
  265.                                         case COMM_UP:     
  266.                                                                 target_mm++;
  267.                                                                 break;         //增加转速
  268.                                         case COMM_DOWN:   
  269.                                                                 target_mm--;
  270.                                                                 break;//减少转速
  271.                                         case COMM_LEFT:  
  272.                                                                 //front_right_speed_duty++;
  273.                                                                 //if(front_right_speed_duty>50)
  274.                                                                 //        front_right_speed_duty=50;
  275.                                                                 flag = 2;
  276.                                                                 break;//停止
  277.                                         case COMM_RIGHT:
  278.                                                                 //front_right_speed_duty--;
  279.                                                                 //if(front_right_speed_duty<1)
  280.                                                                 //        front_right_speed_duty=0;
  281.                                                                 flag=3;
  282.                                                                 break;//停止
  283.                                         case COMM_STOP:
  284.                                                                 flag=1;  
  285.                                                                 break;
  286.                                         default :
  287.                                         break;
  288.                                 }
  289.                                 LEDToggle(LED_PIN);
  290.                                 LCD1602WriteDistance(height_mm);
  291.                                 LCD1602WriteCommand(target_mm);
  292.                 }

  294.                 if(flag!=0)
  295.                         break;               
  296.         }

  298.         if(flag==2 || flag==1 )//2 基本要求
  299.         {
  300.                 //基本要求，先注水到100mm
  301.                 GoToTarget();
  302.                 Keep3Min();
  303.        
  304.                 //水位到110mm，并保持3分钟
  305.                 target_mm = 110;
  306.                 //注水到设定高度
  307.                 GoToTarget();
  308.                 Keep3Min();
  309.        
  310.                 //上述操作结束后，停止注水
  311.                 front_right_speed_duty = 0;
  312.                 LCD1602WriteCommand(888);
  313.                 Delayms(1000);
  314.                 LCD1602WriteCommand(888);
  315.                 Delayms(1000);
  316.                 LCD1602WriteCommand(888);
  317.                 Delayms(1000);
  318.                 LCD1602WriteCommand(888);
  319.                 Delayms(1000);

  321.         }//基本部分结束
  322.         else if(flag==3 )//发挥部分
  323.         {
  324.                 //注水到设定高度
  325.                 GoToTarget();
  326.                 Keep3Min();
  327.        
  328.                 target_mm = 100;
  329.                 GoToTarget();
  330.                 Keep3Min();
  331.        
  332.                 target_mm = 200;
  333. ……………………

  335. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
WaterLevel.zip (22.87 KB, 下载次数: 60)


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

使用道具 举报

沙发
ID:933682 发表于 2021-6-7 08:48 | 只看该作者
有没有proteus的仿真图
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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