malidp_drv.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781
  1. /*
  2. * (C) COPYRIGHT 2016 ARM Limited. All rights reserved.
  3. * Author: Liviu Dudau <Liviu.Dudau@arm.com>
  4. *
  5. * This program is free software and is provided to you under the terms of the
  6. * GNU General Public License version 2 as published by the Free Software
  7. * Foundation, and any use by you of this program is subject to the terms
  8. * of such GNU licence.
  9. *
  10. * ARM Mali DP500/DP550/DP650 KMS/DRM driver
  11. */
  12. #include <linux/module.h>
  13. #include <linux/clk.h>
  14. #include <linux/component.h>
  15. #include <linux/console.h>
  16. #include <linux/of_device.h>
  17. #include <linux/of_graph.h>
  18. #include <linux/of_reserved_mem.h>
  19. #include <linux/pm_runtime.h>
  20. #include <drm/drmP.h>
  21. #include <drm/drm_atomic.h>
  22. #include <drm/drm_atomic_helper.h>
  23. #include <drm/drm_crtc.h>
  24. #include <drm/drm_crtc_helper.h>
  25. #include <drm/drm_fb_cma_helper.h>
  26. #include <drm/drm_gem_cma_helper.h>
  27. #include <drm/drm_gem_framebuffer_helper.h>
  28. #include <drm/drm_modeset_helper.h>
  29. #include <drm/drm_of.h>
  30. #include "malidp_drv.h"
  31. #include "malidp_regs.h"
  32. #include "malidp_hw.h"
  33. #define MALIDP_CONF_VALID_TIMEOUT 250
  34. static void malidp_write_gamma_table(struct malidp_hw_device *hwdev,
  35. u32 data[MALIDP_COEFFTAB_NUM_COEFFS])
  36. {
  37. int i;
  38. /* Update all channels with a single gamma curve. */
  39. const u32 gamma_write_mask = GENMASK(18, 16);
  40. /*
  41. * Always write an entire table, so the address field in
  42. * DE_COEFFTAB_ADDR is 0 and we can use the gamma_write_mask bitmask
  43. * directly.
  44. */
  45. malidp_hw_write(hwdev, gamma_write_mask,
  46. hwdev->hw->map.coeffs_base + MALIDP_COEF_TABLE_ADDR);
  47. for (i = 0; i < MALIDP_COEFFTAB_NUM_COEFFS; ++i)
  48. malidp_hw_write(hwdev, data[i],
  49. hwdev->hw->map.coeffs_base +
  50. MALIDP_COEF_TABLE_DATA);
  51. }
  52. static void malidp_atomic_commit_update_gamma(struct drm_crtc *crtc,
  53. struct drm_crtc_state *old_state)
  54. {
  55. struct malidp_drm *malidp = crtc_to_malidp_device(crtc);
  56. struct malidp_hw_device *hwdev = malidp->dev;
  57. if (!crtc->state->color_mgmt_changed)
  58. return;
  59. if (!crtc->state->gamma_lut) {
  60. malidp_hw_clearbits(hwdev,
  61. MALIDP_DISP_FUNC_GAMMA,
  62. MALIDP_DE_DISPLAY_FUNC);
  63. } else {
  64. struct malidp_crtc_state *mc =
  65. to_malidp_crtc_state(crtc->state);
  66. if (!old_state->gamma_lut || (crtc->state->gamma_lut->base.id !=
  67. old_state->gamma_lut->base.id))
  68. malidp_write_gamma_table(hwdev, mc->gamma_coeffs);
  69. malidp_hw_setbits(hwdev, MALIDP_DISP_FUNC_GAMMA,
  70. MALIDP_DE_DISPLAY_FUNC);
  71. }
  72. }
  73. static
  74. void malidp_atomic_commit_update_coloradj(struct drm_crtc *crtc,
  75. struct drm_crtc_state *old_state)
  76. {
  77. struct malidp_drm *malidp = crtc_to_malidp_device(crtc);
  78. struct malidp_hw_device *hwdev = malidp->dev;
  79. int i;
  80. if (!crtc->state->color_mgmt_changed)
  81. return;
  82. if (!crtc->state->ctm) {
  83. malidp_hw_clearbits(hwdev, MALIDP_DISP_FUNC_CADJ,
  84. MALIDP_DE_DISPLAY_FUNC);
  85. } else {
  86. struct malidp_crtc_state *mc =
  87. to_malidp_crtc_state(crtc->state);
  88. if (!old_state->ctm || (crtc->state->ctm->base.id !=
  89. old_state->ctm->base.id))
  90. for (i = 0; i < MALIDP_COLORADJ_NUM_COEFFS; ++i)
  91. malidp_hw_write(hwdev,
  92. mc->coloradj_coeffs[i],
  93. hwdev->hw->map.coeffs_base +
  94. MALIDP_COLOR_ADJ_COEF + 4 * i);
  95. malidp_hw_setbits(hwdev, MALIDP_DISP_FUNC_CADJ,
  96. MALIDP_DE_DISPLAY_FUNC);
  97. }
  98. }
  99. static void malidp_atomic_commit_se_config(struct drm_crtc *crtc,
  100. struct drm_crtc_state *old_state)
  101. {
  102. struct malidp_crtc_state *cs = to_malidp_crtc_state(crtc->state);
  103. struct malidp_crtc_state *old_cs = to_malidp_crtc_state(old_state);
  104. struct malidp_drm *malidp = crtc_to_malidp_device(crtc);
  105. struct malidp_hw_device *hwdev = malidp->dev;
  106. struct malidp_se_config *s = &cs->scaler_config;
  107. struct malidp_se_config *old_s = &old_cs->scaler_config;
  108. u32 se_control = hwdev->hw->map.se_base +
  109. ((hwdev->hw->map.features & MALIDP_REGMAP_HAS_CLEARIRQ) ?
  110. 0x10 : 0xC);
  111. u32 layer_control = se_control + MALIDP_SE_LAYER_CONTROL;
  112. u32 scr = se_control + MALIDP_SE_SCALING_CONTROL;
  113. u32 val;
  114. /* Set SE_CONTROL */
  115. if (!s->scale_enable) {
  116. val = malidp_hw_read(hwdev, se_control);
  117. val &= ~MALIDP_SE_SCALING_EN;
  118. malidp_hw_write(hwdev, val, se_control);
  119. return;
  120. }
  121. hwdev->hw->se_set_scaling_coeffs(hwdev, s, old_s);
  122. val = malidp_hw_read(hwdev, se_control);
  123. val |= MALIDP_SE_SCALING_EN | MALIDP_SE_ALPHA_EN;
  124. val &= ~MALIDP_SE_ENH(MALIDP_SE_ENH_MASK);
  125. val |= s->enhancer_enable ? MALIDP_SE_ENH(3) : 0;
  126. val |= MALIDP_SE_RGBO_IF_EN;
  127. malidp_hw_write(hwdev, val, se_control);
  128. /* Set IN_SIZE & OUT_SIZE. */
  129. val = MALIDP_SE_SET_V_SIZE(s->input_h) |
  130. MALIDP_SE_SET_H_SIZE(s->input_w);
  131. malidp_hw_write(hwdev, val, layer_control + MALIDP_SE_L0_IN_SIZE);
  132. val = MALIDP_SE_SET_V_SIZE(s->output_h) |
  133. MALIDP_SE_SET_H_SIZE(s->output_w);
  134. malidp_hw_write(hwdev, val, layer_control + MALIDP_SE_L0_OUT_SIZE);
  135. /* Set phase regs. */
  136. malidp_hw_write(hwdev, s->h_init_phase, scr + MALIDP_SE_H_INIT_PH);
  137. malidp_hw_write(hwdev, s->h_delta_phase, scr + MALIDP_SE_H_DELTA_PH);
  138. malidp_hw_write(hwdev, s->v_init_phase, scr + MALIDP_SE_V_INIT_PH);
  139. malidp_hw_write(hwdev, s->v_delta_phase, scr + MALIDP_SE_V_DELTA_PH);
  140. }
  141. /*
  142. * set the "config valid" bit and wait until the hardware acts on it
  143. */
  144. static int malidp_set_and_wait_config_valid(struct drm_device *drm)
  145. {
  146. struct malidp_drm *malidp = drm->dev_private;
  147. struct malidp_hw_device *hwdev = malidp->dev;
  148. int ret;
  149. atomic_set(&malidp->config_valid, 0);
  150. hwdev->hw->set_config_valid(hwdev);
  151. /* don't wait for config_valid flag if we are in config mode */
  152. if (hwdev->hw->in_config_mode(hwdev))
  153. return 0;
  154. ret = wait_event_interruptible_timeout(malidp->wq,
  155. atomic_read(&malidp->config_valid) == 1,
  156. msecs_to_jiffies(MALIDP_CONF_VALID_TIMEOUT));
  157. return (ret > 0) ? 0 : -ETIMEDOUT;
  158. }
  159. static void malidp_output_poll_changed(struct drm_device *drm)
  160. {
  161. struct malidp_drm *malidp = drm->dev_private;
  162. drm_fbdev_cma_hotplug_event(malidp->fbdev);
  163. }
  164. static void malidp_atomic_commit_hw_done(struct drm_atomic_state *state)
  165. {
  166. struct drm_pending_vblank_event *event;
  167. struct drm_device *drm = state->dev;
  168. struct malidp_drm *malidp = drm->dev_private;
  169. if (malidp->crtc.enabled) {
  170. /* only set config_valid if the CRTC is enabled */
  171. if (malidp_set_and_wait_config_valid(drm))
  172. DRM_DEBUG_DRIVER("timed out waiting for updated configuration\n");
  173. }
  174. event = malidp->crtc.state->event;
  175. if (event) {
  176. malidp->crtc.state->event = NULL;
  177. spin_lock_irq(&drm->event_lock);
  178. if (drm_crtc_vblank_get(&malidp->crtc) == 0)
  179. drm_crtc_arm_vblank_event(&malidp->crtc, event);
  180. else
  181. drm_crtc_send_vblank_event(&malidp->crtc, event);
  182. spin_unlock_irq(&drm->event_lock);
  183. }
  184. drm_atomic_helper_commit_hw_done(state);
  185. }
  186. static void malidp_atomic_commit_tail(struct drm_atomic_state *state)
  187. {
  188. struct drm_device *drm = state->dev;
  189. struct drm_crtc *crtc;
  190. struct drm_crtc_state *old_crtc_state;
  191. int i;
  192. pm_runtime_get_sync(drm->dev);
  193. drm_atomic_helper_commit_modeset_disables(drm, state);
  194. for_each_old_crtc_in_state(state, crtc, old_crtc_state, i) {
  195. malidp_atomic_commit_update_gamma(crtc, old_crtc_state);
  196. malidp_atomic_commit_update_coloradj(crtc, old_crtc_state);
  197. malidp_atomic_commit_se_config(crtc, old_crtc_state);
  198. }
  199. drm_atomic_helper_commit_planes(drm, state, 0);
  200. drm_atomic_helper_commit_modeset_enables(drm, state);
  201. malidp_atomic_commit_hw_done(state);
  202. drm_atomic_helper_wait_for_vblanks(drm, state);
  203. pm_runtime_put(drm->dev);
  204. drm_atomic_helper_cleanup_planes(drm, state);
  205. }
  206. static const struct drm_mode_config_helper_funcs malidp_mode_config_helpers = {
  207. .atomic_commit_tail = malidp_atomic_commit_tail,
  208. };
  209. static const struct drm_mode_config_funcs malidp_mode_config_funcs = {
  210. .fb_create = drm_gem_fb_create,
  211. .output_poll_changed = malidp_output_poll_changed,
  212. .atomic_check = drm_atomic_helper_check,
  213. .atomic_commit = drm_atomic_helper_commit,
  214. };
  215. static int malidp_init(struct drm_device *drm)
  216. {
  217. int ret;
  218. struct malidp_drm *malidp = drm->dev_private;
  219. struct malidp_hw_device *hwdev = malidp->dev;
  220. drm_mode_config_init(drm);
  221. drm->mode_config.min_width = hwdev->min_line_size;
  222. drm->mode_config.min_height = hwdev->min_line_size;
  223. drm->mode_config.max_width = hwdev->max_line_size;
  224. drm->mode_config.max_height = hwdev->max_line_size;
  225. drm->mode_config.funcs = &malidp_mode_config_funcs;
  226. drm->mode_config.helper_private = &malidp_mode_config_helpers;
  227. ret = malidp_crtc_init(drm);
  228. if (ret) {
  229. drm_mode_config_cleanup(drm);
  230. return ret;
  231. }
  232. return 0;
  233. }
  234. static void malidp_fini(struct drm_device *drm)
  235. {
  236. malidp_de_planes_destroy(drm);
  237. drm_mode_config_cleanup(drm);
  238. }
  239. static int malidp_irq_init(struct platform_device *pdev)
  240. {
  241. int irq_de, irq_se, ret = 0;
  242. struct drm_device *drm = dev_get_drvdata(&pdev->dev);
  243. /* fetch the interrupts from DT */
  244. irq_de = platform_get_irq_byname(pdev, "DE");
  245. if (irq_de < 0) {
  246. DRM_ERROR("no 'DE' IRQ specified!\n");
  247. return irq_de;
  248. }
  249. irq_se = platform_get_irq_byname(pdev, "SE");
  250. if (irq_se < 0) {
  251. DRM_ERROR("no 'SE' IRQ specified!\n");
  252. return irq_se;
  253. }
  254. ret = malidp_de_irq_init(drm, irq_de);
  255. if (ret)
  256. return ret;
  257. ret = malidp_se_irq_init(drm, irq_se);
  258. if (ret) {
  259. malidp_de_irq_fini(drm);
  260. return ret;
  261. }
  262. return 0;
  263. }
  264. static void malidp_lastclose(struct drm_device *drm)
  265. {
  266. struct malidp_drm *malidp = drm->dev_private;
  267. drm_fbdev_cma_restore_mode(malidp->fbdev);
  268. }
  269. DEFINE_DRM_GEM_CMA_FOPS(fops);
  270. static struct drm_driver malidp_driver = {
  271. .driver_features = DRIVER_GEM | DRIVER_MODESET | DRIVER_ATOMIC |
  272. DRIVER_PRIME,
  273. .lastclose = malidp_lastclose,
  274. .gem_free_object_unlocked = drm_gem_cma_free_object,
  275. .gem_vm_ops = &drm_gem_cma_vm_ops,
  276. .dumb_create = drm_gem_cma_dumb_create,
  277. .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
  278. .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
  279. .gem_prime_export = drm_gem_prime_export,
  280. .gem_prime_import = drm_gem_prime_import,
  281. .gem_prime_get_sg_table = drm_gem_cma_prime_get_sg_table,
  282. .gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
  283. .gem_prime_vmap = drm_gem_cma_prime_vmap,
  284. .gem_prime_vunmap = drm_gem_cma_prime_vunmap,
  285. .gem_prime_mmap = drm_gem_cma_prime_mmap,
  286. .fops = &fops,
  287. .name = "mali-dp",
  288. .desc = "ARM Mali Display Processor driver",
  289. .date = "20160106",
  290. .major = 1,
  291. .minor = 0,
  292. };
  293. static const struct of_device_id malidp_drm_of_match[] = {
  294. {
  295. .compatible = "arm,mali-dp500",
  296. .data = &malidp_device[MALIDP_500]
  297. },
  298. {
  299. .compatible = "arm,mali-dp550",
  300. .data = &malidp_device[MALIDP_550]
  301. },
  302. {
  303. .compatible = "arm,mali-dp650",
  304. .data = &malidp_device[MALIDP_650]
  305. },
  306. {},
  307. };
  308. MODULE_DEVICE_TABLE(of, malidp_drm_of_match);
  309. static bool malidp_is_compatible_hw_id(struct malidp_hw_device *hwdev,
  310. const struct of_device_id *dev_id)
  311. {
  312. u32 core_id;
  313. const char *compatstr_dp500 = "arm,mali-dp500";
  314. bool is_dp500;
  315. bool dt_is_dp500;
  316. /*
  317. * The DP500 CORE_ID register is in a different location, so check it
  318. * first. If the product id field matches, then this is DP500, otherwise
  319. * check the DP550/650 CORE_ID register.
  320. */
  321. core_id = malidp_hw_read(hwdev, MALIDP500_DC_BASE + MALIDP_DE_CORE_ID);
  322. /* Offset 0x18 will never read 0x500 on products other than DP500. */
  323. is_dp500 = (MALIDP_PRODUCT_ID(core_id) == 0x500);
  324. dt_is_dp500 = strnstr(dev_id->compatible, compatstr_dp500,
  325. sizeof(dev_id->compatible)) != NULL;
  326. if (is_dp500 != dt_is_dp500) {
  327. DRM_ERROR("Device-tree expects %s, but hardware %s DP500.\n",
  328. dev_id->compatible, is_dp500 ? "is" : "is not");
  329. return false;
  330. } else if (!dt_is_dp500) {
  331. u16 product_id;
  332. char buf[32];
  333. core_id = malidp_hw_read(hwdev,
  334. MALIDP550_DC_BASE + MALIDP_DE_CORE_ID);
  335. product_id = MALIDP_PRODUCT_ID(core_id);
  336. snprintf(buf, sizeof(buf), "arm,mali-dp%X", product_id);
  337. if (!strnstr(dev_id->compatible, buf,
  338. sizeof(dev_id->compatible))) {
  339. DRM_ERROR("Device-tree expects %s, but hardware is DP%03X.\n",
  340. dev_id->compatible, product_id);
  341. return false;
  342. }
  343. }
  344. return true;
  345. }
  346. static bool malidp_has_sufficient_address_space(const struct resource *res,
  347. const struct of_device_id *dev_id)
  348. {
  349. resource_size_t res_size = resource_size(res);
  350. const char *compatstr_dp500 = "arm,mali-dp500";
  351. if (!strnstr(dev_id->compatible, compatstr_dp500,
  352. sizeof(dev_id->compatible)))
  353. return res_size >= MALIDP550_ADDR_SPACE_SIZE;
  354. else if (res_size < MALIDP500_ADDR_SPACE_SIZE)
  355. return false;
  356. return true;
  357. }
  358. static ssize_t core_id_show(struct device *dev, struct device_attribute *attr,
  359. char *buf)
  360. {
  361. struct drm_device *drm = dev_get_drvdata(dev);
  362. struct malidp_drm *malidp = drm->dev_private;
  363. return snprintf(buf, PAGE_SIZE, "%08x\n", malidp->core_id);
  364. }
  365. DEVICE_ATTR_RO(core_id);
  366. static int malidp_init_sysfs(struct device *dev)
  367. {
  368. int ret = device_create_file(dev, &dev_attr_core_id);
  369. if (ret)
  370. DRM_ERROR("failed to create device file for core_id\n");
  371. return ret;
  372. }
  373. static void malidp_fini_sysfs(struct device *dev)
  374. {
  375. device_remove_file(dev, &dev_attr_core_id);
  376. }
  377. #define MAX_OUTPUT_CHANNELS 3
  378. static int malidp_runtime_pm_suspend(struct device *dev)
  379. {
  380. struct drm_device *drm = dev_get_drvdata(dev);
  381. struct malidp_drm *malidp = drm->dev_private;
  382. struct malidp_hw_device *hwdev = malidp->dev;
  383. /* we can only suspend if the hardware is in config mode */
  384. WARN_ON(!hwdev->hw->in_config_mode(hwdev));
  385. hwdev->pm_suspended = true;
  386. clk_disable_unprepare(hwdev->mclk);
  387. clk_disable_unprepare(hwdev->aclk);
  388. clk_disable_unprepare(hwdev->pclk);
  389. return 0;
  390. }
  391. static int malidp_runtime_pm_resume(struct device *dev)
  392. {
  393. struct drm_device *drm = dev_get_drvdata(dev);
  394. struct malidp_drm *malidp = drm->dev_private;
  395. struct malidp_hw_device *hwdev = malidp->dev;
  396. clk_prepare_enable(hwdev->pclk);
  397. clk_prepare_enable(hwdev->aclk);
  398. clk_prepare_enable(hwdev->mclk);
  399. hwdev->pm_suspended = false;
  400. return 0;
  401. }
  402. static int malidp_bind(struct device *dev)
  403. {
  404. struct resource *res;
  405. struct drm_device *drm;
  406. struct malidp_drm *malidp;
  407. struct malidp_hw_device *hwdev;
  408. struct platform_device *pdev = to_platform_device(dev);
  409. struct of_device_id const *dev_id;
  410. /* number of lines for the R, G and B output */
  411. u8 output_width[MAX_OUTPUT_CHANNELS];
  412. int ret = 0, i;
  413. u32 version, out_depth = 0;
  414. malidp = devm_kzalloc(dev, sizeof(*malidp), GFP_KERNEL);
  415. if (!malidp)
  416. return -ENOMEM;
  417. hwdev = devm_kzalloc(dev, sizeof(*hwdev), GFP_KERNEL);
  418. if (!hwdev)
  419. return -ENOMEM;
  420. hwdev->hw = (struct malidp_hw *)of_device_get_match_data(dev);
  421. malidp->dev = hwdev;
  422. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  423. hwdev->regs = devm_ioremap_resource(dev, res);
  424. if (IS_ERR(hwdev->regs))
  425. return PTR_ERR(hwdev->regs);
  426. hwdev->pclk = devm_clk_get(dev, "pclk");
  427. if (IS_ERR(hwdev->pclk))
  428. return PTR_ERR(hwdev->pclk);
  429. hwdev->aclk = devm_clk_get(dev, "aclk");
  430. if (IS_ERR(hwdev->aclk))
  431. return PTR_ERR(hwdev->aclk);
  432. hwdev->mclk = devm_clk_get(dev, "mclk");
  433. if (IS_ERR(hwdev->mclk))
  434. return PTR_ERR(hwdev->mclk);
  435. hwdev->pxlclk = devm_clk_get(dev, "pxlclk");
  436. if (IS_ERR(hwdev->pxlclk))
  437. return PTR_ERR(hwdev->pxlclk);
  438. /* Get the optional framebuffer memory resource */
  439. ret = of_reserved_mem_device_init(dev);
  440. if (ret && ret != -ENODEV)
  441. return ret;
  442. drm = drm_dev_alloc(&malidp_driver, dev);
  443. if (IS_ERR(drm)) {
  444. ret = PTR_ERR(drm);
  445. goto alloc_fail;
  446. }
  447. drm->dev_private = malidp;
  448. dev_set_drvdata(dev, drm);
  449. /* Enable power management */
  450. pm_runtime_enable(dev);
  451. /* Resume device to enable the clocks */
  452. if (pm_runtime_enabled(dev))
  453. pm_runtime_get_sync(dev);
  454. else
  455. malidp_runtime_pm_resume(dev);
  456. dev_id = of_match_device(malidp_drm_of_match, dev);
  457. if (!dev_id) {
  458. ret = -EINVAL;
  459. goto query_hw_fail;
  460. }
  461. if (!malidp_has_sufficient_address_space(res, dev_id)) {
  462. DRM_ERROR("Insufficient address space in device-tree.\n");
  463. ret = -EINVAL;
  464. goto query_hw_fail;
  465. }
  466. if (!malidp_is_compatible_hw_id(hwdev, dev_id)) {
  467. ret = -EINVAL;
  468. goto query_hw_fail;
  469. }
  470. ret = hwdev->hw->query_hw(hwdev);
  471. if (ret) {
  472. DRM_ERROR("Invalid HW configuration\n");
  473. goto query_hw_fail;
  474. }
  475. version = malidp_hw_read(hwdev, hwdev->hw->map.dc_base + MALIDP_DE_CORE_ID);
  476. DRM_INFO("found ARM Mali-DP%3x version r%dp%d\n", version >> 16,
  477. (version >> 12) & 0xf, (version >> 8) & 0xf);
  478. malidp->core_id = version;
  479. /* set the number of lines used for output of RGB data */
  480. ret = of_property_read_u8_array(dev->of_node,
  481. "arm,malidp-output-port-lines",
  482. output_width, MAX_OUTPUT_CHANNELS);
  483. if (ret)
  484. goto query_hw_fail;
  485. for (i = 0; i < MAX_OUTPUT_CHANNELS; i++)
  486. out_depth = (out_depth << 8) | (output_width[i] & 0xf);
  487. malidp_hw_write(hwdev, out_depth, hwdev->hw->map.out_depth_base);
  488. atomic_set(&malidp->config_valid, 0);
  489. init_waitqueue_head(&malidp->wq);
  490. ret = malidp_init(drm);
  491. if (ret < 0)
  492. goto query_hw_fail;
  493. ret = malidp_init_sysfs(dev);
  494. if (ret)
  495. goto init_fail;
  496. /* Set the CRTC's port so that the encoder component can find it */
  497. malidp->crtc.port = of_graph_get_port_by_id(dev->of_node, 0);
  498. ret = component_bind_all(dev, drm);
  499. if (ret) {
  500. DRM_ERROR("Failed to bind all components\n");
  501. goto bind_fail;
  502. }
  503. ret = malidp_irq_init(pdev);
  504. if (ret < 0)
  505. goto irq_init_fail;
  506. drm->irq_enabled = true;
  507. ret = drm_vblank_init(drm, drm->mode_config.num_crtc);
  508. if (ret < 0) {
  509. DRM_ERROR("failed to initialise vblank\n");
  510. goto vblank_fail;
  511. }
  512. pm_runtime_put(dev);
  513. drm_mode_config_reset(drm);
  514. malidp->fbdev = drm_fbdev_cma_init(drm, 32,
  515. drm->mode_config.num_connector);
  516. if (IS_ERR(malidp->fbdev)) {
  517. ret = PTR_ERR(malidp->fbdev);
  518. malidp->fbdev = NULL;
  519. goto fbdev_fail;
  520. }
  521. drm_kms_helper_poll_init(drm);
  522. ret = drm_dev_register(drm, 0);
  523. if (ret)
  524. goto register_fail;
  525. return 0;
  526. register_fail:
  527. if (malidp->fbdev) {
  528. drm_fbdev_cma_fini(malidp->fbdev);
  529. malidp->fbdev = NULL;
  530. }
  531. drm_kms_helper_poll_fini(drm);
  532. fbdev_fail:
  533. pm_runtime_get_sync(dev);
  534. vblank_fail:
  535. malidp_se_irq_fini(drm);
  536. malidp_de_irq_fini(drm);
  537. drm->irq_enabled = false;
  538. irq_init_fail:
  539. component_unbind_all(dev, drm);
  540. bind_fail:
  541. of_node_put(malidp->crtc.port);
  542. malidp->crtc.port = NULL;
  543. init_fail:
  544. malidp_fini_sysfs(dev);
  545. malidp_fini(drm);
  546. query_hw_fail:
  547. pm_runtime_put(dev);
  548. if (pm_runtime_enabled(dev))
  549. pm_runtime_disable(dev);
  550. else
  551. malidp_runtime_pm_suspend(dev);
  552. drm->dev_private = NULL;
  553. dev_set_drvdata(dev, NULL);
  554. drm_dev_put(drm);
  555. alloc_fail:
  556. of_reserved_mem_device_release(dev);
  557. return ret;
  558. }
  559. static void malidp_unbind(struct device *dev)
  560. {
  561. struct drm_device *drm = dev_get_drvdata(dev);
  562. struct malidp_drm *malidp = drm->dev_private;
  563. drm_dev_unregister(drm);
  564. if (malidp->fbdev) {
  565. drm_fbdev_cma_fini(malidp->fbdev);
  566. malidp->fbdev = NULL;
  567. }
  568. drm_kms_helper_poll_fini(drm);
  569. pm_runtime_get_sync(dev);
  570. malidp_se_irq_fini(drm);
  571. malidp_de_irq_fini(drm);
  572. component_unbind_all(dev, drm);
  573. of_node_put(malidp->crtc.port);
  574. malidp->crtc.port = NULL;
  575. malidp_fini_sysfs(dev);
  576. malidp_fini(drm);
  577. pm_runtime_put(dev);
  578. if (pm_runtime_enabled(dev))
  579. pm_runtime_disable(dev);
  580. else
  581. malidp_runtime_pm_suspend(dev);
  582. drm->dev_private = NULL;
  583. dev_set_drvdata(dev, NULL);
  584. drm_dev_put(drm);
  585. of_reserved_mem_device_release(dev);
  586. }
  587. static const struct component_master_ops malidp_master_ops = {
  588. .bind = malidp_bind,
  589. .unbind = malidp_unbind,
  590. };
  591. static int malidp_compare_dev(struct device *dev, void *data)
  592. {
  593. struct device_node *np = data;
  594. return dev->of_node == np;
  595. }
  596. static int malidp_platform_probe(struct platform_device *pdev)
  597. {
  598. struct device_node *port;
  599. struct component_match *match = NULL;
  600. if (!pdev->dev.of_node)
  601. return -ENODEV;
  602. /* there is only one output port inside each device, find it */
  603. port = of_graph_get_remote_node(pdev->dev.of_node, 0, 0);
  604. if (!port)
  605. return -ENODEV;
  606. drm_of_component_match_add(&pdev->dev, &match, malidp_compare_dev,
  607. port);
  608. of_node_put(port);
  609. return component_master_add_with_match(&pdev->dev, &malidp_master_ops,
  610. match);
  611. }
  612. static int malidp_platform_remove(struct platform_device *pdev)
  613. {
  614. component_master_del(&pdev->dev, &malidp_master_ops);
  615. return 0;
  616. }
  617. static int __maybe_unused malidp_pm_suspend(struct device *dev)
  618. {
  619. struct drm_device *drm = dev_get_drvdata(dev);
  620. return drm_mode_config_helper_suspend(drm);
  621. }
  622. static int __maybe_unused malidp_pm_resume(struct device *dev)
  623. {
  624. struct drm_device *drm = dev_get_drvdata(dev);
  625. drm_mode_config_helper_resume(drm);
  626. return 0;
  627. }
  628. static const struct dev_pm_ops malidp_pm_ops = {
  629. SET_SYSTEM_SLEEP_PM_OPS(malidp_pm_suspend, malidp_pm_resume) \
  630. SET_RUNTIME_PM_OPS(malidp_runtime_pm_suspend, malidp_runtime_pm_resume, NULL)
  631. };
  632. static struct platform_driver malidp_platform_driver = {
  633. .probe = malidp_platform_probe,
  634. .remove = malidp_platform_remove,
  635. .driver = {
  636. .name = "mali-dp",
  637. .pm = &malidp_pm_ops,
  638. .of_match_table = malidp_drm_of_match,
  639. },
  640. };
  641. module_platform_driver(malidp_platform_driver);
  642. MODULE_AUTHOR("Liviu Dudau <Liviu.Dudau@arm.com>");
  643. MODULE_DESCRIPTION("ARM Mali DP DRM driver");
  644. MODULE_LICENSE("GPL v2");