venc.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742
  1. /*
  2. * linux/drivers/video/omap2/dss/venc.c
  3. *
  4. * Copyright (C) 2009 Nokia Corporation
  5. * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
  6. *
  7. * VENC settings from TI's DSS driver
  8. *
  9. * This program is free software; you can redistribute it and/or modify it
  10. * under the terms of the GNU General Public License version 2 as published by
  11. * the Free Software Foundation.
  12. *
  13. * This program is distributed in the hope that it will be useful, but WITHOUT
  14. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  15. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  16. * more details.
  17. *
  18. * You should have received a copy of the GNU General Public License along with
  19. * this program. If not, see <http://www.gnu.org/licenses/>.
  20. */
  21. #define DSS_SUBSYS_NAME "VENC"
  22. #include <linux/kernel.h>
  23. #include <linux/module.h>
  24. #include <linux/clk.h>
  25. #include <linux/err.h>
  26. #include <linux/io.h>
  27. #include <linux/mutex.h>
  28. #include <linux/completion.h>
  29. #include <linux/delay.h>
  30. #include <linux/string.h>
  31. #include <linux/seq_file.h>
  32. #include <linux/platform_device.h>
  33. #include <linux/regulator/consumer.h>
  34. #include <plat/display.h>
  35. #include <plat/cpu.h>
  36. #include "dss.h"
  37. #define VENC_BASE 0x48050C00
  38. /* Venc registers */
  39. #define VENC_REV_ID 0x00
  40. #define VENC_STATUS 0x04
  41. #define VENC_F_CONTROL 0x08
  42. #define VENC_VIDOUT_CTRL 0x10
  43. #define VENC_SYNC_CTRL 0x14
  44. #define VENC_LLEN 0x1C
  45. #define VENC_FLENS 0x20
  46. #define VENC_HFLTR_CTRL 0x24
  47. #define VENC_CC_CARR_WSS_CARR 0x28
  48. #define VENC_C_PHASE 0x2C
  49. #define VENC_GAIN_U 0x30
  50. #define VENC_GAIN_V 0x34
  51. #define VENC_GAIN_Y 0x38
  52. #define VENC_BLACK_LEVEL 0x3C
  53. #define VENC_BLANK_LEVEL 0x40
  54. #define VENC_X_COLOR 0x44
  55. #define VENC_M_CONTROL 0x48
  56. #define VENC_BSTAMP_WSS_DATA 0x4C
  57. #define VENC_S_CARR 0x50
  58. #define VENC_LINE21 0x54
  59. #define VENC_LN_SEL 0x58
  60. #define VENC_L21__WC_CTL 0x5C
  61. #define VENC_HTRIGGER_VTRIGGER 0x60
  62. #define VENC_SAVID__EAVID 0x64
  63. #define VENC_FLEN__FAL 0x68
  64. #define VENC_LAL__PHASE_RESET 0x6C
  65. #define VENC_HS_INT_START_STOP_X 0x70
  66. #define VENC_HS_EXT_START_STOP_X 0x74
  67. #define VENC_VS_INT_START_X 0x78
  68. #define VENC_VS_INT_STOP_X__VS_INT_START_Y 0x7C
  69. #define VENC_VS_INT_STOP_Y__VS_EXT_START_X 0x80
  70. #define VENC_VS_EXT_STOP_X__VS_EXT_START_Y 0x84
  71. #define VENC_VS_EXT_STOP_Y 0x88
  72. #define VENC_AVID_START_STOP_X 0x90
  73. #define VENC_AVID_START_STOP_Y 0x94
  74. #define VENC_FID_INT_START_X__FID_INT_START_Y 0xA0
  75. #define VENC_FID_INT_OFFSET_Y__FID_EXT_START_X 0xA4
  76. #define VENC_FID_EXT_START_Y__FID_EXT_OFFSET_Y 0xA8
  77. #define VENC_TVDETGP_INT_START_STOP_X 0xB0
  78. #define VENC_TVDETGP_INT_START_STOP_Y 0xB4
  79. #define VENC_GEN_CTRL 0xB8
  80. #define VENC_OUTPUT_CONTROL 0xC4
  81. #define VENC_OUTPUT_TEST 0xC8
  82. #define VENC_DAC_B__DAC_C 0xC8
  83. struct venc_config {
  84. u32 f_control;
  85. u32 vidout_ctrl;
  86. u32 sync_ctrl;
  87. u32 llen;
  88. u32 flens;
  89. u32 hfltr_ctrl;
  90. u32 cc_carr_wss_carr;
  91. u32 c_phase;
  92. u32 gain_u;
  93. u32 gain_v;
  94. u32 gain_y;
  95. u32 black_level;
  96. u32 blank_level;
  97. u32 x_color;
  98. u32 m_control;
  99. u32 bstamp_wss_data;
  100. u32 s_carr;
  101. u32 line21;
  102. u32 ln_sel;
  103. u32 l21__wc_ctl;
  104. u32 htrigger_vtrigger;
  105. u32 savid__eavid;
  106. u32 flen__fal;
  107. u32 lal__phase_reset;
  108. u32 hs_int_start_stop_x;
  109. u32 hs_ext_start_stop_x;
  110. u32 vs_int_start_x;
  111. u32 vs_int_stop_x__vs_int_start_y;
  112. u32 vs_int_stop_y__vs_ext_start_x;
  113. u32 vs_ext_stop_x__vs_ext_start_y;
  114. u32 vs_ext_stop_y;
  115. u32 avid_start_stop_x;
  116. u32 avid_start_stop_y;
  117. u32 fid_int_start_x__fid_int_start_y;
  118. u32 fid_int_offset_y__fid_ext_start_x;
  119. u32 fid_ext_start_y__fid_ext_offset_y;
  120. u32 tvdetgp_int_start_stop_x;
  121. u32 tvdetgp_int_start_stop_y;
  122. u32 gen_ctrl;
  123. };
  124. /* from TRM */
  125. static const struct venc_config venc_config_pal_trm = {
  126. .f_control = 0,
  127. .vidout_ctrl = 1,
  128. .sync_ctrl = 0x40,
  129. .llen = 0x35F, /* 863 */
  130. .flens = 0x270, /* 624 */
  131. .hfltr_ctrl = 0,
  132. .cc_carr_wss_carr = 0x2F7225ED,
  133. .c_phase = 0,
  134. .gain_u = 0x111,
  135. .gain_v = 0x181,
  136. .gain_y = 0x140,
  137. .black_level = 0x3B,
  138. .blank_level = 0x3B,
  139. .x_color = 0x7,
  140. .m_control = 0x2,
  141. .bstamp_wss_data = 0x3F,
  142. .s_carr = 0x2A098ACB,
  143. .line21 = 0,
  144. .ln_sel = 0x01290015,
  145. .l21__wc_ctl = 0x0000F603,
  146. .htrigger_vtrigger = 0,
  147. .savid__eavid = 0x06A70108,
  148. .flen__fal = 0x00180270,
  149. .lal__phase_reset = 0x00040135,
  150. .hs_int_start_stop_x = 0x00880358,
  151. .hs_ext_start_stop_x = 0x000F035F,
  152. .vs_int_start_x = 0x01A70000,
  153. .vs_int_stop_x__vs_int_start_y = 0x000001A7,
  154. .vs_int_stop_y__vs_ext_start_x = 0x01AF0000,
  155. .vs_ext_stop_x__vs_ext_start_y = 0x000101AF,
  156. .vs_ext_stop_y = 0x00000025,
  157. .avid_start_stop_x = 0x03530083,
  158. .avid_start_stop_y = 0x026C002E,
  159. .fid_int_start_x__fid_int_start_y = 0x0001008A,
  160. .fid_int_offset_y__fid_ext_start_x = 0x002E0138,
  161. .fid_ext_start_y__fid_ext_offset_y = 0x01380001,
  162. .tvdetgp_int_start_stop_x = 0x00140001,
  163. .tvdetgp_int_start_stop_y = 0x00010001,
  164. .gen_ctrl = 0x00FF0000,
  165. };
  166. /* from TRM */
  167. static const struct venc_config venc_config_ntsc_trm = {
  168. .f_control = 0,
  169. .vidout_ctrl = 1,
  170. .sync_ctrl = 0x8040,
  171. .llen = 0x359,
  172. .flens = 0x20C,
  173. .hfltr_ctrl = 0,
  174. .cc_carr_wss_carr = 0x043F2631,
  175. .c_phase = 0,
  176. .gain_u = 0x102,
  177. .gain_v = 0x16C,
  178. .gain_y = 0x12F,
  179. .black_level = 0x43,
  180. .blank_level = 0x38,
  181. .x_color = 0x7,
  182. .m_control = 0x1,
  183. .bstamp_wss_data = 0x38,
  184. .s_carr = 0x21F07C1F,
  185. .line21 = 0,
  186. .ln_sel = 0x01310011,
  187. .l21__wc_ctl = 0x0000F003,
  188. .htrigger_vtrigger = 0,
  189. .savid__eavid = 0x069300F4,
  190. .flen__fal = 0x0016020C,
  191. .lal__phase_reset = 0x00060107,
  192. .hs_int_start_stop_x = 0x008E0350,
  193. .hs_ext_start_stop_x = 0x000F0359,
  194. .vs_int_start_x = 0x01A00000,
  195. .vs_int_stop_x__vs_int_start_y = 0x020701A0,
  196. .vs_int_stop_y__vs_ext_start_x = 0x01AC0024,
  197. .vs_ext_stop_x__vs_ext_start_y = 0x020D01AC,
  198. .vs_ext_stop_y = 0x00000006,
  199. .avid_start_stop_x = 0x03480078,
  200. .avid_start_stop_y = 0x02060024,
  201. .fid_int_start_x__fid_int_start_y = 0x0001008A,
  202. .fid_int_offset_y__fid_ext_start_x = 0x01AC0106,
  203. .fid_ext_start_y__fid_ext_offset_y = 0x01060006,
  204. .tvdetgp_int_start_stop_x = 0x00140001,
  205. .tvdetgp_int_start_stop_y = 0x00010001,
  206. .gen_ctrl = 0x00F90000,
  207. };
  208. static const struct venc_config venc_config_pal_bdghi = {
  209. .f_control = 0,
  210. .vidout_ctrl = 0,
  211. .sync_ctrl = 0,
  212. .hfltr_ctrl = 0,
  213. .x_color = 0,
  214. .line21 = 0,
  215. .ln_sel = 21,
  216. .htrigger_vtrigger = 0,
  217. .tvdetgp_int_start_stop_x = 0x00140001,
  218. .tvdetgp_int_start_stop_y = 0x00010001,
  219. .gen_ctrl = 0x00FB0000,
  220. .llen = 864-1,
  221. .flens = 625-1,
  222. .cc_carr_wss_carr = 0x2F7625ED,
  223. .c_phase = 0xDF,
  224. .gain_u = 0x111,
  225. .gain_v = 0x181,
  226. .gain_y = 0x140,
  227. .black_level = 0x3e,
  228. .blank_level = 0x3e,
  229. .m_control = 0<<2 | 1<<1,
  230. .bstamp_wss_data = 0x42,
  231. .s_carr = 0x2a098acb,
  232. .l21__wc_ctl = 0<<13 | 0x16<<8 | 0<<0,
  233. .savid__eavid = 0x06A70108,
  234. .flen__fal = 23<<16 | 624<<0,
  235. .lal__phase_reset = 2<<17 | 310<<0,
  236. .hs_int_start_stop_x = 0x00920358,
  237. .hs_ext_start_stop_x = 0x000F035F,
  238. .vs_int_start_x = 0x1a7<<16,
  239. .vs_int_stop_x__vs_int_start_y = 0x000601A7,
  240. .vs_int_stop_y__vs_ext_start_x = 0x01AF0036,
  241. .vs_ext_stop_x__vs_ext_start_y = 0x27101af,
  242. .vs_ext_stop_y = 0x05,
  243. .avid_start_stop_x = 0x03530082,
  244. .avid_start_stop_y = 0x0270002E,
  245. .fid_int_start_x__fid_int_start_y = 0x0005008A,
  246. .fid_int_offset_y__fid_ext_start_x = 0x002E0138,
  247. .fid_ext_start_y__fid_ext_offset_y = 0x01380005,
  248. };
  249. const struct omap_video_timings omap_dss_pal_timings = {
  250. .x_res = 720,
  251. .y_res = 574,
  252. .pixel_clock = 13500,
  253. .hsw = 64,
  254. .hfp = 12,
  255. .hbp = 68,
  256. .vsw = 5,
  257. .vfp = 5,
  258. .vbp = 41,
  259. };
  260. EXPORT_SYMBOL(omap_dss_pal_timings);
  261. const struct omap_video_timings omap_dss_ntsc_timings = {
  262. .x_res = 720,
  263. .y_res = 482,
  264. .pixel_clock = 13500,
  265. .hsw = 64,
  266. .hfp = 16,
  267. .hbp = 58,
  268. .vsw = 6,
  269. .vfp = 6,
  270. .vbp = 31,
  271. };
  272. EXPORT_SYMBOL(omap_dss_ntsc_timings);
  273. static struct {
  274. void __iomem *base;
  275. struct mutex venc_lock;
  276. u32 wss_data;
  277. struct regulator *vdda_dac_reg;
  278. } venc;
  279. static inline void venc_write_reg(int idx, u32 val)
  280. {
  281. __raw_writel(val, venc.base + idx);
  282. }
  283. static inline u32 venc_read_reg(int idx)
  284. {
  285. u32 l = __raw_readl(venc.base + idx);
  286. return l;
  287. }
  288. static void venc_write_config(const struct venc_config *config)
  289. {
  290. DSSDBG("write venc conf\n");
  291. venc_write_reg(VENC_LLEN, config->llen);
  292. venc_write_reg(VENC_FLENS, config->flens);
  293. venc_write_reg(VENC_CC_CARR_WSS_CARR, config->cc_carr_wss_carr);
  294. venc_write_reg(VENC_C_PHASE, config->c_phase);
  295. venc_write_reg(VENC_GAIN_U, config->gain_u);
  296. venc_write_reg(VENC_GAIN_V, config->gain_v);
  297. venc_write_reg(VENC_GAIN_Y, config->gain_y);
  298. venc_write_reg(VENC_BLACK_LEVEL, config->black_level);
  299. venc_write_reg(VENC_BLANK_LEVEL, config->blank_level);
  300. venc_write_reg(VENC_M_CONTROL, config->m_control);
  301. venc_write_reg(VENC_BSTAMP_WSS_DATA, config->bstamp_wss_data |
  302. venc.wss_data);
  303. venc_write_reg(VENC_S_CARR, config->s_carr);
  304. venc_write_reg(VENC_L21__WC_CTL, config->l21__wc_ctl);
  305. venc_write_reg(VENC_SAVID__EAVID, config->savid__eavid);
  306. venc_write_reg(VENC_FLEN__FAL, config->flen__fal);
  307. venc_write_reg(VENC_LAL__PHASE_RESET, config->lal__phase_reset);
  308. venc_write_reg(VENC_HS_INT_START_STOP_X, config->hs_int_start_stop_x);
  309. venc_write_reg(VENC_HS_EXT_START_STOP_X, config->hs_ext_start_stop_x);
  310. venc_write_reg(VENC_VS_INT_START_X, config->vs_int_start_x);
  311. venc_write_reg(VENC_VS_INT_STOP_X__VS_INT_START_Y,
  312. config->vs_int_stop_x__vs_int_start_y);
  313. venc_write_reg(VENC_VS_INT_STOP_Y__VS_EXT_START_X,
  314. config->vs_int_stop_y__vs_ext_start_x);
  315. venc_write_reg(VENC_VS_EXT_STOP_X__VS_EXT_START_Y,
  316. config->vs_ext_stop_x__vs_ext_start_y);
  317. venc_write_reg(VENC_VS_EXT_STOP_Y, config->vs_ext_stop_y);
  318. venc_write_reg(VENC_AVID_START_STOP_X, config->avid_start_stop_x);
  319. venc_write_reg(VENC_AVID_START_STOP_Y, config->avid_start_stop_y);
  320. venc_write_reg(VENC_FID_INT_START_X__FID_INT_START_Y,
  321. config->fid_int_start_x__fid_int_start_y);
  322. venc_write_reg(VENC_FID_INT_OFFSET_Y__FID_EXT_START_X,
  323. config->fid_int_offset_y__fid_ext_start_x);
  324. venc_write_reg(VENC_FID_EXT_START_Y__FID_EXT_OFFSET_Y,
  325. config->fid_ext_start_y__fid_ext_offset_y);
  326. venc_write_reg(VENC_DAC_B__DAC_C, venc_read_reg(VENC_DAC_B__DAC_C));
  327. venc_write_reg(VENC_VIDOUT_CTRL, config->vidout_ctrl);
  328. venc_write_reg(VENC_HFLTR_CTRL, config->hfltr_ctrl);
  329. venc_write_reg(VENC_X_COLOR, config->x_color);
  330. venc_write_reg(VENC_LINE21, config->line21);
  331. venc_write_reg(VENC_LN_SEL, config->ln_sel);
  332. venc_write_reg(VENC_HTRIGGER_VTRIGGER, config->htrigger_vtrigger);
  333. venc_write_reg(VENC_TVDETGP_INT_START_STOP_X,
  334. config->tvdetgp_int_start_stop_x);
  335. venc_write_reg(VENC_TVDETGP_INT_START_STOP_Y,
  336. config->tvdetgp_int_start_stop_y);
  337. venc_write_reg(VENC_GEN_CTRL, config->gen_ctrl);
  338. venc_write_reg(VENC_F_CONTROL, config->f_control);
  339. venc_write_reg(VENC_SYNC_CTRL, config->sync_ctrl);
  340. }
  341. static void venc_reset(void)
  342. {
  343. int t = 1000;
  344. venc_write_reg(VENC_F_CONTROL, 1<<8);
  345. while (venc_read_reg(VENC_F_CONTROL) & (1<<8)) {
  346. if (--t == 0) {
  347. DSSERR("Failed to reset venc\n");
  348. return;
  349. }
  350. }
  351. /* the magical sleep that makes things work */
  352. msleep(20);
  353. }
  354. static void venc_enable_clocks(int enable)
  355. {
  356. if (enable)
  357. dss_clk_enable(DSS_CLK_ICK | DSS_CLK_FCK1 | DSS_CLK_54M |
  358. DSS_CLK_96M);
  359. else
  360. dss_clk_disable(DSS_CLK_ICK | DSS_CLK_FCK1 | DSS_CLK_54M |
  361. DSS_CLK_96M);
  362. }
  363. static const struct venc_config *venc_timings_to_config(
  364. struct omap_video_timings *timings)
  365. {
  366. if (memcmp(&omap_dss_pal_timings, timings, sizeof(*timings)) == 0)
  367. return &venc_config_pal_trm;
  368. if (memcmp(&omap_dss_ntsc_timings, timings, sizeof(*timings)) == 0)
  369. return &venc_config_ntsc_trm;
  370. BUG();
  371. }
  372. static void venc_power_on(struct omap_dss_device *dssdev)
  373. {
  374. u32 l;
  375. venc_enable_clocks(1);
  376. venc_reset();
  377. venc_write_config(venc_timings_to_config(&dssdev->panel.timings));
  378. dss_set_venc_output(dssdev->phy.venc.type);
  379. dss_set_dac_pwrdn_bgz(1);
  380. l = 0;
  381. if (dssdev->phy.venc.type == OMAP_DSS_VENC_TYPE_COMPOSITE)
  382. l |= 1 << 1;
  383. else /* S-Video */
  384. l |= (1 << 0) | (1 << 2);
  385. if (dssdev->phy.venc.invert_polarity == false)
  386. l |= 1 << 3;
  387. venc_write_reg(VENC_OUTPUT_CONTROL, l);
  388. dispc_set_digit_size(dssdev->panel.timings.x_res,
  389. dssdev->panel.timings.y_res/2);
  390. regulator_enable(venc.vdda_dac_reg);
  391. if (dssdev->platform_enable)
  392. dssdev->platform_enable(dssdev);
  393. dssdev->manager->enable(dssdev->manager);
  394. }
  395. static void venc_power_off(struct omap_dss_device *dssdev)
  396. {
  397. venc_write_reg(VENC_OUTPUT_CONTROL, 0);
  398. dss_set_dac_pwrdn_bgz(0);
  399. dssdev->manager->disable(dssdev->manager);
  400. if (dssdev->platform_disable)
  401. dssdev->platform_disable(dssdev);
  402. regulator_disable(venc.vdda_dac_reg);
  403. venc_enable_clocks(0);
  404. }
  405. /* driver */
  406. static int venc_panel_probe(struct omap_dss_device *dssdev)
  407. {
  408. dssdev->panel.timings = omap_dss_pal_timings;
  409. return 0;
  410. }
  411. static void venc_panel_remove(struct omap_dss_device *dssdev)
  412. {
  413. }
  414. static int venc_panel_enable(struct omap_dss_device *dssdev)
  415. {
  416. int r = 0;
  417. DSSDBG("venc_enable_display\n");
  418. mutex_lock(&venc.venc_lock);
  419. if (dssdev->state != OMAP_DSS_DISPLAY_DISABLED) {
  420. r = -EINVAL;
  421. goto err1;
  422. }
  423. venc_power_on(dssdev);
  424. venc.wss_data = 0;
  425. dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
  426. /* wait couple of vsyncs until enabling the LCD */
  427. msleep(50);
  428. err1:
  429. mutex_unlock(&venc.venc_lock);
  430. return r;
  431. }
  432. static void venc_panel_disable(struct omap_dss_device *dssdev)
  433. {
  434. DSSDBG("venc_disable_display\n");
  435. mutex_lock(&venc.venc_lock);
  436. if (dssdev->state == OMAP_DSS_DISPLAY_DISABLED)
  437. goto end;
  438. if (dssdev->state == OMAP_DSS_DISPLAY_SUSPENDED) {
  439. /* suspended is the same as disabled with venc */
  440. dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
  441. goto end;
  442. }
  443. venc_power_off(dssdev);
  444. /* wait at least 5 vsyncs after disabling the LCD */
  445. msleep(100);
  446. dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
  447. end:
  448. mutex_unlock(&venc.venc_lock);
  449. }
  450. static int venc_panel_suspend(struct omap_dss_device *dssdev)
  451. {
  452. venc_panel_disable(dssdev);
  453. return 0;
  454. }
  455. static int venc_panel_resume(struct omap_dss_device *dssdev)
  456. {
  457. return venc_panel_enable(dssdev);
  458. }
  459. static enum omap_dss_update_mode venc_get_update_mode(
  460. struct omap_dss_device *dssdev)
  461. {
  462. return OMAP_DSS_UPDATE_AUTO;
  463. }
  464. static int venc_set_update_mode(struct omap_dss_device *dssdev,
  465. enum omap_dss_update_mode mode)
  466. {
  467. if (mode != OMAP_DSS_UPDATE_AUTO)
  468. return -EINVAL;
  469. return 0;
  470. }
  471. static void venc_get_timings(struct omap_dss_device *dssdev,
  472. struct omap_video_timings *timings)
  473. {
  474. *timings = dssdev->panel.timings;
  475. }
  476. static void venc_set_timings(struct omap_dss_device *dssdev,
  477. struct omap_video_timings *timings)
  478. {
  479. DSSDBG("venc_set_timings\n");
  480. /* Reset WSS data when the TV standard changes. */
  481. if (memcmp(&dssdev->panel.timings, timings, sizeof(*timings)))
  482. venc.wss_data = 0;
  483. dssdev->panel.timings = *timings;
  484. if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE) {
  485. /* turn the venc off and on to get new timings to use */
  486. venc_panel_disable(dssdev);
  487. venc_panel_enable(dssdev);
  488. }
  489. }
  490. static int venc_check_timings(struct omap_dss_device *dssdev,
  491. struct omap_video_timings *timings)
  492. {
  493. DSSDBG("venc_check_timings\n");
  494. if (memcmp(&omap_dss_pal_timings, timings, sizeof(*timings)) == 0)
  495. return 0;
  496. if (memcmp(&omap_dss_ntsc_timings, timings, sizeof(*timings)) == 0)
  497. return 0;
  498. return -EINVAL;
  499. }
  500. static u32 venc_get_wss(struct omap_dss_device *dssdev)
  501. {
  502. /* Invert due to VENC_L21_WC_CTL:INV=1 */
  503. return (venc.wss_data >> 8) ^ 0xfffff;
  504. }
  505. static int venc_set_wss(struct omap_dss_device *dssdev, u32 wss)
  506. {
  507. const struct venc_config *config;
  508. DSSDBG("venc_set_wss\n");
  509. mutex_lock(&venc.venc_lock);
  510. config = venc_timings_to_config(&dssdev->panel.timings);
  511. /* Invert due to VENC_L21_WC_CTL:INV=1 */
  512. venc.wss_data = (wss ^ 0xfffff) << 8;
  513. venc_enable_clocks(1);
  514. venc_write_reg(VENC_BSTAMP_WSS_DATA, config->bstamp_wss_data |
  515. venc.wss_data);
  516. venc_enable_clocks(0);
  517. mutex_unlock(&venc.venc_lock);
  518. return 0;
  519. }
  520. static struct omap_dss_driver venc_driver = {
  521. .probe = venc_panel_probe,
  522. .remove = venc_panel_remove,
  523. .enable = venc_panel_enable,
  524. .disable = venc_panel_disable,
  525. .suspend = venc_panel_suspend,
  526. .resume = venc_panel_resume,
  527. .get_resolution = omapdss_default_get_resolution,
  528. .get_recommended_bpp = omapdss_default_get_recommended_bpp,
  529. .set_update_mode = venc_set_update_mode,
  530. .get_update_mode = venc_get_update_mode,
  531. .get_timings = venc_get_timings,
  532. .set_timings = venc_set_timings,
  533. .check_timings = venc_check_timings,
  534. .get_wss = venc_get_wss,
  535. .set_wss = venc_set_wss,
  536. .driver = {
  537. .name = "venc",
  538. .owner = THIS_MODULE,
  539. },
  540. };
  541. /* driver end */
  542. int venc_init(struct platform_device *pdev)
  543. {
  544. u8 rev_id;
  545. mutex_init(&venc.venc_lock);
  546. venc.wss_data = 0;
  547. venc.base = ioremap(VENC_BASE, SZ_1K);
  548. if (!venc.base) {
  549. DSSERR("can't ioremap VENC\n");
  550. return -ENOMEM;
  551. }
  552. venc.vdda_dac_reg = dss_get_vdda_dac();
  553. if (IS_ERR(venc.vdda_dac_reg)) {
  554. iounmap(venc.base);
  555. DSSERR("can't get VDDA_DAC regulator\n");
  556. return PTR_ERR(venc.vdda_dac_reg);
  557. }
  558. venc_enable_clocks(1);
  559. rev_id = (u8)(venc_read_reg(VENC_REV_ID) & 0xff);
  560. printk(KERN_INFO "OMAP VENC rev %d\n", rev_id);
  561. venc_enable_clocks(0);
  562. return omap_dss_register_driver(&venc_driver);
  563. }
  564. void venc_exit(void)
  565. {
  566. omap_dss_unregister_driver(&venc_driver);
  567. iounmap(venc.base);
  568. }
  569. int venc_init_display(struct omap_dss_device *dssdev)
  570. {
  571. DSSDBG("init_display\n");
  572. return 0;
  573. }
  574. void venc_dump_regs(struct seq_file *s)
  575. {
  576. #define DUMPREG(r) seq_printf(s, "%-35s %08x\n", #r, venc_read_reg(r))
  577. venc_enable_clocks(1);
  578. DUMPREG(VENC_F_CONTROL);
  579. DUMPREG(VENC_VIDOUT_CTRL);
  580. DUMPREG(VENC_SYNC_CTRL);
  581. DUMPREG(VENC_LLEN);
  582. DUMPREG(VENC_FLENS);
  583. DUMPREG(VENC_HFLTR_CTRL);
  584. DUMPREG(VENC_CC_CARR_WSS_CARR);
  585. DUMPREG(VENC_C_PHASE);
  586. DUMPREG(VENC_GAIN_U);
  587. DUMPREG(VENC_GAIN_V);
  588. DUMPREG(VENC_GAIN_Y);
  589. DUMPREG(VENC_BLACK_LEVEL);
  590. DUMPREG(VENC_BLANK_LEVEL);
  591. DUMPREG(VENC_X_COLOR);
  592. DUMPREG(VENC_M_CONTROL);
  593. DUMPREG(VENC_BSTAMP_WSS_DATA);
  594. DUMPREG(VENC_S_CARR);
  595. DUMPREG(VENC_LINE21);
  596. DUMPREG(VENC_LN_SEL);
  597. DUMPREG(VENC_L21__WC_CTL);
  598. DUMPREG(VENC_HTRIGGER_VTRIGGER);
  599. DUMPREG(VENC_SAVID__EAVID);
  600. DUMPREG(VENC_FLEN__FAL);
  601. DUMPREG(VENC_LAL__PHASE_RESET);
  602. DUMPREG(VENC_HS_INT_START_STOP_X);
  603. DUMPREG(VENC_HS_EXT_START_STOP_X);
  604. DUMPREG(VENC_VS_INT_START_X);
  605. DUMPREG(VENC_VS_INT_STOP_X__VS_INT_START_Y);
  606. DUMPREG(VENC_VS_INT_STOP_Y__VS_EXT_START_X);
  607. DUMPREG(VENC_VS_EXT_STOP_X__VS_EXT_START_Y);
  608. DUMPREG(VENC_VS_EXT_STOP_Y);
  609. DUMPREG(VENC_AVID_START_STOP_X);
  610. DUMPREG(VENC_AVID_START_STOP_Y);
  611. DUMPREG(VENC_FID_INT_START_X__FID_INT_START_Y);
  612. DUMPREG(VENC_FID_INT_OFFSET_Y__FID_EXT_START_X);
  613. DUMPREG(VENC_FID_EXT_START_Y__FID_EXT_OFFSET_Y);
  614. DUMPREG(VENC_TVDETGP_INT_START_STOP_X);
  615. DUMPREG(VENC_TVDETGP_INT_START_STOP_Y);
  616. DUMPREG(VENC_GEN_CTRL);
  617. DUMPREG(VENC_OUTPUT_CONTROL);
  618. DUMPREG(VENC_OUTPUT_TEST);
  619. venc_enable_clocks(0);
  620. #undef DUMPREG
  621. }