drivers/media/video/gspca/pac_common.h

   1 /*
   2  * Pixart PAC207BCA / PAC73xx common functions
   3  *
   4  * Copyright (C) 2008 Hans de Goede <j.w.r.degoede@hhs.nl>
   5  * Copyright (C) 2005 Thomas Kaiser thomas@kaiser-linux.li
   6  * Copyleft (C) 2005 Michel Xhaard mxhaard@magic.fr
   7  *
   8  * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  23  *
  24  */
  25
  26 static const unsigned char pac_sof_marker[5] =
  27                 { 0xff, 0xff, 0x00, 0xff, 0x96 };
  28
  29 static unsigned char *pac_find_sof(struct gspca_dev *gspca_dev,
  30                                         unsigned char *m, int len)
  31 {
  32         struct sd *sd = (struct sd *) gspca_dev;
  33         int i;
  34
  35         /* Search for the SOF marker (fixed part) in the header */
  36         for (i = 0; i < len; i++) {
  37                 if (m[i] == pac_sof_marker[sd->sof_read]) {
  38                         sd->sof_read++;
  39                         if (sd->sof_read == sizeof(pac_sof_marker)) {
  40                                 PDEBUG(D_STREAM,
  41                                         "SOF found, bytes to analyze: %u."
  42                                         " Frame starts at byte #%u",
  43                                         len, i + 1);
  44                                 sd->sof_read = 0;
  45                                 return m + i + 1;
  46                         }
  47                 } else {
  48                         sd->sof_read = 0;
  49                 }
  50         }
  51
  52         return NULL;
  53 }