dce_virtual.c 20 KB

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