dce_virtual.c 20 KB

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