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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › easy_trace算法源码 OV7670和stm32的颜色识别
返回列表 发新帖
查看: 3527|回复: 2
收起左侧

easy_trace算法源码 OV7670和stm32的颜色识别

[复制链接]
ID:330915 发表于 2018-5-16 00:11 | 显示全部楼层 |阅读模式
基于OV7670和stm32的颜色识别算法

单片机源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "lcd.h"
  5. #include "usart.h"         
  6. #include "string.h"
  7. #include "ov7670.h"
  8. #include "timer.h"
  9. #include "exti.h"
  10. #include "Trace.h"
  11. #include "can.h"

  13. u8 Way_Angle=1;                             //获取角度的算法，1：四元数  2：卡尔曼  3：互补滤波
  14. u8 Flag_Qian,Flag_Hou,Flag_Left,Flag_Right,Flag_Direction=0; //蓝牙遥控相关的变量
  15. u8 Flag_Stop=1,Flag_Show=0;                 //停止标志位和 显示标志位 默认停止 显示打开
  16. int Encoder_A,Encoder_B,Encoder_C;             //编码器的脉冲计数
  17. int Encoder_A_EXTI;
  18. int Motor_A,Motor_B,Motor_C;                   //电机PWM变量
  19. int Target_A,Target_B,Target_C;                   //电机目标速度
  20. int Temperature;                            //显示温度
  21. int Voltage;                                //电池电压采样相关的变量
  22. float Angle_Balance,Gyro_Balance,Gyro_Turn; //平衡倾角 平衡陀螺仪 转向陀螺仪
  23. float Show_Data_Mb;                         //全局显示变量，用于显示需要查看的数据
  24. u32 Distance;                               //超声波测距
  25. u8 delay_50,delay_flag;         //默认情况下，不开启避障功能，长按用户按键2s以上可以进入避障模式
  26. int Velocity=30;
  27. u8 Usart3_Receive;
  28. u8 rxbuf[8],Rxbuf[16];
  29. u8 txbuf[8];
  30. int AZ,GZ;
  31. float Pitch,Roll,Yaw;
  32. u32 count,usart_count;
  33. int temp,temp2,temp3,count_temp,flag;
  34. u8 ON_txbuf[8]={10,12,15,19,24,30,37,1} ;
  35. u8 Velocity_txbuf[8]={11,13,16,20,25,31,38,50} ;
  36. void car(u16 command);
  37. void carturn(u16 commandturn,u16 turnangle);

  39. char* bian(int a);

  41. u8 flag2=1;


  44. const u8*LMODE_TBL[5]={"Auto","Sunny","Cloudy","Office","Home"};                                                        //5种光照模式            
  45. const u8*EFFECTS_TBL[7]={"Normal","Negative","B&W","Redish","Greenish","Bluish","Antique"};        //7种特效
  46. extern u8 ov_sta;        //在exit.c里面定义
  47. extern u8 ov_frame;        //在timer.c里面定义       



  51. u16 r,y;

  53. u16 i;
  54. u16 j;
  55. unsigned short C16;
  56. //更新LCD显示
  57. void camera_refresh(void)
  58. {
  59.         RESULT Resu;
  60.         TARGET_CONDI Condition={0,240,0,240,200,210,30,30,320,240};        //API参数  hls的阈值，识别时用的       
  61.         u16 color;               

  63.         if(ov_sta==2)
  64.         {
  65.                 LCD_Scan_Dir(U2D_L2R);                //从上到下,从左到右
  66.                 LCD_SetCursor(0x00,0x0000);        //设置光标位置
  67.                 LCD_WriteRAM_Prepare();     //开始写入GRAM       
  68.                 OV7670_RRST=0;                                //开始复位读指针
  69.                 OV7670_RCK=0;
  70.                 OV7670_RCK=1;
  71.                 OV7670_RCK=0;
  72.                 OV7670_RRST=1;                                //复位读指针结束
  73.                 OV7670_RCK=1;         

  75.                 for(i=0;i<240;i++)
  76.                    {
  77.                     for(j=0;j<320;j++)
  78.                                                 {                       
  79.                                                         OV7670_RCK=0;
  80.                         color=GPIOC->IDR&0XFF;        //读数据
  81.                         OV7670_RCK=1;
  82.                         color<<=8;  
  83.                         OV7670_RCK=0;
  84.                         color|=GPIOC->IDR&0XFF;        //读数据
  85.                         OV7670_RCK=1;
  86.       LCD->LCD_RAM=color;

  88.                                                 }   
  89.                                 }       
  90.                        

  92.                
  93.                         if(Trace(&Condition,&Resu) )                      //API
  94.                         {
  95.                                
  96.                                
  97.                                 LCD_Fill(Resu.x-Resu.w/2,Resu.y-Resu.h/2,Resu.x+Resu.w/2,Resu.y-Resu.h/2+1,0xf800);//u16 x,u16 y,u16 width,u16 hight,u16 Color
  98.                                 LCD_Fill(Resu.x-Resu.w/2,Resu.y-Resu.h/2,Resu.x-Resu.w/2+1,Resu.y+Resu.h/2,0xf800);
  99.                                 LCD_Fill(Resu.x-Resu.w/2,Resu.y+Resu.h/2,Resu.x+Resu.w/2,Resu.y+Resu.h/2+1,0xf800);
  100.                                 LCD_Fill(Resu.x+Resu.w/2,Resu.y-Resu.h/2,Resu.x+Resu.w/2+1,Resu.y+Resu.h/2,0xf800);
  101.                                 LCD_Fill(Resu.x-2,Resu.y-2,Resu.x+2,Resu.y+2,0xf800);
  102.                                     
  103.                                 //LED1=!LED1;
  104.                                 r=Resu.x;y=Resu.y;
  105.                                
  106.                                 LCD_ShowString(60,130,200,16,16,bian(r));
  107.                                
  108.                                 if(r>130) //偏左//右转                       
  109.                                 {
  110.                                         txbuf[0]=10;
  111.                                 txbuf[1]=12;
  112.                                 txbuf[2]=15;       
  113.                                 txbuf[3]=19;               
  114.                           txbuf[4]=24;
  115.                                 txbuf[5]=30;       
  116.                           txbuf[6]=37;
  117.                                 txbuf[7]=1;        //00000111                                               
  118.                                
  119.                                 CAN1_SEND(0X121,txbuf);//CAN发送
  120.                                 carturn(2,3);
  121.                                 //flag2=1;
  122.                                 //car(1);                       
  123.                                 }
  124.                                 if(r<110)//偏右//左转
  125.                                                 {       
  126.                                                         txbuf[0]=10;
  127.                                 txbuf[1]=12;
  128.                                 txbuf[2]=15;       
  129.                                 txbuf[3]=19;               
  130.                           txbuf[4]=24;
  131.                                 txbuf[5]=30;       
  132.                           txbuf[6]=37;
  133.                                 txbuf[7]=1;        //00000111                                               
  134.                                
  135.                                 CAN1_SEND(0X121,txbuf);//CAN发送
  136.                                 carturn(1,3);
  137.                                 //flag2=2;
  138.                                 //car(1);
  139.                        
  140.                                         }
  141.                                         /*else if((r<=130)&&(r>=110))//前
  142.                                                 {
  143.                                 car(1);
  144.                                         }
  145.                                                 else
  146.                                                 LCD_ShowString(60,130,200,16,16,"Error");*/
  147.                         }
  148.                         /*else
  149.                         {
  150.                                
  151.                                 carturn(1,3);
  152.                         }*/
  153.                
  154.                                
  155.                        
  156.                 EXTI_ClearITPendingBit(EXTI_Line8);  //清除LINE8上的中断标志位
  157.                 ov_sta=0;                                        //开始下一次采集
  158.                 ov_frame++;
  159.                 LCD_Scan_Dir(DFT_SCAN_DIR);        //恢复默认扫描方向
  160.         }
  161. }               
  162. int main(void)
  163. {         
  164.         u8 key;
  165.         u8 lightmode=2,saturation=2,brightness=2,contrast=2;
  166.         u8 effect=0;         
  167.         u8 i=0;            
  168.         u8 msgbuf[15];//消息缓存区
  169.         u8 tm=0;

  171.         delay_init();                     //延时函数初始化          
  172.         NVIC_Configuration();          //设置NVIC中断分组2:2位抢占优先级，2位响应优先级
  173.         uart_init(9600);                 //串口初始化为9600
  174.         LED_Init();                             //LED端口初始化
  175.         LCD_Init();       
  176.         if(lcddev.id==0X6804||lcddev.id==0X5310)         //强制设置屏幕分辨率为320*240.以支持3.5寸大屏
  177.         {
  178.                 lcddev.width=240;
  179.                 lcddev.height=320;
  180.         }
  181.                             
  182.         POINT_COLOR=RED;//设置字体为红色  
  183.         LCD_ShowString(60,130,200,16,16,"S1:Light Mode");
  184.         LCD_ShowString(60,150,200,16,16,"KS2:Saturation");
  185.         LCD_ShowString(60,170,200,16,16,"S3:Brightness");
  186.         LCD_ShowString(60,190,200,16,16,"S4:Contrast");
  187.         LCD_ShowString(60,210,200,16,16,"TPAD(SD2):Effects");         
  188.   LCD_ShowString(60,230,200,16,16,"OV7670 Init...");       


  191.         while(OV7670_Init())//初始化OV7670
  192.         {
  193.                 LCD_ShowString(60,230,200,16,16,"OV7670 Error!!");
  194.                 delay_ms(200);
  195.           LCD_Fill(60,230,239,246,WHITE);
  196.                 delay_ms(200);
  197.         }
  198.         LCD_ShowString(60,230,200,16,16,"OV7670 Init OK");
  199.         delay_ms(1500);                   
  200.         OV7670_Light_Mode(lightmode);
  201.         OV7670_Color_Saturation(saturation);
  202.         OV7670_Brightness(brightness);
  203.         OV7670_Contrast(contrast);
  204.         OV7670_Special_Effects(effect);         
  205.        
  206.         TIM6_Int_Init(10000,7199);                        //10Khz计数频率,1秒钟中断                                                                          
  207.         EXTI8_Init();                                                //使能定时器捕获
  208.         OV7670_Window_Set(10,174,240,320);        //设置窗口          
  209.   OV7670_CS=0;                                                 
  210.         CAN1_Mode_Init(1,2,3,6,0);  //CAN初始化
  211.        
  212.         while(1)
  213.         {
  214.                
  215.                                           
  216.                                 /*txbuf[0]=10;
  217.                                 txbuf[1]=12;
  218.                                 txbuf[2]=15;       
  219.                                 txbuf[3]=19;               
  220.                           txbuf[4]=24;
  221.                                 txbuf[5]=30;       
  222.                           txbuf[6]=37;
  223.                                 txbuf[7]=1;        //00000111                                                                       
  224.                                 CAN1_SEND(0X121,txbuf);//CAN发送*/
  225.                                
  226.                                 camera_refresh();//更新显示
  227.                                
  228.                                  
  229.         }          
  230. }







  238. void car(u16 command)
  239. {
  240.    switch(command)
  241.          {
  242.                   case 1:                       //前进，速度为25
  243.                           txbuf[0]=1;
  244.                                 txbuf[1]=0;
  245.                                 txbuf[2]=0;       
  246.                                 txbuf[3]=0;               
  247.                           txbuf[4]=3;
  248.                                 txbuf[5]=0;       
  249.                           txbuf[6]=0;
  250.                                 txbuf[7]=0x00;        //00000111                                               
  251.                                 CAN1_SEND(0X121,txbuf);
  252.                           break;
  253.                         case 2:                   //后退，速度为25
  254.                           txbuf[0]=1;
  255.                                 txbuf[1]=0;
  256.                                 txbuf[2]=0;       
  257.                                 txbuf[3]=0;               
  258.                           txbuf[4]=25;
  259.                                 txbuf[5]=0;       
  260.                           txbuf[6]=0;
  261.                                 txbuf[7]=0x02;        //00000111                                               
  262.                                 CAN1_SEND(0X121,txbuf);
  263.                           break;
  264.                         case 3:                    //向右，速度为25
  265.                           txbuf[0]=1;
  266.                                 txbuf[1]=0;
  267.                                 txbuf[2]=25;       
  268.                                 txbuf[3]=0;               
  269.                           txbuf[4]=0;
  270.                                 txbuf[5]=0;       
  271.                           txbuf[6]=0;
  272.                                 txbuf[7]=0x00;        //00000111                                               
  273.                                 CAN1_SEND(0X121,txbuf);
  274.                           break;
  275.                         case 4:                  //向左，速度为25
  276.                           txbuf[0]=1;
  277.                                 txbuf[1]=0;
  278.                                 txbuf[2]=25;       
  279.                                 txbuf[3]=0;               
  280.                           txbuf[4]=0;
  281.                                 txbuf[5]=0;       
  282.                           txbuf[6]=0;
  283.                                 txbuf[7]=0x04;        //00000111                                               
  284.                                 CAN1_SEND(0X121,txbuf);
  285.         break;
  286.                         default:printf("error");                       
  287.          
  288.          }
  289. }
  290. void carturn(u16 commandturn,u16 turnangle)
  291. {
  292.      if(commandturn==1)//右转turnangle 角度
  293.                  {
  294.                     txbuf[0]=1;
  295.                                 txbuf[1]=0;
  296.                                 txbuf[2]=0;       
  297.                                 txbuf[3]=0;               
  298.                           txbuf[4]=0;
  299.                                 txbuf[5]=0;       
  300.                           txbuf[6]=turnangle;
  301.                                 txbuf[7]=0x00;        //00000111                                               
  302.                                 CAN1_SEND(0X121,txbuf);
  303.                  }
  304.                  else if(commandturn==2)//左转turnangle角度
  305.                  {
  306.                                  txbuf[0]=1;
  307.                                 txbuf[1]=0;
  308.                                 txbuf[2]=0;       
  309.                                 txbuf[3]=0;               
  310.                           txbuf[4]=0;
  311.                                 txbuf[5]=0;       
  312.                           txbuf[6]=turnangle;
  313.                                 txbuf[7]=0x03;        //00000111                                               
  314.                                 CAN1_SEND(0X121,txbuf);
  315.                          }
  316.                  else
  317.                          printf("error");

  319. }

  321. char* bian(int a){
  322.     int i=0,l;
  323.                 char*s;
  324.         char n[10];
  325.         while(a>0){n[i++]=a%10;a/=10;}
  326.         l=--i;
  327.         for(;i>=0;i--)s[l-i]=n[i]+'0';
  328.         s[l+1]=0;
  329.         return s;

  331. }

复制代码
所有资料51hei提供下载:
Track2.rar (439.27 KB, 下载次数: 31)
回复

使用道具 举报

ID:308469 发表于 2018-6-3 19:31 | 显示全部楼层
颜色识别这部分应该看什么资料学习
回复

使用道具 举报

ID:138247 发表于 2019-5-2 15:20 | 显示全部楼层

谢谢楼主分享。。。。
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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