/drivers/media/video/gspca/spca505.c

https://bitbucket.org/ndreys/linux-sunxi · C · 827 lines · 640 code · 87 blank · 100 comment · 18 complexity · f3d125eac9ecd66b68c58f60ffb395f8 MD5 · raw file 

    

  1. /*
    2. 

  2.  * SPCA505 chip based cameras initialization data
    3. 

  3.  *
    4. 

  4.  * V4L2 by Jean-Francis Moine <http://moinejf.free.fr>
    5. 

  5.  *
    6. 

  6.  * This program is free software; you can redistribute it and/or modify
    7. 

  7.  * it under the terms of the GNU General Public License as published by
    8. 

  8.  * the Free Software Foundation; either version 2 of the License, or
    9. 

  9.  * any later version.
    10. 

  10.  *
    11. 

  11.  * This program is distributed in the hope that it will be useful,
    12. 

  12.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
    13. 

  13.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
    14. 

  14.  * GNU General Public License for more details.
    15. 

  15.  *
    16. 

  16.  * You should have received a copy of the GNU General Public License
    17. 

  17.  * along with this program; if not, write to the Free Software
    18. 

  18.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
    19. 

  19.  *
    20. 

  20.  */
    21. 

  21. 

  22. #define MODULE_NAME "spca505"
    23. 

  23. 

  24. #include "gspca.h"
    25. 

  25. 

  26. MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
    27. 

  27. MODULE_DESCRIPTION("GSPCA/SPCA505 USB Camera Driver");
    28. 

  28. MODULE_LICENSE("GPL");
    29. 

  29. 

  30. /* specific webcam descriptor */
    31. 

  31. struct sd {
    32. 

  32. 	struct gspca_dev gspca_dev;		/* !! must be the first item */
    33. 

  33. 

  34. 	u8 brightness;
    35. 

  35. 

  36. 	u8 subtype;
    37. 

  37. #define IntelPCCameraPro 0
    38. 

  38. #define Nxultra 1
    39. 

  39. };
    40. 

  40. 

  41. /* V4L2 controls supported by the driver */
    42. 

  42. static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
    43. 

  43. static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
    44. 

  44. 

  45. static const struct ctrl sd_ctrls[] = {
    46. 

  46. 	{
    47. 

  47. 	    {
    48. 

  48. 		.id      = V4L2_CID_BRIGHTNESS,
    49. 

  49. 		.type    = V4L2_CTRL_TYPE_INTEGER,
    50. 

  50. 		.name    = "Brightness",
    51. 

  51. 		.minimum = 0,
    52. 

  52. 		.maximum = 255,
    53. 

  53. 		.step    = 1,
    54. 

  54. #define BRIGHTNESS_DEF 127
    55. 

  55. 		.default_value = BRIGHTNESS_DEF,
    56. 

  56. 	    },
    57. 

  57. 	    .set = sd_setbrightness,
    58. 

  58. 	    .get = sd_getbrightness,
    59. 

  59. 	},
    60. 

  60. };
    61. 

  61. 

  62. static const struct v4l2_pix_format vga_mode[] = {
    63. 

  63. 	{160, 120, V4L2_PIX_FMT_SPCA505, V4L2_FIELD_NONE,
    64. 

  64. 		.bytesperline = 160,
    65. 

  65. 		.sizeimage = 160 * 120 * 3 / 2,
    66. 

  66. 		.colorspace = V4L2_COLORSPACE_SRGB,
    67. 

  67. 		.priv = 4},
    68. 

  68. 	{176, 144, V4L2_PIX_FMT_SPCA505, V4L2_FIELD_NONE,
    69. 

  69. 		.bytesperline = 176,
    70. 

  70. 		.sizeimage = 176 * 144 * 3 / 2,
    71. 

  71. 		.colorspace = V4L2_COLORSPACE_SRGB,
    72. 

  72. 		.priv = 3},
    73. 

  73. 	{320, 240, V4L2_PIX_FMT_SPCA505, V4L2_FIELD_NONE,
    74. 

  74. 		.bytesperline = 320,
    75. 

  75. 		.sizeimage = 320 * 240 * 3 / 2,
    76. 

  76. 		.colorspace = V4L2_COLORSPACE_SRGB,
    77. 

  77. 		.priv = 2},
    78. 

  78. 	{352, 288, V4L2_PIX_FMT_SPCA505, V4L2_FIELD_NONE,
    79. 

  79. 		.bytesperline = 352,
    80. 

  80. 		.sizeimage = 352 * 288 * 3 / 2,
    81. 

  81. 		.colorspace = V4L2_COLORSPACE_SRGB,
    82. 

  82. 		.priv = 1},
    83. 

  83. 	{640, 480, V4L2_PIX_FMT_SPCA505, V4L2_FIELD_NONE,
    84. 

  84. 		.bytesperline = 640,
    85. 

  85. 		.sizeimage = 640 * 480 * 3 / 2,
    86. 

  86. 		.colorspace = V4L2_COLORSPACE_SRGB,
    87. 

  87. 		.priv = 0},
    88. 

  88. };
    89. 

  89. 

  90. #define SPCA50X_OFFSET_DATA 10
    91. 

  91. 

  92. #define SPCA50X_REG_USB 0x02	/* spca505 501 */
    93. 

  93. 

  94. #define SPCA50X_USB_CTRL 0x00	/* spca505 */
    95. 

  95. #define SPCA50X_CUSB_ENABLE 0x01 /* spca505 */
    96. 

  96. 

  97. #define SPCA50X_REG_GLOBAL 0x03	/* spca505 */
    98. 

  98. #define SPCA50X_GMISC0_IDSEL 0x01 /* Global control device ID select spca505 */
    99. 

  99. #define SPCA50X_GLOBAL_MISC0 0x00 /* Global control miscellaneous 0 spca505 */
    100. 

  100. 

  101. #define SPCA50X_GLOBAL_MISC1 0x01 /* 505 */
    102. 

  102. #define SPCA50X_GLOBAL_MISC3 0x03 /* 505 */
    103. 

  103. #define SPCA50X_GMISC3_SAA7113RST 0x20	/* Not sure about this one spca505 */
    104. 

  104. 

  105. /* Image format and compression control */
    106. 

  106. #define SPCA50X_REG_COMPRESS 0x04
    107. 

  107. 

  108. /*
    109. 

  109.  * Data to initialize a SPCA505. Common to the CCD and external modes
    110. 

  110.  */
    111. 

  111. static const u8 spca505_init_data[][3] = {
    112. 

  112. 	/* bmRequest,value,index */
    113. 

  113. 	{SPCA50X_REG_GLOBAL, SPCA50X_GMISC3_SAA7113RST, SPCA50X_GLOBAL_MISC3},
    114. 

  114. 	/* Sensor reset */
    115. 

  115. 	{SPCA50X_REG_GLOBAL, 0x00, SPCA50X_GLOBAL_MISC3},
    116. 

  116. 	{SPCA50X_REG_GLOBAL, 0x00, SPCA50X_GLOBAL_MISC1},
    117. 

  117. 	/* Block USB reset */
    118. 

  118. 	{SPCA50X_REG_GLOBAL, SPCA50X_GMISC0_IDSEL, SPCA50X_GLOBAL_MISC0},
    119. 

  119. 

  120. 	{0x05, 0x01, 0x10},
    121. 

  121. 					/* Maybe power down some stuff */
    122. 

  122. 	{0x05, 0x0f, 0x11},
    123. 

  123. 

  124. 	/* Setup internal CCD  ? */
    125. 

  125. 	{0x06, 0x10, 0x08},
    126. 

  126. 	{0x06, 0x00, 0x09},
    127. 

  127. 	{0x06, 0x00, 0x0a},
    128. 

  128. 	{0x06, 0x00, 0x0b},
    129. 

  129. 	{0x06, 0x10, 0x0c},
    130. 

  130. 	{0x06, 0x00, 0x0d},
    131. 

  131. 	{0x06, 0x00, 0x0e},
    132. 

  132. 	{0x06, 0x00, 0x0f},
    133. 

  133. 	{0x06, 0x10, 0x10},
    134. 

  134. 	{0x06, 0x02, 0x11},
    135. 

  135. 	{0x06, 0x00, 0x12},
    136. 

  136. 	{0x06, 0x04, 0x13},
    137. 

  137. 	{0x06, 0x02, 0x14},
    138. 

  138. 	{0x06, 0x8a, 0x51},
    139. 

  139. 	{0x06, 0x40, 0x52},
    140. 

  140. 	{0x06, 0xb6, 0x53},
    141. 

  141. 	{0x06, 0x3d, 0x54},
    142. 

  142. 	{}
    143. 

  143. };
    144. 

  144. 

  145. /*
    146. 

  146.  * Data to initialize the camera using the internal CCD
    147. 

  147.  */
    148. 

  148. static const u8 spca505_open_data_ccd[][3] = {
    149. 

  149. 	/* bmRequest,value,index */
    150. 

  150. 	/* Internal CCD data set */
    151. 

  151. 	{0x03, 0x04, 0x01},
    152. 

  152. 	/* This could be a reset */
    153. 

  153. 	{0x03, 0x00, 0x01},
    154. 

  154. 

  155. 	/* Setup compression and image registers. 0x6 and 0x7 seem to be
    156. 

  156. 	   related to H&V hold, and are resolution mode specific */
    157. 

  157. 		{0x04, 0x10, 0x01},
    158. 

  158. 		/* DIFF(0x50), was (0x10) */
    159. 

  159. 	{0x04, 0x00, 0x04},
    160. 

  160. 	{0x04, 0x00, 0x05},
    161. 

  161. 	{0x04, 0x20, 0x06},
    162. 

  162. 	{0x04, 0x20, 0x07},
    163. 

  163. 

  164. 	{0x08, 0x0a, 0x00},
    165. 

  165. 	/* DIFF (0x4a), was (0xa) */
    166. 

  166. 

  167. 	{0x05, 0x00, 0x10},
    168. 

  168. 	{0x05, 0x00, 0x11},
    169. 

  169. 	{0x05, 0x00, 0x00},
    170. 

  170. 	/* DIFF not written */
    171. 

  171. 	{0x05, 0x00, 0x01},
    172. 

  172. 	/* DIFF not written */
    173. 

  173. 	{0x05, 0x00, 0x02},
    174. 

  174. 	/* DIFF not written */
    175. 

  175. 	{0x05, 0x00, 0x03},
    176. 

  176. 	/* DIFF not written */
    177. 

  177. 	{0x05, 0x00, 0x04},
    178. 

  178. 	/* DIFF not written */
    179. 

  179. 		{0x05, 0x80, 0x05},
    180. 

  180. 		/* DIFF not written */
    181. 

  181. 		{0x05, 0xe0, 0x06},
    182. 

  182. 		/* DIFF not written */
    183. 

  183. 		{0x05, 0x20, 0x07},
    184. 

  184. 		/* DIFF not written */
    185. 

  185. 		{0x05, 0xa0, 0x08},
    186. 

  186. 		/* DIFF not written */
    187. 

  187. 		{0x05, 0x0, 0x12},
    188. 

  188. 		/* DIFF not written */
    189. 

  189. 	{0x05, 0x02, 0x0f},
    190. 

  190. 	/* DIFF not written */
    191. 

  191. 		{0x05, 0x10, 0x46},
    192. 

  192. 		/* DIFF not written */
    193. 

  193. 		{0x05, 0x8, 0x4a},
    194. 

  194. 		/* DIFF not written */
    195. 

  195. 

  196. 	{0x03, 0x08, 0x03},
    197. 

  197. 	/* DIFF (0x3,0x28,0x3) */
    198. 

  198. 	{0x03, 0x08, 0x01},
    199. 

  199. 	{0x03, 0x0c, 0x03},
    200. 

  200. 	/* DIFF not written */
    201. 

  201. 		{0x03, 0x21, 0x00},
    202. 

  202. 		/* DIFF (0x39) */
    203. 

  203. 

  204. /* Extra block copied from init to hopefully ensure CCD is in a sane state */
    205. 

  205. 	{0x06, 0x10, 0x08},
    206. 

  206. 	{0x06, 0x00, 0x09},
    207. 

  207. 	{0x06, 0x00, 0x0a},
    208. 

  208. 	{0x06, 0x00, 0x0b},
    209. 

  209. 	{0x06, 0x10, 0x0c},
    210. 

  210. 	{0x06, 0x00, 0x0d},
    211. 

  211. 	{0x06, 0x00, 0x0e},
    212. 

  212. 	{0x06, 0x00, 0x0f},
    213. 

  213. 	{0x06, 0x10, 0x10},
    214. 

  214. 	{0x06, 0x02, 0x11},
    215. 

  215. 	{0x06, 0x00, 0x12},
    216. 

  216. 	{0x06, 0x04, 0x13},
    217. 

  217. 	{0x06, 0x02, 0x14},
    218. 

  218. 	{0x06, 0x8a, 0x51},
    219. 

  219. 	{0x06, 0x40, 0x52},
    220. 

  220. 	{0x06, 0xb6, 0x53},
    221. 

  221. 	{0x06, 0x3d, 0x54},
    222. 

  222. 	/* End of extra block */
    223. 

  223. 

  224. 		{0x06, 0x3f, 0x1},
    225. 

  225. 		/* Block skipped */
    226. 

  226. 	{0x06, 0x10, 0x02},
    227. 

  227. 	{0x06, 0x64, 0x07},
    228. 

  228. 	{0x06, 0x10, 0x08},
    229. 

  229. 	{0x06, 0x00, 0x09},
    230. 

  230. 	{0x06, 0x00, 0x0a},
    231. 

  231. 	{0x06, 0x00, 0x0b},
    232. 

  232. 	{0x06, 0x10, 0x0c},
    233. 

  233. 	{0x06, 0x00, 0x0d},
    234. 

  234. 	{0x06, 0x00, 0x0e},
    235. 

  235. 	{0x06, 0x00, 0x0f},
    236. 

  236. 	{0x06, 0x10, 0x10},
    237. 

  237. 	{0x06, 0x02, 0x11},
    238. 

  238. 	{0x06, 0x00, 0x12},
    239. 

  239. 	{0x06, 0x04, 0x13},
    240. 

  240. 	{0x06, 0x02, 0x14},
    241. 

  241. 	{0x06, 0x8a, 0x51},
    242. 

  242. 	{0x06, 0x40, 0x52},
    243. 

  243. 	{0x06, 0xb6, 0x53},
    244. 

  244. 	{0x06, 0x3d, 0x54},
    245. 

  245. 	{0x06, 0x60, 0x57},
    246. 

  246. 	{0x06, 0x20, 0x58},
    247. 

  247. 	{0x06, 0x15, 0x59},
    248. 

  248. 	{0x06, 0x05, 0x5a},
    249. 

  249. 

  250. 	{0x05, 0x01, 0xc0},
    251. 

  251. 	{0x05, 0x10, 0xcb},
    252. 

  252. 		{0x05, 0x80, 0xc1},
    253. 

  253. 		/* */
    254. 

  254. 		{0x05, 0x0, 0xc2},
    255. 

  255. 		/* 4 was 0 */
    256. 

  256. 	{0x05, 0x00, 0xca},
    257. 

  257. 		{0x05, 0x80, 0xc1},
    258. 

  258. 		/*  */
    259. 

  259. 	{0x05, 0x04, 0xc2},
    260. 

  260. 	{0x05, 0x00, 0xca},
    261. 

  261. 		{0x05, 0x0, 0xc1},
    262. 

  262. 		/*  */
    263. 

  263. 	{0x05, 0x00, 0xc2},
    264. 

  264. 	{0x05, 0x00, 0xca},
    265. 

  265. 		{0x05, 0x40, 0xc1},
    266. 

  266. 		/* */
    267. 

  267. 	{0x05, 0x17, 0xc2},
    268. 

  268. 	{0x05, 0x00, 0xca},
    269. 

  269. 		{0x05, 0x80, 0xc1},
    270. 

  270. 		/* */
    271. 

  271. 	{0x05, 0x06, 0xc2},
    272. 

  272. 	{0x05, 0x00, 0xca},
    273. 

  273. 		{0x05, 0x80, 0xc1},
    274. 

  274. 		/* */
    275. 

  275. 	{0x05, 0x04, 0xc2},
    276. 

  276. 	{0x05, 0x00, 0xca},
    277. 

  277. 

  278. 	{0x03, 0x4c, 0x3},
    279. 

  279. 	{0x03, 0x18, 0x1},
    280. 

  280. 

  281. 	{0x06, 0x70, 0x51},
    282. 

  282. 	{0x06, 0xbe, 0x53},
    283. 

  283. 	{0x06, 0x71, 0x57},
    284. 

  284. 	{0x06, 0x20, 0x58},
    285. 

  285. 	{0x06, 0x05, 0x59},
    286. 

  286. 	{0x06, 0x15, 0x5a},
    287. 

  287. 

  288. 	{0x04, 0x00, 0x08},
    289. 

  289. 	/* Compress = OFF (0x1 to turn on) */
    290. 

  290. 	{0x04, 0x12, 0x09},
    291. 

  291. 	{0x04, 0x21, 0x0a},
    292. 

  292. 	{0x04, 0x10, 0x0b},
    293. 

  293. 	{0x04, 0x21, 0x0c},
    294. 

  294. 	{0x04, 0x05, 0x00},
    295. 

  295. 	/* was 5 (Image Type ? ) */
    296. 

  296. 	{0x04, 0x00, 0x01},
    297. 

  297. 

  298. 	{0x06, 0x3f, 0x01},
    299. 

  299. 

  300. 	{0x04, 0x00, 0x04},
    301. 

  301. 	{0x04, 0x00, 0x05},
    302. 

  302. 	{0x04, 0x40, 0x06},
    303. 

  303. 	{0x04, 0x40, 0x07},
    304. 

  304. 

  305. 	{0x06, 0x1c, 0x17},
    306. 

  306. 	{0x06, 0xe2, 0x19},
    307. 

  307. 	{0x06, 0x1c, 0x1b},
    308. 

  308. 	{0x06, 0xe2, 0x1d},
    309. 

  309. 	{0x06, 0xaa, 0x1f},
    310. 

  310. 	{0x06, 0x70, 0x20},
    311. 

  311. 

  312. 	{0x05, 0x01, 0x10},
    313. 

  313. 	{0x05, 0x00, 0x11},
    314. 

  314. 	{0x05, 0x01, 0x00},
    315. 

  315. 	{0x05, 0x05, 0x01},
    316. 

  316. 		{0x05, 0x00, 0xc1},
    317. 

  317. 		/* */
    318. 

  318. 	{0x05, 0x00, 0xc2},
    319. 

  319. 	{0x05, 0x00, 0xca},
    320. 

  320. 

  321. 	{0x06, 0x70, 0x51},
    322. 

  322. 	{0x06, 0xbe, 0x53},
    323. 

  323. 	{}
    324. 

  324. };
    325. 

  325. 

  326. /*
    327. 

  327.  * Made by Tomasz Zablocki (skalamandra@poczta.onet.pl)
    328. 

  328.  * SPCA505b chip based cameras initialization data
    329. 

  329.  */
    330. 

  330. /* jfm */
    331. 

  331. #define initial_brightness 0x7f	/* 0x0(white)-0xff(black) */
    332. 

  332. /* #define initial_brightness 0x0	//0x0(white)-0xff(black) */
    333. 

  333. /*
    334. 

  334.  * Data to initialize a SPCA505. Common to the CCD and external modes
    335. 

  335.  */
    336. 

  336. static const u8 spca505b_init_data[][3] = {
    337. 

  337. /* start */
    338. 

  338. 	{0x02, 0x00, 0x00},		/* init */
    339. 

  339. 	{0x02, 0x00, 0x01},
    340. 

  340. 	{0x02, 0x00, 0x02},
    341. 

  341. 	{0x02, 0x00, 0x03},
    342. 

  342. 	{0x02, 0x00, 0x04},
    343. 

  343. 	{0x02, 0x00, 0x05},
    344. 

  344. 	{0x02, 0x00, 0x06},
    345. 

  345. 	{0x02, 0x00, 0x07},
    346. 

  346. 	{0x02, 0x00, 0x08},
    347. 

  347. 	{0x02, 0x00, 0x09},
    348. 

  348. 	{0x03, 0x00, 0x00},
    349. 

  349. 	{0x03, 0x00, 0x01},
    350. 

  350. 	{0x03, 0x00, 0x02},
    351. 

  351. 	{0x03, 0x00, 0x03},
    352. 

  352. 	{0x03, 0x00, 0x04},
    353. 

  353. 	{0x03, 0x00, 0x05},
    354. 

  354. 	{0x03, 0x00, 0x06},
    355. 

  355. 	{0x04, 0x00, 0x00},
    356. 

  356. 	{0x04, 0x00, 0x02},
    357. 

  357. 	{0x04, 0x00, 0x04},
    358. 

  358. 	{0x04, 0x00, 0x05},
    359. 

  359. 	{0x04, 0x00, 0x06},
    360. 

  360. 	{0x04, 0x00, 0x07},
    361. 

  361. 	{0x04, 0x00, 0x08},
    362. 

  362. 	{0x04, 0x00, 0x09},
    363. 

  363. 	{0x04, 0x00, 0x0a},
    364. 

  364. 	{0x04, 0x00, 0x0b},
    365. 

  365. 	{0x04, 0x00, 0x0c},
    366. 

  366. 	{0x07, 0x00, 0x00},
    367. 

  367. 	{0x07, 0x00, 0x03},
    368. 

  368. 	{0x08, 0x00, 0x00},
    369. 

  369. 	{0x08, 0x00, 0x01},
    370. 

  370. 	{0x08, 0x00, 0x02},
    371. 

  371. 	{0x06, 0x18, 0x08},
    372. 

  372. 	{0x06, 0xfc, 0x09},
    373. 

  373. 	{0x06, 0xfc, 0x0a},
    374. 

  374. 	{0x06, 0xfc, 0x0b},
    375. 

  375. 	{0x06, 0x18, 0x0c},
    376. 

  376. 	{0x06, 0xfc, 0x0d},
    377. 

  377. 	{0x06, 0xfc, 0x0e},
    378. 

  378. 	{0x06, 0xfc, 0x0f},
    379. 

  379. 	{0x06, 0x18, 0x10},
    380. 

  380. 	{0x06, 0xfe, 0x12},
    381. 

  381. 	{0x06, 0x00, 0x11},
    382. 

  382. 	{0x06, 0x00, 0x14},
    383. 

  383. 	{0x06, 0x00, 0x13},
    384. 

  384. 	{0x06, 0x28, 0x51},
    385. 

  385. 	{0x06, 0xff, 0x53},
    386. 

  386. 	{0x02, 0x00, 0x08},
    387. 

  387. 

  388. 	{0x03, 0x00, 0x03},
    389. 

  389. 	{0x03, 0x10, 0x03},
    390. 

  390. 	{}
    391. 

  391. };
    392. 

  392. 

  393. /*
    394. 

  394.  * Data to initialize the camera using the internal CCD
    395. 

  395.  */
    396. 

  396. static const u8 spca505b_open_data_ccd[][3] = {
    397. 

  397. 

  398. /* {0x02,0x00,0x00}, */
    399. 

  399. 	{0x03, 0x04, 0x01},		/* rst */
    400. 

  400. 	{0x03, 0x00, 0x01},
    401. 

  401. 	{0x03, 0x00, 0x00},
    402. 

  402. 	{0x03, 0x21, 0x00},
    403. 

  403. 	{0x03, 0x00, 0x04},
    404. 

  404. 	{0x03, 0x00, 0x03},
    405. 

  405. 	{0x03, 0x18, 0x03},
    406. 

  406. 	{0x03, 0x08, 0x01},
    407. 

  407. 	{0x03, 0x1c, 0x03},
    408. 

  408. 	{0x03, 0x5c, 0x03},
    409. 

  409. 	{0x03, 0x5c, 0x03},
    410. 

  410. 	{0x03, 0x18, 0x01},
    411. 

  411. 

  412. /* same as 505 */
    413. 

  413. 	{0x04, 0x10, 0x01},
    414. 

  414. 	{0x04, 0x00, 0x04},
    415. 

  415. 	{0x04, 0x00, 0x05},
    416. 

  416. 	{0x04, 0x20, 0x06},
    417. 

  417. 	{0x04, 0x20, 0x07},
    418. 

  418. 

  419. 	{0x08, 0x0a, 0x00},
    420. 

  420. 

  421. 	{0x05, 0x00, 0x10},
    422. 

  422. 	{0x05, 0x00, 0x11},
    423. 

  423. 	{0x05, 0x00, 0x12},
    424. 

  424. 	{0x05, 0x6f, 0x00},
    425. 

  425. 	{0x05, initial_brightness >> 6, 0x00},
    426. 

  426. 	{0x05, (initial_brightness << 2) & 0xff, 0x01},
    427. 

  427. 	{0x05, 0x00, 0x02},
    428. 

  428. 	{0x05, 0x01, 0x03},
    429. 

  429. 	{0x05, 0x00, 0x04},
    430. 

  430. 	{0x05, 0x03, 0x05},
    431. 

  431. 	{0x05, 0xe0, 0x06},
    432. 

  432. 	{0x05, 0x20, 0x07},
    433. 

  433. 	{0x05, 0xa0, 0x08},
    434. 

  434. 	{0x05, 0x00, 0x12},
    435. 

  435. 	{0x05, 0x02, 0x0f},
    436. 

  436. 	{0x05, 0x80, 0x14},		/* max exposure off (0=on) */
    437. 

  437. 	{0x05, 0x01, 0xb0},
    438. 

  438. 	{0x05, 0x01, 0xbf},
    439. 

  439. 	{0x03, 0x02, 0x06},
    440. 

  440. 	{0x05, 0x10, 0x46},
    441. 

  441. 	{0x05, 0x08, 0x4a},
    442. 

  442. 

  443. 	{0x06, 0x00, 0x01},
    444. 

  444. 	{0x06, 0x10, 0x02},
    445. 

  445. 	{0x06, 0x64, 0x07},
    446. 

  446. 	{0x06, 0x18, 0x08},
    447. 

  447. 	{0x06, 0xfc, 0x09},
    448. 

  448. 	{0x06, 0xfc, 0x0a},
    449. 

  449. 	{0x06, 0xfc, 0x0b},
    450. 

  450. 	{0x04, 0x00, 0x01},
    451. 

  451. 	{0x06, 0x18, 0x0c},
    452. 

  452. 	{0x06, 0xfc, 0x0d},
    453. 

  453. 	{0x06, 0xfc, 0x0e},
    454. 

  454. 	{0x06, 0xfc, 0x0f},
    455. 

  455. 	{0x06, 0x11, 0x10},		/* contrast */
    456. 

  456. 	{0x06, 0x00, 0x11},
    457. 

  457. 	{0x06, 0xfe, 0x12},
    458. 

  458. 	{0x06, 0x00, 0x13},
    459. 

  459. 	{0x06, 0x00, 0x14},
    460. 

  460. 	{0x06, 0x9d, 0x51},
    461. 

  461. 	{0x06, 0x40, 0x52},
    462. 

  462. 	{0x06, 0x7c, 0x53},
    463. 

  463. 	{0x06, 0x40, 0x54},
    464. 

  464. 	{0x06, 0x02, 0x57},
    465. 

  465. 	{0x06, 0x03, 0x58},
    466. 

  466. 	{0x06, 0x15, 0x59},
    467. 

  467. 	{0x06, 0x05, 0x5a},
    468. 

  468. 	{0x06, 0x03, 0x56},
    469. 

  469. 	{0x06, 0x02, 0x3f},
    470. 

  470. 	{0x06, 0x00, 0x40},
    471. 

  471. 	{0x06, 0x39, 0x41},
    472. 

  472. 	{0x06, 0x69, 0x42},
    473. 

  473. 	{0x06, 0x87, 0x43},
    474. 

  474. 	{0x06, 0x9e, 0x44},
    475. 

  475. 	{0x06, 0xb1, 0x45},
    476. 

  476. 	{0x06, 0xbf, 0x46},
    477. 

  477. 	{0x06, 0xcc, 0x47},
    478. 

  478. 	{0x06, 0xd5, 0x48},
    479. 

  479. 	{0x06, 0xdd, 0x49},
    480. 

  480. 	{0x06, 0xe3, 0x4a},
    481. 

  481. 	{0x06, 0xe8, 0x4b},
    482. 

  482. 	{0x06, 0xed, 0x4c},
    483. 

  483. 	{0x06, 0xf2, 0x4d},
    484. 

  484. 	{0x06, 0xf7, 0x4e},
    485. 

  485. 	{0x06, 0xfc, 0x4f},
    486. 

  486. 	{0x06, 0xff, 0x50},
    487. 

  487. 

  488. 	{0x05, 0x01, 0xc0},
    489. 

  489. 	{0x05, 0x10, 0xcb},
    490. 

  490. 	{0x05, 0x40, 0xc1},
    491. 

  491. 	{0x05, 0x04, 0xc2},
    492. 

  492. 	{0x05, 0x00, 0xca},
    493. 

  493. 	{0x05, 0x40, 0xc1},
    494. 

  494. 	{0x05, 0x09, 0xc2},
    495. 

  495. 	{0x05, 0x00, 0xca},
    496. 

  496. 	{0x05, 0xc0, 0xc1},
    497. 

  497. 	{0x05, 0x09, 0xc2},
    498. 

  498. 	{0x05, 0x00, 0xca},
    499. 

  499. 	{0x05, 0x40, 0xc1},
    500. 

  500. 	{0x05, 0x59, 0xc2},
    501. 

  501. 	{0x05, 0x00, 0xca},
    502. 

  502. 	{0x04, 0x00, 0x01},
    503. 

  503. 	{0x05, 0x80, 0xc1},
    504. 

  504. 	{0x05, 0xec, 0xc2},
    505. 

  505. 	{0x05, 0x0, 0xca},
    506. 

  506. 

  507. 	{0x06, 0x02, 0x57},
    508. 

  508. 	{0x06, 0x01, 0x58},
    509. 

  509. 	{0x06, 0x15, 0x59},
    510. 

  510. 	{0x06, 0x0a, 0x5a},
    511. 

  511. 	{0x06, 0x01, 0x57},
    512. 

  512. 	{0x06, 0x8a, 0x03},
    513. 

  513. 	{0x06, 0x0a, 0x6c},
    514. 

  514. 	{0x06, 0x30, 0x01},
    515. 

  515. 	{0x06, 0x20, 0x02},
    516. 

  516. 	{0x06, 0x00, 0x03},
    517. 

  517. 

  518. 	{0x05, 0x8c, 0x25},
    519. 

  519. 

  520. 	{0x06, 0x4d, 0x51},		/* maybe saturation (4d) */
    521. 

  521. 	{0x06, 0x84, 0x53},		/* making green (84) */
    522. 

  522. 	{0x06, 0x00, 0x57},		/* sharpness (1) */
    523. 

  523. 	{0x06, 0x18, 0x08},
    524. 

  524. 	{0x06, 0xfc, 0x09},
    525. 

  525. 	{0x06, 0xfc, 0x0a},
    526. 

  526. 	{0x06, 0xfc, 0x0b},
    527. 

  527. 	{0x06, 0x18, 0x0c},		/* maybe hue (18) */
    528. 

  528. 	{0x06, 0xfc, 0x0d},
    529. 

  529. 	{0x06, 0xfc, 0x0e},
    530. 

  530. 	{0x06, 0xfc, 0x0f},
    531. 

  531. 	{0x06, 0x18, 0x10},		/* maybe contrast (18) */
    532. 

  532. 

  533. 	{0x05, 0x01, 0x02},
    534. 

  534. 

  535. 	{0x04, 0x00, 0x08},		/* compression */
    536. 

  536. 	{0x04, 0x12, 0x09},
    537. 

  537. 	{0x04, 0x21, 0x0a},
    538. 

  538. 	{0x04, 0x10, 0x0b},
    539. 

  539. 	{0x04, 0x21, 0x0c},
    540. 

  540. 	{0x04, 0x1d, 0x00},		/* imagetype (1d) */
    541. 

  541. 	{0x04, 0x41, 0x01},		/* hardware snapcontrol */
    542. 

  542. 

  543. 	{0x04, 0x00, 0x04},
    544. 

  544. 	{0x04, 0x00, 0x05},
    545. 

  545. 	{0x04, 0x10, 0x06},
    546. 

  546. 	{0x04, 0x10, 0x07},
    547. 

  547. 	{0x04, 0x40, 0x06},
    548. 

  548. 	{0x04, 0x40, 0x07},
    549. 

  549. 	{0x04, 0x00, 0x04},
    550. 

  550. 	{0x04, 0x00, 0x05},
    551. 

  551. 

  552. 	{0x06, 0x1c, 0x17},
    553. 

  553. 	{0x06, 0xe2, 0x19},
    554. 

  554. 	{0x06, 0x1c, 0x1b},
    555. 

  555. 	{0x06, 0xe2, 0x1d},
    556. 

  556. 	{0x06, 0x5f, 0x1f},
    557. 

  557. 	{0x06, 0x32, 0x20},
    558. 

  558. 

  559. 	{0x05, initial_brightness >> 6, 0x00},
    560. 

  560. 	{0x05, (initial_brightness << 2) & 0xff, 0x01},
    561. 

  561. 	{0x05, 0x06, 0xc1},
    562. 

  562. 	{0x05, 0x58, 0xc2},
    563. 

  563. 	{0x05, 0x00, 0xca},
    564. 

  564. 	{0x05, 0x00, 0x11},
    565. 

  565. 	{}
    566. 

  566. };
    567. 

  567. 

  568. static int reg_write(struct usb_device *dev,
    569. 

  569. 		     u16 req, u16 index, u16 value)
    570. 

  570. {
    571. 

  571. 	int ret;
    572. 

  572. 

  573. 	ret = usb_control_msg(dev,
    574. 

  574. 			usb_sndctrlpipe(dev, 0),
    575. 

  575. 			req,
    576. 

  576. 			USB_TYPE_VENDOR | USB_RECIP_DEVICE,
    577. 

  577. 			value, index, NULL, 0, 500);
    578. 

  578. 	PDEBUG(D_USBO, "reg write: 0x%02x,0x%02x:0x%02x, %d",
    579. 

  579. 		req, index, value, ret);
    580. 

  580. 	if (ret < 0)
    581. 

  581. 		err("reg write: error %d", ret);
    582. 

  582. 	return ret;
    583. 

  583. }
    584. 

  584. 

  585. /* returns: negative is error, pos or zero is data */
    586. 

  586. static int reg_read(struct gspca_dev *gspca_dev,
    587. 

  587. 			u16 req,	/* bRequest */
    588. 

  588. 			u16 index)	/* wIndex */
    589. 

  589. {
    590. 

  590. 	int ret;
    591. 

  591. 

  592. 	ret = usb_control_msg(gspca_dev->dev,
    593. 

  593. 			usb_rcvctrlpipe(gspca_dev->dev, 0),
    594. 

  594. 			req,
    595. 

  595. 			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
    596. 

  596. 			0,			/* value */
    597. 

  597. 			index,
    598. 

  598. 			gspca_dev->usb_buf, 2,
    599. 

  599. 			500);			/* timeout */
    600. 

  600. 	if (ret < 0)
    601. 

  601. 		return ret;
    602. 

  602. 	return (gspca_dev->usb_buf[1] << 8) + gspca_dev->usb_buf[0];
    603. 

  603. }
    604. 

  604. 

  605. static int write_vector(struct gspca_dev *gspca_dev,
    606. 

  606. 			const u8 data[][3])
    607. 

  607. {
    608. 

  608. 	struct usb_device *dev = gspca_dev->dev;
    609. 

  609. 	int ret, i = 0;
    610. 

  610. 

  611. 	while (data[i][0] != 0) {
    612. 

  612. 		ret = reg_write(dev, data[i][0], data[i][2], data[i][1]);
    613. 

  613. 		if (ret < 0)
    614. 

  614. 			return ret;
    615. 

  615. 		i++;
    616. 

  616. 	}
    617. 

  617. 	return 0;
    618. 

  618. }
    619. 

  619. 

  620. /* this function is called at probe time */
    621. 

  621. static int sd_config(struct gspca_dev *gspca_dev,
    622. 

  622. 			const struct usb_device_id *id)
    623. 

  623. {
    624. 

  624. 	struct sd *sd = (struct sd *) gspca_dev;
    625. 

  625. 	struct cam *cam;
    626. 

  626. 

  627. 	cam = &gspca_dev->cam;
    628. 

  628. 	cam->cam_mode = vga_mode;
    629. 

  629. 	sd->subtype = id->driver_info;
    630. 

  630. 	if (sd->subtype != IntelPCCameraPro)
    631. 

  631. 		cam->nmodes = ARRAY_SIZE(vga_mode);
    632. 

  632. 	else			/* no 640x480 for IntelPCCameraPro */
    633. 

  633. 		cam->nmodes = ARRAY_SIZE(vga_mode) - 1;
    634. 

  634. 	sd->brightness = BRIGHTNESS_DEF;
    635. 

  635. 

  636. 	return 0;
    637. 

  637. }
    638. 

  638. 

  639. /* this function is called at probe and resume time */
    640. 

  640. static int sd_init(struct gspca_dev *gspca_dev)
    641. 

  641. {
    642. 

  642. 	struct sd *sd = (struct sd *) gspca_dev;
    643. 

  643. 

  644. 	if (write_vector(gspca_dev,
    645. 

  645. 			 sd->subtype == Nxultra
    646. 

  646. 				? spca505b_init_data
    647. 

  647. 				: spca505_init_data))
    648. 

  648. 		return -EIO;
    649. 

  649. 	return 0;
    650. 

  650. }
    651. 

  651. 

  652. static void setbrightness(struct gspca_dev *gspca_dev)
    653. 

  653. {
    654. 

  654. 	struct sd *sd = (struct sd *) gspca_dev;
    655. 

  655. 	u8 brightness = sd->brightness;
    656. 

  656. 

  657. 	reg_write(gspca_dev->dev, 0x05, 0x00, (255 - brightness) >> 6);
    658. 

  658. 	reg_write(gspca_dev->dev, 0x05, 0x01, (255 - brightness) << 2);
    659. 

  659. }
    660. 

  660. 

  661. static int sd_start(struct gspca_dev *gspca_dev)
    662. 

  662. {
    663. 

  663. 	struct sd *sd = (struct sd *) gspca_dev;
    664. 

  664. 	struct usb_device *dev = gspca_dev->dev;
    665. 

  665. 	int ret, mode;
    666. 

  666. 	static u8 mode_tb[][3] = {
    667. 

  667. 	/*	  r00   r06   r07	*/
    668. 

  668. 		{0x00, 0x10, 0x10},	/* 640x480 */
    669. 

  669. 		{0x01, 0x1a, 0x1a},	/* 352x288 */
    670. 

  670. 		{0x02, 0x1c, 0x1d},	/* 320x240 */
    671. 

  671. 		{0x04, 0x34, 0x34},	/* 176x144 */
    672. 

  672. 		{0x05, 0x40, 0x40}	/* 160x120 */
    673. 

  673. 	};
    674. 

  674. 

  675. 	if (sd->subtype == Nxultra)
    676. 

  676. 		write_vector(gspca_dev, spca505b_open_data_ccd);
    677. 

  677. 	else
    678. 

  678. 		write_vector(gspca_dev, spca505_open_data_ccd);
    679. 

  679. 	ret = reg_read(gspca_dev, 0x06, 0x16);
    680. 

  680. 

  681. 	if (ret < 0) {
    682. 

  682. 		PDEBUG(D_ERR|D_CONF,
    683. 

  683. 		       "register read failed err: %d",
    684. 

  684. 		       ret);
    685. 

  685. 		return ret;
    686. 

  686. 	}
    687. 

  687. 	if (ret != 0x0101) {
    688. 

  688. 		err("After vector read returns 0x%04x should be 0x0101",
    689. 

  689. 			ret);
    690. 

  690. 	}
    691. 

  691. 

  692. 	ret = reg_write(gspca_dev->dev, 0x06, 0x16, 0x0a);
    693. 

  693. 	if (ret < 0)
    694. 

  694. 		return ret;
    695. 

  695. 	reg_write(gspca_dev->dev, 0x05, 0xc2, 0x12);
    696. 

  696. 

  697. 	/* necessary because without it we can see stream
    698. 

  698. 	 * only once after loading module */
    699. 

  699. 	/* stopping usb registers Tomasz change */
    700. 

  700. 	reg_write(dev, 0x02, 0x00, 0x00);
    701. 

  701. 

  702. 	mode = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
    703. 

  703. 	reg_write(dev, SPCA50X_REG_COMPRESS, 0x00, mode_tb[mode][0]);
    704. 

  704. 	reg_write(dev, SPCA50X_REG_COMPRESS, 0x06, mode_tb[mode][1]);
    705. 

  705. 	reg_write(dev, SPCA50X_REG_COMPRESS, 0x07, mode_tb[mode][2]);
    706. 

  706. 

  707. 	ret = reg_write(dev, SPCA50X_REG_USB,
    708. 

  708. 			 SPCA50X_USB_CTRL,
    709. 

  709. 			 SPCA50X_CUSB_ENABLE);
    710. 

  710. 

  711. 	setbrightness(gspca_dev);
    712. 

  712. 

  713. 	return ret;
    714. 

  714. }
    715. 

  715. 

  716. static void sd_stopN(struct gspca_dev *gspca_dev)
    717. 

  717. {
    718. 

  718. 	/* Disable ISO packet machine */
    719. 

  719. 	reg_write(gspca_dev->dev, 0x02, 0x00, 0x00);
    720. 

  720. }
    721. 

  721. 

  722. /* called on streamoff with alt 0 and on disconnect */
    723. 

  723. static void sd_stop0(struct gspca_dev *gspca_dev)
    724. 

  724. {
    725. 

  725. 	if (!gspca_dev->present)
    726. 

  726. 		return;
    727. 

  727. 

  728. 	/* This maybe reset or power control */
    729. 

  729. 	reg_write(gspca_dev->dev, 0x03, 0x03, 0x20);
    730. 

  730. 	reg_write(gspca_dev->dev, 0x03, 0x01, 0x00);
    731. 

  731. 	reg_write(gspca_dev->dev, 0x03, 0x00, 0x01);
    732. 

  732. 	reg_write(gspca_dev->dev, 0x05, 0x10, 0x01);
    733. 

  733. 	reg_write(gspca_dev->dev, 0x05, 0x11, 0x0f);
    734. 

  734. }
    735. 

  735. 

  736. static void sd_pkt_scan(struct gspca_dev *gspca_dev,
    737. 

  737. 			u8 *data,			/* isoc packet */
    738. 

  738. 			int len)			/* iso packet length */
    739. 

  739. {
    740. 

  740. 	switch (data[0]) {
    741. 

  741. 	case 0:				/* start of frame */
    742. 

  742. 		gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
    743. 

  743. 		data += SPCA50X_OFFSET_DATA;
    744. 

  744. 		len -= SPCA50X_OFFSET_DATA;
    745. 

  745. 		gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
    746. 

  746. 		break;
    747. 

  747. 	case 0xff:			/* drop */
    748. 

  748. 		break;
    749. 

  749. 	default:
    750. 

  750. 		data += 1;
    751. 

  751. 		len -= 1;
    752. 

  752. 		gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
    753. 

  753. 		break;
    754. 

  754. 	}
    755. 

  755. }
    756. 

  756. 

  757. static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
    758. 

  758. {
    759. 

  759. 	struct sd *sd = (struct sd *) gspca_dev;
    760. 

  760. 

  761. 	sd->brightness = val;
    762. 

  762. 	if (gspca_dev->streaming)
    763. 

  763. 		setbrightness(gspca_dev);
    764. 

  764. 	return 0;
    765. 

  765. }
    766. 

  766. 

  767. static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
    768. 

  768. {
    769. 

  769. 	struct sd *sd = (struct sd *) gspca_dev;
    770. 

  770. 

  771. 	*val = sd->brightness;
    772. 

  772. 	return 0;
    773. 

  773. }
    774. 

  774. 

  775. /* sub-driver description */
    776. 

  776. static const struct sd_desc sd_desc = {
    777. 

  777. 	.name = MODULE_NAME,
    778. 

  778. 	.ctrls = sd_ctrls,
    779. 

  779. 	.nctrls = ARRAY_SIZE(sd_ctrls),
    780. 

  780. 	.config = sd_config,
    781. 

  781. 	.init = sd_init,
    782. 

  782. 	.start = sd_start,
    783. 

  783. 	.stopN = sd_stopN,
    784. 

  784. 	.stop0 = sd_stop0,
    785. 

  785. 	.pkt_scan = sd_pkt_scan,
    786. 

  786. };
    787. 

  787. 

  788. /* -- module initialisation -- */
    789. 

  789. static const struct usb_device_id device_table[] = {
    790. 

  790. 	{USB_DEVICE(0x041e, 0x401d), .driver_info = Nxultra},
    791. 

  791. 	{USB_DEVICE(0x0733, 0x0430), .driver_info = IntelPCCameraPro},
    792. 

  792. /*fixme: may be UsbGrabberPV321 BRIDGE_SPCA506 SENSOR_SAA7113 */
    793. 

  793. 	{}
    794. 

  794. };
    795. 

  795. MODULE_DEVICE_TABLE(usb, device_table);
    796. 

  796. 

  797. /* -- device connect -- */
    798. 

  798. static int sd_probe(struct usb_interface *intf,
    799. 

  799. 			const struct usb_device_id *id)
    800. 

  800. {
    801. 

  801. 	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
    802. 

  802. 				THIS_MODULE);
    803. 

  803. }
    804. 

  804. 

  805. static struct usb_driver sd_driver = {
    806. 

  806. 	.name = MODULE_NAME,
    807. 

  807. 	.id_table = device_table,
    808. 

  808. 	.probe = sd_probe,
    809. 

  809. 	.disconnect = gspca_disconnect,
    810. 

  810. #ifdef CONFIG_PM
    811. 

  811. 	.suspend = gspca_suspend,
    812. 

  812. 	.resume = gspca_resume,
    813. 

  813. #endif
    814. 

  814. };
    815. 

  815. 

  816. /* -- module insert / remove -- */
    817. 

  817. static int __init sd_mod_init(void)
    818. 

  818. {
    819. 

  819. 	return usb_register(&sd_driver);
    820. 

  820. }
    821. 

  821. static void __exit sd_mod_exit(void)
    822. 

  822. {
    823. 

  823. 	usb_deregister(&sd_driver);
    824. 

  824. }
    825. 

  825. 

  826. module_init(sd_mod_init);
    827. 

  827. module_exit(sd_mod_exit);
    828.