基于stm32的攝像頭ov7670顏色識別源碼

ID:371148 · 發表于 2018-7-13 20:32

//讀取某點的顏色
static void ReadColor( uint16_t usX, uint16_t usY, COLOR_RGB* color_rgb )
{
      unsigned short rgb;

      rgb = LCD_ReadPoint( usX, usY );                                     //獲取顏色數據

      //轉換成值域為[0,255]的三原色值
      color_rgb->Red                = (unsigned char)( ( rgb & 0xF800 ) >> 8 );
      color_rgb->Green  = (unsigned char)( ( rgb & 0x07E0 ) >> 3 );
      color_rgb->Blue       = (unsigned char)( ( rgb & 0x001F ) << 3 );
}
/*************************************/
//RGB轉換為HLS
//H:色度
//L：亮度
//S：飽和度
static void RGB2HSL( const COLOR_RGB* color_rgb, COLOR_HLS* color_hls )
{
      int r, g, b;
      int h, l, s;
      int max, min, dif;

      r = color_rgb->Red;
      g = color_rgb->Green;
      b = color_rgb->Blue;

      max = maxOf3Values( r, g, b );
      min = minOf3Values( r, g, b );
      dif = max - min;

      //計算l，亮度
      l = ( max + min ) * 240 / 255 / 2;

      //計算h，色度
      if( max == min )//無定義
      {
            s = 0;
            h = 0;
      }
      else
{
            //計算色度
            if( max == r )
            {
                     if( min == b )//h介于0到40
                     {
                              h = 40 * ( g - b ) / dif;
                     }
                     else if( min == g )//h介于200到240
                     {
                              h = 40 * ( g - b ) / dif + 240;
                     }

            }
            else if( max == g )
            {
                     h = 40 * ( b - r ) / dif + 80;
            }
            else if( max == b )
            {
                     h = 40 * ( r - g ) / dif + 160;
            }

            //計算飽和度
            if( l == 0 )
            {
                     s = 0;
            }
            else if( l <= 120 )
            {
                     s = dif * 240 / ( max + min );
            }
            else

{
                     s = dif * 240 / ( 480 - ( max + min ) );
            }
      }
color_hls->Hue = h;                                                       //色度
      color_hls->Lightness = l;                               //亮度
      color_hls->Saturation = s;                      //飽和度
}