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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › 2020年电赛省赛非接触物体测量STM32F4单片机+OPENMV源程 ...
返回列表 发新帖
查看: 2444|回复: 1
打印 上一主题 下一主题
收起左侧

2020年电赛省赛非接触物体测量STM32F4单片机+OPENMV源程序

[复制链接]
跳转到指定楼层
楼主
ID:524037 发表于 2022-5-14 21:05 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
  1. #include "sys.h"
  2. #include "delay.h"
  3. #include "usart.h"
  4. #include "led.h"
  5. #include "lcd.h"
  6. #include "pwm.h"
  7. #include "key.h"
  8. #include "openmv.h"
  9. #include "data_deal.h"
  10. #include "control.h"
  11. #include "ui.h"
  12. extern int32_t  out_pwm,last_out_pwm;
  13. #define Focal 180//焦距 测量所得
  14. #define X_Error_MAX 0 //X 轴偏差允许范围
  15. openmv_s Dealover_OV;
  16. TFmini   Dealover_TF;
  17. int32_t X_error,cen_x;
  18. u16 OV_Deal_count=0,TF_Deal_count=0;
  19. int Shape_buf[100],i;
  20. u32 distance_buf[100];
  21. float Cx_buf[100],Cy_buf[100],Length_buf[100];
  22. float  dealover_distance,Actual_length;
  23. int        still_pwm=0;
  24. u8 First_start_test_flag,TF_over_flag=0,OV_over_flag=0,Third_start_test_flag=0;
  25. void GET_Size();
  26. int main(void)
  27. {      
  28.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//设置系统中断优先级分组2
  29.         delay_init(168);      //初始化延时函数
  30.         LED_Init();
  31.         KEY_Init();
  32.         uart1_init(115200);                //初始化串口波特率为115200
  33.         openmv_init();
  34.         TIM10_PWM_Init(40000,50);  //设置为 20000  20ms/20000=0.001ms  脉宽范围为（20000-500）19500-（20000-2500） 17500
  35.          LCD_Init();           //初始化LCD FSMC接口
  36.         POINT_COLOR=BLACK;      //画笔颜色：红色
  37.         LED1=0;     //PF10 连接openMV p7 LED1亮为1,2        
  38.         Servo=1;     // PF9 连接openMV p LED1灭为4        
  39.         delay_ms(1000);//等待数据稳定
  40.         
  41.           while(1)
  42.         {  
  43.                
  44. /**********题1.2**********/               
  45.                  if(KEY_Scan(1)==1)
  46.                 {
  47.                         
  48.                         First_start_test_flag=1;
  49.                         LED1=1;
  50.                 }
  51. /**********题3**********/
  52.                 if(KEY_Scan(1)==3)
  53.                 {
  54.                         Third_start_test_flag=1;
  55.                 }
  56. /***************开始读取值并处理***************/
  57.                 if(First_start_test_flag)   
  58.                 {

  60.                         LCD_ShowString(60,10,140,140,16,"Testing");
  61.                         GET_Size();
  62.                         //delay_ms(1000);//测完值就等待1s
  63.                         /***********所有数据处理完毕 显示界面*******************/
  64.                         if(TF_over_flag&&OV_over_flag)
  65.                         {   
  66.                                 LCD_ShowString(20,10,140,140,16,"Test Over");
  67.                                 if(First_start_test_flag)
  68.                                         UI_1(Dealover_OV,Actual_length,dealover_distance);
  69.                                 TF_over_flag=0;
  70.                                 OV_over_flag=0;
  71.                                 First_start_test_flag=0;                        
  72.                         }
  73.                 }
  74.                 if(Third_start_test_flag==1)
  75.                 {   
  76.                         LCD_ShowString(60,10,140,140,16,"Start Find");
  77.                         if(openmvs.flag==1)
  78.                         {        

  80.                                  if(openmvs.shape==2)
  81.                                 cen_x=openmvs.cx+openmvs.length/2;
  82.                                 else
  83.                                         cen_x=openmvs.cx;
  84.                                 if((int)cen_x<80)
  85.                                          X_error= 80-(int)cen_x;
  86.                                 else
  87.                                         X_error= (int)cen_x-80;
  88.                                 LCD_ShowNum(80,160,(int)openmvs.cx,5,16);
  89.                                 /*************获取中点**************/

  91.                                 /************得出偏差************/
  92.                                 //LCD_ShowNum(80,160,openmvs.shape,5,16);
  93.                                 LCD_ShowNum(80,200,X_error,5,16);
  94.                         if(X_error<=X_Error_MAX)
  95.                         {
  96.                                 GET_Size();
  97.                                 LCD_ShowNum(80,200,X_error,5,16);
  98.                                 LCD_ShowString(20,10,140,140,16,"Find over");
  99.                                 UI_1(openmvs,Actual_length,dealover_distance);
  100.                                 Servo=0; //舵机断电
  101.                                 TF_over_flag=0;
  102.                                 OV_over_flag=0;
  103.                                 Third_start_test_flag=0;
  104.                                 still_pwm=last_out_pwm;
  105.                         }
  106.                         if(Third_start_test_flag==1)
  107.                         {
  108.                                 if(openmvs.shape!=0)
  109.                                 {   
  110.                                                 PlacePID_CS(cen_x);
  111.                                                 delay_ms(30);
  112.                                         if(X_error<=15)
  113.                                                 delay_ms(50);
  114.                                 }
  115.                                 else
  116.                                 {
  117.                                         saomiao();
  118.                                         delay_ms(30);
  119.                                 
  120.                                 }
  121.                         }
  122.                         }
  123.                 }
  124.         }
  125. }
  126. void GET_Size(void )
  127. {
  128.                 if(tfmini.receiveComplete==1&&TF_Deal_count<100)
  129.                         {
  130.                                 distance_buf[TF_Deal_count]=tfmini.distance;
  131.                                   TF_Deal_count++;
  132.                         
  133.                         }
  134.                         if(TF_Deal_count>=100)
  135.                         {
  136.                            dealover_distance=tfmini_deal(distance_buf);
  137.                                 //LCD_ShowNum(150,50,dealover_distance,5,16);
  138.                                 TF_Deal_count=0;
  139.                                 TF_over_flag=1;
  140.                                 //LCD_ShowString(10,70,140,140,16,"2");
  141.                         }
  142.                         
  143.                         if((openmvs.flag==1)&&(OV_Deal_count<100)  )
  144.                         {   
  145.                                 //LCD_ShowString(10,70,140,140,16,"2");
  146.                                 Shape_buf[OV_Deal_count]=openmvs.shape ;
  147.                                 Cx_buf[OV_Deal_count]= openmvs.cx;
  148.                                 Cy_buf[OV_Deal_count]= openmvs.cx ;
  149.                                 Length_buf[OV_Deal_count]= openmvs.length ;
  150.                                 openmvs.flag=0;
  151.                                 OV_Deal_count++;
  152.                         }
  153.                 //        LCD_ShowNum(80,300,(u16)Shape_buf[OV_Deal_count-1],1,16);
  154.                         if(OV_Deal_count>=100)
  155.                         {
  156.                                 // for(i=0;i<100;i++) //数据处理
  157.                                 // LCD_ShowNum(80,200,Shape_buf[i],5,16);
  158.                          Dealover_OV=openmv_data_deal(Shape_buf,Cx_buf,Cy_buf,Length_buf) ;
  159.                          OV_Deal_count=0;
  160.                          OV_over_flag=1;
  161.                         //LCD_ShowNum(80,200,(u16)Dealover_OV.shape,5,16);
  162.                         }                                                                  
  163.                         Actual_length=Get_Actuallength(Dealover_OV,dealover_distance,Focal);
  164. }
复制代码

Keil代码下载: 代码.7z (364.22 KB, 下载次数: 34)

评分

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

查看全部评分

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

使用道具 举报

沙发
ID:1084874 发表于 2023-6-19 10:37 | 只看该作者
大佬可以发个openmv端的程序吗
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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