/drivers/media/video/soc_mediabus.c

https://bitbucket.org/wisechild/galaxy-nexus · C · 400 lines · 378 code · 13 blank · 9 comment · 5 complexity · 5cad2a159fb4a8d05233401cd7edc6a0 MD5 · raw file 

    

  1. /*
    2. 

  2.  * soc-camera media bus helper routines
    3. 

  3.  *
    4. 

  4.  * Copyright (C) 2009, Guennadi Liakhovetski <g.liakhovetski@gmx.de>
    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 version 2 as
    8. 

  8.  * published by the Free Software Foundation.
    9. 

  9.  */
    10. 

  10. 

  11. #include <linux/kernel.h>
    12. 

  12. #include <linux/module.h>
    13. 

  13. 

  14. #include <media/v4l2-device.h>
    15. 

  15. #include <media/v4l2-mediabus.h>
    16. 

  16. #include <media/soc_mediabus.h>
    17. 

  17. 

  18. static const struct soc_mbus_lookup mbus_fmt[] = {
    19. 

  19. {
    20. 

  20. 	.code = V4L2_MBUS_FMT_YUYV8_2X8,
    21. 

  21. 	.fmt = {
    22. 

  22. 		.fourcc			= V4L2_PIX_FMT_YUYV,
    23. 

  23. 		.name			= "YUYV",
    24. 

  24. 		.bits_per_sample	= 8,
    25. 

  25. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    26. 

  26. 		.order			= SOC_MBUS_ORDER_LE,
    27. 

  27. 	},
    28. 

  28. }, {
    29. 

  29. 	.code = V4L2_MBUS_FMT_YVYU8_2X8,
    30. 

  30. 	.fmt = {
    31. 

  31. 		.fourcc			= V4L2_PIX_FMT_YVYU,
    32. 

  32. 		.name			= "YVYU",
    33. 

  33. 		.bits_per_sample	= 8,
    34. 

  34. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    35. 

  35. 		.order			= SOC_MBUS_ORDER_LE,
    36. 

  36. 	},
    37. 

  37. }, {
    38. 

  38. 	.code = V4L2_MBUS_FMT_UYVY8_2X8,
    39. 

  39. 	.fmt = {
    40. 

  40. 		.fourcc			= V4L2_PIX_FMT_UYVY,
    41. 

  41. 		.name			= "UYVY",
    42. 

  42. 		.bits_per_sample	= 8,
    43. 

  43. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    44. 

  44. 		.order			= SOC_MBUS_ORDER_LE,
    45. 

  45. 	},
    46. 

  46. }, {
    47. 

  47. 	.code = V4L2_MBUS_FMT_VYUY8_2X8,
    48. 

  48. 	.fmt = {
    49. 

  49. 		.fourcc			= V4L2_PIX_FMT_VYUY,
    50. 

  50. 		.name			= "VYUY",
    51. 

  51. 		.bits_per_sample	= 8,
    52. 

  52. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    53. 

  53. 		.order			= SOC_MBUS_ORDER_LE,
    54. 

  54. 	},
    55. 

  55. }, {
    56. 

  56. 	.code = V4L2_MBUS_FMT_RGB555_2X8_PADHI_LE,
    57. 

  57. 	.fmt = {
    58. 

  58. 		.fourcc			= V4L2_PIX_FMT_RGB555,
    59. 

  59. 		.name			= "RGB555",
    60. 

  60. 		.bits_per_sample	= 8,
    61. 

  61. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    62. 

  62. 		.order			= SOC_MBUS_ORDER_LE,
    63. 

  63. 	},
    64. 

  64. }, {
    65. 

  65. 	.code = V4L2_MBUS_FMT_RGB555_2X8_PADHI_BE,
    66. 

  66. 	.fmt = {
    67. 

  67. 		.fourcc			= V4L2_PIX_FMT_RGB555X,
    68. 

  68. 		.name			= "RGB555X",
    69. 

  69. 		.bits_per_sample	= 8,
    70. 

  70. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    71. 

  71. 		.order			= SOC_MBUS_ORDER_LE,
    72. 

  72. 	},
    73. 

  73. }, {
    74. 

  74. 	.code = V4L2_MBUS_FMT_RGB565_2X8_LE,
    75. 

  75. 	.fmt = {
    76. 

  76. 		.fourcc			= V4L2_PIX_FMT_RGB565,
    77. 

  77. 		.name			= "RGB565",
    78. 

  78. 		.bits_per_sample	= 8,
    79. 

  79. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    80. 

  80. 		.order			= SOC_MBUS_ORDER_LE,
    81. 

  81. 	},
    82. 

  82. }, {
    83. 

  83. 	.code = V4L2_MBUS_FMT_RGB565_2X8_BE,
    84. 

  84. 	.fmt = {
    85. 

  85. 		.fourcc			= V4L2_PIX_FMT_RGB565X,
    86. 

  86. 		.name			= "RGB565X",
    87. 

  87. 		.bits_per_sample	= 8,
    88. 

  88. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    89. 

  89. 		.order			= SOC_MBUS_ORDER_LE,
    90. 

  90. 	},
    91. 

  91. }, {
    92. 

  92. 	.code = V4L2_MBUS_FMT_SBGGR8_1X8,
    93. 

  93. 	.fmt = {
    94. 

  94. 		.fourcc			= V4L2_PIX_FMT_SBGGR8,
    95. 

  95. 		.name			= "Bayer 8 BGGR",
    96. 

  96. 		.bits_per_sample	= 8,
    97. 

  97. 		.packing		= SOC_MBUS_PACKING_NONE,
    98. 

  98. 		.order			= SOC_MBUS_ORDER_LE,
    99. 

  99. 	},
    100. 

  100. }, {
    101. 

  101. 	.code = V4L2_MBUS_FMT_SBGGR10_1X10,
    102. 

  102. 	.fmt = {
    103. 

  103. 		.fourcc			= V4L2_PIX_FMT_SBGGR10,
    104. 

  104. 		.name			= "Bayer 10 BGGR",
    105. 

  105. 		.bits_per_sample	= 10,
    106. 

  106. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    107. 

  107. 		.order			= SOC_MBUS_ORDER_LE,
    108. 

  108. 	},
    109. 

  109. }, {
    110. 

  110. 	.code = V4L2_MBUS_FMT_Y8_1X8,
    111. 

  111. 	.fmt = {
    112. 

  112. 		.fourcc			= V4L2_PIX_FMT_GREY,
    113. 

  113. 		.name			= "Grey",
    114. 

  114. 		.bits_per_sample	= 8,
    115. 

  115. 		.packing		= SOC_MBUS_PACKING_NONE,
    116. 

  116. 		.order			= SOC_MBUS_ORDER_LE,
    117. 

  117. 	},
    118. 

  118. }, {
    119. 

  119. 	.code = V4L2_MBUS_FMT_Y10_1X10,
    120. 

  120. 	.fmt = {
    121. 

  121. 		.fourcc			= V4L2_PIX_FMT_Y10,
    122. 

  122. 		.name			= "Grey 10bit",
    123. 

  123. 		.bits_per_sample	= 10,
    124. 

  124. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    125. 

  125. 		.order			= SOC_MBUS_ORDER_LE,
    126. 

  126. 	},
    127. 

  127. }, {
    128. 

  128. 	.code = V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE,
    129. 

  129. 	.fmt = {
    130. 

  130. 		.fourcc			= V4L2_PIX_FMT_SBGGR10,
    131. 

  131. 		.name			= "Bayer 10 BGGR",
    132. 

  132. 		.bits_per_sample	= 8,
    133. 

  133. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    134. 

  134. 		.order			= SOC_MBUS_ORDER_LE,
    135. 

  135. 	},
    136. 

  136. }, {
    137. 

  137. 	.code = V4L2_MBUS_FMT_SBGGR10_2X8_PADLO_LE,
    138. 

  138. 	.fmt = {
    139. 

  139. 		.fourcc			= V4L2_PIX_FMT_SBGGR10,
    140. 

  140. 		.name			= "Bayer 10 BGGR",
    141. 

  141. 		.bits_per_sample	= 8,
    142. 

  142. 		.packing		= SOC_MBUS_PACKING_2X8_PADLO,
    143. 

  143. 		.order			= SOC_MBUS_ORDER_LE,
    144. 

  144. 	},
    145. 

  145. }, {
    146. 

  146. 	.code = V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_BE,
    147. 

  147. 	.fmt = {
    148. 

  148. 		.fourcc			= V4L2_PIX_FMT_SBGGR10,
    149. 

  149. 		.name			= "Bayer 10 BGGR",
    150. 

  150. 		.bits_per_sample	= 8,
    151. 

  151. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    152. 

  152. 		.order			= SOC_MBUS_ORDER_BE,
    153. 

  153. 	},
    154. 

  154. }, {
    155. 

  155. 	.code = V4L2_MBUS_FMT_SBGGR10_2X8_PADLO_BE,
    156. 

  156. 	.fmt = {
    157. 

  157. 		.fourcc			= V4L2_PIX_FMT_SBGGR10,
    158. 

  158. 		.name			= "Bayer 10 BGGR",
    159. 

  159. 		.bits_per_sample	= 8,
    160. 

  160. 		.packing		= SOC_MBUS_PACKING_2X8_PADLO,
    161. 

  161. 		.order			= SOC_MBUS_ORDER_BE,
    162. 

  162. 	},
    163. 

  163. }, {
    164. 

  164. 	.code = V4L2_MBUS_FMT_JPEG_1X8,
    165. 

  165. 	.fmt = {
    166. 

  166. 		.fourcc                 = V4L2_PIX_FMT_JPEG,
    167. 

  167. 		.name                   = "JPEG",
    168. 

  168. 		.bits_per_sample        = 8,
    169. 

  169. 		.packing                = SOC_MBUS_PACKING_VARIABLE,
    170. 

  170. 		.order                  = SOC_MBUS_ORDER_LE,
    171. 

  171. 	},
    172. 

  172. }, {
    173. 

  173. 	.code = V4L2_MBUS_FMT_RGB444_2X8_PADHI_BE,
    174. 

  174. 	.fmt = {
    175. 

  175. 		.fourcc			= V4L2_PIX_FMT_RGB444,
    176. 

  176. 		.name			= "RGB444",
    177. 

  177. 		.bits_per_sample	= 8,
    178. 

  178. 		.packing		= SOC_MBUS_PACKING_2X8_PADHI,
    179. 

  179. 		.order			= SOC_MBUS_ORDER_BE,
    180. 

  180. 	},
    181. 

  181. }, {
    182. 

  182. 	.code = V4L2_MBUS_FMT_YUYV8_1_5X8,
    183. 

  183. 	.fmt = {
    184. 

  184. 		.fourcc			= V4L2_PIX_FMT_YUV420,
    185. 

  185. 		.name			= "YUYV 4:2:0",
    186. 

  186. 		.bits_per_sample	= 8,
    187. 

  187. 		.packing		= SOC_MBUS_PACKING_1_5X8,
    188. 

  188. 		.order			= SOC_MBUS_ORDER_LE,
    189. 

  189. 	},
    190. 

  190. }, {
    191. 

  191. 	.code = V4L2_MBUS_FMT_YVYU8_1_5X8,
    192. 

  192. 	.fmt = {
    193. 

  193. 		.fourcc			= V4L2_PIX_FMT_YVU420,
    194. 

  194. 		.name			= "YVYU 4:2:0",
    195. 

  195. 		.bits_per_sample	= 8,
    196. 

  196. 		.packing		= SOC_MBUS_PACKING_1_5X8,
    197. 

  197. 		.order			= SOC_MBUS_ORDER_LE,
    198. 

  198. 	},
    199. 

  199. }, {
    200. 

  200. 	.code = V4L2_MBUS_FMT_UYVY8_1X16,
    201. 

  201. 	.fmt = {
    202. 

  202. 		.fourcc			= V4L2_PIX_FMT_UYVY,
    203. 

  203. 		.name			= "UYVY 16bit",
    204. 

  204. 		.bits_per_sample	= 16,
    205. 

  205. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    206. 

  206. 		.order			= SOC_MBUS_ORDER_LE,
    207. 

  207. 	},
    208. 

  208. }, {
    209. 

  209. 	.code = V4L2_MBUS_FMT_VYUY8_1X16,
    210. 

  210. 	.fmt = {
    211. 

  211. 		.fourcc			= V4L2_PIX_FMT_VYUY,
    212. 

  212. 		.name			= "VYUY 16bit",
    213. 

  213. 		.bits_per_sample	= 16,
    214. 

  214. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    215. 

  215. 		.order			= SOC_MBUS_ORDER_LE,
    216. 

  216. 	},
    217. 

  217. }, {
    218. 

  218. 	.code = V4L2_MBUS_FMT_YUYV8_1X16,
    219. 

  219. 	.fmt = {
    220. 

  220. 		.fourcc			= V4L2_PIX_FMT_YUYV,
    221. 

  221. 		.name			= "YUYV 16bit",
    222. 

  222. 		.bits_per_sample	= 16,
    223. 

  223. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    224. 

  224. 		.order			= SOC_MBUS_ORDER_LE,
    225. 

  225. 	},
    226. 

  226. }, {
    227. 

  227. 	.code = V4L2_MBUS_FMT_YVYU8_1X16,
    228. 

  228. 	.fmt = {
    229. 

  229. 		.fourcc			= V4L2_PIX_FMT_YVYU,
    230. 

  230. 		.name			= "YVYU 16bit",
    231. 

  231. 		.bits_per_sample	= 16,
    232. 

  232. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    233. 

  233. 		.order			= SOC_MBUS_ORDER_LE,
    234. 

  234. 	},
    235. 

  235. }, {
    236. 

  236. 	.code = V4L2_MBUS_FMT_SGRBG8_1X8,
    237. 

  237. 	.fmt = {
    238. 

  238. 		.fourcc			= V4L2_PIX_FMT_SGRBG8,
    239. 

  239. 		.name			= "Bayer 8 GRBG",
    240. 

  240. 		.bits_per_sample	= 8,
    241. 

  241. 		.packing		= SOC_MBUS_PACKING_NONE,
    242. 

  242. 		.order			= SOC_MBUS_ORDER_LE,
    243. 

  243. 	},
    244. 

  244. }, {
    245. 

  245. 	.code = V4L2_MBUS_FMT_SGRBG10_DPCM8_1X8,
    246. 

  246. 	.fmt = {
    247. 

  247. 		.fourcc			= V4L2_PIX_FMT_SGRBG10DPCM8,
    248. 

  248. 		.name			= "Bayer 10 BGGR DPCM 8",
    249. 

  249. 		.bits_per_sample	= 8,
    250. 

  250. 		.packing		= SOC_MBUS_PACKING_NONE,
    251. 

  251. 		.order			= SOC_MBUS_ORDER_LE,
    252. 

  252. 	},
    253. 

  253. }, {
    254. 

  254. 	.code = V4L2_MBUS_FMT_SGBRG10_1X10,
    255. 

  255. 	.fmt = {
    256. 

  256. 		.fourcc			= V4L2_PIX_FMT_SGBRG10,
    257. 

  257. 		.name			= "Bayer 10 GBRG",
    258. 

  258. 		.bits_per_sample	= 10,
    259. 

  259. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    260. 

  260. 		.order			= SOC_MBUS_ORDER_LE,
    261. 

  261. 	},
    262. 

  262. }, {
    263. 

  263. 	.code = V4L2_MBUS_FMT_SGRBG10_1X10,
    264. 

  264. 	.fmt = {
    265. 

  265. 		.fourcc			= V4L2_PIX_FMT_SGRBG10,
    266. 

  266. 		.name			= "Bayer 10 GRBG",
    267. 

  267. 		.bits_per_sample	= 10,
    268. 

  268. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    269. 

  269. 		.order			= SOC_MBUS_ORDER_LE,
    270. 

  270. 	},
    271. 

  271. }, {
    272. 

  272. 	.code = V4L2_MBUS_FMT_SRGGB10_1X10,
    273. 

  273. 	.fmt = {
    274. 

  274. 		.fourcc			= V4L2_PIX_FMT_SRGGB10,
    275. 

  275. 		.name			= "Bayer 10 RGGB",
    276. 

  276. 		.bits_per_sample	= 10,
    277. 

  277. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    278. 

  278. 		.order			= SOC_MBUS_ORDER_LE,
    279. 

  279. 	},
    280. 

  280. }, {
    281. 

  281. 	.code = V4L2_MBUS_FMT_SBGGR12_1X12,
    282. 

  282. 	.fmt = {
    283. 

  283. 		.fourcc			= V4L2_PIX_FMT_SBGGR12,
    284. 

  284. 		.name			= "Bayer 12 BGGR",
    285. 

  285. 		.bits_per_sample	= 12,
    286. 

  286. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    287. 

  287. 		.order			= SOC_MBUS_ORDER_LE,
    288. 

  288. 	},
    289. 

  289. }, {
    290. 

  290. 	.code = V4L2_MBUS_FMT_SGBRG12_1X12,
    291. 

  291. 	.fmt = {
    292. 

  292. 		.fourcc			= V4L2_PIX_FMT_SGBRG12,
    293. 

  293. 		.name			= "Bayer 12 GBRG",
    294. 

  294. 		.bits_per_sample	= 12,
    295. 

  295. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    296. 

  296. 		.order			= SOC_MBUS_ORDER_LE,
    297. 

  297. 	},
    298. 

  298. }, {
    299. 

  299. 	.code = V4L2_MBUS_FMT_SGRBG12_1X12,
    300. 

  300. 	.fmt = {
    301. 

  301. 		.fourcc			= V4L2_PIX_FMT_SGRBG12,
    302. 

  302. 		.name			= "Bayer 12 GRBG",
    303. 

  303. 		.bits_per_sample	= 12,
    304. 

  304. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    305. 

  305. 		.order			= SOC_MBUS_ORDER_LE,
    306. 

  306. 	},
    307. 

  307. }, {
    308. 

  308. 	.code = V4L2_MBUS_FMT_SRGGB12_1X12,
    309. 

  309. 	.fmt = {
    310. 

  310. 		.fourcc			= V4L2_PIX_FMT_SRGGB12,
    311. 

  311. 		.name			= "Bayer 12 RGGB",
    312. 

  312. 		.bits_per_sample	= 12,
    313. 

  313. 		.packing		= SOC_MBUS_PACKING_EXTEND16,
    314. 

  314. 		.order			= SOC_MBUS_ORDER_LE,
    315. 

  315. 	},
    316. 

  316. },
    317. 

  317. };
    318. 

  318. 

  319. int soc_mbus_samples_per_pixel(const struct soc_mbus_pixelfmt *mf,
    320. 

  320. 			unsigned int *numerator, unsigned int *denominator)
    321. 

  321. {
    322. 

  322. 	switch (mf->packing) {
    323. 

  323. 	case SOC_MBUS_PACKING_NONE:
    324. 

  324. 	case SOC_MBUS_PACKING_EXTEND16:
    325. 

  325. 		*numerator = 1;
    326. 

  326. 		*denominator = 1;
    327. 

  327. 		return 0;
    328. 

  328. 	case SOC_MBUS_PACKING_2X8_PADHI:
    329. 

  329. 	case SOC_MBUS_PACKING_2X8_PADLO:
    330. 

  330. 		*numerator = 2;
    331. 

  331. 		*denominator = 1;
    332. 

  332. 		return 0;
    333. 

  333. 	case SOC_MBUS_PACKING_1_5X8:
    334. 

  334. 		*numerator = 3;
    335. 

  335. 		*denominator = 2;
    336. 

  336. 		return 0;
    337. 

  337. 	case SOC_MBUS_PACKING_VARIABLE:
    338. 

  338. 		*numerator = 0;
    339. 

  339. 		*denominator = 1;
    340. 

  340. 		return 0;
    341. 

  341. 	}
    342. 

  342. 	return -EINVAL;
    343. 

  343. }
    344. 

  344. EXPORT_SYMBOL(soc_mbus_samples_per_pixel);
    345. 

  345. 

  346. s32 soc_mbus_bytes_per_line(u32 width, const struct soc_mbus_pixelfmt *mf)
    347. 

  347. {
    348. 

  348. 	switch (mf->packing) {
    349. 

  349. 	case SOC_MBUS_PACKING_NONE:
    350. 

  350. 		return width * mf->bits_per_sample / 8;
    351. 

  351. 	case SOC_MBUS_PACKING_2X8_PADHI:
    352. 

  352. 	case SOC_MBUS_PACKING_2X8_PADLO:
    353. 

  353. 	case SOC_MBUS_PACKING_EXTEND16:
    354. 

  354. 		return width * 2;
    355. 

  355. 	case SOC_MBUS_PACKING_1_5X8:
    356. 

  356. 		return width * 3 / 2;
    357. 

  357. 	case SOC_MBUS_PACKING_VARIABLE:
    358. 

  358. 		return 0;
    359. 

  359. 	}
    360. 

  360. 	return -EINVAL;
    361. 

  361. }
    362. 

  362. EXPORT_SYMBOL(soc_mbus_bytes_per_line);
    363. 

  363. 

  364. const struct soc_mbus_pixelfmt *soc_mbus_find_fmtdesc(
    365. 

  365. 	enum v4l2_mbus_pixelcode code,
    366. 

  366. 	const struct soc_mbus_lookup *lookup,
    367. 

  367. 	int n)
    368. 

  368. {
    369. 

  369. 	int i;
    370. 

  370. 

  371. 	for (i = 0; i < n; i++)
    372. 

  372. 		if (lookup[i].code == code)
    373. 

  373. 			return &lookup[i].fmt;
    374. 

  374. 

  375. 	return NULL;
    376. 

  376. }
    377. 

  377. EXPORT_SYMBOL(soc_mbus_find_fmtdesc);
    378. 

  378. 

  379. const struct soc_mbus_pixelfmt *soc_mbus_get_fmtdesc(
    380. 

  380. 	enum v4l2_mbus_pixelcode code)
    381. 

  381. {
    382. 

  382. 	return soc_mbus_find_fmtdesc(code, mbus_fmt, ARRAY_SIZE(mbus_fmt));
    383. 

  383. }
    384. 

  384. EXPORT_SYMBOL(soc_mbus_get_fmtdesc);
    385. 

  385. 

  386. static int __init soc_mbus_init(void)
    387. 

  387. {
    388. 

  388. 	return 0;
    389. 

  389. }
    390. 

  390. 

  391. static void __exit soc_mbus_exit(void)
    392. 

  392. {
    393. 

  393. }
    394. 

  394. 

  395. module_init(soc_mbus_init);
    396. 

  396. module_exit(soc_mbus_exit);
    397. 

  397. 

  398. MODULE_DESCRIPTION("soc-camera media bus interface");
    399. 

  399. MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>");
    400. 

  400. MODULE_LICENSE("GPL v2");
    401.