dce_virtual.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823
  1. /*
  2. * Copyright 2014 Advanced Micro Devices, Inc.
  3. *
  4. * Permission is hereby granted, free of charge, to any person obtaining a
  5. * copy of this software and associated documentation files (the "Software"),
  6. * to deal in the Software without restriction, including without limitation
  7. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8. * and/or sell copies of the Software, and to permit persons to whom the
  9. * Software is furnished to do so, subject to the following conditions:
  10. *
  11. * The above copyright notice and this permission notice shall be included in
  12. * all copies or substantial portions of the Software.
  13. *
  14. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  17. * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18. * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19. * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20. * OTHER DEALINGS IN THE SOFTWARE.
  21. *
  22. */
  23. #include "drmP.h"
  24. #include "amdgpu.h"
  25. #include "amdgpu_pm.h"
  26. #include "amdgpu_i2c.h"
  27. #include "atom.h"
  28. #include "amdgpu_pll.h"
  29. #include "amdgpu_connectors.h"
  30. #ifdef CONFIG_DRM_AMDGPU_SI
  31. #include "dce_v6_0.h"
  32. #endif
  33. #ifdef CONFIG_DRM_AMDGPU_CIK
  34. #include "dce_v8_0.h"
  35. #endif
  36. #include "dce_v10_0.h"
  37. #include "dce_v11_0.h"
  38. #include "dce_virtual.h"
  39. static void dce_virtual_set_display_funcs(struct amdgpu_device *adev);
  40. static void dce_virtual_set_irq_funcs(struct amdgpu_device *adev);
  41. static int dce_virtual_connector_encoder_init(struct amdgpu_device *adev,
  42. int index);
  43. /**
  44. * dce_virtual_vblank_wait - vblank wait asic callback.
  45. *
  46. * @adev: amdgpu_device pointer
  47. * @crtc: crtc to wait for vblank on
  48. *
  49. * Wait for vblank on the requested crtc (evergreen+).
  50. */
  51. static void dce_virtual_vblank_wait(struct amdgpu_device *adev, int crtc)
  52. {
  53. return;
  54. }
  55. static u32 dce_virtual_vblank_get_counter(struct amdgpu_device *adev, int crtc)
  56. {
  57. return 0;
  58. }
  59. static void dce_virtual_page_flip(struct amdgpu_device *adev,
  60. int crtc_id, u64 crtc_base, bool async)
  61. {
  62. return;
  63. }
  64. static int dce_virtual_crtc_get_scanoutpos(struct amdgpu_device *adev, int crtc,
  65. u32 *vbl, u32 *position)
  66. {
  67. *vbl = 0;
  68. *position = 0;
  69. return -EINVAL;
  70. }
  71. static bool dce_virtual_hpd_sense(struct amdgpu_device *adev,
  72. enum amdgpu_hpd_id hpd)
  73. {
  74. return true;
  75. }
  76. static void dce_virtual_hpd_set_polarity(struct amdgpu_device *adev,
  77. enum amdgpu_hpd_id hpd)
  78. {
  79. return;
  80. }
  81. static u32 dce_virtual_hpd_get_gpio_reg(struct amdgpu_device *adev)
  82. {
  83. return 0;
  84. }
  85. static bool dce_virtual_is_display_hung(struct amdgpu_device *adev)
  86. {
  87. return false;
  88. }
  89. static void dce_virtual_stop_mc_access(struct amdgpu_device *adev,
  90. struct amdgpu_mode_mc_save *save)
  91. {
  92. switch (adev->asic_type) {
  93. #ifdef CONFIG_DRM_AMDGPU_SI
  94. case CHIP_TAHITI:
  95. case CHIP_PITCAIRN:
  96. case CHIP_VERDE:
  97. case CHIP_OLAND:
  98. dce_v6_0_disable_dce(adev);
  99. break;
  100. #endif
  101. #ifdef CONFIG_DRM_AMDGPU_CIK
  102. case CHIP_BONAIRE:
  103. case CHIP_HAWAII:
  104. case CHIP_KAVERI:
  105. case CHIP_KABINI:
  106. case CHIP_MULLINS:
  107. dce_v8_0_disable_dce(adev);
  108. break;
  109. #endif
  110. case CHIP_FIJI:
  111. case CHIP_TONGA:
  112. dce_v10_0_disable_dce(adev);
  113. break;
  114. case CHIP_CARRIZO:
  115. case CHIP_STONEY:
  116. case CHIP_POLARIS11:
  117. case CHIP_POLARIS10:
  118. dce_v11_0_disable_dce(adev);
  119. break;
  120. case CHIP_TOPAZ:
  121. #ifdef CONFIG_DRM_AMDGPU_SI
  122. case CHIP_HAINAN:
  123. #endif
  124. /* no DCE */
  125. return;
  126. default:
  127. DRM_ERROR("Virtual display unsupported ASIC type: 0x%X\n", adev->asic_type);
  128. }
  129. return;
  130. }
  131. static void dce_virtual_resume_mc_access(struct amdgpu_device *adev,
  132. struct amdgpu_mode_mc_save *save)
  133. {
  134. return;
  135. }
  136. static void dce_virtual_set_vga_render_state(struct amdgpu_device *adev,
  137. bool render)
  138. {
  139. return;
  140. }
  141. /**
  142. * dce_virtual_bandwidth_update - program display watermarks
  143. *
  144. * @adev: amdgpu_device pointer
  145. *
  146. * Calculate and program the display watermarks and line
  147. * buffer allocation (CIK).
  148. */
  149. static void dce_virtual_bandwidth_update(struct amdgpu_device *adev)
  150. {
  151. return;
  152. }
  153. static int dce_virtual_crtc_gamma_set(struct drm_crtc *crtc, u16 *red,
  154. u16 *green, u16 *blue, uint32_t size)
  155. {
  156. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  157. int i;
  158. /* userspace palettes are always correct as is */
  159. for (i = 0; i < size; i++) {
  160. amdgpu_crtc->lut_r[i] = red[i] >> 6;
  161. amdgpu_crtc->lut_g[i] = green[i] >> 6;
  162. amdgpu_crtc->lut_b[i] = blue[i] >> 6;
  163. }
  164. return 0;
  165. }
  166. static void dce_virtual_crtc_destroy(struct drm_crtc *crtc)
  167. {
  168. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  169. drm_crtc_cleanup(crtc);
  170. kfree(amdgpu_crtc);
  171. }
  172. static const struct drm_crtc_funcs dce_virtual_crtc_funcs = {
  173. .cursor_set2 = NULL,
  174. .cursor_move = NULL,
  175. .gamma_set = dce_virtual_crtc_gamma_set,
  176. .set_config = amdgpu_crtc_set_config,
  177. .destroy = dce_virtual_crtc_destroy,
  178. .page_flip_target = amdgpu_crtc_page_flip_target,
  179. };
  180. static void dce_virtual_crtc_dpms(struct drm_crtc *crtc, int mode)
  181. {
  182. struct drm_device *dev = crtc->dev;
  183. struct amdgpu_device *adev = dev->dev_private;
  184. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  185. unsigned type;
  186. switch (mode) {
  187. case DRM_MODE_DPMS_ON:
  188. amdgpu_crtc->enabled = true;
  189. /* Make sure VBLANK interrupts are still enabled */
  190. type = amdgpu_crtc_idx_to_irq_type(adev, amdgpu_crtc->crtc_id);
  191. amdgpu_irq_update(adev, &adev->crtc_irq, type);
  192. drm_vblank_on(dev, amdgpu_crtc->crtc_id);
  193. break;
  194. case DRM_MODE_DPMS_STANDBY:
  195. case DRM_MODE_DPMS_SUSPEND:
  196. case DRM_MODE_DPMS_OFF:
  197. drm_vblank_off(dev, amdgpu_crtc->crtc_id);
  198. amdgpu_crtc->enabled = false;
  199. break;
  200. }
  201. }
  202. static void dce_virtual_crtc_prepare(struct drm_crtc *crtc)
  203. {
  204. dce_virtual_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  205. }
  206. static void dce_virtual_crtc_commit(struct drm_crtc *crtc)
  207. {
  208. dce_virtual_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
  209. }
  210. static void dce_virtual_crtc_disable(struct drm_crtc *crtc)
  211. {
  212. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  213. dce_virtual_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  214. if (crtc->primary->fb) {
  215. int r;
  216. struct amdgpu_framebuffer *amdgpu_fb;
  217. struct amdgpu_bo *abo;
  218. amdgpu_fb = to_amdgpu_framebuffer(crtc->primary->fb);
  219. abo = gem_to_amdgpu_bo(amdgpu_fb->obj);
  220. r = amdgpu_bo_reserve(abo, false);
  221. if (unlikely(r))
  222. DRM_ERROR("failed to reserve abo before unpin\n");
  223. else {
  224. amdgpu_bo_unpin(abo);
  225. amdgpu_bo_unreserve(abo);
  226. }
  227. }
  228. amdgpu_crtc->pll_id = ATOM_PPLL_INVALID;
  229. amdgpu_crtc->encoder = NULL;
  230. amdgpu_crtc->connector = NULL;
  231. }
  232. static int dce_virtual_crtc_mode_set(struct drm_crtc *crtc,
  233. struct drm_display_mode *mode,
  234. struct drm_display_mode *adjusted_mode,
  235. int x, int y, struct drm_framebuffer *old_fb)
  236. {
  237. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  238. /* update the hw version fpr dpm */
  239. amdgpu_crtc->hw_mode = *adjusted_mode;
  240. return 0;
  241. }
  242. static bool dce_virtual_crtc_mode_fixup(struct drm_crtc *crtc,
  243. const struct drm_display_mode *mode,
  244. struct drm_display_mode *adjusted_mode)
  245. {
  246. return true;
  247. }
  248. static int dce_virtual_crtc_set_base(struct drm_crtc *crtc, int x, int y,
  249. struct drm_framebuffer *old_fb)
  250. {
  251. return 0;
  252. }
  253. static void dce_virtual_crtc_load_lut(struct drm_crtc *crtc)
  254. {
  255. return;
  256. }
  257. static int dce_virtual_crtc_set_base_atomic(struct drm_crtc *crtc,
  258. struct drm_framebuffer *fb,
  259. int x, int y, enum mode_set_atomic state)
  260. {
  261. return 0;
  262. }
  263. static const struct drm_crtc_helper_funcs dce_virtual_crtc_helper_funcs = {
  264. .dpms = dce_virtual_crtc_dpms,
  265. .mode_fixup = dce_virtual_crtc_mode_fixup,
  266. .mode_set = dce_virtual_crtc_mode_set,
  267. .mode_set_base = dce_virtual_crtc_set_base,
  268. .mode_set_base_atomic = dce_virtual_crtc_set_base_atomic,
  269. .prepare = dce_virtual_crtc_prepare,
  270. .commit = dce_virtual_crtc_commit,
  271. .load_lut = dce_virtual_crtc_load_lut,
  272. .disable = dce_virtual_crtc_disable,
  273. };
  274. static int dce_virtual_crtc_init(struct amdgpu_device *adev, int index)
  275. {
  276. struct amdgpu_crtc *amdgpu_crtc;
  277. int i;
  278. amdgpu_crtc = kzalloc(sizeof(struct amdgpu_crtc) +
  279. (AMDGPUFB_CONN_LIMIT * sizeof(struct drm_connector *)), GFP_KERNEL);
  280. if (amdgpu_crtc == NULL)
  281. return -ENOMEM;
  282. drm_crtc_init(adev->ddev, &amdgpu_crtc->base, &dce_virtual_crtc_funcs);
  283. drm_mode_crtc_set_gamma_size(&amdgpu_crtc->base, 256);
  284. amdgpu_crtc->crtc_id = index;
  285. adev->mode_info.crtcs[index] = amdgpu_crtc;
  286. for (i = 0; i < 256; i++) {
  287. amdgpu_crtc->lut_r[i] = i << 2;
  288. amdgpu_crtc->lut_g[i] = i << 2;
  289. amdgpu_crtc->lut_b[i] = i << 2;
  290. }
  291. amdgpu_crtc->pll_id = ATOM_PPLL_INVALID;
  292. amdgpu_crtc->encoder = NULL;
  293. amdgpu_crtc->connector = NULL;
  294. amdgpu_crtc->vsync_timer_enabled = AMDGPU_IRQ_STATE_DISABLE;
  295. drm_crtc_helper_add(&amdgpu_crtc->base, &dce_virtual_crtc_helper_funcs);
  296. return 0;
  297. }
  298. static int dce_virtual_early_init(void *handle)
  299. {
  300. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  301. dce_virtual_set_display_funcs(adev);
  302. dce_virtual_set_irq_funcs(adev);
  303. adev->mode_info.num_hpd = 1;
  304. adev->mode_info.num_dig = 1;
  305. return 0;
  306. }
  307. static struct drm_encoder *
  308. dce_virtual_encoder(struct drm_connector *connector)
  309. {
  310. int enc_id = connector->encoder_ids[0];
  311. struct drm_encoder *encoder;
  312. int i;
  313. for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++) {
  314. if (connector->encoder_ids[i] == 0)
  315. break;
  316. encoder = drm_encoder_find(connector->dev, connector->encoder_ids[i]);
  317. if (!encoder)
  318. continue;
  319. if (encoder->encoder_type == DRM_MODE_ENCODER_VIRTUAL)
  320. return encoder;
  321. }
  322. /* pick the first one */
  323. if (enc_id)
  324. return drm_encoder_find(connector->dev, enc_id);
  325. return NULL;
  326. }
  327. static int dce_virtual_get_modes(struct drm_connector *connector)
  328. {
  329. struct drm_device *dev = connector->dev;
  330. struct drm_display_mode *mode = NULL;
  331. unsigned i;
  332. static const struct mode_size {
  333. int w;
  334. int h;
  335. } common_modes[17] = {
  336. { 640, 480},
  337. { 720, 480},
  338. { 800, 600},
  339. { 848, 480},
  340. {1024, 768},
  341. {1152, 768},
  342. {1280, 720},
  343. {1280, 800},
  344. {1280, 854},
  345. {1280, 960},
  346. {1280, 1024},
  347. {1440, 900},
  348. {1400, 1050},
  349. {1680, 1050},
  350. {1600, 1200},
  351. {1920, 1080},
  352. {1920, 1200}
  353. };
  354. for (i = 0; i < 17; i++) {
  355. mode = drm_cvt_mode(dev, common_modes[i].w, common_modes[i].h, 60, false, false, false);
  356. drm_mode_probed_add(connector, mode);
  357. }
  358. return 0;
  359. }
  360. static int dce_virtual_mode_valid(struct drm_connector *connector,
  361. struct drm_display_mode *mode)
  362. {
  363. return MODE_OK;
  364. }
  365. static int
  366. dce_virtual_dpms(struct drm_connector *connector, int mode)
  367. {
  368. return 0;
  369. }
  370. static enum drm_connector_status
  371. dce_virtual_detect(struct drm_connector *connector, bool force)
  372. {
  373. return connector_status_connected;
  374. }
  375. static int
  376. dce_virtual_set_property(struct drm_connector *connector,
  377. struct drm_property *property,
  378. uint64_t val)
  379. {
  380. return 0;
  381. }
  382. static void dce_virtual_destroy(struct drm_connector *connector)
  383. {
  384. drm_connector_unregister(connector);
  385. drm_connector_cleanup(connector);
  386. kfree(connector);
  387. }
  388. static void dce_virtual_force(struct drm_connector *connector)
  389. {
  390. return;
  391. }
  392. static const struct drm_connector_helper_funcs dce_virtual_connector_helper_funcs = {
  393. .get_modes = dce_virtual_get_modes,
  394. .mode_valid = dce_virtual_mode_valid,
  395. .best_encoder = dce_virtual_encoder,
  396. };
  397. static const struct drm_connector_funcs dce_virtual_connector_funcs = {
  398. .dpms = dce_virtual_dpms,
  399. .detect = dce_virtual_detect,
  400. .fill_modes = drm_helper_probe_single_connector_modes,
  401. .set_property = dce_virtual_set_property,
  402. .destroy = dce_virtual_destroy,
  403. .force = dce_virtual_force,
  404. };
  405. static int dce_virtual_sw_init(void *handle)
  406. {
  407. int r, i;
  408. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  409. r = amdgpu_irq_add_id(adev, 229, &adev->crtc_irq);
  410. if (r)
  411. return r;
  412. adev->ddev->max_vblank_count = 0;
  413. adev->ddev->mode_config.funcs = &amdgpu_mode_funcs;
  414. adev->ddev->mode_config.max_width = 16384;
  415. adev->ddev->mode_config.max_height = 16384;
  416. adev->ddev->mode_config.preferred_depth = 24;
  417. adev->ddev->mode_config.prefer_shadow = 1;
  418. adev->ddev->mode_config.fb_base = adev->mc.aper_base;
  419. r = amdgpu_modeset_create_props(adev);
  420. if (r)
  421. return r;
  422. adev->ddev->mode_config.max_width = 16384;
  423. adev->ddev->mode_config.max_height = 16384;
  424. /* allocate crtcs, encoders, connectors */
  425. for (i = 0; i < adev->mode_info.num_crtc; i++) {
  426. r = dce_virtual_crtc_init(adev, i);
  427. if (r)
  428. return r;
  429. r = dce_virtual_connector_encoder_init(adev, i);
  430. if (r)
  431. return r;
  432. }
  433. drm_kms_helper_poll_init(adev->ddev);
  434. adev->mode_info.mode_config_initialized = true;
  435. return 0;
  436. }
  437. static int dce_virtual_sw_fini(void *handle)
  438. {
  439. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  440. kfree(adev->mode_info.bios_hardcoded_edid);
  441. drm_kms_helper_poll_fini(adev->ddev);
  442. drm_mode_config_cleanup(adev->ddev);
  443. adev->mode_info.mode_config_initialized = false;
  444. return 0;
  445. }
  446. static int dce_virtual_hw_init(void *handle)
  447. {
  448. return 0;
  449. }
  450. static int dce_virtual_hw_fini(void *handle)
  451. {
  452. return 0;
  453. }
  454. static int dce_virtual_suspend(void *handle)
  455. {
  456. return dce_virtual_hw_fini(handle);
  457. }
  458. static int dce_virtual_resume(void *handle)
  459. {
  460. return dce_virtual_hw_init(handle);
  461. }
  462. static bool dce_virtual_is_idle(void *handle)
  463. {
  464. return true;
  465. }
  466. static int dce_virtual_wait_for_idle(void *handle)
  467. {
  468. return 0;
  469. }
  470. static int dce_virtual_soft_reset(void *handle)
  471. {
  472. return 0;
  473. }
  474. static int dce_virtual_set_clockgating_state(void *handle,
  475. enum amd_clockgating_state state)
  476. {
  477. return 0;
  478. }
  479. static int dce_virtual_set_powergating_state(void *handle,
  480. enum amd_powergating_state state)
  481. {
  482. return 0;
  483. }
  484. const struct amd_ip_funcs dce_virtual_ip_funcs = {
  485. .name = "dce_virtual",
  486. .early_init = dce_virtual_early_init,
  487. .late_init = NULL,
  488. .sw_init = dce_virtual_sw_init,
  489. .sw_fini = dce_virtual_sw_fini,
  490. .hw_init = dce_virtual_hw_init,
  491. .hw_fini = dce_virtual_hw_fini,
  492. .suspend = dce_virtual_suspend,
  493. .resume = dce_virtual_resume,
  494. .is_idle = dce_virtual_is_idle,
  495. .wait_for_idle = dce_virtual_wait_for_idle,
  496. .soft_reset = dce_virtual_soft_reset,
  497. .set_clockgating_state = dce_virtual_set_clockgating_state,
  498. .set_powergating_state = dce_virtual_set_powergating_state,
  499. };
  500. /* these are handled by the primary encoders */
  501. static void dce_virtual_encoder_prepare(struct drm_encoder *encoder)
  502. {
  503. return;
  504. }
  505. static void dce_virtual_encoder_commit(struct drm_encoder *encoder)
  506. {
  507. return;
  508. }
  509. static void
  510. dce_virtual_encoder_mode_set(struct drm_encoder *encoder,
  511. struct drm_display_mode *mode,
  512. struct drm_display_mode *adjusted_mode)
  513. {
  514. return;
  515. }
  516. static void dce_virtual_encoder_disable(struct drm_encoder *encoder)
  517. {
  518. return;
  519. }
  520. static void
  521. dce_virtual_encoder_dpms(struct drm_encoder *encoder, int mode)
  522. {
  523. return;
  524. }
  525. static bool dce_virtual_encoder_mode_fixup(struct drm_encoder *encoder,
  526. const struct drm_display_mode *mode,
  527. struct drm_display_mode *adjusted_mode)
  528. {
  529. return true;
  530. }
  531. static const struct drm_encoder_helper_funcs dce_virtual_encoder_helper_funcs = {
  532. .dpms = dce_virtual_encoder_dpms,
  533. .mode_fixup = dce_virtual_encoder_mode_fixup,
  534. .prepare = dce_virtual_encoder_prepare,
  535. .mode_set = dce_virtual_encoder_mode_set,
  536. .commit = dce_virtual_encoder_commit,
  537. .disable = dce_virtual_encoder_disable,
  538. };
  539. static void dce_virtual_encoder_destroy(struct drm_encoder *encoder)
  540. {
  541. struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
  542. kfree(amdgpu_encoder->enc_priv);
  543. drm_encoder_cleanup(encoder);
  544. kfree(amdgpu_encoder);
  545. }
  546. static const struct drm_encoder_funcs dce_virtual_encoder_funcs = {
  547. .destroy = dce_virtual_encoder_destroy,
  548. };
  549. static int dce_virtual_connector_encoder_init(struct amdgpu_device *adev,
  550. int index)
  551. {
  552. struct drm_encoder *encoder;
  553. struct drm_connector *connector;
  554. /* add a new encoder */
  555. encoder = kzalloc(sizeof(struct drm_encoder), GFP_KERNEL);
  556. if (!encoder)
  557. return -ENOMEM;
  558. encoder->possible_crtcs = 1 << index;
  559. drm_encoder_init(adev->ddev, encoder, &dce_virtual_encoder_funcs,
  560. DRM_MODE_ENCODER_VIRTUAL, NULL);
  561. drm_encoder_helper_add(encoder, &dce_virtual_encoder_helper_funcs);
  562. connector = kzalloc(sizeof(struct drm_connector), GFP_KERNEL);
  563. if (!connector) {
  564. kfree(encoder);
  565. return -ENOMEM;
  566. }
  567. /* add a new connector */
  568. drm_connector_init(adev->ddev, connector, &dce_virtual_connector_funcs,
  569. DRM_MODE_CONNECTOR_VIRTUAL);
  570. drm_connector_helper_add(connector, &dce_virtual_connector_helper_funcs);
  571. connector->display_info.subpixel_order = SubPixelHorizontalRGB;
  572. connector->interlace_allowed = false;
  573. connector->doublescan_allowed = false;
  574. drm_connector_register(connector);
  575. /* link them */
  576. drm_mode_connector_attach_encoder(connector, encoder);
  577. return 0;
  578. }
  579. static const struct amdgpu_display_funcs dce_virtual_display_funcs = {
  580. .set_vga_render_state = &dce_virtual_set_vga_render_state,
  581. .bandwidth_update = &dce_virtual_bandwidth_update,
  582. .vblank_get_counter = &dce_virtual_vblank_get_counter,
  583. .vblank_wait = &dce_virtual_vblank_wait,
  584. .is_display_hung = &dce_virtual_is_display_hung,
  585. .backlight_set_level = NULL,
  586. .backlight_get_level = NULL,
  587. .hpd_sense = &dce_virtual_hpd_sense,
  588. .hpd_set_polarity = &dce_virtual_hpd_set_polarity,
  589. .hpd_get_gpio_reg = &dce_virtual_hpd_get_gpio_reg,
  590. .page_flip = &dce_virtual_page_flip,
  591. .page_flip_get_scanoutpos = &dce_virtual_crtc_get_scanoutpos,
  592. .add_encoder = NULL,
  593. .add_connector = NULL,
  594. .stop_mc_access = &dce_virtual_stop_mc_access,
  595. .resume_mc_access = &dce_virtual_resume_mc_access,
  596. };
  597. static void dce_virtual_set_display_funcs(struct amdgpu_device *adev)
  598. {
  599. if (adev->mode_info.funcs == NULL)
  600. adev->mode_info.funcs = &dce_virtual_display_funcs;
  601. }
  602. static int dce_virtual_pageflip(struct amdgpu_device *adev,
  603. unsigned crtc_id)
  604. {
  605. unsigned long flags;
  606. struct amdgpu_crtc *amdgpu_crtc;
  607. struct amdgpu_flip_work *works;
  608. amdgpu_crtc = adev->mode_info.crtcs[crtc_id];
  609. if (crtc_id >= adev->mode_info.num_crtc) {
  610. DRM_ERROR("invalid pageflip crtc %d\n", crtc_id);
  611. return -EINVAL;
  612. }
  613. /* IRQ could occur when in initial stage */
  614. if (amdgpu_crtc == NULL)
  615. return 0;
  616. spin_lock_irqsave(&adev->ddev->event_lock, flags);
  617. works = amdgpu_crtc->pflip_works;
  618. if (amdgpu_crtc->pflip_status != AMDGPU_FLIP_SUBMITTED) {
  619. DRM_DEBUG_DRIVER("amdgpu_crtc->pflip_status = %d != "
  620. "AMDGPU_FLIP_SUBMITTED(%d)\n",
  621. amdgpu_crtc->pflip_status,
  622. AMDGPU_FLIP_SUBMITTED);
  623. spin_unlock_irqrestore(&adev->ddev->event_lock, flags);
  624. return 0;
  625. }
  626. /* page flip completed. clean up */
  627. amdgpu_crtc->pflip_status = AMDGPU_FLIP_NONE;
  628. amdgpu_crtc->pflip_works = NULL;
  629. /* wakeup usersapce */
  630. if (works->event)
  631. drm_crtc_send_vblank_event(&amdgpu_crtc->base, works->event);
  632. spin_unlock_irqrestore(&adev->ddev->event_lock, flags);
  633. drm_crtc_vblank_put(&amdgpu_crtc->base);
  634. schedule_work(&works->unpin_work);
  635. return 0;
  636. }
  637. static enum hrtimer_restart dce_virtual_vblank_timer_handle(struct hrtimer *vblank_timer)
  638. {
  639. struct amdgpu_crtc *amdgpu_crtc = container_of(vblank_timer,
  640. struct amdgpu_crtc, vblank_timer);
  641. struct drm_device *ddev = amdgpu_crtc->base.dev;
  642. struct amdgpu_device *adev = ddev->dev_private;
  643. drm_handle_vblank(ddev, amdgpu_crtc->crtc_id);
  644. dce_virtual_pageflip(adev, amdgpu_crtc->crtc_id);
  645. hrtimer_start(vblank_timer, ktime_set(0, DCE_VIRTUAL_VBLANK_PERIOD),
  646. HRTIMER_MODE_REL);
  647. return HRTIMER_NORESTART;
  648. }
  649. static void dce_virtual_set_crtc_vblank_interrupt_state(struct amdgpu_device *adev,
  650. int crtc,
  651. enum amdgpu_interrupt_state state)
  652. {
  653. if (crtc >= adev->mode_info.num_crtc) {
  654. DRM_DEBUG("invalid crtc %d\n", crtc);
  655. return;
  656. }
  657. if (state && !adev->mode_info.crtcs[crtc]->vsync_timer_enabled) {
  658. DRM_DEBUG("Enable software vsync timer\n");
  659. hrtimer_init(&adev->mode_info.crtcs[crtc]->vblank_timer,
  660. CLOCK_MONOTONIC, HRTIMER_MODE_REL);
  661. hrtimer_set_expires(&adev->mode_info.crtcs[crtc]->vblank_timer,
  662. ktime_set(0, DCE_VIRTUAL_VBLANK_PERIOD));
  663. adev->mode_info.crtcs[crtc]->vblank_timer.function =
  664. dce_virtual_vblank_timer_handle;
  665. hrtimer_start(&adev->mode_info.crtcs[crtc]->vblank_timer,
  666. ktime_set(0, DCE_VIRTUAL_VBLANK_PERIOD), HRTIMER_MODE_REL);
  667. } else if (!state && adev->mode_info.crtcs[crtc]->vsync_timer_enabled) {
  668. DRM_DEBUG("Disable software vsync timer\n");
  669. hrtimer_cancel(&adev->mode_info.crtcs[crtc]->vblank_timer);
  670. }
  671. adev->mode_info.crtcs[crtc]->vsync_timer_enabled = state;
  672. DRM_DEBUG("[FM]set crtc %d vblank interrupt state %d\n", crtc, state);
  673. }
  674. static int dce_virtual_set_crtc_irq_state(struct amdgpu_device *adev,
  675. struct amdgpu_irq_src *source,
  676. unsigned type,
  677. enum amdgpu_interrupt_state state)
  678. {
  679. if (type > AMDGPU_CRTC_IRQ_VBLANK6)
  680. return -EINVAL;
  681. dce_virtual_set_crtc_vblank_interrupt_state(adev, type, state);
  682. return 0;
  683. }
  684. static const struct amdgpu_irq_src_funcs dce_virtual_crtc_irq_funcs = {
  685. .set = dce_virtual_set_crtc_irq_state,
  686. .process = NULL,
  687. };
  688. static void dce_virtual_set_irq_funcs(struct amdgpu_device *adev)
  689. {
  690. adev->crtc_irq.num_types = AMDGPU_CRTC_IRQ_LAST;
  691. adev->crtc_irq.funcs = &dce_virtual_crtc_irq_funcs;
  692. }