Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 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 | * |
Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 20 | */ |
| 21 | |
Hans de Goede | 8a5b2e9 | 2008-09-03 17:12:17 -0300 | [diff] [blame] | 22 | /* We calculate the autogain at the end of the transfer of a frame, at this |
Hans de Goede | 5fb2dde | 2010-02-17 11:59:19 -0300 | [diff] [blame] | 23 | moment a frame with the old settings is being captured and transmitted. So |
Mauro Carvalho Chehab | 3e4d8f4 | 2019-02-18 14:29:03 -0500 | [diff] [blame] | 24 | if we adjust the gain or exposure we must ignore at least the next frame for |
Hans de Goede | 5fb2dde | 2010-02-17 11:59:19 -0300 | [diff] [blame] | 25 | the new settings to come into effect before doing any other adjustments. */ |
| 26 | #define PAC_AUTOGAIN_IGNORE_FRAMES 2 |
Hans de Goede | 8a5b2e9 | 2008-09-03 17:12:17 -0300 | [diff] [blame] | 27 | |
Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 28 | static const unsigned char pac_sof_marker[5] = |
| 29 | { 0xff, 0xff, 0x00, 0xff, 0x96 }; |
| 30 | |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 31 | /* |
| 32 | The following state machine finds the SOF marker sequence |
| 33 | 0xff, 0xff, 0x00, 0xff, 0x96 in a byte stream. |
| 34 | |
| 35 | +----------+ |
| 36 | | 0: START |<---------------\ |
| 37 | +----------+<-\ | |
| 38 | | \---/otherwise | |
| 39 | v 0xff | |
| 40 | +----------+ otherwise | |
| 41 | | 1 |--------------->* |
| 42 | | | ^ |
| 43 | +----------+ | |
| 44 | | | |
| 45 | v 0xff | |
| 46 | +----------+<-\0xff | |
| 47 | /->| |--/ | |
| 48 | | | 2 |--------------->* |
| 49 | | | | otherwise ^ |
| 50 | | +----------+ | |
| 51 | | | | |
| 52 | | v 0x00 | |
| 53 | | +----------+ | |
| 54 | | | 3 | | |
| 55 | | | |--------------->* |
| 56 | | +----------+ otherwise ^ |
| 57 | | | | |
| 58 | 0xff | v 0xff | |
| 59 | | +----------+ | |
| 60 | \--| 4 | | |
| 61 | | |----------------/ |
| 62 | +----------+ otherwise |
| 63 | | |
| 64 | v 0x96 |
| 65 | +----------+ |
| 66 | | FOUND | |
| 67 | +----------+ |
| 68 | */ |
| 69 | |
Theodore Kilgore | c93396e | 2013-02-04 13:17:55 -0300 | [diff] [blame] | 70 | static unsigned char *pac_find_sof(struct gspca_dev *gspca_dev, u8 *sof_read, |
Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 71 | unsigned char *m, int len) |
| 72 | { |
Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 73 | int i; |
| 74 | |
| 75 | /* Search for the SOF marker (fixed part) in the header */ |
| 76 | for (i = 0; i < len; i++) { |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 77 | switch (*sof_read) { |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 78 | case 0: |
| 79 | if (m[i] == 0xff) |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 80 | *sof_read = 1; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 81 | break; |
| 82 | case 1: |
| 83 | if (m[i] == 0xff) |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 84 | *sof_read = 2; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 85 | else |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 86 | *sof_read = 0; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 87 | break; |
| 88 | case 2: |
| 89 | switch (m[i]) { |
| 90 | case 0x00: |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 91 | *sof_read = 3; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 92 | break; |
| 93 | case 0xff: |
| 94 | /* stay in this state */ |
| 95 | break; |
| 96 | default: |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 97 | *sof_read = 0; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 98 | } |
| 99 | break; |
| 100 | case 3: |
| 101 | if (m[i] == 0xff) |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 102 | *sof_read = 4; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 103 | else |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 104 | *sof_read = 0; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 105 | break; |
| 106 | case 4: |
| 107 | switch (m[i]) { |
| 108 | case 0x96: |
| 109 | /* Pattern found */ |
Joe Perches | 37d5efb | 2017-09-22 15:20:33 -0400 | [diff] [blame] | 110 | gspca_dbg(gspca_dev, D_FRAM, |
| 111 | "SOF found, bytes to analyze: %u - Frame starts at byte #%u\n", |
| 112 | len, i + 1); |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 113 | *sof_read = 0; |
Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 114 | return m + i + 1; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 115 | break; |
| 116 | case 0xff: |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 117 | *sof_read = 2; |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 118 | break; |
| 119 | default: |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 120 | *sof_read = 0; |
Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 121 | } |
Marton Nemeth | e0d49e2 | 2009-10-05 05:41:30 -0300 | [diff] [blame] | 122 | break; |
| 123 | default: |
Marton Nemeth | a6b69e4 | 2009-11-02 08:05:51 -0300 | [diff] [blame] | 124 | *sof_read = 0; |
Hans de Goede | 327c4ab | 2008-09-03 17:12:14 -0300 | [diff] [blame] | 125 | } |
| 126 | } |
| 127 | |
| 128 | return NULL; |
| 129 | } |