dce_virtual.c 20 KB

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