tvp7002.c 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098
  1. /* Texas Instruments Triple 8-/10-BIT 165-/110-MSPS Video and Graphics
  2. * Digitizer with Horizontal PLL registers
  3. *
  4. * Copyright (C) 2009 Texas Instruments Inc
  5. * Author: Santiago Nunez-Corrales <santiago.nunez@ridgerun.com>
  6. *
  7. * This code is partially based upon the TVP5150 driver
  8. * written by Mauro Carvalho Chehab (mchehab@infradead.org),
  9. * the TVP514x driver written by Vaibhav Hiremath <hvaibhav@ti.com>
  10. * and the TVP7002 driver in the TI LSP 2.10.00.14. Revisions by
  11. * Muralidharan Karicheri and Snehaprabha Narnakaje (TI).
  12. *
  13. * This program is free software; you can redistribute it and/or modify
  14. * it under the terms of the GNU General Public License as published by
  15. * the Free Software Foundation; either version 2 of the License, or
  16. * (at your option) any later version.
  17. *
  18. * This program is distributed in the hope that it will be useful,
  19. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  21. * GNU General Public License for more details.
  22. *
  23. * You should have received a copy of the GNU General Public License
  24. * along with this program; if not, write to the Free Software
  25. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  26. */
  27. #include <linux/delay.h>
  28. #include <linux/i2c.h>
  29. #include <linux/slab.h>
  30. #include <linux/videodev2.h>
  31. #include <linux/module.h>
  32. #include <linux/v4l2-dv-timings.h>
  33. #include <media/tvp7002.h>
  34. #include <media/v4l2-async.h>
  35. #include <media/v4l2-device.h>
  36. #include <media/v4l2-common.h>
  37. #include <media/v4l2-ctrls.h>
  38. #include "tvp7002_reg.h"
  39. MODULE_DESCRIPTION("TI TVP7002 Video and Graphics Digitizer driver");
  40. MODULE_AUTHOR("Santiago Nunez-Corrales <santiago.nunez@ridgerun.com>");
  41. MODULE_LICENSE("GPL");
  42. /* I2C retry attempts */
  43. #define I2C_RETRY_COUNT (5)
  44. /* End of registers */
  45. #define TVP7002_EOR 0x5c
  46. /* Read write definition for registers */
  47. #define TVP7002_READ 0
  48. #define TVP7002_WRITE 1
  49. #define TVP7002_RESERVED 2
  50. /* Interlaced vs progressive mask and shift */
  51. #define TVP7002_IP_SHIFT 5
  52. #define TVP7002_INPR_MASK (0x01 << TVP7002_IP_SHIFT)
  53. /* Shift for CPL and LPF registers */
  54. #define TVP7002_CL_SHIFT 8
  55. #define TVP7002_CL_MASK 0x0f
  56. /* Debug functions */
  57. static bool debug;
  58. module_param(debug, bool, 0644);
  59. MODULE_PARM_DESC(debug, "Debug level (0-2)");
  60. /* Structure for register values */
  61. struct i2c_reg_value {
  62. u8 reg;
  63. u8 value;
  64. u8 type;
  65. };
  66. /*
  67. * Register default values (according to tvp7002 datasheet)
  68. * In the case of read-only registers, the value (0xff) is
  69. * never written. R/W functionality is controlled by the
  70. * writable bit in the register struct definition.
  71. */
  72. static const struct i2c_reg_value tvp7002_init_default[] = {
  73. { TVP7002_CHIP_REV, 0xff, TVP7002_READ },
  74. { TVP7002_HPLL_FDBK_DIV_MSBS, 0x67, TVP7002_WRITE },
  75. { TVP7002_HPLL_FDBK_DIV_LSBS, 0x20, TVP7002_WRITE },
  76. { TVP7002_HPLL_CRTL, 0xa0, TVP7002_WRITE },
  77. { TVP7002_HPLL_PHASE_SEL, 0x80, TVP7002_WRITE },
  78. { TVP7002_CLAMP_START, 0x32, TVP7002_WRITE },
  79. { TVP7002_CLAMP_W, 0x20, TVP7002_WRITE },
  80. { TVP7002_HSYNC_OUT_W, 0x60, TVP7002_WRITE },
  81. { TVP7002_B_FINE_GAIN, 0x00, TVP7002_WRITE },
  82. { TVP7002_G_FINE_GAIN, 0x00, TVP7002_WRITE },
  83. { TVP7002_R_FINE_GAIN, 0x00, TVP7002_WRITE },
  84. { TVP7002_B_FINE_OFF_MSBS, 0x80, TVP7002_WRITE },
  85. { TVP7002_G_FINE_OFF_MSBS, 0x80, TVP7002_WRITE },
  86. { TVP7002_R_FINE_OFF_MSBS, 0x80, TVP7002_WRITE },
  87. { TVP7002_SYNC_CTL_1, 0x20, TVP7002_WRITE },
  88. { TVP7002_HPLL_AND_CLAMP_CTL, 0x2e, TVP7002_WRITE },
  89. { TVP7002_SYNC_ON_G_THRS, 0x5d, TVP7002_WRITE },
  90. { TVP7002_SYNC_SEPARATOR_THRS, 0x47, TVP7002_WRITE },
  91. { TVP7002_HPLL_PRE_COAST, 0x00, TVP7002_WRITE },
  92. { TVP7002_HPLL_POST_COAST, 0x00, TVP7002_WRITE },
  93. { TVP7002_SYNC_DETECT_STAT, 0xff, TVP7002_READ },
  94. { TVP7002_OUT_FORMATTER, 0x47, TVP7002_WRITE },
  95. { TVP7002_MISC_CTL_1, 0x01, TVP7002_WRITE },
  96. { TVP7002_MISC_CTL_2, 0x00, TVP7002_WRITE },
  97. { TVP7002_MISC_CTL_3, 0x01, TVP7002_WRITE },
  98. { TVP7002_IN_MUX_SEL_1, 0x00, TVP7002_WRITE },
  99. { TVP7002_IN_MUX_SEL_2, 0x67, TVP7002_WRITE },
  100. { TVP7002_B_AND_G_COARSE_GAIN, 0x77, TVP7002_WRITE },
  101. { TVP7002_R_COARSE_GAIN, 0x07, TVP7002_WRITE },
  102. { TVP7002_FINE_OFF_LSBS, 0x00, TVP7002_WRITE },
  103. { TVP7002_B_COARSE_OFF, 0x10, TVP7002_WRITE },
  104. { TVP7002_G_COARSE_OFF, 0x10, TVP7002_WRITE },
  105. { TVP7002_R_COARSE_OFF, 0x10, TVP7002_WRITE },
  106. { TVP7002_HSOUT_OUT_START, 0x08, TVP7002_WRITE },
  107. { TVP7002_MISC_CTL_4, 0x00, TVP7002_WRITE },
  108. { TVP7002_B_DGTL_ALC_OUT_LSBS, 0xff, TVP7002_READ },
  109. { TVP7002_G_DGTL_ALC_OUT_LSBS, 0xff, TVP7002_READ },
  110. { TVP7002_R_DGTL_ALC_OUT_LSBS, 0xff, TVP7002_READ },
  111. { TVP7002_AUTO_LVL_CTL_ENABLE, 0x80, TVP7002_WRITE },
  112. { TVP7002_DGTL_ALC_OUT_MSBS, 0xff, TVP7002_READ },
  113. { TVP7002_AUTO_LVL_CTL_FILTER, 0x53, TVP7002_WRITE },
  114. { 0x29, 0x08, TVP7002_RESERVED },
  115. { TVP7002_FINE_CLAMP_CTL, 0x07, TVP7002_WRITE },
  116. /* PWR_CTL is controlled only by the probe and reset functions */
  117. { TVP7002_PWR_CTL, 0x00, TVP7002_RESERVED },
  118. { TVP7002_ADC_SETUP, 0x50, TVP7002_WRITE },
  119. { TVP7002_COARSE_CLAMP_CTL, 0x00, TVP7002_WRITE },
  120. { TVP7002_SOG_CLAMP, 0x80, TVP7002_WRITE },
  121. { TVP7002_RGB_COARSE_CLAMP_CTL, 0x8c, TVP7002_WRITE },
  122. { TVP7002_SOG_COARSE_CLAMP_CTL, 0x04, TVP7002_WRITE },
  123. { TVP7002_ALC_PLACEMENT, 0x5a, TVP7002_WRITE },
  124. { 0x32, 0x18, TVP7002_RESERVED },
  125. { 0x33, 0x60, TVP7002_RESERVED },
  126. { TVP7002_MVIS_STRIPPER_W, 0xff, TVP7002_RESERVED },
  127. { TVP7002_VSYNC_ALGN, 0x10, TVP7002_WRITE },
  128. { TVP7002_SYNC_BYPASS, 0x00, TVP7002_WRITE },
  129. { TVP7002_L_FRAME_STAT_LSBS, 0xff, TVP7002_READ },
  130. { TVP7002_L_FRAME_STAT_MSBS, 0xff, TVP7002_READ },
  131. { TVP7002_CLK_L_STAT_LSBS, 0xff, TVP7002_READ },
  132. { TVP7002_CLK_L_STAT_MSBS, 0xff, TVP7002_READ },
  133. { TVP7002_HSYNC_W, 0xff, TVP7002_READ },
  134. { TVP7002_VSYNC_W, 0xff, TVP7002_READ },
  135. { TVP7002_L_LENGTH_TOL, 0x03, TVP7002_WRITE },
  136. { 0x3e, 0x60, TVP7002_RESERVED },
  137. { TVP7002_VIDEO_BWTH_CTL, 0x01, TVP7002_WRITE },
  138. { TVP7002_AVID_START_PIXEL_LSBS, 0x01, TVP7002_WRITE },
  139. { TVP7002_AVID_START_PIXEL_MSBS, 0x2c, TVP7002_WRITE },
  140. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x06, TVP7002_WRITE },
  141. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x2c, TVP7002_WRITE },
  142. { TVP7002_VBLK_F_0_START_L_OFF, 0x05, TVP7002_WRITE },
  143. { TVP7002_VBLK_F_1_START_L_OFF, 0x00, TVP7002_WRITE },
  144. { TVP7002_VBLK_F_0_DURATION, 0x1e, TVP7002_WRITE },
  145. { TVP7002_VBLK_F_1_DURATION, 0x00, TVP7002_WRITE },
  146. { TVP7002_FBIT_F_0_START_L_OFF, 0x00, TVP7002_WRITE },
  147. { TVP7002_FBIT_F_1_START_L_OFF, 0x00, TVP7002_WRITE },
  148. { TVP7002_YUV_Y_G_COEF_LSBS, 0xe3, TVP7002_WRITE },
  149. { TVP7002_YUV_Y_G_COEF_MSBS, 0x16, TVP7002_WRITE },
  150. { TVP7002_YUV_Y_B_COEF_LSBS, 0x4f, TVP7002_WRITE },
  151. { TVP7002_YUV_Y_B_COEF_MSBS, 0x02, TVP7002_WRITE },
  152. { TVP7002_YUV_Y_R_COEF_LSBS, 0xce, TVP7002_WRITE },
  153. { TVP7002_YUV_Y_R_COEF_MSBS, 0x06, TVP7002_WRITE },
  154. { TVP7002_YUV_U_G_COEF_LSBS, 0xab, TVP7002_WRITE },
  155. { TVP7002_YUV_U_G_COEF_MSBS, 0xf3, TVP7002_WRITE },
  156. { TVP7002_YUV_U_B_COEF_LSBS, 0x00, TVP7002_WRITE },
  157. { TVP7002_YUV_U_B_COEF_MSBS, 0x10, TVP7002_WRITE },
  158. { TVP7002_YUV_U_R_COEF_LSBS, 0x55, TVP7002_WRITE },
  159. { TVP7002_YUV_U_R_COEF_MSBS, 0xfc, TVP7002_WRITE },
  160. { TVP7002_YUV_V_G_COEF_LSBS, 0x78, TVP7002_WRITE },
  161. { TVP7002_YUV_V_G_COEF_MSBS, 0xf1, TVP7002_WRITE },
  162. { TVP7002_YUV_V_B_COEF_LSBS, 0x88, TVP7002_WRITE },
  163. { TVP7002_YUV_V_B_COEF_MSBS, 0xfe, TVP7002_WRITE },
  164. { TVP7002_YUV_V_R_COEF_LSBS, 0x00, TVP7002_WRITE },
  165. { TVP7002_YUV_V_R_COEF_MSBS, 0x10, TVP7002_WRITE },
  166. /* This signals end of register values */
  167. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  168. };
  169. /* Register parameters for 480P */
  170. static const struct i2c_reg_value tvp7002_parms_480P[] = {
  171. { TVP7002_HPLL_FDBK_DIV_MSBS, 0x35, TVP7002_WRITE },
  172. { TVP7002_HPLL_FDBK_DIV_LSBS, 0xa0, TVP7002_WRITE },
  173. { TVP7002_HPLL_CRTL, 0x02, TVP7002_WRITE },
  174. { TVP7002_AVID_START_PIXEL_LSBS, 0x91, TVP7002_WRITE },
  175. { TVP7002_AVID_START_PIXEL_MSBS, 0x00, TVP7002_WRITE },
  176. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x0B, TVP7002_WRITE },
  177. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x00, TVP7002_WRITE },
  178. { TVP7002_VBLK_F_0_START_L_OFF, 0x03, TVP7002_WRITE },
  179. { TVP7002_VBLK_F_1_START_L_OFF, 0x01, TVP7002_WRITE },
  180. { TVP7002_VBLK_F_0_DURATION, 0x13, TVP7002_WRITE },
  181. { TVP7002_VBLK_F_1_DURATION, 0x13, TVP7002_WRITE },
  182. { TVP7002_ALC_PLACEMENT, 0x18, TVP7002_WRITE },
  183. { TVP7002_CLAMP_START, 0x06, TVP7002_WRITE },
  184. { TVP7002_CLAMP_W, 0x10, TVP7002_WRITE },
  185. { TVP7002_HPLL_PRE_COAST, 0x03, TVP7002_WRITE },
  186. { TVP7002_HPLL_POST_COAST, 0x03, TVP7002_WRITE },
  187. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  188. };
  189. /* Register parameters for 576P */
  190. static const struct i2c_reg_value tvp7002_parms_576P[] = {
  191. { TVP7002_HPLL_FDBK_DIV_MSBS, 0x36, TVP7002_WRITE },
  192. { TVP7002_HPLL_FDBK_DIV_LSBS, 0x00, TVP7002_WRITE },
  193. { TVP7002_HPLL_CRTL, 0x18, TVP7002_WRITE },
  194. { TVP7002_AVID_START_PIXEL_LSBS, 0x9B, TVP7002_WRITE },
  195. { TVP7002_AVID_START_PIXEL_MSBS, 0x00, TVP7002_WRITE },
  196. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x0F, TVP7002_WRITE },
  197. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x00, TVP7002_WRITE },
  198. { TVP7002_VBLK_F_0_START_L_OFF, 0x00, TVP7002_WRITE },
  199. { TVP7002_VBLK_F_1_START_L_OFF, 0x00, TVP7002_WRITE },
  200. { TVP7002_VBLK_F_0_DURATION, 0x2D, TVP7002_WRITE },
  201. { TVP7002_VBLK_F_1_DURATION, 0x00, TVP7002_WRITE },
  202. { TVP7002_ALC_PLACEMENT, 0x18, TVP7002_WRITE },
  203. { TVP7002_CLAMP_START, 0x06, TVP7002_WRITE },
  204. { TVP7002_CLAMP_W, 0x10, TVP7002_WRITE },
  205. { TVP7002_HPLL_PRE_COAST, 0x03, TVP7002_WRITE },
  206. { TVP7002_HPLL_POST_COAST, 0x03, TVP7002_WRITE },
  207. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  208. };
  209. /* Register parameters for 1080I60 */
  210. static const struct i2c_reg_value tvp7002_parms_1080I60[] = {
  211. { TVP7002_HPLL_FDBK_DIV_MSBS, 0x89, TVP7002_WRITE },
  212. { TVP7002_HPLL_FDBK_DIV_LSBS, 0x80, TVP7002_WRITE },
  213. { TVP7002_HPLL_CRTL, 0x98, TVP7002_WRITE },
  214. { TVP7002_AVID_START_PIXEL_LSBS, 0x06, TVP7002_WRITE },
  215. { TVP7002_AVID_START_PIXEL_MSBS, 0x01, TVP7002_WRITE },
  216. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x8a, TVP7002_WRITE },
  217. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x08, TVP7002_WRITE },
  218. { TVP7002_VBLK_F_0_START_L_OFF, 0x02, TVP7002_WRITE },
  219. { TVP7002_VBLK_F_1_START_L_OFF, 0x02, TVP7002_WRITE },
  220. { TVP7002_VBLK_F_0_DURATION, 0x16, TVP7002_WRITE },
  221. { TVP7002_VBLK_F_1_DURATION, 0x17, TVP7002_WRITE },
  222. { TVP7002_ALC_PLACEMENT, 0x5a, TVP7002_WRITE },
  223. { TVP7002_CLAMP_START, 0x32, TVP7002_WRITE },
  224. { TVP7002_CLAMP_W, 0x20, TVP7002_WRITE },
  225. { TVP7002_HPLL_PRE_COAST, 0x01, TVP7002_WRITE },
  226. { TVP7002_HPLL_POST_COAST, 0x00, TVP7002_WRITE },
  227. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  228. };
  229. /* Register parameters for 1080P60 */
  230. static const struct i2c_reg_value tvp7002_parms_1080P60[] = {
  231. { TVP7002_HPLL_FDBK_DIV_MSBS, 0x89, TVP7002_WRITE },
  232. { TVP7002_HPLL_FDBK_DIV_LSBS, 0x80, TVP7002_WRITE },
  233. { TVP7002_HPLL_CRTL, 0xE0, TVP7002_WRITE },
  234. { TVP7002_AVID_START_PIXEL_LSBS, 0x06, TVP7002_WRITE },
  235. { TVP7002_AVID_START_PIXEL_MSBS, 0x01, TVP7002_WRITE },
  236. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x8a, TVP7002_WRITE },
  237. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x08, TVP7002_WRITE },
  238. { TVP7002_VBLK_F_0_START_L_OFF, 0x02, TVP7002_WRITE },
  239. { TVP7002_VBLK_F_1_START_L_OFF, 0x02, TVP7002_WRITE },
  240. { TVP7002_VBLK_F_0_DURATION, 0x16, TVP7002_WRITE },
  241. { TVP7002_VBLK_F_1_DURATION, 0x17, TVP7002_WRITE },
  242. { TVP7002_ALC_PLACEMENT, 0x5a, TVP7002_WRITE },
  243. { TVP7002_CLAMP_START, 0x32, TVP7002_WRITE },
  244. { TVP7002_CLAMP_W, 0x20, TVP7002_WRITE },
  245. { TVP7002_HPLL_PRE_COAST, 0x01, TVP7002_WRITE },
  246. { TVP7002_HPLL_POST_COAST, 0x00, TVP7002_WRITE },
  247. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  248. };
  249. /* Register parameters for 1080I50 */
  250. static const struct i2c_reg_value tvp7002_parms_1080I50[] = {
  251. { TVP7002_HPLL_FDBK_DIV_MSBS, 0xa5, TVP7002_WRITE },
  252. { TVP7002_HPLL_FDBK_DIV_LSBS, 0x00, TVP7002_WRITE },
  253. { TVP7002_HPLL_CRTL, 0x98, TVP7002_WRITE },
  254. { TVP7002_AVID_START_PIXEL_LSBS, 0x06, TVP7002_WRITE },
  255. { TVP7002_AVID_START_PIXEL_MSBS, 0x01, TVP7002_WRITE },
  256. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x8a, TVP7002_WRITE },
  257. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x08, TVP7002_WRITE },
  258. { TVP7002_VBLK_F_0_START_L_OFF, 0x02, TVP7002_WRITE },
  259. { TVP7002_VBLK_F_1_START_L_OFF, 0x02, TVP7002_WRITE },
  260. { TVP7002_VBLK_F_0_DURATION, 0x16, TVP7002_WRITE },
  261. { TVP7002_VBLK_F_1_DURATION, 0x17, TVP7002_WRITE },
  262. { TVP7002_ALC_PLACEMENT, 0x5a, TVP7002_WRITE },
  263. { TVP7002_CLAMP_START, 0x32, TVP7002_WRITE },
  264. { TVP7002_CLAMP_W, 0x20, TVP7002_WRITE },
  265. { TVP7002_HPLL_PRE_COAST, 0x01, TVP7002_WRITE },
  266. { TVP7002_HPLL_POST_COAST, 0x00, TVP7002_WRITE },
  267. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  268. };
  269. /* Register parameters for 720P60 */
  270. static const struct i2c_reg_value tvp7002_parms_720P60[] = {
  271. { TVP7002_HPLL_FDBK_DIV_MSBS, 0x67, TVP7002_WRITE },
  272. { TVP7002_HPLL_FDBK_DIV_LSBS, 0x20, TVP7002_WRITE },
  273. { TVP7002_HPLL_CRTL, 0xa0, TVP7002_WRITE },
  274. { TVP7002_AVID_START_PIXEL_LSBS, 0x47, TVP7002_WRITE },
  275. { TVP7002_AVID_START_PIXEL_MSBS, 0x01, TVP7002_WRITE },
  276. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x4B, TVP7002_WRITE },
  277. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x06, TVP7002_WRITE },
  278. { TVP7002_VBLK_F_0_START_L_OFF, 0x05, TVP7002_WRITE },
  279. { TVP7002_VBLK_F_1_START_L_OFF, 0x00, TVP7002_WRITE },
  280. { TVP7002_VBLK_F_0_DURATION, 0x2D, TVP7002_WRITE },
  281. { TVP7002_VBLK_F_1_DURATION, 0x00, TVP7002_WRITE },
  282. { TVP7002_ALC_PLACEMENT, 0x5a, TVP7002_WRITE },
  283. { TVP7002_CLAMP_START, 0x32, TVP7002_WRITE },
  284. { TVP7002_CLAMP_W, 0x20, TVP7002_WRITE },
  285. { TVP7002_HPLL_PRE_COAST, 0x00, TVP7002_WRITE },
  286. { TVP7002_HPLL_POST_COAST, 0x00, TVP7002_WRITE },
  287. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  288. };
  289. /* Register parameters for 720P50 */
  290. static const struct i2c_reg_value tvp7002_parms_720P50[] = {
  291. { TVP7002_HPLL_FDBK_DIV_MSBS, 0x7b, TVP7002_WRITE },
  292. { TVP7002_HPLL_FDBK_DIV_LSBS, 0xc0, TVP7002_WRITE },
  293. { TVP7002_HPLL_CRTL, 0x98, TVP7002_WRITE },
  294. { TVP7002_AVID_START_PIXEL_LSBS, 0x47, TVP7002_WRITE },
  295. { TVP7002_AVID_START_PIXEL_MSBS, 0x01, TVP7002_WRITE },
  296. { TVP7002_AVID_STOP_PIXEL_LSBS, 0x4B, TVP7002_WRITE },
  297. { TVP7002_AVID_STOP_PIXEL_MSBS, 0x06, TVP7002_WRITE },
  298. { TVP7002_VBLK_F_0_START_L_OFF, 0x05, TVP7002_WRITE },
  299. { TVP7002_VBLK_F_1_START_L_OFF, 0x00, TVP7002_WRITE },
  300. { TVP7002_VBLK_F_0_DURATION, 0x2D, TVP7002_WRITE },
  301. { TVP7002_VBLK_F_1_DURATION, 0x00, TVP7002_WRITE },
  302. { TVP7002_ALC_PLACEMENT, 0x5a, TVP7002_WRITE },
  303. { TVP7002_CLAMP_START, 0x32, TVP7002_WRITE },
  304. { TVP7002_CLAMP_W, 0x20, TVP7002_WRITE },
  305. { TVP7002_HPLL_PRE_COAST, 0x01, TVP7002_WRITE },
  306. { TVP7002_HPLL_POST_COAST, 0x00, TVP7002_WRITE },
  307. { TVP7002_EOR, 0xff, TVP7002_RESERVED }
  308. };
  309. /* Timings definition for handling device operation */
  310. struct tvp7002_timings_definition {
  311. struct v4l2_dv_timings timings;
  312. const struct i2c_reg_value *p_settings;
  313. enum v4l2_colorspace color_space;
  314. enum v4l2_field scanmode;
  315. u16 progressive;
  316. u16 lines_per_frame;
  317. u16 cpl_min;
  318. u16 cpl_max;
  319. };
  320. /* Struct list for digital video timings */
  321. static const struct tvp7002_timings_definition tvp7002_timings[] = {
  322. {
  323. V4L2_DV_BT_CEA_1280X720P60,
  324. tvp7002_parms_720P60,
  325. V4L2_COLORSPACE_REC709,
  326. V4L2_FIELD_NONE,
  327. 1,
  328. 0x2EE,
  329. 135,
  330. 153
  331. },
  332. {
  333. V4L2_DV_BT_CEA_1920X1080I60,
  334. tvp7002_parms_1080I60,
  335. V4L2_COLORSPACE_REC709,
  336. V4L2_FIELD_INTERLACED,
  337. 0,
  338. 0x465,
  339. 181,
  340. 205
  341. },
  342. {
  343. V4L2_DV_BT_CEA_1920X1080I50,
  344. tvp7002_parms_1080I50,
  345. V4L2_COLORSPACE_REC709,
  346. V4L2_FIELD_INTERLACED,
  347. 0,
  348. 0x465,
  349. 217,
  350. 245
  351. },
  352. {
  353. V4L2_DV_BT_CEA_1280X720P50,
  354. tvp7002_parms_720P50,
  355. V4L2_COLORSPACE_REC709,
  356. V4L2_FIELD_NONE,
  357. 1,
  358. 0x2EE,
  359. 163,
  360. 183
  361. },
  362. {
  363. V4L2_DV_BT_CEA_1920X1080P60,
  364. tvp7002_parms_1080P60,
  365. V4L2_COLORSPACE_REC709,
  366. V4L2_FIELD_NONE,
  367. 1,
  368. 0x465,
  369. 90,
  370. 102
  371. },
  372. {
  373. V4L2_DV_BT_CEA_720X480P59_94,
  374. tvp7002_parms_480P,
  375. V4L2_COLORSPACE_SMPTE170M,
  376. V4L2_FIELD_NONE,
  377. 1,
  378. 0x20D,
  379. 0xffff,
  380. 0xffff
  381. },
  382. {
  383. V4L2_DV_BT_CEA_720X576P50,
  384. tvp7002_parms_576P,
  385. V4L2_COLORSPACE_SMPTE170M,
  386. V4L2_FIELD_NONE,
  387. 1,
  388. 0x271,
  389. 0xffff,
  390. 0xffff
  391. }
  392. };
  393. #define NUM_TIMINGS ARRAY_SIZE(tvp7002_timings)
  394. /* Device definition */
  395. struct tvp7002 {
  396. struct v4l2_subdev sd;
  397. struct v4l2_ctrl_handler hdl;
  398. const struct tvp7002_config *pdata;
  399. int ver;
  400. int streaming;
  401. const struct tvp7002_timings_definition *current_timings;
  402. struct media_pad pad;
  403. };
  404. /*
  405. * to_tvp7002 - Obtain device handler TVP7002
  406. * @sd: ptr to v4l2_subdev struct
  407. *
  408. * Returns device handler tvp7002.
  409. */
  410. static inline struct tvp7002 *to_tvp7002(struct v4l2_subdev *sd)
  411. {
  412. return container_of(sd, struct tvp7002, sd);
  413. }
  414. static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
  415. {
  416. return &container_of(ctrl->handler, struct tvp7002, hdl)->sd;
  417. }
  418. /*
  419. * tvp7002_read - Read a value from a register in an TVP7002
  420. * @sd: ptr to v4l2_subdev struct
  421. * @addr: TVP7002 register address
  422. * @dst: pointer to 8-bit destination
  423. *
  424. * Returns value read if successful, or non-zero (-1) otherwise.
  425. */
  426. static int tvp7002_read(struct v4l2_subdev *sd, u8 addr, u8 *dst)
  427. {
  428. struct i2c_client *c = v4l2_get_subdevdata(sd);
  429. int retry;
  430. int error;
  431. for (retry = 0; retry < I2C_RETRY_COUNT; retry++) {
  432. error = i2c_smbus_read_byte_data(c, addr);
  433. if (error >= 0) {
  434. *dst = (u8)error;
  435. return 0;
  436. }
  437. msleep_interruptible(10);
  438. }
  439. v4l2_err(sd, "TVP7002 read error %d\n", error);
  440. return error;
  441. }
  442. /*
  443. * tvp7002_read_err() - Read a register value with error code
  444. * @sd: pointer to standard V4L2 sub-device structure
  445. * @reg: destination register
  446. * @val: value to be read
  447. * @err: pointer to error value
  448. *
  449. * Read a value in a register and save error value in pointer.
  450. * Also update the register table if successful
  451. */
  452. static inline void tvp7002_read_err(struct v4l2_subdev *sd, u8 reg,
  453. u8 *dst, int *err)
  454. {
  455. if (!*err)
  456. *err = tvp7002_read(sd, reg, dst);
  457. }
  458. /*
  459. * tvp7002_write() - Write a value to a register in TVP7002
  460. * @sd: ptr to v4l2_subdev struct
  461. * @addr: TVP7002 register address
  462. * @value: value to be written to the register
  463. *
  464. * Write a value to a register in an TVP7002 decoder device.
  465. * Returns zero if successful, or non-zero otherwise.
  466. */
  467. static int tvp7002_write(struct v4l2_subdev *sd, u8 addr, u8 value)
  468. {
  469. struct i2c_client *c;
  470. int retry;
  471. int error;
  472. c = v4l2_get_subdevdata(sd);
  473. for (retry = 0; retry < I2C_RETRY_COUNT; retry++) {
  474. error = i2c_smbus_write_byte_data(c, addr, value);
  475. if (error >= 0)
  476. return 0;
  477. v4l2_warn(sd, "Write: retry ... %d\n", retry);
  478. msleep_interruptible(10);
  479. }
  480. v4l2_err(sd, "TVP7002 write error %d\n", error);
  481. return error;
  482. }
  483. /*
  484. * tvp7002_write_err() - Write a register value with error code
  485. * @sd: pointer to standard V4L2 sub-device structure
  486. * @reg: destination register
  487. * @val: value to be written
  488. * @err: pointer to error value
  489. *
  490. * Write a value in a register and save error value in pointer.
  491. * Also update the register table if successful
  492. */
  493. static inline void tvp7002_write_err(struct v4l2_subdev *sd, u8 reg,
  494. u8 val, int *err)
  495. {
  496. if (!*err)
  497. *err = tvp7002_write(sd, reg, val);
  498. }
  499. /*
  500. * tvp7002_write_inittab() - Write initialization values
  501. * @sd: ptr to v4l2_subdev struct
  502. * @regs: ptr to i2c_reg_value struct
  503. *
  504. * Write initialization values.
  505. * Returns zero or -EINVAL if read operation fails.
  506. */
  507. static int tvp7002_write_inittab(struct v4l2_subdev *sd,
  508. const struct i2c_reg_value *regs)
  509. {
  510. int error = 0;
  511. /* Initialize the first (defined) registers */
  512. while (TVP7002_EOR != regs->reg) {
  513. if (TVP7002_WRITE == regs->type)
  514. tvp7002_write_err(sd, regs->reg, regs->value, &error);
  515. regs++;
  516. }
  517. return error;
  518. }
  519. static int tvp7002_s_dv_timings(struct v4l2_subdev *sd,
  520. struct v4l2_dv_timings *dv_timings)
  521. {
  522. struct tvp7002 *device = to_tvp7002(sd);
  523. const struct v4l2_bt_timings *bt = &dv_timings->bt;
  524. int i;
  525. if (dv_timings->type != V4L2_DV_BT_656_1120)
  526. return -EINVAL;
  527. for (i = 0; i < NUM_TIMINGS; i++) {
  528. const struct v4l2_bt_timings *t = &tvp7002_timings[i].timings.bt;
  529. if (!memcmp(bt, t, &bt->standards - &bt->width)) {
  530. device->current_timings = &tvp7002_timings[i];
  531. return tvp7002_write_inittab(sd, tvp7002_timings[i].p_settings);
  532. }
  533. }
  534. return -EINVAL;
  535. }
  536. static int tvp7002_g_dv_timings(struct v4l2_subdev *sd,
  537. struct v4l2_dv_timings *dv_timings)
  538. {
  539. struct tvp7002 *device = to_tvp7002(sd);
  540. *dv_timings = device->current_timings->timings;
  541. return 0;
  542. }
  543. /*
  544. * tvp7002_s_ctrl() - Set a control
  545. * @ctrl: ptr to v4l2_ctrl struct
  546. *
  547. * Set a control in TVP7002 decoder device.
  548. * Returns zero when successful or -EINVAL if register access fails.
  549. */
  550. static int tvp7002_s_ctrl(struct v4l2_ctrl *ctrl)
  551. {
  552. struct v4l2_subdev *sd = to_sd(ctrl);
  553. int error = 0;
  554. switch (ctrl->id) {
  555. case V4L2_CID_GAIN:
  556. tvp7002_write_err(sd, TVP7002_R_FINE_GAIN, ctrl->val, &error);
  557. tvp7002_write_err(sd, TVP7002_G_FINE_GAIN, ctrl->val, &error);
  558. tvp7002_write_err(sd, TVP7002_B_FINE_GAIN, ctrl->val, &error);
  559. return error;
  560. }
  561. return -EINVAL;
  562. }
  563. /*
  564. * tvp7002_mbus_fmt() - V4L2 decoder interface handler for try/s/g_mbus_fmt
  565. * @sd: pointer to standard V4L2 sub-device structure
  566. * @f: pointer to mediabus format structure
  567. *
  568. * Negotiate the image capture size and mediabus format.
  569. * There is only one possible format, so this single function works for
  570. * get, set and try.
  571. */
  572. static int tvp7002_mbus_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *f)
  573. {
  574. struct tvp7002 *device = to_tvp7002(sd);
  575. const struct v4l2_bt_timings *bt = &device->current_timings->timings.bt;
  576. f->width = bt->width;
  577. f->height = bt->height;
  578. f->code = V4L2_MBUS_FMT_YUYV10_1X20;
  579. f->field = device->current_timings->scanmode;
  580. f->colorspace = device->current_timings->color_space;
  581. v4l2_dbg(1, debug, sd, "MBUS_FMT: Width - %d, Height - %d",
  582. f->width, f->height);
  583. return 0;
  584. }
  585. /*
  586. * tvp7002_query_dv() - query DV timings
  587. * @sd: pointer to standard V4L2 sub-device structure
  588. * @index: index into the tvp7002_timings array
  589. *
  590. * Returns the current DV timings detected by TVP7002. If no active input is
  591. * detected, returns -EINVAL
  592. */
  593. static int tvp7002_query_dv(struct v4l2_subdev *sd, int *index)
  594. {
  595. const struct tvp7002_timings_definition *timings = tvp7002_timings;
  596. u8 progressive;
  597. u32 lpfr;
  598. u32 cpln;
  599. int error = 0;
  600. u8 lpf_lsb;
  601. u8 lpf_msb;
  602. u8 cpl_lsb;
  603. u8 cpl_msb;
  604. /* Return invalid index if no active input is detected */
  605. *index = NUM_TIMINGS;
  606. /* Read standards from device registers */
  607. tvp7002_read_err(sd, TVP7002_L_FRAME_STAT_LSBS, &lpf_lsb, &error);
  608. tvp7002_read_err(sd, TVP7002_L_FRAME_STAT_MSBS, &lpf_msb, &error);
  609. if (error < 0)
  610. return error;
  611. tvp7002_read_err(sd, TVP7002_CLK_L_STAT_LSBS, &cpl_lsb, &error);
  612. tvp7002_read_err(sd, TVP7002_CLK_L_STAT_MSBS, &cpl_msb, &error);
  613. if (error < 0)
  614. return error;
  615. /* Get lines per frame, clocks per line and interlaced/progresive */
  616. lpfr = lpf_lsb | ((TVP7002_CL_MASK & lpf_msb) << TVP7002_CL_SHIFT);
  617. cpln = cpl_lsb | ((TVP7002_CL_MASK & cpl_msb) << TVP7002_CL_SHIFT);
  618. progressive = (lpf_msb & TVP7002_INPR_MASK) >> TVP7002_IP_SHIFT;
  619. /* Do checking of video modes */
  620. for (*index = 0; *index < NUM_TIMINGS; (*index)++, timings++)
  621. if (lpfr == timings->lines_per_frame &&
  622. progressive == timings->progressive) {
  623. if (timings->cpl_min == 0xffff)
  624. break;
  625. if (cpln >= timings->cpl_min && cpln <= timings->cpl_max)
  626. break;
  627. }
  628. if (*index == NUM_TIMINGS) {
  629. v4l2_dbg(1, debug, sd, "detection failed: lpf = %x, cpl = %x\n",
  630. lpfr, cpln);
  631. return -ENOLINK;
  632. }
  633. /* Update lines per frame and clocks per line info */
  634. v4l2_dbg(1, debug, sd, "detected timings: %d\n", *index);
  635. return 0;
  636. }
  637. static int tvp7002_query_dv_timings(struct v4l2_subdev *sd,
  638. struct v4l2_dv_timings *timings)
  639. {
  640. int index;
  641. int err = tvp7002_query_dv(sd, &index);
  642. if (err)
  643. return err;
  644. *timings = tvp7002_timings[index].timings;
  645. return 0;
  646. }
  647. #ifdef CONFIG_VIDEO_ADV_DEBUG
  648. /*
  649. * tvp7002_g_register() - Get the value of a register
  650. * @sd: ptr to v4l2_subdev struct
  651. * @reg: ptr to v4l2_dbg_register struct
  652. *
  653. * Get the value of a TVP7002 decoder device register.
  654. * Returns zero when successful, -EINVAL if register read fails or
  655. * access to I2C client fails.
  656. */
  657. static int tvp7002_g_register(struct v4l2_subdev *sd,
  658. struct v4l2_dbg_register *reg)
  659. {
  660. u8 val;
  661. int ret;
  662. ret = tvp7002_read(sd, reg->reg & 0xff, &val);
  663. reg->val = val;
  664. reg->size = 1;
  665. return ret;
  666. }
  667. /*
  668. * tvp7002_s_register() - set a control
  669. * @sd: ptr to v4l2_subdev struct
  670. * @reg: ptr to v4l2_dbg_register struct
  671. *
  672. * Get the value of a TVP7002 decoder device register.
  673. * Returns zero when successful, -EINVAL if register read fails.
  674. */
  675. static int tvp7002_s_register(struct v4l2_subdev *sd,
  676. const struct v4l2_dbg_register *reg)
  677. {
  678. return tvp7002_write(sd, reg->reg & 0xff, reg->val & 0xff);
  679. }
  680. #endif
  681. /*
  682. * tvp7002_enum_mbus_fmt() - Enum supported mediabus formats
  683. * @sd: pointer to standard V4L2 sub-device structure
  684. * @index: format index
  685. * @code: pointer to mediabus format
  686. *
  687. * Enumerate supported mediabus formats.
  688. */
  689. static int tvp7002_enum_mbus_fmt(struct v4l2_subdev *sd, unsigned index,
  690. enum v4l2_mbus_pixelcode *code)
  691. {
  692. /* Check requested format index is within range */
  693. if (index)
  694. return -EINVAL;
  695. *code = V4L2_MBUS_FMT_YUYV10_1X20;
  696. return 0;
  697. }
  698. /*
  699. * tvp7002_s_stream() - V4L2 decoder i/f handler for s_stream
  700. * @sd: pointer to standard V4L2 sub-device structure
  701. * @enable: streaming enable or disable
  702. *
  703. * Sets streaming to enable or disable, if possible.
  704. */
  705. static int tvp7002_s_stream(struct v4l2_subdev *sd, int enable)
  706. {
  707. struct tvp7002 *device = to_tvp7002(sd);
  708. int error = 0;
  709. if (device->streaming == enable)
  710. return 0;
  711. if (enable) {
  712. /* Set output state on (low impedance means stream on) */
  713. error = tvp7002_write(sd, TVP7002_MISC_CTL_2, 0x00);
  714. device->streaming = enable;
  715. } else {
  716. /* Set output state off (high impedance means stream off) */
  717. error = tvp7002_write(sd, TVP7002_MISC_CTL_2, 0x03);
  718. if (error)
  719. v4l2_dbg(1, debug, sd, "Unable to stop streaming\n");
  720. device->streaming = enable;
  721. }
  722. return error;
  723. }
  724. /*
  725. * tvp7002_log_status() - Print information about register settings
  726. * @sd: ptr to v4l2_subdev struct
  727. *
  728. * Log register values of a TVP7002 decoder device.
  729. * Returns zero or -EINVAL if read operation fails.
  730. */
  731. static int tvp7002_log_status(struct v4l2_subdev *sd)
  732. {
  733. struct tvp7002 *device = to_tvp7002(sd);
  734. const struct v4l2_bt_timings *bt;
  735. int detected;
  736. /* Find my current timings */
  737. tvp7002_query_dv(sd, &detected);
  738. bt = &device->current_timings->timings.bt;
  739. v4l2_info(sd, "Selected DV Timings: %ux%u\n", bt->width, bt->height);
  740. if (detected == NUM_TIMINGS) {
  741. v4l2_info(sd, "Detected DV Timings: None\n");
  742. } else {
  743. bt = &tvp7002_timings[detected].timings.bt;
  744. v4l2_info(sd, "Detected DV Timings: %ux%u\n",
  745. bt->width, bt->height);
  746. }
  747. v4l2_info(sd, "Streaming enabled: %s\n",
  748. device->streaming ? "yes" : "no");
  749. /* Print the current value of the gain control */
  750. v4l2_ctrl_handler_log_status(&device->hdl, sd->name);
  751. return 0;
  752. }
  753. static int tvp7002_enum_dv_timings(struct v4l2_subdev *sd,
  754. struct v4l2_enum_dv_timings *timings)
  755. {
  756. /* Check requested format index is within range */
  757. if (timings->index >= NUM_TIMINGS)
  758. return -EINVAL;
  759. timings->timings = tvp7002_timings[timings->index].timings;
  760. return 0;
  761. }
  762. static const struct v4l2_ctrl_ops tvp7002_ctrl_ops = {
  763. .s_ctrl = tvp7002_s_ctrl,
  764. };
  765. /*
  766. * tvp7002_enum_mbus_code() - Enum supported digital video format on pad
  767. * @sd: pointer to standard V4L2 sub-device structure
  768. * @fh: file handle for the subdev
  769. * @code: pointer to subdev enum mbus code struct
  770. *
  771. * Enumerate supported digital video formats for pad.
  772. */
  773. static int
  774. tvp7002_enum_mbus_code(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh,
  775. struct v4l2_subdev_mbus_code_enum *code)
  776. {
  777. /* Check requested format index is within range */
  778. if (code->index != 0)
  779. return -EINVAL;
  780. code->code = V4L2_MBUS_FMT_YUYV10_1X20;
  781. return 0;
  782. }
  783. /*
  784. * tvp7002_get_pad_format() - get video format on pad
  785. * @sd: pointer to standard V4L2 sub-device structure
  786. * @fh: file handle for the subdev
  787. * @fmt: pointer to subdev format struct
  788. *
  789. * get video format for pad.
  790. */
  791. static int
  792. tvp7002_get_pad_format(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh,
  793. struct v4l2_subdev_format *fmt)
  794. {
  795. struct tvp7002 *tvp7002 = to_tvp7002(sd);
  796. fmt->format.code = V4L2_MBUS_FMT_YUYV10_1X20;
  797. fmt->format.width = tvp7002->current_timings->timings.bt.width;
  798. fmt->format.height = tvp7002->current_timings->timings.bt.height;
  799. fmt->format.field = tvp7002->current_timings->scanmode;
  800. fmt->format.colorspace = tvp7002->current_timings->color_space;
  801. return 0;
  802. }
  803. /*
  804. * tvp7002_set_pad_format() - set video format on pad
  805. * @sd: pointer to standard V4L2 sub-device structure
  806. * @fh: file handle for the subdev
  807. * @fmt: pointer to subdev format struct
  808. *
  809. * set video format for pad.
  810. */
  811. static int
  812. tvp7002_set_pad_format(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh,
  813. struct v4l2_subdev_format *fmt)
  814. {
  815. return tvp7002_get_pad_format(sd, fh, fmt);
  816. }
  817. /* V4L2 core operation handlers */
  818. static const struct v4l2_subdev_core_ops tvp7002_core_ops = {
  819. .log_status = tvp7002_log_status,
  820. .g_ext_ctrls = v4l2_subdev_g_ext_ctrls,
  821. .try_ext_ctrls = v4l2_subdev_try_ext_ctrls,
  822. .s_ext_ctrls = v4l2_subdev_s_ext_ctrls,
  823. .g_ctrl = v4l2_subdev_g_ctrl,
  824. .s_ctrl = v4l2_subdev_s_ctrl,
  825. .queryctrl = v4l2_subdev_queryctrl,
  826. .querymenu = v4l2_subdev_querymenu,
  827. #ifdef CONFIG_VIDEO_ADV_DEBUG
  828. .g_register = tvp7002_g_register,
  829. .s_register = tvp7002_s_register,
  830. #endif
  831. };
  832. /* Specific video subsystem operation handlers */
  833. static const struct v4l2_subdev_video_ops tvp7002_video_ops = {
  834. .g_dv_timings = tvp7002_g_dv_timings,
  835. .s_dv_timings = tvp7002_s_dv_timings,
  836. .enum_dv_timings = tvp7002_enum_dv_timings,
  837. .query_dv_timings = tvp7002_query_dv_timings,
  838. .s_stream = tvp7002_s_stream,
  839. .g_mbus_fmt = tvp7002_mbus_fmt,
  840. .try_mbus_fmt = tvp7002_mbus_fmt,
  841. .s_mbus_fmt = tvp7002_mbus_fmt,
  842. .enum_mbus_fmt = tvp7002_enum_mbus_fmt,
  843. };
  844. /* media pad related operation handlers */
  845. static const struct v4l2_subdev_pad_ops tvp7002_pad_ops = {
  846. .enum_mbus_code = tvp7002_enum_mbus_code,
  847. .get_fmt = tvp7002_get_pad_format,
  848. .set_fmt = tvp7002_set_pad_format,
  849. };
  850. /* V4L2 top level operation handlers */
  851. static const struct v4l2_subdev_ops tvp7002_ops = {
  852. .core = &tvp7002_core_ops,
  853. .video = &tvp7002_video_ops,
  854. .pad = &tvp7002_pad_ops,
  855. };
  856. /*
  857. * tvp7002_probe - Probe a TVP7002 device
  858. * @c: ptr to i2c_client struct
  859. * @id: ptr to i2c_device_id struct
  860. *
  861. * Initialize the TVP7002 device
  862. * Returns zero when successful, -EINVAL if register read fails or
  863. * -EIO if i2c access is not available.
  864. */
  865. static int tvp7002_probe(struct i2c_client *c, const struct i2c_device_id *id)
  866. {
  867. struct v4l2_subdev *sd;
  868. struct tvp7002 *device;
  869. struct v4l2_dv_timings timings;
  870. int polarity_a;
  871. int polarity_b;
  872. u8 revision;
  873. int error;
  874. /* Check if the adapter supports the needed features */
  875. if (!i2c_check_functionality(c->adapter,
  876. I2C_FUNC_SMBUS_READ_BYTE | I2C_FUNC_SMBUS_WRITE_BYTE_DATA))
  877. return -EIO;
  878. if (!c->dev.platform_data) {
  879. v4l_err(c, "No platform data!!\n");
  880. return -ENODEV;
  881. }
  882. device = devm_kzalloc(&c->dev, sizeof(struct tvp7002), GFP_KERNEL);
  883. if (!device)
  884. return -ENOMEM;
  885. sd = &device->sd;
  886. device->pdata = c->dev.platform_data;
  887. device->current_timings = tvp7002_timings;
  888. /* Tell v4l2 the device is ready */
  889. v4l2_i2c_subdev_init(sd, c, &tvp7002_ops);
  890. v4l_info(c, "tvp7002 found @ 0x%02x (%s)\n",
  891. c->addr, c->adapter->name);
  892. error = tvp7002_read(sd, TVP7002_CHIP_REV, &revision);
  893. if (error < 0)
  894. return error;
  895. /* Get revision number */
  896. v4l2_info(sd, "Rev. %02x detected.\n", revision);
  897. if (revision != 0x02)
  898. v4l2_info(sd, "Unknown revision detected.\n");
  899. /* Initializes TVP7002 to its default values */
  900. error = tvp7002_write_inittab(sd, tvp7002_init_default);
  901. if (error < 0)
  902. return error;
  903. /* Set polarity information after registers have been set */
  904. polarity_a = 0x20 | device->pdata->hs_polarity << 5
  905. | device->pdata->vs_polarity << 2;
  906. error = tvp7002_write(sd, TVP7002_SYNC_CTL_1, polarity_a);
  907. if (error < 0)
  908. return error;
  909. polarity_b = 0x01 | device->pdata->fid_polarity << 2
  910. | device->pdata->sog_polarity << 1
  911. | device->pdata->clk_polarity;
  912. error = tvp7002_write(sd, TVP7002_MISC_CTL_3, polarity_b);
  913. if (error < 0)
  914. return error;
  915. /* Set registers according to default video mode */
  916. timings = device->current_timings->timings;
  917. error = tvp7002_s_dv_timings(sd, &timings);
  918. #if defined(CONFIG_MEDIA_CONTROLLER)
  919. device->pad.flags = MEDIA_PAD_FL_SOURCE;
  920. device->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
  921. device->sd.entity.flags |= MEDIA_ENT_T_V4L2_SUBDEV_DECODER;
  922. error = media_entity_init(&device->sd.entity, 1, &device->pad, 0);
  923. if (error < 0)
  924. return error;
  925. #endif
  926. v4l2_ctrl_handler_init(&device->hdl, 1);
  927. v4l2_ctrl_new_std(&device->hdl, &tvp7002_ctrl_ops,
  928. V4L2_CID_GAIN, 0, 255, 1, 0);
  929. sd->ctrl_handler = &device->hdl;
  930. if (device->hdl.error) {
  931. error = device->hdl.error;
  932. goto error;
  933. }
  934. v4l2_ctrl_handler_setup(&device->hdl);
  935. error = v4l2_async_register_subdev(&device->sd);
  936. if (error)
  937. goto error;
  938. return 0;
  939. error:
  940. v4l2_ctrl_handler_free(&device->hdl);
  941. #if defined(CONFIG_MEDIA_CONTROLLER)
  942. media_entity_cleanup(&device->sd.entity);
  943. #endif
  944. return error;
  945. }
  946. /*
  947. * tvp7002_remove - Remove TVP7002 device support
  948. * @c: ptr to i2c_client struct
  949. *
  950. * Reset the TVP7002 device
  951. * Returns zero.
  952. */
  953. static int tvp7002_remove(struct i2c_client *c)
  954. {
  955. struct v4l2_subdev *sd = i2c_get_clientdata(c);
  956. struct tvp7002 *device = to_tvp7002(sd);
  957. v4l2_dbg(1, debug, sd, "Removing tvp7002 adapter"
  958. "on address 0x%x\n", c->addr);
  959. v4l2_async_unregister_subdev(&device->sd);
  960. #if defined(CONFIG_MEDIA_CONTROLLER)
  961. media_entity_cleanup(&device->sd.entity);
  962. #endif
  963. v4l2_device_unregister_subdev(sd);
  964. v4l2_ctrl_handler_free(&device->hdl);
  965. return 0;
  966. }
  967. /* I2C Device ID table */
  968. static const struct i2c_device_id tvp7002_id[] = {
  969. { "tvp7002", 0 },
  970. { }
  971. };
  972. MODULE_DEVICE_TABLE(i2c, tvp7002_id);
  973. /* I2C driver data */
  974. static struct i2c_driver tvp7002_driver = {
  975. .driver = {
  976. .owner = THIS_MODULE,
  977. .name = TVP7002_MODULE_NAME,
  978. },
  979. .probe = tvp7002_probe,
  980. .remove = tvp7002_remove,
  981. .id_table = tvp7002_id,
  982. };
  983. module_i2c_driver(tvp7002_driver);