shmob_drm_crtc.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * shmob_drm_crtc.c -- SH Mobile DRM CRTCs
  4. *
  5. * Copyright (C) 2012 Renesas Electronics Corporation
  6. *
  7. * Laurent Pinchart (laurent.pinchart@ideasonboard.com)
  8. */
  9. #include <linux/backlight.h>
  10. #include <linux/clk.h>
  11. #include <drm/drmP.h>
  12. #include <drm/drm_crtc.h>
  13. #include <drm/drm_crtc_helper.h>
  14. #include <drm/drm_fb_cma_helper.h>
  15. #include <drm/drm_gem_cma_helper.h>
  16. #include <drm/drm_plane_helper.h>
  17. #include "shmob_drm_backlight.h"
  18. #include "shmob_drm_crtc.h"
  19. #include "shmob_drm_drv.h"
  20. #include "shmob_drm_kms.h"
  21. #include "shmob_drm_plane.h"
  22. #include "shmob_drm_regs.h"
  23. /*
  24. * TODO: panel support
  25. */
  26. /* -----------------------------------------------------------------------------
  27. * Clock management
  28. */
  29. static int shmob_drm_clk_on(struct shmob_drm_device *sdev)
  30. {
  31. int ret;
  32. if (sdev->clock) {
  33. ret = clk_prepare_enable(sdev->clock);
  34. if (ret < 0)
  35. return ret;
  36. }
  37. return 0;
  38. }
  39. static void shmob_drm_clk_off(struct shmob_drm_device *sdev)
  40. {
  41. if (sdev->clock)
  42. clk_disable_unprepare(sdev->clock);
  43. }
  44. /* -----------------------------------------------------------------------------
  45. * CRTC
  46. */
  47. static void shmob_drm_crtc_setup_geometry(struct shmob_drm_crtc *scrtc)
  48. {
  49. struct drm_crtc *crtc = &scrtc->crtc;
  50. struct shmob_drm_device *sdev = crtc->dev->dev_private;
  51. const struct shmob_drm_interface_data *idata = &sdev->pdata->iface;
  52. const struct drm_display_mode *mode = &crtc->mode;
  53. u32 value;
  54. value = sdev->ldmt1r
  55. | ((mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : LDMT1R_VPOL)
  56. | ((mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : LDMT1R_HPOL)
  57. | ((idata->flags & SHMOB_DRM_IFACE_FL_DWPOL) ? LDMT1R_DWPOL : 0)
  58. | ((idata->flags & SHMOB_DRM_IFACE_FL_DIPOL) ? LDMT1R_DIPOL : 0)
  59. | ((idata->flags & SHMOB_DRM_IFACE_FL_DAPOL) ? LDMT1R_DAPOL : 0)
  60. | ((idata->flags & SHMOB_DRM_IFACE_FL_HSCNT) ? LDMT1R_HSCNT : 0)
  61. | ((idata->flags & SHMOB_DRM_IFACE_FL_DWCNT) ? LDMT1R_DWCNT : 0);
  62. lcdc_write(sdev, LDMT1R, value);
  63. if (idata->interface >= SHMOB_DRM_IFACE_SYS8A &&
  64. idata->interface <= SHMOB_DRM_IFACE_SYS24) {
  65. /* Setup SYS bus. */
  66. value = (idata->sys.cs_setup << LDMT2R_CSUP_SHIFT)
  67. | (idata->sys.vsync_active_high ? LDMT2R_RSV : 0)
  68. | (idata->sys.vsync_dir_input ? LDMT2R_VSEL : 0)
  69. | (idata->sys.write_setup << LDMT2R_WCSC_SHIFT)
  70. | (idata->sys.write_cycle << LDMT2R_WCEC_SHIFT)
  71. | (idata->sys.write_strobe << LDMT2R_WCLW_SHIFT);
  72. lcdc_write(sdev, LDMT2R, value);
  73. value = (idata->sys.read_latch << LDMT3R_RDLC_SHIFT)
  74. | (idata->sys.read_setup << LDMT3R_RCSC_SHIFT)
  75. | (idata->sys.read_cycle << LDMT3R_RCEC_SHIFT)
  76. | (idata->sys.read_strobe << LDMT3R_RCLW_SHIFT);
  77. lcdc_write(sdev, LDMT3R, value);
  78. }
  79. value = ((mode->hdisplay / 8) << 16) /* HDCN */
  80. | (mode->htotal / 8); /* HTCN */
  81. lcdc_write(sdev, LDHCNR, value);
  82. value = (((mode->hsync_end - mode->hsync_start) / 8) << 16) /* HSYNW */
  83. | (mode->hsync_start / 8); /* HSYNP */
  84. lcdc_write(sdev, LDHSYNR, value);
  85. value = ((mode->hdisplay & 7) << 24) | ((mode->htotal & 7) << 16)
  86. | (((mode->hsync_end - mode->hsync_start) & 7) << 8)
  87. | (mode->hsync_start & 7);
  88. lcdc_write(sdev, LDHAJR, value);
  89. value = ((mode->vdisplay) << 16) /* VDLN */
  90. | mode->vtotal; /* VTLN */
  91. lcdc_write(sdev, LDVLNR, value);
  92. value = ((mode->vsync_end - mode->vsync_start) << 16) /* VSYNW */
  93. | mode->vsync_start; /* VSYNP */
  94. lcdc_write(sdev, LDVSYNR, value);
  95. }
  96. static void shmob_drm_crtc_start_stop(struct shmob_drm_crtc *scrtc, bool start)
  97. {
  98. struct shmob_drm_device *sdev = scrtc->crtc.dev->dev_private;
  99. u32 value;
  100. value = lcdc_read(sdev, LDCNT2R);
  101. if (start)
  102. lcdc_write(sdev, LDCNT2R, value | LDCNT2R_DO);
  103. else
  104. lcdc_write(sdev, LDCNT2R, value & ~LDCNT2R_DO);
  105. /* Wait until power is applied/stopped. */
  106. while (1) {
  107. value = lcdc_read(sdev, LDPMR) & LDPMR_LPS;
  108. if ((start && value) || (!start && !value))
  109. break;
  110. cpu_relax();
  111. }
  112. if (!start) {
  113. /* Stop the dot clock. */
  114. lcdc_write(sdev, LDDCKSTPR, LDDCKSTPR_DCKSTP);
  115. }
  116. }
  117. /*
  118. * shmob_drm_crtc_start - Configure and start the LCDC
  119. * @scrtc: the SH Mobile CRTC
  120. *
  121. * Configure and start the LCDC device. External devices (clocks, MERAM, panels,
  122. * ...) are not touched by this function.
  123. */
  124. static void shmob_drm_crtc_start(struct shmob_drm_crtc *scrtc)
  125. {
  126. struct drm_crtc *crtc = &scrtc->crtc;
  127. struct shmob_drm_device *sdev = crtc->dev->dev_private;
  128. const struct shmob_drm_interface_data *idata = &sdev->pdata->iface;
  129. const struct shmob_drm_format_info *format;
  130. struct drm_device *dev = sdev->ddev;
  131. struct drm_plane *plane;
  132. u32 value;
  133. int ret;
  134. if (scrtc->started)
  135. return;
  136. format = shmob_drm_format_info(crtc->primary->fb->format->format);
  137. if (WARN_ON(format == NULL))
  138. return;
  139. /* Enable clocks before accessing the hardware. */
  140. ret = shmob_drm_clk_on(sdev);
  141. if (ret < 0)
  142. return;
  143. /* Reset and enable the LCDC. */
  144. lcdc_write(sdev, LDCNT2R, lcdc_read(sdev, LDCNT2R) | LDCNT2R_BR);
  145. lcdc_wait_bit(sdev, LDCNT2R, LDCNT2R_BR, 0);
  146. lcdc_write(sdev, LDCNT2R, LDCNT2R_ME);
  147. /* Stop the LCDC first and disable all interrupts. */
  148. shmob_drm_crtc_start_stop(scrtc, false);
  149. lcdc_write(sdev, LDINTR, 0);
  150. /* Configure power supply, dot clocks and start them. */
  151. lcdc_write(sdev, LDPMR, 0);
  152. value = sdev->lddckr;
  153. if (idata->clk_div) {
  154. /* FIXME: sh7724 can only use 42, 48, 54 and 60 for the divider
  155. * denominator.
  156. */
  157. lcdc_write(sdev, LDDCKPAT1R, 0);
  158. lcdc_write(sdev, LDDCKPAT2R, (1 << (idata->clk_div / 2)) - 1);
  159. if (idata->clk_div == 1)
  160. value |= LDDCKR_MOSEL;
  161. else
  162. value |= idata->clk_div;
  163. }
  164. lcdc_write(sdev, LDDCKR, value);
  165. lcdc_write(sdev, LDDCKSTPR, 0);
  166. lcdc_wait_bit(sdev, LDDCKSTPR, ~0, 0);
  167. /* TODO: Setup SYS panel */
  168. /* Setup geometry, format, frame buffer memory and operation mode. */
  169. shmob_drm_crtc_setup_geometry(scrtc);
  170. /* TODO: Handle YUV colorspaces. Hardcode REC709 for now. */
  171. lcdc_write(sdev, LDDFR, format->lddfr | LDDFR_CF1);
  172. lcdc_write(sdev, LDMLSR, scrtc->line_size);
  173. lcdc_write(sdev, LDSA1R, scrtc->dma[0]);
  174. if (format->yuv)
  175. lcdc_write(sdev, LDSA2R, scrtc->dma[1]);
  176. lcdc_write(sdev, LDSM1R, 0);
  177. /* Word and long word swap. */
  178. switch (format->fourcc) {
  179. case DRM_FORMAT_RGB565:
  180. case DRM_FORMAT_NV21:
  181. case DRM_FORMAT_NV61:
  182. case DRM_FORMAT_NV42:
  183. value = LDDDSR_LS | LDDDSR_WS;
  184. break;
  185. case DRM_FORMAT_RGB888:
  186. case DRM_FORMAT_NV12:
  187. case DRM_FORMAT_NV16:
  188. case DRM_FORMAT_NV24:
  189. value = LDDDSR_LS | LDDDSR_WS | LDDDSR_BS;
  190. break;
  191. case DRM_FORMAT_ARGB8888:
  192. default:
  193. value = LDDDSR_LS;
  194. break;
  195. }
  196. lcdc_write(sdev, LDDDSR, value);
  197. /* Setup planes. */
  198. drm_for_each_legacy_plane(plane, dev) {
  199. if (plane->crtc == crtc)
  200. shmob_drm_plane_setup(plane);
  201. }
  202. /* Enable the display output. */
  203. lcdc_write(sdev, LDCNT1R, LDCNT1R_DE);
  204. shmob_drm_crtc_start_stop(scrtc, true);
  205. scrtc->started = true;
  206. }
  207. static void shmob_drm_crtc_stop(struct shmob_drm_crtc *scrtc)
  208. {
  209. struct drm_crtc *crtc = &scrtc->crtc;
  210. struct shmob_drm_device *sdev = crtc->dev->dev_private;
  211. if (!scrtc->started)
  212. return;
  213. /* Stop the LCDC. */
  214. shmob_drm_crtc_start_stop(scrtc, false);
  215. /* Disable the display output. */
  216. lcdc_write(sdev, LDCNT1R, 0);
  217. /* Stop clocks. */
  218. shmob_drm_clk_off(sdev);
  219. scrtc->started = false;
  220. }
  221. void shmob_drm_crtc_suspend(struct shmob_drm_crtc *scrtc)
  222. {
  223. shmob_drm_crtc_stop(scrtc);
  224. }
  225. void shmob_drm_crtc_resume(struct shmob_drm_crtc *scrtc)
  226. {
  227. if (scrtc->dpms != DRM_MODE_DPMS_ON)
  228. return;
  229. shmob_drm_crtc_start(scrtc);
  230. }
  231. static void shmob_drm_crtc_compute_base(struct shmob_drm_crtc *scrtc,
  232. int x, int y)
  233. {
  234. struct drm_crtc *crtc = &scrtc->crtc;
  235. struct drm_framebuffer *fb = crtc->primary->fb;
  236. struct drm_gem_cma_object *gem;
  237. unsigned int bpp;
  238. bpp = scrtc->format->yuv ? 8 : scrtc->format->bpp;
  239. gem = drm_fb_cma_get_gem_obj(fb, 0);
  240. scrtc->dma[0] = gem->paddr + fb->offsets[0]
  241. + y * fb->pitches[0] + x * bpp / 8;
  242. if (scrtc->format->yuv) {
  243. bpp = scrtc->format->bpp - 8;
  244. gem = drm_fb_cma_get_gem_obj(fb, 1);
  245. scrtc->dma[1] = gem->paddr + fb->offsets[1]
  246. + y / (bpp == 4 ? 2 : 1) * fb->pitches[1]
  247. + x * (bpp == 16 ? 2 : 1);
  248. }
  249. }
  250. static void shmob_drm_crtc_update_base(struct shmob_drm_crtc *scrtc)
  251. {
  252. struct drm_crtc *crtc = &scrtc->crtc;
  253. struct shmob_drm_device *sdev = crtc->dev->dev_private;
  254. shmob_drm_crtc_compute_base(scrtc, crtc->x, crtc->y);
  255. lcdc_write_mirror(sdev, LDSA1R, scrtc->dma[0]);
  256. if (scrtc->format->yuv)
  257. lcdc_write_mirror(sdev, LDSA2R, scrtc->dma[1]);
  258. lcdc_write(sdev, LDRCNTR, lcdc_read(sdev, LDRCNTR) ^ LDRCNTR_MRS);
  259. }
  260. #define to_shmob_crtc(c) container_of(c, struct shmob_drm_crtc, crtc)
  261. static void shmob_drm_crtc_dpms(struct drm_crtc *crtc, int mode)
  262. {
  263. struct shmob_drm_crtc *scrtc = to_shmob_crtc(crtc);
  264. if (scrtc->dpms == mode)
  265. return;
  266. if (mode == DRM_MODE_DPMS_ON)
  267. shmob_drm_crtc_start(scrtc);
  268. else
  269. shmob_drm_crtc_stop(scrtc);
  270. scrtc->dpms = mode;
  271. }
  272. static void shmob_drm_crtc_mode_prepare(struct drm_crtc *crtc)
  273. {
  274. shmob_drm_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  275. }
  276. static int shmob_drm_crtc_mode_set(struct drm_crtc *crtc,
  277. struct drm_display_mode *mode,
  278. struct drm_display_mode *adjusted_mode,
  279. int x, int y,
  280. struct drm_framebuffer *old_fb)
  281. {
  282. struct shmob_drm_crtc *scrtc = to_shmob_crtc(crtc);
  283. struct shmob_drm_device *sdev = crtc->dev->dev_private;
  284. const struct shmob_drm_format_info *format;
  285. format = shmob_drm_format_info(crtc->primary->fb->format->format);
  286. if (format == NULL) {
  287. dev_dbg(sdev->dev, "mode_set: unsupported format %08x\n",
  288. crtc->primary->fb->format->format);
  289. return -EINVAL;
  290. }
  291. scrtc->format = format;
  292. scrtc->line_size = crtc->primary->fb->pitches[0];
  293. shmob_drm_crtc_compute_base(scrtc, x, y);
  294. return 0;
  295. }
  296. static void shmob_drm_crtc_mode_commit(struct drm_crtc *crtc)
  297. {
  298. shmob_drm_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
  299. }
  300. static int shmob_drm_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
  301. struct drm_framebuffer *old_fb)
  302. {
  303. shmob_drm_crtc_update_base(to_shmob_crtc(crtc));
  304. return 0;
  305. }
  306. static const struct drm_crtc_helper_funcs crtc_helper_funcs = {
  307. .dpms = shmob_drm_crtc_dpms,
  308. .prepare = shmob_drm_crtc_mode_prepare,
  309. .commit = shmob_drm_crtc_mode_commit,
  310. .mode_set = shmob_drm_crtc_mode_set,
  311. .mode_set_base = shmob_drm_crtc_mode_set_base,
  312. };
  313. void shmob_drm_crtc_finish_page_flip(struct shmob_drm_crtc *scrtc)
  314. {
  315. struct drm_pending_vblank_event *event;
  316. struct drm_device *dev = scrtc->crtc.dev;
  317. unsigned long flags;
  318. spin_lock_irqsave(&dev->event_lock, flags);
  319. event = scrtc->event;
  320. scrtc->event = NULL;
  321. if (event) {
  322. drm_crtc_send_vblank_event(&scrtc->crtc, event);
  323. drm_crtc_vblank_put(&scrtc->crtc);
  324. }
  325. spin_unlock_irqrestore(&dev->event_lock, flags);
  326. }
  327. static int shmob_drm_crtc_page_flip(struct drm_crtc *crtc,
  328. struct drm_framebuffer *fb,
  329. struct drm_pending_vblank_event *event,
  330. uint32_t page_flip_flags,
  331. struct drm_modeset_acquire_ctx *ctx)
  332. {
  333. struct shmob_drm_crtc *scrtc = to_shmob_crtc(crtc);
  334. struct drm_device *dev = scrtc->crtc.dev;
  335. unsigned long flags;
  336. spin_lock_irqsave(&dev->event_lock, flags);
  337. if (scrtc->event != NULL) {
  338. spin_unlock_irqrestore(&dev->event_lock, flags);
  339. return -EBUSY;
  340. }
  341. spin_unlock_irqrestore(&dev->event_lock, flags);
  342. crtc->primary->fb = fb;
  343. shmob_drm_crtc_update_base(scrtc);
  344. if (event) {
  345. event->pipe = 0;
  346. drm_crtc_vblank_get(&scrtc->crtc);
  347. spin_lock_irqsave(&dev->event_lock, flags);
  348. scrtc->event = event;
  349. spin_unlock_irqrestore(&dev->event_lock, flags);
  350. }
  351. return 0;
  352. }
  353. static void shmob_drm_crtc_enable_vblank(struct shmob_drm_device *sdev,
  354. bool enable)
  355. {
  356. unsigned long flags;
  357. u32 ldintr;
  358. /* Be careful not to acknowledge any pending interrupt. */
  359. spin_lock_irqsave(&sdev->irq_lock, flags);
  360. ldintr = lcdc_read(sdev, LDINTR) | LDINTR_STATUS_MASK;
  361. if (enable)
  362. ldintr |= LDINTR_VEE;
  363. else
  364. ldintr &= ~LDINTR_VEE;
  365. lcdc_write(sdev, LDINTR, ldintr);
  366. spin_unlock_irqrestore(&sdev->irq_lock, flags);
  367. }
  368. static int shmob_drm_enable_vblank(struct drm_crtc *crtc)
  369. {
  370. struct shmob_drm_device *sdev = crtc->dev->dev_private;
  371. shmob_drm_crtc_enable_vblank(sdev, true);
  372. return 0;
  373. }
  374. static void shmob_drm_disable_vblank(struct drm_crtc *crtc)
  375. {
  376. struct shmob_drm_device *sdev = crtc->dev->dev_private;
  377. shmob_drm_crtc_enable_vblank(sdev, false);
  378. }
  379. static const struct drm_crtc_funcs crtc_funcs = {
  380. .destroy = drm_crtc_cleanup,
  381. .set_config = drm_crtc_helper_set_config,
  382. .page_flip = shmob_drm_crtc_page_flip,
  383. .enable_vblank = shmob_drm_enable_vblank,
  384. .disable_vblank = shmob_drm_disable_vblank,
  385. };
  386. int shmob_drm_crtc_create(struct shmob_drm_device *sdev)
  387. {
  388. struct drm_crtc *crtc = &sdev->crtc.crtc;
  389. int ret;
  390. sdev->crtc.dpms = DRM_MODE_DPMS_OFF;
  391. ret = drm_crtc_init(sdev->ddev, crtc, &crtc_funcs);
  392. if (ret < 0)
  393. return ret;
  394. drm_crtc_helper_add(crtc, &crtc_helper_funcs);
  395. return 0;
  396. }
  397. /* -----------------------------------------------------------------------------
  398. * Encoder
  399. */
  400. #define to_shmob_encoder(e) \
  401. container_of(e, struct shmob_drm_encoder, encoder)
  402. static void shmob_drm_encoder_dpms(struct drm_encoder *encoder, int mode)
  403. {
  404. struct shmob_drm_encoder *senc = to_shmob_encoder(encoder);
  405. struct shmob_drm_device *sdev = encoder->dev->dev_private;
  406. struct shmob_drm_connector *scon = &sdev->connector;
  407. if (senc->dpms == mode)
  408. return;
  409. shmob_drm_backlight_dpms(scon, mode);
  410. senc->dpms = mode;
  411. }
  412. static bool shmob_drm_encoder_mode_fixup(struct drm_encoder *encoder,
  413. const struct drm_display_mode *mode,
  414. struct drm_display_mode *adjusted_mode)
  415. {
  416. struct drm_device *dev = encoder->dev;
  417. struct shmob_drm_device *sdev = dev->dev_private;
  418. struct drm_connector *connector = &sdev->connector.connector;
  419. const struct drm_display_mode *panel_mode;
  420. if (list_empty(&connector->modes)) {
  421. dev_dbg(dev->dev, "mode_fixup: empty modes list\n");
  422. return false;
  423. }
  424. /* The flat panel mode is fixed, just copy it to the adjusted mode. */
  425. panel_mode = list_first_entry(&connector->modes,
  426. struct drm_display_mode, head);
  427. drm_mode_copy(adjusted_mode, panel_mode);
  428. return true;
  429. }
  430. static void shmob_drm_encoder_mode_prepare(struct drm_encoder *encoder)
  431. {
  432. /* No-op, everything is handled in the CRTC code. */
  433. }
  434. static void shmob_drm_encoder_mode_set(struct drm_encoder *encoder,
  435. struct drm_display_mode *mode,
  436. struct drm_display_mode *adjusted_mode)
  437. {
  438. /* No-op, everything is handled in the CRTC code. */
  439. }
  440. static void shmob_drm_encoder_mode_commit(struct drm_encoder *encoder)
  441. {
  442. /* No-op, everything is handled in the CRTC code. */
  443. }
  444. static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
  445. .dpms = shmob_drm_encoder_dpms,
  446. .mode_fixup = shmob_drm_encoder_mode_fixup,
  447. .prepare = shmob_drm_encoder_mode_prepare,
  448. .commit = shmob_drm_encoder_mode_commit,
  449. .mode_set = shmob_drm_encoder_mode_set,
  450. };
  451. static void shmob_drm_encoder_destroy(struct drm_encoder *encoder)
  452. {
  453. drm_encoder_cleanup(encoder);
  454. }
  455. static const struct drm_encoder_funcs encoder_funcs = {
  456. .destroy = shmob_drm_encoder_destroy,
  457. };
  458. int shmob_drm_encoder_create(struct shmob_drm_device *sdev)
  459. {
  460. struct drm_encoder *encoder = &sdev->encoder.encoder;
  461. int ret;
  462. sdev->encoder.dpms = DRM_MODE_DPMS_OFF;
  463. encoder->possible_crtcs = 1;
  464. ret = drm_encoder_init(sdev->ddev, encoder, &encoder_funcs,
  465. DRM_MODE_ENCODER_LVDS, NULL);
  466. if (ret < 0)
  467. return ret;
  468. drm_encoder_helper_add(encoder, &encoder_helper_funcs);
  469. return 0;
  470. }
  471. /* -----------------------------------------------------------------------------
  472. * Connector
  473. */
  474. #define to_shmob_connector(c) \
  475. container_of(c, struct shmob_drm_connector, connector)
  476. static int shmob_drm_connector_get_modes(struct drm_connector *connector)
  477. {
  478. struct shmob_drm_device *sdev = connector->dev->dev_private;
  479. struct drm_display_mode *mode;
  480. mode = drm_mode_create(connector->dev);
  481. if (mode == NULL)
  482. return 0;
  483. mode->type = DRM_MODE_TYPE_PREFERRED | DRM_MODE_TYPE_DRIVER;
  484. mode->clock = sdev->pdata->panel.mode.clock;
  485. mode->hdisplay = sdev->pdata->panel.mode.hdisplay;
  486. mode->hsync_start = sdev->pdata->panel.mode.hsync_start;
  487. mode->hsync_end = sdev->pdata->panel.mode.hsync_end;
  488. mode->htotal = sdev->pdata->panel.mode.htotal;
  489. mode->vdisplay = sdev->pdata->panel.mode.vdisplay;
  490. mode->vsync_start = sdev->pdata->panel.mode.vsync_start;
  491. mode->vsync_end = sdev->pdata->panel.mode.vsync_end;
  492. mode->vtotal = sdev->pdata->panel.mode.vtotal;
  493. mode->flags = sdev->pdata->panel.mode.flags;
  494. drm_mode_set_name(mode);
  495. drm_mode_probed_add(connector, mode);
  496. connector->display_info.width_mm = sdev->pdata->panel.width_mm;
  497. connector->display_info.height_mm = sdev->pdata->panel.height_mm;
  498. return 1;
  499. }
  500. static struct drm_encoder *
  501. shmob_drm_connector_best_encoder(struct drm_connector *connector)
  502. {
  503. struct shmob_drm_connector *scon = to_shmob_connector(connector);
  504. return scon->encoder;
  505. }
  506. static const struct drm_connector_helper_funcs connector_helper_funcs = {
  507. .get_modes = shmob_drm_connector_get_modes,
  508. .best_encoder = shmob_drm_connector_best_encoder,
  509. };
  510. static void shmob_drm_connector_destroy(struct drm_connector *connector)
  511. {
  512. struct shmob_drm_connector *scon = to_shmob_connector(connector);
  513. shmob_drm_backlight_exit(scon);
  514. drm_connector_unregister(connector);
  515. drm_connector_cleanup(connector);
  516. }
  517. static const struct drm_connector_funcs connector_funcs = {
  518. .dpms = drm_helper_connector_dpms,
  519. .fill_modes = drm_helper_probe_single_connector_modes,
  520. .destroy = shmob_drm_connector_destroy,
  521. };
  522. int shmob_drm_connector_create(struct shmob_drm_device *sdev,
  523. struct drm_encoder *encoder)
  524. {
  525. struct drm_connector *connector = &sdev->connector.connector;
  526. int ret;
  527. sdev->connector.encoder = encoder;
  528. connector->display_info.width_mm = sdev->pdata->panel.width_mm;
  529. connector->display_info.height_mm = sdev->pdata->panel.height_mm;
  530. ret = drm_connector_init(sdev->ddev, connector, &connector_funcs,
  531. DRM_MODE_CONNECTOR_LVDS);
  532. if (ret < 0)
  533. return ret;
  534. drm_connector_helper_add(connector, &connector_helper_funcs);
  535. ret = shmob_drm_backlight_init(&sdev->connector);
  536. if (ret < 0)
  537. goto err_cleanup;
  538. ret = drm_connector_attach_encoder(connector, encoder);
  539. if (ret < 0)
  540. goto err_backlight;
  541. drm_helper_connector_dpms(connector, DRM_MODE_DPMS_OFF);
  542. drm_object_property_set_value(&connector->base,
  543. sdev->ddev->mode_config.dpms_property, DRM_MODE_DPMS_OFF);
  544. return 0;
  545. err_backlight:
  546. shmob_drm_backlight_exit(&sdev->connector);
  547. err_cleanup:
  548. drm_connector_cleanup(connector);
  549. return ret;
  550. }