dce_virtual.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781
  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 <drm/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. #define DCE_VIRTUAL_VBLANK_PERIOD 16666666
  40. static void dce_virtual_set_display_funcs(struct amdgpu_device *adev);
  41. static void dce_virtual_set_irq_funcs(struct amdgpu_device *adev);
  42. static int dce_virtual_connector_encoder_init(struct amdgpu_device *adev,
  43. int index);
  44. static void dce_virtual_set_crtc_vblank_interrupt_state(struct amdgpu_device *adev,
  45. int crtc,
  46. enum amdgpu_interrupt_state state);
  47. static u32 dce_virtual_vblank_get_counter(struct amdgpu_device *adev, int crtc)
  48. {
  49. return 0;
  50. }
  51. static void dce_virtual_page_flip(struct amdgpu_device *adev,
  52. int crtc_id, u64 crtc_base, bool async)
  53. {
  54. return;
  55. }
  56. static int dce_virtual_crtc_get_scanoutpos(struct amdgpu_device *adev, int crtc,
  57. u32 *vbl, u32 *position)
  58. {
  59. *vbl = 0;
  60. *position = 0;
  61. return -EINVAL;
  62. }
  63. static bool dce_virtual_hpd_sense(struct amdgpu_device *adev,
  64. enum amdgpu_hpd_id hpd)
  65. {
  66. return true;
  67. }
  68. static void dce_virtual_hpd_set_polarity(struct amdgpu_device *adev,
  69. enum amdgpu_hpd_id hpd)
  70. {
  71. return;
  72. }
  73. static u32 dce_virtual_hpd_get_gpio_reg(struct amdgpu_device *adev)
  74. {
  75. return 0;
  76. }
  77. /**
  78. * dce_virtual_bandwidth_update - program display watermarks
  79. *
  80. * @adev: amdgpu_device pointer
  81. *
  82. * Calculate and program the display watermarks and line
  83. * buffer allocation (CIK).
  84. */
  85. static void dce_virtual_bandwidth_update(struct amdgpu_device *adev)
  86. {
  87. return;
  88. }
  89. static int dce_virtual_crtc_gamma_set(struct drm_crtc *crtc, u16 *red,
  90. u16 *green, u16 *blue, uint32_t size,
  91. struct drm_modeset_acquire_ctx *ctx)
  92. {
  93. return 0;
  94. }
  95. static void dce_virtual_crtc_destroy(struct drm_crtc *crtc)
  96. {
  97. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  98. drm_crtc_cleanup(crtc);
  99. kfree(amdgpu_crtc);
  100. }
  101. static const struct drm_crtc_funcs dce_virtual_crtc_funcs = {
  102. .cursor_set2 = NULL,
  103. .cursor_move = NULL,
  104. .gamma_set = dce_virtual_crtc_gamma_set,
  105. .set_config = amdgpu_display_crtc_set_config,
  106. .destroy = dce_virtual_crtc_destroy,
  107. .page_flip_target = amdgpu_display_crtc_page_flip_target,
  108. };
  109. static void dce_virtual_crtc_dpms(struct drm_crtc *crtc, int mode)
  110. {
  111. struct drm_device *dev = crtc->dev;
  112. struct amdgpu_device *adev = dev->dev_private;
  113. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  114. unsigned type;
  115. if (amdgpu_sriov_vf(adev))
  116. return;
  117. switch (mode) {
  118. case DRM_MODE_DPMS_ON:
  119. amdgpu_crtc->enabled = true;
  120. /* Make sure VBLANK interrupts are still enabled */
  121. type = amdgpu_display_crtc_idx_to_irq_type(adev,
  122. amdgpu_crtc->crtc_id);
  123. amdgpu_irq_update(adev, &adev->crtc_irq, type);
  124. drm_crtc_vblank_on(crtc);
  125. break;
  126. case DRM_MODE_DPMS_STANDBY:
  127. case DRM_MODE_DPMS_SUSPEND:
  128. case DRM_MODE_DPMS_OFF:
  129. drm_crtc_vblank_off(crtc);
  130. amdgpu_crtc->enabled = false;
  131. break;
  132. }
  133. }
  134. static void dce_virtual_crtc_prepare(struct drm_crtc *crtc)
  135. {
  136. dce_virtual_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  137. }
  138. static void dce_virtual_crtc_commit(struct drm_crtc *crtc)
  139. {
  140. dce_virtual_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
  141. }
  142. static void dce_virtual_crtc_disable(struct drm_crtc *crtc)
  143. {
  144. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  145. dce_virtual_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  146. if (crtc->primary->fb) {
  147. int r;
  148. struct amdgpu_framebuffer *amdgpu_fb;
  149. struct amdgpu_bo *abo;
  150. amdgpu_fb = to_amdgpu_framebuffer(crtc->primary->fb);
  151. abo = gem_to_amdgpu_bo(amdgpu_fb->obj);
  152. r = amdgpu_bo_reserve(abo, true);
  153. if (unlikely(r))
  154. DRM_ERROR("failed to reserve abo before unpin\n");
  155. else {
  156. amdgpu_bo_unpin(abo);
  157. amdgpu_bo_unreserve(abo);
  158. }
  159. }
  160. amdgpu_crtc->pll_id = ATOM_PPLL_INVALID;
  161. amdgpu_crtc->encoder = NULL;
  162. amdgpu_crtc->connector = NULL;
  163. }
  164. static int dce_virtual_crtc_mode_set(struct drm_crtc *crtc,
  165. struct drm_display_mode *mode,
  166. struct drm_display_mode *adjusted_mode,
  167. int x, int y, struct drm_framebuffer *old_fb)
  168. {
  169. struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
  170. /* update the hw version fpr dpm */
  171. amdgpu_crtc->hw_mode = *adjusted_mode;
  172. return 0;
  173. }
  174. static bool dce_virtual_crtc_mode_fixup(struct drm_crtc *crtc,
  175. const struct drm_display_mode *mode,
  176. struct drm_display_mode *adjusted_mode)
  177. {
  178. return true;
  179. }
  180. static int dce_virtual_crtc_set_base(struct drm_crtc *crtc, int x, int y,
  181. struct drm_framebuffer *old_fb)
  182. {
  183. return 0;
  184. }
  185. static int dce_virtual_crtc_set_base_atomic(struct drm_crtc *crtc,
  186. struct drm_framebuffer *fb,
  187. int x, int y, enum mode_set_atomic state)
  188. {
  189. return 0;
  190. }
  191. static const struct drm_crtc_helper_funcs dce_virtual_crtc_helper_funcs = {
  192. .dpms = dce_virtual_crtc_dpms,
  193. .mode_fixup = dce_virtual_crtc_mode_fixup,
  194. .mode_set = dce_virtual_crtc_mode_set,
  195. .mode_set_base = dce_virtual_crtc_set_base,
  196. .mode_set_base_atomic = dce_virtual_crtc_set_base_atomic,
  197. .prepare = dce_virtual_crtc_prepare,
  198. .commit = dce_virtual_crtc_commit,
  199. .disable = dce_virtual_crtc_disable,
  200. };
  201. static int dce_virtual_crtc_init(struct amdgpu_device *adev, int index)
  202. {
  203. struct amdgpu_crtc *amdgpu_crtc;
  204. amdgpu_crtc = kzalloc(sizeof(struct amdgpu_crtc) +
  205. (AMDGPUFB_CONN_LIMIT * sizeof(struct drm_connector *)), GFP_KERNEL);
  206. if (amdgpu_crtc == NULL)
  207. return -ENOMEM;
  208. drm_crtc_init(adev->ddev, &amdgpu_crtc->base, &dce_virtual_crtc_funcs);
  209. drm_mode_crtc_set_gamma_size(&amdgpu_crtc->base, 256);
  210. amdgpu_crtc->crtc_id = index;
  211. adev->mode_info.crtcs[index] = amdgpu_crtc;
  212. amdgpu_crtc->pll_id = ATOM_PPLL_INVALID;
  213. amdgpu_crtc->encoder = NULL;
  214. amdgpu_crtc->connector = NULL;
  215. amdgpu_crtc->vsync_timer_enabled = AMDGPU_IRQ_STATE_DISABLE;
  216. drm_crtc_helper_add(&amdgpu_crtc->base, &dce_virtual_crtc_helper_funcs);
  217. return 0;
  218. }
  219. static int dce_virtual_early_init(void *handle)
  220. {
  221. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  222. dce_virtual_set_display_funcs(adev);
  223. dce_virtual_set_irq_funcs(adev);
  224. adev->mode_info.num_hpd = 1;
  225. adev->mode_info.num_dig = 1;
  226. return 0;
  227. }
  228. static struct drm_encoder *
  229. dce_virtual_encoder(struct drm_connector *connector)
  230. {
  231. int enc_id = connector->encoder_ids[0];
  232. struct drm_encoder *encoder;
  233. int i;
  234. for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++) {
  235. if (connector->encoder_ids[i] == 0)
  236. break;
  237. encoder = drm_encoder_find(connector->dev, NULL, connector->encoder_ids[i]);
  238. if (!encoder)
  239. continue;
  240. if (encoder->encoder_type == DRM_MODE_ENCODER_VIRTUAL)
  241. return encoder;
  242. }
  243. /* pick the first one */
  244. if (enc_id)
  245. return drm_encoder_find(connector->dev, NULL, enc_id);
  246. return NULL;
  247. }
  248. static int dce_virtual_get_modes(struct drm_connector *connector)
  249. {
  250. struct drm_device *dev = connector->dev;
  251. struct drm_display_mode *mode = NULL;
  252. unsigned i;
  253. static const struct mode_size {
  254. int w;
  255. int h;
  256. } common_modes[17] = {
  257. { 640, 480},
  258. { 720, 480},
  259. { 800, 600},
  260. { 848, 480},
  261. {1024, 768},
  262. {1152, 768},
  263. {1280, 720},
  264. {1280, 800},
  265. {1280, 854},
  266. {1280, 960},
  267. {1280, 1024},
  268. {1440, 900},
  269. {1400, 1050},
  270. {1680, 1050},
  271. {1600, 1200},
  272. {1920, 1080},
  273. {1920, 1200}
  274. };
  275. for (i = 0; i < 17; i++) {
  276. mode = drm_cvt_mode(dev, common_modes[i].w, common_modes[i].h, 60, false, false, false);
  277. drm_mode_probed_add(connector, mode);
  278. }
  279. return 0;
  280. }
  281. static int dce_virtual_mode_valid(struct drm_connector *connector,
  282. struct drm_display_mode *mode)
  283. {
  284. return MODE_OK;
  285. }
  286. static int
  287. dce_virtual_dpms(struct drm_connector *connector, int mode)
  288. {
  289. return 0;
  290. }
  291. static int
  292. dce_virtual_set_property(struct drm_connector *connector,
  293. struct drm_property *property,
  294. uint64_t val)
  295. {
  296. return 0;
  297. }
  298. static void dce_virtual_destroy(struct drm_connector *connector)
  299. {
  300. drm_connector_unregister(connector);
  301. drm_connector_cleanup(connector);
  302. kfree(connector);
  303. }
  304. static void dce_virtual_force(struct drm_connector *connector)
  305. {
  306. return;
  307. }
  308. static const struct drm_connector_helper_funcs dce_virtual_connector_helper_funcs = {
  309. .get_modes = dce_virtual_get_modes,
  310. .mode_valid = dce_virtual_mode_valid,
  311. .best_encoder = dce_virtual_encoder,
  312. };
  313. static const struct drm_connector_funcs dce_virtual_connector_funcs = {
  314. .dpms = dce_virtual_dpms,
  315. .fill_modes = drm_helper_probe_single_connector_modes,
  316. .set_property = dce_virtual_set_property,
  317. .destroy = dce_virtual_destroy,
  318. .force = dce_virtual_force,
  319. };
  320. static int dce_virtual_sw_init(void *handle)
  321. {
  322. int r, i;
  323. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  324. r = amdgpu_irq_add_id(adev, AMDGPU_IH_CLIENTID_LEGACY, 229, &adev->crtc_irq);
  325. if (r)
  326. return r;
  327. adev->ddev->max_vblank_count = 0;
  328. adev->ddev->mode_config.funcs = &amdgpu_mode_funcs;
  329. adev->ddev->mode_config.max_width = 16384;
  330. adev->ddev->mode_config.max_height = 16384;
  331. adev->ddev->mode_config.preferred_depth = 24;
  332. adev->ddev->mode_config.prefer_shadow = 1;
  333. adev->ddev->mode_config.fb_base = adev->gmc.aper_base;
  334. r = amdgpu_display_modeset_create_props(adev);
  335. if (r)
  336. return r;
  337. adev->ddev->mode_config.max_width = 16384;
  338. adev->ddev->mode_config.max_height = 16384;
  339. /* allocate crtcs, encoders, connectors */
  340. for (i = 0; i < adev->mode_info.num_crtc; i++) {
  341. r = dce_virtual_crtc_init(adev, i);
  342. if (r)
  343. return r;
  344. r = dce_virtual_connector_encoder_init(adev, i);
  345. if (r)
  346. return r;
  347. }
  348. drm_kms_helper_poll_init(adev->ddev);
  349. adev->mode_info.mode_config_initialized = true;
  350. return 0;
  351. }
  352. static int dce_virtual_sw_fini(void *handle)
  353. {
  354. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  355. kfree(adev->mode_info.bios_hardcoded_edid);
  356. drm_kms_helper_poll_fini(adev->ddev);
  357. drm_mode_config_cleanup(adev->ddev);
  358. /* clear crtcs pointer to avoid dce irq finish routine access freed data */
  359. memset(adev->mode_info.crtcs, 0, sizeof(adev->mode_info.crtcs[0]) * AMDGPU_MAX_CRTCS);
  360. adev->mode_info.mode_config_initialized = false;
  361. return 0;
  362. }
  363. static int dce_virtual_hw_init(void *handle)
  364. {
  365. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  366. switch (adev->asic_type) {
  367. #ifdef CONFIG_DRM_AMDGPU_SI
  368. case CHIP_TAHITI:
  369. case CHIP_PITCAIRN:
  370. case CHIP_VERDE:
  371. case CHIP_OLAND:
  372. dce_v6_0_disable_dce(adev);
  373. break;
  374. #endif
  375. #ifdef CONFIG_DRM_AMDGPU_CIK
  376. case CHIP_BONAIRE:
  377. case CHIP_HAWAII:
  378. case CHIP_KAVERI:
  379. case CHIP_KABINI:
  380. case CHIP_MULLINS:
  381. dce_v8_0_disable_dce(adev);
  382. break;
  383. #endif
  384. case CHIP_FIJI:
  385. case CHIP_TONGA:
  386. dce_v10_0_disable_dce(adev);
  387. break;
  388. case CHIP_CARRIZO:
  389. case CHIP_STONEY:
  390. case CHIP_POLARIS11:
  391. case CHIP_POLARIS10:
  392. dce_v11_0_disable_dce(adev);
  393. break;
  394. case CHIP_TOPAZ:
  395. #ifdef CONFIG_DRM_AMDGPU_SI
  396. case CHIP_HAINAN:
  397. #endif
  398. /* no DCE */
  399. break;
  400. case CHIP_VEGA10:
  401. break;
  402. default:
  403. DRM_ERROR("Virtual display unsupported ASIC type: 0x%X\n", adev->asic_type);
  404. }
  405. return 0;
  406. }
  407. static int dce_virtual_hw_fini(void *handle)
  408. {
  409. struct amdgpu_device *adev = (struct amdgpu_device *)handle;
  410. int i = 0;
  411. for (i = 0; i<adev->mode_info.num_crtc; i++)
  412. if (adev->mode_info.crtcs[i])
  413. dce_virtual_set_crtc_vblank_interrupt_state(adev, i, AMDGPU_IRQ_STATE_DISABLE);
  414. return 0;
  415. }
  416. static int dce_virtual_suspend(void *handle)
  417. {
  418. return dce_virtual_hw_fini(handle);
  419. }
  420. static int dce_virtual_resume(void *handle)
  421. {
  422. return dce_virtual_hw_init(handle);
  423. }
  424. static bool dce_virtual_is_idle(void *handle)
  425. {
  426. return true;
  427. }
  428. static int dce_virtual_wait_for_idle(void *handle)
  429. {
  430. return 0;
  431. }
  432. static int dce_virtual_soft_reset(void *handle)
  433. {
  434. return 0;
  435. }
  436. static int dce_virtual_set_clockgating_state(void *handle,
  437. enum amd_clockgating_state state)
  438. {
  439. return 0;
  440. }
  441. static int dce_virtual_set_powergating_state(void *handle,
  442. enum amd_powergating_state state)
  443. {
  444. return 0;
  445. }
  446. static const struct amd_ip_funcs dce_virtual_ip_funcs = {
  447. .name = "dce_virtual",
  448. .early_init = dce_virtual_early_init,
  449. .late_init = NULL,
  450. .sw_init = dce_virtual_sw_init,
  451. .sw_fini = dce_virtual_sw_fini,
  452. .hw_init = dce_virtual_hw_init,
  453. .hw_fini = dce_virtual_hw_fini,
  454. .suspend = dce_virtual_suspend,
  455. .resume = dce_virtual_resume,
  456. .is_idle = dce_virtual_is_idle,
  457. .wait_for_idle = dce_virtual_wait_for_idle,
  458. .soft_reset = dce_virtual_soft_reset,
  459. .set_clockgating_state = dce_virtual_set_clockgating_state,
  460. .set_powergating_state = dce_virtual_set_powergating_state,
  461. };
  462. /* these are handled by the primary encoders */
  463. static void dce_virtual_encoder_prepare(struct drm_encoder *encoder)
  464. {
  465. return;
  466. }
  467. static void dce_virtual_encoder_commit(struct drm_encoder *encoder)
  468. {
  469. return;
  470. }
  471. static void
  472. dce_virtual_encoder_mode_set(struct drm_encoder *encoder,
  473. struct drm_display_mode *mode,
  474. struct drm_display_mode *adjusted_mode)
  475. {
  476. return;
  477. }
  478. static void dce_virtual_encoder_disable(struct drm_encoder *encoder)
  479. {
  480. return;
  481. }
  482. static void
  483. dce_virtual_encoder_dpms(struct drm_encoder *encoder, int mode)
  484. {
  485. return;
  486. }
  487. static bool dce_virtual_encoder_mode_fixup(struct drm_encoder *encoder,
  488. const struct drm_display_mode *mode,
  489. struct drm_display_mode *adjusted_mode)
  490. {
  491. return true;
  492. }
  493. static const struct drm_encoder_helper_funcs dce_virtual_encoder_helper_funcs = {
  494. .dpms = dce_virtual_encoder_dpms,
  495. .mode_fixup = dce_virtual_encoder_mode_fixup,
  496. .prepare = dce_virtual_encoder_prepare,
  497. .mode_set = dce_virtual_encoder_mode_set,
  498. .commit = dce_virtual_encoder_commit,
  499. .disable = dce_virtual_encoder_disable,
  500. };
  501. static void dce_virtual_encoder_destroy(struct drm_encoder *encoder)
  502. {
  503. drm_encoder_cleanup(encoder);
  504. kfree(encoder);
  505. }
  506. static const struct drm_encoder_funcs dce_virtual_encoder_funcs = {
  507. .destroy = dce_virtual_encoder_destroy,
  508. };
  509. static int dce_virtual_connector_encoder_init(struct amdgpu_device *adev,
  510. int index)
  511. {
  512. struct drm_encoder *encoder;
  513. struct drm_connector *connector;
  514. /* add a new encoder */
  515. encoder = kzalloc(sizeof(struct drm_encoder), GFP_KERNEL);
  516. if (!encoder)
  517. return -ENOMEM;
  518. encoder->possible_crtcs = 1 << index;
  519. drm_encoder_init(adev->ddev, encoder, &dce_virtual_encoder_funcs,
  520. DRM_MODE_ENCODER_VIRTUAL, NULL);
  521. drm_encoder_helper_add(encoder, &dce_virtual_encoder_helper_funcs);
  522. connector = kzalloc(sizeof(struct drm_connector), GFP_KERNEL);
  523. if (!connector) {
  524. kfree(encoder);
  525. return -ENOMEM;
  526. }
  527. /* add a new connector */
  528. drm_connector_init(adev->ddev, connector, &dce_virtual_connector_funcs,
  529. DRM_MODE_CONNECTOR_VIRTUAL);
  530. drm_connector_helper_add(connector, &dce_virtual_connector_helper_funcs);
  531. connector->display_info.subpixel_order = SubPixelHorizontalRGB;
  532. connector->interlace_allowed = false;
  533. connector->doublescan_allowed = false;
  534. drm_connector_register(connector);
  535. /* link them */
  536. drm_mode_connector_attach_encoder(connector, encoder);
  537. return 0;
  538. }
  539. static const struct amdgpu_display_funcs dce_virtual_display_funcs = {
  540. .bandwidth_update = &dce_virtual_bandwidth_update,
  541. .vblank_get_counter = &dce_virtual_vblank_get_counter,
  542. .backlight_set_level = NULL,
  543. .backlight_get_level = NULL,
  544. .hpd_sense = &dce_virtual_hpd_sense,
  545. .hpd_set_polarity = &dce_virtual_hpd_set_polarity,
  546. .hpd_get_gpio_reg = &dce_virtual_hpd_get_gpio_reg,
  547. .page_flip = &dce_virtual_page_flip,
  548. .page_flip_get_scanoutpos = &dce_virtual_crtc_get_scanoutpos,
  549. .add_encoder = NULL,
  550. .add_connector = NULL,
  551. };
  552. static void dce_virtual_set_display_funcs(struct amdgpu_device *adev)
  553. {
  554. if (adev->mode_info.funcs == NULL)
  555. adev->mode_info.funcs = &dce_virtual_display_funcs;
  556. }
  557. static int dce_virtual_pageflip(struct amdgpu_device *adev,
  558. unsigned crtc_id)
  559. {
  560. unsigned long flags;
  561. struct amdgpu_crtc *amdgpu_crtc;
  562. struct amdgpu_flip_work *works;
  563. amdgpu_crtc = adev->mode_info.crtcs[crtc_id];
  564. if (crtc_id >= adev->mode_info.num_crtc) {
  565. DRM_ERROR("invalid pageflip crtc %d\n", crtc_id);
  566. return -EINVAL;
  567. }
  568. /* IRQ could occur when in initial stage */
  569. if (amdgpu_crtc == NULL)
  570. return 0;
  571. spin_lock_irqsave(&adev->ddev->event_lock, flags);
  572. works = amdgpu_crtc->pflip_works;
  573. if (amdgpu_crtc->pflip_status != AMDGPU_FLIP_SUBMITTED) {
  574. DRM_DEBUG_DRIVER("amdgpu_crtc->pflip_status = %d != "
  575. "AMDGPU_FLIP_SUBMITTED(%d)\n",
  576. amdgpu_crtc->pflip_status,
  577. AMDGPU_FLIP_SUBMITTED);
  578. spin_unlock_irqrestore(&adev->ddev->event_lock, flags);
  579. return 0;
  580. }
  581. /* page flip completed. clean up */
  582. amdgpu_crtc->pflip_status = AMDGPU_FLIP_NONE;
  583. amdgpu_crtc->pflip_works = NULL;
  584. /* wakeup usersapce */
  585. if (works->event)
  586. drm_crtc_send_vblank_event(&amdgpu_crtc->base, works->event);
  587. spin_unlock_irqrestore(&adev->ddev->event_lock, flags);
  588. drm_crtc_vblank_put(&amdgpu_crtc->base);
  589. schedule_work(&works->unpin_work);
  590. return 0;
  591. }
  592. static enum hrtimer_restart dce_virtual_vblank_timer_handle(struct hrtimer *vblank_timer)
  593. {
  594. struct amdgpu_crtc *amdgpu_crtc = container_of(vblank_timer,
  595. struct amdgpu_crtc, vblank_timer);
  596. struct drm_device *ddev = amdgpu_crtc->base.dev;
  597. struct amdgpu_device *adev = ddev->dev_private;
  598. drm_handle_vblank(ddev, amdgpu_crtc->crtc_id);
  599. dce_virtual_pageflip(adev, amdgpu_crtc->crtc_id);
  600. hrtimer_start(vblank_timer, DCE_VIRTUAL_VBLANK_PERIOD,
  601. HRTIMER_MODE_REL);
  602. return HRTIMER_NORESTART;
  603. }
  604. static void dce_virtual_set_crtc_vblank_interrupt_state(struct amdgpu_device *adev,
  605. int crtc,
  606. enum amdgpu_interrupt_state state)
  607. {
  608. if (crtc >= adev->mode_info.num_crtc || !adev->mode_info.crtcs[crtc]) {
  609. DRM_DEBUG("invalid crtc %d\n", crtc);
  610. return;
  611. }
  612. if (state && !adev->mode_info.crtcs[crtc]->vsync_timer_enabled) {
  613. DRM_DEBUG("Enable software vsync timer\n");
  614. hrtimer_init(&adev->mode_info.crtcs[crtc]->vblank_timer,
  615. CLOCK_MONOTONIC, HRTIMER_MODE_REL);
  616. hrtimer_set_expires(&adev->mode_info.crtcs[crtc]->vblank_timer,
  617. DCE_VIRTUAL_VBLANK_PERIOD);
  618. adev->mode_info.crtcs[crtc]->vblank_timer.function =
  619. dce_virtual_vblank_timer_handle;
  620. hrtimer_start(&adev->mode_info.crtcs[crtc]->vblank_timer,
  621. DCE_VIRTUAL_VBLANK_PERIOD, HRTIMER_MODE_REL);
  622. } else if (!state && adev->mode_info.crtcs[crtc]->vsync_timer_enabled) {
  623. DRM_DEBUG("Disable software vsync timer\n");
  624. hrtimer_cancel(&adev->mode_info.crtcs[crtc]->vblank_timer);
  625. }
  626. adev->mode_info.crtcs[crtc]->vsync_timer_enabled = state;
  627. DRM_DEBUG("[FM]set crtc %d vblank interrupt state %d\n", crtc, state);
  628. }
  629. static int dce_virtual_set_crtc_irq_state(struct amdgpu_device *adev,
  630. struct amdgpu_irq_src *source,
  631. unsigned type,
  632. enum amdgpu_interrupt_state state)
  633. {
  634. if (type > AMDGPU_CRTC_IRQ_VBLANK6)
  635. return -EINVAL;
  636. dce_virtual_set_crtc_vblank_interrupt_state(adev, type, state);
  637. return 0;
  638. }
  639. static const struct amdgpu_irq_src_funcs dce_virtual_crtc_irq_funcs = {
  640. .set = dce_virtual_set_crtc_irq_state,
  641. .process = NULL,
  642. };
  643. static void dce_virtual_set_irq_funcs(struct amdgpu_device *adev)
  644. {
  645. adev->crtc_irq.num_types = AMDGPU_CRTC_IRQ_VBLANK6 + 1;
  646. adev->crtc_irq.funcs = &dce_virtual_crtc_irq_funcs;
  647. }
  648. const struct amdgpu_ip_block_version dce_virtual_ip_block =
  649. {
  650. .type = AMD_IP_BLOCK_TYPE_DCE,
  651. .major = 1,
  652. .minor = 0,
  653. .rev = 0,
  654. .funcs = &dce_virtual_ip_funcs,
  655. };