tvp5150.c 34 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161
  1. /*
  2. * tvp5150 - Texas Instruments TVP5150A(M) video decoder driver
  3. *
  4. * Copyright (c) 2005 Mauro Carvalho Chehab (mchehab@brturbo.com.br)
  5. * This code is placed under the terms of the GNU General Public License
  6. */
  7. #include <linux/i2c.h>
  8. #include <linux/videodev.h>
  9. #include <linux/delay.h>
  10. #include <linux/video_decoder.h>
  11. #include <media/v4l2-common.h>
  12. #include "tvp5150_reg.h"
  13. MODULE_DESCRIPTION("Texas Instruments TVP5150A video decoder driver"); /* standard i2c insmod options */
  14. MODULE_AUTHOR("Mauro Carvalho Chehab");
  15. MODULE_LICENSE("GPL");
  16. static unsigned short normal_i2c[] = {
  17. 0xb8 >> 1,
  18. 0xba >> 1,
  19. I2C_CLIENT_END
  20. };
  21. I2C_CLIENT_INSMOD;
  22. static int debug = 0;
  23. module_param(debug, int, 0);
  24. MODULE_PARM_DESC(debug, "Debug level (0-1)");
  25. #define tvp5150_info(fmt, arg...) do { \
  26. printk(KERN_INFO "%s %d-%04x: " fmt, c->driver->name, \
  27. i2c_adapter_id(c->adapter), c->addr , ## arg); } while (0)
  28. #define tvp5150_dbg(num, fmt, arg...) \
  29. do { \
  30. if (debug >= num) \
  31. printk(KERN_DEBUG "%s debug %d-%04x: " fmt, c->driver->name, \
  32. i2c_adapter_id(c->adapter), c->addr , ## arg); \
  33. } while (0)
  34. /* supported controls */
  35. static struct v4l2_queryctrl tvp5150_qctrl[] = {
  36. {
  37. .id = V4L2_CID_BRIGHTNESS,
  38. .type = V4L2_CTRL_TYPE_INTEGER,
  39. .name = "Brightness",
  40. .minimum = 0,
  41. .maximum = 255,
  42. .step = 1,
  43. .default_value = 0,
  44. .flags = 0,
  45. }, {
  46. .id = V4L2_CID_CONTRAST,
  47. .type = V4L2_CTRL_TYPE_INTEGER,
  48. .name = "Contrast",
  49. .minimum = 0,
  50. .maximum = 255,
  51. .step = 0x1,
  52. .default_value = 0x10,
  53. .flags = 0,
  54. }, {
  55. .id = V4L2_CID_SATURATION,
  56. .type = V4L2_CTRL_TYPE_INTEGER,
  57. .name = "Saturation",
  58. .minimum = 0,
  59. .maximum = 255,
  60. .step = 0x1,
  61. .default_value = 0x10,
  62. .flags = 0,
  63. }, {
  64. .id = V4L2_CID_HUE,
  65. .type = V4L2_CTRL_TYPE_INTEGER,
  66. .name = "Hue",
  67. .minimum = -128,
  68. .maximum = 127,
  69. .step = 0x1,
  70. .default_value = 0x10,
  71. .flags = 0,
  72. }
  73. };
  74. struct tvp5150 {
  75. struct i2c_client *client;
  76. int norm;
  77. int input;
  78. int enable;
  79. int bright;
  80. int contrast;
  81. int hue;
  82. int sat;
  83. };
  84. static inline int tvp5150_read(struct i2c_client *c, unsigned char addr)
  85. {
  86. unsigned char buffer[1];
  87. int rc;
  88. buffer[0] = addr;
  89. if (1 != (rc = i2c_master_send(c, buffer, 1)))
  90. tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 1)\n", rc);
  91. msleep(10);
  92. if (1 != (rc = i2c_master_recv(c, buffer, 1)))
  93. tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 1)\n", rc);
  94. tvp5150_dbg(2, "tvp5150: read 0x%02x = 0x%02x\n", addr, buffer[0]);
  95. return (buffer[0]);
  96. }
  97. static inline void tvp5150_write(struct i2c_client *c, unsigned char addr,
  98. unsigned char value)
  99. {
  100. unsigned char buffer[2];
  101. int rc;
  102. buffer[0] = addr;
  103. buffer[1] = value;
  104. tvp5150_dbg(2, "tvp5150: writing 0x%02x 0x%02x\n", buffer[0], buffer[1]);
  105. if (2 != (rc = i2c_master_send(c, buffer, 2)))
  106. tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 2)\n", rc);
  107. }
  108. static void dump_reg(struct i2c_client *c)
  109. {
  110. printk("tvp5150: Video input source selection #1 = 0x%02x\n",
  111. tvp5150_read(c, TVP5150_VD_IN_SRC_SEL_1));
  112. printk("tvp5150: Analog channel controls = 0x%02x\n",
  113. tvp5150_read(c, TVP5150_ANAL_CHL_CTL));
  114. printk("tvp5150: Operation mode controls = 0x%02x\n",
  115. tvp5150_read(c, TVP5150_OP_MODE_CTL));
  116. printk("tvp5150: Miscellaneous controls = 0x%02x\n",
  117. tvp5150_read(c, TVP5150_MISC_CTL));
  118. printk("tvp5150: Autoswitch mask: TVP5150A / TVP5150AM = 0x%02x\n",
  119. tvp5150_read(c, TVP5150_AUTOSW_MSK));
  120. printk("tvp5150: Color killer threshold control = 0x%02x\n",
  121. tvp5150_read(c, TVP5150_COLOR_KIL_THSH_CTL));
  122. printk("tvp5150: Luminance processing control #1 = 0x%02x\n",
  123. tvp5150_read(c, TVP5150_LUMA_PROC_CTL_1));
  124. printk("tvp5150: Luminance processing control #2 = 0x%02x\n",
  125. tvp5150_read(c, TVP5150_LUMA_PROC_CTL_2));
  126. printk("tvp5150: Brightness control = 0x%02x\n",
  127. tvp5150_read(c, TVP5150_BRIGHT_CTL));
  128. printk("tvp5150: Color saturation control = 0x%02x\n",
  129. tvp5150_read(c, TVP5150_SATURATION_CTL));
  130. printk("tvp5150: Hue control = 0x%02x\n",
  131. tvp5150_read(c, TVP5150_HUE_CTL));
  132. printk("tvp5150: Contrast control = 0x%02x\n",
  133. tvp5150_read(c, TVP5150_CONTRAST_CTL));
  134. printk("tvp5150: Outputs and data rates select = 0x%02x\n",
  135. tvp5150_read(c, TVP5150_DATA_RATE_SEL));
  136. printk("tvp5150: Luminance processing control #3 = 0x%02x\n",
  137. tvp5150_read(c, TVP5150_LUMA_PROC_CTL_3));
  138. printk("tvp5150: Configuration shared pins = 0x%02x\n",
  139. tvp5150_read(c, TVP5150_CONF_SHARED_PIN));
  140. printk("tvp5150: Active video cropping start MSB = 0x%02x\n",
  141. tvp5150_read(c, TVP5150_ACT_VD_CROP_ST_MSB));
  142. printk("tvp5150: Active video cropping start LSB = 0x%02x\n",
  143. tvp5150_read(c, TVP5150_ACT_VD_CROP_ST_LSB));
  144. printk("tvp5150: Active video cropping stop MSB = 0x%02x\n",
  145. tvp5150_read(c, TVP5150_ACT_VD_CROP_STP_MSB));
  146. printk("tvp5150: Active video cropping stop LSB = 0x%02x\n",
  147. tvp5150_read(c, TVP5150_ACT_VD_CROP_STP_LSB));
  148. printk("tvp5150: Genlock/RTC = 0x%02x\n",
  149. tvp5150_read(c, TVP5150_GENLOCK));
  150. printk("tvp5150: Horizontal sync start = 0x%02x\n",
  151. tvp5150_read(c, TVP5150_HORIZ_SYNC_START));
  152. printk("tvp5150: Vertical blanking start = 0x%02x\n",
  153. tvp5150_read(c, TVP5150_VERT_BLANKING_START));
  154. printk("tvp5150: Vertical blanking stop = 0x%02x\n",
  155. tvp5150_read(c, TVP5150_VERT_BLANKING_STOP));
  156. printk("tvp5150: Chrominance processing control #1 = 0x%02x\n",
  157. tvp5150_read(c, TVP5150_CHROMA_PROC_CTL_1));
  158. printk("tvp5150: Chrominance processing control #2 = 0x%02x\n",
  159. tvp5150_read(c, TVP5150_CHROMA_PROC_CTL_2));
  160. printk("tvp5150: Interrupt reset register B = 0x%02x\n",
  161. tvp5150_read(c, TVP5150_INT_RESET_REG_B));
  162. printk("tvp5150: Interrupt enable register B = 0x%02x\n",
  163. tvp5150_read(c, TVP5150_INT_ENABLE_REG_B));
  164. printk("tvp5150: Interrupt configuration register B = 0x%02x\n",
  165. tvp5150_read(c, TVP5150_INTT_CONFIG_REG_B));
  166. printk("tvp5150: Video standard = 0x%02x\n",
  167. tvp5150_read(c, TVP5150_VIDEO_STD));
  168. printk("tvp5150: Cb gain factor = 0x%02x\n",
  169. tvp5150_read(c, TVP5150_CB_GAIN_FACT));
  170. printk("tvp5150: Cr gain factor = 0x%02x\n",
  171. tvp5150_read(c, TVP5150_CR_GAIN_FACTOR));
  172. printk("tvp5150: Macrovision on counter = 0x%02x\n",
  173. tvp5150_read(c, TVP5150_MACROVISION_ON_CTR));
  174. printk("tvp5150: Macrovision off counter = 0x%02x\n",
  175. tvp5150_read(c, TVP5150_MACROVISION_OFF_CTR));
  176. printk("tvp5150: revision select (TVP5150AM1 only) = 0x%02x\n",
  177. tvp5150_read(c, TVP5150_REV_SELECT));
  178. printk("tvp5150: MSB of device ID = 0x%02x\n",
  179. tvp5150_read(c, TVP5150_MSB_DEV_ID));
  180. printk("tvp5150: LSB of device ID = 0x%02x\n",
  181. tvp5150_read(c, TVP5150_LSB_DEV_ID));
  182. printk("tvp5150: ROM major version = 0x%02x\n",
  183. tvp5150_read(c, TVP5150_ROM_MAJOR_VER));
  184. printk("tvp5150: ROM minor version = 0x%02x\n",
  185. tvp5150_read(c, TVP5150_ROM_MINOR_VER));
  186. printk("tvp5150: Vertical line count MSB = 0x%02x\n",
  187. tvp5150_read(c, TVP5150_VERT_LN_COUNT_MSB));
  188. printk("tvp5150: Vertical line count LSB = 0x%02x\n",
  189. tvp5150_read(c, TVP5150_VERT_LN_COUNT_LSB));
  190. printk("tvp5150: Interrupt status register B = 0x%02x\n",
  191. tvp5150_read(c, TVP5150_INT_STATUS_REG_B));
  192. printk("tvp5150: Interrupt active register B = 0x%02x\n",
  193. tvp5150_read(c, TVP5150_INT_ACTIVE_REG_B));
  194. printk("tvp5150: Status register #1 = 0x%02x\n",
  195. tvp5150_read(c, TVP5150_STATUS_REG_1));
  196. printk("tvp5150: Status register #2 = 0x%02x\n",
  197. tvp5150_read(c, TVP5150_STATUS_REG_2));
  198. printk("tvp5150: Status register #3 = 0x%02x\n",
  199. tvp5150_read(c, TVP5150_STATUS_REG_3));
  200. printk("tvp5150: Status register #4 = 0x%02x\n",
  201. tvp5150_read(c, TVP5150_STATUS_REG_4));
  202. printk("tvp5150: Status register #5 = 0x%02x\n",
  203. tvp5150_read(c, TVP5150_STATUS_REG_5));
  204. printk("tvp5150: Closed caption data registers = 0x%02x\n",
  205. tvp5150_read(c, TVP5150_CC_DATA_REG1));
  206. printk("tvp5150: Closed caption data registers = 0x%02x\n",
  207. tvp5150_read(c, TVP5150_CC_DATA_REG2));
  208. printk("tvp5150: Closed caption data registers = 0x%02x\n",
  209. tvp5150_read(c, TVP5150_CC_DATA_REG3));
  210. printk("tvp5150: Closed caption data registers = 0x%02x\n",
  211. tvp5150_read(c, TVP5150_CC_DATA_REG4));
  212. printk("tvp5150: WSS data registers = 0x%02x\n",
  213. tvp5150_read(c, TVP5150_WSS_DATA_REG1));
  214. printk("tvp5150: WSS data registers = 0x%02x\n",
  215. tvp5150_read(c, TVP5150_WSS_DATA_REG2));
  216. printk("tvp5150: WSS data registers = 0x%02x\n",
  217. tvp5150_read(c, TVP5150_WSS_DATA_REG3));
  218. printk("tvp5150: WSS data registers = 0x%02x\n",
  219. tvp5150_read(c, TVP5150_WSS_DATA_REG4));
  220. printk("tvp5150: WSS data registers = 0x%02x\n",
  221. tvp5150_read(c, TVP5150_WSS_DATA_REG5));
  222. printk("tvp5150: WSS data registers = 0x%02x\n",
  223. tvp5150_read(c, TVP5150_WSS_DATA_REG6));
  224. printk("tvp5150: VPS data registers = 0x%02x\n",
  225. tvp5150_read(c, TVP5150_VPS_DATA_REG1));
  226. printk("tvp5150: VPS data registers = 0x%02x\n",
  227. tvp5150_read(c, TVP5150_VPS_DATA_REG2));
  228. printk("tvp5150: VPS data registers = 0x%02x\n",
  229. tvp5150_read(c, TVP5150_VPS_DATA_REG3));
  230. printk("tvp5150: VPS data registers = 0x%02x\n",
  231. tvp5150_read(c, TVP5150_VPS_DATA_REG4));
  232. printk("tvp5150: VPS data registers = 0x%02x\n",
  233. tvp5150_read(c, TVP5150_VPS_DATA_REG5));
  234. printk("tvp5150: VPS data registers = 0x%02x\n",
  235. tvp5150_read(c, TVP5150_VPS_DATA_REG6));
  236. printk("tvp5150: VPS data registers = 0x%02x\n",
  237. tvp5150_read(c, TVP5150_VPS_DATA_REG7));
  238. printk("tvp5150: VPS data registers = 0x%02x\n",
  239. tvp5150_read(c, TVP5150_VPS_DATA_REG8));
  240. printk("tvp5150: VPS data registers = 0x%02x\n",
  241. tvp5150_read(c, TVP5150_VPS_DATA_REG9));
  242. printk("tvp5150: VPS data registers = 0x%02x\n",
  243. tvp5150_read(c, TVP5150_VPS_DATA_REG10));
  244. printk("tvp5150: VPS data registers = 0x%02x\n",
  245. tvp5150_read(c, TVP5150_VPS_DATA_REG11));
  246. printk("tvp5150: VPS data registers = 0x%02x\n",
  247. tvp5150_read(c, TVP5150_VPS_DATA_REG12));
  248. printk("tvp5150: VPS data registers = 0x%02x\n",
  249. tvp5150_read(c, TVP5150_VPS_DATA_REG13));
  250. printk("tvp5150: VITC data registers = 0x%02x\n",
  251. tvp5150_read(c, TVP5150_VITC_DATA_REG1));
  252. printk("tvp5150: VITC data registers = 0x%02x\n",
  253. tvp5150_read(c, TVP5150_VITC_DATA_REG2));
  254. printk("tvp5150: VITC data registers = 0x%02x\n",
  255. tvp5150_read(c, TVP5150_VITC_DATA_REG3));
  256. printk("tvp5150: VITC data registers = 0x%02x\n",
  257. tvp5150_read(c, TVP5150_VITC_DATA_REG4));
  258. printk("tvp5150: VITC data registers = 0x%02x\n",
  259. tvp5150_read(c, TVP5150_VITC_DATA_REG5));
  260. printk("tvp5150: VITC data registers = 0x%02x\n",
  261. tvp5150_read(c, TVP5150_VITC_DATA_REG6));
  262. printk("tvp5150: VITC data registers = 0x%02x\n",
  263. tvp5150_read(c, TVP5150_VITC_DATA_REG7));
  264. printk("tvp5150: VITC data registers = 0x%02x\n",
  265. tvp5150_read(c, TVP5150_VITC_DATA_REG8));
  266. printk("tvp5150: VITC data registers = 0x%02x\n",
  267. tvp5150_read(c, TVP5150_VITC_DATA_REG9));
  268. printk("tvp5150: VBI FIFO read data = 0x%02x\n",
  269. tvp5150_read(c, TVP5150_VBI_FIFO_READ_DATA));
  270. printk("tvp5150: Teletext filter 1 = 0x%02x\n",
  271. tvp5150_read(c, TVP5150_TELETEXT_FIL_1_1));
  272. printk("tvp5150: Teletext filter 1 = 0x%02x\n",
  273. tvp5150_read(c, TVP5150_TELETEXT_FIL_1_2));
  274. printk("tvp5150: Teletext filter 1 = 0x%02x\n",
  275. tvp5150_read(c, TVP5150_TELETEXT_FIL_1_3));
  276. printk("tvp5150: Teletext filter 1 = 0x%02x\n",
  277. tvp5150_read(c, TVP5150_TELETEXT_FIL_1_4));
  278. printk("tvp5150: Teletext filter 1 = 0x%02x\n",
  279. tvp5150_read(c, TVP5150_TELETEXT_FIL_1_5));
  280. printk("tvp5150: Teletext filter 2 = 0x%02x\n",
  281. tvp5150_read(c, TVP5150_TELETEXT_FIL_2_1));
  282. printk("tvp5150: Teletext filter 2 = 0x%02x\n",
  283. tvp5150_read(c, TVP5150_TELETEXT_FIL_2_2));
  284. printk("tvp5150: Teletext filter 2 = 0x%02x\n",
  285. tvp5150_read(c, TVP5150_TELETEXT_FIL_2_3));
  286. printk("tvp5150: Teletext filter 2 = 0x%02x\n",
  287. tvp5150_read(c, TVP5150_TELETEXT_FIL_2_4));
  288. printk("tvp5150: Teletext filter 2 = 0x%02x\n",
  289. tvp5150_read(c, TVP5150_TELETEXT_FIL_2_5));
  290. printk("tvp5150: Teletext filter enable = 0x%02x\n",
  291. tvp5150_read(c, TVP5150_TELETEXT_FIL_ENA));
  292. printk("tvp5150: Interrupt status register A = 0x%02x\n",
  293. tvp5150_read(c, TVP5150_INT_STATUS_REG_A));
  294. printk("tvp5150: Interrupt enable register A = 0x%02x\n",
  295. tvp5150_read(c, TVP5150_INT_ENABLE_REG_A));
  296. printk("tvp5150: Interrupt configuration = 0x%02x\n",
  297. tvp5150_read(c, TVP5150_INT_CONF));
  298. printk("tvp5150: VDP configuration RAM data = 0x%02x\n",
  299. tvp5150_read(c, TVP5150_VDP_CONF_RAM_DATA));
  300. printk("tvp5150: Configuration RAM address low byte = 0x%02x\n",
  301. tvp5150_read(c, TVP5150_CONF_RAM_ADDR_LOW));
  302. printk("tvp5150: Configuration RAM address high byte = 0x%02x\n",
  303. tvp5150_read(c, TVP5150_CONF_RAM_ADDR_HIGH));
  304. printk("tvp5150: VDP status register = 0x%02x\n",
  305. tvp5150_read(c, TVP5150_VDP_STATUS_REG));
  306. printk("tvp5150: FIFO word count = 0x%02x\n",
  307. tvp5150_read(c, TVP5150_FIFO_WORD_COUNT));
  308. printk("tvp5150: FIFO interrupt threshold = 0x%02x\n",
  309. tvp5150_read(c, TVP5150_FIFO_INT_THRESHOLD));
  310. printk("tvp5150: FIFO reset = 0x%02x\n",
  311. tvp5150_read(c, TVP5150_FIFO_RESET));
  312. printk("tvp5150: Line number interrupt = 0x%02x\n",
  313. tvp5150_read(c, TVP5150_LINE_NUMBER_INT));
  314. printk("tvp5150: Pixel alignment register low byte = 0x%02x\n",
  315. tvp5150_read(c, TVP5150_PIX_ALIGN_REG_LOW));
  316. printk("tvp5150: Pixel alignment register high byte = 0x%02x\n",
  317. tvp5150_read(c, TVP5150_PIX_ALIGN_REG_HIGH));
  318. printk("tvp5150: FIFO output control = 0x%02x\n",
  319. tvp5150_read(c, TVP5150_FIFO_OUT_CTRL));
  320. printk("tvp5150: Full field enable 1 = 0x%02x\n",
  321. tvp5150_read(c, TVP5150_FULL_FIELD_ENA_1));
  322. printk("tvp5150: Full field enable 2 = 0x%02x\n",
  323. tvp5150_read(c, TVP5150_FULL_FIELD_ENA_2));
  324. printk("tvp5150: Line mode registers = 0x%02x\n",
  325. tvp5150_read(c, TVP5150_LINE_MODE_REG_1));
  326. printk("tvp5150: Line mode registers = 0x%02x\n",
  327. tvp5150_read(c, TVP5150_LINE_MODE_REG_2));
  328. printk("tvp5150: Line mode registers = 0x%02x\n",
  329. tvp5150_read(c, TVP5150_LINE_MODE_REG_3));
  330. printk("tvp5150: Line mode registers = 0x%02x\n",
  331. tvp5150_read(c, TVP5150_LINE_MODE_REG_4));
  332. printk("tvp5150: Line mode registers = 0x%02x\n",
  333. tvp5150_read(c, TVP5150_LINE_MODE_REG_5));
  334. printk("tvp5150: Line mode registers = 0x%02x\n",
  335. tvp5150_read(c, TVP5150_LINE_MODE_REG_6));
  336. printk("tvp5150: Line mode registers = 0x%02x\n",
  337. tvp5150_read(c, TVP5150_LINE_MODE_REG_7));
  338. printk("tvp5150: Line mode registers = 0x%02x\n",
  339. tvp5150_read(c, TVP5150_LINE_MODE_REG_8));
  340. printk("tvp5150: Line mode registers = 0x%02x\n",
  341. tvp5150_read(c, TVP5150_LINE_MODE_REG_9));
  342. printk("tvp5150: Line mode registers = 0x%02x\n",
  343. tvp5150_read(c, TVP5150_LINE_MODE_REG_10));
  344. printk("tvp5150: Line mode registers = 0x%02x\n",
  345. tvp5150_read(c, TVP5150_LINE_MODE_REG_11));
  346. printk("tvp5150: Line mode registers = 0x%02x\n",
  347. tvp5150_read(c, TVP5150_LINE_MODE_REG_12));
  348. printk("tvp5150: Line mode registers = 0x%02x\n",
  349. tvp5150_read(c, TVP5150_LINE_MODE_REG_13));
  350. printk("tvp5150: Line mode registers = 0x%02x\n",
  351. tvp5150_read(c, TVP5150_LINE_MODE_REG_14));
  352. printk("tvp5150: Line mode registers = 0x%02x\n",
  353. tvp5150_read(c, TVP5150_LINE_MODE_REG_15));
  354. printk("tvp5150: Line mode registers = 0x%02x\n",
  355. tvp5150_read(c, TVP5150_LINE_MODE_REG_16));
  356. printk("tvp5150: Line mode registers = 0x%02x\n",
  357. tvp5150_read(c, TVP5150_LINE_MODE_REG_17));
  358. printk("tvp5150: Line mode registers = 0x%02x\n",
  359. tvp5150_read(c, TVP5150_LINE_MODE_REG_18));
  360. printk("tvp5150: Line mode registers = 0x%02x\n",
  361. tvp5150_read(c, TVP5150_LINE_MODE_REG_19));
  362. printk("tvp5150: Line mode registers = 0x%02x\n",
  363. tvp5150_read(c, TVP5150_LINE_MODE_REG_20));
  364. printk("tvp5150: Line mode registers = 0x%02x\n",
  365. tvp5150_read(c, TVP5150_LINE_MODE_REG_21));
  366. printk("tvp5150: Line mode registers = 0x%02x\n",
  367. tvp5150_read(c, TVP5150_LINE_MODE_REG_22));
  368. printk("tvp5150: Line mode registers = 0x%02x\n",
  369. tvp5150_read(c, TVP5150_LINE_MODE_REG_23));
  370. printk("tvp5150: Line mode registers = 0x%02x\n",
  371. tvp5150_read(c, TVP5150_LINE_MODE_REG_24));
  372. printk("tvp5150: Line mode registers = 0x%02x\n",
  373. tvp5150_read(c, TVP5150_LINE_MODE_REG_25));
  374. printk("tvp5150: Line mode registers = 0x%02x\n",
  375. tvp5150_read(c, TVP5150_LINE_MODE_REG_27));
  376. printk("tvp5150: Line mode registers = 0x%02x\n",
  377. tvp5150_read(c, TVP5150_LINE_MODE_REG_28));
  378. printk("tvp5150: Line mode registers = 0x%02x\n",
  379. tvp5150_read(c, TVP5150_LINE_MODE_REG_29));
  380. printk("tvp5150: Line mode registers = 0x%02x\n",
  381. tvp5150_read(c, TVP5150_LINE_MODE_REG_30));
  382. printk("tvp5150: Line mode registers = 0x%02x\n",
  383. tvp5150_read(c, TVP5150_LINE_MODE_REG_31));
  384. printk("tvp5150: Line mode registers = 0x%02x\n",
  385. tvp5150_read(c, TVP5150_LINE_MODE_REG_32));
  386. printk("tvp5150: Line mode registers = 0x%02x\n",
  387. tvp5150_read(c, TVP5150_LINE_MODE_REG_33));
  388. printk("tvp5150: Line mode registers = 0x%02x\n",
  389. tvp5150_read(c, TVP5150_LINE_MODE_REG_34));
  390. printk("tvp5150: Line mode registers = 0x%02x\n",
  391. tvp5150_read(c, TVP5150_LINE_MODE_REG_35));
  392. printk("tvp5150: Line mode registers = 0x%02x\n",
  393. tvp5150_read(c, TVP5150_LINE_MODE_REG_36));
  394. printk("tvp5150: Line mode registers = 0x%02x\n",
  395. tvp5150_read(c, TVP5150_LINE_MODE_REG_37));
  396. printk("tvp5150: Line mode registers = 0x%02x\n",
  397. tvp5150_read(c, TVP5150_LINE_MODE_REG_38));
  398. printk("tvp5150: Line mode registers = 0x%02x\n",
  399. tvp5150_read(c, TVP5150_LINE_MODE_REG_39));
  400. printk("tvp5150: Line mode registers = 0x%02x\n",
  401. tvp5150_read(c, TVP5150_LINE_MODE_REG_40));
  402. printk("tvp5150: Line mode registers = 0x%02x\n",
  403. tvp5150_read(c, TVP5150_LINE_MODE_REG_41));
  404. printk("tvp5150: Line mode registers = 0x%02x\n",
  405. tvp5150_read(c, TVP5150_LINE_MODE_REG_42));
  406. printk("tvp5150: Line mode registers = 0x%02x\n",
  407. tvp5150_read(c, TVP5150_LINE_MODE_REG_43));
  408. printk("tvp5150: Line mode registers = 0x%02x\n",
  409. tvp5150_read(c, TVP5150_LINE_MODE_REG_44));
  410. printk("tvp5150: Full field mode register = 0x%02x\n",
  411. tvp5150_read(c, TVP5150_FULL_FIELD_MODE_REG));
  412. }
  413. /****************************************************************************
  414. Basic functions
  415. ****************************************************************************/
  416. enum tvp5150_input {
  417. TVP5150_ANALOG_CH0 = 0,
  418. TVP5150_SVIDEO = 1,
  419. TVP5150_ANALOG_CH1 = 2,
  420. TVP5150_BLACK_SCREEN = 8
  421. };
  422. static inline void tvp5150_selmux(struct i2c_client *c,
  423. enum tvp5150_input input)
  424. {
  425. int opmode=0;
  426. struct tvp5150 *decoder = i2c_get_clientdata(c);
  427. if (!decoder->enable)
  428. input |= TVP5150_BLACK_SCREEN;
  429. switch (input) {
  430. case TVP5150_ANALOG_CH0:
  431. case TVP5150_ANALOG_CH1:
  432. opmode=0x30; /* TV Mode */
  433. break;
  434. default:
  435. opmode=0; /* Auto Mode */
  436. break;
  437. }
  438. tvp5150_write(c, TVP5150_OP_MODE_CTL, opmode);
  439. tvp5150_write(c, TVP5150_VD_IN_SRC_SEL_1, input);
  440. };
  441. struct i2c_reg_value {
  442. unsigned char reg;
  443. unsigned char value;
  444. };
  445. /* Default values as sugested at TVP5150AM1 datasheet */
  446. static const struct i2c_reg_value tvp5150_init_default[] = {
  447. { /* 0x00 */
  448. TVP5150_VD_IN_SRC_SEL_1,0x00
  449. },
  450. { /* 0x01 */
  451. TVP5150_ANAL_CHL_CTL,0x15
  452. },
  453. { /* 0x02 */
  454. TVP5150_OP_MODE_CTL,0x00
  455. },
  456. { /* 0x03 */
  457. TVP5150_MISC_CTL,0x01
  458. },
  459. { /* 0x06 */
  460. TVP5150_COLOR_KIL_THSH_CTL,0x10
  461. },
  462. { /* 0x07 */
  463. TVP5150_LUMA_PROC_CTL_1,0x60
  464. },
  465. { /* 0x08 */
  466. TVP5150_LUMA_PROC_CTL_2,0x00
  467. },
  468. { /* 0x09 */
  469. TVP5150_BRIGHT_CTL,0x80
  470. },
  471. { /* 0x0a */
  472. TVP5150_SATURATION_CTL,0x80
  473. },
  474. { /* 0x0b */
  475. TVP5150_HUE_CTL,0x00
  476. },
  477. { /* 0x0c */
  478. TVP5150_CONTRAST_CTL,0x80
  479. },
  480. { /* 0x0d */
  481. TVP5150_DATA_RATE_SEL,0x47
  482. },
  483. { /* 0x0e */
  484. TVP5150_LUMA_PROC_CTL_3,0x00
  485. },
  486. { /* 0x0f */
  487. TVP5150_CONF_SHARED_PIN,0x08
  488. },
  489. { /* 0x11 */
  490. TVP5150_ACT_VD_CROP_ST_MSB,0x00
  491. },
  492. { /* 0x12 */
  493. TVP5150_ACT_VD_CROP_ST_LSB,0x00
  494. },
  495. { /* 0x13 */
  496. TVP5150_ACT_VD_CROP_STP_MSB,0x00
  497. },
  498. { /* 0x14 */
  499. TVP5150_ACT_VD_CROP_STP_LSB,0x00
  500. },
  501. { /* 0x15 */
  502. TVP5150_GENLOCK,0x01
  503. },
  504. { /* 0x16 */
  505. TVP5150_HORIZ_SYNC_START,0x80
  506. },
  507. { /* 0x18 */
  508. TVP5150_VERT_BLANKING_START,0x00
  509. },
  510. { /* 0x19 */
  511. TVP5150_VERT_BLANKING_STOP,0x00
  512. },
  513. { /* 0x1a */
  514. TVP5150_CHROMA_PROC_CTL_1,0x0c
  515. },
  516. { /* 0x1b */
  517. TVP5150_CHROMA_PROC_CTL_2,0x14
  518. },
  519. { /* 0x1c */
  520. TVP5150_INT_RESET_REG_B,0x00
  521. },
  522. { /* 0x1d */
  523. TVP5150_INT_ENABLE_REG_B,0x00
  524. },
  525. { /* 0x1e */
  526. TVP5150_INTT_CONFIG_REG_B,0x00
  527. },
  528. { /* 0x28 */
  529. TVP5150_VIDEO_STD,0x00
  530. },
  531. { /* 0x2e */
  532. TVP5150_MACROVISION_ON_CTR,0x0f
  533. },
  534. { /* 0x2f */
  535. TVP5150_MACROVISION_OFF_CTR,0x01
  536. },
  537. { /* 0xbb */
  538. TVP5150_TELETEXT_FIL_ENA,0x00
  539. },
  540. { /* 0xc0 */
  541. TVP5150_INT_STATUS_REG_A,0x00
  542. },
  543. { /* 0xc1 */
  544. TVP5150_INT_ENABLE_REG_A,0x00
  545. },
  546. { /* 0xc2 */
  547. TVP5150_INT_CONF,0x04
  548. },
  549. { /* 0xc8 */
  550. TVP5150_FIFO_INT_THRESHOLD,0x80
  551. },
  552. { /* 0xc9 */
  553. TVP5150_FIFO_RESET,0x00
  554. },
  555. { /* 0xca */
  556. TVP5150_LINE_NUMBER_INT,0x00
  557. },
  558. { /* 0xcb */
  559. TVP5150_PIX_ALIGN_REG_LOW,0x4e
  560. },
  561. { /* 0xcc */
  562. TVP5150_PIX_ALIGN_REG_HIGH,0x00
  563. },
  564. { /* 0xcd */
  565. TVP5150_FIFO_OUT_CTRL,0x01
  566. },
  567. { /* 0xcf */
  568. TVP5150_FULL_FIELD_ENA_1,0x00
  569. },
  570. { /* 0xd0 */
  571. TVP5150_FULL_FIELD_ENA_2,0x00
  572. },
  573. { /* 0xfc */
  574. TVP5150_FULL_FIELD_MODE_REG,0x7f
  575. },
  576. { /* end of data */
  577. 0xff,0xff
  578. }
  579. };
  580. /* Default values as sugested at TVP5150AM1 datasheet */
  581. static const struct i2c_reg_value tvp5150_init_enable[] = {
  582. {
  583. TVP5150_CONF_SHARED_PIN, 2
  584. },{ /* Automatic offset and AGC enabled */
  585. TVP5150_ANAL_CHL_CTL, 0x15
  586. },{ /* Activate YCrCb output 0x9 or 0xd ? */
  587. TVP5150_MISC_CTL, 0x6f
  588. },{ /* Activates video std autodetection for all standards */
  589. TVP5150_AUTOSW_MSK, 0x0
  590. },{ /* Default format: 0x47. For 4:2:2: 0x40 */
  591. TVP5150_DATA_RATE_SEL, 0x47
  592. },{
  593. TVP5150_CHROMA_PROC_CTL_1, 0x0c
  594. },{
  595. TVP5150_CHROMA_PROC_CTL_2, 0x54
  596. },{ /* Non documented, but initialized on WinTV USB2 */
  597. 0x27, 0x20
  598. },{
  599. 0xff,0xff
  600. }
  601. };
  602. struct i2c_vbi_ram_value {
  603. u16 reg;
  604. unsigned char values[26];
  605. };
  606. struct i2c_vbi_ram_value vbi_ram_default[] =
  607. {
  608. {0x010, /* WST SECAM 6 */
  609. { 0xaa, 0xaa, 0xff, 0xff , 0xe7, 0x2e, 0x20, 0x26, 0xe6, 0xb4, 0x0e, 0x0, 0x0, 0x0, 0x10, 0x0 }
  610. },
  611. {0x030, /* WST PAL B 6 */
  612. { 0xaa, 0xaa, 0xff, 0xff , 0x27, 0x2e, 0x20, 0x2b, 0xa6, 0x72, 0x10, 0x0, 0x0, 0x0, 0x10, 0x0 }
  613. },
  614. {0x050, /* WST PAL C 6 */
  615. { 0xaa, 0xaa, 0xff, 0xff , 0xe7, 0x2e, 0x20, 0x22, 0xa6, 0x98, 0x0d, 0x0, 0x0, 0x0, 0x10, 0x0 }
  616. },
  617. {0x070, /* WST NTSC 6 */
  618. { 0xaa, 0xaa, 0xff, 0xff , 0x27, 0x2e, 0x20, 0x23, 0x69, 0x93, 0x0d, 0x0, 0x0, 0x0, 0x10, 0x0 }
  619. },
  620. {0x090, /* NABTS, NTSC 6 */
  621. { 0xaa, 0xaa, 0xff, 0xff , 0xe7, 0x2e, 0x20, 0x22, 0x69, 0x93, 0x0d, 0x0, 0x0, 0x0, 0x15, 0x0 }
  622. },
  623. {0x0b0, /* NABTS, NTSC-J 6 */
  624. { 0xaa, 0xaa, 0xff, 0xff , 0xa7, 0x2e, 0x20, 0x23, 0x69, 0x93, 0x0d, 0x0, 0x0, 0x0, 0x10, 0x0 }
  625. },
  626. {0x0d0, /* CC, PAL/SECAM 6 */
  627. { 0xaa, 0x2a, 0xff, 0x3f , 0x04, 0x51, 0x6e, 0x02, 0xa6, 0x7b, 0x09, 0x0, 0x0, 0x0, 0x27, 0x0 }
  628. },
  629. {0x0f0, /* CC, NTSC 6 */
  630. { 0xaa, 0x2a, 0xff, 0x3f , 0x04, 0x51, 0x6e, 0x02, 0x69, 0x8c, 0x09, 0x0, 0x0, 0x0, 0x27, 0x0 }
  631. },
  632. {0x110, /* WSS, PAL/SECAM 6 */
  633. { 0x5b, 0x55, 0xc5, 0xff , 0x0, 0x71, 0x6e, 0x42, 0xa6, 0xcd, 0x0f, 0x0, 0x0, 0x0, 0x3a, 0x0 }
  634. },
  635. {0x130, /* WSS, NTSC C */
  636. { 0x38, 0x00, 0x3f, 0x00 , 0x0, 0x71, 0x6e, 0x43, 0x69, 0x7c, 0x08, 0x0, 0x0, 0x0, 0x39, 0x0 }
  637. },
  638. {0x150, /* VITC, PAL/SECAM 6 */
  639. { 0x0, 0x0, 0x0, 0x0 , 0x0, 0x8f, 0x6d, 0x49, 0xa6, 0x85, 0x08, 0x0, 0x0, 0x0, 0x4c, 0x0 }
  640. },
  641. {0x170, /* VITC, NTSC 6 */
  642. { 0x0, 0x0, 0x0, 0x0 , 0x0, 0x8f, 0x6d, 0x49, 0x69, 0x94, 0x08, 0x0, 0x0, 0x0, 0x4c, 0x0 }
  643. },
  644. { (u16)-1 }
  645. };
  646. static int tvp5150_write_inittab(struct i2c_client *c,
  647. const struct i2c_reg_value *regs)
  648. {
  649. while (regs->reg != 0xff) {
  650. tvp5150_write(c, regs->reg, regs->value);
  651. regs++;
  652. }
  653. return 0;
  654. }
  655. static int tvp5150_vdp_init(struct i2c_client *c,
  656. const struct i2c_vbi_ram_value *regs)
  657. {
  658. unsigned int i;
  659. /* Disable Full Field */
  660. tvp5150_write(c, TVP5150_FULL_FIELD_ENA_1, 0);
  661. /* Before programming, Line mode should be at 0xff */
  662. for (i=TVP5150_FULL_FIELD_ENA_2; i<=TVP5150_LINE_MODE_REG_44; i++)
  663. tvp5150_write(c, i, 0xff);
  664. /* Load Ram Table */
  665. while (regs->reg != (u16)-1 ) {
  666. tvp5150_write(c, TVP5150_CONF_RAM_ADDR_HIGH,regs->reg>>8);
  667. tvp5150_write(c, TVP5150_CONF_RAM_ADDR_LOW,regs->reg);
  668. for (i=0;i<16;i++)
  669. tvp5150_write(c, TVP5150_VDP_CONF_RAM_DATA,regs->values[i]);
  670. regs++;
  671. }
  672. return 0;
  673. }
  674. static int tvp5150_set_std(struct i2c_client *c, v4l2_std_id std)
  675. {
  676. struct tvp5150 *decoder = i2c_get_clientdata(c);
  677. int fmt=0;
  678. decoder->norm=std;
  679. /* First tests should be against specific std */
  680. if (std == V4L2_STD_ALL) {
  681. fmt=0; /* Autodetect mode */
  682. } else if (std & V4L2_STD_NTSC_443) {
  683. fmt=0xa;
  684. } else if (std & V4L2_STD_PAL_M) {
  685. fmt=0x6;
  686. } else if (std & (V4L2_STD_PAL_N| V4L2_STD_PAL_Nc)) {
  687. fmt=0x8;
  688. } else {
  689. /* Then, test against generic ones */
  690. if (std & V4L2_STD_NTSC) {
  691. fmt=0x2;
  692. } else if (std & V4L2_STD_PAL) {
  693. fmt=0x4;
  694. } else if (std & V4L2_STD_SECAM) {
  695. fmt=0xc;
  696. }
  697. }
  698. tvp5150_dbg(1,"Set video std register to %d.\n",fmt);
  699. tvp5150_write(c, TVP5150_VIDEO_STD, fmt);
  700. return 0;
  701. }
  702. static inline void tvp5150_reset(struct i2c_client *c)
  703. {
  704. u8 type, ver_656, msb_id, lsb_id, msb_rom, lsb_rom;
  705. struct tvp5150 *decoder = i2c_get_clientdata(c);
  706. type=tvp5150_read(c,TVP5150_AUTOSW_MSK);
  707. msb_id=tvp5150_read(c,TVP5150_MSB_DEV_ID);
  708. lsb_id=tvp5150_read(c,TVP5150_LSB_DEV_ID);
  709. msb_rom=tvp5150_read(c,TVP5150_ROM_MAJOR_VER);
  710. lsb_rom=tvp5150_read(c,TVP5150_ROM_MINOR_VER);
  711. if (type==0xdc) {
  712. ver_656=tvp5150_read(c,TVP5150_REV_SELECT);
  713. tvp5150_info("tvp%02x%02xam1 detected 656 version is %d.\n",msb_id, lsb_id,ver_656);
  714. } else if (type==0xfc) {
  715. tvp5150_info("tvp%02x%02xa detected.\n",msb_id, lsb_id);
  716. } else {
  717. tvp5150_info("unknown tvp%02x%02x chip detected(%d).\n",msb_id,lsb_id,type);
  718. }
  719. tvp5150_info("Rom ver is %d.%d\n",msb_rom,lsb_rom);
  720. /* Initializes TVP5150 to its default values */
  721. tvp5150_write_inittab(c, tvp5150_init_default);
  722. /* Initializes VDP registers */
  723. tvp5150_vdp_init(c, vbi_ram_default);
  724. /* Selects decoder input */
  725. tvp5150_selmux(c, decoder->input);
  726. /* Initializes TVP5150 to stream enabled values */
  727. tvp5150_write_inittab(c, tvp5150_init_enable);
  728. /* Initialize image preferences */
  729. tvp5150_write(c, TVP5150_BRIGHT_CTL, decoder->bright >> 8);
  730. tvp5150_write(c, TVP5150_CONTRAST_CTL, decoder->contrast >> 8);
  731. tvp5150_write(c, TVP5150_SATURATION_CTL, decoder->contrast >> 8);
  732. tvp5150_write(c, TVP5150_HUE_CTL, (decoder->hue - 32768) >> 8);
  733. tvp5150_set_std(c, decoder->norm);
  734. };
  735. static int tvp5150_get_ctrl(struct i2c_client *c, struct v4l2_control *ctrl)
  736. {
  737. /* struct tvp5150 *decoder = i2c_get_clientdata(c); */
  738. switch (ctrl->id) {
  739. case V4L2_CID_BRIGHTNESS:
  740. ctrl->value = tvp5150_read(c, TVP5150_BRIGHT_CTL);
  741. return 0;
  742. case V4L2_CID_CONTRAST:
  743. ctrl->value = tvp5150_read(c, TVP5150_CONTRAST_CTL);
  744. return 0;
  745. case V4L2_CID_SATURATION:
  746. ctrl->value = tvp5150_read(c, TVP5150_SATURATION_CTL);
  747. return 0;
  748. case V4L2_CID_HUE:
  749. ctrl->value = tvp5150_read(c, TVP5150_HUE_CTL);
  750. return 0;
  751. }
  752. return -EINVAL;
  753. }
  754. static int tvp5150_set_ctrl(struct i2c_client *c, struct v4l2_control *ctrl)
  755. {
  756. /* struct tvp5150 *decoder = i2c_get_clientdata(c); */
  757. switch (ctrl->id) {
  758. case V4L2_CID_BRIGHTNESS:
  759. tvp5150_write(c, TVP5150_BRIGHT_CTL, ctrl->value);
  760. return 0;
  761. case V4L2_CID_CONTRAST:
  762. tvp5150_write(c, TVP5150_CONTRAST_CTL, ctrl->value);
  763. return 0;
  764. case V4L2_CID_SATURATION:
  765. tvp5150_write(c, TVP5150_SATURATION_CTL, ctrl->value);
  766. return 0;
  767. case V4L2_CID_HUE:
  768. tvp5150_write(c, TVP5150_HUE_CTL, ctrl->value);
  769. return 0;
  770. }
  771. return -EINVAL;
  772. }
  773. /****************************************************************************
  774. I2C Command
  775. ****************************************************************************/
  776. static int tvp5150_command(struct i2c_client *c,
  777. unsigned int cmd, void *arg)
  778. {
  779. struct tvp5150 *decoder = i2c_get_clientdata(c);
  780. switch (cmd) {
  781. case 0:
  782. case VIDIOC_INT_RESET:
  783. case DECODER_INIT:
  784. tvp5150_reset(c);
  785. break;
  786. case VIDIOC_S_STD:
  787. if (decoder->norm == *(v4l2_std_id *)arg)
  788. break;
  789. return tvp5150_set_std(c, *(v4l2_std_id *)arg);
  790. case VIDIOC_G_STD:
  791. *(v4l2_std_id *)arg = decoder->norm;
  792. break;
  793. #ifdef CONFIG_VIDEO_ADV_DEBUG
  794. case VIDIOC_INT_G_REGISTER:
  795. {
  796. struct v4l2_register *reg = arg;
  797. if (reg->i2c_id != I2C_DRIVERID_TVP5150)
  798. return -EINVAL;
  799. reg->val = tvp5150_read(c, reg->reg & 0xff);
  800. break;
  801. }
  802. case VIDIOC_INT_S_REGISTER:
  803. {
  804. struct v4l2_register *reg = arg;
  805. if (reg->i2c_id != I2C_DRIVERID_TVP5150)
  806. return -EINVAL;
  807. if (!capable(CAP_SYS_ADMIN))
  808. return -EPERM;
  809. tvp5150_write(c, reg->reg & 0xff, reg->val & 0xff);
  810. break;
  811. }
  812. #endif
  813. case DECODER_DUMP:
  814. dump_reg(c);
  815. break;
  816. case DECODER_GET_CAPABILITIES:
  817. {
  818. struct video_decoder_capability *cap = arg;
  819. cap->flags = VIDEO_DECODER_PAL |
  820. VIDEO_DECODER_NTSC |
  821. VIDEO_DECODER_SECAM |
  822. VIDEO_DECODER_AUTO | VIDEO_DECODER_CCIR;
  823. cap->inputs = 3;
  824. cap->outputs = 1;
  825. break;
  826. }
  827. case DECODER_GET_STATUS:
  828. {
  829. break;
  830. }
  831. case DECODER_SET_GPIO:
  832. break;
  833. case DECODER_SET_VBI_BYPASS:
  834. break;
  835. case DECODER_SET_NORM:
  836. {
  837. int *iarg = arg;
  838. switch (*iarg) {
  839. case VIDEO_MODE_NTSC:
  840. break;
  841. case VIDEO_MODE_PAL:
  842. break;
  843. case VIDEO_MODE_SECAM:
  844. break;
  845. case VIDEO_MODE_AUTO:
  846. break;
  847. default:
  848. return -EINVAL;
  849. }
  850. decoder->norm = *iarg;
  851. break;
  852. }
  853. case DECODER_SET_INPUT:
  854. {
  855. int *iarg = arg;
  856. if (*iarg < 0 || *iarg > 3) {
  857. return -EINVAL;
  858. }
  859. decoder->input = *iarg;
  860. tvp5150_selmux(c, decoder->input);
  861. break;
  862. }
  863. case DECODER_SET_OUTPUT:
  864. {
  865. int *iarg = arg;
  866. /* not much choice of outputs */
  867. if (*iarg != 0) {
  868. return -EINVAL;
  869. }
  870. break;
  871. }
  872. case DECODER_ENABLE_OUTPUT:
  873. {
  874. int *iarg = arg;
  875. decoder->enable = (*iarg != 0);
  876. tvp5150_selmux(c, decoder->input);
  877. break;
  878. }
  879. case VIDIOC_QUERYCTRL:
  880. {
  881. struct v4l2_queryctrl *qc = arg;
  882. int i;
  883. tvp5150_dbg(1, "VIDIOC_QUERYCTRL called\n");
  884. for (i = 0; i < ARRAY_SIZE(tvp5150_qctrl); i++)
  885. if (qc->id && qc->id == tvp5150_qctrl[i].id) {
  886. memcpy(qc, &(tvp5150_qctrl[i]),
  887. sizeof(*qc));
  888. return 0;
  889. }
  890. return -EINVAL;
  891. }
  892. case VIDIOC_G_CTRL:
  893. {
  894. struct v4l2_control *ctrl = arg;
  895. tvp5150_dbg(1, "VIDIOC_G_CTRL called\n");
  896. return tvp5150_get_ctrl(c, ctrl);
  897. }
  898. case VIDIOC_S_CTRL:
  899. {
  900. struct v4l2_control *ctrl = arg;
  901. u8 i, n;
  902. n = sizeof(tvp5150_qctrl) / sizeof(tvp5150_qctrl[0]);
  903. for (i = 0; i < n; i++)
  904. if (ctrl->id == tvp5150_qctrl[i].id) {
  905. if (ctrl->value <
  906. tvp5150_qctrl[i].minimum
  907. || ctrl->value >
  908. tvp5150_qctrl[i].maximum)
  909. return -ERANGE;
  910. tvp5150_dbg(1,
  911. "VIDIOC_S_CTRL: id=%d, value=%d\n",
  912. ctrl->id, ctrl->value);
  913. return tvp5150_set_ctrl(c, ctrl);
  914. }
  915. return -EINVAL;
  916. }
  917. case DECODER_SET_PICTURE:
  918. {
  919. struct video_picture *pic = arg;
  920. if (decoder->bright != pic->brightness) {
  921. /* We want 0 to 255 we get 0-65535 */
  922. decoder->bright = pic->brightness;
  923. tvp5150_write(c, TVP5150_BRIGHT_CTL,
  924. decoder->bright >> 8);
  925. }
  926. if (decoder->contrast != pic->contrast) {
  927. /* We want 0 to 255 we get 0-65535 */
  928. decoder->contrast = pic->contrast;
  929. tvp5150_write(c, TVP5150_CONTRAST_CTL,
  930. decoder->contrast >> 8);
  931. }
  932. if (decoder->sat != pic->colour) {
  933. /* We want 0 to 255 we get 0-65535 */
  934. decoder->sat = pic->colour;
  935. tvp5150_write(c, TVP5150_SATURATION_CTL,
  936. decoder->contrast >> 8);
  937. }
  938. if (decoder->hue != pic->hue) {
  939. /* We want -128 to 127 we get 0-65535 */
  940. decoder->hue = pic->hue;
  941. tvp5150_write(c, TVP5150_HUE_CTL,
  942. (decoder->hue - 32768) >> 8);
  943. }
  944. break;
  945. }
  946. default:
  947. return -EINVAL;
  948. }
  949. return 0;
  950. }
  951. /****************************************************************************
  952. I2C Client & Driver
  953. ****************************************************************************/
  954. static struct i2c_driver driver;
  955. static struct i2c_client client_template = {
  956. .name = "(unset)",
  957. .driver = &driver,
  958. };
  959. static int tvp5150_detect_client(struct i2c_adapter *adapter,
  960. int address, int kind)
  961. {
  962. struct i2c_client *c;
  963. struct tvp5150 *core;
  964. int rv;
  965. if (debug)
  966. printk( KERN_INFO
  967. "tvp5150.c: detecting tvp5150 client on address 0x%x\n",
  968. address << 1);
  969. client_template.adapter = adapter;
  970. client_template.addr = address;
  971. /* Check if the adapter supports the needed features */
  972. if (!i2c_check_functionality
  973. (adapter,
  974. I2C_FUNC_SMBUS_READ_BYTE | I2C_FUNC_SMBUS_WRITE_BYTE_DATA))
  975. return 0;
  976. c = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
  977. if (c == 0)
  978. return -ENOMEM;
  979. memcpy(c, &client_template, sizeof(struct i2c_client));
  980. core = kmalloc(sizeof(struct tvp5150), GFP_KERNEL);
  981. if (core == 0) {
  982. kfree(c);
  983. return -ENOMEM;
  984. }
  985. memset(core, 0, sizeof(struct tvp5150));
  986. i2c_set_clientdata(c, core);
  987. rv = i2c_attach_client(c);
  988. core->norm = V4L2_STD_ALL;
  989. core->input = 2;
  990. core->enable = 1;
  991. core->bright = 32768;
  992. core->contrast = 32768;
  993. core->hue = 32768;
  994. core->sat = 32768;
  995. if (rv) {
  996. kfree(c);
  997. kfree(core);
  998. return rv;
  999. }
  1000. if (debug > 1)
  1001. dump_reg(c);
  1002. return 0;
  1003. }
  1004. static int tvp5150_attach_adapter(struct i2c_adapter *adapter)
  1005. {
  1006. if (debug)
  1007. printk( KERN_INFO
  1008. "tvp5150.c: starting probe for adapter %s (0x%x)\n",
  1009. adapter->name, adapter->id);
  1010. return i2c_probe(adapter, &addr_data, &tvp5150_detect_client);
  1011. }
  1012. static int tvp5150_detach_client(struct i2c_client *c)
  1013. {
  1014. struct tvp5150 *decoder = i2c_get_clientdata(c);
  1015. int err;
  1016. tvp5150_dbg(1,
  1017. "tvp5150.c: removing tvp5150 adapter on address 0x%x\n",
  1018. c->addr << 1);
  1019. err = i2c_detach_client(c);
  1020. if (err) {
  1021. return err;
  1022. }
  1023. kfree(decoder);
  1024. kfree(c);
  1025. return 0;
  1026. }
  1027. /* ----------------------------------------------------------------------- */
  1028. static struct i2c_driver driver = {
  1029. .driver = {
  1030. .name = "tvp5150",
  1031. },
  1032. /* FIXME */
  1033. .id = I2C_DRIVERID_SAA7110,
  1034. .attach_adapter = tvp5150_attach_adapter,
  1035. .detach_client = tvp5150_detach_client,
  1036. .command = tvp5150_command,
  1037. };
  1038. static int __init tvp5150_init(void)
  1039. {
  1040. return i2c_add_driver(&driver);
  1041. }
  1042. static void __exit tvp5150_exit(void)
  1043. {
  1044. i2c_del_driver(&driver);
  1045. }
  1046. module_init(tvp5150_init);
  1047. module_exit(tvp5150_exit);