dce_virtual.c 20 KB

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