Commit | Line | Data |
---|---|---|
327c4abf HG |
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 | ||
8a5b2e90 | 26 | /* We calculate the autogain at the end of the transfer of a frame, at this |
5fb2dde2 HG |
27 | moment a frame with the old settings is being captured and transmitted. So |
28 | if we adjust the gain or exposure we must ignore atleast the next frame for | |
29 | the new settings to come into effect before doing any other adjustments. */ | |
30 | #define PAC_AUTOGAIN_IGNORE_FRAMES 2 | |
8a5b2e90 | 31 | |
327c4abf HG |
32 | static const unsigned char pac_sof_marker[5] = |
33 | { 0xff, 0xff, 0x00, 0xff, 0x96 }; | |
34 | ||
e0d49e2d MN |
35 | /* |
36 | The following state machine finds the SOF marker sequence | |
37 | 0xff, 0xff, 0x00, 0xff, 0x96 in a byte stream. | |
38 | ||
39 | +----------+ | |
40 | | 0: START |<---------------\ | |
41 | +----------+<-\ | | |
42 | | \---/otherwise | | |
43 | v 0xff | | |
44 | +----------+ otherwise | | |
45 | | 1 |--------------->* | |
46 | | | ^ | |
47 | +----------+ | | |
48 | | | | |
49 | v 0xff | | |
50 | +----------+<-\0xff | | |
51 | /->| |--/ | | |
52 | | | 2 |--------------->* | |
53 | | | | otherwise ^ | |
54 | | +----------+ | | |
55 | | | | | |
56 | | v 0x00 | | |
57 | | +----------+ | | |
58 | | | 3 | | | |
59 | | | |--------------->* | |
60 | | +----------+ otherwise ^ | |
61 | | | | | |
62 | 0xff | v 0xff | | |
63 | | +----------+ | | |
64 | \--| 4 | | | |
65 | | |----------------/ | |
66 | +----------+ otherwise | |
67 | | | |
68 | v 0x96 | |
69 | +----------+ | |
70 | | FOUND | | |
71 | +----------+ | |
72 | */ | |
73 | ||
a6b69e40 | 74 | static unsigned char *pac_find_sof(u8 *sof_read, |
327c4abf HG |
75 | unsigned char *m, int len) |
76 | { | |
327c4abf HG |
77 | int i; |
78 | ||
79 | /* Search for the SOF marker (fixed part) in the header */ | |
80 | for (i = 0; i < len; i++) { | |
a6b69e40 | 81 | switch (*sof_read) { |
e0d49e2d MN |
82 | case 0: |
83 | if (m[i] == 0xff) | |
a6b69e40 | 84 | *sof_read = 1; |
e0d49e2d MN |
85 | break; |
86 | case 1: | |
87 | if (m[i] == 0xff) | |
a6b69e40 | 88 | *sof_read = 2; |
e0d49e2d | 89 | else |
a6b69e40 | 90 | *sof_read = 0; |
e0d49e2d MN |
91 | break; |
92 | case 2: | |
93 | switch (m[i]) { | |
94 | case 0x00: | |
a6b69e40 | 95 | *sof_read = 3; |
e0d49e2d MN |
96 | break; |
97 | case 0xff: | |
98 | /* stay in this state */ | |
99 | break; | |
100 | default: | |
a6b69e40 | 101 | *sof_read = 0; |
e0d49e2d MN |
102 | } |
103 | break; | |
104 | case 3: | |
105 | if (m[i] == 0xff) | |
a6b69e40 | 106 | *sof_read = 4; |
e0d49e2d | 107 | else |
a6b69e40 | 108 | *sof_read = 0; |
e0d49e2d MN |
109 | break; |
110 | case 4: | |
111 | switch (m[i]) { | |
112 | case 0x96: | |
113 | /* Pattern found */ | |
8a5b2e90 | 114 | PDEBUG(D_FRAM, |
327c4abf HG |
115 | "SOF found, bytes to analyze: %u." |
116 | " Frame starts at byte #%u", | |
117 | len, i + 1); | |
a6b69e40 | 118 | *sof_read = 0; |
327c4abf | 119 | return m + i + 1; |
e0d49e2d MN |
120 | break; |
121 | case 0xff: | |
a6b69e40 | 122 | *sof_read = 2; |
e0d49e2d MN |
123 | break; |
124 | default: | |
a6b69e40 | 125 | *sof_read = 0; |
327c4abf | 126 | } |
e0d49e2d MN |
127 | break; |
128 | default: | |
a6b69e40 | 129 | *sof_read = 0; |
327c4abf HG |
130 | } |
131 | } | |
132 | ||
133 | return NULL; | |
134 | } |