amdgpu_dm.c 339.2 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
/*
 * Copyright 2015 Advanced Micro Devices, Inc.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 * OTHER DEALINGS IN THE SOFTWARE.
 *
 * Authors: AMD
 *
 */

D
David Francis 已提交
26 27 28
/* The caprices of the preprocessor require that this be declared right here */
#define CREATE_TRACE_POINTS

29 30
#include "dm_services_types.h"
#include "dc.h"
31
#include "dc_link_dp.h"
32
#include "link_enc_cfg.h"
33
#include "dc/inc/core_types.h"
34
#include "dal_asic_id.h"
35
#include "dmub/dmub_srv.h"
36 37
#include "dc/inc/hw/dmcu.h"
#include "dc/inc/hw/abm.h"
38
#include "dc/dc_dmub_srv.h"
39
#include "dc/dc_edid_parser.h"
40
#include "dc/dc_stat.h"
41
#include "amdgpu_dm_trace.h"
42 43 44

#include "vid.h"
#include "amdgpu.h"
45
#include "amdgpu_display.h"
D
David Francis 已提交
46
#include "amdgpu_ucode.h"
47 48
#include "atom.h"
#include "amdgpu_dm.h"
49 50
#ifdef CONFIG_DRM_AMD_DC_HDCP
#include "amdgpu_dm_hdcp.h"
51
#include <drm/drm_hdcp.h>
52
#endif
53
#include "amdgpu_pm.h"
54
#include "amdgpu_atombios.h"
55 56 57 58

#include "amd_shared.h"
#include "amdgpu_dm_irq.h"
#include "dm_helpers.h"
59
#include "amdgpu_dm_mst_types.h"
60 61 62
#if defined(CONFIG_DEBUG_FS)
#include "amdgpu_dm_debugfs.h"
#endif
63
#include "amdgpu_dm_psr.h"
64 65 66

#include "ivsrcid/ivsrcid_vislands30.h"

67
#include "i2caux_interface.h"
68 69
#include <linux/module.h>
#include <linux/moduleparam.h>
70
#include <linux/types.h>
71
#include <linux/pm_runtime.h>
72
#include <linux/pci.h>
D
David Francis 已提交
73
#include <linux/firmware.h>
74
#include <linux/component.h>
75 76

#include <drm/drm_atomic.h>
77
#include <drm/drm_atomic_uapi.h>
78
#include <drm/drm_atomic_helper.h>
79
#include <drm/dp/drm_dp_mst_helper.h>
80
#include <drm/drm_fb_helper.h>
81
#include <drm/drm_fourcc.h>
82
#include <drm/drm_edid.h>
83
#include <drm/drm_vblank.h>
84
#include <drm/drm_audio_component.h>
85

86
#if defined(CONFIG_DRM_AMD_DC_DCN)
87
#include "ivsrcid/dcn/irqsrcs_dcn_1_0.h"
88

89 90
#include "dcn/dcn_1_0_offset.h"
#include "dcn/dcn_1_0_sh_mask.h"
91 92
#include "soc15_hw_ip.h"
#include "vega10_ip_offset.h"
93 94 95 96

#include "soc15_common.h"
#endif

97
#include "modules/inc/mod_freesync.h"
D
David Francis 已提交
98
#include "modules/power/power_helpers.h"
99
#include "modules/inc/mod_info_packet.h"
100

101 102
#define FIRMWARE_RENOIR_DMUB "amdgpu/renoir_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_RENOIR_DMUB);
103 104
#define FIRMWARE_SIENNA_CICHLID_DMUB "amdgpu/sienna_cichlid_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_SIENNA_CICHLID_DMUB);
105 106
#define FIRMWARE_NAVY_FLOUNDER_DMUB "amdgpu/navy_flounder_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_NAVY_FLOUNDER_DMUB);
107 108
#define FIRMWARE_GREEN_SARDINE_DMUB "amdgpu/green_sardine_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_GREEN_SARDINE_DMUB);
109 110
#define FIRMWARE_VANGOGH_DMUB "amdgpu/vangogh_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_VANGOGH_DMUB);
111 112
#define FIRMWARE_DIMGREY_CAVEFISH_DMUB "amdgpu/dimgrey_cavefish_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_DIMGREY_CAVEFISH_DMUB);
113 114
#define FIRMWARE_BEIGE_GOBY_DMUB "amdgpu/beige_goby_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_BEIGE_GOBY_DMUB);
115 116
#define FIRMWARE_YELLOW_CARP_DMUB "amdgpu/yellow_carp_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_YELLOW_CARP_DMUB);
117 118
#define FIRMWARE_DCN_315_DMUB "amdgpu/dcn_3_1_5_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_DCN_315_DMUB);
119 120
#define FIRMWARE_DCN316_DMUB "amdgpu/dcn_3_1_6_dmcub.bin"
MODULE_FIRMWARE(FIRMWARE_DCN316_DMUB);
121

D
David Francis 已提交
122 123
#define FIRMWARE_RAVEN_DMCU		"amdgpu/raven_dmcu.bin"
MODULE_FIRMWARE(FIRMWARE_RAVEN_DMCU);
124

125 126 127
#define FIRMWARE_NAVI12_DMCU            "amdgpu/navi12_dmcu.bin"
MODULE_FIRMWARE(FIRMWARE_NAVI12_DMCU);

128 129 130 131 132 133
/* Number of bytes in PSP header for firmware. */
#define PSP_HEADER_BYTES 0x100

/* Number of bytes in PSP footer for firmware. */
#define PSP_FOOTER_BYTES 0x100

134 135 136 137
/**
 * DOC: overview
 *
 * The AMDgpu display manager, **amdgpu_dm** (or even simpler,
138
 * **dm**) sits between DRM and DC. It acts as a liaison, converting DRM
139 140 141 142 143
 * requests into DC requests, and DC responses into DRM responses.
 *
 * The root control structure is &struct amdgpu_display_manager.
 */

144 145 146
/* basic init/fini API */
static int amdgpu_dm_init(struct amdgpu_device *adev);
static void amdgpu_dm_fini(struct amdgpu_device *adev);
147
static bool is_freesync_video_mode(const struct drm_display_mode *mode, struct amdgpu_dm_connector *aconnector);
148

149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184
static enum drm_mode_subconnector get_subconnector_type(struct dc_link *link)
{
	switch (link->dpcd_caps.dongle_type) {
	case DISPLAY_DONGLE_NONE:
		return DRM_MODE_SUBCONNECTOR_Native;
	case DISPLAY_DONGLE_DP_VGA_CONVERTER:
		return DRM_MODE_SUBCONNECTOR_VGA;
	case DISPLAY_DONGLE_DP_DVI_CONVERTER:
	case DISPLAY_DONGLE_DP_DVI_DONGLE:
		return DRM_MODE_SUBCONNECTOR_DVID;
	case DISPLAY_DONGLE_DP_HDMI_CONVERTER:
	case DISPLAY_DONGLE_DP_HDMI_DONGLE:
		return DRM_MODE_SUBCONNECTOR_HDMIA;
	case DISPLAY_DONGLE_DP_HDMI_MISMATCHED_DONGLE:
	default:
		return DRM_MODE_SUBCONNECTOR_Unknown;
	}
}

static void update_subconnector_property(struct amdgpu_dm_connector *aconnector)
{
	struct dc_link *link = aconnector->dc_link;
	struct drm_connector *connector = &aconnector->base;
	enum drm_mode_subconnector subconnector = DRM_MODE_SUBCONNECTOR_Unknown;

	if (connector->connector_type != DRM_MODE_CONNECTOR_DisplayPort)
		return;

	if (aconnector->dc_sink)
		subconnector = get_subconnector_type(link);

	drm_object_property_set_value(&connector->base,
			connector->dev->mode_config.dp_subconnector_property,
			subconnector);
}

185 186
/*
 * initializes drm_device display related structures, based on the information
187 188 189 190 191 192 193 194 195 196
 * provided by DAL. The drm strcutures are: drm_crtc, drm_connector,
 * drm_encoder, drm_mode_config
 *
 * Returns 0 on success
 */
static int amdgpu_dm_initialize_drm_device(struct amdgpu_device *adev);
/* removes and deallocates the drm structures, created by the above function */
static void amdgpu_dm_destroy_drm_device(struct amdgpu_display_manager *dm);

static int amdgpu_dm_plane_init(struct amdgpu_display_manager *dm,
H
Harry Wentland 已提交
197
				struct drm_plane *plane,
198 199
				unsigned long possible_crtcs,
				const struct dc_plane_cap *plane_cap);
200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217
static int amdgpu_dm_crtc_init(struct amdgpu_display_manager *dm,
			       struct drm_plane *plane,
			       uint32_t link_index);
static int amdgpu_dm_connector_init(struct amdgpu_display_manager *dm,
				    struct amdgpu_dm_connector *amdgpu_dm_connector,
				    uint32_t link_index,
				    struct amdgpu_encoder *amdgpu_encoder);
static int amdgpu_dm_encoder_init(struct drm_device *dev,
				  struct amdgpu_encoder *aencoder,
				  uint32_t link_index);

static int amdgpu_dm_connector_get_modes(struct drm_connector *connector);

static void amdgpu_dm_atomic_commit_tail(struct drm_atomic_state *state);

static int amdgpu_dm_atomic_check(struct drm_device *dev,
				  struct drm_atomic_state *state);

218 219
static void handle_cursor_update(struct drm_plane *plane,
				 struct drm_plane_state *old_plane_state);
220

221 222 223
static const struct drm_format_info *
amd_get_format_info(const struct drm_mode_fb_cmd2 *cmd);

224
static void handle_hpd_irq_helper(struct amdgpu_dm_connector *aconnector);
225
static void handle_hpd_rx_irq(void *param);
226

227 228 229
static bool
is_timing_unchanged_for_freesync(struct drm_crtc_state *old_crtc_state,
				 struct drm_crtc_state *new_crtc_state);
230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
/*
 * dm_vblank_get_counter
 *
 * @brief
 * Get counter for number of vertical blanks
 *
 * @param
 * struct amdgpu_device *adev - [in] desired amdgpu device
 * int disp_idx - [in] which CRTC to get the counter from
 *
 * @return
 * Counter for vertical blanks
 */
static u32 dm_vblank_get_counter(struct amdgpu_device *adev, int crtc)
{
	if (crtc >= adev->mode_info.num_crtc)
		return 0;
	else {
		struct amdgpu_crtc *acrtc = adev->mode_info.crtcs[crtc];

250
		if (acrtc->dm_irq_params.stream == NULL) {
251 252
			DRM_ERROR("dc_stream_state is NULL for crtc '%d'!\n",
				  crtc);
253 254 255
			return 0;
		}

256
		return dc_stream_get_vblank_counter(acrtc->dm_irq_params.stream);
257 258 259 260
	}
}

static int dm_crtc_get_scanoutpos(struct amdgpu_device *adev, int crtc,
261
				  u32 *vbl, u32 *position)
262
{
263 264
	uint32_t v_blank_start, v_blank_end, h_position, v_position;

265 266 267 268 269
	if ((crtc < 0) || (crtc >= adev->mode_info.num_crtc))
		return -EINVAL;
	else {
		struct amdgpu_crtc *acrtc = adev->mode_info.crtcs[crtc];

270
		if (acrtc->dm_irq_params.stream ==  NULL) {
271 272
			DRM_ERROR("dc_stream_state is NULL for crtc '%d'!\n",
				  crtc);
273 274 275
			return 0;
		}

276 277 278 279
		/*
		 * TODO rework base driver to use values directly.
		 * for now parse it back into reg-format
		 */
280
		dc_stream_get_scanoutpos(acrtc->dm_irq_params.stream,
281 282 283 284 285
					 &v_blank_start,
					 &v_blank_end,
					 &h_position,
					 &v_position);

286 287
		*position = v_position | (h_position << 16);
		*vbl = v_blank_start | (v_blank_end << 16);
288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315
	}

	return 0;
}

static bool dm_is_idle(void *handle)
{
	/* XXX todo */
	return true;
}

static int dm_wait_for_idle(void *handle)
{
	/* XXX todo */
	return 0;
}

static bool dm_check_soft_reset(void *handle)
{
	return false;
}

static int dm_soft_reset(void *handle)
{
	/* XXX todo */
	return 0;
}

316 317 318
static struct amdgpu_crtc *
get_crtc_by_otg_inst(struct amdgpu_device *adev,
		     int otg_inst)
319
{
320
	struct drm_device *dev = adev_to_drm(adev);
321 322 323
	struct drm_crtc *crtc;
	struct amdgpu_crtc *amdgpu_crtc;

N
Nirmoy Das 已提交
324
	if (WARN_ON(otg_inst == -1))
325 326 327 328 329 330 331 332 333 334 335 336
		return adev->mode_info.crtcs[0];

	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
		amdgpu_crtc = to_amdgpu_crtc(crtc);

		if (amdgpu_crtc->otg_inst == otg_inst)
			return amdgpu_crtc;
	}

	return NULL;
}

337 338 339 340 341 342 343 344
static inline bool amdgpu_dm_vrr_active_irq(struct amdgpu_crtc *acrtc)
{
	return acrtc->dm_irq_params.freesync_config.state ==
		       VRR_STATE_ACTIVE_VARIABLE ||
	       acrtc->dm_irq_params.freesync_config.state ==
		       VRR_STATE_ACTIVE_FIXED;
}

345 346 347 348 349 350
static inline bool amdgpu_dm_vrr_active(struct dm_crtc_state *dm_state)
{
	return dm_state->freesync_config.state == VRR_STATE_ACTIVE_VARIABLE ||
	       dm_state->freesync_config.state == VRR_STATE_ACTIVE_FIXED;
}

351 352 353 354 355 356 357 358 359 360 361
static inline bool is_dc_timing_adjust_needed(struct dm_crtc_state *old_state,
					      struct dm_crtc_state *new_state)
{
	if (new_state->freesync_config.state ==  VRR_STATE_ACTIVE_FIXED)
		return true;
	else if (amdgpu_dm_vrr_active(old_state) != amdgpu_dm_vrr_active(new_state))
		return true;
	else
		return false;
}

362 363 364 365 366 367 368
/**
 * dm_pflip_high_irq() - Handle pageflip interrupt
 * @interrupt_params: ignored
 *
 * Handles the pageflip interrupt by notifying all interested parties
 * that the pageflip has been completed.
 */
369 370 371 372 373 374
static void dm_pflip_high_irq(void *interrupt_params)
{
	struct amdgpu_crtc *amdgpu_crtc;
	struct common_irq_params *irq_params = interrupt_params;
	struct amdgpu_device *adev = irq_params->adev;
	unsigned long flags;
375 376 377
	struct drm_pending_vblank_event *e;
	uint32_t vpos, hpos, v_blank_start, v_blank_end;
	bool vrr_active;
378 379 380 381

	amdgpu_crtc = get_crtc_by_otg_inst(adev, irq_params->irq_src - IRQ_TYPE_PFLIP);

	/* IRQ could occur when in initial stage */
382
	/* TODO work and BO cleanup */
383
	if (amdgpu_crtc == NULL) {
384
		DC_LOG_PFLIP("CRTC is null, returning.\n");
385 386 387
		return;
	}

388
	spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
389 390

	if (amdgpu_crtc->pflip_status != AMDGPU_FLIP_SUBMITTED){
391
		DC_LOG_PFLIP("amdgpu_crtc->pflip_status = %d !=AMDGPU_FLIP_SUBMITTED(%d) on crtc:%d[%p] \n",
392 393 394 395
						 amdgpu_crtc->pflip_status,
						 AMDGPU_FLIP_SUBMITTED,
						 amdgpu_crtc->crtc_id,
						 amdgpu_crtc);
396
		spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
397 398 399
		return;
	}

400 401 402
	/* page flip completed. */
	e = amdgpu_crtc->event;
	amdgpu_crtc->event = NULL;
403

N
Nirmoy Das 已提交
404
	WARN_ON(!e);
405

406
	vrr_active = amdgpu_dm_vrr_active_irq(amdgpu_crtc);
407 408 409

	/* Fixed refresh rate, or VRR scanout position outside front-porch? */
	if (!vrr_active ||
410
	    !dc_stream_get_scanoutpos(amdgpu_crtc->dm_irq_params.stream, &v_blank_start,
411 412 413 414 415 416 417
				      &v_blank_end, &hpos, &vpos) ||
	    (vpos < v_blank_start)) {
		/* Update to correct count and vblank timestamp if racing with
		 * vblank irq. This also updates to the correct vblank timestamp
		 * even in VRR mode, as scanout is past the front-porch atm.
		 */
		drm_crtc_accurate_vblank_count(&amdgpu_crtc->base);
418

419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445
		/* Wake up userspace by sending the pageflip event with proper
		 * count and timestamp of vblank of flip completion.
		 */
		if (e) {
			drm_crtc_send_vblank_event(&amdgpu_crtc->base, e);

			/* Event sent, so done with vblank for this flip */
			drm_crtc_vblank_put(&amdgpu_crtc->base);
		}
	} else if (e) {
		/* VRR active and inside front-porch: vblank count and
		 * timestamp for pageflip event will only be up to date after
		 * drm_crtc_handle_vblank() has been executed from late vblank
		 * irq handler after start of back-porch (vline 0). We queue the
		 * pageflip event for send-out by drm_crtc_handle_vblank() with
		 * updated timestamp and count, once it runs after us.
		 *
		 * We need to open-code this instead of using the helper
		 * drm_crtc_arm_vblank_event(), as that helper would
		 * call drm_crtc_accurate_vblank_count(), which we must
		 * not call in VRR mode while we are in front-porch!
		 */

		/* sequence will be replaced by real count during send-out. */
		e->sequence = drm_crtc_vblank_count(&amdgpu_crtc->base);
		e->pipe = amdgpu_crtc->crtc_id;

446
		list_add_tail(&e->base.link, &adev_to_drm(adev)->vblank_event_list);
447 448
		e = NULL;
	}
449

450 451 452 453 454
	/* Keep track of vblank of this flip for flip throttling. We use the
	 * cooked hw counter, as that one incremented at start of this vblank
	 * of pageflip completion, so last_flip_vblank is the forbidden count
	 * for queueing new pageflips if vsync + VRR is enabled.
	 */
455
	amdgpu_crtc->dm_irq_params.last_flip_vblank =
456
		amdgpu_get_vblank_counter_kms(&amdgpu_crtc->base);
457

458
	amdgpu_crtc->pflip_status = AMDGPU_FLIP_NONE;
459
	spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
460

461 462 463
	DC_LOG_PFLIP("crtc:%d[%p], pflip_stat:AMDGPU_FLIP_NONE, vrr[%d]-fp %d\n",
		     amdgpu_crtc->crtc_id, amdgpu_crtc,
		     vrr_active, (int) !e);
464 465
}

466 467 468 469 470
static void dm_vupdate_high_irq(void *interrupt_params)
{
	struct common_irq_params *irq_params = interrupt_params;
	struct amdgpu_device *adev = irq_params->adev;
	struct amdgpu_crtc *acrtc;
471 472 473
	struct drm_device *drm_dev;
	struct drm_vblank_crtc *vblank;
	ktime_t frame_duration_ns, previous_timestamp;
474
	unsigned long flags;
475
	int vrr_active;
476 477 478 479

	acrtc = get_crtc_by_otg_inst(adev, irq_params->irq_src - IRQ_TYPE_VUPDATE);

	if (acrtc) {
480
		vrr_active = amdgpu_dm_vrr_active_irq(acrtc);
481 482 483 484 485 486 487 488 489 490 491
		drm_dev = acrtc->base.dev;
		vblank = &drm_dev->vblank[acrtc->base.index];
		previous_timestamp = atomic64_read(&irq_params->previous_timestamp);
		frame_duration_ns = vblank->time - previous_timestamp;

		if (frame_duration_ns > 0) {
			trace_amdgpu_refresh_rate_track(acrtc->base.index,
						frame_duration_ns,
						ktime_divns(NSEC_PER_SEC, frame_duration_ns));
			atomic64_set(&irq_params->previous_timestamp, vblank->time);
		}
492

493
		DC_LOG_VBLANK("crtc:%d, vupdate-vrr:%d\n",
494
			      acrtc->crtc_id,
495
			      vrr_active);
496 497 498 499 500 501 502

		/* Core vblank handling is done here after end of front-porch in
		 * vrr mode, as vblank timestamping will give valid results
		 * while now done after front-porch. This will also deliver
		 * page-flip completion events that have been queued to us
		 * if a pageflip happened inside front-porch.
		 */
503
		if (vrr_active) {
504
			drm_crtc_handle_vblank(&acrtc->base);
505 506

			/* BTR processing for pre-DCE12 ASICs */
507
			if (acrtc->dm_irq_params.stream &&
508
			    adev->family < AMDGPU_FAMILY_AI) {
509
				spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
510 511
				mod_freesync_handle_v_update(
				    adev->dm.freesync_module,
512 513
				    acrtc->dm_irq_params.stream,
				    &acrtc->dm_irq_params.vrr_params);
514 515 516

				dc_stream_adjust_vmin_vmax(
				    adev->dm.dc,
517 518
				    acrtc->dm_irq_params.stream,
				    &acrtc->dm_irq_params.vrr_params.adjust);
519
				spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
520 521
			}
		}
522 523 524
	}
}

525 526
/**
 * dm_crtc_high_irq() - Handles CRTC interrupt
527
 * @interrupt_params: used for determining the CRTC instance
528 529 530 531
 *
 * Handles the CRTC/VSYNC interrupt by notfying DRM's VBLANK
 * event handler.
 */
532 533 534 535 536
static void dm_crtc_high_irq(void *interrupt_params)
{
	struct common_irq_params *irq_params = interrupt_params;
	struct amdgpu_device *adev = irq_params->adev;
	struct amdgpu_crtc *acrtc;
537
	unsigned long flags;
538
	int vrr_active;
539

540
	acrtc = get_crtc_by_otg_inst(adev, irq_params->irq_src - IRQ_TYPE_VBLANK);
541 542 543
	if (!acrtc)
		return;

544
	vrr_active = amdgpu_dm_vrr_active_irq(acrtc);
545

546
	DC_LOG_VBLANK("crtc:%d, vupdate-vrr:%d, planes:%d\n", acrtc->crtc_id,
547
		      vrr_active, acrtc->dm_irq_params.active_planes);
548

549 550 551 552 553 554
	/**
	 * Core vblank handling at start of front-porch is only possible
	 * in non-vrr mode, as only there vblank timestamping will give
	 * valid results while done in front-porch. Otherwise defer it
	 * to dm_vupdate_high_irq after end of front-porch.
	 */
555
	if (!vrr_active)
556 557 558 559 560 561
		drm_crtc_handle_vblank(&acrtc->base);

	/**
	 * Following stuff must happen at start of vblank, for crc
	 * computation and below-the-range btr support in vrr mode.
	 */
562
	amdgpu_dm_crtc_handle_crc_irq(&acrtc->base);
563 564 565 566

	/* BTR updates need to happen before VUPDATE on Vega and above. */
	if (adev->family < AMDGPU_FAMILY_AI)
		return;
567

568
	spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
569

570 571 572 573
	if (acrtc->dm_irq_params.stream &&
	    acrtc->dm_irq_params.vrr_params.supported &&
	    acrtc->dm_irq_params.freesync_config.state ==
		    VRR_STATE_ACTIVE_VARIABLE) {
574
		mod_freesync_handle_v_update(adev->dm.freesync_module,
575 576
					     acrtc->dm_irq_params.stream,
					     &acrtc->dm_irq_params.vrr_params);
577

578 579
		dc_stream_adjust_vmin_vmax(adev->dm.dc, acrtc->dm_irq_params.stream,
					   &acrtc->dm_irq_params.vrr_params.adjust);
580 581
	}

582 583 584 585 586 587 588 589 590 591
	/*
	 * If there aren't any active_planes then DCH HUBP may be clock-gated.
	 * In that case, pageflip completion interrupts won't fire and pageflip
	 * completion events won't get delivered. Prevent this by sending
	 * pending pageflip events from here if a flip is still pending.
	 *
	 * If any planes are enabled, use dm_pflip_high_irq() instead, to
	 * avoid race conditions between flip programming and completion,
	 * which could cause too early flip completion events.
	 */
592 593
	if (adev->family >= AMDGPU_FAMILY_RV &&
	    acrtc->pflip_status == AMDGPU_FLIP_SUBMITTED &&
594
	    acrtc->dm_irq_params.active_planes == 0) {
595 596 597 598 599 600 601 602
		if (acrtc->event) {
			drm_crtc_send_vblank_event(&acrtc->base, acrtc->event);
			acrtc->event = NULL;
			drm_crtc_vblank_put(&acrtc->base);
		}
		acrtc->pflip_status = AMDGPU_FLIP_NONE;
	}

603
	spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
604 605
}

606
#if defined(CONFIG_DRM_AMD_DC_DCN)
607
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
608 609 610
/**
 * dm_dcn_vertical_interrupt0_high_irq() - Handles OTG Vertical interrupt0 for
 * DCN generation ASICs
611
 * @interrupt_params: interrupt parameters
612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627
 *
 * Used to set crc window/read out crc value at vertical line 0 position
 */
static void dm_dcn_vertical_interrupt0_high_irq(void *interrupt_params)
{
	struct common_irq_params *irq_params = interrupt_params;
	struct amdgpu_device *adev = irq_params->adev;
	struct amdgpu_crtc *acrtc;

	acrtc = get_crtc_by_otg_inst(adev, irq_params->irq_src - IRQ_TYPE_VLINE0);

	if (!acrtc)
		return;

	amdgpu_dm_crtc_handle_crc_window_irq(&acrtc->base);
}
628
#endif /* CONFIG_DRM_AMD_SECURE_DISPLAY */
629

630
/**
Y
Yann Dirson 已提交
631
 * dmub_aux_setconfig_callback - Callback for AUX or SET_CONFIG command.
632 633 634 635 636 637 638
 * @adev: amdgpu_device pointer
 * @notify: dmub notification structure
 *
 * Dmub AUX or SET_CONFIG command completion processing callback
 * Copies dmub notification to DM which is to be read by AUX command.
 * issuing thread and also signals the event to wake up the thread.
 */
639 640
static void dmub_aux_setconfig_callback(struct amdgpu_device *adev,
					struct dmub_notification *notify)
641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
{
	if (adev->dm.dmub_notify)
		memcpy(adev->dm.dmub_notify, notify, sizeof(struct dmub_notification));
	if (notify->type == DMUB_NOTIFICATION_AUX_REPLY)
		complete(&adev->dm.dmub_aux_transfer_done);
}

/**
 * dmub_hpd_callback - DMUB HPD interrupt processing callback.
 * @adev: amdgpu_device pointer
 * @notify: dmub notification structure
 *
 * Dmub Hpd interrupt processing callback. Gets displayindex through the
 * ink index and calls helper to do the processing.
 */
656 657
static void dmub_hpd_callback(struct amdgpu_device *adev,
			      struct dmub_notification *notify)
658 659
{
	struct amdgpu_dm_connector *aconnector;
660
	struct amdgpu_dm_connector *hpd_aconnector = NULL;
661 662 663 664
	struct drm_connector *connector;
	struct drm_connector_list_iter iter;
	struct dc_link *link;
	uint8_t link_index = 0;
665
	struct drm_device *dev;
666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681

	if (adev == NULL)
		return;

	if (notify == NULL) {
		DRM_ERROR("DMUB HPD callback notification was NULL");
		return;
	}

	if (notify->link_index > adev->dm.dc->link_count) {
		DRM_ERROR("DMUB HPD index (%u)is abnormal", notify->link_index);
		return;
	}

	link_index = notify->link_index;
	link = adev->dm.dc->links[link_index];
682
	dev = adev->dm.ddev;
683 684 685 686 687 688

	drm_connector_list_iter_begin(dev, &iter);
	drm_for_each_connector_iter(connector, &iter) {
		aconnector = to_amdgpu_dm_connector(connector);
		if (link && aconnector->dc_link == link) {
			DRM_INFO("DMUB HPD callback: link_index=%u\n", link_index);
689
			hpd_aconnector = aconnector;
690 691 692 693 694
			break;
		}
	}
	drm_connector_list_iter_end(&iter);

695 696 697 698 699 700
	if (hpd_aconnector) {
		if (notify->type == DMUB_NOTIFICATION_HPD)
			handle_hpd_irq_helper(hpd_aconnector);
		else if (notify->type == DMUB_NOTIFICATION_HPD_IRQ)
			handle_hpd_rx_irq(hpd_aconnector);
	}
701 702 703 704 705 706 707 708 709 710 711 712 713 714
}

/**
 * register_dmub_notify_callback - Sets callback for DMUB notify
 * @adev: amdgpu_device pointer
 * @type: Type of dmub notification
 * @callback: Dmub interrupt callback function
 * @dmub_int_thread_offload: offload indicator
 *
 * API to register a dmub callback handler for a dmub notification
 * Also sets indicator whether callback processing to be offloaded.
 * to dmub interrupt handling thread
 * Return: true if successfully registered, false if there is existing registration
 */
715 716 717 718
static bool register_dmub_notify_callback(struct amdgpu_device *adev,
					  enum dmub_notification_type type,
					  dmub_notify_interrupt_callback_t callback,
					  bool dmub_int_thread_offload)
719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743
{
	if (callback != NULL && type < ARRAY_SIZE(adev->dm.dmub_thread_offload)) {
		adev->dm.dmub_callback[type] = callback;
		adev->dm.dmub_thread_offload[type] = dmub_int_thread_offload;
	} else
		return false;

	return true;
}

static void dm_handle_hpd_work(struct work_struct *work)
{
	struct dmub_hpd_work *dmub_hpd_wrk;

	dmub_hpd_wrk = container_of(work, struct dmub_hpd_work, handle_hpd_work);

	if (!dmub_hpd_wrk->dmub_notify) {
		DRM_ERROR("dmub_hpd_wrk dmub_notify is NULL");
		return;
	}

	if (dmub_hpd_wrk->dmub_notify->type < ARRAY_SIZE(dmub_hpd_wrk->adev->dm.dmub_callback)) {
		dmub_hpd_wrk->adev->dm.dmub_callback[dmub_hpd_wrk->dmub_notify->type](dmub_hpd_wrk->adev,
		dmub_hpd_wrk->dmub_notify);
	}
744 745

	kfree(dmub_hpd_wrk->dmub_notify);
746 747 748 749
	kfree(dmub_hpd_wrk);

}

750
#define DMUB_TRACE_MAX_READ 64
751 752 753 754 755 756 757 758 759 760 761 762 763 764 765
/**
 * dm_dmub_outbox1_low_irq() - Handles Outbox interrupt
 * @interrupt_params: used for determining the Outbox instance
 *
 * Handles the Outbox Interrupt
 * event handler.
 */
static void dm_dmub_outbox1_low_irq(void *interrupt_params)
{
	struct dmub_notification notify;
	struct common_irq_params *irq_params = interrupt_params;
	struct amdgpu_device *adev = irq_params->adev;
	struct amdgpu_display_manager *dm = &adev->dm;
	struct dmcub_trace_buf_entry entry = { 0 };
	uint32_t count = 0;
766
	struct dmub_hpd_work *dmub_hpd_wrk;
767
	struct dc_link *plink = NULL;
768

769 770
	if (dc_enable_dmub_notifications(adev->dm.dc) &&
		irq_params->irq_src == DC_IRQ_SOURCE_DMCUB_OUTBOX) {
771

772 773 774 775 776 777
		do {
			dc_stat_get_dmub_notification(adev->dm.dc, &notify);
			if (notify.type > ARRAY_SIZE(dm->dmub_thread_offload)) {
				DRM_ERROR("DM: notify type %d invalid!", notify.type);
				continue;
			}
778 779 780 781
			if (!dm->dmub_callback[notify.type]) {
				DRM_DEBUG_DRIVER("DMUB notification skipped, no handler: type=%d\n", notify.type);
				continue;
			}
782
			if (dm->dmub_thread_offload[notify.type] == true) {
783 784 785 786 787 788 789 790 791 792 793 794 795 796
				dmub_hpd_wrk = kzalloc(sizeof(*dmub_hpd_wrk), GFP_ATOMIC);
				if (!dmub_hpd_wrk) {
					DRM_ERROR("Failed to allocate dmub_hpd_wrk");
					return;
				}
				dmub_hpd_wrk->dmub_notify = kzalloc(sizeof(struct dmub_notification), GFP_ATOMIC);
				if (!dmub_hpd_wrk->dmub_notify) {
					kfree(dmub_hpd_wrk);
					DRM_ERROR("Failed to allocate dmub_hpd_wrk->dmub_notify");
					return;
				}
				INIT_WORK(&dmub_hpd_wrk->handle_hpd_work, dm_handle_hpd_work);
				if (dmub_hpd_wrk->dmub_notify)
					memcpy(dmub_hpd_wrk->dmub_notify, &notify, sizeof(struct dmub_notification));
797 798 799 800 801
				dmub_hpd_wrk->adev = adev;
				if (notify.type == DMUB_NOTIFICATION_HPD) {
					plink = adev->dm.dc->links[notify.link_index];
					if (plink) {
						plink->hpd_status =
802
							notify.hpd_status == DP_HPD_PLUG;
803
					}
804
				}
805 806 807 808 809
				queue_work(adev->dm.delayed_hpd_wq, &dmub_hpd_wrk->handle_hpd_work);
			} else {
				dm->dmub_callback[notify.type](adev, &notify);
			}
		} while (notify.pending_notification);
810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826
	}


	do {
		if (dc_dmub_srv_get_dmub_outbox0_msg(dm->dc, &entry)) {
			trace_amdgpu_dmub_trace_high_irq(entry.trace_code, entry.tick_count,
							entry.param0, entry.param1);

			DRM_DEBUG_DRIVER("trace_code:%u, tick_count:%u, param0:%u, param1:%u\n",
				 entry.trace_code, entry.tick_count, entry.param0, entry.param1);
		} else
			break;

		count++;

	} while (count <= DMUB_TRACE_MAX_READ);

827 828
	if (count > DMUB_TRACE_MAX_READ)
		DRM_DEBUG_DRIVER("Warning : count > DMUB_TRACE_MAX_READ");
829
}
830
#endif /* CONFIG_DRM_AMD_DC_DCN */
831

832 833 834 835 836 837 838 839 840 841 842 843 844 845 846
static int dm_set_clockgating_state(void *handle,
		  enum amd_clockgating_state state)
{
	return 0;
}

static int dm_set_powergating_state(void *handle,
		  enum amd_powergating_state state)
{
	return 0;
}

/* Prototypes of private functions */
static int dm_early_init(void* handle);

847
/* Allocate memory for FBC compressed data  */
848
static void amdgpu_dm_fbc_init(struct drm_connector *connector)
849
{
850
	struct drm_device *dev = connector->dev;
851
	struct amdgpu_device *adev = drm_to_adev(dev);
M
Mauro Carvalho Chehab 已提交
852
	struct dm_compressor_info *compressor = &adev->dm.compressor;
853 854
	struct amdgpu_dm_connector *aconn = to_amdgpu_dm_connector(connector);
	struct drm_display_mode *mode;
855 856 857 858
	unsigned long max_size = 0;

	if (adev->dm.dc->fbc_compressor == NULL)
		return;
859

860
	if (aconn->dc_link->connector_signal != SIGNAL_TYPE_EDP)
861 862
		return;

863 864
	if (compressor->bo_ptr)
		return;
865 866


867 868 869
	list_for_each_entry(mode, &connector->modes, head) {
		if (max_size < mode->htotal * mode->vtotal)
			max_size = mode->htotal * mode->vtotal;
870 871 872 873
	}

	if (max_size) {
		int r = amdgpu_bo_create_kernel(adev, max_size * 4, PAGE_SIZE,
874
			    AMDGPU_GEM_DOMAIN_GTT, &compressor->bo_ptr,
875
			    &compressor->gpu_addr, &compressor->cpu_addr);
876 877

		if (r)
878 879 880 881 882 883
			DRM_ERROR("DM: Failed to initialize FBC\n");
		else {
			adev->dm.dc->ctx->fbc_gpu_addr = compressor->gpu_addr;
			DRM_INFO("DM: FBC alloc %lu\n", max_size*4);
		}

884 885 886 887
	}

}

888 889 890 891 892
static int amdgpu_dm_audio_component_get_eld(struct device *kdev, int port,
					  int pipe, bool *enabled,
					  unsigned char *buf, int max_bytes)
{
	struct drm_device *dev = dev_get_drvdata(kdev);
893
	struct amdgpu_device *adev = drm_to_adev(dev);
894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931
	struct drm_connector *connector;
	struct drm_connector_list_iter conn_iter;
	struct amdgpu_dm_connector *aconnector;
	int ret = 0;

	*enabled = false;

	mutex_lock(&adev->dm.audio_lock);

	drm_connector_list_iter_begin(dev, &conn_iter);
	drm_for_each_connector_iter(connector, &conn_iter) {
		aconnector = to_amdgpu_dm_connector(connector);
		if (aconnector->audio_inst != port)
			continue;

		*enabled = true;
		ret = drm_eld_size(connector->eld);
		memcpy(buf, connector->eld, min(max_bytes, ret));

		break;
	}
	drm_connector_list_iter_end(&conn_iter);

	mutex_unlock(&adev->dm.audio_lock);

	DRM_DEBUG_KMS("Get ELD : idx=%d ret=%d en=%d\n", port, ret, *enabled);

	return ret;
}

static const struct drm_audio_component_ops amdgpu_dm_audio_component_ops = {
	.get_eld = amdgpu_dm_audio_component_get_eld,
};

static int amdgpu_dm_audio_component_bind(struct device *kdev,
				       struct device *hda_kdev, void *data)
{
	struct drm_device *dev = dev_get_drvdata(kdev);
932
	struct amdgpu_device *adev = drm_to_adev(dev);
933 934 935 936 937 938 939 940 941 942 943 944 945
	struct drm_audio_component *acomp = data;

	acomp->ops = &amdgpu_dm_audio_component_ops;
	acomp->dev = kdev;
	adev->dm.audio_component = acomp;

	return 0;
}

static void amdgpu_dm_audio_component_unbind(struct device *kdev,
					  struct device *hda_kdev, void *data)
{
	struct drm_device *dev = dev_get_drvdata(kdev);
946
	struct amdgpu_device *adev = drm_to_adev(dev);
947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008
	struct drm_audio_component *acomp = data;

	acomp->ops = NULL;
	acomp->dev = NULL;
	adev->dm.audio_component = NULL;
}

static const struct component_ops amdgpu_dm_audio_component_bind_ops = {
	.bind	= amdgpu_dm_audio_component_bind,
	.unbind	= amdgpu_dm_audio_component_unbind,
};

static int amdgpu_dm_audio_init(struct amdgpu_device *adev)
{
	int i, ret;

	if (!amdgpu_audio)
		return 0;

	adev->mode_info.audio.enabled = true;

	adev->mode_info.audio.num_pins = adev->dm.dc->res_pool->audio_count;

	for (i = 0; i < adev->mode_info.audio.num_pins; i++) {
		adev->mode_info.audio.pin[i].channels = -1;
		adev->mode_info.audio.pin[i].rate = -1;
		adev->mode_info.audio.pin[i].bits_per_sample = -1;
		adev->mode_info.audio.pin[i].status_bits = 0;
		adev->mode_info.audio.pin[i].category_code = 0;
		adev->mode_info.audio.pin[i].connected = false;
		adev->mode_info.audio.pin[i].id =
			adev->dm.dc->res_pool->audios[i]->inst;
		adev->mode_info.audio.pin[i].offset = 0;
	}

	ret = component_add(adev->dev, &amdgpu_dm_audio_component_bind_ops);
	if (ret < 0)
		return ret;

	adev->dm.audio_registered = true;

	return 0;
}

static void amdgpu_dm_audio_fini(struct amdgpu_device *adev)
{
	if (!amdgpu_audio)
		return;

	if (!adev->mode_info.audio.enabled)
		return;

	if (adev->dm.audio_registered) {
		component_del(adev->dev, &amdgpu_dm_audio_component_bind_ops);
		adev->dm.audio_registered = false;
	}

	/* TODO: Disable audio? */

	adev->mode_info.audio.enabled = false;
}

1009
static  void amdgpu_dm_audio_eld_notify(struct amdgpu_device *adev, int pin)
1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020
{
	struct drm_audio_component *acomp = adev->dm.audio_component;

	if (acomp && acomp->audio_ops && acomp->audio_ops->pin_eld_notify) {
		DRM_DEBUG_KMS("Notify ELD: %d\n", pin);

		acomp->audio_ops->pin_eld_notify(acomp->audio_ops->audio_ptr,
						 pin, -1);
	}
}

1021 1022 1023 1024
static int dm_dmub_hw_init(struct amdgpu_device *adev)
{
	const struct dmcub_firmware_header_v1_0 *hdr;
	struct dmub_srv *dmub_srv = adev->dm.dmub_srv;
1025
	struct dmub_srv_fb_info *fb_info = adev->dm.dmub_fb_info;
1026 1027 1028 1029 1030 1031
	const struct firmware *dmub_fw = adev->dm.dmub_fw;
	struct dmcu *dmcu = adev->dm.dc->res_pool->dmcu;
	struct abm *abm = adev->dm.dc->res_pool->abm;
	struct dmub_srv_hw_params hw_params;
	enum dmub_status status;
	const unsigned char *fw_inst_const, *fw_bss_data;
1032
	uint32_t i, fw_inst_const_size, fw_bss_data_size;
1033 1034 1035 1036 1037 1038
	bool has_hw_support;

	if (!dmub_srv)
		/* DMUB isn't supported on the ASIC. */
		return 0;

1039 1040 1041 1042 1043
	if (!fb_info) {
		DRM_ERROR("No framebuffer info for DMUB service.\n");
		return -EINVAL;
	}

1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060
	if (!dmub_fw) {
		/* Firmware required for DMUB support. */
		DRM_ERROR("No firmware provided for DMUB.\n");
		return -EINVAL;
	}

	status = dmub_srv_has_hw_support(dmub_srv, &has_hw_support);
	if (status != DMUB_STATUS_OK) {
		DRM_ERROR("Error checking HW support for DMUB: %d\n", status);
		return -EINVAL;
	}

	if (!has_hw_support) {
		DRM_INFO("DMUB unsupported on ASIC\n");
		return 0;
	}

1061 1062 1063 1064 1065
	/* Reset DMCUB if it was previously running - before we overwrite its memory. */
	status = dmub_srv_hw_reset(dmub_srv);
	if (status != DMUB_STATUS_OK)
		DRM_WARN("Error resetting DMUB HW: %d\n", status);

1066 1067 1068 1069
	hdr = (const struct dmcub_firmware_header_v1_0 *)dmub_fw->data;

	fw_inst_const = dmub_fw->data +
			le32_to_cpu(hdr->header.ucode_array_offset_bytes) +
1070
			PSP_HEADER_BYTES;
1071 1072 1073 1074 1075 1076

	fw_bss_data = dmub_fw->data +
		      le32_to_cpu(hdr->header.ucode_array_offset_bytes) +
		      le32_to_cpu(hdr->inst_const_bytes);

	/* Copy firmware and bios info into FB memory. */
1077 1078 1079 1080 1081
	fw_inst_const_size = le32_to_cpu(hdr->inst_const_bytes) -
			     PSP_HEADER_BYTES - PSP_FOOTER_BYTES;

	fw_bss_data_size = le32_to_cpu(hdr->bss_data_bytes);

1082 1083 1084 1085 1086 1087 1088 1089 1090 1091
	/* if adev->firmware.load_type == AMDGPU_FW_LOAD_PSP,
	 * amdgpu_ucode_init_single_fw will load dmub firmware
	 * fw_inst_const part to cw0; otherwise, the firmware back door load
	 * will be done by dm_dmub_hw_init
	 */
	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP) {
		memcpy(fb_info->fb[DMUB_WINDOW_0_INST_CONST].cpu_addr, fw_inst_const,
				fw_inst_const_size);
	}

1092 1093 1094
	if (fw_bss_data_size)
		memcpy(fb_info->fb[DMUB_WINDOW_2_BSS_DATA].cpu_addr,
		       fw_bss_data, fw_bss_data_size);
1095 1096

	/* Copy firmware bios info into FB memory. */
1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108
	memcpy(fb_info->fb[DMUB_WINDOW_3_VBIOS].cpu_addr, adev->bios,
	       adev->bios_size);

	/* Reset regions that need to be reset. */
	memset(fb_info->fb[DMUB_WINDOW_4_MAILBOX].cpu_addr, 0,
	fb_info->fb[DMUB_WINDOW_4_MAILBOX].size);

	memset(fb_info->fb[DMUB_WINDOW_5_TRACEBUFF].cpu_addr, 0,
	       fb_info->fb[DMUB_WINDOW_5_TRACEBUFF].size);

	memset(fb_info->fb[DMUB_WINDOW_6_FW_STATE].cpu_addr, 0,
	       fb_info->fb[DMUB_WINDOW_6_FW_STATE].size);
1109 1110 1111 1112 1113 1114

	/* Initialize hardware. */
	memset(&hw_params, 0, sizeof(hw_params));
	hw_params.fb_base = adev->gmc.fb_start;
	hw_params.fb_offset = adev->gmc.aper_base;

H
Hersen Wu 已提交
1115 1116 1117 1118
	/* backdoor load firmware and trigger dmub running */
	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
		hw_params.load_inst_const = true;

1119 1120 1121
	if (dmcu)
		hw_params.psp_version = dmcu->psp_version;

1122 1123
	for (i = 0; i < fb_info->num_fb; ++i)
		hw_params.fb[i] = &fb_info->fb[i];
1124

1125 1126 1127
	switch (adev->ip_versions[DCE_HWIP][0]) {
	case IP_VERSION(3, 1, 3): /* Only for this asic hw internal rev B0 */
		hw_params.dpia_supported = true;
1128
#if defined(CONFIG_DRM_AMD_DC_DCN)
1129
		hw_params.disable_dpia = adev->dm.dc->debug.dpia_debug.bits.disable_dpia;
1130 1131 1132 1133 1134 1135
#endif
		break;
	default:
		break;
	}

1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152
	status = dmub_srv_hw_init(dmub_srv, &hw_params);
	if (status != DMUB_STATUS_OK) {
		DRM_ERROR("Error initializing DMUB HW: %d\n", status);
		return -EINVAL;
	}

	/* Wait for firmware load to finish. */
	status = dmub_srv_wait_for_auto_load(dmub_srv, 100000);
	if (status != DMUB_STATUS_OK)
		DRM_WARN("Wait for DMUB auto-load failed: %d\n", status);

	/* Init DMCU and ABM if available. */
	if (dmcu && abm) {
		dmcu->funcs->dmcu_init(dmcu);
		abm->dmcu_is_running = dmcu->funcs->is_dmcu_initialized(dmcu);
	}

1153 1154
	if (!adev->dm.dc->ctx->dmub_srv)
		adev->dm.dc->ctx->dmub_srv = dc_dmub_srv_create(adev->dm.dc, dmub_srv);
1155 1156 1157 1158 1159
	if (!adev->dm.dc->ctx->dmub_srv) {
		DRM_ERROR("Couldn't allocate DC DMUB server!\n");
		return -ENOMEM;
	}

1160 1161 1162 1163 1164 1165
	DRM_INFO("DMUB hardware initialized: version=0x%08X\n",
		 adev->dm.dmcub_fw_version);

	return 0;
}

1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191
static void dm_dmub_hw_resume(struct amdgpu_device *adev)
{
	struct dmub_srv *dmub_srv = adev->dm.dmub_srv;
	enum dmub_status status;
	bool init;

	if (!dmub_srv) {
		/* DMUB isn't supported on the ASIC. */
		return;
	}

	status = dmub_srv_is_hw_init(dmub_srv, &init);
	if (status != DMUB_STATUS_OK)
		DRM_WARN("DMUB hardware init check failed: %d\n", status);

	if (status == DMUB_STATUS_OK && init) {
		/* Wait for firmware load to finish. */
		status = dmub_srv_wait_for_auto_load(dmub_srv, 100000);
		if (status != DMUB_STATUS_OK)
			DRM_WARN("Wait for DMUB auto-load failed: %d\n", status);
	} else {
		/* Perform the full hardware initialization. */
		dm_dmub_hw_init(adev);
	}
}

1192
#if defined(CONFIG_DRM_AMD_DC_DCN)
1193
static void mmhub_read_system_context(struct amdgpu_device *adev, struct dc_phy_addr_space_config *pa_config)
1194
{
1195 1196 1197 1198 1199
	uint64_t pt_base;
	uint32_t logical_addr_low;
	uint32_t logical_addr_high;
	uint32_t agp_base, agp_bot, agp_top;
	PHYSICAL_ADDRESS_LOC page_table_start, page_table_end, page_table_base;
1200

1201 1202
	memset(pa_config, 0, sizeof(*pa_config));

1203 1204
	logical_addr_low  = min(adev->gmc.fb_start, adev->gmc.agp_start) >> 18;
	pt_base = amdgpu_gmc_pd_addr(adev->gart.bo);
1205

1206 1207 1208 1209 1210 1211 1212 1213 1214 1215
	if (adev->apu_flags & AMD_APU_IS_RAVEN2)
		/*
		 * Raven2 has a HW issue that it is unable to use the vram which
		 * is out of MC_VM_SYSTEM_APERTURE_HIGH_ADDR. So here is the
		 * workaround that increase system aperture high address (add 1)
		 * to get rid of the VM fault and hardware hang.
		 */
		logical_addr_high = max((adev->gmc.fb_end >> 18) + 0x1, adev->gmc.agp_end >> 18);
	else
		logical_addr_high = max(adev->gmc.fb_end, adev->gmc.agp_end) >> 18;
1216

1217 1218 1219
	agp_base = 0;
	agp_bot = adev->gmc.agp_start >> 24;
	agp_top = adev->gmc.agp_end >> 24;
1220 1221


1222 1223 1224 1225 1226 1227
	page_table_start.high_part = (u32)(adev->gmc.gart_start >> 44) & 0xF;
	page_table_start.low_part = (u32)(adev->gmc.gart_start >> 12);
	page_table_end.high_part = (u32)(adev->gmc.gart_end >> 44) & 0xF;
	page_table_end.low_part = (u32)(adev->gmc.gart_end >> 12);
	page_table_base.high_part = upper_32_bits(pt_base) & 0xF;
	page_table_base.low_part = lower_32_bits(pt_base);
1228

1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244
	pa_config->system_aperture.start_addr = (uint64_t)logical_addr_low << 18;
	pa_config->system_aperture.end_addr = (uint64_t)logical_addr_high << 18;

	pa_config->system_aperture.agp_base = (uint64_t)agp_base << 24 ;
	pa_config->system_aperture.agp_bot = (uint64_t)agp_bot << 24;
	pa_config->system_aperture.agp_top = (uint64_t)agp_top << 24;

	pa_config->system_aperture.fb_base = adev->gmc.fb_start;
	pa_config->system_aperture.fb_offset = adev->gmc.aper_base;
	pa_config->system_aperture.fb_top = adev->gmc.fb_end;

	pa_config->gart_config.page_table_start_addr = page_table_start.quad_part << 12;
	pa_config->gart_config.page_table_end_addr = page_table_end.quad_part << 12;
	pa_config->gart_config.page_table_base_addr = page_table_base.quad_part;

	pa_config->is_hvm_enabled = 0;
1245 1246

}
1247
#endif
1248
#if defined(CONFIG_DRM_AMD_DC_DCN)
1249
static void vblank_control_worker(struct work_struct *work)
1250
{
1251 1252
	struct vblank_control_work *vblank_work =
		container_of(work, struct vblank_control_work, work);
1253 1254 1255 1256 1257 1258
	struct amdgpu_display_manager *dm = vblank_work->dm;

	mutex_lock(&dm->dc_lock);

	if (vblank_work->enable)
		dm->active_vblank_irq_count++;
1259
	else if(dm->active_vblank_irq_count)
1260 1261
		dm->active_vblank_irq_count--;

1262
	dc_allow_idle_optimizations(dm->dc, dm->active_vblank_irq_count == 0);
1263

1264
	DRM_DEBUG_KMS("Allow idle optimizations (MALL): %d\n", dm->active_vblank_irq_count == 0);
1265

1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
	/* Control PSR based on vblank requirements from OS */
	if (vblank_work->stream && vblank_work->stream->link) {
		if (vblank_work->enable) {
			if (vblank_work->stream->link->psr_settings.psr_allow_active)
				amdgpu_dm_psr_disable(vblank_work->stream);
		} else if (vblank_work->stream->link->psr_settings.psr_feature_enabled &&
			   !vblank_work->stream->link->psr_settings.psr_allow_active &&
			   vblank_work->acrtc->dm_irq_params.allow_psr_entry) {
			amdgpu_dm_psr_enable(vblank_work->stream);
		}
	}

1278
	mutex_unlock(&dm->dc_lock);
1279 1280 1281

	dc_stream_release(vblank_work->stream);

1282
	kfree(vblank_work);
1283 1284 1285
}

#endif
1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362

static void dm_handle_hpd_rx_offload_work(struct work_struct *work)
{
	struct hpd_rx_irq_offload_work *offload_work;
	struct amdgpu_dm_connector *aconnector;
	struct dc_link *dc_link;
	struct amdgpu_device *adev;
	enum dc_connection_type new_connection_type = dc_connection_none;
	unsigned long flags;

	offload_work = container_of(work, struct hpd_rx_irq_offload_work, work);
	aconnector = offload_work->offload_wq->aconnector;

	if (!aconnector) {
		DRM_ERROR("Can't retrieve aconnector in hpd_rx_irq_offload_work");
		goto skip;
	}

	adev = drm_to_adev(aconnector->base.dev);
	dc_link = aconnector->dc_link;

	mutex_lock(&aconnector->hpd_lock);
	if (!dc_link_detect_sink(dc_link, &new_connection_type))
		DRM_ERROR("KMS: Failed to detect connector\n");
	mutex_unlock(&aconnector->hpd_lock);

	if (new_connection_type == dc_connection_none)
		goto skip;

	if (amdgpu_in_reset(adev))
		goto skip;

	mutex_lock(&adev->dm.dc_lock);
	if (offload_work->data.bytes.device_service_irq.bits.AUTOMATED_TEST)
		dc_link_dp_handle_automated_test(dc_link);
	else if ((dc_link->connector_signal != SIGNAL_TYPE_EDP) &&
			hpd_rx_irq_check_link_loss_status(dc_link, &offload_work->data) &&
			dc_link_dp_allow_hpd_rx_irq(dc_link)) {
		dc_link_dp_handle_link_loss(dc_link);
		spin_lock_irqsave(&offload_work->offload_wq->offload_lock, flags);
		offload_work->offload_wq->is_handling_link_loss = false;
		spin_unlock_irqrestore(&offload_work->offload_wq->offload_lock, flags);
	}
	mutex_unlock(&adev->dm.dc_lock);

skip:
	kfree(offload_work);

}

static struct hpd_rx_irq_offload_work_queue *hpd_rx_irq_create_workqueue(struct dc *dc)
{
	int max_caps = dc->caps.max_links;
	int i = 0;
	struct hpd_rx_irq_offload_work_queue *hpd_rx_offload_wq = NULL;

	hpd_rx_offload_wq = kcalloc(max_caps, sizeof(*hpd_rx_offload_wq), GFP_KERNEL);

	if (!hpd_rx_offload_wq)
		return NULL;


	for (i = 0; i < max_caps; i++) {
		hpd_rx_offload_wq[i].wq =
				    create_singlethread_workqueue("amdgpu_dm_hpd_rx_offload_wq");

		if (hpd_rx_offload_wq[i].wq == NULL) {
			DRM_ERROR("create amdgpu_dm_hpd_rx_offload_wq fail!");
			return NULL;
		}

		spin_lock_init(&hpd_rx_offload_wq[i].offload_lock);
	}

	return hpd_rx_offload_wq;
}

1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
struct amdgpu_stutter_quirk {
	u16 chip_vendor;
	u16 chip_device;
	u16 subsys_vendor;
	u16 subsys_device;
	u8 revision;
};

static const struct amdgpu_stutter_quirk amdgpu_stutter_quirk_list[] = {
	/* https://bugzilla.kernel.org/show_bug.cgi?id=214417 */
	{ 0x1002, 0x15dd, 0x1002, 0x15dd, 0xc8 },
	{ 0, 0, 0, 0, 0 },
};

static bool dm_should_disable_stutter(struct pci_dev *pdev)
{
	const struct amdgpu_stutter_quirk *p = amdgpu_stutter_quirk_list;

	while (p && p->chip_device != 0) {
		if (pdev->vendor == p->chip_vendor &&
		    pdev->device == p->chip_device &&
		    pdev->subsystem_vendor == p->subsys_vendor &&
		    pdev->subsystem_device == p->subsys_device &&
		    pdev->revision == p->revision) {
			return true;
		}
		++p;
	}
	return false;
}

1394
static int amdgpu_dm_init(struct amdgpu_device *adev)
1395 1396
{
	struct dc_init_data init_data;
1397 1398 1399
#ifdef CONFIG_DRM_AMD_DC_HDCP
	struct dc_callback_init init_params;
#endif
1400
	int r;
1401

1402
	adev->dm.ddev = adev_to_drm(adev);
1403 1404 1405 1406
	adev->dm.adev = adev;

	/* Zero all the fields */
	memset(&init_data, 0, sizeof(init_data));
1407 1408 1409
#ifdef CONFIG_DRM_AMD_DC_HDCP
	memset(&init_params, 0, sizeof(init_params));
#endif
1410

1411
	mutex_init(&adev->dm.dc_lock);
1412
	mutex_init(&adev->dm.audio_lock);
1413 1414 1415
#if defined(CONFIG_DRM_AMD_DC_DCN)
	spin_lock_init(&adev->dm.vblank_lock);
#endif
1416

1417 1418 1419 1420 1421 1422 1423
	if(amdgpu_dm_irq_init(adev)) {
		DRM_ERROR("amdgpu: failed to initialize DM IRQ support.\n");
		goto error;
	}

	init_data.asic_id.chip_family = adev->family;

1424
	init_data.asic_id.pci_revision_id = adev->pdev->revision;
1425
	init_data.asic_id.hw_internal_rev = adev->external_rev_id;
1426
	init_data.asic_id.chip_id = adev->pdev->device;
1427

1428
	init_data.asic_id.vram_width = adev->gmc.vram_width;
1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445
	/* TODO: initialize init_data.asic_id.vram_type here!!!! */
	init_data.asic_id.atombios_base_address =
		adev->mode_info.atom_context->bios;

	init_data.driver = adev;

	adev->dm.cgs_device = amdgpu_cgs_create_device(adev);

	if (!adev->dm.cgs_device) {
		DRM_ERROR("amdgpu: failed to create cgs device.\n");
		goto error;
	}

	init_data.cgs_device = adev->dm.cgs_device;

	init_data.dce_environment = DCE_ENV_PRODUCTION_DRV;

1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464
	switch (adev->ip_versions[DCE_HWIP][0]) {
	case IP_VERSION(2, 1, 0):
		switch (adev->dm.dmcub_fw_version) {
		case 0: /* development */
		case 0x1: /* linux-firmware.git hash 6d9f399 */
		case 0x01000000: /* linux-firmware.git hash 9a0b0f4 */
			init_data.flags.disable_dmcu = false;
			break;
		default:
			init_data.flags.disable_dmcu = true;
		}
		break;
	case IP_VERSION(2, 0, 3):
		init_data.flags.disable_dmcu = true;
		break;
	default:
		break;
	}

1465 1466 1467
	switch (adev->asic_type) {
	case CHIP_CARRIZO:
	case CHIP_STONEY:
1468 1469
		init_data.flags.gpu_vm_support = true;
		break;
1470
	default:
1471
		switch (adev->ip_versions[DCE_HWIP][0]) {
1472 1473
		case IP_VERSION(1, 0, 0):
		case IP_VERSION(1, 0, 1):
1474 1475 1476 1477 1478
			/* enable S/G on PCO and RV2 */
			if ((adev->apu_flags & AMD_APU_IS_RAVEN2) ||
			    (adev->apu_flags & AMD_APU_IS_PICASSO))
				init_data.flags.gpu_vm_support = true;
			break;
1479
		case IP_VERSION(2, 1, 0):
1480 1481 1482
		case IP_VERSION(3, 0, 1):
		case IP_VERSION(3, 1, 2):
		case IP_VERSION(3, 1, 3):
1483
		case IP_VERSION(3, 1, 5):
1484 1485 1486 1487 1488
			init_data.flags.gpu_vm_support = true;
			break;
		default:
			break;
		}
1489 1490
		break;
	}
1491

1492 1493 1494
	if (init_data.flags.gpu_vm_support)
		adev->mode_info.gpu_vm_support = true;

1495 1496 1497
	if (amdgpu_dc_feature_mask & DC_FBC_MASK)
		init_data.flags.fbc_support = true;

1498 1499 1500
	if (amdgpu_dc_feature_mask & DC_MULTI_MON_PP_MCLK_SWITCH_MASK)
		init_data.flags.multi_mon_pp_mclk_switch = true;

1501 1502
	if (amdgpu_dc_feature_mask & DC_DISABLE_FRACTIONAL_PWM_MASK)
		init_data.flags.disable_fractional_pwm = true;
1503 1504 1505

	if (amdgpu_dc_feature_mask & DC_EDP_NO_POWER_SEQUENCING)
		init_data.flags.edp_no_power_sequencing = true;
1506

1507 1508 1509 1510 1511 1512 1513
#ifdef CONFIG_DRM_AMD_DC_DCN
	if (amdgpu_dc_feature_mask & DC_DISABLE_LTTPR_DP1_4A)
		init_data.flags.allow_lttpr_non_transparent_mode.bits.DP1_4A = true;
	if (amdgpu_dc_feature_mask & DC_DISABLE_LTTPR_DP2_0)
		init_data.flags.allow_lttpr_non_transparent_mode.bits.DP2_0 = true;
#endif

1514
	init_data.flags.seamless_boot_edp_requested = false;
1515

1516
	if (check_seamless_boot_capability(adev)) {
1517
		init_data.flags.seamless_boot_edp_requested = true;
1518 1519 1520 1521
		init_data.flags.allow_seamless_boot_optimization = true;
		DRM_INFO("Seamless boot condition check passed\n");
	}

1522
	INIT_LIST_HEAD(&adev->dm.da_list);
1523 1524 1525
	/* Display Core create. */
	adev->dm.dc = dc_create(&init_data);

1526
	if (adev->dm.dc) {
1527
		DRM_INFO("Display Core initialized with v%s!\n", DC_VER);
1528
	} else {
1529
		DRM_INFO("Display Core failed to initialize with v%s!\n", DC_VER);
1530 1531
		goto error;
	}
1532

1533 1534 1535 1536 1537
	if (amdgpu_dc_debug_mask & DC_DISABLE_PIPE_SPLIT) {
		adev->dm.dc->debug.force_single_disp_pipe_split = false;
		adev->dm.dc->debug.pipe_split_policy = MPC_SPLIT_AVOID;
	}

1538 1539
	if (adev->asic_type != CHIP_CARRIZO && adev->asic_type != CHIP_STONEY)
		adev->dm.dc->debug.disable_stutter = amdgpu_pp_feature_mask & PP_STUTTER_MODE ? false : true;
1540 1541
	if (dm_should_disable_stutter(adev->pdev))
		adev->dm.dc->debug.disable_stutter = true;
1542

1543 1544 1545
	if (amdgpu_dc_debug_mask & DC_DISABLE_STUTTER)
		adev->dm.dc->debug.disable_stutter = true;

1546
	if (amdgpu_dc_debug_mask & DC_DISABLE_DSC) {
1547
		adev->dm.dc->debug.disable_dsc = true;
1548 1549
		adev->dm.dc->debug.disable_dsc_edp = true;
	}
1550 1551 1552 1553

	if (amdgpu_dc_debug_mask & DC_DISABLE_CLOCK_GATING)
		adev->dm.dc->debug.disable_clock_gate = true;

1554 1555 1556 1557 1558 1559
	r = dm_dmub_hw_init(adev);
	if (r) {
		DRM_ERROR("DMUB interface failed to initialize: status=%d\n", r);
		goto error;
	}

1560 1561
	dc_hardware_init(adev->dm.dc);

1562 1563 1564 1565 1566 1567
	adev->dm.hpd_rx_offload_wq = hpd_rx_irq_create_workqueue(adev->dm.dc);
	if (!adev->dm.hpd_rx_offload_wq) {
		DRM_ERROR("amdgpu: failed to create hpd rx offload workqueue.\n");
		goto error;
	}

1568
#if defined(CONFIG_DRM_AMD_DC_DCN)
1569
	if ((adev->flags & AMD_IS_APU) && (adev->asic_type >= CHIP_CARRIZO)) {
1570 1571
		struct dc_phy_addr_space_config pa_config;

1572
		mmhub_read_system_context(adev, &pa_config);
1573

1574 1575 1576 1577
		// Call the DC init_memory func
		dc_setup_system_context(adev->dm.dc, &pa_config);
	}
#endif
1578

1579 1580 1581 1582 1583
	adev->dm.freesync_module = mod_freesync_create(adev->dm.dc);
	if (!adev->dm.freesync_module) {
		DRM_ERROR(
		"amdgpu: failed to initialize freesync_module.\n");
	} else
1584
		DRM_DEBUG_DRIVER("amdgpu: freesync_module init done %p.\n",
1585 1586
				adev->dm.freesync_module);

1587 1588
	amdgpu_dm_init_color_mod();

1589 1590
#if defined(CONFIG_DRM_AMD_DC_DCN)
	if (adev->dm.dc->caps.max_links > 0) {
1591 1592 1593
		adev->dm.vblank_control_workqueue =
			create_singlethread_workqueue("dm_vblank_control_workqueue");
		if (!adev->dm.vblank_control_workqueue)
1594 1595 1596 1597
			DRM_ERROR("amdgpu: failed to initialize vblank_workqueue.\n");
	}
#endif

1598
#ifdef CONFIG_DRM_AMD_DC_HDCP
1599
	if (adev->dm.dc->caps.max_links > 0 && adev->family >= AMDGPU_FAMILY_RV) {
1600
		adev->dm.hdcp_workqueue = hdcp_create_workqueue(adev, &init_params.cp_psp, adev->dm.dc);
1601

1602 1603 1604 1605
		if (!adev->dm.hdcp_workqueue)
			DRM_ERROR("amdgpu: failed to initialize hdcp_workqueue.\n");
		else
			DRM_DEBUG_DRIVER("amdgpu: hdcp_workqueue init done %p.\n", adev->dm.hdcp_workqueue);
1606

1607 1608
		dc_init_callbacks(adev->dm.dc, &init_params);
	}
1609 1610 1611
#endif
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
	adev->dm.crc_rd_wrk = amdgpu_dm_crtc_secure_display_create_work();
1612
#endif
1613 1614 1615 1616 1617 1618 1619
	if (dc_enable_dmub_notifications(adev->dm.dc)) {
		init_completion(&adev->dm.dmub_aux_transfer_done);
		adev->dm.dmub_notify = kzalloc(sizeof(struct dmub_notification), GFP_KERNEL);
		if (!adev->dm.dmub_notify) {
			DRM_INFO("amdgpu: fail to allocate adev->dm.dmub_notify");
			goto error;
		}
1620 1621 1622 1623 1624 1625 1626

		adev->dm.delayed_hpd_wq = create_singlethread_workqueue("amdgpu_dm_hpd_wq");
		if (!adev->dm.delayed_hpd_wq) {
			DRM_ERROR("amdgpu: failed to create hpd offload workqueue.\n");
			goto error;
		}

1627
		amdgpu_dm_outbox_init(adev);
1628 1629 1630 1631 1632 1633 1634 1635 1636 1637
#if defined(CONFIG_DRM_AMD_DC_DCN)
		if (!register_dmub_notify_callback(adev, DMUB_NOTIFICATION_AUX_REPLY,
			dmub_aux_setconfig_callback, false)) {
			DRM_ERROR("amdgpu: fail to register dmub aux callback");
			goto error;
		}
		if (!register_dmub_notify_callback(adev, DMUB_NOTIFICATION_HPD, dmub_hpd_callback, true)) {
			DRM_ERROR("amdgpu: fail to register dmub hpd callback");
			goto error;
		}
1638 1639 1640 1641
		if (!register_dmub_notify_callback(adev, DMUB_NOTIFICATION_HPD_IRQ, dmub_hpd_callback, true)) {
			DRM_ERROR("amdgpu: fail to register dmub hpd callback");
			goto error;
		}
1642
#endif /* CONFIG_DRM_AMD_DC_DCN */
1643 1644
	}

1645 1646 1647 1648 1649 1650
	if (amdgpu_dm_initialize_drm_device(adev)) {
		DRM_ERROR(
		"amdgpu: failed to initialize sw for display support.\n");
		goto error;
	}

1651 1652 1653
	/* create fake encoders for MST */
	dm_dp_create_fake_mst_encoders(adev);

1654 1655 1656
	/* TODO: Add_display_info? */

	/* TODO use dynamic cursor width */
1657 1658
	adev_to_drm(adev)->mode_config.cursor_width = adev->dm.dc->caps.max_cursor_size;
	adev_to_drm(adev)->mode_config.cursor_height = adev->dm.dc->caps.max_cursor_size;
1659

1660
	if (drm_vblank_init(adev_to_drm(adev), adev->dm.display_indexes_num)) {
1661 1662 1663 1664 1665
		DRM_ERROR(
		"amdgpu: failed to initialize sw for display support.\n");
		goto error;
	}

1666

1667
	DRM_DEBUG_DRIVER("KMS initialized.\n");
1668 1669 1670 1671 1672

	return 0;
error:
	amdgpu_dm_fini(adev);

1673
	return -EINVAL;
1674 1675
}

1676 1677 1678 1679 1680 1681 1682 1683 1684
static int amdgpu_dm_early_fini(void *handle)
{
	struct amdgpu_device *adev = (struct amdgpu_device *)handle;

	amdgpu_dm_audio_fini(adev);

	return 0;
}

1685
static void amdgpu_dm_fini(struct amdgpu_device *adev)
1686
{
1687 1688
	int i;

1689 1690 1691 1692 1693 1694 1695
#if defined(CONFIG_DRM_AMD_DC_DCN)
	if (adev->dm.vblank_control_workqueue) {
		destroy_workqueue(adev->dm.vblank_control_workqueue);
		adev->dm.vblank_control_workqueue = NULL;
	}
#endif

1696 1697 1698 1699
	for (i = 0; i < adev->dm.display_indexes_num; i++) {
		drm_encoder_cleanup(&adev->dm.mst_encoders[i].base);
	}

1700
	amdgpu_dm_destroy_drm_device(&adev->dm);
E
Emily Deng 已提交
1701

1702 1703 1704 1705 1706 1707 1708
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
	if (adev->dm.crc_rd_wrk) {
		flush_work(&adev->dm.crc_rd_wrk->notify_ta_work);
		kfree(adev->dm.crc_rd_wrk);
		adev->dm.crc_rd_wrk = NULL;
	}
#endif
1709 1710
#ifdef CONFIG_DRM_AMD_DC_HDCP
	if (adev->dm.hdcp_workqueue) {
1711
		hdcp_destroy(&adev->dev->kobj, adev->dm.hdcp_workqueue);
1712 1713 1714 1715 1716 1717
		adev->dm.hdcp_workqueue = NULL;
	}

	if (adev->dm.dc)
		dc_deinit_callbacks(adev->dm.dc);
#endif
1718

1719
	dc_dmub_srv_destroy(&adev->dm.dc->ctx->dmub_srv);
1720

1721 1722 1723
	if (dc_enable_dmub_notifications(adev->dm.dc)) {
		kfree(adev->dm.dmub_notify);
		adev->dm.dmub_notify = NULL;
1724 1725
		destroy_workqueue(adev->dm.delayed_hpd_wq);
		adev->dm.delayed_hpd_wq = NULL;
1726 1727
	}

1728 1729 1730 1731
	if (adev->dm.dmub_bo)
		amdgpu_bo_free_kernel(&adev->dm.dmub_bo,
				      &adev->dm.dmub_bo_gpu_addr,
				      &adev->dm.dmub_bo_cpu_addr);
1732

1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744
	if (adev->dm.hpd_rx_offload_wq) {
		for (i = 0; i < adev->dm.dc->caps.max_links; i++) {
			if (adev->dm.hpd_rx_offload_wq[i].wq) {
				destroy_workqueue(adev->dm.hpd_rx_offload_wq[i].wq);
				adev->dm.hpd_rx_offload_wq[i].wq = NULL;
			}
		}

		kfree(adev->dm.hpd_rx_offload_wq);
		adev->dm.hpd_rx_offload_wq = NULL;
	}

E
Emily Deng 已提交
1745 1746 1747
	/* DC Destroy TODO: Replace destroy DAL */
	if (adev->dm.dc)
		dc_destroy(&adev->dm.dc);
1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761
	/*
	 * TODO: pageflip, vlank interrupt
	 *
	 * amdgpu_dm_irq_fini(adev);
	 */

	if (adev->dm.cgs_device) {
		amdgpu_cgs_destroy_device(adev->dm.cgs_device);
		adev->dm.cgs_device = NULL;
	}
	if (adev->dm.freesync_module) {
		mod_freesync_destroy(adev->dm.freesync_module);
		adev->dm.freesync_module = NULL;
	}
1762

1763
	mutex_destroy(&adev->dm.audio_lock);
1764 1765
	mutex_destroy(&adev->dm.dc_lock);

1766 1767 1768
	return;
}

D
David Francis 已提交
1769
static int load_dmcu_fw(struct amdgpu_device *adev)
1770
{
1771
	const char *fw_name_dmcu = NULL;
D
David Francis 已提交
1772 1773 1774 1775
	int r;
	const struct dmcu_firmware_header_v1_0 *hdr;

	switch(adev->asic_type) {
1776 1777 1778 1779 1780 1781
#if defined(CONFIG_DRM_AMD_DC_SI)
	case CHIP_TAHITI:
	case CHIP_PITCAIRN:
	case CHIP_VERDE:
	case CHIP_OLAND:
#endif
D
David Francis 已提交
1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798
	case CHIP_BONAIRE:
	case CHIP_HAWAII:
	case CHIP_KAVERI:
	case CHIP_KABINI:
	case CHIP_MULLINS:
	case CHIP_TONGA:
	case CHIP_FIJI:
	case CHIP_CARRIZO:
	case CHIP_STONEY:
	case CHIP_POLARIS11:
	case CHIP_POLARIS10:
	case CHIP_POLARIS12:
	case CHIP_VEGAM:
	case CHIP_VEGA10:
	case CHIP_VEGA12:
	case CHIP_VEGA20:
		return 0;
1799 1800 1801
	case CHIP_NAVI12:
		fw_name_dmcu = FIRMWARE_NAVI12_DMCU;
		break;
D
David Francis 已提交
1802
	case CHIP_RAVEN:
1803 1804 1805 1806 1807 1808
		if (ASICREV_IS_PICASSO(adev->external_rev_id))
			fw_name_dmcu = FIRMWARE_RAVEN_DMCU;
		else if (ASICREV_IS_RAVEN2(adev->external_rev_id))
			fw_name_dmcu = FIRMWARE_RAVEN_DMCU;
		else
			return 0;
D
David Francis 已提交
1809 1810
		break;
	default:
1811
		switch (adev->ip_versions[DCE_HWIP][0]) {
1812 1813 1814 1815 1816 1817 1818 1819 1820 1821
		case IP_VERSION(2, 0, 2):
		case IP_VERSION(2, 0, 3):
		case IP_VERSION(2, 0, 0):
		case IP_VERSION(2, 1, 0):
		case IP_VERSION(3, 0, 0):
		case IP_VERSION(3, 0, 2):
		case IP_VERSION(3, 0, 3):
		case IP_VERSION(3, 0, 1):
		case IP_VERSION(3, 1, 2):
		case IP_VERSION(3, 1, 3):
1822
		case IP_VERSION(3, 1, 5):
1823
		case IP_VERSION(3, 1, 6):
1824 1825 1826 1827
			return 0;
		default:
			break;
		}
D
David Francis 已提交
1828
		DRM_ERROR("Unsupported ASIC type: 0x%X\n", adev->asic_type);
1829
		return -EINVAL;
D
David Francis 已提交
1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869
	}

	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP) {
		DRM_DEBUG_KMS("dm: DMCU firmware not supported on direct or SMU loading\n");
		return 0;
	}

	r = request_firmware_direct(&adev->dm.fw_dmcu, fw_name_dmcu, adev->dev);
	if (r == -ENOENT) {
		/* DMCU firmware is not necessary, so don't raise a fuss if it's missing */
		DRM_DEBUG_KMS("dm: DMCU firmware not found\n");
		adev->dm.fw_dmcu = NULL;
		return 0;
	}
	if (r) {
		dev_err(adev->dev, "amdgpu_dm: Can't load firmware \"%s\"\n",
			fw_name_dmcu);
		return r;
	}

	r = amdgpu_ucode_validate(adev->dm.fw_dmcu);
	if (r) {
		dev_err(adev->dev, "amdgpu_dm: Can't validate firmware \"%s\"\n",
			fw_name_dmcu);
		release_firmware(adev->dm.fw_dmcu);
		adev->dm.fw_dmcu = NULL;
		return r;
	}

	hdr = (const struct dmcu_firmware_header_v1_0 *)adev->dm.fw_dmcu->data;
	adev->firmware.ucode[AMDGPU_UCODE_ID_DMCU_ERAM].ucode_id = AMDGPU_UCODE_ID_DMCU_ERAM;
	adev->firmware.ucode[AMDGPU_UCODE_ID_DMCU_ERAM].fw = adev->dm.fw_dmcu;
	adev->firmware.fw_size +=
		ALIGN(le32_to_cpu(hdr->header.ucode_size_bytes) - le32_to_cpu(hdr->intv_size_bytes), PAGE_SIZE);

	adev->firmware.ucode[AMDGPU_UCODE_ID_DMCU_INTV].ucode_id = AMDGPU_UCODE_ID_DMCU_INTV;
	adev->firmware.ucode[AMDGPU_UCODE_ID_DMCU_INTV].fw = adev->dm.fw_dmcu;
	adev->firmware.fw_size +=
		ALIGN(le32_to_cpu(hdr->intv_size_bytes), PAGE_SIZE);

1870 1871
	adev->dm.dmcu_fw_version = le32_to_cpu(hdr->header.ucode_version);

D
David Francis 已提交
1872 1873
	DRM_DEBUG_KMS("PSP loading DMCU firmware\n");

1874 1875 1876
	return 0;
}

1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894
static uint32_t amdgpu_dm_dmub_reg_read(void *ctx, uint32_t address)
{
	struct amdgpu_device *adev = ctx;

	return dm_read_reg(adev->dm.dc->ctx, address);
}

static void amdgpu_dm_dmub_reg_write(void *ctx, uint32_t address,
				     uint32_t value)
{
	struct amdgpu_device *adev = ctx;

	return dm_write_reg(adev->dm.dc->ctx, address, value);
}

static int dm_dmub_sw_init(struct amdgpu_device *adev)
{
	struct dmub_srv_create_params create_params;
1895 1896 1897 1898 1899
	struct dmub_srv_region_params region_params;
	struct dmub_srv_region_info region_info;
	struct dmub_srv_fb_params fb_params;
	struct dmub_srv_fb_info *fb_info;
	struct dmub_srv *dmub_srv;
1900 1901 1902 1903 1904 1905
	const struct dmcub_firmware_header_v1_0 *hdr;
	const char *fw_name_dmub;
	enum dmub_asic dmub_asic;
	enum dmub_status status;
	int r;

1906
	switch (adev->ip_versions[DCE_HWIP][0]) {
1907
	case IP_VERSION(2, 1, 0):
1908 1909
		dmub_asic = DMUB_ASIC_DCN21;
		fw_name_dmub = FIRMWARE_RENOIR_DMUB;
1910 1911
		if (ASICREV_IS_GREEN_SARDINE(adev->external_rev_id))
			fw_name_dmub = FIRMWARE_GREEN_SARDINE_DMUB;
1912
		break;
1913
	case IP_VERSION(3, 0, 0):
1914
		if (adev->ip_versions[GC_HWIP][0] == IP_VERSION(10, 3, 0)) {
1915 1916 1917 1918 1919 1920
			dmub_asic = DMUB_ASIC_DCN30;
			fw_name_dmub = FIRMWARE_SIENNA_CICHLID_DMUB;
		} else {
			dmub_asic = DMUB_ASIC_DCN30;
			fw_name_dmub = FIRMWARE_NAVY_FLOUNDER_DMUB;
		}
1921
		break;
1922
	case IP_VERSION(3, 0, 1):
1923 1924 1925
		dmub_asic = DMUB_ASIC_DCN301;
		fw_name_dmub = FIRMWARE_VANGOGH_DMUB;
		break;
1926
	case IP_VERSION(3, 0, 2):
1927 1928 1929
		dmub_asic = DMUB_ASIC_DCN302;
		fw_name_dmub = FIRMWARE_DIMGREY_CAVEFISH_DMUB;
		break;
1930
	case IP_VERSION(3, 0, 3):
1931 1932 1933
		dmub_asic = DMUB_ASIC_DCN303;
		fw_name_dmub = FIRMWARE_BEIGE_GOBY_DMUB;
		break;
1934 1935
	case IP_VERSION(3, 1, 2):
	case IP_VERSION(3, 1, 3):
1936
		dmub_asic = (adev->external_rev_id == YELLOW_CARP_B0) ? DMUB_ASIC_DCN31B : DMUB_ASIC_DCN31;
1937 1938
		fw_name_dmub = FIRMWARE_YELLOW_CARP_DMUB;
		break;
1939 1940 1941 1942
	case IP_VERSION(3, 1, 5):
		dmub_asic = DMUB_ASIC_DCN315;
		fw_name_dmub = FIRMWARE_DCN_315_DMUB;
		break;
1943
	case IP_VERSION(3, 1, 6):
1944
		dmub_asic = DMUB_ASIC_DCN316;
1945 1946
		fw_name_dmub = FIRMWARE_DCN316_DMUB;
		break;
1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964
	default:
		/* ASIC doesn't support DMUB. */
		return 0;
	}

	r = request_firmware_direct(&adev->dm.dmub_fw, fw_name_dmub, adev->dev);
	if (r) {
		DRM_ERROR("DMUB firmware loading failed: %d\n", r);
		return 0;
	}

	r = amdgpu_ucode_validate(adev->dm.dmub_fw);
	if (r) {
		DRM_ERROR("Couldn't validate DMUB firmware: %d\n", r);
		return 0;
	}

	hdr = (const struct dmcub_firmware_header_v1_0 *)adev->dm.dmub_fw->data;
1965
	adev->dm.dmcub_fw_version = le32_to_cpu(hdr->header.ucode_version);
1966

1967 1968 1969 1970 1971 1972 1973
	if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
		adev->firmware.ucode[AMDGPU_UCODE_ID_DMCUB].ucode_id =
			AMDGPU_UCODE_ID_DMCUB;
		adev->firmware.ucode[AMDGPU_UCODE_ID_DMCUB].fw =
			adev->dm.dmub_fw;
		adev->firmware.fw_size +=
			ALIGN(le32_to_cpu(hdr->inst_const_bytes), PAGE_SIZE);
1974

1975 1976 1977 1978
		DRM_INFO("Loading DMUB firmware via PSP: version=0x%08X\n",
			 adev->dm.dmcub_fw_version);
	}

1979

1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007
	adev->dm.dmub_srv = kzalloc(sizeof(*adev->dm.dmub_srv), GFP_KERNEL);
	dmub_srv = adev->dm.dmub_srv;

	if (!dmub_srv) {
		DRM_ERROR("Failed to allocate DMUB service!\n");
		return -ENOMEM;
	}

	memset(&create_params, 0, sizeof(create_params));
	create_params.user_ctx = adev;
	create_params.funcs.reg_read = amdgpu_dm_dmub_reg_read;
	create_params.funcs.reg_write = amdgpu_dm_dmub_reg_write;
	create_params.asic = dmub_asic;

	/* Create the DMUB service. */
	status = dmub_srv_create(dmub_srv, &create_params);
	if (status != DMUB_STATUS_OK) {
		DRM_ERROR("Error creating DMUB service: %d\n", status);
		return -EINVAL;
	}

	/* Calculate the size of all the regions for the DMUB service. */
	memset(&region_params, 0, sizeof(region_params));

	region_params.inst_const_size = le32_to_cpu(hdr->inst_const_bytes) -
					PSP_HEADER_BYTES - PSP_FOOTER_BYTES;
	region_params.bss_data_size = le32_to_cpu(hdr->bss_data_bytes);
	region_params.vbios_size = adev->bios_size;
2008
	region_params.fw_bss_data = region_params.bss_data_size ?
2009 2010
		adev->dm.dmub_fw->data +
		le32_to_cpu(hdr->header.ucode_array_offset_bytes) +
2011
		le32_to_cpu(hdr->inst_const_bytes) : NULL;
2012 2013 2014 2015
	region_params.fw_inst_const =
		adev->dm.dmub_fw->data +
		le32_to_cpu(hdr->header.ucode_array_offset_bytes) +
		PSP_HEADER_BYTES;
2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057

	status = dmub_srv_calc_region_info(dmub_srv, &region_params,
					   &region_info);

	if (status != DMUB_STATUS_OK) {
		DRM_ERROR("Error calculating DMUB region info: %d\n", status);
		return -EINVAL;
	}

	/*
	 * Allocate a framebuffer based on the total size of all the regions.
	 * TODO: Move this into GART.
	 */
	r = amdgpu_bo_create_kernel(adev, region_info.fb_size, PAGE_SIZE,
				    AMDGPU_GEM_DOMAIN_VRAM, &adev->dm.dmub_bo,
				    &adev->dm.dmub_bo_gpu_addr,
				    &adev->dm.dmub_bo_cpu_addr);
	if (r)
		return r;

	/* Rebase the regions on the framebuffer address. */
	memset(&fb_params, 0, sizeof(fb_params));
	fb_params.cpu_addr = adev->dm.dmub_bo_cpu_addr;
	fb_params.gpu_addr = adev->dm.dmub_bo_gpu_addr;
	fb_params.region_info = &region_info;

	adev->dm.dmub_fb_info =
		kzalloc(sizeof(*adev->dm.dmub_fb_info), GFP_KERNEL);
	fb_info = adev->dm.dmub_fb_info;

	if (!fb_info) {
		DRM_ERROR(
			"Failed to allocate framebuffer info for DMUB service!\n");
		return -ENOMEM;
	}

	status = dmub_srv_calc_fb_info(dmub_srv, &fb_params, fb_info);
	if (status != DMUB_STATUS_OK) {
		DRM_ERROR("Error calculating DMUB FB info: %d\n", status);
		return -EINVAL;
	}

2058 2059 2060
	return 0;
}

D
David Francis 已提交
2061 2062 2063
static int dm_sw_init(void *handle)
{
	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2064 2065 2066 2067 2068
	int r;

	r = dm_dmub_sw_init(adev);
	if (r)
		return r;
D
David Francis 已提交
2069 2070 2071 2072

	return load_dmcu_fw(adev);
}

2073 2074
static int dm_sw_fini(void *handle)
{
D
David Francis 已提交
2075 2076
	struct amdgpu_device *adev = (struct amdgpu_device *)handle;

2077 2078 2079
	kfree(adev->dm.dmub_fb_info);
	adev->dm.dmub_fb_info = NULL;

2080 2081 2082 2083 2084
	if (adev->dm.dmub_srv) {
		dmub_srv_destroy(adev->dm.dmub_srv);
		adev->dm.dmub_srv = NULL;
	}

2085 2086
	release_firmware(adev->dm.dmub_fw);
	adev->dm.dmub_fw = NULL;
2087

2088 2089
	release_firmware(adev->dm.fw_dmcu);
	adev->dm.fw_dmcu = NULL;
D
David Francis 已提交
2090

2091 2092 2093
	return 0;
}

2094
static int detect_mst_link_for_all_connectors(struct drm_device *dev)
2095
{
2096
	struct amdgpu_dm_connector *aconnector;
2097
	struct drm_connector *connector;
2098
	struct drm_connector_list_iter iter;
2099
	int ret = 0;
2100

2101 2102
	drm_connector_list_iter_begin(dev, &iter);
	drm_for_each_connector_iter(connector, &iter) {
2103
		aconnector = to_amdgpu_dm_connector(connector);
2104 2105
		if (aconnector->dc_link->type == dc_connection_mst_branch &&
		    aconnector->mst_mgr.aux) {
2106
			DRM_DEBUG_DRIVER("DM_MST: starting TM on aconnector: %p [id: %d]\n",
2107 2108
					 aconnector,
					 aconnector->base.base.id);
2109 2110 2111 2112

			ret = drm_dp_mst_topology_mgr_set_mst(&aconnector->mst_mgr, true);
			if (ret < 0) {
				DRM_ERROR("DM_MST: Failed to start MST\n");
2113 2114 2115
				aconnector->dc_link->type =
					dc_connection_single;
				break;
2116
			}
2117
		}
2118
	}
2119
	drm_connector_list_iter_end(&iter);
2120

2121 2122 2123 2124 2125
	return ret;
}

static int dm_late_init(void *handle)
{
2126
	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
2127

D
David Francis 已提交
2128 2129 2130
	struct dmcu_iram_parameters params;
	unsigned int linear_lut[16];
	int i;
2131
	struct dmcu *dmcu = NULL;
D
David Francis 已提交
2132

2133 2134
	dmcu = adev->dm.dc->res_pool->dmcu;

D
David Francis 已提交
2135 2136 2137 2138
	for (i = 0; i < 16; i++)
		linear_lut[i] = 0xFFFF * i / 15;

	params.set = 0;
2139
	params.backlight_ramping_override = false;
D
David Francis 已提交
2140 2141 2142 2143 2144
	params.backlight_ramping_start = 0xCCCC;
	params.backlight_ramping_reduction = 0xCCCCCCCC;
	params.backlight_lut_array_size = 16;
	params.backlight_lut_array = linear_lut;

2145 2146 2147 2148
	/* Min backlight level after ABM reduction,  Don't allow below 1%
	 * 0xFFFF x 0.01 = 0x28F
	 */
	params.min_abm_backlight = 0x28F;
2149
	/* In the case where abm is implemented on dmcub,
2150 2151 2152 2153 2154 2155 2156 2157 2158
	* dmcu object will be null.
	* ABM 2.4 and up are implemented on dmcub.
	*/
	if (dmcu) {
		if (!dmcu_load_iram(dmcu, params))
			return -EINVAL;
	} else if (adev->dm.dc->ctx->dmub_srv) {
		struct dc_link *edp_links[MAX_NUM_EDP];
		int edp_num;
D
David Francis 已提交
2159

2160 2161 2162 2163 2164 2165
		get_edp_links(adev->dm.dc, edp_links, &edp_num);
		for (i = 0; i < edp_num; i++) {
			if (!dmub_init_abm_config(adev->dm.dc->res_pool, params, i))
				return -EINVAL;
		}
	}
D
David Francis 已提交
2166

2167
	return detect_mst_link_for_all_connectors(adev_to_drm(adev));
2168 2169 2170 2171
}

static void s3_handle_mst(struct drm_device *dev, bool suspend)
{
2172
	struct amdgpu_dm_connector *aconnector;
2173
	struct drm_connector *connector;
2174
	struct drm_connector_list_iter iter;
2175 2176 2177
	struct drm_dp_mst_topology_mgr *mgr;
	int ret;
	bool need_hotplug = false;
2178

2179 2180
	drm_connector_list_iter_begin(dev, &iter);
	drm_for_each_connector_iter(connector, &iter) {
2181 2182 2183 2184 2185 2186 2187 2188 2189 2190
		aconnector = to_amdgpu_dm_connector(connector);
		if (aconnector->dc_link->type != dc_connection_mst_branch ||
		    aconnector->mst_port)
			continue;

		mgr = &aconnector->mst_mgr;

		if (suspend) {
			drm_dp_mst_topology_mgr_suspend(mgr);
		} else {
2191
			ret = drm_dp_mst_topology_mgr_resume(mgr, true);
2192 2193 2194 2195 2196
			if (ret < 0) {
				drm_dp_mst_topology_mgr_set_mst(mgr, false);
				need_hotplug = true;
			}
		}
2197
	}
2198
	drm_connector_list_iter_end(&iter);
2199 2200 2201

	if (need_hotplug)
		drm_kms_helper_hotplug_event(dev);
2202 2203
}

2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237
static int amdgpu_dm_smu_write_watermarks_table(struct amdgpu_device *adev)
{
	int ret = 0;

	/* This interface is for dGPU Navi1x.Linux dc-pplib interface depends
	 * on window driver dc implementation.
	 * For Navi1x, clock settings of dcn watermarks are fixed. the settings
	 * should be passed to smu during boot up and resume from s3.
	 * boot up: dc calculate dcn watermark clock settings within dc_create,
	 * dcn20_resource_construct
	 * then call pplib functions below to pass the settings to smu:
	 * smu_set_watermarks_for_clock_ranges
	 * smu_set_watermarks_table
	 * navi10_set_watermarks_table
	 * smu_write_watermarks_table
	 *
	 * For Renoir, clock settings of dcn watermark are also fixed values.
	 * dc has implemented different flow for window driver:
	 * dc_hardware_init / dc_set_power_state
	 * dcn10_init_hw
	 * notify_wm_ranges
	 * set_wm_ranges
	 * -- Linux
	 * smu_set_watermarks_for_clock_ranges
	 * renoir_set_watermarks_table
	 * smu_write_watermarks_table
	 *
	 * For Linux,
	 * dc_hardware_init -> amdgpu_dm_init
	 * dc_set_power_state --> dm_resume
	 *
	 * therefore, this function apply to navi10/12/14 but not Renoir
	 * *
	 */
2238
	switch (adev->ip_versions[DCE_HWIP][0]) {
2239 2240
	case IP_VERSION(2, 0, 2):
	case IP_VERSION(2, 0, 0):
2241 2242 2243 2244 2245
		break;
	default:
		return 0;
	}

2246
	ret = amdgpu_dpm_write_watermarks_table(adev);
2247 2248 2249
	if (ret) {
		DRM_ERROR("Failed to update WMTABLE!\n");
		return ret;
2250 2251 2252 2253 2254
	}

	return 0;
}

2255 2256
/**
 * dm_hw_init() - Initialize DC device
2257
 * @handle: The base driver device containing the amdgpu_dm device.
2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274
 *
 * Initialize the &struct amdgpu_display_manager device. This involves calling
 * the initializers of each DM component, then populating the struct with them.
 *
 * Although the function implies hardware initialization, both hardware and
 * software are initialized here. Splitting them out to their relevant init
 * hooks is a future TODO item.
 *
 * Some notable things that are initialized here:
 *
 * - Display Core, both software and hardware
 * - DC modules that we need (freesync and color management)
 * - DRM software states
 * - Interrupt sources and handlers
 * - Vblank support
 * - Debug FS entries, if enabled
 */
2275 2276 2277 2278 2279 2280 2281 2282 2283 2284
static int dm_hw_init(void *handle)
{
	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
	/* Create DAL display manager */
	amdgpu_dm_init(adev);
	amdgpu_dm_hpd_init(adev);

	return 0;
}

2285 2286
/**
 * dm_hw_fini() - Teardown DC device
2287
 * @handle: The base driver device containing the amdgpu_dm device.
2288 2289 2290 2291 2292
 *
 * Teardown components within &struct amdgpu_display_manager that require
 * cleanup. This involves cleaning up the DRM device, DC, and any modules that
 * were loaded. Also flush IRQ workqueues and disable them.
 */
2293 2294 2295 2296 2297 2298 2299
static int dm_hw_fini(void *handle)
{
	struct amdgpu_device *adev = (struct amdgpu_device *)handle;

	amdgpu_dm_hpd_fini(adev);

	amdgpu_dm_irq_fini(adev);
2300
	amdgpu_dm_fini(adev);
2301 2302 2303
	return 0;
}

2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322

static int dm_enable_vblank(struct drm_crtc *crtc);
static void dm_disable_vblank(struct drm_crtc *crtc);

static void dm_gpureset_toggle_interrupts(struct amdgpu_device *adev,
				 struct dc_state *state, bool enable)
{
	enum dc_irq_source irq_source;
	struct amdgpu_crtc *acrtc;
	int rc = -EBUSY;
	int i = 0;

	for (i = 0; i < state->stream_count; i++) {
		acrtc = get_crtc_by_otg_inst(
				adev, state->stream_status[i].primary_otg_inst);

		if (acrtc && state->stream_status[i].plane_count != 0) {
			irq_source = IRQ_TYPE_PFLIP + acrtc->otg_inst;
			rc = dc_interrupt_set(adev->dm.dc, irq_source, enable) ? 0 : -EBUSY;
2323 2324
			DRM_DEBUG_VBL("crtc %d - vupdate irq %sabling: r=%d\n",
				      acrtc->crtc_id, enable ? "en" : "dis", rc);
2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341
			if (rc)
				DRM_WARN("Failed to %s pflip interrupts\n",
					 enable ? "enable" : "disable");

			if (enable) {
				rc = dm_enable_vblank(&acrtc->base);
				if (rc)
					DRM_WARN("Failed to enable vblank interrupts\n");
			} else {
				dm_disable_vblank(&acrtc->base);
			}

		}
	}

}

2342
static enum dc_status amdgpu_dm_commit_zero_streams(struct dc *dc)
2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385
{
	struct dc_state *context = NULL;
	enum dc_status res = DC_ERROR_UNEXPECTED;
	int i;
	struct dc_stream_state *del_streams[MAX_PIPES];
	int del_streams_count = 0;

	memset(del_streams, 0, sizeof(del_streams));

	context = dc_create_state(dc);
	if (context == NULL)
		goto context_alloc_fail;

	dc_resource_state_copy_construct_current(dc, context);

	/* First remove from context all streams */
	for (i = 0; i < context->stream_count; i++) {
		struct dc_stream_state *stream = context->streams[i];

		del_streams[del_streams_count++] = stream;
	}

	/* Remove all planes for removed streams and then remove the streams */
	for (i = 0; i < del_streams_count; i++) {
		if (!dc_rem_all_planes_for_stream(dc, del_streams[i], context)) {
			res = DC_FAIL_DETACH_SURFACES;
			goto fail;
		}

		res = dc_remove_stream_from_ctx(dc, context, del_streams[i]);
		if (res != DC_OK)
			goto fail;
	}

	res = dc_commit_state(dc, context);

fail:
	dc_release_state(context);

context_alloc_fail:
	return res;
}

2386 2387 2388 2389 2390 2391 2392 2393 2394 2395
static void hpd_rx_irq_work_suspend(struct amdgpu_display_manager *dm)
{
	int i;

	if (dm->hpd_rx_offload_wq) {
		for (i = 0; i < dm->dc->caps.max_links; i++)
			flush_workqueue(dm->hpd_rx_offload_wq[i].wq);
	}
}

2396 2397 2398 2399 2400 2401
static int dm_suspend(void *handle)
{
	struct amdgpu_device *adev = handle;
	struct amdgpu_display_manager *dm = &adev->dm;
	int ret = 0;

2402
	if (amdgpu_in_reset(adev)) {
2403
		mutex_lock(&dm->dc_lock);
2404 2405 2406 2407 2408

#if defined(CONFIG_DRM_AMD_DC_DCN)
		dc_allow_idle_optimizations(adev->dm.dc, false);
#endif

2409 2410 2411 2412 2413 2414 2415 2416
		dm->cached_dc_state = dc_copy_state(dm->dc->current_state);

		dm_gpureset_toggle_interrupts(adev, dm->cached_dc_state, false);

		amdgpu_dm_commit_zero_streams(dm->dc);

		amdgpu_dm_irq_suspend(adev);

2417 2418
		hpd_rx_irq_work_suspend(dm);

2419 2420
		return ret;
	}
2421

2422
	WARN_ON(adev->dm.cached_state);
2423
	adev->dm.cached_state = drm_atomic_helper_suspend(adev_to_drm(adev));
2424

2425
	s3_handle_mst(adev_to_drm(adev), true);
2426 2427 2428

	amdgpu_dm_irq_suspend(adev);

2429 2430
	hpd_rx_irq_work_suspend(dm);

2431
	dc_set_power_state(dm->dc, DC_ACPI_CM_POWER_STATE_D3);
2432

2433
	return 0;
2434 2435
}

2436
struct amdgpu_dm_connector *
2437 2438
amdgpu_dm_find_first_crtc_matching_connector(struct drm_atomic_state *state,
					     struct drm_crtc *crtc)
2439 2440
{
	uint32_t i;
2441
	struct drm_connector_state *new_con_state;
2442 2443 2444
	struct drm_connector *connector;
	struct drm_crtc *crtc_from_state;

2445 2446
	for_each_new_connector_in_state(state, connector, new_con_state, i) {
		crtc_from_state = new_con_state->crtc;
2447 2448

		if (crtc_from_state == crtc)
2449
			return to_amdgpu_dm_connector(connector);
2450 2451 2452 2453 2454
	}

	return NULL;
}

2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466
static void emulated_link_detect(struct dc_link *link)
{
	struct dc_sink_init_data sink_init_data = { 0 };
	struct display_sink_capability sink_caps = { 0 };
	enum dc_edid_status edid_status;
	struct dc_context *dc_ctx = link->ctx;
	struct dc_sink *sink = NULL;
	struct dc_sink *prev_sink = NULL;

	link->type = dc_connection_none;
	prev_sink = link->local_sink;

2467 2468
	if (prev_sink)
		dc_sink_release(prev_sink);
2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523

	switch (link->connector_signal) {
	case SIGNAL_TYPE_HDMI_TYPE_A: {
		sink_caps.transaction_type = DDC_TRANSACTION_TYPE_I2C;
		sink_caps.signal = SIGNAL_TYPE_HDMI_TYPE_A;
		break;
	}

	case SIGNAL_TYPE_DVI_SINGLE_LINK: {
		sink_caps.transaction_type = DDC_TRANSACTION_TYPE_I2C;
		sink_caps.signal = SIGNAL_TYPE_DVI_SINGLE_LINK;
		break;
	}

	case SIGNAL_TYPE_DVI_DUAL_LINK: {
		sink_caps.transaction_type = DDC_TRANSACTION_TYPE_I2C;
		sink_caps.signal = SIGNAL_TYPE_DVI_DUAL_LINK;
		break;
	}

	case SIGNAL_TYPE_LVDS: {
		sink_caps.transaction_type = DDC_TRANSACTION_TYPE_I2C;
		sink_caps.signal = SIGNAL_TYPE_LVDS;
		break;
	}

	case SIGNAL_TYPE_EDP: {
		sink_caps.transaction_type =
			DDC_TRANSACTION_TYPE_I2C_OVER_AUX;
		sink_caps.signal = SIGNAL_TYPE_EDP;
		break;
	}

	case SIGNAL_TYPE_DISPLAY_PORT: {
		sink_caps.transaction_type =
			DDC_TRANSACTION_TYPE_I2C_OVER_AUX;
		sink_caps.signal = SIGNAL_TYPE_VIRTUAL;
		break;
	}

	default:
		DC_ERROR("Invalid connector type! signal:%d\n",
			link->connector_signal);
		return;
	}

	sink_init_data.link = link;
	sink_init_data.sink_signal = sink_caps.signal;

	sink = dc_sink_create(&sink_init_data);
	if (!sink) {
		DC_ERROR("Failed to create sink!\n");
		return;
	}

2524
	/* dc_sink_create returns a new reference */
2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536
	link->local_sink = sink;

	edid_status = dm_helpers_read_local_edid(
			link->ctx,
			link,
			sink);

	if (edid_status != EDID_OK)
		DC_ERROR("Failed to read EDID");

}

2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567
static void dm_gpureset_commit_state(struct dc_state *dc_state,
				     struct amdgpu_display_manager *dm)
{
	struct {
		struct dc_surface_update surface_updates[MAX_SURFACES];
		struct dc_plane_info plane_infos[MAX_SURFACES];
		struct dc_scaling_info scaling_infos[MAX_SURFACES];
		struct dc_flip_addrs flip_addrs[MAX_SURFACES];
		struct dc_stream_update stream_update;
	} * bundle;
	int k, m;

	bundle = kzalloc(sizeof(*bundle), GFP_KERNEL);

	if (!bundle) {
		dm_error("Failed to allocate update bundle\n");
		goto cleanup;
	}

	for (k = 0; k < dc_state->stream_count; k++) {
		bundle->stream_update.stream = dc_state->streams[k];

		for (m = 0; m < dc_state->stream_status->plane_count; m++) {
			bundle->surface_updates[m].surface =
				dc_state->stream_status->plane_states[m];
			bundle->surface_updates[m].surface->force_full_update =
				true;
		}
		dc_commit_updates_for_stream(
			dm->dc, bundle->surface_updates,
			dc_state->stream_status->plane_count,
2568
			dc_state->streams[k], &bundle->stream_update, dc_state);
2569 2570 2571 2572 2573 2574 2575 2576
	}

cleanup:
	kfree(bundle);

	return;
}

2577
static void dm_set_dpms_off(struct dc_link *link, struct dm_crtc_state *acrtc_state)
2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597
{
	struct dc_stream_state *stream_state;
	struct amdgpu_dm_connector *aconnector = link->priv;
	struct amdgpu_device *adev = drm_to_adev(aconnector->base.dev);
	struct dc_stream_update stream_update;
	bool dpms_off = true;

	memset(&stream_update, 0, sizeof(stream_update));
	stream_update.dpms_off = &dpms_off;

	mutex_lock(&adev->dm.dc_lock);
	stream_state = dc_stream_find_from_link(link);

	if (stream_state == NULL) {
		DRM_DEBUG_DRIVER("Error finding stream state associated with link!\n");
		mutex_unlock(&adev->dm.dc_lock);
		return;
	}

	stream_update.stream = stream_state;
2598
	acrtc_state->force_dpms_off = true;
2599
	dc_commit_updates_for_stream(stream_state->ctx->dc, NULL, 0,
2600 2601
				     stream_state, &stream_update,
				     stream_state->ctx->dc->current_state);
2602 2603 2604
	mutex_unlock(&adev->dm.dc_lock);
}

2605 2606 2607
static int dm_resume(void *handle)
{
	struct amdgpu_device *adev = handle;
2608
	struct drm_device *ddev = adev_to_drm(adev);
2609
	struct amdgpu_display_manager *dm = &adev->dm;
2610
	struct amdgpu_dm_connector *aconnector;
2611
	struct drm_connector *connector;
2612
	struct drm_connector_list_iter iter;
2613
	struct drm_crtc *crtc;
2614
	struct drm_crtc_state *new_crtc_state;
2615 2616 2617 2618
	struct dm_crtc_state *dm_new_crtc_state;
	struct drm_plane *plane;
	struct drm_plane_state *new_plane_state;
	struct dm_plane_state *dm_new_plane_state;
2619
	struct dm_atomic_state *dm_state = to_dm_atomic_state(dm->atomic_obj.state);
2620
	enum dc_connection_type new_connection_type = dc_connection_none;
2621 2622
	struct dc_state *dc_state;
	int i, r, j;
2623

2624
	if (amdgpu_in_reset(adev)) {
2625 2626
		dc_state = dm->cached_dc_state;

2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640
		/*
		 * The dc->current_state is backed up into dm->cached_dc_state
		 * before we commit 0 streams.
		 *
		 * DC will clear link encoder assignments on the real state
		 * but the changes won't propagate over to the copy we made
		 * before the 0 streams commit.
		 *
		 * DC expects that link encoder assignments are *not* valid
		 * when committing a state, so as a workaround it needs to be
		 * cleared here.
		 */
		link_enc_cfg_init(dm->dc, dc_state);

2641 2642
		if (dc_enable_dmub_notifications(adev->dm.dc))
			amdgpu_dm_outbox_init(adev);
2643

2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654
		r = dm_dmub_hw_init(adev);
		if (r)
			DRM_ERROR("DMUB interface failed to initialize: status=%d\n", r);

		dc_set_power_state(dm->dc, DC_ACPI_CM_POWER_STATE_D0);
		dc_resume(dm->dc);

		amdgpu_dm_irq_resume_early(adev);

		for (i = 0; i < dc_state->stream_count; i++) {
			dc_state->streams[i]->mode_changed = true;
2655 2656
			for (j = 0; j < dc_state->stream_status[i].plane_count; j++) {
				dc_state->stream_status[i].plane_states[j]->update_flags.raw
2657 2658 2659 2660 2661
					= 0xffffffff;
			}
		}

		WARN_ON(!dc_commit_state(dm->dc, dc_state));
2662

2663 2664 2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675
		dm_gpureset_commit_state(dm->cached_dc_state, dm);

		dm_gpureset_toggle_interrupts(adev, dm->cached_dc_state, true);

		dc_release_state(dm->cached_dc_state);
		dm->cached_dc_state = NULL;

		amdgpu_dm_irq_resume_late(adev);

		mutex_unlock(&dm->dc_lock);

		return 0;
	}
2676 2677 2678 2679 2680 2681
	/* Recreate dc_state - DC invalidates it when setting power state to S3. */
	dc_release_state(dm_state->context);
	dm_state->context = dc_create_state(dm->dc);
	/* TODO: Remove dc_state->dccg, use dc->dccg directly. */
	dc_resource_state_construct(dm->dc, dm_state->context);

2682 2683 2684 2685
	/* Re-enable outbox interrupts for DPIA. */
	if (dc_enable_dmub_notifications(adev->dm.dc))
		amdgpu_dm_outbox_init(adev);

2686
	/* Before powering on DC we need to re-initialize DMUB. */
2687
	dm_dmub_hw_resume(adev);
2688

2689 2690 2691
	/* power on hardware */
	dc_set_power_state(dm->dc, DC_ACPI_CM_POWER_STATE_D0);

2692 2693 2694 2695 2696 2697 2698 2699 2700
	/* program HPD filter */
	dc_resume(dm->dc);

	/*
	 * early enable HPD Rx IRQ, should be done before set mode as short
	 * pulse interrupts are used for MST
	 */
	amdgpu_dm_irq_resume_early(adev);

2701
	/* On resume we need to rewrite the MSTM control bits to enable MST*/
2702 2703
	s3_handle_mst(ddev, false);

2704
	/* Do detection*/
2705 2706
	drm_connector_list_iter_begin(ddev, &iter);
	drm_for_each_connector_iter(connector, &iter) {
2707
		aconnector = to_amdgpu_dm_connector(connector);
2708 2709 2710 2711 2712 2713 2714 2715

		/*
		 * this is the case when traversing through already created
		 * MST connectors, should be skipped
		 */
		if (aconnector->mst_port)
			continue;

2716
		mutex_lock(&aconnector->hpd_lock);
2717 2718 2719 2720 2721 2722 2723
		if (!dc_link_detect_sink(aconnector->dc_link, &new_connection_type))
			DRM_ERROR("KMS: Failed to detect connector\n");

		if (aconnector->base.force && new_connection_type == dc_connection_none)
			emulated_link_detect(aconnector->dc_link);
		else
			dc_link_detect(aconnector->dc_link, DETECT_REASON_HPD);
R
Roman Li 已提交
2724 2725 2726 2727

		if (aconnector->fake_enable && aconnector->dc_link->local_sink)
			aconnector->fake_enable = false;

2728 2729
		if (aconnector->dc_sink)
			dc_sink_release(aconnector->dc_sink);
2730 2731
		aconnector->dc_sink = NULL;
		amdgpu_dm_update_connector_after_detect(aconnector);
2732
		mutex_unlock(&aconnector->hpd_lock);
2733
	}
2734
	drm_connector_list_iter_end(&iter);
2735

2736
	/* Force mode set in atomic commit */
2737
	for_each_new_crtc_in_state(dm->cached_state, crtc, new_crtc_state, i)
2738
		new_crtc_state->active_changed = true;
2739

2740 2741 2742 2743 2744
	/*
	 * atomic_check is expected to create the dc states. We need to release
	 * them here, since they were duplicated as part of the suspend
	 * procedure.
	 */
2745
	for_each_new_crtc_in_state(dm->cached_state, crtc, new_crtc_state, i) {
2746 2747 2748 2749 2750 2751 2752 2753
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
		if (dm_new_crtc_state->stream) {
			WARN_ON(kref_read(&dm_new_crtc_state->stream->refcount) > 1);
			dc_stream_release(dm_new_crtc_state->stream);
			dm_new_crtc_state->stream = NULL;
		}
	}

2754
	for_each_new_plane_in_state(dm->cached_state, plane, new_plane_state, i) {
2755 2756 2757 2758 2759 2760 2761 2762
		dm_new_plane_state = to_dm_plane_state(new_plane_state);
		if (dm_new_plane_state->dc_state) {
			WARN_ON(kref_read(&dm_new_plane_state->dc_state->refcount) > 1);
			dc_plane_state_release(dm_new_plane_state->dc_state);
			dm_new_plane_state->dc_state = NULL;
		}
	}

2763
	drm_atomic_helper_resume(ddev, dm->cached_state);
2764

2765
	dm->cached_state = NULL;
2766

2767
	amdgpu_dm_irq_resume_late(adev);
2768

2769 2770
	amdgpu_dm_smu_write_watermarks_table(adev);

2771
	return 0;
2772 2773
}

2774 2775 2776 2777 2778 2779 2780 2781 2782 2783
/**
 * DOC: DM Lifecycle
 *
 * DM (and consequently DC) is registered in the amdgpu base driver as a IP
 * block. When CONFIG_DRM_AMD_DC is enabled, the DM device IP block is added to
 * the base driver's device list to be initialized and torn down accordingly.
 *
 * The functions to do so are provided as hooks in &struct amd_ip_funcs.
 */

2784 2785 2786
static const struct amd_ip_funcs amdgpu_dm_funcs = {
	.name = "dm",
	.early_init = dm_early_init,
2787
	.late_init = dm_late_init,
2788 2789
	.sw_init = dm_sw_init,
	.sw_fini = dm_sw_fini,
2790
	.early_fini = amdgpu_dm_early_fini,
2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811
	.hw_init = dm_hw_init,
	.hw_fini = dm_hw_fini,
	.suspend = dm_suspend,
	.resume = dm_resume,
	.is_idle = dm_is_idle,
	.wait_for_idle = dm_wait_for_idle,
	.check_soft_reset = dm_check_soft_reset,
	.soft_reset = dm_soft_reset,
	.set_clockgating_state = dm_set_clockgating_state,
	.set_powergating_state = dm_set_powergating_state,
};

const struct amdgpu_ip_block_version dm_ip_block =
{
	.type = AMD_IP_BLOCK_TYPE_DCE,
	.major = 1,
	.minor = 0,
	.rev = 0,
	.funcs = &amdgpu_dm_funcs,
};

2812

2813 2814 2815 2816 2817
/**
 * DOC: atomic
 *
 * *WIP*
 */
2818

2819
static const struct drm_mode_config_funcs amdgpu_dm_mode_funcs = {
2820
	.fb_create = amdgpu_display_user_framebuffer_create,
2821
	.get_format_info = amd_get_format_info,
2822
	.output_poll_changed = drm_fb_helper_output_poll_changed,
2823
	.atomic_check = amdgpu_dm_atomic_check,
2824
	.atomic_commit = drm_atomic_helper_commit,
2825 2826 2827 2828
};

static struct drm_mode_config_helper_funcs amdgpu_dm_mode_config_helperfuncs = {
	.atomic_commit_tail = amdgpu_dm_atomic_commit_tail
2829 2830
};

2831 2832 2833 2834 2835 2836 2837
static void update_connector_ext_caps(struct amdgpu_dm_connector *aconnector)
{
	u32 max_cll, min_cll, max, min, q, r;
	struct amdgpu_dm_backlight_caps *caps;
	struct amdgpu_display_manager *dm;
	struct drm_connector *conn_base;
	struct amdgpu_device *adev;
2838
	struct dc_link *link = NULL;
2839 2840 2841
	static const u8 pre_computed_values[] = {
		50, 51, 52, 53, 55, 56, 57, 58, 59, 61, 62, 63, 65, 66, 68, 69,
		71, 72, 74, 75, 77, 79, 81, 82, 84, 86, 88, 90, 92, 94, 96, 98};
2842
	int i;
2843 2844 2845 2846

	if (!aconnector || !aconnector->dc_link)
		return;

2847 2848 2849 2850
	link = aconnector->dc_link;
	if (link->connector_signal != SIGNAL_TYPE_EDP)
		return;

2851
	conn_base = &aconnector->base;
2852
	adev = drm_to_adev(conn_base->dev);
2853
	dm = &adev->dm;
2854 2855 2856 2857 2858 2859 2860
	for (i = 0; i < dm->num_of_edps; i++) {
		if (link == dm->backlight_link[i])
			break;
	}
	if (i >= dm->num_of_edps)
		return;
	caps = &dm->backlight_caps[i];
2861 2862 2863 2864 2865
	caps->ext_caps = &aconnector->dc_link->dpcd_sink_ext_caps;
	caps->aux_support = false;
	max_cll = conn_base->hdr_sink_metadata.hdmi_type1.max_cll;
	min_cll = conn_base->hdr_sink_metadata.hdmi_type1.min_cll;

2866
	if (caps->ext_caps->bits.oled == 1 /*||
2867
	    caps->ext_caps->bits.sdr_aux_backlight_control == 1 ||
2868
	    caps->ext_caps->bits.hdr_aux_backlight_control == 1*/)
2869 2870
		caps->aux_support = true;

2871 2872 2873 2874 2875
	if (amdgpu_backlight == 0)
		caps->aux_support = false;
	else if (amdgpu_backlight == 1)
		caps->aux_support = true;

2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902
	/* From the specification (CTA-861-G), for calculating the maximum
	 * luminance we need to use:
	 *	Luminance = 50*2**(CV/32)
	 * Where CV is a one-byte value.
	 * For calculating this expression we may need float point precision;
	 * to avoid this complexity level, we take advantage that CV is divided
	 * by a constant. From the Euclids division algorithm, we know that CV
	 * can be written as: CV = 32*q + r. Next, we replace CV in the
	 * Luminance expression and get 50*(2**q)*(2**(r/32)), hence we just
	 * need to pre-compute the value of r/32. For pre-computing the values
	 * We just used the following Ruby line:
	 *	(0...32).each {|cv| puts (50*2**(cv/32.0)).round}
	 * The results of the above expressions can be verified at
	 * pre_computed_values.
	 */
	q = max_cll >> 5;
	r = max_cll % 32;
	max = (1 << q) * pre_computed_values[r];

	// min luminance: maxLum * (CV/255)^2 / 100
	q = DIV_ROUND_CLOSEST(min_cll, 255);
	min = max * DIV_ROUND_CLOSEST((q * q), 100);

	caps->aux_max_input_signal = max;
	caps->aux_min_input_signal = min;
}

2903 2904
void amdgpu_dm_update_connector_after_detect(
		struct amdgpu_dm_connector *aconnector)
2905 2906 2907
{
	struct drm_connector *connector = &aconnector->base;
	struct drm_device *dev = connector->dev;
2908
	struct dc_sink *sink;
2909 2910 2911 2912 2913 2914

	/* MST handled by drm_mst framework */
	if (aconnector->mst_mgr.mst_state == true)
		return;

	sink = aconnector->dc_link->local_sink;
2915 2916
	if (sink)
		dc_sink_retain(sink);
2917

2918 2919
	/*
	 * Edid mgmt connector gets first update only in mode_valid hook and then
2920
	 * the connector sink is set to either fake or physical sink depends on link status.
2921
	 * Skip if already done during boot.
2922 2923 2924 2925
	 */
	if (aconnector->base.force != DRM_FORCE_UNSPECIFIED
			&& aconnector->dc_em_sink) {

2926 2927 2928
		/*
		 * For S3 resume with headless use eml_sink to fake stream
		 * because on resume connector->sink is set to NULL
2929 2930 2931 2932
		 */
		mutex_lock(&dev->mode_config.mutex);

		if (sink) {
2933
			if (aconnector->dc_sink) {
2934
				amdgpu_dm_update_freesync_caps(connector, NULL);
2935 2936 2937 2938
				/*
				 * retain and release below are used to
				 * bump up refcount for sink because the link doesn't point
				 * to it anymore after disconnect, so on next crtc to connector
2939 2940
				 * reshuffle by UMD we will get into unwanted dc_sink release
				 */
2941
				dc_sink_release(aconnector->dc_sink);
2942
			}
2943
			aconnector->dc_sink = sink;
2944
			dc_sink_retain(aconnector->dc_sink);
2945 2946
			amdgpu_dm_update_freesync_caps(connector,
					aconnector->edid);
2947
		} else {
2948
			amdgpu_dm_update_freesync_caps(connector, NULL);
2949
			if (!aconnector->dc_sink) {
2950
				aconnector->dc_sink = aconnector->dc_em_sink;
2951
				dc_sink_retain(aconnector->dc_sink);
2952
			}
2953 2954 2955
		}

		mutex_unlock(&dev->mode_config.mutex);
2956 2957 2958

		if (sink)
			dc_sink_release(sink);
2959 2960 2961 2962 2963 2964 2965
		return;
	}

	/*
	 * TODO: temporary guard to look for proper fix
	 * if this sink is MST sink, we should not do anything
	 */
2966 2967
	if (sink && sink->sink_signal == SIGNAL_TYPE_DISPLAY_PORT_MST) {
		dc_sink_release(sink);
2968
		return;
2969
	}
2970 2971

	if (aconnector->dc_sink == sink) {
2972 2973 2974 2975
		/*
		 * We got a DP short pulse (Link Loss, DP CTS, etc...).
		 * Do nothing!!
		 */
2976
		DRM_DEBUG_DRIVER("DCHPD: connector_id=%d: dc_sink didn't change.\n",
2977
				aconnector->connector_id);
2978 2979
		if (sink)
			dc_sink_release(sink);
2980 2981 2982
		return;
	}

2983
	DRM_DEBUG_DRIVER("DCHPD: connector_id=%d: Old sink=%p New sink=%p\n",
2984 2985 2986 2987
		aconnector->connector_id, aconnector->dc_sink, sink);

	mutex_lock(&dev->mode_config.mutex);

2988 2989 2990 2991
	/*
	 * 1. Update status of the drm connector
	 * 2. Send an event and let userspace tell us what to do
	 */
2992
	if (sink) {
2993 2994 2995 2996
		/*
		 * TODO: check if we still need the S3 mode update workaround.
		 * If yes, put it here.
		 */
2997
		if (aconnector->dc_sink) {
2998
			amdgpu_dm_update_freesync_caps(connector, NULL);
2999 3000
			dc_sink_release(aconnector->dc_sink);
		}
3001 3002

		aconnector->dc_sink = sink;
3003
		dc_sink_retain(aconnector->dc_sink);
3004
		if (sink->dc_edid.length == 0) {
3005
			aconnector->edid = NULL;
3006 3007 3008 3009
			if (aconnector->dc_link->aux_mode) {
				drm_dp_cec_unset_edid(
					&aconnector->dm_dp_aux.aux);
			}
3010
		} else {
3011
			aconnector->edid =
3012
				(struct edid *)sink->dc_edid.raw_edid;
3013

3014 3015 3016
			if (aconnector->dc_link->aux_mode)
				drm_dp_cec_set_edid(&aconnector->dm_dp_aux.aux,
						    aconnector->edid);
3017
		}
3018

3019
		drm_connector_update_edid_property(connector, aconnector->edid);
3020
		amdgpu_dm_update_freesync_caps(connector, aconnector->edid);
3021
		update_connector_ext_caps(aconnector);
3022
	} else {
3023
		drm_dp_cec_unset_edid(&aconnector->dm_dp_aux.aux);
3024
		amdgpu_dm_update_freesync_caps(connector, NULL);
3025
		drm_connector_update_edid_property(connector, NULL);
3026
		aconnector->num_modes = 0;
3027
		dc_sink_release(aconnector->dc_sink);
3028
		aconnector->dc_sink = NULL;
3029
		aconnector->edid = NULL;
3030 3031 3032 3033 3034
#ifdef CONFIG_DRM_AMD_DC_HDCP
		/* Set CP to DESIRED if it was ENABLED, so we can re-enable it again on hotplug */
		if (connector->state->content_protection == DRM_MODE_CONTENT_PROTECTION_ENABLED)
			connector->state->content_protection = DRM_MODE_CONTENT_PROTECTION_DESIRED;
#endif
3035 3036 3037
	}

	mutex_unlock(&dev->mode_config.mutex);
3038

3039 3040
	update_subconnector_property(aconnector);

3041 3042
	if (sink)
		dc_sink_release(sink);
3043 3044
}

3045
static void handle_hpd_irq_helper(struct amdgpu_dm_connector *aconnector)
3046 3047 3048
{
	struct drm_connector *connector = &aconnector->base;
	struct drm_device *dev = connector->dev;
3049
	enum dc_connection_type new_connection_type = dc_connection_none;
3050
	struct amdgpu_device *adev = drm_to_adev(dev);
3051
	struct dm_connector_state *dm_con_state = to_dm_connector_state(connector->state);
3052
	struct dm_crtc_state *dm_crtc_state = NULL;
3053

3054 3055 3056
	if (adev->dm.disable_hpd_irq)
		return;

3057 3058 3059 3060
	if (dm_con_state->base.state && dm_con_state->base.crtc)
		dm_crtc_state = to_dm_crtc_state(drm_atomic_get_crtc_state(
					dm_con_state->base.state,
					dm_con_state->base.crtc));
3061 3062 3063
	/*
	 * In case of failure or MST no need to update connector status or notify the OS
	 * since (for MST case) MST does this in its own context.
3064 3065
	 */
	mutex_lock(&aconnector->hpd_lock);
3066

3067
#ifdef CONFIG_DRM_AMD_DC_HDCP
3068
	if (adev->dm.hdcp_workqueue) {
3069
		hdcp_reset_display(adev->dm.hdcp_workqueue, aconnector->dc_link->link_index);
3070 3071
		dm_con_state->update_hdcp = true;
	}
3072
#endif
3073 3074 3075
	if (aconnector->fake_enable)
		aconnector->fake_enable = false;

3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086
	if (!dc_link_detect_sink(aconnector->dc_link, &new_connection_type))
		DRM_ERROR("KMS: Failed to detect connector\n");

	if (aconnector->base.force && new_connection_type == dc_connection_none) {
		emulated_link_detect(aconnector->dc_link);

		drm_modeset_lock_all(dev);
		dm_restore_drm_connector_state(dev, connector);
		drm_modeset_unlock_all(dev);

		if (aconnector->base.force == DRM_FORCE_UNSPECIFIED)
3087
			drm_kms_helper_connector_hotplug_event(connector);
3088 3089

	} else if (dc_link_detect(aconnector->dc_link, DETECT_REASON_HPD)) {
3090
		if (new_connection_type == dc_connection_none &&
3091 3092 3093
		    aconnector->dc_link->type == dc_connection_none &&
		    dm_crtc_state)
			dm_set_dpms_off(aconnector->dc_link, dm_crtc_state);
3094

3095
		amdgpu_dm_update_connector_after_detect(aconnector);
3096 3097 3098 3099 3100 3101

		drm_modeset_lock_all(dev);
		dm_restore_drm_connector_state(dev, connector);
		drm_modeset_unlock_all(dev);

		if (aconnector->base.force == DRM_FORCE_UNSPECIFIED)
3102
			drm_kms_helper_connector_hotplug_event(connector);
3103 3104 3105 3106 3107
	}
	mutex_unlock(&aconnector->hpd_lock);

}

3108 3109 3110 3111 3112 3113 3114 3115
static void handle_hpd_irq(void *param)
{
	struct amdgpu_dm_connector *aconnector = (struct amdgpu_dm_connector *)param;

	handle_hpd_irq_helper(aconnector);

}

3116
static void dm_handle_mst_sideband_msg(struct amdgpu_dm_connector *aconnector)
3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141 3142 3143 3144 3145 3146 3147 3148 3149 3150 3151
{
	uint8_t esi[DP_PSR_ERROR_STATUS - DP_SINK_COUNT_ESI] = { 0 };
	uint8_t dret;
	bool new_irq_handled = false;
	int dpcd_addr;
	int dpcd_bytes_to_read;

	const int max_process_count = 30;
	int process_count = 0;

	const struct dc_link_status *link_status = dc_link_get_status(aconnector->dc_link);

	if (link_status->dpcd_caps->dpcd_rev.raw < 0x12) {
		dpcd_bytes_to_read = DP_LANE0_1_STATUS - DP_SINK_COUNT;
		/* DPCD 0x200 - 0x201 for downstream IRQ */
		dpcd_addr = DP_SINK_COUNT;
	} else {
		dpcd_bytes_to_read = DP_PSR_ERROR_STATUS - DP_SINK_COUNT_ESI;
		/* DPCD 0x2002 - 0x2005 for downstream IRQ */
		dpcd_addr = DP_SINK_COUNT_ESI;
	}

	dret = drm_dp_dpcd_read(
		&aconnector->dm_dp_aux.aux,
		dpcd_addr,
		esi,
		dpcd_bytes_to_read);

	while (dret == dpcd_bytes_to_read &&
		process_count < max_process_count) {
		uint8_t retry;
		dret = 0;

		process_count++;

3152
		DRM_DEBUG_DRIVER("ESI %02x %02x %02x\n", esi[0], esi[1], esi[2]);
3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176
		/* handle HPD short pulse irq */
		if (aconnector->mst_mgr.mst_state)
			drm_dp_mst_hpd_irq(
				&aconnector->mst_mgr,
				esi,
				&new_irq_handled);

		if (new_irq_handled) {
			/* ACK at DPCD to notify down stream */
			const int ack_dpcd_bytes_to_write =
				dpcd_bytes_to_read - 1;

			for (retry = 0; retry < 3; retry++) {
				uint8_t wret;

				wret = drm_dp_dpcd_write(
					&aconnector->dm_dp_aux.aux,
					dpcd_addr + 1,
					&esi[1],
					ack_dpcd_bytes_to_write);
				if (wret == ack_dpcd_bytes_to_write)
					break;
			}

3177
			/* check if there is new irq to be handled */
3178 3179 3180 3181 3182 3183 3184
			dret = drm_dp_dpcd_read(
				&aconnector->dm_dp_aux.aux,
				dpcd_addr,
				esi,
				dpcd_bytes_to_read);

			new_irq_handled = false;
3185
		} else {
3186
			break;
3187
		}
3188 3189 3190
	}

	if (process_count == max_process_count)
3191
		DRM_DEBUG_DRIVER("Loop exceeded max iterations\n");
3192 3193
}

3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211 3212
static void schedule_hpd_rx_offload_work(struct hpd_rx_irq_offload_work_queue *offload_wq,
							union hpd_irq_data hpd_irq_data)
{
	struct hpd_rx_irq_offload_work *offload_work =
				kzalloc(sizeof(*offload_work), GFP_KERNEL);

	if (!offload_work) {
		DRM_ERROR("Failed to allocate hpd_rx_irq_offload_work.\n");
		return;
	}

	INIT_WORK(&offload_work->work, dm_handle_hpd_rx_offload_work);
	offload_work->data = hpd_irq_data;
	offload_work->offload_wq = offload_wq;

	queue_work(offload_wq->wq, &offload_work->work);
	DRM_DEBUG_KMS("queue work to handle hpd_rx offload work");
}

3213 3214
static void handle_hpd_rx_irq(void *param)
{
3215
	struct amdgpu_dm_connector *aconnector = (struct amdgpu_dm_connector *)param;
3216 3217
	struct drm_connector *connector = &aconnector->base;
	struct drm_device *dev = connector->dev;
3218
	struct dc_link *dc_link = aconnector->dc_link;
3219
	bool is_mst_root_connector = aconnector->mst_mgr.mst_state;
3220
	bool result = false;
3221
	enum dc_connection_type new_connection_type = dc_connection_none;
3222
	struct amdgpu_device *adev = drm_to_adev(dev);
3223
	union hpd_irq_data hpd_irq_data;
3224 3225 3226 3227
	bool link_loss = false;
	bool has_left_work = false;
	int idx = aconnector->base.index;
	struct hpd_rx_irq_offload_work_queue *offload_wq = &adev->dm.hpd_rx_offload_wq[idx];
3228 3229

	memset(&hpd_irq_data, 0, sizeof(hpd_irq_data));
3230

3231 3232 3233
	if (adev->dm.disable_hpd_irq)
		return;

3234 3235
	/*
	 * TODO:Temporary add mutex to protect hpd interrupt not have a gpio
3236 3237 3238
	 * conflict, after implement i2c helper, this mutex should be
	 * retired.
	 */
3239
	mutex_lock(&aconnector->hpd_lock);
3240

3241 3242
	result = dc_link_handle_hpd_rx_irq(dc_link, &hpd_irq_data,
						&link_loss, true, &has_left_work);
3243

3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255
	if (!has_left_work)
		goto out;

	if (hpd_irq_data.bytes.device_service_irq.bits.AUTOMATED_TEST) {
		schedule_hpd_rx_offload_work(offload_wq, hpd_irq_data);
		goto out;
	}

	if (dc_link_dp_allow_hpd_rx_irq(dc_link)) {
		if (hpd_irq_data.bytes.device_service_irq.bits.UP_REQ_MSG_RDY ||
			hpd_irq_data.bytes.device_service_irq.bits.DOWN_REP_MSG_RDY) {
			dm_handle_mst_sideband_msg(aconnector);
3256 3257 3258
			goto out;
		}

3259 3260
		if (link_loss) {
			bool skip = false;
3261

3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275
			spin_lock(&offload_wq->offload_lock);
			skip = offload_wq->is_handling_link_loss;

			if (!skip)
				offload_wq->is_handling_link_loss = true;

			spin_unlock(&offload_wq->offload_lock);

			if (!skip)
				schedule_hpd_rx_offload_work(offload_wq, hpd_irq_data);

			goto out;
		}
	}
3276

3277
out:
3278
	if (result && !is_mst_root_connector) {
3279
		/* Downstream Port status changed. */
3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295
		if (!dc_link_detect_sink(dc_link, &new_connection_type))
			DRM_ERROR("KMS: Failed to detect connector\n");

		if (aconnector->base.force && new_connection_type == dc_connection_none) {
			emulated_link_detect(dc_link);

			if (aconnector->fake_enable)
				aconnector->fake_enable = false;

			amdgpu_dm_update_connector_after_detect(aconnector);


			drm_modeset_lock_all(dev);
			dm_restore_drm_connector_state(dev, connector);
			drm_modeset_unlock_all(dev);

3296
			drm_kms_helper_connector_hotplug_event(connector);
3297
		} else if (dc_link_detect(dc_link, DETECT_REASON_HPDRX)) {
3298 3299 3300 3301

			if (aconnector->fake_enable)
				aconnector->fake_enable = false;

3302 3303 3304 3305 3306 3307 3308
			amdgpu_dm_update_connector_after_detect(aconnector);


			drm_modeset_lock_all(dev);
			dm_restore_drm_connector_state(dev, connector);
			drm_modeset_unlock_all(dev);

3309
			drm_kms_helper_connector_hotplug_event(connector);
3310 3311
		}
	}
3312
#ifdef CONFIG_DRM_AMD_DC_HDCP
3313 3314 3315 3316
	if (hpd_irq_data.bytes.device_service_irq.bits.CP_IRQ) {
		if (adev->dm.hdcp_workqueue)
			hdcp_handle_cpirq(adev->dm.hdcp_workqueue,  aconnector->base.index);
	}
3317
#endif
3318

3319
	if (dc_link->type != dc_connection_mst_branch)
3320
		drm_dp_cec_irq(&aconnector->dm_dp_aux.aux);
3321 3322

	mutex_unlock(&aconnector->hpd_lock);
3323 3324 3325 3326
}

static void register_hpd_handlers(struct amdgpu_device *adev)
{
3327
	struct drm_device *dev = adev_to_drm(adev);
3328
	struct drm_connector *connector;
3329
	struct amdgpu_dm_connector *aconnector;
3330 3331 3332 3333 3334 3335 3336 3337 3338
	const struct dc_link *dc_link;
	struct dc_interrupt_params int_params = {0};

	int_params.requested_polarity = INTERRUPT_POLARITY_DEFAULT;
	int_params.current_polarity = INTERRUPT_POLARITY_DEFAULT;

	list_for_each_entry(connector,
			&dev->mode_config.connector_list, head)	{

3339
		aconnector = to_amdgpu_dm_connector(connector);
3340 3341 3342 3343 3344 3345 3346 3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358 3359
		dc_link = aconnector->dc_link;

		if (DC_IRQ_SOURCE_INVALID != dc_link->irq_source_hpd) {
			int_params.int_context = INTERRUPT_LOW_IRQ_CONTEXT;
			int_params.irq_source = dc_link->irq_source_hpd;

			amdgpu_dm_irq_register_interrupt(adev, &int_params,
					handle_hpd_irq,
					(void *) aconnector);
		}

		if (DC_IRQ_SOURCE_INVALID != dc_link->irq_source_hpd_rx) {

			/* Also register for DP short pulse (hpd_rx). */
			int_params.int_context = INTERRUPT_LOW_IRQ_CONTEXT;
			int_params.irq_source =	dc_link->irq_source_hpd_rx;

			amdgpu_dm_irq_register_interrupt(adev, &int_params,
					handle_hpd_rx_irq,
					(void *) aconnector);
3360 3361 3362 3363

			if (adev->dm.hpd_rx_offload_wq)
				adev->dm.hpd_rx_offload_wq[connector->index].aconnector =
					aconnector;
3364 3365 3366 3367
		}
	}
}

3368 3369 3370 3371 3372 3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393 3394 3395 3396 3397 3398 3399 3400 3401 3402 3403 3404 3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425 3426 3427 3428 3429 3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450
#if defined(CONFIG_DRM_AMD_DC_SI)
/* Register IRQ sources and initialize IRQ callbacks */
static int dce60_register_irq_handlers(struct amdgpu_device *adev)
{
	struct dc *dc = adev->dm.dc;
	struct common_irq_params *c_irq_params;
	struct dc_interrupt_params int_params = {0};
	int r;
	int i;
	unsigned client_id = AMDGPU_IRQ_CLIENTID_LEGACY;

	int_params.requested_polarity = INTERRUPT_POLARITY_DEFAULT;
	int_params.current_polarity = INTERRUPT_POLARITY_DEFAULT;

	/*
	 * Actions of amdgpu_irq_add_id():
	 * 1. Register a set() function with base driver.
	 *    Base driver will call set() function to enable/disable an
	 *    interrupt in DC hardware.
	 * 2. Register amdgpu_dm_irq_handler().
	 *    Base driver will call amdgpu_dm_irq_handler() for ALL interrupts
	 *    coming from DC hardware.
	 *    amdgpu_dm_irq_handler() will re-direct the interrupt to DC
	 *    for acknowledging and handling. */

	/* Use VBLANK interrupt */
	for (i = 0; i < adev->mode_info.num_crtc; i++) {
		r = amdgpu_irq_add_id(adev, client_id, i+1 , &adev->crtc_irq);
		if (r) {
			DRM_ERROR("Failed to add crtc irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
			dc_interrupt_to_irq_source(dc, i+1 , 0);

		c_irq_params = &adev->dm.vblank_params[int_params.irq_source - DC_IRQ_SOURCE_VBLANK1];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
				dm_crtc_high_irq, c_irq_params);
	}

	/* Use GRPH_PFLIP interrupt */
	for (i = VISLANDS30_IV_SRCID_D1_GRPH_PFLIP;
			i <= VISLANDS30_IV_SRCID_D6_GRPH_PFLIP; i += 2) {
		r = amdgpu_irq_add_id(adev, client_id, i, &adev->pageflip_irq);
		if (r) {
			DRM_ERROR("Failed to add page flip irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
			dc_interrupt_to_irq_source(dc, i, 0);

		c_irq_params = &adev->dm.pflip_params[int_params.irq_source - DC_IRQ_SOURCE_PFLIP_FIRST];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
				dm_pflip_high_irq, c_irq_params);

	}

	/* HPD */
	r = amdgpu_irq_add_id(adev, client_id,
			VISLANDS30_IV_SRCID_HOTPLUG_DETECT_A, &adev->hpd_irq);
	if (r) {
		DRM_ERROR("Failed to add hpd irq id!\n");
		return r;
	}

	register_hpd_handlers(adev);

	return 0;
}
#endif

3451 3452 3453 3454 3455 3456 3457 3458
/* Register IRQ sources and initialize IRQ callbacks */
static int dce110_register_irq_handlers(struct amdgpu_device *adev)
{
	struct dc *dc = adev->dm.dc;
	struct common_irq_params *c_irq_params;
	struct dc_interrupt_params int_params = {0};
	int r;
	int i;
3459
	unsigned client_id = AMDGPU_IRQ_CLIENTID_LEGACY;
3460

3461
	if (adev->family >= AMDGPU_FAMILY_AI)
3462
		client_id = SOC15_IH_CLIENTID_DCE;
3463 3464 3465 3466

	int_params.requested_polarity = INTERRUPT_POLARITY_DEFAULT;
	int_params.current_polarity = INTERRUPT_POLARITY_DEFAULT;

3467 3468
	/*
	 * Actions of amdgpu_irq_add_id():
3469 3470 3471 3472 3473 3474 3475 3476 3477
	 * 1. Register a set() function with base driver.
	 *    Base driver will call set() function to enable/disable an
	 *    interrupt in DC hardware.
	 * 2. Register amdgpu_dm_irq_handler().
	 *    Base driver will call amdgpu_dm_irq_handler() for ALL interrupts
	 *    coming from DC hardware.
	 *    amdgpu_dm_irq_handler() will re-direct the interrupt to DC
	 *    for acknowledging and handling. */

3478
	/* Use VBLANK interrupt */
3479
	for (i = VISLANDS30_IV_SRCID_D1_VERTICAL_INTERRUPT0; i <= VISLANDS30_IV_SRCID_D6_VERTICAL_INTERRUPT0; i++) {
3480
		r = amdgpu_irq_add_id(adev, client_id, i, &adev->crtc_irq);
3481 3482 3483 3484 3485 3486 3487
		if (r) {
			DRM_ERROR("Failed to add crtc irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
3488
			dc_interrupt_to_irq_source(dc, i, 0);
3489

3490
		c_irq_params = &adev->dm.vblank_params[int_params.irq_source - DC_IRQ_SOURCE_VBLANK1];
3491 3492 3493 3494 3495 3496 3497 3498

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
				dm_crtc_high_irq, c_irq_params);
	}

3499 3500 3501 3502 3503 3504 3505 3506 3507 3508 3509 3510 3511 3512 3513 3514 3515 3516 3517 3518 3519
	/* Use VUPDATE interrupt */
	for (i = VISLANDS30_IV_SRCID_D1_V_UPDATE_INT; i <= VISLANDS30_IV_SRCID_D6_V_UPDATE_INT; i += 2) {
		r = amdgpu_irq_add_id(adev, client_id, i, &adev->vupdate_irq);
		if (r) {
			DRM_ERROR("Failed to add vupdate irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
			dc_interrupt_to_irq_source(dc, i, 0);

		c_irq_params = &adev->dm.vupdate_params[int_params.irq_source - DC_IRQ_SOURCE_VUPDATE1];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
				dm_vupdate_high_irq, c_irq_params);
	}

3520
	/* Use GRPH_PFLIP interrupt */
3521 3522
	for (i = VISLANDS30_IV_SRCID_D1_GRPH_PFLIP;
			i <= VISLANDS30_IV_SRCID_D6_GRPH_PFLIP; i += 2) {
3523
		r = amdgpu_irq_add_id(adev, client_id, i, &adev->pageflip_irq);
3524 3525 3526 3527 3528 3529 3530 3531 3532 3533 3534 3535 3536 3537 3538 3539 3540 3541 3542 3543
		if (r) {
			DRM_ERROR("Failed to add page flip irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
			dc_interrupt_to_irq_source(dc, i, 0);

		c_irq_params = &adev->dm.pflip_params[int_params.irq_source - DC_IRQ_SOURCE_PFLIP_FIRST];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
				dm_pflip_high_irq, c_irq_params);

	}

	/* HPD */
3544 3545
	r = amdgpu_irq_add_id(adev, client_id,
			VISLANDS30_IV_SRCID_HOTPLUG_DETECT_A, &adev->hpd_irq);
3546 3547 3548 3549 3550 3551 3552 3553 3554 3555
	if (r) {
		DRM_ERROR("Failed to add hpd irq id!\n");
		return r;
	}

	register_hpd_handlers(adev);

	return 0;
}

3556
#if defined(CONFIG_DRM_AMD_DC_DCN)
3557 3558 3559 3560 3561 3562 3563 3564
/* Register IRQ sources and initialize IRQ callbacks */
static int dcn10_register_irq_handlers(struct amdgpu_device *adev)
{
	struct dc *dc = adev->dm.dc;
	struct common_irq_params *c_irq_params;
	struct dc_interrupt_params int_params = {0};
	int r;
	int i;
3565 3566 3567 3568 3569 3570 3571 3572 3573 3574
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
	static const unsigned int vrtl_int_srcid[] = {
		DCN_1_0__SRCID__OTG1_VERTICAL_INTERRUPT0_CONTROL,
		DCN_1_0__SRCID__OTG2_VERTICAL_INTERRUPT0_CONTROL,
		DCN_1_0__SRCID__OTG3_VERTICAL_INTERRUPT0_CONTROL,
		DCN_1_0__SRCID__OTG4_VERTICAL_INTERRUPT0_CONTROL,
		DCN_1_0__SRCID__OTG5_VERTICAL_INTERRUPT0_CONTROL,
		DCN_1_0__SRCID__OTG6_VERTICAL_INTERRUPT0_CONTROL
	};
#endif
3575 3576 3577 3578

	int_params.requested_polarity = INTERRUPT_POLARITY_DEFAULT;
	int_params.current_polarity = INTERRUPT_POLARITY_DEFAULT;

3579 3580
	/*
	 * Actions of amdgpu_irq_add_id():
3581 3582 3583 3584 3585 3586 3587 3588
	 * 1. Register a set() function with base driver.
	 *    Base driver will call set() function to enable/disable an
	 *    interrupt in DC hardware.
	 * 2. Register amdgpu_dm_irq_handler().
	 *    Base driver will call amdgpu_dm_irq_handler() for ALL interrupts
	 *    coming from DC hardware.
	 *    amdgpu_dm_irq_handler() will re-direct the interrupt to DC
	 *    for acknowledging and handling.
3589
	 */
3590 3591 3592 3593 3594

	/* Use VSTARTUP interrupt */
	for (i = DCN_1_0__SRCID__DC_D1_OTG_VSTARTUP;
			i <= DCN_1_0__SRCID__DC_D1_OTG_VSTARTUP + adev->mode_info.num_crtc - 1;
			i++) {
3595
		r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_DCE, i, &adev->crtc_irq);
3596 3597 3598 3599 3600 3601 3602 3603 3604 3605 3606 3607 3608 3609 3610

		if (r) {
			DRM_ERROR("Failed to add crtc irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
			dc_interrupt_to_irq_source(dc, i, 0);

		c_irq_params = &adev->dm.vblank_params[int_params.irq_source - DC_IRQ_SOURCE_VBLANK1];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

3611 3612 3613 3614
		amdgpu_dm_irq_register_interrupt(
			adev, &int_params, dm_crtc_high_irq, c_irq_params);
	}

3615 3616
	/* Use otg vertical line interrupt */
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
3617 3618 3619
	for (i = 0; i <= adev->mode_info.num_crtc - 1; i++) {
		r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_DCE,
				vrtl_int_srcid[i], &adev->vline0_irq);
3620 3621 3622 3623 3624 3625 3626 3627

		if (r) {
			DRM_ERROR("Failed to add vline0 irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
3628 3629 3630 3631 3632 3633
			dc_interrupt_to_irq_source(dc, vrtl_int_srcid[i], 0);

		if (int_params.irq_source == DC_IRQ_SOURCE_INVALID) {
			DRM_ERROR("Failed to register vline0 irq %d!\n", vrtl_int_srcid[i]);
			break;
		}
3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645

		c_irq_params = &adev->dm.vline0_params[int_params.irq_source
					- DC_IRQ_SOURCE_DC1_VLINE0];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
				dm_dcn_vertical_interrupt0_high_irq, c_irq_params);
	}
#endif

3646 3647 3648 3649 3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669
	/* Use VUPDATE_NO_LOCK interrupt on DCN, which seems to correspond to
	 * the regular VUPDATE interrupt on DCE. We want DC_IRQ_SOURCE_VUPDATEx
	 * to trigger at end of each vblank, regardless of state of the lock,
	 * matching DCE behaviour.
	 */
	for (i = DCN_1_0__SRCID__OTG0_IHC_V_UPDATE_NO_LOCK_INTERRUPT;
	     i <= DCN_1_0__SRCID__OTG0_IHC_V_UPDATE_NO_LOCK_INTERRUPT + adev->mode_info.num_crtc - 1;
	     i++) {
		r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_DCE, i, &adev->vupdate_irq);

		if (r) {
			DRM_ERROR("Failed to add vupdate irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
			dc_interrupt_to_irq_source(dc, i, 0);

		c_irq_params = &adev->dm.vupdate_params[int_params.irq_source - DC_IRQ_SOURCE_VUPDATE1];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

3670
		amdgpu_dm_irq_register_interrupt(adev, &int_params,
3671
				dm_vupdate_high_irq, c_irq_params);
3672 3673
	}

3674 3675
	/* Use GRPH_PFLIP interrupt */
	for (i = DCN_1_0__SRCID__HUBP0_FLIP_INTERRUPT;
3676
			i <= DCN_1_0__SRCID__HUBP0_FLIP_INTERRUPT + dc->caps.max_otg_num - 1;
3677
			i++) {
3678
		r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_DCE, i, &adev->pageflip_irq);
3679 3680 3681 3682 3683 3684 3685 3686 3687 3688 3689 3690 3691 3692 3693 3694 3695 3696 3697
		if (r) {
			DRM_ERROR("Failed to add page flip irq id!\n");
			return r;
		}

		int_params.int_context = INTERRUPT_HIGH_IRQ_CONTEXT;
		int_params.irq_source =
			dc_interrupt_to_irq_source(dc, i, 0);

		c_irq_params = &adev->dm.pflip_params[int_params.irq_source - DC_IRQ_SOURCE_PFLIP_FIRST];

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
				dm_pflip_high_irq, c_irq_params);

	}

3698 3699 3700 3701 3702 3703 3704
	/* HPD */
	r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_DCE, DCN_1_0__SRCID__DC_HPD1_INT,
			&adev->hpd_irq);
	if (r) {
		DRM_ERROR("Failed to add hpd irq id!\n");
		return r;
	}
3705

3706
	register_hpd_handlers(adev);
3707

3708 3709 3710 3711 3712 3713 3714 3715 3716 3717 3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730
	return 0;
}
/* Register Outbox IRQ sources and initialize IRQ callbacks */
static int register_outbox_irq_handlers(struct amdgpu_device *adev)
{
	struct dc *dc = adev->dm.dc;
	struct common_irq_params *c_irq_params;
	struct dc_interrupt_params int_params = {0};
	int r, i;

	int_params.requested_polarity = INTERRUPT_POLARITY_DEFAULT;
	int_params.current_polarity = INTERRUPT_POLARITY_DEFAULT;

	r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_DCE, DCN_1_0__SRCID__DMCUB_OUTBOX_LOW_PRIORITY_READY_INT,
			&adev->dmub_outbox_irq);
	if (r) {
		DRM_ERROR("Failed to add outbox irq id!\n");
		return r;
	}

	if (dc->ctx->dmub_srv) {
		i = DCN_1_0__SRCID__DMCUB_OUTBOX_LOW_PRIORITY_READY_INT;
		int_params.int_context = INTERRUPT_LOW_IRQ_CONTEXT;
3731
		int_params.irq_source =
3732
		dc_interrupt_to_irq_source(dc, i, 0);
3733

3734
		c_irq_params = &adev->dm.dmub_outbox_params[0];
3735 3736 3737 3738 3739

		c_irq_params->adev = adev;
		c_irq_params->irq_src = int_params.irq_source;

		amdgpu_dm_irq_register_interrupt(adev, &int_params,
3740
				dm_dmub_outbox1_low_irq, c_irq_params);
3741 3742 3743 3744 3745 3746
	}

	return 0;
}
#endif

3747 3748 3749 3750 3751 3752
/*
 * Acquires the lock for the atomic state object and returns
 * the new atomic state.
 *
 * This should only be called during atomic check.
 */
3753 3754
int dm_atomic_get_state(struct drm_atomic_state *state,
			struct dm_atomic_state **dm_state)
3755 3756
{
	struct drm_device *dev = state->dev;
3757
	struct amdgpu_device *adev = drm_to_adev(dev);
3758 3759 3760 3761 3762 3763 3764 3765 3766 3767 3768 3769 3770 3771 3772
	struct amdgpu_display_manager *dm = &adev->dm;
	struct drm_private_state *priv_state;

	if (*dm_state)
		return 0;

	priv_state = drm_atomic_get_private_obj_state(state, &dm->atomic_obj);
	if (IS_ERR(priv_state))
		return PTR_ERR(priv_state);

	*dm_state = to_dm_atomic_state(priv_state);

	return 0;
}

3773
static struct dm_atomic_state *
3774 3775 3776
dm_atomic_get_new_state(struct drm_atomic_state *state)
{
	struct drm_device *dev = state->dev;
3777
	struct amdgpu_device *adev = drm_to_adev(dev);
3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795 3796 3797 3798 3799 3800 3801
	struct amdgpu_display_manager *dm = &adev->dm;
	struct drm_private_obj *obj;
	struct drm_private_state *new_obj_state;
	int i;

	for_each_new_private_obj_in_state(state, obj, new_obj_state, i) {
		if (obj->funcs == dm->atomic_obj.funcs)
			return to_dm_atomic_state(new_obj_state);
	}

	return NULL;
}

static struct drm_private_state *
dm_atomic_duplicate_state(struct drm_private_obj *obj)
{
	struct dm_atomic_state *old_state, *new_state;

	new_state = kzalloc(sizeof(*new_state), GFP_KERNEL);
	if (!new_state)
		return NULL;

	__drm_atomic_helper_private_obj_duplicate_state(obj, &new_state->base);

3802 3803 3804 3805 3806
	old_state = to_dm_atomic_state(obj->state);

	if (old_state && old_state->context)
		new_state->context = dc_copy_state(old_state->context);

3807 3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826 3827 3828 3829 3830
	if (!new_state->context) {
		kfree(new_state);
		return NULL;
	}

	return &new_state->base;
}

static void dm_atomic_destroy_state(struct drm_private_obj *obj,
				    struct drm_private_state *state)
{
	struct dm_atomic_state *dm_state = to_dm_atomic_state(state);

	if (dm_state && dm_state->context)
		dc_release_state(dm_state->context);

	kfree(dm_state);
}

static struct drm_private_state_funcs dm_atomic_state_funcs = {
	.atomic_duplicate_state = dm_atomic_duplicate_state,
	.atomic_destroy_state = dm_atomic_destroy_state,
};

3831 3832
static int amdgpu_dm_mode_config_init(struct amdgpu_device *adev)
{
3833
	struct dm_atomic_state *state;
3834 3835 3836 3837
	int r;

	adev->mode_info.mode_config_initialized = true;

3838 3839
	adev_to_drm(adev)->mode_config.funcs = (void *)&amdgpu_dm_mode_funcs;
	adev_to_drm(adev)->mode_config.helper_private = &amdgpu_dm_mode_config_helperfuncs;
3840

3841 3842
	adev_to_drm(adev)->mode_config.max_width = 16384;
	adev_to_drm(adev)->mode_config.max_height = 16384;
3843

3844 3845
	adev_to_drm(adev)->mode_config.preferred_depth = 24;
	adev_to_drm(adev)->mode_config.prefer_shadow = 1;
3846
	/* indicates support for immediate flip */
3847
	adev_to_drm(adev)->mode_config.async_page_flip = true;
3848

3849
	adev_to_drm(adev)->mode_config.fb_base = adev->gmc.aper_base;
3850

3851 3852 3853 3854
	state = kzalloc(sizeof(*state), GFP_KERNEL);
	if (!state)
		return -ENOMEM;

3855
	state->context = dc_create_state(adev->dm.dc);
3856 3857 3858 3859 3860 3861 3862
	if (!state->context) {
		kfree(state);
		return -ENOMEM;
	}

	dc_resource_state_copy_construct_current(adev->dm.dc, state->context);

3863
	drm_atomic_private_obj_init(adev_to_drm(adev),
3864
				    &adev->dm.atomic_obj,
3865 3866 3867
				    &state->base,
				    &dm_atomic_state_funcs);

3868
	r = amdgpu_display_modeset_create_props(adev);
3869 3870 3871
	if (r) {
		dc_release_state(state->context);
		kfree(state);
3872
		return r;
3873
	}
3874

3875
	r = amdgpu_dm_audio_init(adev);
3876 3877 3878
	if (r) {
		dc_release_state(state->context);
		kfree(state);
3879
		return r;
3880
	}
3881

3882 3883 3884
	return 0;
}

3885 3886
#define AMDGPU_DM_DEFAULT_MIN_BACKLIGHT 12
#define AMDGPU_DM_DEFAULT_MAX_BACKLIGHT 255
3887
#define AUX_BL_DEFAULT_TRANSITION_TIME_MS 50
3888

3889 3890 3891
#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) ||\
	defined(CONFIG_BACKLIGHT_CLASS_DEVICE_MODULE)

3892 3893
static void amdgpu_dm_update_backlight_caps(struct amdgpu_display_manager *dm,
					    int bl_idx)
3894 3895 3896 3897
{
#if defined(CONFIG_ACPI)
	struct amdgpu_dm_backlight_caps caps;

3898 3899
	memset(&caps, 0, sizeof(caps));

3900
	if (dm->backlight_caps[bl_idx].caps_valid)
3901 3902
		return;

3903
	amdgpu_acpi_get_backlight_caps(&caps);
3904
	if (caps.caps_valid) {
3905
		dm->backlight_caps[bl_idx].caps_valid = true;
3906 3907
		if (caps.aux_support)
			return;
3908 3909
		dm->backlight_caps[bl_idx].min_input_signal = caps.min_input_signal;
		dm->backlight_caps[bl_idx].max_input_signal = caps.max_input_signal;
3910
	} else {
3911
		dm->backlight_caps[bl_idx].min_input_signal =
3912
				AMDGPU_DM_DEFAULT_MIN_BACKLIGHT;
3913
		dm->backlight_caps[bl_idx].max_input_signal =
3914 3915 3916
				AMDGPU_DM_DEFAULT_MAX_BACKLIGHT;
	}
#else
3917
	if (dm->backlight_caps[bl_idx].aux_support)
3918 3919
		return;

3920 3921
	dm->backlight_caps[bl_idx].min_input_signal = AMDGPU_DM_DEFAULT_MIN_BACKLIGHT;
	dm->backlight_caps[bl_idx].max_input_signal = AMDGPU_DM_DEFAULT_MAX_BACKLIGHT;
3922 3923 3924
#endif
}

3925 3926
static int get_brightness_range(const struct amdgpu_dm_backlight_caps *caps,
				unsigned *min, unsigned *max)
3927 3928
{
	if (!caps)
3929
		return 0;
3930

3931 3932 3933 3934
	if (caps->aux_support) {
		// Firmware limits are in nits, DC API wants millinits.
		*max = 1000 * caps->aux_max_input_signal;
		*min = 1000 * caps->aux_min_input_signal;
3935
	} else {
3936 3937 3938
		// Firmware limits are 8-bit, PWM control is 16-bit.
		*max = 0x101 * caps->max_input_signal;
		*min = 0x101 * caps->min_input_signal;
3939
	}
3940 3941
	return 1;
}
3942

3943 3944 3945 3946
static u32 convert_brightness_from_user(const struct amdgpu_dm_backlight_caps *caps,
					uint32_t brightness)
{
	unsigned min, max;
3947

3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968
	if (!get_brightness_range(caps, &min, &max))
		return brightness;

	// Rescale 0..255 to min..max
	return min + DIV_ROUND_CLOSEST((max - min) * brightness,
				       AMDGPU_MAX_BL_LEVEL);
}

static u32 convert_brightness_to_user(const struct amdgpu_dm_backlight_caps *caps,
				      uint32_t brightness)
{
	unsigned min, max;

	if (!get_brightness_range(caps, &min, &max))
		return brightness;

	if (brightness < min)
		return 0;
	// Rescale min..max to 0..255
	return DIV_ROUND_CLOSEST(AMDGPU_MAX_BL_LEVEL * (brightness - min),
				 max - min);
3969 3970
}

3971
static int amdgpu_dm_backlight_set_level(struct amdgpu_display_manager *dm,
3972
					 int bl_idx,
3973
					 u32 user_brightness)
3974
{
3975
	struct amdgpu_dm_backlight_caps caps;
3976 3977
	struct dc_link *link;
	u32 brightness;
3978
	bool rc;
3979

3980 3981
	amdgpu_dm_update_backlight_caps(dm, bl_idx);
	caps = dm->backlight_caps[bl_idx];
3982

3983
	dm->brightness[bl_idx] = user_brightness;
3984 3985 3986
	/* update scratch register */
	if (bl_idx == 0)
		amdgpu_atombios_scratch_regs_set_backlight_level(dm->adev, dm->brightness[bl_idx]);
3987 3988
	brightness = convert_brightness_from_user(&caps, dm->brightness[bl_idx]);
	link = (struct dc_link *)dm->backlight_link[bl_idx];
3989

3990
	/* Change brightness based on AUX property */
3991
	if (caps.aux_support) {
3992 3993 3994 3995
		rc = dc_link_set_backlight_level_nits(link, true, brightness,
						      AUX_BL_DEFAULT_TRANSITION_TIME_MS);
		if (!rc)
			DRM_DEBUG("DM: Failed to update backlight via AUX on eDP[%d]\n", bl_idx);
3996
	} else {
3997 3998 3999
		rc = dc_link_set_backlight_level(link, brightness, 0);
		if (!rc)
			DRM_DEBUG("DM: Failed to update backlight on eDP[%d]\n", bl_idx);
4000
	}
4001 4002

	return rc ? 0 : 1;
4003 4004
}

4005
static int amdgpu_dm_backlight_update_status(struct backlight_device *bd)
4006
{
4007
	struct amdgpu_display_manager *dm = bl_get_data(bd);
4008
	int i;
4009

4010 4011 4012 4013 4014 4015 4016
	for (i = 0; i < dm->num_of_edps; i++) {
		if (bd == dm->backlight_dev[i])
			break;
	}
	if (i >= AMDGPU_DM_MAX_NUM_EDP)
		i = 0;
	amdgpu_dm_backlight_set_level(dm, i, bd->props.brightness);
4017 4018 4019 4020

	return 0;
}

4021 4022
static u32 amdgpu_dm_backlight_get_level(struct amdgpu_display_manager *dm,
					 int bl_idx)
4023
{
4024
	struct amdgpu_dm_backlight_caps caps;
4025
	struct dc_link *link = (struct dc_link *)dm->backlight_link[bl_idx];
4026

4027 4028
	amdgpu_dm_update_backlight_caps(dm, bl_idx);
	caps = dm->backlight_caps[bl_idx];
4029

4030 4031 4032 4033 4034 4035
	if (caps.aux_support) {
		u32 avg, peak;
		bool rc;

		rc = dc_link_get_backlight_level_nits(link, &avg, &peak);
		if (!rc)
4036
			return dm->brightness[bl_idx];
4037 4038
		return convert_brightness_to_user(&caps, avg);
	} else {
4039
		int ret = dc_link_get_backlight_level(link);
4040 4041

		if (ret == DC_ERROR_UNEXPECTED)
4042
			return dm->brightness[bl_idx];
4043 4044
		return convert_brightness_to_user(&caps, ret);
	}
4045 4046
}

4047 4048 4049
static int amdgpu_dm_backlight_get_brightness(struct backlight_device *bd)
{
	struct amdgpu_display_manager *dm = bl_get_data(bd);
4050
	int i;
4051

4052 4053 4054 4055 4056 4057 4058
	for (i = 0; i < dm->num_of_edps; i++) {
		if (bd == dm->backlight_dev[i])
			break;
	}
	if (i >= AMDGPU_DM_MAX_NUM_EDP)
		i = 0;
	return amdgpu_dm_backlight_get_level(dm, i);
4059 4060
}

4061
static const struct backlight_ops amdgpu_dm_backlight_ops = {
4062
	.options = BL_CORE_SUSPENDRESUME,
4063 4064 4065 4066
	.get_brightness = amdgpu_dm_backlight_get_brightness,
	.update_status	= amdgpu_dm_backlight_update_status,
};

4067 4068
static void
amdgpu_dm_register_backlight_device(struct amdgpu_display_manager *dm)
4069 4070 4071 4072
{
	char bl_name[16];
	struct backlight_properties props = { 0 };

4073 4074
	amdgpu_dm_update_backlight_caps(dm, dm->num_of_edps);
	dm->brightness[dm->num_of_edps] = AMDGPU_MAX_BL_LEVEL;
4075

4076
	props.max_brightness = AMDGPU_MAX_BL_LEVEL;
4077
	props.brightness = AMDGPU_MAX_BL_LEVEL;
4078 4079 4080
	props.type = BACKLIGHT_RAW;

	snprintf(bl_name, sizeof(bl_name), "amdgpu_bl%d",
4081
		 adev_to_drm(dm->adev)->primary->index + dm->num_of_edps);
4082

4083 4084 4085 4086 4087
	dm->backlight_dev[dm->num_of_edps] = backlight_device_register(bl_name,
								       adev_to_drm(dm->adev)->dev,
								       dm,
								       &amdgpu_dm_backlight_ops,
								       &props);
4088

4089
	if (IS_ERR(dm->backlight_dev[dm->num_of_edps]))
4090 4091
		DRM_ERROR("DM: Backlight registration failed!\n");
	else
4092
		DRM_DEBUG_DRIVER("DM: Registered Backlight device: %s\n", bl_name);
4093 4094 4095
}
#endif

4096
static int initialize_plane(struct amdgpu_display_manager *dm,
4097
			    struct amdgpu_mode_info *mode_info, int plane_id,
4098 4099
			    enum drm_plane_type plane_type,
			    const struct dc_plane_cap *plane_cap)
4100
{
H
Harry Wentland 已提交
4101
	struct drm_plane *plane;
4102 4103 4104
	unsigned long possible_crtcs;
	int ret = 0;

H
Harry Wentland 已提交
4105
	plane = kzalloc(sizeof(struct drm_plane), GFP_KERNEL);
4106 4107 4108 4109
	if (!plane) {
		DRM_ERROR("KMS: Failed to allocate plane\n");
		return -ENOMEM;
	}
4110
	plane->type = plane_type;
4111 4112

	/*
4113 4114 4115 4116
	 * HACK: IGT tests expect that the primary plane for a CRTC
	 * can only have one possible CRTC. Only expose support for
	 * any CRTC if they're not going to be used as a primary plane
	 * for a CRTC - like overlay or underlay planes.
4117 4118 4119 4120 4121
	 */
	possible_crtcs = 1 << plane_id;
	if (plane_id >= dm->dc->caps.max_streams)
		possible_crtcs = 0xff;

4122
	ret = amdgpu_dm_plane_init(dm, plane, possible_crtcs, plane_cap);
4123 4124 4125

	if (ret) {
		DRM_ERROR("KMS: Failed to initialize plane\n");
4126
		kfree(plane);
4127 4128 4129
		return ret;
	}

4130 4131 4132
	if (mode_info)
		mode_info->planes[plane_id] = plane;

4133 4134 4135
	return ret;
}

4136 4137 4138 4139 4140 4141 4142 4143 4144

static void register_backlight_device(struct amdgpu_display_manager *dm,
				      struct dc_link *link)
{
#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) ||\
	defined(CONFIG_BACKLIGHT_CLASS_DEVICE_MODULE)

	if ((link->connector_signal & (SIGNAL_TYPE_EDP | SIGNAL_TYPE_LVDS)) &&
	    link->type != dc_connection_none) {
4145 4146
		/*
		 * Event if registration failed, we should continue with
4147 4148 4149
		 * DM initialization because not having a backlight control
		 * is better then a black screen.
		 */
4150
		if (!dm->backlight_dev[dm->num_of_edps])
4151
			amdgpu_dm_register_backlight_device(dm);
4152

4153
		if (dm->backlight_dev[dm->num_of_edps]) {
4154 4155 4156
			dm->backlight_link[dm->num_of_edps] = link;
			dm->num_of_edps++;
		}
4157 4158 4159 4160 4161
	}
#endif
}


4162 4163
/*
 * In this architecture, the association
4164 4165 4166 4167 4168 4169
 * connector -> encoder -> crtc
 * id not really requried. The crtc and connector will hold the
 * display_index as an abstraction to use with DAL component
 *
 * Returns 0 on success
 */
4170
static int amdgpu_dm_initialize_drm_device(struct amdgpu_device *adev)
4171 4172
{
	struct amdgpu_display_manager *dm = &adev->dm;
4173
	int32_t i;
4174
	struct amdgpu_dm_connector *aconnector = NULL;
4175
	struct amdgpu_encoder *aencoder = NULL;
4176
	struct amdgpu_mode_info *mode_info = &adev->mode_info;
4177
	uint32_t link_cnt;
4178
	int32_t primary_planes;
4179
	enum dc_connection_type new_connection_type = dc_connection_none;
4180
	const struct dc_plane_cap *plane;
4181
	bool psr_feature_enabled = false;
4182

4183 4184 4185 4186
	dm->display_indexes_num = dm->dc->caps.max_streams;
	/* Update the actual used number of crtc */
	adev->mode_info.num_crtc = adev->dm.display_indexes_num;

4187 4188 4189
	link_cnt = dm->dc->caps.max_links;
	if (amdgpu_dm_mode_config_init(dm->adev)) {
		DRM_ERROR("DM: Failed to initialize mode config\n");
4190
		return -EINVAL;
4191 4192
	}

4193 4194
	/* There is one primary plane per CRTC */
	primary_planes = dm->dc->caps.max_streams;
4195
	ASSERT(primary_planes <= AMDGPU_MAX_PLANES);
4196

4197 4198 4199 4200 4201
	/*
	 * Initialize primary planes, implicit planes for legacy IOCTLS.
	 * Order is reversed to match iteration order in atomic check.
	 */
	for (i = (primary_planes - 1); i >= 0; i--) {
4202 4203
		plane = &dm->dc->caps.planes[i];

4204
		if (initialize_plane(dm, mode_info, i,
4205
				     DRM_PLANE_TYPE_PRIMARY, plane)) {
4206
			DRM_ERROR("KMS: Failed to initialize primary plane\n");
4207
			goto fail;
4208
		}
4209
	}
4210

4211 4212 4213 4214 4215
	/*
	 * Initialize overlay planes, index starting after primary planes.
	 * These planes have a higher DRM index than the primary planes since
	 * they should be considered as having a higher z-order.
	 * Order is reversed to match iteration order in atomic check.
4216 4217 4218
	 *
	 * Only support DCN for now, and only expose one so we don't encourage
	 * userspace to use up all the pipes.
4219
	 */
4220 4221 4222 4223 4224 4225 4226 4227 4228
	for (i = 0; i < dm->dc->caps.max_planes; ++i) {
		struct dc_plane_cap *plane = &dm->dc->caps.planes[i];

		if (plane->type != DC_PLANE_TYPE_DCN_UNIVERSAL)
			continue;

		if (!plane->blends_with_above || !plane->blends_with_below)
			continue;

4229
		if (!plane->pixel_format_support.argb8888)
4230 4231
			continue;

4232
		if (initialize_plane(dm, NULL, primary_planes + i,
4233
				     DRM_PLANE_TYPE_OVERLAY, plane)) {
4234
			DRM_ERROR("KMS: Failed to initialize overlay plane\n");
4235
			goto fail;
4236
		}
4237 4238 4239

		/* Only create one overlay plane. */
		break;
4240
	}
4241

4242
	for (i = 0; i < dm->dc->caps.max_streams; i++)
H
Harry Wentland 已提交
4243
		if (amdgpu_dm_crtc_init(dm, mode_info->planes[i], i)) {
4244
			DRM_ERROR("KMS: Failed to initialize crtc\n");
4245
			goto fail;
4246 4247
		}

4248
#if defined(CONFIG_DRM_AMD_DC_DCN)
4249
	/* Use Outbox interrupt */
4250
	switch (adev->ip_versions[DCE_HWIP][0]) {
4251 4252 4253
	case IP_VERSION(3, 0, 0):
	case IP_VERSION(3, 1, 2):
	case IP_VERSION(3, 1, 3):
4254
	case IP_VERSION(3, 1, 5):
4255
	case IP_VERSION(3, 1, 6):
4256
	case IP_VERSION(2, 1, 0):
4257 4258 4259 4260 4261 4262
		if (register_outbox_irq_handlers(dm->adev)) {
			DRM_ERROR("DM: Failed to initialize IRQ\n");
			goto fail;
		}
		break;
	default:
4263
		DRM_DEBUG_KMS("Unsupported DCN IP version for outbox: 0x%X\n",
4264
			      adev->ip_versions[DCE_HWIP][0]);
4265
	}
4266 4267 4268 4269 4270 4271

	/* Determine whether to enable PSR support by default. */
	if (!(amdgpu_dc_debug_mask & DC_DISABLE_PSR)) {
		switch (adev->ip_versions[DCE_HWIP][0]) {
		case IP_VERSION(3, 1, 2):
		case IP_VERSION(3, 1, 3):
4272
		case IP_VERSION(3, 1, 5):
4273
		case IP_VERSION(3, 1, 6):
4274 4275 4276 4277 4278 4279 4280
			psr_feature_enabled = true;
			break;
		default:
			psr_feature_enabled = amdgpu_dc_feature_mask & DC_PSR_MASK;
			break;
		}
	}
4281
#endif
4282

4283 4284 4285
	/* Disable vblank IRQs aggressively for power-saving. */
	adev_to_drm(adev)->vblank_disable_immediate = true;

4286 4287
	/* loops over all connectors on the board */
	for (i = 0; i < link_cnt; i++) {
4288
		struct dc_link *link = NULL;
4289 4290 4291 4292 4293 4294 4295 4296 4297 4298

		if (i > AMDGPU_DM_MAX_DISPLAY_INDEX) {
			DRM_ERROR(
				"KMS: Cannot support more than %d display indexes\n",
					AMDGPU_DM_MAX_DISPLAY_INDEX);
			continue;
		}

		aconnector = kzalloc(sizeof(*aconnector), GFP_KERNEL);
		if (!aconnector)
4299
			goto fail;
4300 4301

		aencoder = kzalloc(sizeof(*aencoder), GFP_KERNEL);
4302
		if (!aencoder)
4303
			goto fail;
4304 4305 4306

		if (amdgpu_dm_encoder_init(dm->ddev, aencoder, i)) {
			DRM_ERROR("KMS: Failed to initialize encoder\n");
4307
			goto fail;
4308 4309 4310 4311
		}

		if (amdgpu_dm_connector_init(dm, aconnector, i, aencoder)) {
			DRM_ERROR("KMS: Failed to initialize connector\n");
4312
			goto fail;
4313 4314
		}

4315 4316
		link = dc_get_link_at_index(dm->dc, i);

4317 4318 4319 4320 4321 4322 4323 4324
		if (!dc_link_detect_sink(link, &new_connection_type))
			DRM_ERROR("KMS: Failed to detect connector\n");

		if (aconnector->base.force && new_connection_type == dc_connection_none) {
			emulated_link_detect(link);
			amdgpu_dm_update_connector_after_detect(aconnector);

		} else if (dc_link_detect(link, DETECT_REASON_BOOT)) {
4325
			amdgpu_dm_update_connector_after_detect(aconnector);
4326
			register_backlight_device(dm, link);
4327 4328
			if (dm->num_of_edps)
				update_connector_ext_caps(aconnector);
4329
			if (psr_feature_enabled)
4330
				amdgpu_dm_set_psr_caps(link);
4331 4332 4333 4334 4335 4336

			/* TODO: Fix vblank control helpers to delay PSR entry to allow this when
			 * PSR is also supported.
			 */
			if (link->psr_settings.psr_feature_enabled)
				adev_to_drm(adev)->vblank_disable_immediate = false;
4337 4338 4339
		}


4340 4341 4342 4343
	}

	/* Software is initialized. Now we can register interrupt handlers. */
	switch (adev->asic_type) {
4344 4345 4346 4347 4348 4349 4350 4351 4352 4353 4354
#if defined(CONFIG_DRM_AMD_DC_SI)
	case CHIP_TAHITI:
	case CHIP_PITCAIRN:
	case CHIP_VERDE:
	case CHIP_OLAND:
		if (dce60_register_irq_handlers(dm->adev)) {
			DRM_ERROR("DM: Failed to initialize IRQ\n");
			goto fail;
		}
		break;
#endif
4355 4356
	case CHIP_BONAIRE:
	case CHIP_HAWAII:
4357 4358 4359
	case CHIP_KAVERI:
	case CHIP_KABINI:
	case CHIP_MULLINS:
4360 4361 4362 4363 4364 4365
	case CHIP_TONGA:
	case CHIP_FIJI:
	case CHIP_CARRIZO:
	case CHIP_STONEY:
	case CHIP_POLARIS11:
	case CHIP_POLARIS10:
4366
	case CHIP_POLARIS12:
4367
	case CHIP_VEGAM:
4368
	case CHIP_VEGA10:
4369
	case CHIP_VEGA12:
4370
	case CHIP_VEGA20:
4371 4372
		if (dce110_register_irq_handlers(dm->adev)) {
			DRM_ERROR("DM: Failed to initialize IRQ\n");
4373
			goto fail;
4374 4375 4376
		}
		break;
	default:
4377
#if defined(CONFIG_DRM_AMD_DC_DCN)
4378
		switch (adev->ip_versions[DCE_HWIP][0]) {
4379 4380
		case IP_VERSION(1, 0, 0):
		case IP_VERSION(1, 0, 1):
4381 4382 4383 4384 4385 4386 4387 4388 4389 4390
		case IP_VERSION(2, 0, 2):
		case IP_VERSION(2, 0, 3):
		case IP_VERSION(2, 0, 0):
		case IP_VERSION(2, 1, 0):
		case IP_VERSION(3, 0, 0):
		case IP_VERSION(3, 0, 2):
		case IP_VERSION(3, 0, 3):
		case IP_VERSION(3, 0, 1):
		case IP_VERSION(3, 1, 2):
		case IP_VERSION(3, 1, 3):
4391
		case IP_VERSION(3, 1, 5):
4392
		case IP_VERSION(3, 1, 6):
4393 4394 4395 4396 4397 4398
			if (dcn10_register_irq_handlers(dm->adev)) {
				DRM_ERROR("DM: Failed to initialize IRQ\n");
				goto fail;
			}
			break;
		default:
4399
			DRM_ERROR("Unsupported DCE IP versions: 0x%X\n",
4400
					adev->ip_versions[DCE_HWIP][0]);
4401
			goto fail;
4402 4403
		}
#endif
4404
		break;
4405 4406 4407
	}

	return 0;
4408
fail:
4409 4410
	kfree(aencoder);
	kfree(aconnector);
4411

4412
	return -EINVAL;
4413 4414
}

4415
static void amdgpu_dm_destroy_drm_device(struct amdgpu_display_manager *dm)
4416
{
4417
	drm_atomic_private_obj_fini(&dm->atomic_obj);
4418 4419 4420 4421 4422 4423 4424
	return;
}

/******************************************************************************
 * amdgpu_display_funcs functions
 *****************************************************************************/

4425
/*
4426 4427 4428 4429 4430 4431 4432 4433
 * dm_bandwidth_update - program display watermarks
 *
 * @adev: amdgpu_device pointer
 *
 * Calculate and program the display watermarks and line buffer allocation.
 */
static void dm_bandwidth_update(struct amdgpu_device *adev)
{
4434
	/* TODO: implement later */
4435 4436
}

4437
static const struct amdgpu_display_funcs dm_display_funcs = {
4438 4439
	.bandwidth_update = dm_bandwidth_update, /* called unconditionally */
	.vblank_get_counter = dm_vblank_get_counter,/* called unconditionally */
4440 4441
	.backlight_set_level = NULL, /* never called for DC */
	.backlight_get_level = NULL, /* never called for DC */
4442 4443 4444 4445 4446 4447 4448 4449 4450 4451 4452
	.hpd_sense = NULL,/* called unconditionally */
	.hpd_set_polarity = NULL, /* called unconditionally */
	.hpd_get_gpio_reg = NULL, /* VBIOS parsing. DAL does it. */
	.page_flip_get_scanoutpos =
		dm_crtc_get_scanoutpos,/* called unconditionally */
	.add_encoder = NULL, /* VBIOS parsing. DAL does it. */
	.add_connector = NULL, /* VBIOS parsing. DAL does it. */
};

#if defined(CONFIG_DEBUG_KERNEL_DC)

4453 4454 4455 4456
static ssize_t s3_debug_store(struct device *device,
			      struct device_attribute *attr,
			      const char *buf,
			      size_t count)
4457 4458 4459
{
	int ret;
	int s3_state;
4460
	struct drm_device *drm_dev = dev_get_drvdata(device);
4461
	struct amdgpu_device *adev = drm_to_adev(drm_dev);
4462 4463 4464 4465 4466 4467

	ret = kstrtoint(buf, 0, &s3_state);

	if (ret == 0) {
		if (s3_state) {
			dm_resume(adev);
4468
			drm_kms_helper_hotplug_event(adev_to_drm(adev));
4469 4470 4471 4472 4473 4474 4475 4476 4477 4478 4479 4480 4481 4482 4483 4484
		} else
			dm_suspend(adev);
	}

	return ret == 0 ? count : 0;
}

DEVICE_ATTR_WO(s3_debug);

#endif

static int dm_early_init(void *handle)
{
	struct amdgpu_device *adev = (struct amdgpu_device *)handle;

	switch (adev->asic_type) {
4485 4486 4487 4488 4489 4490 4491 4492 4493 4494 4495 4496 4497 4498
#if defined(CONFIG_DRM_AMD_DC_SI)
	case CHIP_TAHITI:
	case CHIP_PITCAIRN:
	case CHIP_VERDE:
		adev->mode_info.num_crtc = 6;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 6;
		break;
	case CHIP_OLAND:
		adev->mode_info.num_crtc = 2;
		adev->mode_info.num_hpd = 2;
		adev->mode_info.num_dig = 2;
		break;
#endif
4499 4500 4501 4502 4503 4504
	case CHIP_BONAIRE:
	case CHIP_HAWAII:
		adev->mode_info.num_crtc = 6;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 6;
		break;
4505 4506 4507 4508 4509 4510 4511 4512 4513 4514 4515
	case CHIP_KAVERI:
		adev->mode_info.num_crtc = 4;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 7;
		break;
	case CHIP_KABINI:
	case CHIP_MULLINS:
		adev->mode_info.num_crtc = 2;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 6;
		break;
4516 4517 4518 4519 4520 4521 4522 4523 4524 4525 4526 4527 4528 4529 4530 4531 4532
	case CHIP_FIJI:
	case CHIP_TONGA:
		adev->mode_info.num_crtc = 6;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 7;
		break;
	case CHIP_CARRIZO:
		adev->mode_info.num_crtc = 3;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 9;
		break;
	case CHIP_STONEY:
		adev->mode_info.num_crtc = 2;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 9;
		break;
	case CHIP_POLARIS11:
4533
	case CHIP_POLARIS12:
4534 4535 4536 4537 4538
		adev->mode_info.num_crtc = 5;
		adev->mode_info.num_hpd = 5;
		adev->mode_info.num_dig = 5;
		break;
	case CHIP_POLARIS10:
4539
	case CHIP_VEGAM:
4540 4541 4542 4543
		adev->mode_info.num_crtc = 6;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 6;
		break;
4544
	case CHIP_VEGA10:
4545
	case CHIP_VEGA12:
4546
	case CHIP_VEGA20:
4547 4548 4549 4550
		adev->mode_info.num_crtc = 6;
		adev->mode_info.num_hpd = 6;
		adev->mode_info.num_dig = 6;
		break;
4551
	default:
4552
#if defined(CONFIG_DRM_AMD_DC_DCN)
4553
		switch (adev->ip_versions[DCE_HWIP][0]) {
4554 4555 4556 4557 4558 4559 4560 4561 4562 4563 4564 4565 4566 4567 4568 4569 4570 4571
		case IP_VERSION(2, 0, 2):
		case IP_VERSION(3, 0, 0):
			adev->mode_info.num_crtc = 6;
			adev->mode_info.num_hpd = 6;
			adev->mode_info.num_dig = 6;
			break;
		case IP_VERSION(2, 0, 0):
		case IP_VERSION(3, 0, 2):
			adev->mode_info.num_crtc = 5;
			adev->mode_info.num_hpd = 5;
			adev->mode_info.num_dig = 5;
			break;
		case IP_VERSION(2, 0, 3):
		case IP_VERSION(3, 0, 3):
			adev->mode_info.num_crtc = 2;
			adev->mode_info.num_hpd = 2;
			adev->mode_info.num_dig = 2;
			break;
4572 4573
		case IP_VERSION(1, 0, 0):
		case IP_VERSION(1, 0, 1):
4574 4575 4576 4577
		case IP_VERSION(3, 0, 1):
		case IP_VERSION(2, 1, 0):
		case IP_VERSION(3, 1, 2):
		case IP_VERSION(3, 1, 3):
4578
		case IP_VERSION(3, 1, 5):
4579
		case IP_VERSION(3, 1, 6):
4580 4581 4582 4583 4584
			adev->mode_info.num_crtc = 4;
			adev->mode_info.num_hpd = 4;
			adev->mode_info.num_dig = 4;
			break;
		default:
4585
			DRM_ERROR("Unsupported DCE IP versions: 0x%x\n",
4586
					adev->ip_versions[DCE_HWIP][0]);
4587
			return -EINVAL;
4588 4589
		}
#endif
4590
		break;
4591 4592
	}

4593 4594
	amdgpu_dm_set_irq_funcs(adev);

4595 4596 4597
	if (adev->mode_info.funcs == NULL)
		adev->mode_info.funcs = &dm_display_funcs;

4598 4599
	/*
	 * Note: Do NOT change adev->audio_endpt_rreg and
4600
	 * adev->audio_endpt_wreg because they are initialised in
4601 4602
	 * amdgpu_device_init()
	 */
4603 4604
#if defined(CONFIG_DEBUG_KERNEL_DC)
	device_create_file(
4605
		adev_to_drm(adev)->dev,
4606 4607 4608 4609 4610 4611
		&dev_attr_s3_debug);
#endif

	return 0;
}

4612
static bool modeset_required(struct drm_crtc_state *crtc_state,
4613 4614
			     struct dc_stream_state *new_stream,
			     struct dc_stream_state *old_stream)
4615
{
4616
	return crtc_state->active && drm_atomic_crtc_needs_modeset(crtc_state);
4617 4618 4619 4620
}

static bool modereset_required(struct drm_crtc_state *crtc_state)
{
4621
	return !crtc_state->active && drm_atomic_crtc_needs_modeset(crtc_state);
4622 4623
}

4624
static void amdgpu_dm_encoder_destroy(struct drm_encoder *encoder)
4625 4626 4627 4628 4629 4630 4631 4632 4633 4634
{
	drm_encoder_cleanup(encoder);
	kfree(encoder);
}

static const struct drm_encoder_funcs amdgpu_dm_encoder_funcs = {
	.destroy = amdgpu_dm_encoder_destroy,
};


4635 4636 4637 4638 4639 4640 4641 4642 4643 4644 4645 4646 4647 4648 4649 4650 4651 4652 4653 4654 4655 4656 4657 4658 4659 4660 4661 4662 4663 4664 4665 4666 4667 4668 4669 4670 4671 4672 4673 4674 4675 4676 4677
static void get_min_max_dc_plane_scaling(struct drm_device *dev,
					 struct drm_framebuffer *fb,
					 int *min_downscale, int *max_upscale)
{
	struct amdgpu_device *adev = drm_to_adev(dev);
	struct dc *dc = adev->dm.dc;
	/* Caps for all supported planes are the same on DCE and DCN 1 - 3 */
	struct dc_plane_cap *plane_cap = &dc->caps.planes[0];

	switch (fb->format->format) {
	case DRM_FORMAT_P010:
	case DRM_FORMAT_NV12:
	case DRM_FORMAT_NV21:
		*max_upscale = plane_cap->max_upscale_factor.nv12;
		*min_downscale = plane_cap->max_downscale_factor.nv12;
		break;

	case DRM_FORMAT_XRGB16161616F:
	case DRM_FORMAT_ARGB16161616F:
	case DRM_FORMAT_XBGR16161616F:
	case DRM_FORMAT_ABGR16161616F:
		*max_upscale = plane_cap->max_upscale_factor.fp16;
		*min_downscale = plane_cap->max_downscale_factor.fp16;
		break;

	default:
		*max_upscale = plane_cap->max_upscale_factor.argb8888;
		*min_downscale = plane_cap->max_downscale_factor.argb8888;
		break;
	}

	/*
	 * A factor of 1 in the plane_cap means to not allow scaling, ie. use a
	 * scaling factor of 1.0 == 1000 units.
	 */
	if (*max_upscale == 1)
		*max_upscale = 1000;

	if (*min_downscale == 1)
		*min_downscale = 1000;
}


4678 4679
static int fill_dc_scaling_info(struct amdgpu_device *adev,
				const struct drm_plane_state *state,
4680
				struct dc_scaling_info *scaling_info)
4681
{
4682
	int scale_w, scale_h, min_downscale, max_upscale;
4683

4684
	memset(scaling_info, 0, sizeof(*scaling_info));
4685

4686 4687 4688
	/* Source is fixed 16.16 but we ignore mantissa for now... */
	scaling_info->src_rect.x = state->src_x >> 16;
	scaling_info->src_rect.y = state->src_y >> 16;
4689

4690 4691 4692
	/*
	 * For reasons we don't (yet) fully understand a non-zero
	 * src_y coordinate into an NV12 buffer can cause a
4693 4694
	 * system hang on DCN1x.
	 * To avoid hangs (and maybe be overly cautious)
4695 4696 4697 4698 4699 4700 4701
	 * let's reject both non-zero src_x and src_y.
	 *
	 * We currently know of only one use-case to reproduce a
	 * scenario with non-zero src_x and src_y for NV12, which
	 * is to gesture the YouTube Android app into full screen
	 * on ChromeOS.
	 */
4702 4703 4704 4705
	if (((adev->ip_versions[DCE_HWIP][0] == IP_VERSION(1, 0, 0)) ||
	    (adev->ip_versions[DCE_HWIP][0] == IP_VERSION(1, 0, 1))) &&
	    (state->fb && state->fb->format->format == DRM_FORMAT_NV12 &&
	    (scaling_info->src_rect.x != 0 || scaling_info->src_rect.y != 0)))
4706 4707
		return -EINVAL;

4708 4709 4710 4711 4712 4713 4714 4715 4716 4717
	scaling_info->src_rect.width = state->src_w >> 16;
	if (scaling_info->src_rect.width == 0)
		return -EINVAL;

	scaling_info->src_rect.height = state->src_h >> 16;
	if (scaling_info->src_rect.height == 0)
		return -EINVAL;

	scaling_info->dst_rect.x = state->crtc_x;
	scaling_info->dst_rect.y = state->crtc_y;
4718 4719

	if (state->crtc_w == 0)
4720
		return -EINVAL;
4721

4722
	scaling_info->dst_rect.width = state->crtc_w;
4723 4724

	if (state->crtc_h == 0)
4725
		return -EINVAL;
4726

4727
	scaling_info->dst_rect.height = state->crtc_h;
4728

4729 4730
	/* DRM doesn't specify clipping on destination output. */
	scaling_info->clip_rect = scaling_info->dst_rect;
4731

4732 4733 4734 4735 4736 4737 4738 4739 4740
	/* Validate scaling per-format with DC plane caps */
	if (state->plane && state->plane->dev && state->fb) {
		get_min_max_dc_plane_scaling(state->plane->dev, state->fb,
					     &min_downscale, &max_upscale);
	} else {
		min_downscale = 250;
		max_upscale = 16000;
	}

4741 4742
	scale_w = scaling_info->dst_rect.width * 1000 /
		  scaling_info->src_rect.width;
4743

4744
	if (scale_w < min_downscale || scale_w > max_upscale)
4745 4746 4747 4748 4749
		return -EINVAL;

	scale_h = scaling_info->dst_rect.height * 1000 /
		  scaling_info->src_rect.height;

4750
	if (scale_h < min_downscale || scale_h > max_upscale)
4751 4752
		return -EINVAL;

4753 4754 4755 4756
	/*
	 * The "scaling_quality" can be ignored for now, quality = 0 has DC
	 * assume reasonable defaults based on the format.
	 */
4757

4758
	return 0;
4759
}
4760

4761 4762 4763
static void
fill_gfx8_tiling_info_from_flags(union dc_tiling_info *tiling_info,
				 uint64_t tiling_flags)
4764
{
4765 4766 4767
	/* Fill GFX8 params */
	if (AMDGPU_TILING_GET(tiling_flags, ARRAY_MODE) == DC_ARRAY_2D_TILED_THIN1) {
		unsigned int bankw, bankh, mtaspect, tile_split, num_banks;
4768

4769 4770 4771 4772 4773
		bankw = AMDGPU_TILING_GET(tiling_flags, BANK_WIDTH);
		bankh = AMDGPU_TILING_GET(tiling_flags, BANK_HEIGHT);
		mtaspect = AMDGPU_TILING_GET(tiling_flags, MACRO_TILE_ASPECT);
		tile_split = AMDGPU_TILING_GET(tiling_flags, TILE_SPLIT);
		num_banks = AMDGPU_TILING_GET(tiling_flags, NUM_BANKS);
4774

4775 4776 4777 4778 4779 4780 4781 4782 4783 4784 4785 4786 4787
		/* XXX fix me for VI */
		tiling_info->gfx8.num_banks = num_banks;
		tiling_info->gfx8.array_mode =
				DC_ARRAY_2D_TILED_THIN1;
		tiling_info->gfx8.tile_split = tile_split;
		tiling_info->gfx8.bank_width = bankw;
		tiling_info->gfx8.bank_height = bankh;
		tiling_info->gfx8.tile_aspect = mtaspect;
		tiling_info->gfx8.tile_mode =
				DC_ADDR_SURF_MICRO_TILING_DISPLAY;
	} else if (AMDGPU_TILING_GET(tiling_flags, ARRAY_MODE)
			== DC_ARRAY_1D_TILED_THIN1) {
		tiling_info->gfx8.array_mode = DC_ARRAY_1D_TILED_THIN1;
4788 4789
	}

4790 4791
	tiling_info->gfx8.pipe_config =
			AMDGPU_TILING_GET(tiling_flags, PIPE_CONFIG);
4792 4793
}

4794 4795 4796 4797 4798 4799 4800 4801 4802 4803 4804 4805 4806 4807 4808 4809 4810
static void
fill_gfx9_tiling_info_from_device(const struct amdgpu_device *adev,
				  union dc_tiling_info *tiling_info)
{
	tiling_info->gfx9.num_pipes =
		adev->gfx.config.gb_addr_config_fields.num_pipes;
	tiling_info->gfx9.num_banks =
		adev->gfx.config.gb_addr_config_fields.num_banks;
	tiling_info->gfx9.pipe_interleave =
		adev->gfx.config.gb_addr_config_fields.pipe_interleave_size;
	tiling_info->gfx9.num_shader_engines =
		adev->gfx.config.gb_addr_config_fields.num_se;
	tiling_info->gfx9.max_compressed_frags =
		adev->gfx.config.gb_addr_config_fields.max_compress_frags;
	tiling_info->gfx9.num_rb_per_se =
		adev->gfx.config.gb_addr_config_fields.num_rb_per_se;
	tiling_info->gfx9.shaderEnable = 1;
4811
	if (adev->ip_versions[GC_HWIP][0] >= IP_VERSION(10, 3, 0))
4812
		tiling_info->gfx9.num_pkrs = adev->gfx.config.gb_addr_config_fields.num_pkrs;
4813 4814
}

4815
static int
4816 4817 4818 4819 4820 4821 4822
validate_dcc(struct amdgpu_device *adev,
	     const enum surface_pixel_format format,
	     const enum dc_rotation_angle rotation,
	     const union dc_tiling_info *tiling_info,
	     const struct dc_plane_dcc_param *dcc,
	     const struct dc_plane_address *address,
	     const struct plane_size *plane_size)
4823 4824
{
	struct dc *dc = adev->dm.dc;
4825 4826
	struct dc_dcc_surface_param input;
	struct dc_surface_dcc_cap output;
4827

4828 4829 4830
	memset(&input, 0, sizeof(input));
	memset(&output, 0, sizeof(output));

4831
	if (!dcc->enable)
4832 4833
		return 0;

4834 4835
	if (format >= SURFACE_PIXEL_FORMAT_VIDEO_BEGIN ||
	    !dc->cap_funcs.get_dcc_compression_cap)
4836
		return -EINVAL;
4837

4838
	input.format = format;
4839 4840
	input.surface_size.width = plane_size->surface_size.width;
	input.surface_size.height = plane_size->surface_size.height;
4841
	input.swizzle_mode = tiling_info->gfx9.swizzle;
4842

4843
	if (rotation == ROTATION_ANGLE_0 || rotation == ROTATION_ANGLE_180)
4844
		input.scan = SCAN_DIRECTION_HORIZONTAL;
4845
	else if (rotation == ROTATION_ANGLE_90 || rotation == ROTATION_ANGLE_270)
4846 4847 4848
		input.scan = SCAN_DIRECTION_VERTICAL;

	if (!dc->cap_funcs.get_dcc_compression_cap(dc, &input, &output))
4849
		return -EINVAL;
4850 4851

	if (!output.capable)
4852
		return -EINVAL;
4853

4854 4855
	if (dcc->independent_64b_blks == 0 &&
	    output.grph.rgb.independent_64b_blks != 0)
4856
		return -EINVAL;
4857

4858 4859 4860
	return 0;
}

4861 4862 4863 4864 4865 4866 4867 4868 4869 4870 4871 4872 4873 4874 4875
static bool
modifier_has_dcc(uint64_t modifier)
{
	return IS_AMD_FMT_MOD(modifier) && AMD_FMT_MOD_GET(DCC, modifier);
}

static unsigned
modifier_gfx9_swizzle_mode(uint64_t modifier)
{
	if (modifier == DRM_FORMAT_MOD_LINEAR)
		return 0;

	return AMD_FMT_MOD_GET(TILE, modifier);
}

4876 4877 4878
static const struct drm_format_info *
amd_get_format_info(const struct drm_mode_fb_cmd2 *cmd)
{
4879
	return amdgpu_lookup_format_info(cmd->pixel_format, cmd->modifier[0]);
4880 4881
}

4882 4883 4884 4885 4886 4887 4888 4889 4890 4891 4892 4893 4894 4895 4896 4897 4898 4899 4900 4901 4902 4903 4904 4905 4906 4907 4908
static void
fill_gfx9_tiling_info_from_modifier(const struct amdgpu_device *adev,
				    union dc_tiling_info *tiling_info,
				    uint64_t modifier)
{
	unsigned int mod_bank_xor_bits = AMD_FMT_MOD_GET(BANK_XOR_BITS, modifier);
	unsigned int mod_pipe_xor_bits = AMD_FMT_MOD_GET(PIPE_XOR_BITS, modifier);
	unsigned int pkrs_log2 = AMD_FMT_MOD_GET(PACKERS, modifier);
	unsigned int pipes_log2 = min(4u, mod_pipe_xor_bits);

	fill_gfx9_tiling_info_from_device(adev, tiling_info);

	if (!IS_AMD_FMT_MOD(modifier))
		return;

	tiling_info->gfx9.num_pipes = 1u << pipes_log2;
	tiling_info->gfx9.num_shader_engines = 1u << (mod_pipe_xor_bits - pipes_log2);

	if (adev->family >= AMDGPU_FAMILY_NV) {
		tiling_info->gfx9.num_pkrs = 1u << pkrs_log2;
	} else {
		tiling_info->gfx9.num_banks = 1u << mod_bank_xor_bits;

		/* for DCC we know it isn't rb aligned, so rb_per_se doesn't matter. */
	}
}

4909 4910 4911 4912 4913 4914 4915 4916 4917 4918 4919 4920 4921
enum dm_micro_swizzle {
	MICRO_SWIZZLE_Z = 0,
	MICRO_SWIZZLE_S = 1,
	MICRO_SWIZZLE_D = 2,
	MICRO_SWIZZLE_R = 3
};

static bool dm_plane_format_mod_supported(struct drm_plane *plane,
					  uint32_t format,
					  uint64_t modifier)
{
	struct amdgpu_device *adev = drm_to_adev(plane->dev);
	const struct drm_format_info *info = drm_format_info(format);
4922
	int i;
4923 4924 4925 4926 4927 4928 4929

	enum dm_micro_swizzle microtile = modifier_gfx9_swizzle_mode(modifier) & 3;

	if (!info)
		return false;

	/*
4930 4931 4932
	 * We always have to allow these modifiers:
	 * 1. Core DRM checks for LINEAR support if userspace does not provide modifiers.
	 * 2. Not passing any modifiers is the same as explicitly passing INVALID.
4933
	 */
4934 4935
	if (modifier == DRM_FORMAT_MOD_LINEAR ||
	    modifier == DRM_FORMAT_MOD_INVALID) {
4936
		return true;
4937
	}
4938

4939 4940 4941 4942 4943 4944
	/* Check that the modifier is on the list of the plane's supported modifiers. */
	for (i = 0; i < plane->modifier_count; i++) {
		if (modifier == plane->modifiers[i])
			break;
	}
	if (i == plane->modifier_count)
4945 4946 4947 4948 4949 4950 4951 4952 4953 4954 4955 4956 4957 4958 4959 4960 4961 4962 4963 4964
		return false;

	/*
	 * For D swizzle the canonical modifier depends on the bpp, so check
	 * it here.
	 */
	if (AMD_FMT_MOD_GET(TILE_VERSION, modifier) == AMD_FMT_MOD_TILE_VER_GFX9 &&
	    adev->family >= AMDGPU_FAMILY_NV) {
		if (microtile == MICRO_SWIZZLE_D && info->cpp[0] == 4)
			return false;
	}

	if (adev->family >= AMDGPU_FAMILY_RV && microtile == MICRO_SWIZZLE_D &&
	    info->cpp[0] < 8)
		return false;

	if (modifier_has_dcc(modifier)) {
		/* Per radeonsi comments 16/64 bpp are more complicated. */
		if (info->cpp[0] != 4)
			return false;
4965 4966 4967 4968
		/* We support multi-planar formats, but not when combined with
		 * additional DCC metadata planes. */
		if (info->num_planes > 1)
			return false;
4969 4970 4971 4972 4973 4974 4975 4976 4977 4978 4979 4980 4981 4982 4983 4984 4985 4986 4987 4988 4989 4990 4991 4992 4993 4994 4995 4996 4997 4998 4999 5000 5001 5002 5003 5004 5005 5006 5007 5008 5009 5010 5011 5012 5013 5014 5015 5016 5017 5018 5019 5020 5021 5022 5023 5024 5025 5026 5027 5028 5029 5030 5031 5032 5033 5034 5035 5036 5037 5038 5039 5040 5041 5042 5043 5044 5045 5046 5047 5048 5049 5050 5051 5052 5053 5054 5055 5056 5057 5058 5059 5060 5061 5062 5063 5064 5065 5066 5067 5068 5069 5070 5071 5072 5073 5074 5075 5076 5077 5078 5079 5080 5081 5082 5083 5084 5085 5086 5087 5088 5089 5090 5091 5092 5093 5094 5095 5096 5097 5098 5099 5100 5101 5102 5103 5104 5105 5106 5107 5108 5109 5110 5111 5112 5113 5114 5115 5116 5117 5118 5119 5120 5121 5122 5123 5124 5125 5126 5127 5128 5129 5130 5131 5132 5133 5134 5135 5136 5137 5138 5139 5140 5141 5142 5143 5144 5145 5146 5147 5148 5149 5150 5151 5152 5153 5154 5155 5156 5157 5158 5159 5160 5161 5162 5163 5164 5165 5166 5167 5168
	}

	return true;
}

static void
add_modifier(uint64_t **mods, uint64_t *size, uint64_t *cap, uint64_t mod)
{
	if (!*mods)
		return;

	if (*cap - *size < 1) {
		uint64_t new_cap = *cap * 2;
		uint64_t *new_mods = kmalloc(new_cap * sizeof(uint64_t), GFP_KERNEL);

		if (!new_mods) {
			kfree(*mods);
			*mods = NULL;
			return;
		}

		memcpy(new_mods, *mods, sizeof(uint64_t) * *size);
		kfree(*mods);
		*mods = new_mods;
		*cap = new_cap;
	}

	(*mods)[*size] = mod;
	*size += 1;
}

static void
add_gfx9_modifiers(const struct amdgpu_device *adev,
		   uint64_t **mods, uint64_t *size, uint64_t *capacity)
{
	int pipes = ilog2(adev->gfx.config.gb_addr_config_fields.num_pipes);
	int pipe_xor_bits = min(8, pipes +
				ilog2(adev->gfx.config.gb_addr_config_fields.num_se));
	int bank_xor_bits = min(8 - pipe_xor_bits,
				ilog2(adev->gfx.config.gb_addr_config_fields.num_banks));
	int rb = ilog2(adev->gfx.config.gb_addr_config_fields.num_se) +
		 ilog2(adev->gfx.config.gb_addr_config_fields.num_rb_per_se);


	if (adev->family == AMDGPU_FAMILY_RV) {
		/* Raven2 and later */
		bool has_constant_encode = adev->asic_type > CHIP_RAVEN || adev->external_rev_id >= 0x81;

		/*
		 * No _D DCC swizzles yet because we only allow 32bpp, which
		 * doesn't support _D on DCN
		 */

		if (has_constant_encode) {
			add_modifier(mods, size, capacity, AMD_FMT_MOD |
				    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S_X) |
				    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9) |
				    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
				    AMD_FMT_MOD_SET(BANK_XOR_BITS, bank_xor_bits) |
				    AMD_FMT_MOD_SET(DCC, 1) |
				    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
				    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B) |
				    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1));
		}

		add_modifier(mods, size, capacity, AMD_FMT_MOD |
			    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S_X) |
			    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9) |
			    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
			    AMD_FMT_MOD_SET(BANK_XOR_BITS, bank_xor_bits) |
			    AMD_FMT_MOD_SET(DCC, 1) |
			    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
			    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B) |
			    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 0));

		if (has_constant_encode) {
			add_modifier(mods, size, capacity, AMD_FMT_MOD |
				    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S_X) |
				    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9) |
				    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
				    AMD_FMT_MOD_SET(BANK_XOR_BITS, bank_xor_bits) |
				    AMD_FMT_MOD_SET(DCC, 1) |
				    AMD_FMT_MOD_SET(DCC_RETILE, 1) |
				    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
				    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B) |

				    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1) |
				    AMD_FMT_MOD_SET(RB, rb) |
				    AMD_FMT_MOD_SET(PIPE, pipes));
		}

		add_modifier(mods, size, capacity, AMD_FMT_MOD |
			    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S_X) |
			    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9) |
			    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
			    AMD_FMT_MOD_SET(BANK_XOR_BITS, bank_xor_bits) |
			    AMD_FMT_MOD_SET(DCC, 1) |
			    AMD_FMT_MOD_SET(DCC_RETILE, 1) |
			    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
			    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B) |
			    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 0) |
			    AMD_FMT_MOD_SET(RB, rb) |
			    AMD_FMT_MOD_SET(PIPE, pipes));
	}

	/*
	 * Only supported for 64bpp on Raven, will be filtered on format in
	 * dm_plane_format_mod_supported.
	 */
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_D_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(BANK_XOR_BITS, bank_xor_bits));

	if (adev->family == AMDGPU_FAMILY_RV) {
		add_modifier(mods, size, capacity, AMD_FMT_MOD |
			    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S_X) |
			    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9) |
			    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
			    AMD_FMT_MOD_SET(BANK_XOR_BITS, bank_xor_bits));
	}

	/*
	 * Only supported for 64bpp on Raven, will be filtered on format in
	 * dm_plane_format_mod_supported.
	 */
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_D) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9));

	if (adev->family == AMDGPU_FAMILY_RV) {
		add_modifier(mods, size, capacity, AMD_FMT_MOD |
			    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S) |
			    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9));
	}
}

static void
add_gfx10_1_modifiers(const struct amdgpu_device *adev,
		      uint64_t **mods, uint64_t *size, uint64_t *capacity)
{
	int pipe_xor_bits = ilog2(adev->gfx.config.gb_addr_config_fields.num_pipes);

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(DCC, 1) |
		    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
		    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B));

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(DCC, 1) |
		    AMD_FMT_MOD_SET(DCC_RETILE, 1) |
		    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
		    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B));

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits));

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits));


	/* Only supported for 64bpp, will be filtered in dm_plane_format_mod_supported */
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_D) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9));

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9));
}

static void
add_gfx10_3_modifiers(const struct amdgpu_device *adev,
		      uint64_t **mods, uint64_t *size, uint64_t *capacity)
{
	int pipe_xor_bits = ilog2(adev->gfx.config.gb_addr_config_fields.num_pipes);
	int pkrs = ilog2(adev->gfx.config.gb_addr_config_fields.num_pkrs);

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10_RBPLUS) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(PACKERS, pkrs) |
		    AMD_FMT_MOD_SET(DCC, 1) |
		    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_128B, 1) |
5169
		    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B));
5170

5171 5172 5173 5174 5175 5176 5177 5178 5179 5180
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10_RBPLUS) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(PACKERS, pkrs) |
		    AMD_FMT_MOD_SET(DCC, 1) |
		    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_128B, 1) |
		    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_128B));

5181 5182 5183 5184 5185 5186 5187 5188 5189 5190
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10_RBPLUS) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(PACKERS, pkrs) |
		    AMD_FMT_MOD_SET(DCC, 1) |
		    AMD_FMT_MOD_SET(DCC_RETILE, 1) |
		    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_64B, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_128B, 1) |
5191
		    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_64B));
5192

5193 5194 5195 5196 5197 5198 5199 5200 5201 5202 5203
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10_RBPLUS) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(PACKERS, pkrs) |
		    AMD_FMT_MOD_SET(DCC, 1) |
		    AMD_FMT_MOD_SET(DCC_RETILE, 1) |
		    AMD_FMT_MOD_SET(DCC_CONSTANT_ENCODE, 1) |
		    AMD_FMT_MOD_SET(DCC_INDEPENDENT_128B, 1) |
		    AMD_FMT_MOD_SET(DCC_MAX_COMPRESSED_BLOCK, AMD_FMT_MOD_DCC_BLOCK_128B));

5204 5205 5206 5207 5208 5209 5210 5211 5212 5213 5214 5215 5216 5217 5218 5219 5220 5221 5222 5223 5224 5225 5226 5227 5228 5229 5230 5231 5232 5233 5234 5235 5236 5237 5238 5239 5240 5241 5242 5243 5244 5245 5246 5247 5248 5249 5250
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_R_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10_RBPLUS) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(PACKERS, pkrs));

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S_X) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX10_RBPLUS) |
		    AMD_FMT_MOD_SET(PIPE_XOR_BITS, pipe_xor_bits) |
		    AMD_FMT_MOD_SET(PACKERS, pkrs));

	/* Only supported for 64bpp, will be filtered in dm_plane_format_mod_supported */
	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_D) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9));

	add_modifier(mods, size, capacity, AMD_FMT_MOD |
		    AMD_FMT_MOD_SET(TILE, AMD_FMT_MOD_TILE_GFX9_64K_S) |
		    AMD_FMT_MOD_SET(TILE_VERSION, AMD_FMT_MOD_TILE_VER_GFX9));
}

static int
get_plane_modifiers(const struct amdgpu_device *adev, unsigned int plane_type, uint64_t **mods)
{
	uint64_t size = 0, capacity = 128;
	*mods = NULL;

	/* We have not hooked up any pre-GFX9 modifiers. */
	if (adev->family < AMDGPU_FAMILY_AI)
		return 0;

	*mods = kmalloc(capacity * sizeof(uint64_t), GFP_KERNEL);

	if (plane_type == DRM_PLANE_TYPE_CURSOR) {
		add_modifier(mods, &size, &capacity, DRM_FORMAT_MOD_LINEAR);
		add_modifier(mods, &size, &capacity, DRM_FORMAT_MOD_INVALID);
		return *mods ? 0 : -ENOMEM;
	}

	switch (adev->family) {
	case AMDGPU_FAMILY_AI:
	case AMDGPU_FAMILY_RV:
		add_gfx9_modifiers(adev, mods, &size, &capacity);
		break;
	case AMDGPU_FAMILY_NV:
	case AMDGPU_FAMILY_VGH:
5251
	case AMDGPU_FAMILY_YC:
5252
	case AMDGPU_FAMILY_GC_10_3_6:
5253
	case AMDGPU_FAMILY_GC_10_3_7:
5254
		if (adev->ip_versions[GC_HWIP][0] >= IP_VERSION(10, 3, 0))
5255 5256 5257 5258 5259 5260 5261 5262 5263 5264 5265 5266 5267 5268 5269 5270 5271
			add_gfx10_3_modifiers(adev, mods, &size, &capacity);
		else
			add_gfx10_1_modifiers(adev, mods, &size, &capacity);
		break;
	}

	add_modifier(mods, &size, &capacity, DRM_FORMAT_MOD_LINEAR);

	/* INVALID marks the end of the list. */
	add_modifier(mods, &size, &capacity, DRM_FORMAT_MOD_INVALID);

	if (!*mods)
		return -ENOMEM;

	return 0;
}

5272 5273 5274 5275 5276 5277 5278 5279 5280 5281 5282 5283
static int
fill_gfx9_plane_attributes_from_modifiers(struct amdgpu_device *adev,
					  const struct amdgpu_framebuffer *afb,
					  const enum surface_pixel_format format,
					  const enum dc_rotation_angle rotation,
					  const struct plane_size *plane_size,
					  union dc_tiling_info *tiling_info,
					  struct dc_plane_dcc_param *dcc,
					  struct dc_plane_address *address,
					  const bool force_disable_dcc)
{
	const uint64_t modifier = afb->base.modifier;
5284
	int ret = 0;
5285 5286 5287 5288 5289 5290

	fill_gfx9_tiling_info_from_modifier(adev, tiling_info, modifier);
	tiling_info->gfx9.swizzle = modifier_gfx9_swizzle_mode(modifier);

	if (modifier_has_dcc(modifier) && !force_disable_dcc) {
		uint64_t dcc_address = afb->address + afb->base.offsets[1];
5291
		bool independent_64b_blks = AMD_FMT_MOD_GET(DCC_INDEPENDENT_64B, modifier);
5292
		bool independent_128b_blks = AMD_FMT_MOD_GET(DCC_INDEPENDENT_128B, modifier);
5293 5294 5295

		dcc->enable = 1;
		dcc->meta_pitch = afb->base.pitches[1];
5296
		dcc->independent_64b_blks = independent_64b_blks;
5297 5298
		if (AMD_FMT_MOD_GET(TILE_VERSION, modifier) == AMD_FMT_MOD_TILE_VER_GFX10_RBPLUS) {
			if (independent_64b_blks && independent_128b_blks)
5299
				dcc->dcc_ind_blk = hubp_ind_block_64b_no_128bcl;
5300 5301 5302
			else if (independent_128b_blks)
				dcc->dcc_ind_blk = hubp_ind_block_128b;
			else if (independent_64b_blks && !independent_128b_blks)
5303
				dcc->dcc_ind_blk = hubp_ind_block_64b;
5304 5305 5306 5307 5308 5309 5310 5311
			else
				dcc->dcc_ind_blk = hubp_ind_block_unconstrained;
		} else {
			if (independent_64b_blks)
				dcc->dcc_ind_blk = hubp_ind_block_64b;
			else
				dcc->dcc_ind_blk = hubp_ind_block_unconstrained;
		}
5312 5313 5314 5315 5316 5317 5318

		address->grph.meta_addr.low_part = lower_32_bits(dcc_address);
		address->grph.meta_addr.high_part = upper_32_bits(dcc_address);
	}

	ret = validate_dcc(adev, format, rotation, tiling_info, dcc, address, plane_size);
	if (ret)
5319
		drm_dbg_kms(adev_to_drm(adev), "validate_dcc: returned error: %d\n", ret);
5320

5321
	return ret;
5322 5323 5324
}

static int
5325
fill_plane_buffer_attributes(struct amdgpu_device *adev,
5326
			     const struct amdgpu_framebuffer *afb,
5327 5328 5329
			     const enum surface_pixel_format format,
			     const enum dc_rotation_angle rotation,
			     const uint64_t tiling_flags,
5330
			     union dc_tiling_info *tiling_info,
5331
			     struct plane_size *plane_size,
5332
			     struct dc_plane_dcc_param *dcc,
5333
			     struct dc_plane_address *address,
5334
			     bool tmz_surface,
5335
			     bool force_disable_dcc)
5336
{
5337
	const struct drm_framebuffer *fb = &afb->base;
5338 5339 5340
	int ret;

	memset(tiling_info, 0, sizeof(*tiling_info));
5341
	memset(plane_size, 0, sizeof(*plane_size));
5342
	memset(dcc, 0, sizeof(*dcc));
5343 5344
	memset(address, 0, sizeof(*address));

5345 5346
	address->tmz_surface = tmz_surface;

5347
	if (format < SURFACE_PIXEL_FORMAT_VIDEO_BEGIN) {
5348 5349
		uint64_t addr = afb->address + fb->offsets[0];

5350 5351 5352 5353 5354
		plane_size->surface_size.x = 0;
		plane_size->surface_size.y = 0;
		plane_size->surface_size.width = fb->width;
		plane_size->surface_size.height = fb->height;
		plane_size->surface_pitch =
5355 5356
			fb->pitches[0] / fb->format->cpp[0];

5357
		address->type = PLN_ADDR_TYPE_GRAPHICS;
5358 5359
		address->grph.addr.low_part = lower_32_bits(addr);
		address->grph.addr.high_part = upper_32_bits(addr);
5360
	} else if (format < SURFACE_PIXEL_FORMAT_INVALID) {
5361
		uint64_t luma_addr = afb->address + fb->offsets[0];
5362
		uint64_t chroma_addr = afb->address + fb->offsets[1];
5363

5364 5365 5366 5367 5368
		plane_size->surface_size.x = 0;
		plane_size->surface_size.y = 0;
		plane_size->surface_size.width = fb->width;
		plane_size->surface_size.height = fb->height;
		plane_size->surface_pitch =
5369 5370
			fb->pitches[0] / fb->format->cpp[0];

5371 5372
		plane_size->chroma_size.x = 0;
		plane_size->chroma_size.y = 0;
5373
		/* TODO: set these based on surface format */
5374 5375
		plane_size->chroma_size.width = fb->width / 2;
		plane_size->chroma_size.height = fb->height / 2;
5376

5377
		plane_size->chroma_pitch =
5378 5379
			fb->pitches[1] / fb->format->cpp[1];

5380 5381
		address->type = PLN_ADDR_TYPE_VIDEO_PROGRESSIVE;
		address->video_progressive.luma_addr.low_part =
5382
			lower_32_bits(luma_addr);
5383
		address->video_progressive.luma_addr.high_part =
5384
			upper_32_bits(luma_addr);
5385 5386 5387 5388 5389
		address->video_progressive.chroma_addr.low_part =
			lower_32_bits(chroma_addr);
		address->video_progressive.chroma_addr.high_part =
			upper_32_bits(chroma_addr);
	}
5390

5391
	if (adev->family >= AMDGPU_FAMILY_AI) {
5392 5393 5394 5395 5396
		ret = fill_gfx9_plane_attributes_from_modifiers(adev, afb, format,
								rotation, plane_size,
								tiling_info, dcc,
								address,
								force_disable_dcc);
5397 5398
		if (ret)
			return ret;
5399 5400
	} else {
		fill_gfx8_tiling_info_from_flags(tiling_info, tiling_flags);
5401 5402 5403
	}

	return 0;
5404 5405
}

5406
static void
5407
fill_blending_from_plane_state(const struct drm_plane_state *plane_state,
5408 5409 5410 5411 5412 5413 5414 5415 5416 5417 5418 5419 5420 5421 5422 5423 5424 5425 5426 5427 5428 5429 5430 5431 5432 5433 5434 5435 5436 5437 5438 5439 5440
			       bool *per_pixel_alpha, bool *global_alpha,
			       int *global_alpha_value)
{
	*per_pixel_alpha = false;
	*global_alpha = false;
	*global_alpha_value = 0xff;

	if (plane_state->plane->type != DRM_PLANE_TYPE_OVERLAY)
		return;

	if (plane_state->pixel_blend_mode == DRM_MODE_BLEND_PREMULTI) {
		static const uint32_t alpha_formats[] = {
			DRM_FORMAT_ARGB8888,
			DRM_FORMAT_RGBA8888,
			DRM_FORMAT_ABGR8888,
		};
		uint32_t format = plane_state->fb->format->format;
		unsigned int i;

		for (i = 0; i < ARRAY_SIZE(alpha_formats); ++i) {
			if (format == alpha_formats[i]) {
				*per_pixel_alpha = true;
				break;
			}
		}
	}

	if (plane_state->alpha < 0xffff) {
		*global_alpha = true;
		*global_alpha_value = plane_state->alpha >> 8;
	}
}

5441 5442
static int
fill_plane_color_attributes(const struct drm_plane_state *plane_state,
5443
			    const enum surface_pixel_format format,
5444 5445 5446 5447 5448 5449 5450
			    enum dc_color_space *color_space)
{
	bool full_range;

	*color_space = COLOR_SPACE_SRGB;

	/* DRM color properties only affect non-RGB formats. */
5451
	if (format < SURFACE_PIXEL_FORMAT_VIDEO_BEGIN)
5452 5453 5454 5455 5456 5457 5458 5459 5460 5461 5462 5463 5464 5465 5466 5467 5468 5469 5470 5471 5472 5473 5474 5475 5476 5477 5478 5479 5480 5481 5482 5483 5484
		return 0;

	full_range = (plane_state->color_range == DRM_COLOR_YCBCR_FULL_RANGE);

	switch (plane_state->color_encoding) {
	case DRM_COLOR_YCBCR_BT601:
		if (full_range)
			*color_space = COLOR_SPACE_YCBCR601;
		else
			*color_space = COLOR_SPACE_YCBCR601_LIMITED;
		break;

	case DRM_COLOR_YCBCR_BT709:
		if (full_range)
			*color_space = COLOR_SPACE_YCBCR709;
		else
			*color_space = COLOR_SPACE_YCBCR709_LIMITED;
		break;

	case DRM_COLOR_YCBCR_BT2020:
		if (full_range)
			*color_space = COLOR_SPACE_2020_YCBCR;
		else
			return -EINVAL;
		break;

	default:
		return -EINVAL;
	}

	return 0;
}

5485 5486 5487 5488 5489
static int
fill_dc_plane_info_and_addr(struct amdgpu_device *adev,
			    const struct drm_plane_state *plane_state,
			    const uint64_t tiling_flags,
			    struct dc_plane_info *plane_info,
5490
			    struct dc_plane_address *address,
5491
			    bool tmz_surface,
5492
			    bool force_disable_dcc)
5493 5494 5495 5496 5497 5498 5499 5500 5501 5502 5503 5504 5505 5506 5507 5508 5509 5510 5511 5512 5513 5514 5515 5516 5517 5518 5519 5520 5521 5522 5523 5524 5525 5526 5527 5528 5529 5530
{
	const struct drm_framebuffer *fb = plane_state->fb;
	const struct amdgpu_framebuffer *afb =
		to_amdgpu_framebuffer(plane_state->fb);
	int ret;

	memset(plane_info, 0, sizeof(*plane_info));

	switch (fb->format->format) {
	case DRM_FORMAT_C8:
		plane_info->format =
			SURFACE_PIXEL_FORMAT_GRPH_PALETA_256_COLORS;
		break;
	case DRM_FORMAT_RGB565:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_RGB565;
		break;
	case DRM_FORMAT_XRGB8888:
	case DRM_FORMAT_ARGB8888:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ARGB8888;
		break;
	case DRM_FORMAT_XRGB2101010:
	case DRM_FORMAT_ARGB2101010:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ARGB2101010;
		break;
	case DRM_FORMAT_XBGR2101010:
	case DRM_FORMAT_ABGR2101010:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ABGR2101010;
		break;
	case DRM_FORMAT_XBGR8888:
	case DRM_FORMAT_ABGR8888:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ABGR8888;
		break;
	case DRM_FORMAT_NV21:
		plane_info->format = SURFACE_PIXEL_FORMAT_VIDEO_420_YCbCr;
		break;
	case DRM_FORMAT_NV12:
		plane_info->format = SURFACE_PIXEL_FORMAT_VIDEO_420_YCrCb;
		break;
5531 5532 5533
	case DRM_FORMAT_P010:
		plane_info->format = SURFACE_PIXEL_FORMAT_VIDEO_420_10bpc_YCrCb;
		break;
5534 5535 5536 5537
	case DRM_FORMAT_XRGB16161616F:
	case DRM_FORMAT_ARGB16161616F:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ARGB16161616F;
		break;
5538 5539 5540 5541
	case DRM_FORMAT_XBGR16161616F:
	case DRM_FORMAT_ABGR16161616F:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ABGR16161616F;
		break;
5542 5543 5544 5545 5546 5547 5548 5549
	case DRM_FORMAT_XRGB16161616:
	case DRM_FORMAT_ARGB16161616:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ARGB16161616;
		break;
	case DRM_FORMAT_XBGR16161616:
	case DRM_FORMAT_ABGR16161616:
		plane_info->format = SURFACE_PIXEL_FORMAT_GRPH_ABGR16161616;
		break;
5550 5551
	default:
		DRM_ERROR(
5552 5553
			"Unsupported screen format %p4cc\n",
			&fb->format->format);
5554 5555 5556 5557 5558 5559 5560 5561 5562 5563 5564 5565 5566 5567 5568 5569 5570 5571 5572 5573 5574 5575 5576 5577
		return -EINVAL;
	}

	switch (plane_state->rotation & DRM_MODE_ROTATE_MASK) {
	case DRM_MODE_ROTATE_0:
		plane_info->rotation = ROTATION_ANGLE_0;
		break;
	case DRM_MODE_ROTATE_90:
		plane_info->rotation = ROTATION_ANGLE_90;
		break;
	case DRM_MODE_ROTATE_180:
		plane_info->rotation = ROTATION_ANGLE_180;
		break;
	case DRM_MODE_ROTATE_270:
		plane_info->rotation = ROTATION_ANGLE_270;
		break;
	default:
		plane_info->rotation = ROTATION_ANGLE_0;
		break;
	}

	plane_info->visible = true;
	plane_info->stereo_format = PLANE_STEREO_FORMAT_NONE;

5578 5579
	plane_info->layer_index = 0;

5580 5581 5582 5583 5584 5585 5586 5587 5588
	ret = fill_plane_color_attributes(plane_state, plane_info->format,
					  &plane_info->color_space);
	if (ret)
		return ret;

	ret = fill_plane_buffer_attributes(adev, afb, plane_info->format,
					   plane_info->rotation, tiling_flags,
					   &plane_info->tiling_info,
					   &plane_info->plane_size,
5589
					   &plane_info->dcc, address, tmz_surface,
5590
					   force_disable_dcc);
5591 5592 5593 5594 5595 5596 5597 5598 5599 5600 5601 5602 5603 5604
	if (ret)
		return ret;

	fill_blending_from_plane_state(
		plane_state, &plane_info->per_pixel_alpha,
		&plane_info->global_alpha, &plane_info->global_alpha_value);

	return 0;
}

static int fill_dc_plane_attributes(struct amdgpu_device *adev,
				    struct dc_plane_state *dc_plane_state,
				    struct drm_plane_state *plane_state,
				    struct drm_crtc_state *crtc_state)
5605
{
5606
	struct dm_crtc_state *dm_crtc_state = to_dm_crtc_state(crtc_state);
5607
	struct amdgpu_framebuffer *afb = (struct amdgpu_framebuffer *)plane_state->fb;
5608 5609 5610
	struct dc_scaling_info scaling_info;
	struct dc_plane_info plane_info;
	int ret;
5611
	bool force_disable_dcc = false;
5612

5613
	ret = fill_dc_scaling_info(adev, plane_state, &scaling_info);
5614 5615
	if (ret)
		return ret;
5616

5617 5618 5619 5620
	dc_plane_state->src_rect = scaling_info.src_rect;
	dc_plane_state->dst_rect = scaling_info.dst_rect;
	dc_plane_state->clip_rect = scaling_info.clip_rect;
	dc_plane_state->scaling_quality = scaling_info.scaling_quality;
5621

5622
	force_disable_dcc = adev->asic_type == CHIP_RAVEN && adev->in_suspend;
5623
	ret = fill_dc_plane_info_and_addr(adev, plane_state,
5624
					  afb->tiling_flags,
5625
					  &plane_info,
5626
					  &dc_plane_state->address,
5627
					  afb->tmz_surface,
5628
					  force_disable_dcc);
5629 5630 5631
	if (ret)
		return ret;

5632 5633 5634 5635 5636 5637 5638 5639 5640 5641 5642 5643 5644
	dc_plane_state->format = plane_info.format;
	dc_plane_state->color_space = plane_info.color_space;
	dc_plane_state->format = plane_info.format;
	dc_plane_state->plane_size = plane_info.plane_size;
	dc_plane_state->rotation = plane_info.rotation;
	dc_plane_state->horizontal_mirror = plane_info.horizontal_mirror;
	dc_plane_state->stereo_format = plane_info.stereo_format;
	dc_plane_state->tiling_info = plane_info.tiling_info;
	dc_plane_state->visible = plane_info.visible;
	dc_plane_state->per_pixel_alpha = plane_info.per_pixel_alpha;
	dc_plane_state->global_alpha = plane_info.global_alpha;
	dc_plane_state->global_alpha_value = plane_info.global_alpha_value;
	dc_plane_state->dcc = plane_info.dcc;
5645
	dc_plane_state->layer_index = plane_info.layer_index; // Always returns 0
5646
	dc_plane_state->flip_int_enabled = true;
5647

5648 5649 5650 5651
	/*
	 * Always set input transfer function, since plane state is refreshed
	 * every time.
	 */
5652 5653 5654
	ret = amdgpu_dm_update_plane_color_mgmt(dm_crtc_state, dc_plane_state);
	if (ret)
		return ret;
5655

5656
	return 0;
5657 5658
}

5659 5660 5661
static void update_stream_scaling_settings(const struct drm_display_mode *mode,
					   const struct dm_connector_state *dm_state,
					   struct dc_stream_state *stream)
5662 5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673 5674 5675 5676 5677
{
	enum amdgpu_rmx_type rmx_type;

	struct rect src = { 0 }; /* viewport in composition space*/
	struct rect dst = { 0 }; /* stream addressable area */

	/* no mode. nothing to be done */
	if (!mode)
		return;

	/* Full screen scaling by default */
	src.width = mode->hdisplay;
	src.height = mode->vdisplay;
	dst.width = stream->timing.h_addressable;
	dst.height = stream->timing.v_addressable;

5678 5679 5680 5681 5682 5683 5684 5685 5686 5687 5688 5689 5690 5691 5692
	if (dm_state) {
		rmx_type = dm_state->scaling;
		if (rmx_type == RMX_ASPECT || rmx_type == RMX_OFF) {
			if (src.width * dst.height <
					src.height * dst.width) {
				/* height needs less upscaling/more downscaling */
				dst.width = src.width *
						dst.height / src.height;
			} else {
				/* width needs less upscaling/more downscaling */
				dst.height = src.height *
						dst.width / src.width;
			}
		} else if (rmx_type == RMX_CENTER) {
			dst = src;
5693 5694
		}

5695 5696
		dst.x = (stream->timing.h_addressable - dst.width) / 2;
		dst.y = (stream->timing.v_addressable - dst.height) / 2;
5697

5698 5699 5700 5701 5702 5703
		if (dm_state->underscan_enable) {
			dst.x += dm_state->underscan_hborder / 2;
			dst.y += dm_state->underscan_vborder / 2;
			dst.width -= dm_state->underscan_hborder;
			dst.height -= dm_state->underscan_vborder;
		}
5704 5705 5706 5707 5708
	}

	stream->src = src;
	stream->dst = dst;

5709 5710
	DRM_DEBUG_KMS("Destination Rectangle x:%d  y:%d  width:%d  height:%d\n",
		      dst.x, dst.y, dst.width, dst.height);
5711 5712 5713

}

5714
static enum dc_color_depth
5715
convert_color_depth_from_display_info(const struct drm_connector *connector,
5716
				      bool is_y420, int requested_bpc)
5717
{
5718
	uint8_t bpc;
5719

5720 5721 5722 5723 5724 5725 5726 5727 5728 5729 5730 5731 5732 5733 5734
	if (is_y420) {
		bpc = 8;

		/* Cap display bpc based on HDMI 2.0 HF-VSDB */
		if (connector->display_info.hdmi.y420_dc_modes & DRM_EDID_YCBCR420_DC_48)
			bpc = 16;
		else if (connector->display_info.hdmi.y420_dc_modes & DRM_EDID_YCBCR420_DC_36)
			bpc = 12;
		else if (connector->display_info.hdmi.y420_dc_modes & DRM_EDID_YCBCR420_DC_30)
			bpc = 10;
	} else {
		bpc = (uint8_t)connector->display_info.bpc;
		/* Assume 8 bpc by default if no bpc is specified. */
		bpc = bpc ? bpc : 8;
	}
5735

5736
	if (requested_bpc > 0) {
5737 5738 5739 5740 5741 5742 5743 5744
		/*
		 * Cap display bpc based on the user requested value.
		 *
		 * The value for state->max_bpc may not correctly updated
		 * depending on when the connector gets added to the state
		 * or if this was called outside of atomic check, so it
		 * can't be used directly.
		 */
5745
		bpc = min_t(u8, bpc, requested_bpc);
5746

5747 5748 5749
		/* Round down to the nearest even number. */
		bpc = bpc - (bpc & 1);
	}
5750

5751 5752
	switch (bpc) {
	case 0:
5753 5754
		/*
		 * Temporary Work around, DRM doesn't parse color depth for
5755 5756 5757 5758 5759 5760 5761 5762 5763 5764 5765 5766 5767 5768 5769 5770 5771 5772 5773 5774 5775
		 * EDID revision before 1.4
		 * TODO: Fix edid parsing
		 */
		return COLOR_DEPTH_888;
	case 6:
		return COLOR_DEPTH_666;
	case 8:
		return COLOR_DEPTH_888;
	case 10:
		return COLOR_DEPTH_101010;
	case 12:
		return COLOR_DEPTH_121212;
	case 14:
		return COLOR_DEPTH_141414;
	case 16:
		return COLOR_DEPTH_161616;
	default:
		return COLOR_DEPTH_UNDEFINED;
	}
}

5776 5777
static enum dc_aspect_ratio
get_aspect_ratio(const struct drm_display_mode *mode_in)
5778
{
5779 5780
	/* 1-1 mapping, since both enums follow the HDMI spec. */
	return (enum dc_aspect_ratio) mode_in->picture_aspect_ratio;
5781 5782
}

5783 5784
static enum dc_color_space
get_output_color_space(const struct dc_crtc_timing *dc_crtc_timing)
5785 5786 5787 5788 5789 5790 5791 5792 5793 5794 5795 5796 5797
{
	enum dc_color_space color_space = COLOR_SPACE_SRGB;

	switch (dc_crtc_timing->pixel_encoding)	{
	case PIXEL_ENCODING_YCBCR422:
	case PIXEL_ENCODING_YCBCR444:
	case PIXEL_ENCODING_YCBCR420:
	{
		/*
		 * 27030khz is the separation point between HDTV and SDTV
		 * according to HDMI spec, we use YCbCr709 and YCbCr601
		 * respectively
		 */
5798
		if (dc_crtc_timing->pix_clk_100hz > 270300) {
5799 5800 5801 5802 5803 5804 5805 5806 5807 5808 5809 5810 5811 5812 5813 5814 5815 5816 5817 5818 5819 5820 5821 5822 5823 5824 5825
			if (dc_crtc_timing->flags.Y_ONLY)
				color_space =
					COLOR_SPACE_YCBCR709_LIMITED;
			else
				color_space = COLOR_SPACE_YCBCR709;
		} else {
			if (dc_crtc_timing->flags.Y_ONLY)
				color_space =
					COLOR_SPACE_YCBCR601_LIMITED;
			else
				color_space = COLOR_SPACE_YCBCR601;
		}

	}
	break;
	case PIXEL_ENCODING_RGB:
		color_space = COLOR_SPACE_SRGB;
		break;

	default:
		WARN_ON(1);
		break;
	}

	return color_space;
}

5826 5827 5828
static bool adjust_colour_depth_from_display_info(
	struct dc_crtc_timing *timing_out,
	const struct drm_display_info *info)
5829
{
5830
	enum dc_color_depth depth = timing_out->display_color_depth;
5831 5832
	int normalized_clk;
	do {
5833
		normalized_clk = timing_out->pix_clk_100hz / 10;
5834 5835 5836 5837
		/* YCbCr 4:2:0 requires additional adjustment of 1/2 */
		if (timing_out->pixel_encoding == PIXEL_ENCODING_YCBCR420)
			normalized_clk /= 2;
		/* Adjusting pix clock following on HDMI spec based on colour depth */
5838 5839 5840
		switch (depth) {
		case COLOR_DEPTH_888:
			break;
5841 5842 5843 5844 5845 5846 5847 5848 5849 5850
		case COLOR_DEPTH_101010:
			normalized_clk = (normalized_clk * 30) / 24;
			break;
		case COLOR_DEPTH_121212:
			normalized_clk = (normalized_clk * 36) / 24;
			break;
		case COLOR_DEPTH_161616:
			normalized_clk = (normalized_clk * 48) / 24;
			break;
		default:
5851 5852
			/* The above depths are the only ones valid for HDMI. */
			return false;
5853
		}
5854 5855 5856 5857 5858 5859
		if (normalized_clk <= info->max_tmds_clock) {
			timing_out->display_color_depth = depth;
			return true;
		}
	} while (--depth > COLOR_DEPTH_666);
	return false;
5860
}
5861

5862 5863 5864 5865 5866
static void fill_stream_properties_from_drm_display_mode(
	struct dc_stream_state *stream,
	const struct drm_display_mode *mode_in,
	const struct drm_connector *connector,
	const struct drm_connector_state *connector_state,
5867 5868
	const struct dc_stream_state *old_stream,
	int requested_bpc)
5869 5870
{
	struct dc_crtc_timing *timing_out = &stream->timing;
5871
	const struct drm_display_info *info = &connector->display_info;
5872
	struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);
5873 5874
	struct hdmi_vendor_infoframe hv_frame;
	struct hdmi_avi_infoframe avi_frame;
5875

5876 5877 5878
	memset(&hv_frame, 0, sizeof(hv_frame));
	memset(&avi_frame, 0, sizeof(avi_frame));

5879 5880 5881 5882 5883
	timing_out->h_border_left = 0;
	timing_out->h_border_right = 0;
	timing_out->v_border_top = 0;
	timing_out->v_border_bottom = 0;
	/* TODO: un-hardcode */
5884
	if (drm_mode_is_420_only(info, mode_in)
5885
			&& stream->signal == SIGNAL_TYPE_HDMI_TYPE_A)
5886
		timing_out->pixel_encoding = PIXEL_ENCODING_YCBCR420;
5887 5888 5889
	else if (drm_mode_is_420_also(info, mode_in)
			&& aconnector->force_yuv420_output)
		timing_out->pixel_encoding = PIXEL_ENCODING_YCBCR420;
5890
	else if ((connector->display_info.color_formats & DRM_COLOR_FORMAT_YCBCR444)
5891
			&& stream->signal == SIGNAL_TYPE_HDMI_TYPE_A)
5892 5893 5894 5895 5896 5897
		timing_out->pixel_encoding = PIXEL_ENCODING_YCBCR444;
	else
		timing_out->pixel_encoding = PIXEL_ENCODING_RGB;

	timing_out->timing_3d_format = TIMING_3D_FORMAT_NONE;
	timing_out->display_color_depth = convert_color_depth_from_display_info(
5898 5899 5900
		connector,
		(timing_out->pixel_encoding == PIXEL_ENCODING_YCBCR420),
		requested_bpc);
5901 5902
	timing_out->scan_type = SCANNING_TYPE_NODATA;
	timing_out->hdmi_vic = 0;
5903 5904 5905 5906 5907 5908 5909 5910 5911 5912 5913 5914

	if(old_stream) {
		timing_out->vic = old_stream->timing.vic;
		timing_out->flags.HSYNC_POSITIVE_POLARITY = old_stream->timing.flags.HSYNC_POSITIVE_POLARITY;
		timing_out->flags.VSYNC_POSITIVE_POLARITY = old_stream->timing.flags.VSYNC_POSITIVE_POLARITY;
	} else {
		timing_out->vic = drm_match_cea_mode(mode_in);
		if (mode_in->flags & DRM_MODE_FLAG_PHSYNC)
			timing_out->flags.HSYNC_POSITIVE_POLARITY = 1;
		if (mode_in->flags & DRM_MODE_FLAG_PVSYNC)
			timing_out->flags.VSYNC_POSITIVE_POLARITY = 1;
	}
5915

5916 5917 5918 5919 5920 5921 5922
	if (stream->signal == SIGNAL_TYPE_HDMI_TYPE_A) {
		drm_hdmi_avi_infoframe_from_display_mode(&avi_frame, (struct drm_connector *)connector, mode_in);
		timing_out->vic = avi_frame.video_code;
		drm_hdmi_vendor_infoframe_from_display_mode(&hv_frame, (struct drm_connector *)connector, mode_in);
		timing_out->hdmi_vic = hv_frame.vic;
	}

5923 5924 5925 5926 5927 5928 5929 5930 5931 5932 5933 5934 5935 5936 5937 5938 5939 5940 5941 5942 5943
	if (is_freesync_video_mode(mode_in, aconnector)) {
		timing_out->h_addressable = mode_in->hdisplay;
		timing_out->h_total = mode_in->htotal;
		timing_out->h_sync_width = mode_in->hsync_end - mode_in->hsync_start;
		timing_out->h_front_porch = mode_in->hsync_start - mode_in->hdisplay;
		timing_out->v_total = mode_in->vtotal;
		timing_out->v_addressable = mode_in->vdisplay;
		timing_out->v_front_porch = mode_in->vsync_start - mode_in->vdisplay;
		timing_out->v_sync_width = mode_in->vsync_end - mode_in->vsync_start;
		timing_out->pix_clk_100hz = mode_in->clock * 10;
	} else {
		timing_out->h_addressable = mode_in->crtc_hdisplay;
		timing_out->h_total = mode_in->crtc_htotal;
		timing_out->h_sync_width = mode_in->crtc_hsync_end - mode_in->crtc_hsync_start;
		timing_out->h_front_porch = mode_in->crtc_hsync_start - mode_in->crtc_hdisplay;
		timing_out->v_total = mode_in->crtc_vtotal;
		timing_out->v_addressable = mode_in->crtc_vdisplay;
		timing_out->v_front_porch = mode_in->crtc_vsync_start - mode_in->crtc_vdisplay;
		timing_out->v_sync_width = mode_in->crtc_vsync_end - mode_in->crtc_vsync_start;
		timing_out->pix_clk_100hz = mode_in->crtc_clock * 10;
	}
5944

5945 5946 5947 5948
	timing_out->aspect_ratio = get_aspect_ratio(mode_in);

	stream->output_color_space = get_output_color_space(timing_out);

5949 5950
	stream->out_transfer_func->type = TF_TYPE_PREDEFINED;
	stream->out_transfer_func->tf = TRANSFER_FUNCTION_SRGB;
5951 5952 5953 5954 5955 5956 5957 5958
	if (stream->signal == SIGNAL_TYPE_HDMI_TYPE_A) {
		if (!adjust_colour_depth_from_display_info(timing_out, info) &&
		    drm_mode_is_420_also(info, mode_in) &&
		    timing_out->pixel_encoding != PIXEL_ENCODING_YCBCR420) {
			timing_out->pixel_encoding = PIXEL_ENCODING_YCBCR420;
			adjust_colour_depth_from_display_info(timing_out, info);
		}
	}
5959 5960
}

5961 5962 5963
static void fill_audio_info(struct audio_info *audio_info,
			    const struct drm_connector *drm_connector,
			    const struct dc_sink *dc_sink)
5964 5965 5966 5967 5968 5969 5970 5971 5972 5973
{
	int i = 0;
	int cea_revision = 0;
	const struct dc_edid_caps *edid_caps = &dc_sink->edid_caps;

	audio_info->manufacture_id = edid_caps->manufacturer_id;
	audio_info->product_id = edid_caps->product_id;

	cea_revision = drm_connector->display_info.cea_rev;

5974
	strscpy(audio_info->display_name,
5975
		edid_caps->display_name,
5976
		AUDIO_INFO_DISPLAY_NAME_SIZE_IN_CHARS);
5977

5978
	if (cea_revision >= 3) {
5979 5980 5981 5982 5983 5984 5985 5986 5987 5988 5989 5990 5991 5992 5993 5994 5995 5996
		audio_info->mode_count = edid_caps->audio_mode_count;

		for (i = 0; i < audio_info->mode_count; ++i) {
			audio_info->modes[i].format_code =
					(enum audio_format_code)
					(edid_caps->audio_modes[i].format_code);
			audio_info->modes[i].channel_count =
					edid_caps->audio_modes[i].channel_count;
			audio_info->modes[i].sample_rates.all =
					edid_caps->audio_modes[i].sample_rate;
			audio_info->modes[i].sample_size =
					edid_caps->audio_modes[i].sample_size;
		}
	}

	audio_info->flags.all = edid_caps->speaker_flags;

	/* TODO: We only check for the progressive mode, check for interlace mode too */
5997
	if (drm_connector->latency_present[0]) {
5998 5999 6000 6001 6002 6003 6004 6005
		audio_info->video_latency = drm_connector->video_latency[0];
		audio_info->audio_latency = drm_connector->audio_latency[0];
	}

	/* TODO: For DP, video and audio latency should be calculated from DPCD caps */

}

6006 6007 6008
static void
copy_crtc_timing_for_drm_display_mode(const struct drm_display_mode *src_mode,
				      struct drm_display_mode *dst_mode)
6009 6010 6011 6012 6013 6014
{
	dst_mode->crtc_hdisplay = src_mode->crtc_hdisplay;
	dst_mode->crtc_vdisplay = src_mode->crtc_vdisplay;
	dst_mode->crtc_clock = src_mode->crtc_clock;
	dst_mode->crtc_hblank_start = src_mode->crtc_hblank_start;
	dst_mode->crtc_hblank_end = src_mode->crtc_hblank_end;
6015
	dst_mode->crtc_hsync_start =  src_mode->crtc_hsync_start;
6016 6017 6018 6019 6020 6021 6022 6023 6024 6025
	dst_mode->crtc_hsync_end = src_mode->crtc_hsync_end;
	dst_mode->crtc_htotal = src_mode->crtc_htotal;
	dst_mode->crtc_hskew = src_mode->crtc_hskew;
	dst_mode->crtc_vblank_start = src_mode->crtc_vblank_start;
	dst_mode->crtc_vblank_end = src_mode->crtc_vblank_end;
	dst_mode->crtc_vsync_start = src_mode->crtc_vsync_start;
	dst_mode->crtc_vsync_end = src_mode->crtc_vsync_end;
	dst_mode->crtc_vtotal = src_mode->crtc_vtotal;
}

6026 6027 6028 6029
static void
decide_crtc_timing_for_drm_display_mode(struct drm_display_mode *drm_mode,
					const struct drm_display_mode *native_mode,
					bool scale_enabled)
6030 6031 6032 6033 6034 6035 6036 6037 6038 6039 6040 6041
{
	if (scale_enabled) {
		copy_crtc_timing_for_drm_display_mode(native_mode, drm_mode);
	} else if (native_mode->clock == drm_mode->clock &&
			native_mode->htotal == drm_mode->htotal &&
			native_mode->vtotal == drm_mode->vtotal) {
		copy_crtc_timing_for_drm_display_mode(native_mode, drm_mode);
	} else {
		/* no scaling nor amdgpu inserted, no need to patch */
	}
}

6042 6043
static struct dc_sink *
create_fake_sink(struct amdgpu_dm_connector *aconnector)
6044 6045
{
	struct dc_sink_init_data sink_init_data = { 0 };
6046
	struct dc_sink *sink = NULL;
6047 6048 6049 6050
	sink_init_data.link = aconnector->dc_link;
	sink_init_data.sink_signal = aconnector->dc_link->connector_signal;

	sink = dc_sink_create(&sink_init_data);
6051
	if (!sink) {
6052
		DRM_ERROR("Failed to create sink!\n");
6053
		return NULL;
6054
	}
6055
	sink->sink_signal = SIGNAL_TYPE_VIRTUAL;
6056

6057
	return sink;
6058 6059
}

6060 6061 6062
static void set_multisync_trigger_params(
		struct dc_stream_state *stream)
{
6063 6064
	struct dc_stream_state *master = NULL;

6065
	if (stream->triggered_crtc_reset.enabled) {
6066 6067 6068 6069 6070
		master = stream->triggered_crtc_reset.event_source;
		stream->triggered_crtc_reset.event =
			master->timing.flags.VSYNC_POSITIVE_POLARITY ?
			CRTC_EVENT_VSYNC_RISING : CRTC_EVENT_VSYNC_FALLING;
		stream->triggered_crtc_reset.delay = TRIGGER_DELAY_NEXT_PIXEL;
6071 6072 6073 6074 6075 6076 6077 6078 6079 6080 6081 6082
	}
}

static void set_master_stream(struct dc_stream_state *stream_set[],
			      int stream_count)
{
	int j, highest_rfr = 0, master_stream = 0;

	for (j = 0;  j < stream_count; j++) {
		if (stream_set[j] && stream_set[j]->triggered_crtc_reset.enabled) {
			int refresh_rate = 0;

6083
			refresh_rate = (stream_set[j]->timing.pix_clk_100hz*100)/
6084 6085 6086 6087 6088 6089 6090 6091
				(stream_set[j]->timing.h_total*stream_set[j]->timing.v_total);
			if (refresh_rate > highest_rfr) {
				highest_rfr = refresh_rate;
				master_stream = j;
			}
		}
	}
	for (j = 0;  j < stream_count; j++) {
6092
		if (stream_set[j])
6093 6094 6095 6096 6097 6098 6099
			stream_set[j]->triggered_crtc_reset.event_source = stream_set[master_stream];
	}
}

static void dm_enable_per_frame_crtc_master_sync(struct dc_state *context)
{
	int i = 0;
6100
	struct dc_stream_state *stream;
6101 6102 6103 6104 6105 6106

	if (context->stream_count < 2)
		return;
	for (i = 0; i < context->stream_count ; i++) {
		if (!context->streams[i])
			continue;
6107 6108
		/*
		 * TODO: add a function to read AMD VSDB bits and set
6109
		 * crtc_sync_master.multi_sync_enabled flag
6110
		 * For now it's set to false
6111 6112
		 */
	}
6113

6114
	set_master_stream(context->streams, context->stream_count);
6115 6116 6117 6118 6119 6120 6121 6122 6123

	for (i = 0; i < context->stream_count ; i++) {
		stream = context->streams[i];

		if (!stream)
			continue;

		set_multisync_trigger_params(stream);
	}
6124 6125
}

6126
#if defined(CONFIG_DRM_AMD_DC_DCN)
6127 6128 6129 6130 6131
static void update_dsc_caps(struct amdgpu_dm_connector *aconnector,
							struct dc_sink *sink, struct dc_stream_state *stream,
							struct dsc_dec_dpcd_caps *dsc_caps)
{
	stream->timing.flags.DSC = 0;
6132
	dsc_caps->is_dsc_supported = false;
6133

6134 6135
	if (aconnector->dc_link && (sink->sink_signal == SIGNAL_TYPE_DISPLAY_PORT ||
		sink->sink_signal == SIGNAL_TYPE_EDP)) {
6136 6137 6138 6139 6140 6141
		if (sink->link->dpcd_caps.dongle_type == DISPLAY_DONGLE_NONE ||
			sink->link->dpcd_caps.dongle_type == DISPLAY_DONGLE_DP_HDMI_CONVERTER)
			dc_dsc_parse_dsc_dpcd(aconnector->dc_link->ctx->dc,
				aconnector->dc_link->dpcd_caps.dsc_caps.dsc_basic_caps.raw,
				aconnector->dc_link->dpcd_caps.dsc_caps.dsc_branch_decoder_caps.raw,
				dsc_caps);
6142 6143 6144
	}
}

6145 6146 6147 6148 6149 6150 6151 6152 6153 6154 6155 6156 6157 6158 6159 6160 6161 6162 6163 6164 6165 6166 6167 6168 6169 6170 6171 6172 6173 6174 6175 6176 6177 6178 6179 6180 6181 6182 6183 6184 6185 6186 6187 6188 6189 6190 6191 6192 6193 6194 6195 6196 6197 6198 6199 6200 6201 6202
static void apply_dsc_policy_for_edp(struct amdgpu_dm_connector *aconnector,
				    struct dc_sink *sink, struct dc_stream_state *stream,
				    struct dsc_dec_dpcd_caps *dsc_caps,
				    uint32_t max_dsc_target_bpp_limit_override)
{
	const struct dc_link_settings *verified_link_cap = NULL;
	uint32_t link_bw_in_kbps;
	uint32_t edp_min_bpp_x16, edp_max_bpp_x16;
	struct dc *dc = sink->ctx->dc;
	struct dc_dsc_bw_range bw_range = {0};
	struct dc_dsc_config dsc_cfg = {0};

	verified_link_cap = dc_link_get_link_cap(stream->link);
	link_bw_in_kbps = dc_link_bandwidth_kbps(stream->link, verified_link_cap);
	edp_min_bpp_x16 = 8 * 16;
	edp_max_bpp_x16 = 8 * 16;

	if (edp_max_bpp_x16 > dsc_caps->edp_max_bits_per_pixel)
		edp_max_bpp_x16 = dsc_caps->edp_max_bits_per_pixel;

	if (edp_max_bpp_x16 < edp_min_bpp_x16)
		edp_min_bpp_x16 = edp_max_bpp_x16;

	if (dc_dsc_compute_bandwidth_range(dc->res_pool->dscs[0],
				dc->debug.dsc_min_slice_height_override,
				edp_min_bpp_x16, edp_max_bpp_x16,
				dsc_caps,
				&stream->timing,
				&bw_range)) {

		if (bw_range.max_kbps < link_bw_in_kbps) {
			if (dc_dsc_compute_config(dc->res_pool->dscs[0],
					dsc_caps,
					dc->debug.dsc_min_slice_height_override,
					max_dsc_target_bpp_limit_override,
					0,
					&stream->timing,
					&dsc_cfg)) {
				stream->timing.dsc_cfg = dsc_cfg;
				stream->timing.flags.DSC = 1;
				stream->timing.dsc_cfg.bits_per_pixel = edp_max_bpp_x16;
			}
			return;
		}
	}

	if (dc_dsc_compute_config(dc->res_pool->dscs[0],
				dsc_caps,
				dc->debug.dsc_min_slice_height_override,
				max_dsc_target_bpp_limit_override,
				link_bw_in_kbps,
				&stream->timing,
				&dsc_cfg)) {
		stream->timing.dsc_cfg = dsc_cfg;
		stream->timing.flags.DSC = 1;
	}
}

6203 6204 6205 6206 6207 6208
static void apply_dsc_policy_for_stream(struct amdgpu_dm_connector *aconnector,
										struct dc_sink *sink, struct dc_stream_state *stream,
										struct dsc_dec_dpcd_caps *dsc_caps)
{
	struct drm_connector *drm_connector = &aconnector->base;
	uint32_t link_bandwidth_kbps;
6209
	uint32_t max_dsc_target_bpp_limit_override = 0;
6210
	struct dc *dc = sink->ctx->dc;
6211 6212
	uint32_t max_supported_bw_in_kbps, timing_bw_in_kbps;
	uint32_t dsc_max_supported_bw_in_kbps;
6213 6214 6215

	link_bandwidth_kbps = dc_link_bandwidth_kbps(aconnector->dc_link,
							dc_link_get_link_cap(aconnector->dc_link));
6216 6217 6218 6219

	if (stream->link && stream->link->local_sink)
		max_dsc_target_bpp_limit_override =
			stream->link->local_sink->edid_caps.panel_patch.max_dsc_target_bpp_limit;
6220

6221 6222 6223 6224
	/* Set DSC policy according to dsc_clock_en */
	dc_dsc_policy_set_enable_dsc_when_not_needed(
		aconnector->dsc_settings.dsc_force_enable == DSC_CLK_FORCE_ENABLE);

6225 6226 6227 6228 6229 6230
	if (aconnector->dc_link && sink->sink_signal == SIGNAL_TYPE_EDP && !dc->debug.disable_dsc_edp &&
	    dc->caps.edp_dsc_support && aconnector->dsc_settings.dsc_force_enable != DSC_CLK_FORCE_DISABLE) {

		apply_dsc_policy_for_edp(aconnector, sink, stream, dsc_caps, max_dsc_target_bpp_limit_override);

	} else if (aconnector->dc_link && sink->sink_signal == SIGNAL_TYPE_DISPLAY_PORT) {
6231 6232
		if (sink->link->dpcd_caps.dongle_type == DISPLAY_DONGLE_NONE) {
			if (dc_dsc_compute_config(aconnector->dc_link->ctx->dc->res_pool->dscs[0],
6233 6234
						dsc_caps,
						aconnector->dc_link->ctx->dc->debug.dsc_min_slice_height_override,
6235
						max_dsc_target_bpp_limit_override,
6236 6237 6238
						link_bandwidth_kbps,
						&stream->timing,
						&stream->timing.dsc_cfg)) {
6239 6240 6241 6242 6243 6244 6245 6246 6247 6248 6249 6250 6251 6252 6253 6254 6255 6256 6257 6258 6259 6260 6261
				stream->timing.flags.DSC = 1;
				DRM_DEBUG_DRIVER("%s: [%s] DSC is selected from SST RX\n",
								 __func__, drm_connector->name);
			}
		} else if (sink->link->dpcd_caps.dongle_type == DISPLAY_DONGLE_DP_HDMI_CONVERTER) {
			timing_bw_in_kbps = dc_bandwidth_in_kbps_from_timing(&stream->timing);
			max_supported_bw_in_kbps = link_bandwidth_kbps;
			dsc_max_supported_bw_in_kbps = link_bandwidth_kbps;

			if (timing_bw_in_kbps > max_supported_bw_in_kbps &&
					max_supported_bw_in_kbps > 0 &&
					dsc_max_supported_bw_in_kbps > 0)
				if (dc_dsc_compute_config(aconnector->dc_link->ctx->dc->res_pool->dscs[0],
						dsc_caps,
						aconnector->dc_link->ctx->dc->debug.dsc_min_slice_height_override,
						max_dsc_target_bpp_limit_override,
						dsc_max_supported_bw_in_kbps,
						&stream->timing,
						&stream->timing.dsc_cfg)) {
					stream->timing.flags.DSC = 1;
					DRM_DEBUG_DRIVER("%s: [%s] DSC is selected from DP-HDMI PCON\n",
									 __func__, drm_connector->name);
				}
6262 6263 6264 6265 6266 6267 6268 6269 6270 6271 6272 6273 6274 6275 6276 6277
		}
	}

	/* Overwrite the stream flag if DSC is enabled through debugfs */
	if (aconnector->dsc_settings.dsc_force_enable == DSC_CLK_FORCE_ENABLE)
		stream->timing.flags.DSC = 1;

	if (stream->timing.flags.DSC && aconnector->dsc_settings.dsc_num_slices_h)
		stream->timing.dsc_cfg.num_slices_h = aconnector->dsc_settings.dsc_num_slices_h;

	if (stream->timing.flags.DSC && aconnector->dsc_settings.dsc_num_slices_v)
		stream->timing.dsc_cfg.num_slices_v = aconnector->dsc_settings.dsc_num_slices_v;

	if (stream->timing.flags.DSC && aconnector->dsc_settings.dsc_bits_per_pixel)
		stream->timing.dsc_cfg.bits_per_pixel = aconnector->dsc_settings.dsc_bits_per_pixel;
}
6278
#endif /* CONFIG_DRM_AMD_DC_DCN */
6279

6280 6281 6282 6283 6284 6285 6286 6287 6288 6289 6290 6291 6292 6293 6294 6295
/**
 * DOC: FreeSync Video
 *
 * When a userspace application wants to play a video, the content follows a
 * standard format definition that usually specifies the FPS for that format.
 * The below list illustrates some video format and the expected FPS,
 * respectively:
 *
 * - TV/NTSC (23.976 FPS)
 * - Cinema (24 FPS)
 * - TV/PAL (25 FPS)
 * - TV/NTSC (29.97 FPS)
 * - TV/NTSC (30 FPS)
 * - Cinema HFR (48 FPS)
 * - TV/PAL (50 FPS)
 * - Commonly used (60 FPS)
6296
 * - Multiples of 24 (48,72,96,120 FPS)
6297 6298 6299 6300 6301 6302 6303 6304 6305 6306 6307 6308 6309
 *
 * The list of standards video format is not huge and can be added to the
 * connector modeset list beforehand. With that, userspace can leverage
 * FreeSync to extends the front porch in order to attain the target refresh
 * rate. Such a switch will happen seamlessly, without screen blanking or
 * reprogramming of the output in any other way. If the userspace requests a
 * modesetting change compatible with FreeSync modes that only differ in the
 * refresh rate, DC will skip the full update and avoid blink during the
 * transition. For example, the video player can change the modesetting from
 * 60Hz to 30Hz for playing TV/NTSC content when it goes full screen without
 * causing any display blink. This same concept can be applied to a mode
 * setting change.
 */
6310 6311 6312 6313 6314 6315 6316 6317 6318 6319 6320 6321 6322 6323 6324 6325 6326 6327 6328 6329 6330 6331 6332 6333 6334 6335 6336 6337 6338 6339 6340 6341 6342 6343 6344 6345 6346 6347 6348 6349 6350 6351 6352 6353 6354 6355 6356 6357 6358 6359 6360 6361 6362
static struct drm_display_mode *
get_highest_refresh_rate_mode(struct amdgpu_dm_connector *aconnector,
			  bool use_probed_modes)
{
	struct drm_display_mode *m, *m_pref = NULL;
	u16 current_refresh, highest_refresh;
	struct list_head *list_head = use_probed_modes ?
						    &aconnector->base.probed_modes :
						    &aconnector->base.modes;

	if (aconnector->freesync_vid_base.clock != 0)
		return &aconnector->freesync_vid_base;

	/* Find the preferred mode */
	list_for_each_entry (m, list_head, head) {
		if (m->type & DRM_MODE_TYPE_PREFERRED) {
			m_pref = m;
			break;
		}
	}

	if (!m_pref) {
		/* Probably an EDID with no preferred mode. Fallback to first entry */
		m_pref = list_first_entry_or_null(
			&aconnector->base.modes, struct drm_display_mode, head);
		if (!m_pref) {
			DRM_DEBUG_DRIVER("No preferred mode found in EDID\n");
			return NULL;
		}
	}

	highest_refresh = drm_mode_vrefresh(m_pref);

	/*
	 * Find the mode with highest refresh rate with same resolution.
	 * For some monitors, preferred mode is not the mode with highest
	 * supported refresh rate.
	 */
	list_for_each_entry (m, list_head, head) {
		current_refresh  = drm_mode_vrefresh(m);

		if (m->hdisplay == m_pref->hdisplay &&
		    m->vdisplay == m_pref->vdisplay &&
		    highest_refresh < current_refresh) {
			highest_refresh = current_refresh;
			m_pref = m;
		}
	}

	aconnector->freesync_vid_base = *m_pref;
	return m_pref;
}

6363
static bool is_freesync_video_mode(const struct drm_display_mode *mode,
6364 6365 6366 6367 6368 6369 6370 6371 6372 6373 6374 6375 6376 6377 6378 6379 6380 6381 6382 6383 6384 6385 6386 6387 6388 6389
				   struct amdgpu_dm_connector *aconnector)
{
	struct drm_display_mode *high_mode;
	int timing_diff;

	high_mode = get_highest_refresh_rate_mode(aconnector, false);
	if (!high_mode || !mode)
		return false;

	timing_diff = high_mode->vtotal - mode->vtotal;

	if (high_mode->clock == 0 || high_mode->clock != mode->clock ||
	    high_mode->hdisplay != mode->hdisplay ||
	    high_mode->vdisplay != mode->vdisplay ||
	    high_mode->hsync_start != mode->hsync_start ||
	    high_mode->hsync_end != mode->hsync_end ||
	    high_mode->htotal != mode->htotal ||
	    high_mode->hskew != mode->hskew ||
	    high_mode->vscan != mode->vscan ||
	    high_mode->vsync_start - mode->vsync_start != timing_diff ||
	    high_mode->vsync_end - mode->vsync_end != timing_diff)
		return false;
	else
		return true;
}

6390
static struct dc_stream_state *
6391 6392
create_stream_for_sink(struct amdgpu_dm_connector *aconnector,
		       const struct drm_display_mode *drm_mode,
6393
		       const struct dm_connector_state *dm_state,
6394 6395
		       const struct dc_stream_state *old_stream,
		       int requested_bpc)
6396 6397
{
	struct drm_display_mode *preferred_mode = NULL;
6398
	struct drm_connector *drm_connector;
6399 6400
	const struct drm_connector_state *con_state =
		dm_state ? &dm_state->base : NULL;
6401
	struct dc_stream_state *stream = NULL;
6402
	struct drm_display_mode mode = *drm_mode;
6403 6404
	struct drm_display_mode saved_mode;
	struct drm_display_mode *freesync_mode = NULL;
6405
	bool native_mode_found = false;
6406 6407
	bool recalculate_timing = false;
	bool scale = dm_state ? (dm_state->scaling != RMX_OFF) : false;
6408
	int mode_refresh;
6409
	int preferred_refresh = 0;
6410
#if defined(CONFIG_DRM_AMD_DC_DCN)
6411
	struct dsc_dec_dpcd_caps dsc_caps;
6412
#endif
6413
	struct dc_sink *sink = NULL;
6414 6415 6416

	memset(&saved_mode, 0, sizeof(saved_mode));

6417
	if (aconnector == NULL) {
6418
		DRM_ERROR("aconnector is NULL!\n");
6419
		return stream;
6420 6421 6422
	}

	drm_connector = &aconnector->base;
6423

6424
	if (!aconnector->dc_sink) {
6425 6426 6427
		sink = create_fake_sink(aconnector);
		if (!sink)
			return stream;
6428 6429
	} else {
		sink = aconnector->dc_sink;
6430
		dc_sink_retain(sink);
6431
	}
6432

6433
	stream = dc_create_stream_for_sink(sink);
6434

6435
	if (stream == NULL) {
6436
		DRM_ERROR("Failed to create stream for sink!\n");
6437
		goto finish;
6438 6439
	}

6440 6441
	stream->dm_stream_context = aconnector;

6442 6443 6444
	stream->timing.flags.LTE_340MCSC_SCRAMBLE =
		drm_connector->display_info.hdmi.scdc.scrambling.low_rates;

6445 6446 6447 6448 6449 6450 6451 6452 6453 6454 6455 6456 6457
	list_for_each_entry(preferred_mode, &aconnector->base.modes, head) {
		/* Search for preferred mode */
		if (preferred_mode->type & DRM_MODE_TYPE_PREFERRED) {
			native_mode_found = true;
			break;
		}
	}
	if (!native_mode_found)
		preferred_mode = list_first_entry_or_null(
				&aconnector->base.modes,
				struct drm_display_mode,
				head);

6458 6459
	mode_refresh = drm_mode_vrefresh(&mode);

6460
	if (preferred_mode == NULL) {
6461 6462
		/*
		 * This may not be an error, the use case is when we have no
6463 6464 6465 6466
		 * usermode calls to reset and set mode upon hotplug. In this
		 * case, we call set mode ourselves to restore the previous mode
		 * and the modelist may not be filled in in time.
		 */
6467
		DRM_DEBUG_DRIVER("No preferred mode found\n");
6468
	} else {
6469
		recalculate_timing = is_freesync_video_mode(&mode, aconnector);
6470 6471 6472 6473 6474 6475
		if (recalculate_timing) {
			freesync_mode = get_highest_refresh_rate_mode(aconnector, false);
			saved_mode = mode;
			mode = *freesync_mode;
		} else {
			decide_crtc_timing_for_drm_display_mode(
6476
				&mode, preferred_mode, scale);
6477

6478 6479
			preferred_refresh = drm_mode_vrefresh(preferred_mode);
		}
6480 6481
	}

6482 6483
	if (recalculate_timing)
		drm_mode_set_crtcinfo(&saved_mode, 0);
6484
	else if (!dm_state)
6485 6486
		drm_mode_set_crtcinfo(&mode, 0);

6487
       /*
6488 6489 6490
	* If scaling is enabled and refresh rate didn't change
	* we copy the vic and polarities of the old timings
	*/
6491
	if (!scale || mode_refresh != preferred_refresh)
6492 6493 6494
		fill_stream_properties_from_drm_display_mode(
			stream, &mode, &aconnector->base, con_state, NULL,
			requested_bpc);
6495
	else
6496 6497 6498
		fill_stream_properties_from_drm_display_mode(
			stream, &mode, &aconnector->base, con_state, old_stream,
			requested_bpc);
6499

6500
#if defined(CONFIG_DRM_AMD_DC_DCN)
6501 6502 6503 6504
	/* SST DSC determination policy */
	update_dsc_caps(aconnector, sink, stream, &dsc_caps);
	if (aconnector->dsc_settings.dsc_force_enable != DSC_CLK_FORCE_DISABLE && dsc_caps.is_dsc_supported)
		apply_dsc_policy_for_stream(aconnector, sink, stream, &dsc_caps);
6505 6506
#endif

6507 6508 6509 6510 6511
	update_stream_scaling_settings(&mode, dm_state, stream);

	fill_audio_info(
		&stream->audio_info,
		drm_connector,
6512
		sink);
6513

6514
	update_stream_signal(stream, sink);
6515

6516
	if (stream->signal == SIGNAL_TYPE_HDMI_TYPE_A)
6517 6518
		mod_build_hf_vsif_infopacket(stream, &stream->vsp_infopacket);

6519 6520 6521 6522 6523 6524 6525 6526 6527 6528 6529 6530
	if (stream->link->psr_settings.psr_feature_enabled) {
		//
		// should decide stream support vsc sdp colorimetry capability
		// before building vsc info packet
		//
		stream->use_vsc_sdp_for_colorimetry = false;
		if (aconnector->dc_sink->sink_signal == SIGNAL_TYPE_DISPLAY_PORT_MST) {
			stream->use_vsc_sdp_for_colorimetry =
				aconnector->dc_sink->is_vsc_sdp_colorimetry_supported;
		} else {
			if (stream->link->dpcd_caps.dprx_feature.bits.VSC_SDP_COLORIMETRY_SUPPORTED)
				stream->use_vsc_sdp_for_colorimetry = true;
R
Roman Li 已提交
6531
		}
6532
		mod_build_vsc_infopacket(stream, &stream->vsc_infopacket, stream->output_color_space);
R
Roman Li 已提交
6533 6534
		aconnector->psr_skip_count = AMDGPU_DM_PSR_ENTRY_DELAY;

R
Roman Li 已提交
6535
	}
6536
finish:
6537
	dc_sink_release(sink);
6538

6539 6540 6541
	return stream;
}

6542
static void amdgpu_dm_crtc_destroy(struct drm_crtc *crtc)
6543 6544 6545 6546 6547 6548
{
	drm_crtc_cleanup(crtc);
	kfree(crtc);
}

static void dm_crtc_destroy_state(struct drm_crtc *crtc,
6549
				  struct drm_crtc_state *state)
6550 6551 6552 6553 6554 6555 6556 6557 6558 6559 6560 6561 6562 6563 6564 6565 6566 6567 6568 6569 6570 6571 6572 6573 6574
{
	struct dm_crtc_state *cur = to_dm_crtc_state(state);

	/* TODO Destroy dc_stream objects are stream object is flattened */
	if (cur->stream)
		dc_stream_release(cur->stream);


	__drm_atomic_helper_crtc_destroy_state(state);


	kfree(state);
}

static void dm_crtc_reset_state(struct drm_crtc *crtc)
{
	struct dm_crtc_state *state;

	if (crtc->state)
		dm_crtc_destroy_state(crtc, crtc->state);

	state = kzalloc(sizeof(*state), GFP_KERNEL);
	if (WARN_ON(!state))
		return;

6575
	__drm_atomic_helper_crtc_reset(crtc, &state->base);
6576 6577 6578 6579 6580 6581 6582 6583 6584 6585 6586 6587
}

static struct drm_crtc_state *
dm_crtc_duplicate_state(struct drm_crtc *crtc)
{
	struct dm_crtc_state *state, *cur;

	cur = to_dm_crtc_state(crtc->state);

	if (WARN_ON(!crtc->state))
		return NULL;

6588
	state = kzalloc(sizeof(*state), GFP_KERNEL);
6589 6590
	if (!state)
		return NULL;
6591 6592 6593 6594 6595 6596 6597 6598

	__drm_atomic_helper_crtc_duplicate_state(crtc, &state->base);

	if (cur->stream) {
		state->stream = cur->stream;
		dc_stream_retain(state->stream);
	}

6599
	state->active_planes = cur->active_planes;
6600
	state->vrr_infopacket = cur->vrr_infopacket;
6601
	state->abm_level = cur->abm_level;
6602 6603
	state->vrr_supported = cur->vrr_supported;
	state->freesync_config = cur->freesync_config;
6604 6605
	state->cm_has_degamma = cur->cm_has_degamma;
	state->cm_is_degamma_srgb = cur->cm_is_degamma_srgb;
6606
	state->force_dpms_off = cur->force_dpms_off;
6607 6608 6609 6610 6611
	/* TODO Duplicate dc_stream after objects are stream object is flattened */

	return &state->base;
}

6612
#ifdef CONFIG_DRM_AMD_SECURE_DISPLAY
6613
static int amdgpu_dm_crtc_late_register(struct drm_crtc *crtc)
6614 6615 6616 6617 6618 6619 6620
{
	crtc_debugfs_init(crtc);

	return 0;
}
#endif

6621 6622 6623 6624
static inline int dm_set_vupdate_irq(struct drm_crtc *crtc, bool enable)
{
	enum dc_irq_source irq_source;
	struct amdgpu_crtc *acrtc = to_amdgpu_crtc(crtc);
6625
	struct amdgpu_device *adev = drm_to_adev(crtc->dev);
6626 6627 6628 6629 6630 6631
	int rc;

	irq_source = IRQ_TYPE_VUPDATE + acrtc->otg_inst;

	rc = dc_interrupt_set(adev->dm.dc, irq_source, enable) ? 0 : -EBUSY;

6632 6633
	DRM_DEBUG_VBL("crtc %d - vupdate irq %sabling: r=%d\n",
		      acrtc->crtc_id, enable ? "en" : "dis", rc);
6634 6635
	return rc;
}
6636 6637 6638 6639 6640

static inline int dm_set_vblank(struct drm_crtc *crtc, bool enable)
{
	enum dc_irq_source irq_source;
	struct amdgpu_crtc *acrtc = to_amdgpu_crtc(crtc);
6641
	struct amdgpu_device *adev = drm_to_adev(crtc->dev);
6642
	struct dm_crtc_state *acrtc_state = to_dm_crtc_state(crtc->state);
6643
#if defined(CONFIG_DRM_AMD_DC_DCN)
6644
	struct amdgpu_display_manager *dm = &adev->dm;
6645
	struct vblank_control_work *work;
6646
#endif
6647 6648 6649 6650 6651 6652 6653 6654 6655 6656 6657 6658 6659
	int rc = 0;

	if (enable) {
		/* vblank irq on -> Only need vupdate irq in vrr mode */
		if (amdgpu_dm_vrr_active(acrtc_state))
			rc = dm_set_vupdate_irq(crtc, true);
	} else {
		/* vblank irq off -> vupdate irq off */
		rc = dm_set_vupdate_irq(crtc, false);
	}

	if (rc)
		return rc;
6660 6661

	irq_source = IRQ_TYPE_VBLANK + acrtc->otg_inst;
6662 6663 6664 6665

	if (!dc_interrupt_set(adev->dm.dc, irq_source, enable))
		return -EBUSY;

6666 6667 6668
	if (amdgpu_in_reset(adev))
		return 0;

6669
#if defined(CONFIG_DRM_AMD_DC_DCN)
6670 6671 6672 6673
	if (dm->vblank_control_workqueue) {
		work = kzalloc(sizeof(*work), GFP_ATOMIC);
		if (!work)
			return -ENOMEM;
6674

6675 6676 6677 6678
		INIT_WORK(&work->work, vblank_control_worker);
		work->dm = dm;
		work->acrtc = acrtc;
		work->enable = enable;
6679

6680 6681 6682 6683
		if (acrtc_state->stream) {
			dc_stream_retain(acrtc_state->stream);
			work->stream = acrtc_state->stream;
		}
6684

6685 6686
		queue_work(dm->vblank_control_workqueue, &work->work);
	}
6687
#endif
6688 6689

	return 0;
6690 6691 6692 6693 6694 6695 6696 6697 6698 6699 6700 6701
}

static int dm_enable_vblank(struct drm_crtc *crtc)
{
	return dm_set_vblank(crtc, true);
}

static void dm_disable_vblank(struct drm_crtc *crtc)
{
	dm_set_vblank(crtc, false);
}

6702 6703 6704 6705 6706 6707 6708 6709
/* Implemented only the options currently availible for the driver */
static const struct drm_crtc_funcs amdgpu_dm_crtc_funcs = {
	.reset = dm_crtc_reset_state,
	.destroy = amdgpu_dm_crtc_destroy,
	.set_config = drm_atomic_helper_set_config,
	.page_flip = drm_atomic_helper_page_flip,
	.atomic_duplicate_state = dm_crtc_duplicate_state,
	.atomic_destroy_state = dm_crtc_destroy_state,
6710
	.set_crc_source = amdgpu_dm_crtc_set_crc_source,
6711
	.verify_crc_source = amdgpu_dm_crtc_verify_crc_source,
6712
	.get_crc_sources = amdgpu_dm_crtc_get_crc_sources,
6713
	.get_vblank_counter = amdgpu_get_vblank_counter_kms,
6714 6715
	.enable_vblank = dm_enable_vblank,
	.disable_vblank = dm_disable_vblank,
6716
	.get_vblank_timestamp = drm_crtc_vblank_helper_get_vblank_timestamp,
6717 6718 6719
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
	.late_register = amdgpu_dm_crtc_late_register,
#endif
6720 6721 6722 6723 6724 6725
};

static enum drm_connector_status
amdgpu_dm_connector_detect(struct drm_connector *connector, bool force)
{
	bool connected;
6726
	struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);
6727

6728 6729
	/*
	 * Notes:
6730 6731
	 * 1. This interface is NOT called in context of HPD irq.
	 * 2. This interface *is called* in context of user-mode ioctl. Which
6732 6733
	 * makes it a bad place for *any* MST-related activity.
	 */
6734

6735 6736
	if (aconnector->base.force == DRM_FORCE_UNSPECIFIED &&
	    !aconnector->fake_enable)
6737 6738 6739 6740
		connected = (aconnector->dc_sink != NULL);
	else
		connected = (aconnector->base.force == DRM_FORCE_ON);

6741 6742
	update_subconnector_property(aconnector);

6743 6744 6745 6746
	return (connected ? connector_status_connected :
			connector_status_disconnected);
}

6747 6748 6749 6750
int amdgpu_dm_connector_atomic_set_property(struct drm_connector *connector,
					    struct drm_connector_state *connector_state,
					    struct drm_property *property,
					    uint64_t val)
6751 6752
{
	struct drm_device *dev = connector->dev;
6753
	struct amdgpu_device *adev = drm_to_adev(dev);
6754 6755 6756 6757 6758 6759 6760 6761 6762 6763 6764 6765 6766 6767 6768 6769 6770 6771 6772 6773 6774 6775 6776 6777 6778 6779 6780 6781 6782 6783 6784 6785 6786 6787 6788 6789 6790 6791 6792 6793
	struct dm_connector_state *dm_old_state =
		to_dm_connector_state(connector->state);
	struct dm_connector_state *dm_new_state =
		to_dm_connector_state(connector_state);

	int ret = -EINVAL;

	if (property == dev->mode_config.scaling_mode_property) {
		enum amdgpu_rmx_type rmx_type;

		switch (val) {
		case DRM_MODE_SCALE_CENTER:
			rmx_type = RMX_CENTER;
			break;
		case DRM_MODE_SCALE_ASPECT:
			rmx_type = RMX_ASPECT;
			break;
		case DRM_MODE_SCALE_FULLSCREEN:
			rmx_type = RMX_FULL;
			break;
		case DRM_MODE_SCALE_NONE:
		default:
			rmx_type = RMX_OFF;
			break;
		}

		if (dm_old_state->scaling == rmx_type)
			return 0;

		dm_new_state->scaling = rmx_type;
		ret = 0;
	} else if (property == adev->mode_info.underscan_hborder_property) {
		dm_new_state->underscan_hborder = val;
		ret = 0;
	} else if (property == adev->mode_info.underscan_vborder_property) {
		dm_new_state->underscan_vborder = val;
		ret = 0;
	} else if (property == adev->mode_info.underscan_property) {
		dm_new_state->underscan_enable = val;
		ret = 0;
6794 6795 6796
	} else if (property == adev->mode_info.abm_level_property) {
		dm_new_state->abm_level = val;
		ret = 0;
6797 6798 6799 6800 6801
	}

	return ret;
}

6802 6803 6804 6805
int amdgpu_dm_connector_atomic_get_property(struct drm_connector *connector,
					    const struct drm_connector_state *state,
					    struct drm_property *property,
					    uint64_t *val)
6806 6807
{
	struct drm_device *dev = connector->dev;
6808
	struct amdgpu_device *adev = drm_to_adev(dev);
6809 6810 6811 6812 6813 6814 6815 6816 6817 6818 6819 6820 6821 6822 6823 6824 6825 6826 6827 6828 6829 6830 6831 6832 6833 6834 6835 6836 6837 6838
	struct dm_connector_state *dm_state =
		to_dm_connector_state(state);
	int ret = -EINVAL;

	if (property == dev->mode_config.scaling_mode_property) {
		switch (dm_state->scaling) {
		case RMX_CENTER:
			*val = DRM_MODE_SCALE_CENTER;
			break;
		case RMX_ASPECT:
			*val = DRM_MODE_SCALE_ASPECT;
			break;
		case RMX_FULL:
			*val = DRM_MODE_SCALE_FULLSCREEN;
			break;
		case RMX_OFF:
		default:
			*val = DRM_MODE_SCALE_NONE;
			break;
		}
		ret = 0;
	} else if (property == adev->mode_info.underscan_hborder_property) {
		*val = dm_state->underscan_hborder;
		ret = 0;
	} else if (property == adev->mode_info.underscan_vborder_property) {
		*val = dm_state->underscan_vborder;
		ret = 0;
	} else if (property == adev->mode_info.underscan_property) {
		*val = dm_state->underscan_enable;
		ret = 0;
6839 6840 6841
	} else if (property == adev->mode_info.abm_level_property) {
		*val = dm_state->abm_level;
		ret = 0;
6842
	}
6843

6844 6845 6846
	return ret;
}

6847 6848 6849 6850 6851 6852 6853
static void amdgpu_dm_connector_unregister(struct drm_connector *connector)
{
	struct amdgpu_dm_connector *amdgpu_dm_connector = to_amdgpu_dm_connector(connector);

	drm_dp_aux_unregister(&amdgpu_dm_connector->dm_dp_aux.aux);
}

6854
static void amdgpu_dm_connector_destroy(struct drm_connector *connector)
6855
{
6856
	struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);
6857
	const struct dc_link *link = aconnector->dc_link;
6858
	struct amdgpu_device *adev = drm_to_adev(connector->dev);
6859
	struct amdgpu_display_manager *dm = &adev->dm;
6860
	int i;
6861

6862 6863 6864 6865 6866 6867 6868
	/*
	 * Call only if mst_mgr was iniitalized before since it's not done
	 * for all connector types.
	 */
	if (aconnector->mst_mgr.dev)
		drm_dp_mst_topology_mgr_destroy(&aconnector->mst_mgr);

6869 6870
#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) ||\
	defined(CONFIG_BACKLIGHT_CLASS_DEVICE_MODULE)
6871 6872 6873 6874 6875
	for (i = 0; i < dm->num_of_edps; i++) {
		if ((link == dm->backlight_link[i]) && dm->backlight_dev[i]) {
			backlight_device_unregister(dm->backlight_dev[i]);
			dm->backlight_dev[i] = NULL;
		}
6876 6877
	}
#endif
6878 6879 6880 6881 6882 6883 6884 6885

	if (aconnector->dc_em_sink)
		dc_sink_release(aconnector->dc_em_sink);
	aconnector->dc_em_sink = NULL;
	if (aconnector->dc_sink)
		dc_sink_release(aconnector->dc_sink);
	aconnector->dc_sink = NULL;

6886
	drm_dp_cec_unregister_connector(&aconnector->dm_dp_aux.aux);
6887 6888
	drm_connector_unregister(connector);
	drm_connector_cleanup(connector);
6889 6890 6891 6892
	if (aconnector->i2c) {
		i2c_del_adapter(&aconnector->i2c->base);
		kfree(aconnector->i2c);
	}
6893
	kfree(aconnector->dm_dp_aux.aux.name);
6894

6895 6896 6897 6898 6899 6900 6901 6902
	kfree(connector);
}

void amdgpu_dm_connector_funcs_reset(struct drm_connector *connector)
{
	struct dm_connector_state *state =
		to_dm_connector_state(connector->state);

6903 6904 6905
	if (connector->state)
		__drm_atomic_helper_connector_destroy_state(connector->state);

6906 6907 6908 6909 6910 6911 6912 6913 6914
	kfree(state);

	state = kzalloc(sizeof(*state), GFP_KERNEL);

	if (state) {
		state->scaling = RMX_OFF;
		state->underscan_enable = false;
		state->underscan_hborder = 0;
		state->underscan_vborder = 0;
6915
		state->base.max_requested_bpc = 8;
6916 6917
		state->vcpi_slots = 0;
		state->pbn = 0;
6918 6919 6920
		if (connector->connector_type == DRM_MODE_CONNECTOR_eDP)
			state->abm_level = amdgpu_dm_abm_level;

6921
		__drm_atomic_helper_connector_reset(connector, &state->base);
6922 6923 6924
	}
}

6925 6926
struct drm_connector_state *
amdgpu_dm_connector_atomic_duplicate_state(struct drm_connector *connector)
6927 6928 6929 6930 6931 6932 6933
{
	struct dm_connector_state *state =
		to_dm_connector_state(connector->state);

	struct dm_connector_state *new_state =
			kmemdup(state, sizeof(*state), GFP_KERNEL);

6934 6935
	if (!new_state)
		return NULL;
6936

6937 6938 6939
	__drm_atomic_helper_connector_duplicate_state(connector, &new_state->base);

	new_state->freesync_capable = state->freesync_capable;
6940
	new_state->abm_level = state->abm_level;
6941 6942 6943 6944
	new_state->scaling = state->scaling;
	new_state->underscan_enable = state->underscan_enable;
	new_state->underscan_hborder = state->underscan_hborder;
	new_state->underscan_vborder = state->underscan_vborder;
6945 6946
	new_state->vcpi_slots = state->vcpi_slots;
	new_state->pbn = state->pbn;
6947
	return &new_state->base;
6948 6949
}

6950 6951 6952 6953 6954
static int
amdgpu_dm_connector_late_register(struct drm_connector *connector)
{
	struct amdgpu_dm_connector *amdgpu_dm_connector =
		to_amdgpu_dm_connector(connector);
6955
	int r;
6956

6957 6958 6959 6960 6961 6962 6963 6964 6965
	if ((connector->connector_type == DRM_MODE_CONNECTOR_DisplayPort) ||
	    (connector->connector_type == DRM_MODE_CONNECTOR_eDP)) {
		amdgpu_dm_connector->dm_dp_aux.aux.dev = connector->kdev;
		r = drm_dp_aux_register(&amdgpu_dm_connector->dm_dp_aux.aux);
		if (r)
			return r;
	}

#if defined(CONFIG_DEBUG_FS)
6966 6967 6968 6969 6970 6971
	connector_debugfs_init(amdgpu_dm_connector);
#endif

	return 0;
}

6972 6973 6974 6975 6976 6977 6978 6979
static const struct drm_connector_funcs amdgpu_dm_connector_funcs = {
	.reset = amdgpu_dm_connector_funcs_reset,
	.detect = amdgpu_dm_connector_detect,
	.fill_modes = drm_helper_probe_single_connector_modes,
	.destroy = amdgpu_dm_connector_destroy,
	.atomic_duplicate_state = amdgpu_dm_connector_atomic_duplicate_state,
	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
	.atomic_set_property = amdgpu_dm_connector_atomic_set_property,
6980
	.atomic_get_property = amdgpu_dm_connector_atomic_get_property,
6981
	.late_register = amdgpu_dm_connector_late_register,
6982
	.early_unregister = amdgpu_dm_connector_unregister
6983 6984 6985 6986 6987 6988 6989
};

static int get_modes(struct drm_connector *connector)
{
	return amdgpu_dm_connector_get_modes(connector);
}

6990
static void create_eml_sink(struct amdgpu_dm_connector *aconnector)
6991 6992 6993 6994 6995
{
	struct dc_sink_init_data init_params = {
			.link = aconnector->dc_link,
			.sink_signal = SIGNAL_TYPE_VIRTUAL
	};
6996
	struct edid *edid;
6997

6998
	if (!aconnector->base.edid_blob_ptr) {
6999 7000 7001 7002 7003 7004 7005 7006
		DRM_ERROR("No EDID firmware found on connector: %s ,forcing to OFF!\n",
				aconnector->base.name);

		aconnector->base.force = DRM_FORCE_OFF;
		aconnector->base.override_edid = false;
		return;
	}

7007 7008
	edid = (struct edid *) aconnector->base.edid_blob_ptr->data;

7009 7010 7011 7012 7013 7014 7015 7016
	aconnector->edid = edid;

	aconnector->dc_em_sink = dc_link_add_remote_sink(
		aconnector->dc_link,
		(uint8_t *)edid,
		(edid->extensions + 1) * EDID_LENGTH,
		&init_params);

7017
	if (aconnector->base.force == DRM_FORCE_ON) {
7018 7019 7020
		aconnector->dc_sink = aconnector->dc_link->local_sink ?
		aconnector->dc_link->local_sink :
		aconnector->dc_em_sink;
7021 7022
		dc_sink_retain(aconnector->dc_sink);
	}
7023 7024
}

7025
static void handle_edid_mgmt(struct amdgpu_dm_connector *aconnector)
7026 7027 7028
{
	struct dc_link *link = (struct dc_link *)aconnector->dc_link;

7029 7030
	/*
	 * In case of headless boot with force on for DP managed connector
7031 7032 7033 7034 7035 7036 7037 7038 7039 7040 7041 7042
	 * Those settings have to be != 0 to get initial modeset
	 */
	if (link->connector_signal == SIGNAL_TYPE_DISPLAY_PORT) {
		link->verified_link_cap.lane_count = LANE_COUNT_FOUR;
		link->verified_link_cap.link_rate = LINK_RATE_HIGH2;
	}


	aconnector->base.override_edid = true;
	create_eml_sink(aconnector);
}

7043
struct dc_stream_state *
7044 7045 7046 7047 7048 7049
create_validate_stream_for_sink(struct amdgpu_dm_connector *aconnector,
				const struct drm_display_mode *drm_mode,
				const struct dm_connector_state *dm_state,
				const struct dc_stream_state *old_stream)
{
	struct drm_connector *connector = &aconnector->base;
7050
	struct amdgpu_device *adev = drm_to_adev(connector->dev);
7051
	struct dc_stream_state *stream;
7052 7053
	const struct drm_connector_state *drm_state = dm_state ? &dm_state->base : NULL;
	int requested_bpc = drm_state ? drm_state->max_requested_bpc : 8;
7054 7055 7056 7057 7058 7059 7060 7061 7062 7063 7064 7065 7066 7067
	enum dc_status dc_result = DC_OK;

	do {
		stream = create_stream_for_sink(aconnector, drm_mode,
						dm_state, old_stream,
						requested_bpc);
		if (stream == NULL) {
			DRM_ERROR("Failed to create stream for sink!\n");
			break;
		}

		dc_result = dc_validate_stream(adev->dm.dc, stream);

		if (dc_result != DC_OK) {
7068
			DRM_DEBUG_KMS("Mode %dx%d (clk %d) failed DC validation with error %d (%s)\n",
7069 7070 7071
				      drm_mode->hdisplay,
				      drm_mode->vdisplay,
				      drm_mode->clock,
7072 7073
				      dc_result,
				      dc_status_to_str(dc_result));
7074 7075 7076 7077 7078 7079 7080 7081

			dc_stream_release(stream);
			stream = NULL;
			requested_bpc -= 2; /* lower bpc to retry validation */
		}

	} while (stream == NULL && requested_bpc >= 6);

7082 7083 7084 7085 7086 7087 7088 7089 7090
	if (dc_result == DC_FAIL_ENC_VALIDATE && !aconnector->force_yuv420_output) {
		DRM_DEBUG_KMS("Retry forcing YCbCr420 encoding\n");

		aconnector->force_yuv420_output = true;
		stream = create_validate_stream_for_sink(aconnector, drm_mode,
						dm_state, old_stream);
		aconnector->force_yuv420_output = false;
	}

7091 7092 7093
	return stream;
}

7094
enum drm_mode_status amdgpu_dm_connector_mode_valid(struct drm_connector *connector,
7095
				   struct drm_display_mode *mode)
7096 7097 7098 7099
{
	int result = MODE_ERROR;
	struct dc_sink *dc_sink;
	/* TODO: Unhardcode stream count */
7100
	struct dc_stream_state *stream;
7101
	struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);
7102 7103 7104 7105 7106

	if ((mode->flags & DRM_MODE_FLAG_INTERLACE) ||
			(mode->flags & DRM_MODE_FLAG_DBLSCAN))
		return result;

7107 7108
	/*
	 * Only run this the first time mode_valid is called to initilialize
7109 7110 7111 7112 7113 7114
	 * EDID mgmt
	 */
	if (aconnector->base.force != DRM_FORCE_UNSPECIFIED &&
		!aconnector->dc_em_sink)
		handle_edid_mgmt(aconnector);

7115
	dc_sink = to_amdgpu_dm_connector(connector)->dc_sink;
7116

7117 7118
	if (dc_sink == NULL && aconnector->base.force != DRM_FORCE_ON_DIGITAL &&
				aconnector->base.force != DRM_FORCE_ON) {
7119 7120 7121 7122
		DRM_ERROR("dc_sink is NULL!\n");
		goto fail;
	}

7123 7124 7125
	stream = create_validate_stream_for_sink(aconnector, mode, NULL, NULL);
	if (stream) {
		dc_stream_release(stream);
7126
		result = MODE_OK;
7127
	}
7128 7129 7130 7131 7132 7133

fail:
	/* TODO: error handling*/
	return result;
}

7134 7135 7136 7137 7138 7139 7140 7141 7142 7143 7144 7145 7146 7147 7148 7149 7150 7151 7152 7153 7154 7155 7156 7157 7158 7159 7160 7161 7162 7163 7164 7165 7166 7167 7168 7169 7170 7171 7172 7173 7174 7175 7176 7177 7178 7179 7180 7181 7182 7183 7184 7185 7186 7187 7188 7189 7190 7191 7192 7193 7194
static int fill_hdr_info_packet(const struct drm_connector_state *state,
				struct dc_info_packet *out)
{
	struct hdmi_drm_infoframe frame;
	unsigned char buf[30]; /* 26 + 4 */
	ssize_t len;
	int ret, i;

	memset(out, 0, sizeof(*out));

	if (!state->hdr_output_metadata)
		return 0;

	ret = drm_hdmi_infoframe_set_hdr_metadata(&frame, state);
	if (ret)
		return ret;

	len = hdmi_drm_infoframe_pack_only(&frame, buf, sizeof(buf));
	if (len < 0)
		return (int)len;

	/* Static metadata is a fixed 26 bytes + 4 byte header. */
	if (len != 30)
		return -EINVAL;

	/* Prepare the infopacket for DC. */
	switch (state->connector->connector_type) {
	case DRM_MODE_CONNECTOR_HDMIA:
		out->hb0 = 0x87; /* type */
		out->hb1 = 0x01; /* version */
		out->hb2 = 0x1A; /* length */
		out->sb[0] = buf[3]; /* checksum */
		i = 1;
		break;

	case DRM_MODE_CONNECTOR_DisplayPort:
	case DRM_MODE_CONNECTOR_eDP:
		out->hb0 = 0x00; /* sdp id, zero */
		out->hb1 = 0x87; /* type */
		out->hb2 = 0x1D; /* payload len - 1 */
		out->hb3 = (0x13 << 2); /* sdp version */
		out->sb[0] = 0x01; /* version */
		out->sb[1] = 0x1A; /* length */
		i = 2;
		break;

	default:
		return -EINVAL;
	}

	memcpy(&out->sb[i], &buf[4], 26);
	out->valid = true;

	print_hex_dump(KERN_DEBUG, "HDR SB:", DUMP_PREFIX_NONE, 16, 1, out->sb,
		       sizeof(out->sb), false);

	return 0;
}

static int
amdgpu_dm_connector_atomic_check(struct drm_connector *conn,
7195
				 struct drm_atomic_state *state)
7196
{
7197 7198
	struct drm_connector_state *new_con_state =
		drm_atomic_get_new_connector_state(state, conn);
7199 7200 7201 7202 7203 7204
	struct drm_connector_state *old_con_state =
		drm_atomic_get_old_connector_state(state, conn);
	struct drm_crtc *crtc = new_con_state->crtc;
	struct drm_crtc_state *new_crtc_state;
	int ret;

7205 7206
	trace_amdgpu_dm_connector_atomic_check(new_con_state);

7207 7208 7209
	if (!crtc)
		return 0;

7210
	if (!drm_connector_atomic_hdr_metadata_equal(old_con_state, new_con_state)) {
7211 7212 7213 7214 7215 7216 7217 7218 7219 7220 7221 7222 7223 7224
		struct dc_info_packet hdr_infopacket;

		ret = fill_hdr_info_packet(new_con_state, &hdr_infopacket);
		if (ret)
			return ret;

		new_crtc_state = drm_atomic_get_crtc_state(state, crtc);
		if (IS_ERR(new_crtc_state))
			return PTR_ERR(new_crtc_state);

		/*
		 * DC considers the stream backends changed if the
		 * static metadata changes. Forcing the modeset also
		 * gives a simple way for userspace to switch from
7225 7226 7227 7228 7229 7230
		 * 8bpc to 10bpc when setting the metadata to enter
		 * or exit HDR.
		 *
		 * Changing the static metadata after it's been
		 * set is permissible, however. So only force a
		 * modeset if we're entering or exiting HDR.
7231
		 */
7232 7233 7234
		new_crtc_state->mode_changed =
			!old_con_state->hdr_output_metadata ||
			!new_con_state->hdr_output_metadata;
7235 7236 7237 7238 7239
	}

	return 0;
}

7240 7241 7242
static const struct drm_connector_helper_funcs
amdgpu_dm_connector_helper_funcs = {
	/*
7243
	 * If hotplugging a second bigger display in FB Con mode, bigger resolution
7244
	 * modes will be filtered by drm_mode_validate_size(), and those modes
7245
	 * are missing after user start lightdm. So we need to renew modes list.
7246 7247
	 * in get_modes call back, not just return the modes count
	 */
7248 7249
	.get_modes = get_modes,
	.mode_valid = amdgpu_dm_connector_mode_valid,
7250
	.atomic_check = amdgpu_dm_connector_atomic_check,
7251 7252 7253 7254 7255 7256
};

static void dm_crtc_helper_disable(struct drm_crtc *crtc)
{
}

7257
static int count_crtc_active_planes(struct drm_crtc_state *new_crtc_state)
7258 7259 7260 7261 7262 7263 7264 7265 7266 7267 7268 7269 7270 7271 7272 7273 7274 7275 7276 7277 7278 7279 7280 7281 7282 7283 7284 7285
{
	struct drm_atomic_state *state = new_crtc_state->state;
	struct drm_plane *plane;
	int num_active = 0;

	drm_for_each_plane_mask(plane, state->dev, new_crtc_state->plane_mask) {
		struct drm_plane_state *new_plane_state;

		/* Cursor planes are "fake". */
		if (plane->type == DRM_PLANE_TYPE_CURSOR)
			continue;

		new_plane_state = drm_atomic_get_new_plane_state(state, plane);

		if (!new_plane_state) {
			/*
			 * The plane is enable on the CRTC and hasn't changed
			 * state. This means that it previously passed
			 * validation and is therefore enabled.
			 */
			num_active += 1;
			continue;
		}

		/* We need a framebuffer to be considered enabled. */
		num_active += (new_plane_state->fb != NULL);
	}

7286 7287 7288
	return num_active;
}

7289 7290
static void dm_update_crtc_active_planes(struct drm_crtc *crtc,
					 struct drm_crtc_state *new_crtc_state)
7291 7292 7293 7294 7295 7296 7297 7298 7299 7300 7301
{
	struct dm_crtc_state *dm_new_crtc_state =
		to_dm_crtc_state(new_crtc_state);

	dm_new_crtc_state->active_planes = 0;

	if (!dm_new_crtc_state->stream)
		return;

	dm_new_crtc_state->active_planes =
		count_crtc_active_planes(new_crtc_state);
7302 7303
}

7304
static int dm_crtc_helper_atomic_check(struct drm_crtc *crtc,
7305
				       struct drm_atomic_state *state)
7306
{
7307 7308
	struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state,
									  crtc);
7309
	struct amdgpu_device *adev = drm_to_adev(crtc->dev);
7310
	struct dc *dc = adev->dm.dc;
7311
	struct dm_crtc_state *dm_crtc_state = to_dm_crtc_state(crtc_state);
7312 7313
	int ret = -EINVAL;

7314
	trace_amdgpu_dm_crtc_atomic_check(crtc_state);
7315

7316
	dm_update_crtc_active_planes(crtc, crtc_state);
7317

N
Nirmoy Das 已提交
7318 7319
	if (WARN_ON(unlikely(!dm_crtc_state->stream &&
		     modeset_required(crtc_state, NULL, dm_crtc_state->stream)))) {
7320 7321 7322
		return ret;
	}

7323
	/*
7324 7325 7326 7327
	 * We require the primary plane to be enabled whenever the CRTC is, otherwise
	 * drm_mode_cursor_universal may end up trying to enable the cursor plane while all other
	 * planes are disabled, which is not supported by the hardware. And there is legacy
	 * userspace which stops using the HW cursor altogether in response to the resulting EINVAL.
7328
	 */
7329
	if (crtc_state->enable &&
7330 7331
	    !(crtc_state->plane_mask & drm_plane_mask(crtc->primary))) {
		DRM_DEBUG_ATOMIC("Can't enable a CRTC without enabling the primary plane\n");
7332
		return -EINVAL;
7333
	}
7334

7335 7336 7337 7338
	/* In some use cases, like reset, no stream is attached */
	if (!dm_crtc_state->stream)
		return 0;

7339
	if (dc_validate_stream(dc, dm_crtc_state->stream) == DC_OK)
7340 7341
		return 0;

7342
	DRM_DEBUG_ATOMIC("Failed DC stream validation\n");
7343 7344 7345
	return ret;
}

7346 7347 7348
static bool dm_crtc_helper_mode_fixup(struct drm_crtc *crtc,
				      const struct drm_display_mode *mode,
				      struct drm_display_mode *adjusted_mode)
7349 7350 7351 7352 7353 7354 7355
{
	return true;
}

static const struct drm_crtc_helper_funcs amdgpu_dm_crtc_helper_funcs = {
	.disable = dm_crtc_helper_disable,
	.atomic_check = dm_crtc_helper_atomic_check,
7356 7357
	.mode_fixup = dm_crtc_helper_mode_fixup,
	.get_scanout_position = amdgpu_crtc_get_scanout_position,
7358 7359 7360 7361 7362 7363 7364
};

static void dm_encoder_helper_disable(struct drm_encoder *encoder)
{

}

7365 7366 7367 7368 7369 7370 7371 7372 7373 7374 7375 7376 7377 7378 7379 7380 7381 7382 7383 7384 7385
static int convert_dc_color_depth_into_bpc (enum dc_color_depth display_color_depth)
{
	switch (display_color_depth) {
		case COLOR_DEPTH_666:
			return 6;
		case COLOR_DEPTH_888:
			return 8;
		case COLOR_DEPTH_101010:
			return 10;
		case COLOR_DEPTH_121212:
			return 12;
		case COLOR_DEPTH_141414:
			return 14;
		case COLOR_DEPTH_161616:
			return 16;
		default:
			break;
		}
	return 0;
}

7386 7387 7388
static int dm_encoder_helper_atomic_check(struct drm_encoder *encoder,
					  struct drm_crtc_state *crtc_state,
					  struct drm_connector_state *conn_state)
7389
{
7390 7391 7392 7393 7394 7395 7396 7397 7398
	struct drm_atomic_state *state = crtc_state->state;
	struct drm_connector *connector = conn_state->connector;
	struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);
	struct dm_connector_state *dm_new_connector_state = to_dm_connector_state(conn_state);
	const struct drm_display_mode *adjusted_mode = &crtc_state->adjusted_mode;
	struct drm_dp_mst_topology_mgr *mst_mgr;
	struct drm_dp_mst_port *mst_port;
	enum dc_color_depth color_depth;
	int clock, bpp = 0;
7399
	bool is_y420 = false;
7400 7401 7402 7403 7404 7405 7406 7407 7408 7409 7410

	if (!aconnector->port || !aconnector->dc_sink)
		return 0;

	mst_port = aconnector->port;
	mst_mgr = &aconnector->mst_port->mst_mgr;

	if (!crtc_state->connectors_changed && !crtc_state->mode_changed)
		return 0;

	if (!state->duplicated) {
7411
		int max_bpc = conn_state->max_requested_bpc;
7412 7413
		is_y420 = drm_mode_is_420_also(&connector->display_info, adjusted_mode) &&
				aconnector->force_yuv420_output;
7414 7415 7416
		color_depth = convert_color_depth_from_display_info(connector,
								    is_y420,
								    max_bpc);
7417 7418
		bpp = convert_dc_color_depth_into_bpc(color_depth) * 3;
		clock = adjusted_mode->clock;
7419
		dm_new_connector_state->pbn = drm_dp_calc_pbn_mode(clock, bpp, false);
7420 7421 7422 7423
	}
	dm_new_connector_state->vcpi_slots = drm_dp_atomic_find_vcpi_slots(state,
									   mst_mgr,
									   mst_port,
7424
									   dm_new_connector_state->pbn,
7425
									   dm_mst_get_pbn_divider(aconnector->dc_link));
7426 7427 7428 7429
	if (dm_new_connector_state->vcpi_slots < 0) {
		DRM_DEBUG_ATOMIC("failed finding vcpi slots: %d\n", (int)dm_new_connector_state->vcpi_slots);
		return dm_new_connector_state->vcpi_slots;
	}
7430 7431 7432 7433 7434 7435 7436 7437
	return 0;
}

const struct drm_encoder_helper_funcs amdgpu_dm_encoder_helper_funcs = {
	.disable = dm_encoder_helper_disable,
	.atomic_check = dm_encoder_helper_atomic_check
};

7438
#if defined(CONFIG_DRM_AMD_DC_DCN)
7439
static int dm_update_mst_vcpi_slots_for_dsc(struct drm_atomic_state *state,
7440 7441
					    struct dc_state *dc_state,
					    struct dsc_mst_fairness_vars *vars)
7442 7443 7444
{
	struct dc_stream_state *stream = NULL;
	struct drm_connector *connector;
7445
	struct drm_connector_state *new_con_state;
7446 7447
	struct amdgpu_dm_connector *aconnector;
	struct dm_connector_state *dm_conn_state;
7448 7449
	int i, j;
	int vcpi, pbn_div, pbn, slot_num = 0;
7450

7451
	for_each_new_connector_in_state(state, connector, new_con_state, i) {
7452 7453 7454 7455 7456 7457 7458 7459 7460 7461 7462 7463 7464 7465 7466 7467 7468 7469 7470 7471 7472 7473 7474 7475 7476 7477

		aconnector = to_amdgpu_dm_connector(connector);

		if (!aconnector->port)
			continue;

		if (!new_con_state || !new_con_state->crtc)
			continue;

		dm_conn_state = to_dm_connector_state(new_con_state);

		for (j = 0; j < dc_state->stream_count; j++) {
			stream = dc_state->streams[j];
			if (!stream)
				continue;

			if ((struct amdgpu_dm_connector*)stream->dm_stream_context == aconnector)
				break;

			stream = NULL;
		}

		if (!stream)
			continue;

		pbn_div = dm_mst_get_pbn_divider(stream->link);
7478 7479 7480 7481 7482 7483 7484 7485
		/* pbn is calculated by compute_mst_dsc_configs_for_state*/
		for (j = 0; j < dc_state->stream_count; j++) {
			if (vars[j].aconnector == aconnector) {
				pbn = vars[j].pbn;
				break;
			}
		}

7486 7487 7488 7489 7490 7491 7492 7493 7494 7495 7496 7497 7498 7499 7500 7501 7502
		if (j == dc_state->stream_count)
			continue;

		slot_num = DIV_ROUND_UP(pbn, pbn_div);

		if (stream->timing.flags.DSC != 1) {
			dm_conn_state->pbn = pbn;
			dm_conn_state->vcpi_slots = slot_num;

			drm_dp_mst_atomic_enable_dsc(state,
						     aconnector->port,
						     dm_conn_state->pbn,
						     0,
						     false);
			continue;
		}

7503 7504 7505 7506 7507 7508 7509 7510 7511 7512 7513 7514
		vcpi = drm_dp_mst_atomic_enable_dsc(state,
						    aconnector->port,
						    pbn, pbn_div,
						    true);
		if (vcpi < 0)
			return vcpi;

		dm_conn_state->pbn = pbn;
		dm_conn_state->vcpi_slots = vcpi;
	}
	return 0;
}
7515
#endif
7516

7517 7518 7519 7520 7521 7522 7523 7524
static void dm_drm_plane_reset(struct drm_plane *plane)
{
	struct dm_plane_state *amdgpu_state = NULL;

	if (plane->state)
		plane->funcs->atomic_destroy_state(plane, plane->state);

	amdgpu_state = kzalloc(sizeof(*amdgpu_state), GFP_KERNEL);
7525
	WARN_ON(amdgpu_state == NULL);
7526

7527 7528
	if (amdgpu_state)
		__drm_atomic_helper_plane_reset(plane, &amdgpu_state->base);
7529 7530 7531 7532 7533 7534 7535 7536 7537 7538 7539 7540 7541 7542
}

static struct drm_plane_state *
dm_drm_plane_duplicate_state(struct drm_plane *plane)
{
	struct dm_plane_state *dm_plane_state, *old_dm_plane_state;

	old_dm_plane_state = to_dm_plane_state(plane->state);
	dm_plane_state = kzalloc(sizeof(*dm_plane_state), GFP_KERNEL);
	if (!dm_plane_state)
		return NULL;

	__drm_atomic_helper_plane_duplicate_state(plane, &dm_plane_state->base);

7543 7544 7545
	if (old_dm_plane_state->dc_state) {
		dm_plane_state->dc_state = old_dm_plane_state->dc_state;
		dc_plane_state_retain(dm_plane_state->dc_state);
7546 7547 7548 7549 7550
	}

	return &dm_plane_state->base;
}

7551
static void dm_drm_plane_destroy_state(struct drm_plane *plane,
7552
				struct drm_plane_state *state)
7553 7554 7555
{
	struct dm_plane_state *dm_plane_state = to_dm_plane_state(state);

7556 7557
	if (dm_plane_state->dc_state)
		dc_plane_state_release(dm_plane_state->dc_state);
7558

7559
	drm_atomic_helper_plane_destroy_state(plane, state);
7560 7561 7562 7563 7564
}

static const struct drm_plane_funcs dm_plane_funcs = {
	.update_plane	= drm_atomic_helper_update_plane,
	.disable_plane	= drm_atomic_helper_disable_plane,
7565
	.destroy	= drm_primary_helper_destroy,
7566 7567 7568
	.reset = dm_drm_plane_reset,
	.atomic_duplicate_state = dm_drm_plane_duplicate_state,
	.atomic_destroy_state = dm_drm_plane_destroy_state,
7569
	.format_mod_supported = dm_plane_format_mod_supported,
7570 7571
};

7572 7573
static int dm_plane_helper_prepare_fb(struct drm_plane *plane,
				      struct drm_plane_state *new_state)
7574 7575 7576
{
	struct amdgpu_framebuffer *afb;
	struct drm_gem_object *obj;
7577
	struct amdgpu_device *adev;
7578 7579
	struct amdgpu_bo *rbo;
	struct dm_plane_state *dm_plane_state_new, *dm_plane_state_old;
7580 7581 7582
	struct list_head list;
	struct ttm_validate_buffer tv;
	struct ww_acquire_ctx ticket;
7583 7584
	uint32_t domain;
	int r;
7585 7586

	if (!new_state->fb) {
7587
		DRM_DEBUG_KMS("No FB bound\n");
7588 7589 7590 7591
		return 0;
	}

	afb = to_amdgpu_framebuffer(new_state->fb);
7592
	obj = new_state->fb->obj[0];
7593
	rbo = gem_to_amdgpu_bo(obj);
7594
	adev = amdgpu_ttm_adev(rbo->tbo.bdev);
7595 7596 7597 7598 7599 7600
	INIT_LIST_HEAD(&list);

	tv.bo = &rbo->tbo;
	tv.num_shared = 1;
	list_add(&tv.head, &list);

7601
	r = ttm_eu_reserve_buffers(&ticket, &list, false, NULL);
7602 7603
	if (r) {
		dev_err(adev->dev, "fail to reserve bo (%d)\n", r);
7604
		return r;
7605
	}
7606

7607
	if (plane->type != DRM_PLANE_TYPE_CURSOR)
7608
		domain = amdgpu_display_supported_domains(adev, rbo->flags);
7609 7610
	else
		domain = AMDGPU_GEM_DOMAIN_VRAM;
7611

7612
	r = amdgpu_bo_pin(rbo, domain);
7613
	if (unlikely(r != 0)) {
7614 7615
		if (r != -ERESTARTSYS)
			DRM_ERROR("Failed to pin framebuffer with error %d\n", r);
7616
		ttm_eu_backoff_reservation(&ticket, &list);
7617 7618 7619
		return r;
	}

7620 7621 7622
	r = amdgpu_ttm_alloc_gart(&rbo->tbo);
	if (unlikely(r != 0)) {
		amdgpu_bo_unpin(rbo);
7623
		ttm_eu_backoff_reservation(&ticket, &list);
7624
		DRM_ERROR("%p bind failed\n", rbo);
7625 7626
		return r;
	}
7627

7628
	ttm_eu_backoff_reservation(&ticket, &list);
7629

7630
	afb->address = amdgpu_bo_gpu_offset(rbo);
7631 7632 7633

	amdgpu_bo_ref(rbo);

7634 7635 7636 7637 7638 7639 7640 7641 7642 7643 7644
	/**
	 * We don't do surface updates on planes that have been newly created,
	 * but we also don't have the afb->address during atomic check.
	 *
	 * Fill in buffer attributes depending on the address here, but only on
	 * newly created planes since they're not being used by DC yet and this
	 * won't modify global state.
	 */
	dm_plane_state_old = to_dm_plane_state(plane->state);
	dm_plane_state_new = to_dm_plane_state(new_state);

7645
	if (dm_plane_state_new->dc_state &&
7646 7647 7648 7649
	    dm_plane_state_old->dc_state != dm_plane_state_new->dc_state) {
		struct dc_plane_state *plane_state =
			dm_plane_state_new->dc_state;
		bool force_disable_dcc = !plane_state->dcc.enable;
7650

7651
		fill_plane_buffer_attributes(
7652
			adev, afb, plane_state->format, plane_state->rotation,
7653
			afb->tiling_flags,
7654 7655
			&plane_state->tiling_info, &plane_state->plane_size,
			&plane_state->dcc, &plane_state->address,
7656
			afb->tmz_surface, force_disable_dcc);
7657 7658 7659 7660 7661
	}

	return 0;
}

7662 7663
static void dm_plane_helper_cleanup_fb(struct drm_plane *plane,
				       struct drm_plane_state *old_state)
7664 7665 7666 7667 7668 7669 7670
{
	struct amdgpu_bo *rbo;
	int r;

	if (!old_state->fb)
		return;

7671
	rbo = gem_to_amdgpu_bo(old_state->fb->obj[0]);
7672 7673 7674 7675
	r = amdgpu_bo_reserve(rbo, false);
	if (unlikely(r)) {
		DRM_ERROR("failed to reserve rbo before unpin\n");
		return;
7676 7677 7678 7679 7680
	}

	amdgpu_bo_unpin(rbo);
	amdgpu_bo_unreserve(rbo);
	amdgpu_bo_unref(&rbo);
7681 7682
}

7683 7684 7685
static int dm_plane_helper_check_state(struct drm_plane_state *state,
				       struct drm_crtc_state *new_crtc_state)
{
7686 7687 7688 7689 7690
	struct drm_framebuffer *fb = state->fb;
	int min_downscale, max_upscale;
	int min_scale = 0;
	int max_scale = INT_MAX;

7691
	/* Plane enabled? Validate viewport and get scaling factors from plane caps. */
7692
	if (fb && state->crtc) {
7693 7694 7695 7696 7697 7698 7699 7700 7701 7702 7703 7704 7705 7706 7707
		/* Validate viewport to cover the case when only the position changes */
		if (state->plane->type != DRM_PLANE_TYPE_CURSOR) {
			int viewport_width = state->crtc_w;
			int viewport_height = state->crtc_h;

			if (state->crtc_x < 0)
				viewport_width += state->crtc_x;
			else if (state->crtc_x + state->crtc_w > new_crtc_state->mode.crtc_hdisplay)
				viewport_width = new_crtc_state->mode.crtc_hdisplay - state->crtc_x;

			if (state->crtc_y < 0)
				viewport_height += state->crtc_y;
			else if (state->crtc_y + state->crtc_h > new_crtc_state->mode.crtc_vdisplay)
				viewport_height = new_crtc_state->mode.crtc_vdisplay - state->crtc_y;

7708 7709 7710 7711 7712
			if (viewport_width < 0 || viewport_height < 0) {
				DRM_DEBUG_ATOMIC("Plane completely outside of screen\n");
				return -EINVAL;
			} else if (viewport_width < MIN_VIEWPORT_SIZE*2) { /* x2 for width is because of pipe-split. */
				DRM_DEBUG_ATOMIC("Viewport width %d smaller than %d\n", viewport_width, MIN_VIEWPORT_SIZE*2);
7713
				return -EINVAL;
7714 7715
			} else if (viewport_height < MIN_VIEWPORT_SIZE) {
				DRM_DEBUG_ATOMIC("Viewport height %d smaller than %d\n", viewport_height, MIN_VIEWPORT_SIZE);
7716
				return -EINVAL;
7717 7718
			}

7719 7720 7721
		}

		/* Get min/max allowed scaling factors from plane caps. */
7722 7723 7724 7725 7726 7727 7728 7729 7730 7731
		get_min_max_dc_plane_scaling(state->crtc->dev, fb,
					     &min_downscale, &max_upscale);
		/*
		 * Convert to drm convention: 16.16 fixed point, instead of dc's
		 * 1.0 == 1000. Also drm scaling is src/dst instead of dc's
		 * dst/src, so min_scale = 1.0 / max_upscale, etc.
		 */
		min_scale = (1000 << 16) / max_upscale;
		max_scale = (1000 << 16) / min_downscale;
	}
7732 7733

	return drm_atomic_helper_check_plane_state(
7734
		state, new_crtc_state, min_scale, max_scale, true, true);
7735 7736
}

7737
static int dm_plane_atomic_check(struct drm_plane *plane,
7738
				 struct drm_atomic_state *state)
7739
{
7740 7741
	struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,
										 plane);
7742
	struct amdgpu_device *adev = drm_to_adev(plane->dev);
7743
	struct dc *dc = adev->dm.dc;
7744
	struct dm_plane_state *dm_plane_state;
7745
	struct dc_scaling_info scaling_info;
7746
	struct drm_crtc_state *new_crtc_state;
7747
	int ret;
7748

7749
	trace_amdgpu_dm_plane_atomic_check(new_plane_state);
7750

7751
	dm_plane_state = to_dm_plane_state(new_plane_state);
7752

7753
	if (!dm_plane_state->dc_state)
7754
		return 0;
7755

7756
	new_crtc_state =
7757
		drm_atomic_get_new_crtc_state(state,
7758
					      new_plane_state->crtc);
7759 7760 7761
	if (!new_crtc_state)
		return -EINVAL;

7762
	ret = dm_plane_helper_check_state(new_plane_state, new_crtc_state);
7763 7764 7765
	if (ret)
		return ret;

7766
	ret = fill_dc_scaling_info(adev, new_plane_state, &scaling_info);
7767 7768
	if (ret)
		return ret;
7769

7770
	if (dc_validate_plane(dc, dm_plane_state->dc_state) == DC_OK)
7771 7772 7773 7774 7775
		return 0;

	return -EINVAL;
}

7776
static int dm_plane_atomic_async_check(struct drm_plane *plane,
7777
				       struct drm_atomic_state *state)
7778 7779 7780 7781 7782 7783 7784 7785 7786
{
	/* Only support async updates on cursor planes. */
	if (plane->type != DRM_PLANE_TYPE_CURSOR)
		return -EINVAL;

	return 0;
}

static void dm_plane_atomic_async_update(struct drm_plane *plane,
7787
					 struct drm_atomic_state *state)
7788
{
7789 7790
	struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,
									   plane);
7791
	struct drm_plane_state *old_state =
7792
		drm_atomic_get_old_plane_state(state, plane);
7793

7794 7795
	trace_amdgpu_dm_atomic_update_cursor(new_state);

7796
	swap(plane->state->fb, new_state->fb);
7797 7798 7799 7800 7801 7802 7803 7804 7805 7806 7807 7808 7809

	plane->state->src_x = new_state->src_x;
	plane->state->src_y = new_state->src_y;
	plane->state->src_w = new_state->src_w;
	plane->state->src_h = new_state->src_h;
	plane->state->crtc_x = new_state->crtc_x;
	plane->state->crtc_y = new_state->crtc_y;
	plane->state->crtc_w = new_state->crtc_w;
	plane->state->crtc_h = new_state->crtc_h;

	handle_cursor_update(plane, old_state);
}

7810 7811 7812
static const struct drm_plane_helper_funcs dm_plane_helper_funcs = {
	.prepare_fb = dm_plane_helper_prepare_fb,
	.cleanup_fb = dm_plane_helper_cleanup_fb,
7813
	.atomic_check = dm_plane_atomic_check,
7814 7815
	.atomic_async_check = dm_plane_atomic_async_check,
	.atomic_async_update = dm_plane_atomic_async_update
7816 7817 7818 7819 7820 7821
};

/*
 * TODO: these are currently initialized to rgb formats only.
 * For future use cases we should either initialize them dynamically based on
 * plane capabilities, or initialize this array to all formats, so internal drm
7822
 * check will succeed, and let DC implement proper check
7823
 */
D
Dave Airlie 已提交
7824
static const uint32_t rgb_formats[] = {
7825 7826 7827 7828 7829 7830 7831
	DRM_FORMAT_XRGB8888,
	DRM_FORMAT_ARGB8888,
	DRM_FORMAT_RGBA8888,
	DRM_FORMAT_XRGB2101010,
	DRM_FORMAT_XBGR2101010,
	DRM_FORMAT_ARGB2101010,
	DRM_FORMAT_ABGR2101010,
7832 7833 7834 7835
	DRM_FORMAT_XRGB16161616,
	DRM_FORMAT_XBGR16161616,
	DRM_FORMAT_ARGB16161616,
	DRM_FORMAT_ABGR16161616,
7836 7837
	DRM_FORMAT_XBGR8888,
	DRM_FORMAT_ABGR8888,
7838
	DRM_FORMAT_RGB565,
7839 7840
};

7841 7842 7843 7844 7845 7846
static const uint32_t overlay_formats[] = {
	DRM_FORMAT_XRGB8888,
	DRM_FORMAT_ARGB8888,
	DRM_FORMAT_RGBA8888,
	DRM_FORMAT_XBGR8888,
	DRM_FORMAT_ABGR8888,
7847
	DRM_FORMAT_RGB565
7848 7849 7850 7851 7852 7853
};

static const u32 cursor_formats[] = {
	DRM_FORMAT_ARGB8888
};

7854 7855 7856
static int get_plane_formats(const struct drm_plane *plane,
			     const struct dc_plane_cap *plane_cap,
			     uint32_t *formats, int max_formats)
7857
{
7858 7859 7860 7861 7862 7863 7864
	int i, num_formats = 0;

	/*
	 * TODO: Query support for each group of formats directly from
	 * DC plane caps. This will require adding more formats to the
	 * caps list.
	 */
7865

H
Harry Wentland 已提交
7866
	switch (plane->type) {
7867
	case DRM_PLANE_TYPE_PRIMARY:
7868 7869 7870 7871 7872 7873 7874
		for (i = 0; i < ARRAY_SIZE(rgb_formats); ++i) {
			if (num_formats >= max_formats)
				break;

			formats[num_formats++] = rgb_formats[i];
		}

7875
		if (plane_cap && plane_cap->pixel_format_support.nv12)
7876
			formats[num_formats++] = DRM_FORMAT_NV12;
7877 7878
		if (plane_cap && plane_cap->pixel_format_support.p010)
			formats[num_formats++] = DRM_FORMAT_P010;
7879 7880 7881
		if (plane_cap && plane_cap->pixel_format_support.fp16) {
			formats[num_formats++] = DRM_FORMAT_XRGB16161616F;
			formats[num_formats++] = DRM_FORMAT_ARGB16161616F;
7882 7883
			formats[num_formats++] = DRM_FORMAT_XBGR16161616F;
			formats[num_formats++] = DRM_FORMAT_ABGR16161616F;
7884
		}
7885
		break;
7886

7887
	case DRM_PLANE_TYPE_OVERLAY:
7888 7889 7890 7891 7892 7893
		for (i = 0; i < ARRAY_SIZE(overlay_formats); ++i) {
			if (num_formats >= max_formats)
				break;

			formats[num_formats++] = overlay_formats[i];
		}
7894
		break;
7895

7896
	case DRM_PLANE_TYPE_CURSOR:
7897 7898 7899 7900 7901 7902
		for (i = 0; i < ARRAY_SIZE(cursor_formats); ++i) {
			if (num_formats >= max_formats)
				break;

			formats[num_formats++] = cursor_formats[i];
		}
7903 7904 7905
		break;
	}

7906 7907 7908 7909 7910 7911 7912 7913 7914 7915 7916
	return num_formats;
}

static int amdgpu_dm_plane_init(struct amdgpu_display_manager *dm,
				struct drm_plane *plane,
				unsigned long possible_crtcs,
				const struct dc_plane_cap *plane_cap)
{
	uint32_t formats[32];
	int num_formats;
	int res = -EPERM;
7917
	unsigned int supported_rotations;
7918
	uint64_t *modifiers = NULL;
7919 7920 7921 7922

	num_formats = get_plane_formats(plane, plane_cap, formats,
					ARRAY_SIZE(formats));

7923 7924 7925 7926
	res = get_plane_modifiers(dm->adev, plane->type, &modifiers);
	if (res)
		return res;

7927 7928 7929
	if (modifiers == NULL)
		adev_to_drm(dm->adev)->mode_config.fb_modifiers_not_supported = true;

7930
	res = drm_universal_plane_init(adev_to_drm(dm->adev), plane, possible_crtcs,
7931
				       &dm_plane_funcs, formats, num_formats,
7932 7933
				       modifiers, plane->type, NULL);
	kfree(modifiers);
7934 7935 7936
	if (res)
		return res;

7937 7938
	if (plane->type == DRM_PLANE_TYPE_OVERLAY &&
	    plane_cap && plane_cap->per_pixel_alpha) {
7939 7940 7941 7942 7943 7944 7945
		unsigned int blend_caps = BIT(DRM_MODE_BLEND_PIXEL_NONE) |
					  BIT(DRM_MODE_BLEND_PREMULTI);

		drm_plane_create_alpha_property(plane);
		drm_plane_create_blend_mode_property(plane, blend_caps);
	}

7946
	if (plane->type == DRM_PLANE_TYPE_PRIMARY &&
7947 7948 7949
	    plane_cap &&
	    (plane_cap->pixel_format_support.nv12 ||
	     plane_cap->pixel_format_support.p010)) {
7950 7951 7952 7953
		/* This only affects YUV formats. */
		drm_plane_create_color_properties(
			plane,
			BIT(DRM_COLOR_YCBCR_BT601) |
7954 7955
			BIT(DRM_COLOR_YCBCR_BT709) |
			BIT(DRM_COLOR_YCBCR_BT2020),
7956 7957 7958 7959 7960
			BIT(DRM_COLOR_YCBCR_LIMITED_RANGE) |
			BIT(DRM_COLOR_YCBCR_FULL_RANGE),
			DRM_COLOR_YCBCR_BT709, DRM_COLOR_YCBCR_LIMITED_RANGE);
	}

7961 7962 7963 7964
	supported_rotations =
		DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_90 |
		DRM_MODE_ROTATE_180 | DRM_MODE_ROTATE_270;

7965 7966
	if (dm->adev->asic_type >= CHIP_BONAIRE &&
	    plane->type != DRM_PLANE_TYPE_CURSOR)
7967 7968
		drm_plane_create_rotation_property(plane, DRM_MODE_ROTATE_0,
						   supported_rotations);
7969

H
Harry Wentland 已提交
7970
	drm_plane_helper_add(plane, &dm_plane_helper_funcs);
7971

7972
	/* Create (reset) the plane state */
H
Harry Wentland 已提交
7973 7974
	if (plane->funcs->reset)
		plane->funcs->reset(plane);
7975

7976
	return 0;
7977 7978
}

7979 7980 7981
static int amdgpu_dm_crtc_init(struct amdgpu_display_manager *dm,
			       struct drm_plane *plane,
			       uint32_t crtc_index)
7982 7983
{
	struct amdgpu_crtc *acrtc = NULL;
H
Harry Wentland 已提交
7984
	struct drm_plane *cursor_plane;
7985 7986 7987 7988 7989 7990 7991

	int res = -ENOMEM;

	cursor_plane = kzalloc(sizeof(*cursor_plane), GFP_KERNEL);
	if (!cursor_plane)
		goto fail;

H
Harry Wentland 已提交
7992
	cursor_plane->type = DRM_PLANE_TYPE_CURSOR;
7993
	res = amdgpu_dm_plane_init(dm, cursor_plane, 0, NULL);
7994 7995 7996 7997 7998 7999 8000 8001 8002

	acrtc = kzalloc(sizeof(struct amdgpu_crtc), GFP_KERNEL);
	if (!acrtc)
		goto fail;

	res = drm_crtc_init_with_planes(
			dm->ddev,
			&acrtc->base,
			plane,
H
Harry Wentland 已提交
8003
			cursor_plane,
8004 8005 8006 8007 8008 8009 8010
			&amdgpu_dm_crtc_funcs, NULL);

	if (res)
		goto fail;

	drm_crtc_helper_add(&acrtc->base, &amdgpu_dm_crtc_helper_funcs);

8011 8012 8013 8014
	/* Create (reset) the plane state */
	if (acrtc->base.funcs->reset)
		acrtc->base.funcs->reset(&acrtc->base);

8015 8016 8017 8018 8019
	acrtc->max_cursor_width = dm->adev->dm.dc->caps.max_cursor_size;
	acrtc->max_cursor_height = dm->adev->dm.dc->caps.max_cursor_size;

	acrtc->crtc_id = crtc_index;
	acrtc->base.enabled = false;
8020
	acrtc->otg_inst = -1;
8021 8022

	dm->adev->mode_info.crtcs[crtc_index] = acrtc;
8023 8024
	drm_crtc_enable_color_mgmt(&acrtc->base, MAX_COLOR_LUT_ENTRIES,
				   true, MAX_COLOR_LUT_ENTRIES);
8025
	drm_mode_crtc_set_gamma_size(&acrtc->base, MAX_COLOR_LEGACY_LUT_ENTRIES);
8026

8027 8028 8029
	return 0;

fail:
8030 8031
	kfree(acrtc);
	kfree(cursor_plane);
8032 8033 8034 8035 8036 8037 8038 8039 8040 8041 8042
	return res;
}


static int to_drm_connector_type(enum signal_type st)
{
	switch (st) {
	case SIGNAL_TYPE_HDMI_TYPE_A:
		return DRM_MODE_CONNECTOR_HDMIA;
	case SIGNAL_TYPE_EDP:
		return DRM_MODE_CONNECTOR_eDP;
8043 8044
	case SIGNAL_TYPE_LVDS:
		return DRM_MODE_CONNECTOR_LVDS;
8045 8046 8047 8048 8049 8050 8051 8052 8053 8054 8055 8056 8057 8058 8059 8060
	case SIGNAL_TYPE_RGB:
		return DRM_MODE_CONNECTOR_VGA;
	case SIGNAL_TYPE_DISPLAY_PORT:
	case SIGNAL_TYPE_DISPLAY_PORT_MST:
		return DRM_MODE_CONNECTOR_DisplayPort;
	case SIGNAL_TYPE_DVI_DUAL_LINK:
	case SIGNAL_TYPE_DVI_SINGLE_LINK:
		return DRM_MODE_CONNECTOR_DVID;
	case SIGNAL_TYPE_VIRTUAL:
		return DRM_MODE_CONNECTOR_VIRTUAL;

	default:
		return DRM_MODE_CONNECTOR_Unknown;
	}
}

8061 8062
static struct drm_encoder *amdgpu_dm_connector_to_encoder(struct drm_connector *connector)
{
8063 8064 8065 8066 8067 8068 8069
	struct drm_encoder *encoder;

	/* There is only one encoder per connector */
	drm_connector_for_each_possible_encoder(connector, encoder)
		return encoder;

	return NULL;
8070 8071
}

8072 8073 8074 8075 8076
static void amdgpu_dm_get_native_mode(struct drm_connector *connector)
{
	struct drm_encoder *encoder;
	struct amdgpu_encoder *amdgpu_encoder;

8077
	encoder = amdgpu_dm_connector_to_encoder(connector);
8078 8079 8080 8081 8082 8083 8084 8085 8086 8087

	if (encoder == NULL)
		return;

	amdgpu_encoder = to_amdgpu_encoder(encoder);

	amdgpu_encoder->native_mode.clock = 0;

	if (!list_empty(&connector->probed_modes)) {
		struct drm_display_mode *preferred_mode = NULL;
8088

8089
		list_for_each_entry(preferred_mode,
8090 8091 8092 8093 8094
				    &connector->probed_modes,
				    head) {
			if (preferred_mode->type & DRM_MODE_TYPE_PREFERRED)
				amdgpu_encoder->native_mode = *preferred_mode;

8095 8096 8097 8098 8099 8100
			break;
		}

	}
}

8101 8102 8103 8104
static struct drm_display_mode *
amdgpu_dm_create_common_mode(struct drm_encoder *encoder,
			     char *name,
			     int hdisplay, int vdisplay)
8105 8106 8107 8108 8109 8110 8111 8112
{
	struct drm_device *dev = encoder->dev;
	struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
	struct drm_display_mode *mode = NULL;
	struct drm_display_mode *native_mode = &amdgpu_encoder->native_mode;

	mode = drm_mode_duplicate(dev, native_mode);

8113
	if (mode == NULL)
8114 8115 8116 8117 8118
		return NULL;

	mode->hdisplay = hdisplay;
	mode->vdisplay = vdisplay;
	mode->type &= ~DRM_MODE_TYPE_PREFERRED;
8119
	strscpy(mode->name, name, DRM_DISPLAY_MODE_LEN);
8120 8121 8122 8123 8124 8125

	return mode;

}

static void amdgpu_dm_connector_add_common_modes(struct drm_encoder *encoder,
8126
						 struct drm_connector *connector)
8127 8128 8129 8130
{
	struct amdgpu_encoder *amdgpu_encoder = to_amdgpu_encoder(encoder);
	struct drm_display_mode *mode = NULL;
	struct drm_display_mode *native_mode = &amdgpu_encoder->native_mode;
8131 8132
	struct amdgpu_dm_connector *amdgpu_dm_connector =
				to_amdgpu_dm_connector(connector);
8133 8134 8135 8136 8137 8138
	int i;
	int n;
	struct mode_size {
		char name[DRM_DISPLAY_MODE_LEN];
		int w;
		int h;
8139
	} common_modes[] = {
8140 8141 8142 8143 8144 8145 8146 8147 8148 8149 8150 8151 8152
		{  "640x480",  640,  480},
		{  "800x600",  800,  600},
		{ "1024x768", 1024,  768},
		{ "1280x720", 1280,  720},
		{ "1280x800", 1280,  800},
		{"1280x1024", 1280, 1024},
		{ "1440x900", 1440,  900},
		{"1680x1050", 1680, 1050},
		{"1600x1200", 1600, 1200},
		{"1920x1080", 1920, 1080},
		{"1920x1200", 1920, 1200}
	};

8153
	n = ARRAY_SIZE(common_modes);
8154 8155 8156 8157 8158 8159

	for (i = 0; i < n; i++) {
		struct drm_display_mode *curmode = NULL;
		bool mode_existed = false;

		if (common_modes[i].w > native_mode->hdisplay ||
8160 8161 8162 8163
		    common_modes[i].h > native_mode->vdisplay ||
		   (common_modes[i].w == native_mode->hdisplay &&
		    common_modes[i].h == native_mode->vdisplay))
			continue;
8164 8165 8166

		list_for_each_entry(curmode, &connector->probed_modes, head) {
			if (common_modes[i].w == curmode->hdisplay &&
8167
			    common_modes[i].h == curmode->vdisplay) {
8168 8169 8170 8171 8172 8173 8174 8175 8176 8177 8178
				mode_existed = true;
				break;
			}
		}

		if (mode_existed)
			continue;

		mode = amdgpu_dm_create_common_mode(encoder,
				common_modes[i].name, common_modes[i].w,
				common_modes[i].h);
8179 8180 8181
		if (!mode)
			continue;

8182
		drm_mode_probed_add(connector, mode);
8183
		amdgpu_dm_connector->num_modes++;
8184 8185 8186
	}
}

8187 8188 8189 8190 8191 8192 8193 8194 8195 8196 8197 8198 8199 8200 8201 8202 8203 8204 8205 8206 8207 8208 8209 8210 8211 8212
static void amdgpu_set_panel_orientation(struct drm_connector *connector)
{
	struct drm_encoder *encoder;
	struct amdgpu_encoder *amdgpu_encoder;
	const struct drm_display_mode *native_mode;

	if (connector->connector_type != DRM_MODE_CONNECTOR_eDP &&
	    connector->connector_type != DRM_MODE_CONNECTOR_LVDS)
		return;

	encoder = amdgpu_dm_connector_to_encoder(connector);
	if (!encoder)
		return;

	amdgpu_encoder = to_amdgpu_encoder(encoder);

	native_mode = &amdgpu_encoder->native_mode;
	if (native_mode->hdisplay == 0 || native_mode->vdisplay == 0)
		return;

	drm_connector_set_panel_orientation_with_quirk(connector,
						       DRM_MODE_PANEL_ORIENTATION_UNKNOWN,
						       native_mode->hdisplay,
						       native_mode->vdisplay);
}

8213 8214
static void amdgpu_dm_connector_ddc_get_modes(struct drm_connector *connector,
					      struct edid *edid)
8215
{
8216 8217
	struct amdgpu_dm_connector *amdgpu_dm_connector =
			to_amdgpu_dm_connector(connector);
8218 8219 8220 8221

	if (edid) {
		/* empty probed_modes */
		INIT_LIST_HEAD(&connector->probed_modes);
8222
		amdgpu_dm_connector->num_modes =
8223 8224
				drm_add_edid_modes(connector, edid);

8225 8226 8227 8228 8229 8230 8231 8232 8233
		/* sorting the probed modes before calling function
		 * amdgpu_dm_get_native_mode() since EDID can have
		 * more than one preferred mode. The modes that are
		 * later in the probed mode list could be of higher
		 * and preferred resolution. For example, 3840x2160
		 * resolution in base EDID preferred timing and 4096x2160
		 * preferred resolution in DID extension block later.
		 */
		drm_mode_sort(&connector->probed_modes);
8234
		amdgpu_dm_get_native_mode(connector);
8235 8236 8237 8238 8239 8240

		/* Freesync capabilities are reset by calling
		 * drm_add_edid_modes() and need to be
		 * restored here.
		 */
		amdgpu_dm_update_freesync_caps(connector, edid);
8241 8242

		amdgpu_set_panel_orientation(connector);
8243
	} else {
8244
		amdgpu_dm_connector->num_modes = 0;
8245
	}
8246 8247
}

8248 8249 8250 8251 8252 8253 8254 8255 8256 8257 8258 8259 8260 8261 8262 8263 8264 8265 8266 8267 8268 8269
static bool is_duplicate_mode(struct amdgpu_dm_connector *aconnector,
			      struct drm_display_mode *mode)
{
	struct drm_display_mode *m;

	list_for_each_entry (m, &aconnector->base.probed_modes, head) {
		if (drm_mode_equal(m, mode))
			return true;
	}

	return false;
}

static uint add_fs_modes(struct amdgpu_dm_connector *aconnector)
{
	const struct drm_display_mode *m;
	struct drm_display_mode *new_mode;
	uint i;
	uint32_t new_modes_count = 0;

	/* Standard FPS values
	 *
8270 8271 8272 8273 8274 8275 8276 8277 8278
	 * 23.976       - TV/NTSC
	 * 24 	        - Cinema
	 * 25 	        - TV/PAL
	 * 29.97        - TV/NTSC
	 * 30 	        - TV/NTSC
	 * 48 	        - Cinema HFR
	 * 50 	        - TV/PAL
	 * 60 	        - Commonly used
	 * 48,72,96,120 - Multiples of 24
8279
	 */
8280 8281
	static const uint32_t common_rates[] = {
		23976, 24000, 25000, 29970, 30000,
8282
		48000, 50000, 60000, 72000, 96000, 120000
8283
	};
8284 8285 8286 8287 8288 8289 8290 8291 8292 8293 8294 8295 8296 8297 8298 8299 8300 8301 8302 8303 8304 8305 8306 8307 8308 8309 8310 8311 8312 8313 8314 8315 8316 8317 8318 8319 8320 8321 8322 8323 8324 8325 8326 8327 8328 8329 8330 8331 8332 8333 8334 8335 8336 8337 8338 8339 8340 8341 8342

	/*
	 * Find mode with highest refresh rate with the same resolution
	 * as the preferred mode. Some monitors report a preferred mode
	 * with lower resolution than the highest refresh rate supported.
	 */

	m = get_highest_refresh_rate_mode(aconnector, true);
	if (!m)
		return 0;

	for (i = 0; i < ARRAY_SIZE(common_rates); i++) {
		uint64_t target_vtotal, target_vtotal_diff;
		uint64_t num, den;

		if (drm_mode_vrefresh(m) * 1000 < common_rates[i])
			continue;

		if (common_rates[i] < aconnector->min_vfreq * 1000 ||
		    common_rates[i] > aconnector->max_vfreq * 1000)
			continue;

		num = (unsigned long long)m->clock * 1000 * 1000;
		den = common_rates[i] * (unsigned long long)m->htotal;
		target_vtotal = div_u64(num, den);
		target_vtotal_diff = target_vtotal - m->vtotal;

		/* Check for illegal modes */
		if (m->vsync_start + target_vtotal_diff < m->vdisplay ||
		    m->vsync_end + target_vtotal_diff < m->vsync_start ||
		    m->vtotal + target_vtotal_diff < m->vsync_end)
			continue;

		new_mode = drm_mode_duplicate(aconnector->base.dev, m);
		if (!new_mode)
			goto out;

		new_mode->vtotal += (u16)target_vtotal_diff;
		new_mode->vsync_start += (u16)target_vtotal_diff;
		new_mode->vsync_end += (u16)target_vtotal_diff;
		new_mode->type &= ~DRM_MODE_TYPE_PREFERRED;
		new_mode->type |= DRM_MODE_TYPE_DRIVER;

		if (!is_duplicate_mode(aconnector, new_mode)) {
			drm_mode_probed_add(&aconnector->base, new_mode);
			new_modes_count += 1;
		} else
			drm_mode_destroy(aconnector->base.dev, new_mode);
	}
 out:
	return new_modes_count;
}

static void amdgpu_dm_connector_add_freesync_modes(struct drm_connector *connector,
						   struct edid *edid)
{
	struct amdgpu_dm_connector *amdgpu_dm_connector =
		to_amdgpu_dm_connector(connector);

8343
	if (!edid)
8344
		return;
8345

8346 8347 8348 8349 8350
	if (amdgpu_dm_connector->max_vfreq - amdgpu_dm_connector->min_vfreq > 10)
		amdgpu_dm_connector->num_modes +=
			add_fs_modes(amdgpu_dm_connector);
}

8351
static int amdgpu_dm_connector_get_modes(struct drm_connector *connector)
8352
{
8353 8354
	struct amdgpu_dm_connector *amdgpu_dm_connector =
			to_amdgpu_dm_connector(connector);
8355
	struct drm_encoder *encoder;
8356
	struct edid *edid = amdgpu_dm_connector->edid;
8357

8358
	encoder = amdgpu_dm_connector_to_encoder(connector);
8359

8360
	if (!drm_edid_is_valid(edid)) {
8361 8362
		amdgpu_dm_connector->num_modes =
				drm_add_modes_noedid(connector, 640, 480);
8363 8364 8365
	} else {
		amdgpu_dm_connector_ddc_get_modes(connector, edid);
		amdgpu_dm_connector_add_common_modes(encoder, connector);
8366
		amdgpu_dm_connector_add_freesync_modes(connector, edid);
8367
	}
8368
	amdgpu_dm_fbc_init(connector);
8369

8370
	return amdgpu_dm_connector->num_modes;
8371 8372
}

8373 8374 8375 8376 8377
void amdgpu_dm_connector_init_helper(struct amdgpu_display_manager *dm,
				     struct amdgpu_dm_connector *aconnector,
				     int connector_type,
				     struct dc_link *link,
				     int link_index)
8378
{
8379
	struct amdgpu_device *adev = drm_to_adev(dm->ddev);
8380

8381 8382 8383 8384 8385 8386 8387
	/*
	 * Some of the properties below require access to state, like bpc.
	 * Allocate some default initial connector state with our reset helper.
	 */
	if (aconnector->base.funcs->reset)
		aconnector->base.funcs->reset(&aconnector->base);

8388 8389 8390 8391 8392 8393 8394
	aconnector->connector_id = link_index;
	aconnector->dc_link = link;
	aconnector->base.interlace_allowed = false;
	aconnector->base.doublescan_allowed = false;
	aconnector->base.stereo_allowed = false;
	aconnector->base.dpms = DRM_MODE_DPMS_OFF;
	aconnector->hpd.hpd = AMDGPU_HPD_NONE; /* not used */
8395
	aconnector->audio_inst = -1;
8396 8397
	mutex_init(&aconnector->hpd_lock);

8398 8399
	/*
	 * configure support HPD hot plug connector_>polled default value is 0
8400 8401
	 * which means HPD hot plug not supported
	 */
8402 8403 8404
	switch (connector_type) {
	case DRM_MODE_CONNECTOR_HDMIA:
		aconnector->base.polled = DRM_CONNECTOR_POLL_HPD;
8405
		aconnector->base.ycbcr_420_allowed =
8406
			link->link_enc->features.hdmi_ycbcr420_supported ? true : false;
8407 8408 8409
		break;
	case DRM_MODE_CONNECTOR_DisplayPort:
		aconnector->base.polled = DRM_CONNECTOR_POLL_HPD;
8410
		link->link_enc = link_enc_cfg_get_link_enc(link);
8411
		ASSERT(link->link_enc);
8412 8413
		if (link->link_enc)
			aconnector->base.ycbcr_420_allowed =
8414
			link->link_enc->features.dp_ycbcr420_supported ? true : false;
8415 8416 8417 8418 8419 8420 8421 8422 8423 8424 8425 8426 8427 8428 8429 8430 8431 8432 8433 8434 8435
		break;
	case DRM_MODE_CONNECTOR_DVID:
		aconnector->base.polled = DRM_CONNECTOR_POLL_HPD;
		break;
	default:
		break;
	}

	drm_object_attach_property(&aconnector->base.base,
				dm->ddev->mode_config.scaling_mode_property,
				DRM_MODE_SCALE_NONE);

	drm_object_attach_property(&aconnector->base.base,
				adev->mode_info.underscan_property,
				UNDERSCAN_OFF);
	drm_object_attach_property(&aconnector->base.base,
				adev->mode_info.underscan_hborder_property,
				0);
	drm_object_attach_property(&aconnector->base.base,
				adev->mode_info.underscan_vborder_property,
				0);
8436

8437 8438
	if (!aconnector->mst_port)
		drm_connector_attach_max_bpc_property(&aconnector->base, 8, 16);
8439

8440 8441 8442
	/* This defaults to the max in the range, but we want 8bpc for non-edp. */
	aconnector->base.state->max_bpc = (connector_type == DRM_MODE_CONNECTOR_eDP) ? 16 : 8;
	aconnector->base.state->max_requested_bpc = aconnector->base.state->max_bpc;
8443

8444
	if (connector_type == DRM_MODE_CONNECTOR_eDP &&
8445
	    (dc_is_dmcu_initialized(adev->dm.dc) || adev->dm.dc->ctx->dmub_srv)) {
8446 8447 8448
		drm_object_attach_property(&aconnector->base.base,
				adev->mode_info.abm_level_property, 0);
	}
8449 8450

	if (connector_type == DRM_MODE_CONNECTOR_HDMIA ||
8451 8452
	    connector_type == DRM_MODE_CONNECTOR_DisplayPort ||
	    connector_type == DRM_MODE_CONNECTOR_eDP) {
8453
		drm_connector_attach_hdr_output_metadata_property(&aconnector->base);
8454

8455 8456 8457
		if (!aconnector->mst_port)
			drm_connector_attach_vrr_capable_property(&aconnector->base);

8458
#ifdef CONFIG_DRM_AMD_DC_HDCP
8459
		if (adev->dm.hdcp_workqueue)
8460
			drm_connector_attach_content_protection_property(&aconnector->base, true);
8461
#endif
8462
	}
8463 8464
}

8465 8466
static int amdgpu_dm_i2c_xfer(struct i2c_adapter *i2c_adap,
			      struct i2c_msg *msgs, int num)
8467 8468 8469 8470 8471 8472 8473
{
	struct amdgpu_i2c_adapter *i2c = i2c_get_adapdata(i2c_adap);
	struct ddc_service *ddc_service = i2c->ddc_service;
	struct i2c_command cmd;
	int i;
	int result = -EIO;

8474
	cmd.payloads = kcalloc(num, sizeof(struct i2c_payload), GFP_KERNEL);
8475 8476 8477 8478 8479 8480 8481 8482 8483 8484 8485 8486 8487 8488 8489

	if (!cmd.payloads)
		return result;

	cmd.number_of_payloads = num;
	cmd.engine = I2C_COMMAND_ENGINE_DEFAULT;
	cmd.speed = 100;

	for (i = 0; i < num; i++) {
		cmd.payloads[i].write = !(msgs[i].flags & I2C_M_RD);
		cmd.payloads[i].address = msgs[i].addr;
		cmd.payloads[i].length = msgs[i].len;
		cmd.payloads[i].data = msgs[i].buf;
	}

8490 8491 8492
	if (dc_submit_i2c(
			ddc_service->ctx->dc,
			ddc_service->ddc_pin->hw_info.ddc_channel,
8493 8494 8495 8496 8497 8498 8499
			&cmd))
		result = num;

	kfree(cmd.payloads);
	return result;
}

8500
static u32 amdgpu_dm_i2c_func(struct i2c_adapter *adap)
8501 8502 8503 8504 8505 8506 8507 8508 8509
{
	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
}

static const struct i2c_algorithm amdgpu_dm_i2c_algo = {
	.master_xfer = amdgpu_dm_i2c_xfer,
	.functionality = amdgpu_dm_i2c_func,
};

8510 8511 8512 8513
static struct amdgpu_i2c_adapter *
create_i2c(struct ddc_service *ddc_service,
	   int link_index,
	   int *res)
8514 8515 8516 8517
{
	struct amdgpu_device *adev = ddc_service->ctx->driver_context;
	struct amdgpu_i2c_adapter *i2c;

8518
	i2c = kzalloc(sizeof(struct amdgpu_i2c_adapter), GFP_KERNEL);
8519 8520
	if (!i2c)
		return NULL;
8521 8522 8523 8524
	i2c->base.owner = THIS_MODULE;
	i2c->base.class = I2C_CLASS_DDC;
	i2c->base.dev.parent = &adev->pdev->dev;
	i2c->base.algo = &amdgpu_dm_i2c_algo;
8525
	snprintf(i2c->base.name, sizeof(i2c->base.name), "AMDGPU DM i2c hw bus %d", link_index);
8526 8527
	i2c_set_adapdata(&i2c->base, i2c);
	i2c->ddc_service = ddc_service;
8528 8529
	if (i2c->ddc_service->ddc_pin)
		i2c->ddc_service->ddc_pin->hw_info.ddc_channel = link_index;
8530 8531 8532 8533

	return i2c;
}

8534

8535 8536
/*
 * Note: this function assumes that dc_link_detect() was called for the
8537 8538
 * dc_link which will be represented by this aconnector.
 */
8539 8540 8541 8542
static int amdgpu_dm_connector_init(struct amdgpu_display_manager *dm,
				    struct amdgpu_dm_connector *aconnector,
				    uint32_t link_index,
				    struct amdgpu_encoder *aencoder)
8543 8544 8545 8546 8547 8548
{
	int res = 0;
	int connector_type;
	struct dc *dc = dm->dc;
	struct dc_link *link = dc_get_link_at_index(dc, link_index);
	struct amdgpu_i2c_adapter *i2c;
8549 8550

	link->priv = aconnector;
8551

8552
	DRM_DEBUG_DRIVER("%s()\n", __func__);
8553 8554

	i2c = create_i2c(link->ddc, link->link_index, &res);
8555 8556 8557 8558 8559
	if (!i2c) {
		DRM_ERROR("Failed to create i2c adapter data\n");
		return -ENOMEM;
	}

8560 8561 8562 8563 8564 8565 8566 8567 8568 8569
	aconnector->i2c = i2c;
	res = i2c_add_adapter(&i2c->base);

	if (res) {
		DRM_ERROR("Failed to register hw i2c %d\n", link->link_index);
		goto out_free;
	}

	connector_type = to_drm_connector_type(link->connector_signal);

8570
	res = drm_connector_init_with_ddc(
8571 8572 8573
			dm->ddev,
			&aconnector->base,
			&amdgpu_dm_connector_funcs,
8574 8575
			connector_type,
			&i2c->base);
8576 8577 8578 8579 8580 8581 8582 8583 8584 8585 8586 8587 8588 8589 8590 8591 8592 8593

	if (res) {
		DRM_ERROR("connector_init failed\n");
		aconnector->connector_id = -1;
		goto out_free;
	}

	drm_connector_helper_add(
			&aconnector->base,
			&amdgpu_dm_connector_helper_funcs);

	amdgpu_dm_connector_init_helper(
		dm,
		aconnector,
		connector_type,
		link,
		link_index);

8594
	drm_connector_attach_encoder(
8595 8596 8597 8598
		&aconnector->base, &aencoder->base);

	if (connector_type == DRM_MODE_CONNECTOR_DisplayPort
		|| connector_type == DRM_MODE_CONNECTOR_eDP)
8599
		amdgpu_dm_initialize_dp_connector(dm, aconnector, link->link_index);
8600 8601 8602 8603 8604 8605 8606 8607 8608 8609 8610 8611 8612 8613 8614 8615 8616 8617 8618 8619 8620 8621 8622 8623 8624 8625 8626 8627

out_free:
	if (res) {
		kfree(i2c);
		aconnector->i2c = NULL;
	}
	return res;
}

int amdgpu_dm_get_encoder_crtc_mask(struct amdgpu_device *adev)
{
	switch (adev->mode_info.num_crtc) {
	case 1:
		return 0x1;
	case 2:
		return 0x3;
	case 3:
		return 0x7;
	case 4:
		return 0xf;
	case 5:
		return 0x1f;
	case 6:
	default:
		return 0x3f;
	}
}

8628 8629 8630
static int amdgpu_dm_encoder_init(struct drm_device *dev,
				  struct amdgpu_encoder *aencoder,
				  uint32_t link_index)
8631
{
8632
	struct amdgpu_device *adev = drm_to_adev(dev);
8633 8634 8635 8636 8637 8638 8639 8640 8641 8642 8643 8644 8645 8646 8647 8648 8649 8650 8651

	int res = drm_encoder_init(dev,
				   &aencoder->base,
				   &amdgpu_dm_encoder_funcs,
				   DRM_MODE_ENCODER_TMDS,
				   NULL);

	aencoder->base.possible_crtcs = amdgpu_dm_get_encoder_crtc_mask(adev);

	if (!res)
		aencoder->encoder_id = link_index;
	else
		aencoder->encoder_id = -1;

	drm_encoder_helper_add(&aencoder->base, &amdgpu_dm_encoder_helper_funcs);

	return res;
}

8652 8653 8654
static void manage_dm_interrupts(struct amdgpu_device *adev,
				 struct amdgpu_crtc *acrtc,
				 bool enable)
8655 8656
{
	/*
8657 8658 8659 8660
	 * We have no guarantee that the frontend index maps to the same
	 * backend index - some even map to more than one.
	 *
	 * TODO: Use a different interrupt or check DC itself for the mapping.
8661 8662
	 */
	int irq_type =
8663
		amdgpu_display_crtc_idx_to_irq_type(
8664 8665 8666 8667 8668 8669 8670 8671 8672
			adev,
			acrtc->crtc_id);

	if (enable) {
		drm_crtc_vblank_on(&acrtc->base);
		amdgpu_irq_get(
			adev,
			&adev->pageflip_irq,
			irq_type);
8673 8674 8675 8676 8677 8678
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
		amdgpu_irq_get(
			adev,
			&adev->vline0_irq,
			irq_type);
#endif
8679
	} else {
8680 8681 8682 8683 8684 8685
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
		amdgpu_irq_put(
			adev,
			&adev->vline0_irq,
			irq_type);
#endif
8686 8687 8688 8689 8690 8691 8692 8693
		amdgpu_irq_put(
			adev,
			&adev->pageflip_irq,
			irq_type);
		drm_crtc_vblank_off(&acrtc->base);
	}
}

8694 8695 8696 8697 8698 8699 8700 8701 8702 8703 8704 8705 8706
static void dm_update_pflip_irq_state(struct amdgpu_device *adev,
				      struct amdgpu_crtc *acrtc)
{
	int irq_type =
		amdgpu_display_crtc_idx_to_irq_type(adev, acrtc->crtc_id);

	/**
	 * This reads the current state for the IRQ and force reapplies
	 * the setting to hardware.
	 */
	amdgpu_irq_update(adev, &adev->pageflip_irq, irq_type);
}

8707 8708 8709
static bool
is_scaling_state_different(const struct dm_connector_state *dm_state,
			   const struct dm_connector_state *old_dm_state)
8710 8711 8712 8713 8714 8715 8716 8717 8718
{
	if (dm_state->scaling != old_dm_state->scaling)
		return true;
	if (!dm_state->underscan_enable && old_dm_state->underscan_enable) {
		if (old_dm_state->underscan_hborder != 0 && old_dm_state->underscan_vborder != 0)
			return true;
	} else  if (dm_state->underscan_enable && !old_dm_state->underscan_enable) {
		if (dm_state->underscan_hborder != 0 && dm_state->underscan_vborder != 0)
			return true;
8719 8720 8721
	} else if (dm_state->underscan_hborder != old_dm_state->underscan_hborder ||
		   dm_state->underscan_vborder != old_dm_state->underscan_vborder)
		return true;
8722 8723 8724
	return false;
}

8725 8726 8727 8728 8729 8730
#ifdef CONFIG_DRM_AMD_DC_HDCP
static bool is_content_protection_different(struct drm_connector_state *state,
					    const struct drm_connector_state *old_state,
					    const struct drm_connector *connector, struct hdcp_workqueue *hdcp_w)
{
	struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);
8731
	struct dm_connector_state *dm_con_state = to_dm_connector_state(connector->state);
8732

8733
	/* Handle: Type0/1 change */
8734 8735 8736 8737 8738 8739
	if (old_state->hdcp_content_type != state->hdcp_content_type &&
	    state->content_protection != DRM_MODE_CONTENT_PROTECTION_UNDESIRED) {
		state->content_protection = DRM_MODE_CONTENT_PROTECTION_DESIRED;
		return true;
	}

8740 8741 8742 8743
	/* CP is being re enabled, ignore this
	 *
	 * Handles:	ENABLED -> DESIRED
	 */
8744 8745 8746 8747 8748 8749
	if (old_state->content_protection == DRM_MODE_CONTENT_PROTECTION_ENABLED &&
	    state->content_protection == DRM_MODE_CONTENT_PROTECTION_DESIRED) {
		state->content_protection = DRM_MODE_CONTENT_PROTECTION_ENABLED;
		return false;
	}

8750 8751 8752 8753
	/* S3 resume case, since old state will always be 0 (UNDESIRED) and the restored state will be ENABLED
	 *
	 * Handles:	UNDESIRED -> ENABLED
	 */
8754 8755 8756 8757
	if (old_state->content_protection == DRM_MODE_CONTENT_PROTECTION_UNDESIRED &&
	    state->content_protection == DRM_MODE_CONTENT_PROTECTION_ENABLED)
		state->content_protection = DRM_MODE_CONTENT_PROTECTION_DESIRED;

8758 8759 8760 8761 8762 8763 8764 8765 8766 8767 8768 8769 8770 8771 8772 8773 8774 8775 8776 8777
	/* Stream removed and re-enabled
	 *
	 * Can sometimes overlap with the HPD case,
	 * thus set update_hdcp to false to avoid
	 * setting HDCP multiple times.
	 *
	 * Handles:	DESIRED -> DESIRED (Special case)
	 */
	if (!(old_state->crtc && old_state->crtc->enabled) &&
		state->crtc && state->crtc->enabled &&
		connector->state->content_protection == DRM_MODE_CONTENT_PROTECTION_DESIRED) {
		dm_con_state->update_hdcp = false;
		return true;
	}

	/* Hot-plug, headless s3, dpms
	 *
	 * Only start HDCP if the display is connected/enabled.
	 * update_hdcp flag will be set to false until the next
	 * HPD comes in.
8778 8779
	 *
	 * Handles:	DESIRED -> DESIRED (Special case)
8780
	 */
8781 8782 8783
	if (dm_con_state->update_hdcp && state->content_protection == DRM_MODE_CONTENT_PROTECTION_DESIRED &&
	    connector->dpms == DRM_MODE_DPMS_ON && aconnector->dc_sink != NULL) {
		dm_con_state->update_hdcp = false;
8784
		return true;
8785
	}
8786

8787 8788 8789 8790 8791
	/*
	 * Handles:	UNDESIRED -> UNDESIRED
	 *		DESIRED -> DESIRED
	 *		ENABLED -> ENABLED
	 */
8792 8793 8794
	if (old_state->content_protection == state->content_protection)
		return false;

8795 8796 8797 8798 8799
	/*
	 * Handles:	UNDESIRED -> DESIRED
	 *		DESIRED -> UNDESIRED
	 *		ENABLED -> UNDESIRED
	 */
8800
	if (state->content_protection != DRM_MODE_CONTENT_PROTECTION_ENABLED)
8801 8802
		return true;

8803 8804 8805
	/*
	 * Handles:	DESIRED -> ENABLED
	 */
8806 8807 8808 8809
	return false;
}

#endif
8810 8811 8812
static void remove_stream(struct amdgpu_device *adev,
			  struct amdgpu_crtc *acrtc,
			  struct dc_stream_state *stream)
8813 8814 8815 8816 8817 8818 8819
{
	/* this is the update mode case */

	acrtc->otg_inst = -1;
	acrtc->enabled = false;
}

8820 8821
static int get_cursor_position(struct drm_plane *plane, struct drm_crtc *crtc,
			       struct dc_cursor_position *position)
8822
{
8823
	struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
8824 8825 8826
	int x, y;
	int xorigin = 0, yorigin = 0;

8827
	if (!crtc || !plane->state->fb)
8828 8829 8830 8831 8832 8833 8834 8835 8836 8837 8838 8839 8840
		return 0;

	if ((plane->state->crtc_w > amdgpu_crtc->max_cursor_width) ||
	    (plane->state->crtc_h > amdgpu_crtc->max_cursor_height)) {
		DRM_ERROR("%s: bad cursor width or height %d x %d\n",
			  __func__,
			  plane->state->crtc_w,
			  plane->state->crtc_h);
		return -EINVAL;
	}

	x = plane->state->crtc_x;
	y = plane->state->crtc_y;
8841

8842 8843 8844 8845
	if (x <= -amdgpu_crtc->max_cursor_width ||
	    y <= -amdgpu_crtc->max_cursor_height)
		return 0;

8846 8847 8848 8849 8850 8851 8852 8853 8854
	if (x < 0) {
		xorigin = min(-x, amdgpu_crtc->max_cursor_width - 1);
		x = 0;
	}
	if (y < 0) {
		yorigin = min(-y, amdgpu_crtc->max_cursor_height - 1);
		y = 0;
	}
	position->enable = true;
8855
	position->translate_by_source = true;
8856 8857 8858 8859 8860 8861 8862 8863
	position->x = x;
	position->y = y;
	position->x_hotspot = xorigin;
	position->y_hotspot = yorigin;

	return 0;
}

8864 8865
static void handle_cursor_update(struct drm_plane *plane,
				 struct drm_plane_state *old_plane_state)
8866
{
8867
	struct amdgpu_device *adev = drm_to_adev(plane->dev);
8868 8869 8870 8871 8872
	struct amdgpu_framebuffer *afb = to_amdgpu_framebuffer(plane->state->fb);
	struct drm_crtc *crtc = afb ? plane->state->crtc : old_plane_state->crtc;
	struct dm_crtc_state *crtc_state = crtc ? to_dm_crtc_state(crtc->state) : NULL;
	struct amdgpu_crtc *amdgpu_crtc = to_amdgpu_crtc(crtc);
	uint64_t address = afb ? afb->address : 0;
8873
	struct dc_cursor_position position = {0};
8874 8875 8876
	struct dc_cursor_attributes attributes;
	int ret;

8877 8878 8879
	if (!plane->state->fb && !old_plane_state->fb)
		return;

8880
	DC_LOG_CURSOR("%s: crtc_id=%d with size %d to %d\n",
8881 8882 8883 8884
		      __func__,
		      amdgpu_crtc->crtc_id,
		      plane->state->crtc_w,
		      plane->state->crtc_h);
8885 8886 8887 8888 8889 8890 8891

	ret = get_cursor_position(plane, crtc, &position);
	if (ret)
		return;

	if (!position.enable) {
		/* turn off cursor */
8892 8893
		if (crtc_state && crtc_state->stream) {
			mutex_lock(&adev->dm.dc_lock);
8894 8895
			dc_stream_set_cursor_position(crtc_state->stream,
						      &position);
8896 8897
			mutex_unlock(&adev->dm.dc_lock);
		}
8898
		return;
8899 8900
	}

8901 8902 8903
	amdgpu_crtc->cursor_width = plane->state->crtc_w;
	amdgpu_crtc->cursor_height = plane->state->crtc_h;

8904
	memset(&attributes, 0, sizeof(attributes));
8905 8906 8907 8908 8909 8910 8911 8912
	attributes.address.high_part = upper_32_bits(address);
	attributes.address.low_part  = lower_32_bits(address);
	attributes.width             = plane->state->crtc_w;
	attributes.height            = plane->state->crtc_h;
	attributes.color_format      = CURSOR_MODE_COLOR_PRE_MULTIPLIED_ALPHA;
	attributes.rotation_angle    = 0;
	attributes.attribute_flags.value = 0;

8913
	attributes.pitch = afb->base.pitches[0] / afb->base.format->cpp[0];
8914

8915
	if (crtc_state->stream) {
8916
		mutex_lock(&adev->dm.dc_lock);
8917 8918 8919
		if (!dc_stream_set_cursor_attributes(crtc_state->stream,
							 &attributes))
			DRM_ERROR("DC failed to set cursor attributes\n");
8920 8921 8922 8923

		if (!dc_stream_set_cursor_position(crtc_state->stream,
						   &position))
			DRM_ERROR("DC failed to set cursor position\n");
8924
		mutex_unlock(&adev->dm.dc_lock);
8925
	}
8926
}
8927 8928 8929 8930 8931 8932 8933 8934 8935 8936 8937 8938 8939 8940 8941

static void prepare_flip_isr(struct amdgpu_crtc *acrtc)
{

	assert_spin_locked(&acrtc->base.dev->event_lock);
	WARN_ON(acrtc->event);

	acrtc->event = acrtc->base.state->event;

	/* Set the flip status */
	acrtc->pflip_status = AMDGPU_FLIP_SUBMITTED;

	/* Mark this event as consumed */
	acrtc->base.state->event = NULL;

8942 8943
	DC_LOG_PFLIP("crtc:%d, pflip_stat:AMDGPU_FLIP_SUBMITTED\n",
		     acrtc->crtc_id);
8944 8945
}

8946 8947 8948
static void update_freesync_state_on_stream(
	struct amdgpu_display_manager *dm,
	struct dm_crtc_state *new_crtc_state,
8949 8950 8951
	struct dc_stream_state *new_stream,
	struct dc_plane_state *surface,
	u32 flip_timestamp_in_us)
8952
{
8953
	struct mod_vrr_params vrr_params;
8954
	struct dc_info_packet vrr_infopacket = {0};
8955
	struct amdgpu_device *adev = dm->adev;
8956
	struct amdgpu_crtc *acrtc = to_amdgpu_crtc(new_crtc_state->base.crtc);
8957
	unsigned long flags;
8958
	bool pack_sdp_v1_3 = false;
8959 8960 8961 8962 8963 8964 8965 8966 8967 8968 8969 8970

	if (!new_stream)
		return;

	/*
	 * TODO: Determine why min/max totals and vrefresh can be 0 here.
	 * For now it's sufficient to just guard against these conditions.
	 */

	if (!new_stream->timing.h_total || !new_stream->timing.v_total)
		return;

8971
	spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
8972
        vrr_params = acrtc->dm_irq_params.vrr_params;
8973

8974 8975 8976 8977 8978 8979 8980
	if (surface) {
		mod_freesync_handle_preflip(
			dm->freesync_module,
			surface,
			new_stream,
			flip_timestamp_in_us,
			&vrr_params);
8981 8982 8983 8984 8985

		if (adev->family < AMDGPU_FAMILY_AI &&
		    amdgpu_dm_vrr_active(new_crtc_state)) {
			mod_freesync_handle_v_update(dm->freesync_module,
						     new_stream, &vrr_params);
8986 8987 8988 8989 8990

			/* Need to call this before the frame ends. */
			dc_stream_adjust_vmin_vmax(dm->dc,
						   new_crtc_state->stream,
						   &vrr_params.adjust);
8991
		}
8992
	}
8993 8994 8995 8996

	mod_freesync_build_vrr_infopacket(
		dm->freesync_module,
		new_stream,
8997
		&vrr_params,
8998 8999
		PACKET_TYPE_VRR,
		TRANSFER_FUNC_UNKNOWN,
9000 9001
		&vrr_infopacket,
		pack_sdp_v1_3);
9002

9003
	new_crtc_state->freesync_timing_changed |=
9004
		(memcmp(&acrtc->dm_irq_params.vrr_params.adjust,
9005 9006
			&vrr_params.adjust,
			sizeof(vrr_params.adjust)) != 0);
9007

9008
	new_crtc_state->freesync_vrr_info_changed |=
9009 9010 9011 9012
		(memcmp(&new_crtc_state->vrr_infopacket,
			&vrr_infopacket,
			sizeof(vrr_infopacket)) != 0);

9013
	acrtc->dm_irq_params.vrr_params = vrr_params;
9014 9015
	new_crtc_state->vrr_infopacket = vrr_infopacket;

9016
	new_stream->adjust = acrtc->dm_irq_params.vrr_params.adjust;
9017 9018 9019 9020 9021 9022
	new_stream->vrr_infopacket = vrr_infopacket;

	if (new_crtc_state->freesync_vrr_info_changed)
		DRM_DEBUG_KMS("VRR packet update: crtc=%u enabled=%d state=%d",
			      new_crtc_state->base.crtc->base.id,
			      (int)new_crtc_state->base.vrr_enabled,
9023
			      (int)vrr_params.state);
9024

9025
	spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
9026 9027
}

9028
static void update_stream_irq_parameters(
9029 9030 9031 9032
	struct amdgpu_display_manager *dm,
	struct dm_crtc_state *new_crtc_state)
{
	struct dc_stream_state *new_stream = new_crtc_state->stream;
9033
	struct mod_vrr_params vrr_params;
9034
	struct mod_freesync_config config = new_crtc_state->freesync_config;
9035
	struct amdgpu_device *adev = dm->adev;
9036
	struct amdgpu_crtc *acrtc = to_amdgpu_crtc(new_crtc_state->base.crtc);
9037
	unsigned long flags;
9038 9039 9040 9041 9042 9043 9044 9045 9046 9047 9048

	if (!new_stream)
		return;

	/*
	 * TODO: Determine why min/max totals and vrefresh can be 0 here.
	 * For now it's sufficient to just guard against these conditions.
	 */
	if (!new_stream->timing.h_total || !new_stream->timing.v_total)
		return;

9049
	spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
9050
	vrr_params = acrtc->dm_irq_params.vrr_params;
9051

9052 9053 9054
	if (new_crtc_state->vrr_supported &&
	    config.min_refresh_in_uhz &&
	    config.max_refresh_in_uhz) {
9055 9056 9057 9058 9059 9060 9061 9062 9063 9064 9065 9066 9067 9068 9069 9070
		/*
		 * if freesync compatible mode was set, config.state will be set
		 * in atomic check
		 */
		if (config.state == VRR_STATE_ACTIVE_FIXED && config.fixed_refresh_in_uhz &&
		    (!drm_atomic_crtc_needs_modeset(&new_crtc_state->base) ||
		     new_crtc_state->freesync_config.state == VRR_STATE_ACTIVE_FIXED)) {
			vrr_params.max_refresh_in_uhz = config.max_refresh_in_uhz;
			vrr_params.min_refresh_in_uhz = config.min_refresh_in_uhz;
			vrr_params.fixed_refresh_in_uhz = config.fixed_refresh_in_uhz;
			vrr_params.state = VRR_STATE_ACTIVE_FIXED;
		} else {
			config.state = new_crtc_state->base.vrr_enabled ?
						     VRR_STATE_ACTIVE_VARIABLE :
						     VRR_STATE_INACTIVE;
		}
9071 9072 9073 9074 9075 9076 9077 9078 9079
	} else {
		config.state = VRR_STATE_UNSUPPORTED;
	}

	mod_freesync_build_vrr_params(dm->freesync_module,
				      new_stream,
				      &config, &vrr_params);

	new_crtc_state->freesync_timing_changed |=
9080 9081
		(memcmp(&acrtc->dm_irq_params.vrr_params.adjust,
			&vrr_params.adjust, sizeof(vrr_params.adjust)) != 0);
9082

9083 9084 9085 9086 9087
	new_crtc_state->freesync_config = config;
	/* Copy state for access from DM IRQ handler */
	acrtc->dm_irq_params.freesync_config = config;
	acrtc->dm_irq_params.active_planes = new_crtc_state->active_planes;
	acrtc->dm_irq_params.vrr_params = vrr_params;
9088
	spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
9089 9090
}

9091 9092 9093 9094 9095 9096 9097 9098 9099 9100 9101
static void amdgpu_dm_handle_vrr_transition(struct dm_crtc_state *old_state,
					    struct dm_crtc_state *new_state)
{
	bool old_vrr_active = amdgpu_dm_vrr_active(old_state);
	bool new_vrr_active = amdgpu_dm_vrr_active(new_state);

	if (!old_vrr_active && new_vrr_active) {
		/* Transition VRR inactive -> active:
		 * While VRR is active, we must not disable vblank irq, as a
		 * reenable after disable would compute bogus vblank/pflip
		 * timestamps if it likely happened inside display front-porch.
9102 9103 9104
		 *
		 * We also need vupdate irq for the actual core vblank handling
		 * at end of vblank.
9105
		 */
9106
		dm_set_vupdate_irq(new_state->base.crtc, true);
9107 9108 9109 9110 9111 9112 9113
		drm_crtc_vblank_get(new_state->base.crtc);
		DRM_DEBUG_DRIVER("%s: crtc=%u VRR off->on: Get vblank ref\n",
				 __func__, new_state->base.crtc->base.id);
	} else if (old_vrr_active && !new_vrr_active) {
		/* Transition VRR active -> inactive:
		 * Allow vblank irq disable again for fixed refresh rate.
		 */
9114
		dm_set_vupdate_irq(new_state->base.crtc, false);
9115 9116 9117 9118 9119 9120
		drm_crtc_vblank_put(new_state->base.crtc);
		DRM_DEBUG_DRIVER("%s: crtc=%u VRR on->off: Drop vblank ref\n",
				 __func__, new_state->base.crtc->base.id);
	}
}

9121 9122 9123
static void amdgpu_dm_commit_cursors(struct drm_atomic_state *state)
{
	struct drm_plane *plane;
9124
	struct drm_plane_state *old_plane_state;
9125 9126 9127 9128 9129 9130
	int i;

	/*
	 * TODO: Make this per-stream so we don't issue redundant updates for
	 * commits with multiple streams.
	 */
9131
	for_each_old_plane_in_state(state, plane, old_plane_state, i)
9132 9133 9134 9135
		if (plane->type == DRM_PLANE_TYPE_CURSOR)
			handle_cursor_update(plane, old_plane_state);
}

9136
static void amdgpu_dm_commit_planes(struct drm_atomic_state *state,
9137
				    struct dc_state *dc_state,
9138 9139 9140
				    struct drm_device *dev,
				    struct amdgpu_display_manager *dm,
				    struct drm_crtc *pcrtc,
9141
				    bool wait_for_vblank)
9142
{
9143
	uint32_t i;
9144
	uint64_t timestamp_ns;
9145
	struct drm_plane *plane;
9146
	struct drm_plane_state *old_plane_state, *new_plane_state;
9147
	struct amdgpu_crtc *acrtc_attach = to_amdgpu_crtc(pcrtc);
9148 9149 9150
	struct drm_crtc_state *new_pcrtc_state =
			drm_atomic_get_new_crtc_state(state, pcrtc);
	struct dm_crtc_state *acrtc_state = to_dm_crtc_state(new_pcrtc_state);
9151 9152
	struct dm_crtc_state *dm_old_crtc_state =
			to_dm_crtc_state(drm_atomic_get_old_crtc_state(state, pcrtc));
9153
	int planes_count = 0, vpos, hpos;
9154
	long r;
9155
	unsigned long flags;
9156
	struct amdgpu_bo *abo;
9157 9158
	uint32_t target_vblank, last_flip_vblank;
	bool vrr_active = amdgpu_dm_vrr_active(acrtc_state);
9159
	bool pflip_present = false;
9160 9161 9162 9163
	struct {
		struct dc_surface_update surface_updates[MAX_SURFACES];
		struct dc_plane_info plane_infos[MAX_SURFACES];
		struct dc_scaling_info scaling_infos[MAX_SURFACES];
9164
		struct dc_flip_addrs flip_addrs[MAX_SURFACES];
9165
		struct dc_stream_update stream_update;
9166
	} *bundle;
9167

9168
	bundle = kzalloc(sizeof(*bundle), GFP_KERNEL);
9169

9170 9171
	if (!bundle) {
		dm_error("Failed to allocate update bundle\n");
9172 9173
		goto cleanup;
	}
9174

9175 9176 9177 9178 9179 9180 9181 9182
	/*
	 * Disable the cursor first if we're disabling all the planes.
	 * It'll remain on the screen after the planes are re-enabled
	 * if we don't.
	 */
	if (acrtc_state->active_planes == 0)
		amdgpu_dm_commit_cursors(state);

9183
	/* update planes when needed */
9184
	for_each_oldnew_plane_in_state(state, plane, old_plane_state, new_plane_state, i) {
9185
		struct drm_crtc *crtc = new_plane_state->crtc;
9186
		struct drm_crtc_state *new_crtc_state;
9187
		struct drm_framebuffer *fb = new_plane_state->fb;
9188
		struct amdgpu_framebuffer *afb = (struct amdgpu_framebuffer *)fb;
9189
		bool plane_needs_flip;
9190
		struct dc_plane_state *dc_plane;
9191
		struct dm_plane_state *dm_new_plane_state = to_dm_plane_state(new_plane_state);
9192

9193 9194
		/* Cursor plane is handled after stream updates */
		if (plane->type == DRM_PLANE_TYPE_CURSOR)
9195 9196
			continue;

9197 9198 9199 9200 9201
		if (!fb || !crtc || pcrtc != crtc)
			continue;

		new_crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
		if (!new_crtc_state->active)
9202 9203
			continue;

9204
		dc_plane = dm_new_plane_state->dc_state;
9205

9206
		bundle->surface_updates[planes_count].surface = dc_plane;
9207
		if (new_pcrtc_state->color_mgmt_changed) {
9208 9209
			bundle->surface_updates[planes_count].gamma = dc_plane->gamma_correction;
			bundle->surface_updates[planes_count].in_transfer_func = dc_plane->in_transfer_func;
9210
			bundle->surface_updates[planes_count].gamut_remap_matrix = &dc_plane->gamut_remap_matrix;
9211
		}
9212

9213
		fill_dc_scaling_info(dm->adev, new_plane_state,
9214
				     &bundle->scaling_infos[planes_count]);
9215

9216 9217
		bundle->surface_updates[planes_count].scaling_info =
			&bundle->scaling_infos[planes_count];
9218

9219
		plane_needs_flip = old_plane_state->fb && new_plane_state->fb;
9220

9221
		pflip_present = pflip_present || plane_needs_flip;
9222

9223 9224 9225 9226
		if (!plane_needs_flip) {
			planes_count += 1;
			continue;
		}
9227

9228 9229
		abo = gem_to_amdgpu_bo(fb->obj[0]);

9230 9231 9232 9233 9234
		/*
		 * Wait for all fences on this FB. Do limited wait to avoid
		 * deadlock during GPU reset when this fence will not signal
		 * but we hold reservation lock for the BO.
		 */
9235 9236
		r = dma_resv_wait_timeout(abo->tbo.base.resv, true, false,
					  msecs_to_jiffies(5000));
9237
		if (unlikely(r <= 0))
9238
			DRM_ERROR("Waiting for fences timed out!");
9239

9240
		fill_dc_plane_info_and_addr(
9241
			dm->adev, new_plane_state,
9242
			afb->tiling_flags,
9243
			&bundle->plane_infos[planes_count],
9244
			&bundle->flip_addrs[planes_count].address,
9245
			afb->tmz_surface, false);
9246

9247
		DRM_DEBUG_ATOMIC("plane: id=%d dcc_en=%d\n",
9248 9249
				 new_plane_state->plane->index,
				 bundle->plane_infos[planes_count].dcc.enable);
9250 9251 9252

		bundle->surface_updates[planes_count].plane_info =
			&bundle->plane_infos[planes_count];
9253

9254 9255 9256 9257
		/*
		 * Only allow immediate flips for fast updates that don't
		 * change FB pitch, DCC state, rotation or mirroing.
		 */
9258
		bundle->flip_addrs[planes_count].flip_immediate =
9259
			crtc->state->async_flip &&
9260
			acrtc_state->update_type == UPDATE_TYPE_FAST;
9261

9262 9263 9264 9265
		timestamp_ns = ktime_get_ns();
		bundle->flip_addrs[planes_count].flip_timestamp_in_us = div_u64(timestamp_ns, 1000);
		bundle->surface_updates[planes_count].flip_addr = &bundle->flip_addrs[planes_count];
		bundle->surface_updates[planes_count].surface = dc_plane;
9266

9267 9268 9269 9270
		if (!bundle->surface_updates[planes_count].surface) {
			DRM_ERROR("No surface for CRTC: id=%d\n",
					acrtc_attach->crtc_id);
			continue;
9271 9272
		}

9273 9274 9275 9276 9277 9278 9279
		if (plane == pcrtc->primary)
			update_freesync_state_on_stream(
				dm,
				acrtc_state,
				acrtc_state->stream,
				dc_plane,
				bundle->flip_addrs[planes_count].flip_timestamp_in_us);
9280

9281
		DRM_DEBUG_ATOMIC("%s Flipping to hi: 0x%x, low: 0x%x\n",
9282 9283 9284
				 __func__,
				 bundle->flip_addrs[planes_count].address.grph.addr.high_part,
				 bundle->flip_addrs[planes_count].address.grph.addr.low_part);
9285 9286 9287

		planes_count += 1;

9288 9289
	}

9290
	if (pflip_present) {
9291 9292 9293 9294 9295 9296 9297
		if (!vrr_active) {
			/* Use old throttling in non-vrr fixed refresh rate mode
			 * to keep flip scheduling based on target vblank counts
			 * working in a backwards compatible way, e.g., for
			 * clients using the GLX_OML_sync_control extension or
			 * DRI3/Present extension with defined target_msc.
			 */
9298
			last_flip_vblank = amdgpu_get_vblank_counter_kms(pcrtc);
9299 9300 9301 9302 9303 9304 9305 9306 9307 9308 9309
		}
		else {
			/* For variable refresh rate mode only:
			 * Get vblank of last completed flip to avoid > 1 vrr
			 * flips per video frame by use of throttling, but allow
			 * flip programming anywhere in the possibly large
			 * variable vrr vblank interval for fine-grained flip
			 * timing control and more opportunity to avoid stutter
			 * on late submission of flips.
			 */
			spin_lock_irqsave(&pcrtc->dev->event_lock, flags);
9310
			last_flip_vblank = acrtc_attach->dm_irq_params.last_flip_vblank;
9311 9312 9313
			spin_unlock_irqrestore(&pcrtc->dev->event_lock, flags);
		}

9314
		target_vblank = last_flip_vblank + wait_for_vblank;
9315 9316 9317 9318 9319 9320 9321 9322 9323 9324 9325 9326

		/*
		 * Wait until we're out of the vertical blank period before the one
		 * targeted by the flip
		 */
		while ((acrtc_attach->enabled &&
			(amdgpu_display_get_crtc_scanoutpos(dm->ddev, acrtc_attach->crtc_id,
							    0, &vpos, &hpos, NULL,
							    NULL, &pcrtc->hwmode)
			 & (DRM_SCANOUTPOS_VALID | DRM_SCANOUTPOS_IN_VBLANK)) ==
			(DRM_SCANOUTPOS_VALID | DRM_SCANOUTPOS_IN_VBLANK) &&
			(int)(target_vblank -
9327
			  amdgpu_get_vblank_counter_kms(pcrtc)) > 0)) {
9328 9329 9330
			usleep_range(1000, 1100);
		}

9331 9332 9333 9334 9335 9336 9337 9338 9339
		/**
		 * Prepare the flip event for the pageflip interrupt to handle.
		 *
		 * This only works in the case where we've already turned on the
		 * appropriate hardware blocks (eg. HUBP) so in the transition case
		 * from 0 -> n planes we have to skip a hardware generated event
		 * and rely on sending it from software.
		 */
		if (acrtc_attach->base.state->event &&
9340 9341
		    acrtc_state->active_planes > 0 &&
		    !acrtc_state->force_dpms_off) {
9342 9343 9344 9345 9346 9347 9348 9349 9350 9351 9352 9353
			drm_crtc_vblank_get(pcrtc);

			spin_lock_irqsave(&pcrtc->dev->event_lock, flags);

			WARN_ON(acrtc_attach->pflip_status != AMDGPU_FLIP_NONE);
			prepare_flip_isr(acrtc_attach);

			spin_unlock_irqrestore(&pcrtc->dev->event_lock, flags);
		}

		if (acrtc_state->stream) {
			if (acrtc_state->freesync_vrr_info_changed)
9354
				bundle->stream_update.vrr_infopacket =
9355
					&acrtc_state->stream->vrr_infopacket;
9356 9357 9358
		}
	}

9359
	/* Update the planes if changed or disable if we don't have any. */
9360 9361
	if ((planes_count || acrtc_state->active_planes == 0) &&
		acrtc_state->stream) {
9362
#if defined(CONFIG_DRM_AMD_DC_DCN)
9363 9364 9365 9366
		/*
		 * If PSR or idle optimizations are enabled then flush out
		 * any pending work before hardware programming.
		 */
9367 9368
		if (dm->vblank_control_workqueue)
			flush_workqueue(dm->vblank_control_workqueue);
9369
#endif
9370

9371
		bundle->stream_update.stream = acrtc_state->stream;
9372
		if (new_pcrtc_state->mode_changed) {
9373 9374
			bundle->stream_update.src = acrtc_state->stream->src;
			bundle->stream_update.dst = acrtc_state->stream->dst;
9375 9376
		}

9377 9378 9379 9380 9381 9382 9383 9384 9385 9386 9387 9388
		if (new_pcrtc_state->color_mgmt_changed) {
			/*
			 * TODO: This isn't fully correct since we've actually
			 * already modified the stream in place.
			 */
			bundle->stream_update.gamut_remap =
				&acrtc_state->stream->gamut_remap_matrix;
			bundle->stream_update.output_csc_transform =
				&acrtc_state->stream->csc_color_matrix;
			bundle->stream_update.out_transfer_func =
				acrtc_state->stream->out_transfer_func;
		}
9389

9390
		acrtc_state->stream->abm_level = acrtc_state->abm_level;
9391
		if (acrtc_state->abm_level != dm_old_crtc_state->abm_level)
9392
			bundle->stream_update.abm_level = &acrtc_state->abm_level;
9393

9394 9395 9396 9397 9398
		/*
		 * If FreeSync state on the stream has changed then we need to
		 * re-adjust the min/max bounds now that DC doesn't handle this
		 * as part of commit.
		 */
9399
		if (is_dc_timing_adjust_needed(dm_old_crtc_state, acrtc_state)) {
9400 9401 9402
			spin_lock_irqsave(&pcrtc->dev->event_lock, flags);
			dc_stream_adjust_vmin_vmax(
				dm->dc, acrtc_state->stream,
9403
				&acrtc_attach->dm_irq_params.vrr_params.adjust);
9404 9405
			spin_unlock_irqrestore(&pcrtc->dev->event_lock, flags);
		}
9406
		mutex_lock(&dm->dc_lock);
R
Roman Li 已提交
9407
		if ((acrtc_state->update_type > UPDATE_TYPE_FAST) &&
9408
				acrtc_state->stream->link->psr_settings.psr_allow_active)
R
Roman Li 已提交
9409 9410
			amdgpu_dm_psr_disable(acrtc_state->stream);

9411
		dc_commit_updates_for_stream(dm->dc,
9412
						     bundle->surface_updates,
9413 9414
						     planes_count,
						     acrtc_state->stream,
9415 9416
						     &bundle->stream_update,
						     dc_state);
R
Roman Li 已提交
9417

9418 9419 9420 9421 9422 9423 9424 9425 9426 9427 9428 9429 9430 9431
		/**
		 * Enable or disable the interrupts on the backend.
		 *
		 * Most pipes are put into power gating when unused.
		 *
		 * When power gating is enabled on a pipe we lose the
		 * interrupt enablement state when power gating is disabled.
		 *
		 * So we need to update the IRQ control state in hardware
		 * whenever the pipe turns on (since it could be previously
		 * power gated) or off (since some pipes can't be power gated
		 * on some ASICs).
		 */
		if (dm_old_crtc_state->active_planes != acrtc_state->active_planes)
9432 9433
			dm_update_pflip_irq_state(drm_to_adev(dev),
						  acrtc_attach);
9434

R
Roman Li 已提交
9435
		if ((acrtc_state->update_type > UPDATE_TYPE_FAST) &&
9436
				acrtc_state->stream->link->psr_settings.psr_version != DC_PSR_VERSION_UNSUPPORTED &&
9437
				!acrtc_state->stream->link->psr_settings.psr_feature_enabled)
R
Roman Li 已提交
9438
			amdgpu_dm_link_setup_psr(acrtc_state->stream);
9439 9440 9441 9442 9443 9444

		/* Decrement skip count when PSR is enabled and we're doing fast updates. */
		if (acrtc_state->update_type == UPDATE_TYPE_FAST &&
		    acrtc_state->stream->link->psr_settings.psr_feature_enabled) {
			struct amdgpu_dm_connector *aconn =
				(struct amdgpu_dm_connector *)acrtc_state->stream->dm_stream_context;
R
Roman Li 已提交
9445 9446 9447

			if (aconn->psr_skip_count > 0)
				aconn->psr_skip_count--;
9448 9449 9450 9451 9452

			/* Allow PSR when skip count is 0. */
			acrtc_attach->dm_irq_params.allow_psr_entry = !aconn->psr_skip_count;
		} else {
			acrtc_attach->dm_irq_params.allow_psr_entry = false;
R
Roman Li 已提交
9453 9454
		}

9455
		mutex_unlock(&dm->dc_lock);
9456
	}
9457

9458 9459 9460 9461 9462 9463 9464
	/*
	 * Update cursor state *after* programming all the planes.
	 * This avoids redundant programming in the case where we're going
	 * to be disabling a single plane - those pipes are being disabled.
	 */
	if (acrtc_state->active_planes)
		amdgpu_dm_commit_cursors(state);
9465

9466
cleanup:
9467
	kfree(bundle);
9468 9469
}

9470 9471 9472
static void amdgpu_dm_commit_audio(struct drm_device *dev,
				   struct drm_atomic_state *state)
{
9473
	struct amdgpu_device *adev = drm_to_adev(dev);
9474 9475 9476 9477 9478 9479 9480 9481 9482 9483 9484 9485 9486 9487 9488 9489 9490 9491 9492 9493 9494 9495 9496 9497 9498 9499 9500 9501 9502 9503 9504 9505 9506 9507 9508 9509 9510 9511 9512 9513 9514 9515 9516 9517 9518 9519 9520 9521 9522 9523 9524 9525 9526 9527 9528 9529 9530 9531 9532 9533 9534 9535 9536 9537 9538 9539 9540 9541 9542 9543 9544
	struct amdgpu_dm_connector *aconnector;
	struct drm_connector *connector;
	struct drm_connector_state *old_con_state, *new_con_state;
	struct drm_crtc_state *new_crtc_state;
	struct dm_crtc_state *new_dm_crtc_state;
	const struct dc_stream_status *status;
	int i, inst;

	/* Notify device removals. */
	for_each_oldnew_connector_in_state(state, connector, old_con_state, new_con_state, i) {
		if (old_con_state->crtc != new_con_state->crtc) {
			/* CRTC changes require notification. */
			goto notify;
		}

		if (!new_con_state->crtc)
			continue;

		new_crtc_state = drm_atomic_get_new_crtc_state(
			state, new_con_state->crtc);

		if (!new_crtc_state)
			continue;

		if (!drm_atomic_crtc_needs_modeset(new_crtc_state))
			continue;

	notify:
		aconnector = to_amdgpu_dm_connector(connector);

		mutex_lock(&adev->dm.audio_lock);
		inst = aconnector->audio_inst;
		aconnector->audio_inst = -1;
		mutex_unlock(&adev->dm.audio_lock);

		amdgpu_dm_audio_eld_notify(adev, inst);
	}

	/* Notify audio device additions. */
	for_each_new_connector_in_state(state, connector, new_con_state, i) {
		if (!new_con_state->crtc)
			continue;

		new_crtc_state = drm_atomic_get_new_crtc_state(
			state, new_con_state->crtc);

		if (!new_crtc_state)
			continue;

		if (!drm_atomic_crtc_needs_modeset(new_crtc_state))
			continue;

		new_dm_crtc_state = to_dm_crtc_state(new_crtc_state);
		if (!new_dm_crtc_state->stream)
			continue;

		status = dc_stream_get_status(new_dm_crtc_state->stream);
		if (!status)
			continue;

		aconnector = to_amdgpu_dm_connector(connector);

		mutex_lock(&adev->dm.audio_lock);
		inst = status->audio_inst;
		aconnector->audio_inst = inst;
		mutex_unlock(&adev->dm.audio_lock);

		amdgpu_dm_audio_eld_notify(adev, inst);
	}
}

9545
/*
9546 9547 9548 9549 9550 9551 9552 9553 9554 9555
 * amdgpu_dm_crtc_copy_transient_flags - copy mirrored flags from DRM to DC
 * @crtc_state: the DRM CRTC state
 * @stream_state: the DC stream state.
 *
 * Copy the mirrored transient state flags from DRM, to DC. It is used to bring
 * a dc_stream_state's flags in sync with a drm_crtc_state's flags.
 */
static void amdgpu_dm_crtc_copy_transient_flags(struct drm_crtc_state *crtc_state,
						struct dc_stream_state *stream_state)
{
9556
	stream_state->mode_changed = drm_atomic_crtc_needs_modeset(crtc_state);
9557
}
9558

9559 9560 9561 9562 9563 9564 9565 9566
/**
 * amdgpu_dm_atomic_commit_tail() - AMDgpu DM's commit tail implementation.
 * @state: The atomic state to commit
 *
 * This will tell DC to commit the constructed DC state from atomic_check,
 * programming the hardware. Any failures here implies a hardware failure, since
 * atomic check should have filtered anything non-kosher.
 */
9567
static void amdgpu_dm_atomic_commit_tail(struct drm_atomic_state *state)
9568 9569
{
	struct drm_device *dev = state->dev;
9570
	struct amdgpu_device *adev = drm_to_adev(dev);
9571 9572
	struct amdgpu_display_manager *dm = &adev->dm;
	struct dm_atomic_state *dm_state;
9573
	struct dc_state *dc_state = NULL, *dc_state_temp = NULL;
9574
	uint32_t i, j;
9575
	struct drm_crtc *crtc;
9576
	struct drm_crtc_state *old_crtc_state, *new_crtc_state;
9577 9578 9579
	unsigned long flags;
	bool wait_for_vblank = true;
	struct drm_connector *connector;
9580
	struct drm_connector_state *old_con_state, *new_con_state;
9581
	struct dm_crtc_state *dm_old_crtc_state, *dm_new_crtc_state;
9582
	int crtc_disable_count = 0;
9583
	bool mode_set_reset_required = false;
9584

9585 9586
	trace_amdgpu_dm_atomic_commit_tail_begin(state);

9587 9588
	drm_atomic_helper_update_legacy_modeset_state(dev, state);

9589 9590 9591 9592 9593
	dm_state = dm_atomic_get_new_state(state);
	if (dm_state && dm_state->context) {
		dc_state = dm_state->context;
	} else {
		/* No state changes, retain current state. */
9594
		dc_state_temp = dc_create_state(dm->dc);
9595 9596 9597 9598
		ASSERT(dc_state_temp);
		dc_state = dc_state_temp;
		dc_resource_state_copy_construct_current(dm->dc, dc_state);
	}
9599

9600 9601 9602 9603 9604 9605 9606 9607 9608 9609 9610 9611 9612 9613
	for_each_oldnew_crtc_in_state (state, crtc, old_crtc_state,
				       new_crtc_state, i) {
		struct amdgpu_crtc *acrtc = to_amdgpu_crtc(crtc);

		dm_old_crtc_state = to_dm_crtc_state(old_crtc_state);

		if (old_crtc_state->active &&
		    (!new_crtc_state->active ||
		     drm_atomic_crtc_needs_modeset(new_crtc_state))) {
			manage_dm_interrupts(adev, acrtc, false);
			dc_stream_release(dm_old_crtc_state->stream);
		}
	}

9614 9615
	drm_atomic_helper_calc_timestamping_constants(state);

9616
	/* update changed items */
9617
	for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state, new_crtc_state, i) {
9618
		struct amdgpu_crtc *acrtc = to_amdgpu_crtc(crtc);
9619

9620 9621
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
		dm_old_crtc_state = to_dm_crtc_state(old_crtc_state);
9622

9623
		DRM_DEBUG_ATOMIC(
9624 9625 9626 9627
			"amdgpu_crtc id:%d crtc_state_flags: enable:%d, active:%d, "
			"planes_changed:%d, mode_changed:%d,active_changed:%d,"
			"connectors_changed:%d\n",
			acrtc->crtc_id,
9628 9629 9630 9631 9632 9633
			new_crtc_state->enable,
			new_crtc_state->active,
			new_crtc_state->planes_changed,
			new_crtc_state->mode_changed,
			new_crtc_state->active_changed,
			new_crtc_state->connectors_changed);
9634

9635 9636 9637 9638 9639 9640 9641 9642 9643 9644
		/* Disable cursor if disabling crtc */
		if (old_crtc_state->active && !new_crtc_state->active) {
			struct dc_cursor_position position;

			memset(&position, 0, sizeof(position));
			mutex_lock(&dm->dc_lock);
			dc_stream_set_cursor_position(dm_old_crtc_state->stream, &position);
			mutex_unlock(&dm->dc_lock);
		}

9645 9646 9647 9648 9649 9650
		/* Copy all transient state flags into dc state */
		if (dm_new_crtc_state->stream) {
			amdgpu_dm_crtc_copy_transient_flags(&dm_new_crtc_state->base,
							    dm_new_crtc_state->stream);
		}

9651 9652 9653 9654
		/* handles headless hotplug case, updating new_state and
		 * aconnector as needed
		 */

9655
		if (modeset_required(new_crtc_state, dm_new_crtc_state->stream, dm_old_crtc_state->stream)) {
9656

9657
			DRM_DEBUG_ATOMIC("Atomic commit: SET crtc id %d: [%p]\n", acrtc->crtc_id, acrtc);
9658

9659
			if (!dm_new_crtc_state->stream) {
9660
				/*
9661 9662 9663
				 * this could happen because of issues with
				 * userspace notifications delivery.
				 * In this case userspace tries to set mode on
9664 9665
				 * display which is disconnected in fact.
				 * dc_sink is NULL in this case on aconnector.
9666 9667 9668 9669 9670 9671 9672 9673 9674
				 * We expect reset mode will come soon.
				 *
				 * This can also happen when unplug is done
				 * during resume sequence ended
				 *
				 * In this case, we want to pretend we still
				 * have a sink to keep the pipe running so that
				 * hw state is consistent with the sw state
				 */
9675
				DRM_DEBUG_DRIVER("%s: Failed to create new stream for crtc %d\n",
9676 9677 9678 9679
						__func__, acrtc->base.base.id);
				continue;
			}

9680 9681
			if (dm_old_crtc_state->stream)
				remove_stream(adev, acrtc, dm_old_crtc_state->stream);
9682

9683 9684
			pm_runtime_get_noresume(dev->dev);

9685
			acrtc->enabled = true;
9686 9687
			acrtc->hw_mode = new_crtc_state->mode;
			crtc->hwmode = new_crtc_state->mode;
9688
			mode_set_reset_required = true;
9689
		} else if (modereset_required(new_crtc_state)) {
9690
			DRM_DEBUG_ATOMIC("Atomic commit: RESET. crtc id %d:[%p]\n", acrtc->crtc_id, acrtc);
9691
			/* i.e. reset mode */
9692
			if (dm_old_crtc_state->stream)
9693
				remove_stream(adev, acrtc, dm_old_crtc_state->stream);
9694

9695
			mode_set_reset_required = true;
9696 9697 9698
		}
	} /* for_each_crtc_in_state() */

9699
	if (dc_state) {
9700
		/* if there mode set or reset, disable eDP PSR */
9701
		if (mode_set_reset_required) {
9702
#if defined(CONFIG_DRM_AMD_DC_DCN)
9703 9704
			if (dm->vblank_control_workqueue)
				flush_workqueue(dm->vblank_control_workqueue);
9705
#endif
9706
			amdgpu_dm_psr_disable_all(dm);
9707
		}
9708

9709
		dm_enable_per_frame_crtc_master_sync(dc_state);
9710
		mutex_lock(&dm->dc_lock);
9711
		WARN_ON(!dc_commit_state(dm->dc, dc_state));
9712 9713 9714 9715 9716
#if defined(CONFIG_DRM_AMD_DC_DCN)
               /* Allow idle optimization when vblank count is 0 for display off */
               if (dm->active_vblank_irq_count == 0)
                   dc_allow_idle_optimizations(dm->dc,true);
#endif
9717
		mutex_unlock(&dm->dc_lock);
9718
	}
9719

9720
	for_each_new_crtc_in_state(state, crtc, new_crtc_state, i) {
9721
		struct amdgpu_crtc *acrtc = to_amdgpu_crtc(crtc);
9722

9723
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
9724

9725
		if (dm_new_crtc_state->stream != NULL) {
9726
			const struct dc_stream_status *status =
9727
					dc_stream_get_status(dm_new_crtc_state->stream);
9728

9729
			if (!status)
9730 9731
				status = dc_stream_get_status_from_state(dc_state,
									 dm_new_crtc_state->stream);
9732
			if (!status)
9733
				DC_ERR("got no status for stream %p on acrtc%p\n", dm_new_crtc_state->stream, acrtc);
9734 9735 9736 9737
			else
				acrtc->otg_inst = status->primary_otg_inst;
		}
	}
9738 9739 9740 9741 9742 9743 9744 9745 9746 9747 9748 9749 9750 9751 9752 9753 9754
#ifdef CONFIG_DRM_AMD_DC_HDCP
	for_each_oldnew_connector_in_state(state, connector, old_con_state, new_con_state, i) {
		struct dm_connector_state *dm_new_con_state = to_dm_connector_state(new_con_state);
		struct amdgpu_crtc *acrtc = to_amdgpu_crtc(dm_new_con_state->base.crtc);
		struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);

		new_crtc_state = NULL;

		if (acrtc)
			new_crtc_state = drm_atomic_get_new_crtc_state(state, &acrtc->base);

		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);

		if (dm_new_crtc_state && dm_new_crtc_state->stream == NULL &&
		    connector->state->content_protection == DRM_MODE_CONTENT_PROTECTION_ENABLED) {
			hdcp_reset_display(adev->dm.hdcp_workqueue, aconnector->dc_link->link_index);
			new_con_state->content_protection = DRM_MODE_CONTENT_PROTECTION_DESIRED;
9755
			dm_new_con_state->update_hdcp = true;
9756 9757 9758 9759
			continue;
		}

		if (is_content_protection_different(new_con_state, old_con_state, connector, adev->dm.hdcp_workqueue))
9760 9761
			hdcp_update_display(
				adev->dm.hdcp_workqueue, aconnector->dc_link->link_index, aconnector,
9762
				new_con_state->hdcp_content_type,
9763
				new_con_state->content_protection == DRM_MODE_CONTENT_PROTECTION_DESIRED);
9764 9765
	}
#endif
9766

9767
	/* Handle connector state changes */
9768
	for_each_oldnew_connector_in_state(state, connector, old_con_state, new_con_state, i) {
9769 9770 9771
		struct dm_connector_state *dm_new_con_state = to_dm_connector_state(new_con_state);
		struct dm_connector_state *dm_old_con_state = to_dm_connector_state(old_con_state);
		struct amdgpu_crtc *acrtc = to_amdgpu_crtc(dm_new_con_state->base.crtc);
9772
		struct dc_surface_update dummy_updates[MAX_SURFACES];
9773
		struct dc_stream_update stream_update;
9774
		struct dc_info_packet hdr_packet;
9775
		struct dc_stream_status *status = NULL;
9776
		bool abm_changed, hdr_changed, scaling_changed;
9777

9778
		memset(&dummy_updates, 0, sizeof(dummy_updates));
9779 9780
		memset(&stream_update, 0, sizeof(stream_update));

9781
		if (acrtc) {
9782
			new_crtc_state = drm_atomic_get_new_crtc_state(state, &acrtc->base);
9783 9784
			old_crtc_state = drm_atomic_get_old_crtc_state(state, &acrtc->base);
		}
9785

9786
		/* Skip any modesets/resets */
9787
		if (!acrtc || drm_atomic_crtc_needs_modeset(new_crtc_state))
9788 9789
			continue;

9790
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
9791 9792
		dm_old_crtc_state = to_dm_crtc_state(old_crtc_state);

9793 9794 9795 9796 9797 9798 9799
		scaling_changed = is_scaling_state_different(dm_new_con_state,
							     dm_old_con_state);

		abm_changed = dm_new_crtc_state->abm_level !=
			      dm_old_crtc_state->abm_level;

		hdr_changed =
9800
			!drm_connector_atomic_hdr_metadata_equal(old_con_state, new_con_state);
9801 9802

		if (!scaling_changed && !abm_changed && !hdr_changed)
9803
			continue;
9804

9805
		stream_update.stream = dm_new_crtc_state->stream;
9806
		if (scaling_changed) {
9807
			update_stream_scaling_settings(&dm_new_con_state->base.crtc->mode,
9808
					dm_new_con_state, dm_new_crtc_state->stream);
9809

9810 9811 9812 9813
			stream_update.src = dm_new_crtc_state->stream->src;
			stream_update.dst = dm_new_crtc_state->stream->dst;
		}

9814
		if (abm_changed) {
9815 9816 9817 9818
			dm_new_crtc_state->stream->abm_level = dm_new_crtc_state->abm_level;

			stream_update.abm_level = &dm_new_crtc_state->abm_level;
		}
9819

9820 9821 9822 9823 9824
		if (hdr_changed) {
			fill_hdr_info_packet(new_con_state, &hdr_packet);
			stream_update.hdr_static_metadata = &hdr_packet;
		}

9825
		status = dc_stream_get_status(dm_new_crtc_state->stream);
9826 9827 9828 9829

		if (WARN_ON(!status))
			continue;

9830
		WARN_ON(!status->plane_count);
9831

9832 9833 9834 9835 9836 9837
		/*
		 * TODO: DC refuses to perform stream updates without a dc_surface_update.
		 * Here we create an empty update on each plane.
		 * To fix this, DC should permit updating only stream properties.
		 */
		for (j = 0; j < status->plane_count; j++)
9838
			dummy_updates[j].surface = status->plane_states[0];
9839 9840 9841 9842


		mutex_lock(&dm->dc_lock);
		dc_commit_updates_for_stream(dm->dc,
9843
						     dummy_updates,
9844 9845
						     status->plane_count,
						     dm_new_crtc_state->stream,
9846 9847
						     &stream_update,
						     dc_state);
9848
		mutex_unlock(&dm->dc_lock);
9849 9850
	}

9851
	/* Count number of newly disabled CRTCs for dropping PM refs later. */
9852
	for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state,
9853
				      new_crtc_state, i) {
9854 9855 9856
		if (old_crtc_state->active && !new_crtc_state->active)
			crtc_disable_count++;

9857
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
9858
		dm_old_crtc_state = to_dm_crtc_state(old_crtc_state);
9859

9860 9861
		/* For freesync config update on crtc state and params for irq */
		update_stream_irq_parameters(dm, dm_new_crtc_state);
9862

9863 9864 9865
		/* Handle vrr on->off / off->on transitions */
		amdgpu_dm_handle_vrr_transition(dm_old_crtc_state,
						dm_new_crtc_state);
9866 9867
	}

9868 9869 9870 9871 9872 9873 9874 9875
	/**
	 * Enable interrupts for CRTCs that are newly enabled or went through
	 * a modeset. It was intentionally deferred until after the front end
	 * state was modified to wait until the OTG was on and so the IRQ
	 * handlers didn't access stale or invalid state.
	 */
	for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state, new_crtc_state, i) {
		struct amdgpu_crtc *acrtc = to_amdgpu_crtc(crtc);
9876
#ifdef CONFIG_DEBUG_FS
9877
		bool configure_crc = false;
9878
		enum amdgpu_dm_pipe_crc_source cur_crc_src;
9879 9880 9881 9882 9883 9884
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
		struct crc_rd_work *crc_rd_wrk = dm->crc_rd_wrk;
#endif
		spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
		cur_crc_src = acrtc->dm_irq_params.crc_src;
		spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
9885
#endif
9886 9887
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);

9888 9889 9890
		if (new_crtc_state->active &&
		    (!old_crtc_state->active ||
		     drm_atomic_crtc_needs_modeset(new_crtc_state))) {
9891 9892
			dc_stream_retain(dm_new_crtc_state->stream);
			acrtc->dm_irq_params.stream = dm_new_crtc_state->stream;
9893
			manage_dm_interrupts(adev, acrtc, true);
9894

9895
#ifdef CONFIG_DEBUG_FS
9896 9897 9898 9899 9900
			/**
			 * Frontend may have changed so reapply the CRC capture
			 * settings for the stream.
			 */
			dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
9901

9902
			if (amdgpu_dm_is_valid_crc_source(cur_crc_src)) {
9903 9904
				configure_crc = true;
#if defined(CONFIG_DRM_AMD_SECURE_DISPLAY)
9905 9906 9907 9908 9909 9910 9911 9912 9913
				if (amdgpu_dm_crc_window_is_activated(crtc)) {
					spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
					acrtc->dm_irq_params.crc_window.update_win = true;
					acrtc->dm_irq_params.crc_window.skip_frame_cnt = 2;
					spin_lock_irq(&crc_rd_wrk->crc_rd_work_lock);
					crc_rd_wrk->crtc = crtc;
					spin_unlock_irq(&crc_rd_wrk->crc_rd_work_lock);
					spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
				}
9914
#endif
9915
			}
9916

9917
			if (configure_crc)
9918 9919 9920
				if (amdgpu_dm_crtc_configure_crc_source(
					crtc, dm_new_crtc_state, cur_crc_src))
					DRM_DEBUG_DRIVER("Failed to configure crc source");
9921
#endif
9922 9923
		}
	}
9924

9925
	for_each_new_crtc_in_state(state, crtc, new_crtc_state, j)
9926
		if (new_crtc_state->async_flip)
9927 9928
			wait_for_vblank = false;

9929
	/* update planes when needed per crtc*/
9930
	for_each_new_crtc_in_state(state, crtc, new_crtc_state, j) {
9931
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
9932

9933
		if (dm_new_crtc_state->stream)
9934
			amdgpu_dm_commit_planes(state, dc_state, dev,
9935
						dm, crtc, wait_for_vblank);
9936 9937
	}

9938 9939 9940
	/* Update audio instances for each connector. */
	amdgpu_dm_commit_audio(dev, state);

9941 9942 9943
#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) ||		\
	defined(CONFIG_BACKLIGHT_CLASS_DEVICE_MODULE)
	/* restore the backlight level */
9944 9945 9946 9947 9948
	for (i = 0; i < dm->num_of_edps; i++) {
		if (dm->backlight_dev[i] &&
		    (amdgpu_dm_backlight_get_level(dm, i) != dm->brightness[i]))
			amdgpu_dm_backlight_set_level(dm, i, dm->brightness[i]);
	}
9949
#endif
9950 9951 9952 9953
	/*
	 * send vblank event on all events not handled in flip and
	 * mark consumed event for drm_atomic_helper_commit_hw_done
	 */
9954
	spin_lock_irqsave(&adev_to_drm(adev)->event_lock, flags);
9955
	for_each_new_crtc_in_state(state, crtc, new_crtc_state, i) {
9956

9957 9958
		if (new_crtc_state->event)
			drm_send_event_locked(dev, &new_crtc_state->event->base);
9959

9960
		new_crtc_state->event = NULL;
9961
	}
9962
	spin_unlock_irqrestore(&adev_to_drm(adev)->event_lock, flags);
9963

9964 9965
	/* Signal HW programming completion */
	drm_atomic_helper_commit_hw_done(state);
9966 9967

	if (wait_for_vblank)
9968
		drm_atomic_helper_wait_for_flip_done(dev, state);
9969 9970

	drm_atomic_helper_cleanup_planes(dev, state);
9971

9972 9973 9974 9975 9976
	/* return the stolen vga memory back to VRAM */
	if (!adev->mman.keep_stolen_vga_memory)
		amdgpu_bo_free_kernel(&adev->mman.stolen_vga_memory, NULL, NULL);
	amdgpu_bo_free_kernel(&adev->mman.stolen_extended_memory, NULL, NULL);

9977 9978
	/*
	 * Finally, drop a runtime PM reference for each newly disabled CRTC,
9979 9980 9981
	 * so we can put the GPU into runtime suspend if we're not driving any
	 * displays anymore
	 */
9982 9983
	for (i = 0; i < crtc_disable_count; i++)
		pm_runtime_put_autosuspend(dev->dev);
9984
	pm_runtime_mark_last_busy(dev->dev);
9985 9986 9987

	if (dc_state_temp)
		dc_release_state(dc_state_temp);
9988 9989 9990 9991 9992 9993 9994 9995 9996 9997 9998 9999 10000 10001 10002 10003 10004 10005 10006 10007 10008 10009 10010 10011 10012 10013 10014 10015
}


static int dm_force_atomic_commit(struct drm_connector *connector)
{
	int ret = 0;
	struct drm_device *ddev = connector->dev;
	struct drm_atomic_state *state = drm_atomic_state_alloc(ddev);
	struct amdgpu_crtc *disconnected_acrtc = to_amdgpu_crtc(connector->encoder->crtc);
	struct drm_plane *plane = disconnected_acrtc->base.primary;
	struct drm_connector_state *conn_state;
	struct drm_crtc_state *crtc_state;
	struct drm_plane_state *plane_state;

	if (!state)
		return -ENOMEM;

	state->acquire_ctx = ddev->mode_config.acquire_ctx;

	/* Construct an atomic state to restore previous display setting */

	/*
	 * Attach connectors to drm_atomic_state
	 */
	conn_state = drm_atomic_get_connector_state(state, connector);

	ret = PTR_ERR_OR_ZERO(conn_state);
	if (ret)
10016
		goto out;
10017 10018 10019 10020 10021 10022

	/* Attach crtc to drm_atomic_state*/
	crtc_state = drm_atomic_get_crtc_state(state, &disconnected_acrtc->base);

	ret = PTR_ERR_OR_ZERO(crtc_state);
	if (ret)
10023
		goto out;
10024 10025 10026 10027 10028 10029 10030 10031 10032

	/* force a restore */
	crtc_state->mode_changed = true;

	/* Attach plane to drm_atomic_state */
	plane_state = drm_atomic_get_plane_state(state, plane);

	ret = PTR_ERR_OR_ZERO(plane_state);
	if (ret)
10033
		goto out;
10034 10035 10036 10037

	/* Call commit internally with the state we just constructed */
	ret = drm_atomic_commit(state);

10038
out:
10039
	drm_atomic_state_put(state);
10040 10041
	if (ret)
		DRM_ERROR("Restoring old state failed with %i\n", ret);
10042 10043 10044 10045 10046

	return ret;
}

/*
10047 10048 10049
 * This function handles all cases when set mode does not come upon hotplug.
 * This includes when a display is unplugged then plugged back into the
 * same port and when running without usermode desktop manager supprot
10050
 */
10051 10052
void dm_restore_drm_connector_state(struct drm_device *dev,
				    struct drm_connector *connector)
10053
{
10054
	struct amdgpu_dm_connector *aconnector = to_amdgpu_dm_connector(connector);
10055 10056 10057 10058 10059 10060 10061
	struct amdgpu_crtc *disconnected_acrtc;
	struct dm_crtc_state *acrtc_state;

	if (!aconnector->dc_sink || !connector->state || !connector->encoder)
		return;

	disconnected_acrtc = to_amdgpu_crtc(connector->encoder->crtc);
10062 10063
	if (!disconnected_acrtc)
		return;
10064

10065 10066
	acrtc_state = to_dm_crtc_state(disconnected_acrtc->base.state);
	if (!acrtc_state->stream)
10067 10068 10069 10070 10071 10072 10073 10074 10075 10076 10077
		return;

	/*
	 * If the previous sink is not released and different from the current,
	 * we deduce we are in a state where we can not rely on usermode call
	 * to turn on the display, so we do it here
	 */
	if (acrtc_state->stream->sink != aconnector->dc_sink)
		dm_force_atomic_commit(&aconnector->base);
}

10078
/*
10079 10080 10081
 * Grabs all modesetting locks to serialize against any blocking commits,
 * Waits for completion of all non blocking commits.
 */
10082 10083
static int do_aquire_global_lock(struct drm_device *dev,
				 struct drm_atomic_state *state)
10084 10085 10086 10087 10088
{
	struct drm_crtc *crtc;
	struct drm_crtc_commit *commit;
	long ret;

10089 10090
	/*
	 * Adding all modeset locks to aquire_ctx will
10091 10092 10093 10094 10095 10096 10097 10098 10099 10100 10101 10102 10103 10104 10105 10106 10107 10108
	 * ensure that when the framework release it the
	 * extra locks we are locking here will get released to
	 */
	ret = drm_modeset_lock_all_ctx(dev, state->acquire_ctx);
	if (ret)
		return ret;

	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
		spin_lock(&crtc->commit_lock);
		commit = list_first_entry_or_null(&crtc->commit_list,
				struct drm_crtc_commit, commit_entry);
		if (commit)
			drm_crtc_commit_get(commit);
		spin_unlock(&crtc->commit_lock);

		if (!commit)
			continue;

10109 10110
		/*
		 * Make sure all pending HW programming completed and
10111 10112 10113 10114 10115 10116 10117 10118 10119 10120
		 * page flips done
		 */
		ret = wait_for_completion_interruptible_timeout(&commit->hw_done, 10*HZ);

		if (ret > 0)
			ret = wait_for_completion_interruptible_timeout(
					&commit->flip_done, 10*HZ);

		if (ret == 0)
			DRM_ERROR("[CRTC:%d:%s] hw_done or flip_done "
10121
				  "timed out\n", crtc->base.id, crtc->name);
10122 10123 10124 10125 10126 10127 10128

		drm_crtc_commit_put(commit);
	}

	return ret < 0 ? ret : 0;
}

10129 10130 10131
static void get_freesync_config_for_crtc(
	struct dm_crtc_state *new_crtc_state,
	struct dm_connector_state *new_con_state)
10132 10133 10134 10135
{
	struct mod_freesync_config config = {0};
	struct amdgpu_dm_connector *aconnector =
			to_amdgpu_dm_connector(new_con_state->base.connector);
10136
	struct drm_display_mode *mode = &new_crtc_state->base.mode;
10137
	int vrefresh = drm_mode_vrefresh(mode);
10138
	bool fs_vid_mode = false;
10139

10140
	new_crtc_state->vrr_supported = new_con_state->freesync_capable &&
10141 10142
					vrefresh >= aconnector->min_vfreq &&
					vrefresh <= aconnector->max_vfreq;
10143

10144 10145
	if (new_crtc_state->vrr_supported) {
		new_crtc_state->stream->ignore_msa_timing_param = true;
10146 10147 10148 10149
		fs_vid_mode = new_crtc_state->freesync_config.state == VRR_STATE_ACTIVE_FIXED;

		config.min_refresh_in_uhz = aconnector->min_vfreq * 1000000;
		config.max_refresh_in_uhz = aconnector->max_vfreq * 1000000;
10150
		config.vsif_supported = true;
10151
		config.btr = true;
10152

10153 10154 10155 10156 10157 10158 10159 10160 10161 10162 10163
		if (fs_vid_mode) {
			config.state = VRR_STATE_ACTIVE_FIXED;
			config.fixed_refresh_in_uhz = new_crtc_state->freesync_config.fixed_refresh_in_uhz;
			goto out;
		} else if (new_crtc_state->base.vrr_enabled) {
			config.state = VRR_STATE_ACTIVE_VARIABLE;
		} else {
			config.state = VRR_STATE_INACTIVE;
		}
	}
out:
10164 10165
	new_crtc_state->freesync_config = config;
}
10166

10167 10168 10169 10170
static void reset_freesync_config_for_crtc(
	struct dm_crtc_state *new_crtc_state)
{
	new_crtc_state->vrr_supported = false;
10171

10172 10173
	memset(&new_crtc_state->vrr_infopacket, 0,
	       sizeof(new_crtc_state->vrr_infopacket));
10174 10175
}

10176 10177 10178 10179 10180 10181 10182 10183 10184 10185 10186 10187 10188 10189 10190 10191 10192 10193 10194 10195 10196 10197 10198 10199 10200 10201 10202 10203 10204 10205 10206 10207 10208 10209 10210 10211 10212 10213 10214 10215 10216 10217 10218 10219
static bool
is_timing_unchanged_for_freesync(struct drm_crtc_state *old_crtc_state,
				 struct drm_crtc_state *new_crtc_state)
{
	struct drm_display_mode old_mode, new_mode;

	if (!old_crtc_state || !new_crtc_state)
		return false;

	old_mode = old_crtc_state->mode;
	new_mode = new_crtc_state->mode;

	if (old_mode.clock       == new_mode.clock &&
	    old_mode.hdisplay    == new_mode.hdisplay &&
	    old_mode.vdisplay    == new_mode.vdisplay &&
	    old_mode.htotal      == new_mode.htotal &&
	    old_mode.vtotal      != new_mode.vtotal &&
	    old_mode.hsync_start == new_mode.hsync_start &&
	    old_mode.vsync_start != new_mode.vsync_start &&
	    old_mode.hsync_end   == new_mode.hsync_end &&
	    old_mode.vsync_end   != new_mode.vsync_end &&
	    old_mode.hskew       == new_mode.hskew &&
	    old_mode.vscan       == new_mode.vscan &&
	    (old_mode.vsync_end - old_mode.vsync_start) ==
	    (new_mode.vsync_end - new_mode.vsync_start))
		return true;

	return false;
}

static void set_freesync_fixed_config(struct dm_crtc_state *dm_new_crtc_state) {
	uint64_t num, den, res;
	struct drm_crtc_state *new_crtc_state = &dm_new_crtc_state->base;

	dm_new_crtc_state->freesync_config.state = VRR_STATE_ACTIVE_FIXED;

	num = (unsigned long long)new_crtc_state->mode.clock * 1000 * 1000000;
	den = (unsigned long long)new_crtc_state->mode.htotal *
	      (unsigned long long)new_crtc_state->mode.vtotal;

	res = div_u64(num, den);
	dm_new_crtc_state->freesync_config.fixed_refresh_in_uhz = res;
}

10220
static int dm_update_crtc_state(struct amdgpu_display_manager *dm,
10221 10222 10223 10224 10225 10226
			 struct drm_atomic_state *state,
			 struct drm_crtc *crtc,
			 struct drm_crtc_state *old_crtc_state,
			 struct drm_crtc_state *new_crtc_state,
			 bool enable,
			 bool *lock_and_validation_needed)
10227
{
10228
	struct dm_atomic_state *dm_state = NULL;
10229
	struct dm_crtc_state *dm_old_crtc_state, *dm_new_crtc_state;
10230
	struct dc_stream_state *new_stream;
10231
	int ret = 0;
10232

10233 10234 10235 10236
	/*
	 * TODO Move this code into dm_crtc_atomic_check once we get rid of dc_validation_set
	 * update changed items
	 */
10237 10238 10239 10240
	struct amdgpu_crtc *acrtc = NULL;
	struct amdgpu_dm_connector *aconnector = NULL;
	struct drm_connector_state *drm_new_conn_state = NULL, *drm_old_conn_state = NULL;
	struct dm_connector_state *dm_new_conn_state = NULL, *dm_old_conn_state = NULL;
10241

10242
	new_stream = NULL;
10243

10244 10245 10246 10247
	dm_old_crtc_state = to_dm_crtc_state(old_crtc_state);
	dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
	acrtc = to_amdgpu_crtc(crtc);
	aconnector = amdgpu_dm_find_first_crtc_matching_connector(state, crtc);
10248

10249 10250 10251 10252 10253 10254 10255
	/* TODO This hack should go away */
	if (aconnector && enable) {
		/* Make sure fake sink is created in plug-in scenario */
		drm_new_conn_state = drm_atomic_get_new_connector_state(state,
							    &aconnector->base);
		drm_old_conn_state = drm_atomic_get_old_connector_state(state,
							    &aconnector->base);
10256

10257 10258 10259 10260
		if (IS_ERR(drm_new_conn_state)) {
			ret = PTR_ERR_OR_ZERO(drm_new_conn_state);
			goto fail;
		}
10261

10262 10263
		dm_new_conn_state = to_dm_connector_state(drm_new_conn_state);
		dm_old_conn_state = to_dm_connector_state(drm_old_conn_state);
10264

10265 10266 10267
		if (!drm_atomic_crtc_needs_modeset(new_crtc_state))
			goto skip_modeset;

10268 10269 10270 10271
		new_stream = create_validate_stream_for_sink(aconnector,
							     &new_crtc_state->mode,
							     dm_new_conn_state,
							     dm_old_crtc_state->stream);
10272

10273 10274 10275 10276 10277 10278
		/*
		 * we can have no stream on ACTION_SET if a display
		 * was disconnected during S3, in this case it is not an
		 * error, the OS will be updated after detection, and
		 * will do the right thing on next atomic commit
		 */
10279

10280 10281 10282 10283 10284 10285
		if (!new_stream) {
			DRM_DEBUG_DRIVER("%s: Failed to create new stream for crtc %d\n",
					__func__, acrtc->base.base.id);
			ret = -ENOMEM;
			goto fail;
		}
10286

10287 10288 10289 10290 10291 10292 10293
		/*
		 * TODO: Check VSDB bits to decide whether this should
		 * be enabled or not.
		 */
		new_stream->triggered_crtc_reset.enabled =
			dm->force_timing_sync;

10294
		dm_new_crtc_state->abm_level = dm_new_conn_state->abm_level;
10295

10296 10297 10298 10299 10300
		ret = fill_hdr_info_packet(drm_new_conn_state,
					   &new_stream->hdr_static_metadata);
		if (ret)
			goto fail;

10301 10302 10303 10304 10305 10306 10307 10308 10309
		/*
		 * If we already removed the old stream from the context
		 * (and set the new stream to NULL) then we can't reuse
		 * the old stream even if the stream and scaling are unchanged.
		 * We'll hit the BUG_ON and black screen.
		 *
		 * TODO: Refactor this function to allow this check to work
		 * in all conditions.
		 */
10310
		if (dm_new_crtc_state->stream &&
10311 10312 10313
		    is_timing_unchanged_for_freesync(new_crtc_state, old_crtc_state))
			goto skip_modeset;

10314 10315
		if (dm_new_crtc_state->stream &&
		    dc_is_stream_unchanged(new_stream, dm_old_crtc_state->stream) &&
10316 10317 10318 10319
		    dc_is_stream_scaling_unchanged(new_stream, dm_old_crtc_state->stream)) {
			new_crtc_state->mode_changed = false;
			DRM_DEBUG_DRIVER("Mode change not required, setting mode_changed to %d",
					 new_crtc_state->mode_changed);
10320
		}
10321
	}
10322

10323
	/* mode_changed flag may get updated above, need to check again */
10324 10325
	if (!drm_atomic_crtc_needs_modeset(new_crtc_state))
		goto skip_modeset;
10326

10327
	DRM_DEBUG_ATOMIC(
10328 10329 10330 10331 10332 10333 10334 10335 10336 10337
		"amdgpu_crtc id:%d crtc_state_flags: enable:%d, active:%d, "
		"planes_changed:%d, mode_changed:%d,active_changed:%d,"
		"connectors_changed:%d\n",
		acrtc->crtc_id,
		new_crtc_state->enable,
		new_crtc_state->active,
		new_crtc_state->planes_changed,
		new_crtc_state->mode_changed,
		new_crtc_state->active_changed,
		new_crtc_state->connectors_changed);
10338

10339 10340
	/* Remove stream for any changed/disabled CRTC */
	if (!enable) {
10341

10342 10343
		if (!dm_old_crtc_state->stream)
			goto skip_modeset;
10344

10345
		if (dm_new_crtc_state->stream &&
10346 10347 10348 10349 10350 10351 10352 10353 10354 10355 10356
		    is_timing_unchanged_for_freesync(new_crtc_state,
						     old_crtc_state)) {
			new_crtc_state->mode_changed = false;
			DRM_DEBUG_DRIVER(
				"Mode change not required for front porch change, "
				"setting mode_changed to %d",
				new_crtc_state->mode_changed);

			set_freesync_fixed_config(dm_new_crtc_state);

			goto skip_modeset;
10357
		} else if (aconnector &&
10358 10359
			   is_freesync_video_mode(&new_crtc_state->mode,
						  aconnector)) {
10360 10361 10362 10363 10364 10365
			struct drm_display_mode *high_mode;

			high_mode = get_highest_refresh_rate_mode(aconnector, false);
			if (!drm_mode_equal(&new_crtc_state->mode, high_mode)) {
				set_freesync_fixed_config(dm_new_crtc_state);
			}
10366 10367
		}

10368 10369 10370
		ret = dm_atomic_get_state(state, &dm_state);
		if (ret)
			goto fail;
10371

10372 10373
		DRM_DEBUG_DRIVER("Disabling DRM crtc: %d\n",
				crtc->base.id);
10374

10375 10376 10377 10378 10379 10380 10381 10382
		/* i.e. reset mode */
		if (dc_remove_stream_from_ctx(
				dm->dc,
				dm_state->context,
				dm_old_crtc_state->stream) != DC_OK) {
			ret = -EINVAL;
			goto fail;
		}
10383

10384 10385
		dc_stream_release(dm_old_crtc_state->stream);
		dm_new_crtc_state->stream = NULL;
10386

10387
		reset_freesync_config_for_crtc(dm_new_crtc_state);
10388

10389
		*lock_and_validation_needed = true;
10390

10391 10392 10393 10394 10395 10396 10397 10398
	} else {/* Add stream for any updated/enabled CRTC */
		/*
		 * Quick fix to prevent NULL pointer on new_stream when
		 * added MST connectors not found in existing crtc_state in the chained mode
		 * TODO: need to dig out the root cause of that
		 */
		if (!aconnector || (!aconnector->dc_sink && aconnector->mst_port))
			goto skip_modeset;
10399

10400 10401
		if (modereset_required(new_crtc_state))
			goto skip_modeset;
10402

10403 10404
		if (modeset_required(new_crtc_state, new_stream,
				     dm_old_crtc_state->stream)) {
10405

10406
			WARN_ON(dm_new_crtc_state->stream);
10407

10408 10409 10410
			ret = dm_atomic_get_state(state, &dm_state);
			if (ret)
				goto fail;
10411

10412
			dm_new_crtc_state->stream = new_stream;
10413

10414
			dc_stream_retain(new_stream);
10415

10416 10417
			DRM_DEBUG_ATOMIC("Enabling DRM crtc: %d\n",
					 crtc->base.id);
10418

10419 10420 10421 10422 10423 10424
			if (dc_add_stream_to_ctx(
					dm->dc,
					dm_state->context,
					dm_new_crtc_state->stream) != DC_OK) {
				ret = -EINVAL;
				goto fail;
10425 10426
			}

10427 10428 10429
			*lock_and_validation_needed = true;
		}
	}
10430

10431 10432 10433 10434
skip_modeset:
	/* Release extra reference */
	if (new_stream)
		 dc_stream_release(new_stream);
10435

10436 10437 10438 10439
	/*
	 * We want to do dc stream updates that do not require a
	 * full modeset below.
	 */
10440
	if (!(enable && aconnector && new_crtc_state->active))
10441 10442 10443 10444 10445 10446 10447 10448 10449 10450
		return 0;
	/*
	 * Given above conditions, the dc state cannot be NULL because:
	 * 1. We're in the process of enabling CRTCs (just been added
	 *    to the dc context, or already is on the context)
	 * 2. Has a valid connector attached, and
	 * 3. Is currently active and enabled.
	 * => The dc stream state currently exists.
	 */
	BUG_ON(dm_new_crtc_state->stream == NULL);
10451

10452
	/* Scaling or underscan settings */
10453 10454
	if (is_scaling_state_different(dm_old_conn_state, dm_new_conn_state) ||
				drm_atomic_crtc_needs_modeset(new_crtc_state))
10455 10456
		update_stream_scaling_settings(
			&new_crtc_state->mode, dm_new_conn_state, dm_new_crtc_state->stream);
10457

10458 10459 10460
	/* ABM settings */
	dm_new_crtc_state->abm_level = dm_new_conn_state->abm_level;

10461 10462 10463 10464 10465 10466
	/*
	 * Color management settings. We also update color properties
	 * when a modeset is needed, to ensure it gets reprogrammed.
	 */
	if (dm_new_crtc_state->base.color_mgmt_changed ||
	    drm_atomic_crtc_needs_modeset(new_crtc_state)) {
10467
		ret = amdgpu_dm_update_crtc_color_mgmt(dm_new_crtc_state);
10468 10469
		if (ret)
			goto fail;
10470
	}
10471

10472 10473 10474 10475
	/* Update Freesync settings. */
	get_freesync_config_for_crtc(dm_new_crtc_state,
				     dm_new_conn_state);

10476
	return ret;
10477 10478 10479 10480 10481

fail:
	if (new_stream)
		dc_stream_release(new_stream);
	return ret;
10482
}
10483

10484 10485 10486 10487 10488 10489 10490 10491 10492 10493
static bool should_reset_plane(struct drm_atomic_state *state,
			       struct drm_plane *plane,
			       struct drm_plane_state *old_plane_state,
			       struct drm_plane_state *new_plane_state)
{
	struct drm_plane *other;
	struct drm_plane_state *old_other_state, *new_other_state;
	struct drm_crtc_state *new_crtc_state;
	int i;

10494 10495 10496 10497 10498 10499 10500 10501
	/*
	 * TODO: Remove this hack once the checks below are sufficient
	 * enough to determine when we need to reset all the planes on
	 * the stream.
	 */
	if (state->allow_modeset)
		return true;

10502 10503 10504 10505 10506 10507 10508 10509 10510 10511 10512 10513 10514 10515
	/* Exit early if we know that we're adding or removing the plane. */
	if (old_plane_state->crtc != new_plane_state->crtc)
		return true;

	/* old crtc == new_crtc == NULL, plane not in context. */
	if (!new_plane_state->crtc)
		return false;

	new_crtc_state =
		drm_atomic_get_new_crtc_state(state, new_plane_state->crtc);

	if (!new_crtc_state)
		return true;

10516 10517 10518 10519
	/* CRTC Degamma changes currently require us to recreate planes. */
	if (new_crtc_state->color_mgmt_changed)
		return true;

10520 10521 10522 10523 10524 10525 10526 10527 10528 10529 10530 10531
	if (drm_atomic_crtc_needs_modeset(new_crtc_state))
		return true;

	/*
	 * If there are any new primary or overlay planes being added or
	 * removed then the z-order can potentially change. To ensure
	 * correct z-order and pipe acquisition the current DC architecture
	 * requires us to remove and recreate all existing planes.
	 *
	 * TODO: Come up with a more elegant solution for this.
	 */
	for_each_oldnew_plane_in_state(state, other, old_other_state, new_other_state, i) {
10532
		struct amdgpu_framebuffer *old_afb, *new_afb;
10533 10534 10535 10536 10537 10538 10539 10540 10541 10542
		if (other->type == DRM_PLANE_TYPE_CURSOR)
			continue;

		if (old_other_state->crtc != new_plane_state->crtc &&
		    new_other_state->crtc != new_plane_state->crtc)
			continue;

		if (old_other_state->crtc != new_other_state->crtc)
			return true;

10543 10544 10545 10546 10547 10548 10549 10550 10551 10552 10553 10554 10555 10556 10557 10558 10559 10560 10561 10562 10563 10564 10565 10566 10567
		/* Src/dst size and scaling updates. */
		if (old_other_state->src_w != new_other_state->src_w ||
		    old_other_state->src_h != new_other_state->src_h ||
		    old_other_state->crtc_w != new_other_state->crtc_w ||
		    old_other_state->crtc_h != new_other_state->crtc_h)
			return true;

		/* Rotation / mirroring updates. */
		if (old_other_state->rotation != new_other_state->rotation)
			return true;

		/* Blending updates. */
		if (old_other_state->pixel_blend_mode !=
		    new_other_state->pixel_blend_mode)
			return true;

		/* Alpha updates. */
		if (old_other_state->alpha != new_other_state->alpha)
			return true;

		/* Colorspace changes. */
		if (old_other_state->color_range != new_other_state->color_range ||
		    old_other_state->color_encoding != new_other_state->color_encoding)
			return true;

10568 10569 10570 10571 10572 10573 10574 10575
		/* Framebuffer checks fall at the end. */
		if (!old_other_state->fb || !new_other_state->fb)
			continue;

		/* Pixel format changes can require bandwidth updates. */
		if (old_other_state->fb->format != new_other_state->fb->format)
			return true;

10576 10577
		old_afb = (struct amdgpu_framebuffer *)old_other_state->fb;
		new_afb = (struct amdgpu_framebuffer *)new_other_state->fb;
10578 10579

		/* Tiling and DCC changes also require bandwidth updates. */
10580 10581
		if (old_afb->tiling_flags != new_afb->tiling_flags ||
		    old_afb->base.modifier != new_afb->base.modifier)
10582 10583 10584 10585 10586 10587
			return true;
	}

	return false;
}

10588 10589 10590 10591
static int dm_check_cursor_fb(struct amdgpu_crtc *new_acrtc,
			      struct drm_plane_state *new_plane_state,
			      struct drm_framebuffer *fb)
{
10592 10593
	struct amdgpu_device *adev = drm_to_adev(new_acrtc->base.dev);
	struct amdgpu_framebuffer *afb = to_amdgpu_framebuffer(fb);
10594
	unsigned int pitch;
10595
	bool linear;
10596 10597 10598 10599 10600 10601 10602 10603 10604 10605 10606 10607 10608 10609 10610 10611 10612 10613 10614 10615 10616 10617 10618 10619 10620 10621 10622 10623 10624 10625 10626 10627 10628 10629

	if (fb->width > new_acrtc->max_cursor_width ||
	    fb->height > new_acrtc->max_cursor_height) {
		DRM_DEBUG_ATOMIC("Bad cursor FB size %dx%d\n",
				 new_plane_state->fb->width,
				 new_plane_state->fb->height);
		return -EINVAL;
	}
	if (new_plane_state->src_w != fb->width << 16 ||
	    new_plane_state->src_h != fb->height << 16) {
		DRM_DEBUG_ATOMIC("Cropping not supported for cursor plane\n");
		return -EINVAL;
	}

	/* Pitch in pixels */
	pitch = fb->pitches[0] / fb->format->cpp[0];

	if (fb->width != pitch) {
		DRM_DEBUG_ATOMIC("Cursor FB width %d doesn't match pitch %d",
				 fb->width, pitch);
		return -EINVAL;
	}

	switch (pitch) {
	case 64:
	case 128:
	case 256:
		/* FB pitch is supported by cursor plane */
		break;
	default:
		DRM_DEBUG_ATOMIC("Bad cursor FB pitch %d px\n", pitch);
		return -EINVAL;
	}

10630 10631 10632 10633 10634 10635 10636 10637 10638 10639 10640 10641 10642 10643 10644 10645
	/* Core DRM takes care of checking FB modifiers, so we only need to
	 * check tiling flags when the FB doesn't have a modifier. */
	if (!(fb->flags & DRM_MODE_FB_MODIFIERS)) {
		if (adev->family < AMDGPU_FAMILY_AI) {
			linear = AMDGPU_TILING_GET(afb->tiling_flags, ARRAY_MODE) != DC_ARRAY_2D_TILED_THIN1 &&
			         AMDGPU_TILING_GET(afb->tiling_flags, ARRAY_MODE) != DC_ARRAY_1D_TILED_THIN1 &&
				 AMDGPU_TILING_GET(afb->tiling_flags, MICRO_TILE_MODE) == 0;
		} else {
			linear = AMDGPU_TILING_GET(afb->tiling_flags, SWIZZLE_MODE) == 0;
		}
		if (!linear) {
			DRM_DEBUG_ATOMIC("Cursor FB not linear");
			return -EINVAL;
		}
	}

10646 10647 10648
	return 0;
}

10649 10650 10651 10652 10653 10654 10655
static int dm_update_plane_state(struct dc *dc,
				 struct drm_atomic_state *state,
				 struct drm_plane *plane,
				 struct drm_plane_state *old_plane_state,
				 struct drm_plane_state *new_plane_state,
				 bool enable,
				 bool *lock_and_validation_needed)
10656
{
10657 10658

	struct dm_atomic_state *dm_state = NULL;
10659
	struct drm_crtc *new_plane_crtc, *old_plane_crtc;
10660
	struct drm_crtc_state *old_crtc_state, *new_crtc_state;
10661 10662
	struct dm_crtc_state *dm_new_crtc_state, *dm_old_crtc_state;
	struct dm_plane_state *dm_new_plane_state, *dm_old_plane_state;
10663
	struct amdgpu_crtc *new_acrtc;
10664
	bool needs_reset;
10665
	int ret = 0;
10666

10667

10668 10669 10670 10671
	new_plane_crtc = new_plane_state->crtc;
	old_plane_crtc = old_plane_state->crtc;
	dm_new_plane_state = to_dm_plane_state(new_plane_state);
	dm_old_plane_state = to_dm_plane_state(old_plane_state);
10672

10673 10674 10675 10676 10677 10678 10679
	if (plane->type == DRM_PLANE_TYPE_CURSOR) {
		if (!enable || !new_plane_crtc ||
			drm_atomic_plane_disabling(plane->state, new_plane_state))
			return 0;

		new_acrtc = to_amdgpu_crtc(new_plane_crtc);

10680 10681 10682 10683 10684
		if (new_plane_state->src_x != 0 || new_plane_state->src_y != 0) {
			DRM_DEBUG_ATOMIC("Cropping not supported for cursor plane\n");
			return -EINVAL;
		}

10685
		if (new_plane_state->fb) {
10686 10687 10688 10689
			ret = dm_check_cursor_fb(new_acrtc, new_plane_state,
						 new_plane_state->fb);
			if (ret)
				return ret;
10690 10691
		}

10692
		return 0;
10693
	}
10694

10695 10696 10697
	needs_reset = should_reset_plane(state, plane, old_plane_state,
					 new_plane_state);

10698 10699
	/* Remove any changed/removed planes */
	if (!enable) {
10700
		if (!needs_reset)
10701
			return 0;
10702

10703 10704
		if (!old_plane_crtc)
			return 0;
10705

10706 10707 10708
		old_crtc_state = drm_atomic_get_old_crtc_state(
				state, old_plane_crtc);
		dm_old_crtc_state = to_dm_crtc_state(old_crtc_state);
10709

10710 10711
		if (!dm_old_crtc_state->stream)
			return 0;
10712

10713 10714
		DRM_DEBUG_ATOMIC("Disabling DRM plane: %d on DRM crtc %d\n",
				plane->base.id, old_plane_crtc->base.id);
10715

10716 10717 10718
		ret = dm_atomic_get_state(state, &dm_state);
		if (ret)
			return ret;
10719

10720 10721 10722 10723 10724
		if (!dc_remove_plane_from_context(
				dc,
				dm_old_crtc_state->stream,
				dm_old_plane_state->dc_state,
				dm_state->context)) {
10725

10726
			return -EINVAL;
10727
		}
10728

10729

10730 10731
		dc_plane_state_release(dm_old_plane_state->dc_state);
		dm_new_plane_state->dc_state = NULL;
10732

10733
		*lock_and_validation_needed = true;
10734

10735 10736
	} else { /* Add new planes */
		struct dc_plane_state *dc_new_plane_state;
10737

10738 10739
		if (drm_atomic_plane_disabling(plane->state, new_plane_state))
			return 0;
10740

10741 10742
		if (!new_plane_crtc)
			return 0;
10743

10744 10745
		new_crtc_state = drm_atomic_get_new_crtc_state(state, new_plane_crtc);
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
10746

10747 10748
		if (!dm_new_crtc_state->stream)
			return 0;
10749

10750
		if (!needs_reset)
10751
			return 0;
10752

10753 10754 10755 10756
		ret = dm_plane_helper_check_state(new_plane_state, new_crtc_state);
		if (ret)
			return ret;

10757
		WARN_ON(dm_new_plane_state->dc_state);
10758

10759 10760 10761
		dc_new_plane_state = dc_create_plane_state(dc);
		if (!dc_new_plane_state)
			return -ENOMEM;
10762

10763 10764
		DRM_DEBUG_ATOMIC("Enabling DRM plane: %d on DRM crtc %d\n",
				 plane->base.id, new_plane_crtc->base.id);
10765

10766
		ret = fill_dc_plane_attributes(
10767
			drm_to_adev(new_plane_crtc->dev),
10768 10769 10770 10771 10772 10773 10774
			dc_new_plane_state,
			new_plane_state,
			new_crtc_state);
		if (ret) {
			dc_plane_state_release(dc_new_plane_state);
			return ret;
		}
10775

10776 10777 10778 10779 10780
		ret = dm_atomic_get_state(state, &dm_state);
		if (ret) {
			dc_plane_state_release(dc_new_plane_state);
			return ret;
		}
10781

10782 10783 10784 10785 10786 10787 10788 10789 10790 10791 10792 10793
		/*
		 * Any atomic check errors that occur after this will
		 * not need a release. The plane state will be attached
		 * to the stream, and therefore part of the atomic
		 * state. It'll be released when the atomic state is
		 * cleaned.
		 */
		if (!dc_add_plane_to_context(
				dc,
				dm_new_crtc_state->stream,
				dc_new_plane_state,
				dm_state->context)) {
10794

10795 10796 10797
			dc_plane_state_release(dc_new_plane_state);
			return -EINVAL;
		}
10798

10799
		dm_new_plane_state->dc_state = dc_new_plane_state;
10800

10801 10802
		dm_new_crtc_state->mpo_requested |= (plane->type == DRM_PLANE_TYPE_OVERLAY);

10803 10804 10805 10806 10807 10808
		/* Tell DC to do a full surface update every time there
		 * is a plane change. Inefficient, but works for now.
		 */
		dm_new_plane_state->dc_state->update_flags.bits.full_update = 1;

		*lock_and_validation_needed = true;
10809
	}
10810 10811


10812 10813
	return ret;
}
10814

10815 10816 10817 10818 10819 10820 10821 10822 10823 10824 10825 10826 10827 10828 10829 10830 10831 10832
static void dm_get_oriented_plane_size(struct drm_plane_state *plane_state,
				       int *src_w, int *src_h)
{
	switch (plane_state->rotation & DRM_MODE_ROTATE_MASK) {
	case DRM_MODE_ROTATE_90:
	case DRM_MODE_ROTATE_270:
		*src_w = plane_state->src_h >> 16;
		*src_h = plane_state->src_w >> 16;
		break;
	case DRM_MODE_ROTATE_0:
	case DRM_MODE_ROTATE_180:
	default:
		*src_w = plane_state->src_w >> 16;
		*src_h = plane_state->src_h >> 16;
		break;
	}
}

S
Simon Ser 已提交
10833 10834 10835 10836
static int dm_check_crtc_cursor(struct drm_atomic_state *state,
				struct drm_crtc *crtc,
				struct drm_crtc_state *new_crtc_state)
{
10837 10838 10839 10840
	struct drm_plane *cursor = crtc->cursor, *underlying;
	struct drm_plane_state *new_cursor_state, *new_underlying_state;
	int i;
	int cursor_scale_w, cursor_scale_h, underlying_scale_w, underlying_scale_h;
10841 10842
	int cursor_src_w, cursor_src_h;
	int underlying_src_w, underlying_src_h;
S
Simon Ser 已提交
10843 10844 10845 10846

	/* On DCE and DCN there is no dedicated hardware cursor plane. We get a
	 * cursor per pipe but it's going to inherit the scaling and
	 * positioning from the underlying pipe. Check the cursor plane's
10847
	 * blending properties match the underlying planes'. */
S
Simon Ser 已提交
10848

10849 10850
	new_cursor_state = drm_atomic_get_new_plane_state(state, cursor);
	if (!new_cursor_state || !new_cursor_state->fb) {
S
Simon Ser 已提交
10851 10852 10853
		return 0;
	}

10854 10855 10856
	dm_get_oriented_plane_size(new_cursor_state, &cursor_src_w, &cursor_src_h);
	cursor_scale_w = new_cursor_state->crtc_w * 1000 / cursor_src_w;
	cursor_scale_h = new_cursor_state->crtc_h * 1000 / cursor_src_h;
S
Simon Ser 已提交
10857

10858 10859 10860 10861
	for_each_new_plane_in_state_reverse(state, underlying, new_underlying_state, i) {
		/* Narrow down to non-cursor planes on the same CRTC as the cursor */
		if (new_underlying_state->crtc != crtc || underlying == crtc->cursor)
			continue;
S
Simon Ser 已提交
10862

10863 10864 10865 10866
		/* Ignore disabled planes */
		if (!new_underlying_state->fb)
			continue;

10867 10868 10869 10870
		dm_get_oriented_plane_size(new_underlying_state,
					   &underlying_src_w, &underlying_src_h);
		underlying_scale_w = new_underlying_state->crtc_w * 1000 / underlying_src_w;
		underlying_scale_h = new_underlying_state->crtc_h * 1000 / underlying_src_h;
10871 10872 10873 10874 10875 10876 10877 10878 10879 10880 10881 10882 10883 10884 10885

		if (cursor_scale_w != underlying_scale_w ||
		    cursor_scale_h != underlying_scale_h) {
			drm_dbg_atomic(crtc->dev,
				       "Cursor [PLANE:%d:%s] scaling doesn't match underlying [PLANE:%d:%s]\n",
				       cursor->base.id, cursor->name, underlying->base.id, underlying->name);
			return -EINVAL;
		}

		/* If this plane covers the whole CRTC, no need to check planes underneath */
		if (new_underlying_state->crtc_x <= 0 &&
		    new_underlying_state->crtc_y <= 0 &&
		    new_underlying_state->crtc_x + new_underlying_state->crtc_w >= new_crtc_state->mode.hdisplay &&
		    new_underlying_state->crtc_y + new_underlying_state->crtc_h >= new_crtc_state->mode.vdisplay)
			break;
S
Simon Ser 已提交
10886 10887 10888 10889 10890
	}

	return 0;
}

10891
#if defined(CONFIG_DRM_AMD_DC_DCN)
10892 10893 10894
static int add_affected_mst_dsc_crtcs(struct drm_atomic_state *state, struct drm_crtc *crtc)
{
	struct drm_connector *connector;
10895
	struct drm_connector_state *conn_state, *old_conn_state;
10896 10897
	struct amdgpu_dm_connector *aconnector = NULL;
	int i;
10898 10899 10900 10901
	for_each_oldnew_connector_in_state(state, connector, old_conn_state, conn_state, i) {
		if (!conn_state->crtc)
			conn_state = old_conn_state;

10902 10903 10904 10905 10906 10907 10908 10909 10910 10911 10912 10913 10914 10915 10916
		if (conn_state->crtc != crtc)
			continue;

		aconnector = to_amdgpu_dm_connector(connector);
		if (!aconnector->port || !aconnector->mst_port)
			aconnector = NULL;
		else
			break;
	}

	if (!aconnector)
		return 0;

	return drm_dp_mst_add_affected_dsc_crtcs(state, &aconnector->mst_port->mst_mgr);
}
10917
#endif
10918

10919 10920 10921 10922 10923 10924 10925 10926 10927 10928 10929 10930 10931 10932 10933
/**
 * amdgpu_dm_atomic_check() - Atomic check implementation for AMDgpu DM.
 * @dev: The DRM device
 * @state: The atomic state to commit
 *
 * Validate that the given atomic state is programmable by DC into hardware.
 * This involves constructing a &struct dc_state reflecting the new hardware
 * state we wish to commit, then querying DC to see if it is programmable. It's
 * important not to modify the existing DC state. Otherwise, atomic_check
 * may unexpectedly commit hardware changes.
 *
 * When validating the DC state, it's important that the right locks are
 * acquired. For full updates case which removes/adds/updates streams on one
 * CRTC while flipping on another CRTC, acquiring global lock will guarantee
 * that any such full update commit will wait for completion of any outstanding
10934
 * flip using DRMs synchronization events.
10935 10936 10937 10938 10939 10940 10941 10942
 *
 * Note that DM adds the affected connectors for all CRTCs in state, when that
 * might not seem necessary. This is because DC stream creation requires the
 * DC sink, which is tied to the DRM connector state. Cleaning this up should
 * be possible but non-trivial - a possible TODO item.
 *
 * Return: -Error code if validation failed.
 */
10943 10944
static int amdgpu_dm_atomic_check(struct drm_device *dev,
				  struct drm_atomic_state *state)
10945
{
10946
	struct amdgpu_device *adev = drm_to_adev(dev);
10947
	struct dm_atomic_state *dm_state = NULL;
10948 10949
	struct dc *dc = adev->dm.dc;
	struct drm_connector *connector;
10950
	struct drm_connector_state *old_con_state, *new_con_state;
10951
	struct drm_crtc *crtc;
10952
	struct drm_crtc_state *old_crtc_state, *new_crtc_state;
10953 10954
	struct drm_plane *plane;
	struct drm_plane_state *old_plane_state, *new_plane_state;
10955
	enum dc_status status;
10956
	int ret, i;
10957
	bool lock_and_validation_needed = false;
10958
	struct dm_crtc_state *dm_old_crtc_state, *dm_new_crtc_state;
10959 10960
#if defined(CONFIG_DRM_AMD_DC_DCN)
	struct dsc_mst_fairness_vars vars[MAX_PIPES];
10961 10962
	struct drm_dp_mst_topology_state *mst_state;
	struct drm_dp_mst_topology_mgr *mgr;
10963
#endif
10964

10965
	trace_amdgpu_dm_atomic_check_begin(state);
10966

10967
	ret = drm_atomic_helper_check_modeset(dev, state);
10968 10969
	if (ret) {
		DRM_DEBUG_DRIVER("drm_atomic_helper_check_modeset() failed\n");
10970
		goto fail;
10971
	}
10972

10973 10974 10975 10976 10977 10978 10979 10980 10981 10982 10983 10984 10985 10986
	/* Check connector changes */
	for_each_oldnew_connector_in_state(state, connector, old_con_state, new_con_state, i) {
		struct dm_connector_state *dm_old_con_state = to_dm_connector_state(old_con_state);
		struct dm_connector_state *dm_new_con_state = to_dm_connector_state(new_con_state);

		/* Skip connectors that are disabled or part of modeset already. */
		if (!old_con_state->crtc && !new_con_state->crtc)
			continue;

		if (!new_con_state->crtc)
			continue;

		new_crtc_state = drm_atomic_get_crtc_state(state, new_con_state->crtc);
		if (IS_ERR(new_crtc_state)) {
10987
			DRM_DEBUG_DRIVER("drm_atomic_get_crtc_state() failed\n");
10988 10989 10990 10991 10992 10993 10994 10995 10996
			ret = PTR_ERR(new_crtc_state);
			goto fail;
		}

		if (dm_old_con_state->abm_level !=
		    dm_new_con_state->abm_level)
			new_crtc_state->connectors_changed = true;
	}

10997
#if defined(CONFIG_DRM_AMD_DC_DCN)
10998
	if (dc_resource_is_dsc_encoding_supported(dc)) {
10999 11000 11001
		for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state, new_crtc_state, i) {
			if (drm_atomic_crtc_needs_modeset(new_crtc_state)) {
				ret = add_affected_mst_dsc_crtcs(state, crtc);
11002 11003
				if (ret) {
					DRM_DEBUG_DRIVER("add_affected_mst_dsc_crtcs() failed\n");
11004
					goto fail;
11005
				}
11006 11007
			}
		}
11008
		pre_validate_dsc(state, &dm_state, vars);
11009
	}
11010
#endif
11011
	for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state, new_crtc_state, i) {
11012 11013
		dm_old_crtc_state = to_dm_crtc_state(old_crtc_state);

11014
		if (!drm_atomic_crtc_needs_modeset(new_crtc_state) &&
11015
		    !new_crtc_state->color_mgmt_changed &&
11016 11017
		    old_crtc_state->vrr_enabled == new_crtc_state->vrr_enabled &&
			dm_old_crtc_state->dsc_force_changed == false)
11018
			continue;
11019

11020
		ret = amdgpu_dm_verify_lut_sizes(new_crtc_state);
11021 11022
		if (ret) {
			DRM_DEBUG_DRIVER("amdgpu_dm_verify_lut_sizes() failed\n");
11023
			goto fail;
11024
		}
11025

11026 11027
		if (!new_crtc_state->enable)
			continue;
11028

11029
		ret = drm_atomic_add_affected_connectors(state, crtc);
11030 11031
		if (ret) {
			DRM_DEBUG_DRIVER("drm_atomic_add_affected_connectors() failed\n");
11032
			goto fail;
11033
		}
11034

11035
		ret = drm_atomic_add_affected_planes(state, crtc);
11036 11037
		if (ret) {
			DRM_DEBUG_DRIVER("drm_atomic_add_affected_planes() failed\n");
11038
			goto fail;
11039
		}
11040

11041
		if (dm_old_crtc_state->dsc_force_changed)
11042
			new_crtc_state->mode_changed = true;
11043 11044
	}

11045 11046 11047 11048 11049 11050 11051 11052 11053 11054 11055 11056 11057 11058 11059 11060 11061 11062 11063 11064 11065 11066 11067 11068 11069 11070 11071 11072 11073 11074 11075
	/*
	 * Add all primary and overlay planes on the CRTC to the state
	 * whenever a plane is enabled to maintain correct z-ordering
	 * and to enable fast surface updates.
	 */
	drm_for_each_crtc(crtc, dev) {
		bool modified = false;

		for_each_oldnew_plane_in_state(state, plane, old_plane_state, new_plane_state, i) {
			if (plane->type == DRM_PLANE_TYPE_CURSOR)
				continue;

			if (new_plane_state->crtc == crtc ||
			    old_plane_state->crtc == crtc) {
				modified = true;
				break;
			}
		}

		if (!modified)
			continue;

		drm_for_each_plane_mask(plane, state->dev, crtc->state->plane_mask) {
			if (plane->type == DRM_PLANE_TYPE_CURSOR)
				continue;

			new_plane_state =
				drm_atomic_get_plane_state(state, plane);

			if (IS_ERR(new_plane_state)) {
				ret = PTR_ERR(new_plane_state);
11076
				DRM_DEBUG_DRIVER("new_plane_state is BAD\n");
11077 11078 11079 11080 11081
				goto fail;
			}
		}
	}

11082
	/* Remove exiting planes if they are modified */
11083 11084 11085 11086 11087 11088
	for_each_oldnew_plane_in_state_reverse(state, plane, old_plane_state, new_plane_state, i) {
		ret = dm_update_plane_state(dc, state, plane,
					    old_plane_state,
					    new_plane_state,
					    false,
					    &lock_and_validation_needed);
11089 11090
		if (ret) {
			DRM_DEBUG_DRIVER("dm_update_plane_state() failed\n");
11091
			goto fail;
11092
		}
11093 11094 11095
	}

	/* Disable all crtcs which require disable */
11096 11097 11098 11099 11100 11101
	for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state, new_crtc_state, i) {
		ret = dm_update_crtc_state(&adev->dm, state, crtc,
					   old_crtc_state,
					   new_crtc_state,
					   false,
					   &lock_and_validation_needed);
11102 11103
		if (ret) {
			DRM_DEBUG_DRIVER("DISABLE: dm_update_crtc_state() failed\n");
11104
			goto fail;
11105
		}
11106 11107 11108
	}

	/* Enable all crtcs which require enable */
11109 11110 11111 11112 11113 11114
	for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state, new_crtc_state, i) {
		ret = dm_update_crtc_state(&adev->dm, state, crtc,
					   old_crtc_state,
					   new_crtc_state,
					   true,
					   &lock_and_validation_needed);
11115 11116
		if (ret) {
			DRM_DEBUG_DRIVER("ENABLE: dm_update_crtc_state() failed\n");
11117
			goto fail;
11118
		}
11119 11120 11121
	}

	/* Add new/modified planes */
11122 11123 11124 11125 11126 11127
	for_each_oldnew_plane_in_state_reverse(state, plane, old_plane_state, new_plane_state, i) {
		ret = dm_update_plane_state(dc, state, plane,
					    old_plane_state,
					    new_plane_state,
					    true,
					    &lock_and_validation_needed);
11128 11129
		if (ret) {
			DRM_DEBUG_DRIVER("dm_update_plane_state() failed\n");
11130
			goto fail;
11131
		}
11132 11133
	}

11134 11135
	/* Run this here since we want to validate the streams we created */
	ret = drm_atomic_helper_check_planes(dev, state);
11136 11137
	if (ret) {
		DRM_DEBUG_DRIVER("drm_atomic_helper_check_planes() failed\n");
11138
		goto fail;
11139
	}
11140

11141 11142 11143 11144 11145 11146
	for_each_new_crtc_in_state(state, crtc, new_crtc_state, i) {
		dm_new_crtc_state = to_dm_crtc_state(new_crtc_state);
		if (dm_new_crtc_state->mpo_requested)
			DRM_DEBUG_DRIVER("MPO enablement requested on crtc:[%p]\n", crtc);
	}

S
Simon Ser 已提交
11147 11148 11149
	/* Check cursor planes scaling */
	for_each_new_crtc_in_state(state, crtc, new_crtc_state, i) {
		ret = dm_check_crtc_cursor(state, crtc, new_crtc_state);
11150 11151
		if (ret) {
			DRM_DEBUG_DRIVER("dm_check_crtc_cursor() failed\n");
S
Simon Ser 已提交
11152
			goto fail;
11153
		}
S
Simon Ser 已提交
11154 11155
	}

11156 11157 11158 11159 11160 11161 11162 11163 11164 11165 11166 11167 11168 11169 11170 11171 11172 11173 11174 11175
	if (state->legacy_cursor_update) {
		/*
		 * This is a fast cursor update coming from the plane update
		 * helper, check if it can be done asynchronously for better
		 * performance.
		 */
		state->async_update =
			!drm_atomic_helper_async_check(dev, state);

		/*
		 * Skip the remaining global validation if this is an async
		 * update. Cursor updates can be done without affecting
		 * state or bandwidth calcs and this avoids the performance
		 * penalty of locking the private state object and
		 * allocating a new dc_state.
		 */
		if (state->async_update)
			return 0;
	}

L
Leo (Sunpeng) Li 已提交
11176
	/* Check scaling and underscan changes*/
11177
	/* TODO Removed scaling changes validation due to inability to commit
11178 11179 11180
	 * new stream into context w\o causing full reset. Need to
	 * decide how to handle.
	 */
11181
	for_each_oldnew_connector_in_state(state, connector, old_con_state, new_con_state, i) {
11182 11183 11184
		struct dm_connector_state *dm_old_con_state = to_dm_connector_state(old_con_state);
		struct dm_connector_state *dm_new_con_state = to_dm_connector_state(new_con_state);
		struct amdgpu_crtc *acrtc = to_amdgpu_crtc(dm_new_con_state->base.crtc);
11185 11186

		/* Skip any modesets/resets */
11187 11188
		if (!acrtc || drm_atomic_crtc_needs_modeset(
				drm_atomic_get_new_crtc_state(state, &acrtc->base)))
11189 11190
			continue;

11191
		/* Skip any thing not scale or underscan changes */
11192
		if (!is_scaling_state_different(dm_new_con_state, dm_old_con_state))
11193 11194 11195 11196 11197
			continue;

		lock_and_validation_needed = true;
	}

11198 11199 11200 11201 11202 11203 11204 11205 11206 11207 11208 11209 11210 11211 11212 11213 11214 11215 11216 11217 11218 11219 11220 11221 11222 11223 11224
#if defined(CONFIG_DRM_AMD_DC_DCN)
	/* set the slot info for each mst_state based on the link encoding format */
	for_each_new_mst_mgr_in_state(state, mgr, mst_state, i) {
		struct amdgpu_dm_connector *aconnector;
		struct drm_connector *connector;
		struct drm_connector_list_iter iter;
		u8 link_coding_cap;

		if (!mgr->mst_state )
			continue;

		drm_connector_list_iter_begin(dev, &iter);
		drm_for_each_connector_iter(connector, &iter) {
			int id = connector->index;

			if (id == mst_state->mgr->conn_base_id) {
				aconnector = to_amdgpu_dm_connector(connector);
				link_coding_cap = dc_link_dp_mst_decide_link_encoding_format(aconnector->dc_link);
				drm_dp_mst_update_slots(mst_state, link_coding_cap);

				break;
			}
		}
		drm_connector_list_iter_end(&iter);

	}
#endif
11225 11226 11227 11228 11229 11230 11231 11232 11233 11234 11235 11236
	/**
	 * Streams and planes are reset when there are changes that affect
	 * bandwidth. Anything that affects bandwidth needs to go through
	 * DC global validation to ensure that the configuration can be applied
	 * to hardware.
	 *
	 * We have to currently stall out here in atomic_check for outstanding
	 * commits to finish in this case because our IRQ handlers reference
	 * DRM state directly - we can end up disabling interrupts too early
	 * if we don't.
	 *
	 * TODO: Remove this stall and drop DM state private objects.
11237
	 */
11238
	if (lock_and_validation_needed) {
11239
		ret = dm_atomic_get_state(state, &dm_state);
11240 11241
		if (ret) {
			DRM_DEBUG_DRIVER("dm_atomic_get_state() failed\n");
11242
			goto fail;
11243
		}
11244 11245

		ret = do_aquire_global_lock(dev, state);
11246 11247
		if (ret) {
			DRM_DEBUG_DRIVER("do_aquire_global_lock() failed\n");
11248
			goto fail;
11249
		}
11250

11251
#if defined(CONFIG_DRM_AMD_DC_DCN)
11252 11253
		if (!compute_mst_dsc_configs_for_state(state, dm_state->context, vars)) {
			DRM_DEBUG_DRIVER("compute_mst_dsc_configs_for_state() failed\n");
11254
			goto fail;
11255
		}
11256

11257
		ret = dm_update_mst_vcpi_slots_for_dsc(state, dm_state->context, vars);
11258 11259
		if (ret) {
			DRM_DEBUG_DRIVER("dm_update_mst_vcpi_slots_for_dsc() failed\n");
11260
			goto fail;
11261
		}
11262
#endif
11263

11264 11265 11266 11267 11268 11269 11270
		/*
		 * Perform validation of MST topology in the state:
		 * We need to perform MST atomic check before calling
		 * dc_validate_global_state(), or there is a chance
		 * to get stuck in an infinite loop and hang eventually.
		 */
		ret = drm_dp_mst_atomic_check(state);
11271 11272
		if (ret) {
			DRM_DEBUG_DRIVER("drm_dp_mst_atomic_check() failed\n");
11273
			goto fail;
11274
		}
11275
		status = dc_validate_global_state(dc, dm_state->context, true);
11276
		if (status != DC_OK) {
11277
			DRM_DEBUG_DRIVER("DC global validation failure: %s (%d)",
11278
				       dc_status_to_str(status), status);
11279 11280 11281
			ret = -EINVAL;
			goto fail;
		}
11282
	} else {
11283
		/*
11284 11285 11286 11287 11288 11289
		 * The commit is a fast update. Fast updates shouldn't change
		 * the DC context, affect global validation, and can have their
		 * commit work done in parallel with other commits not touching
		 * the same resource. If we have a new DC context as part of
		 * the DM atomic state from validation we need to free it and
		 * retain the existing one instead.
11290 11291 11292 11293 11294
		 *
		 * Furthermore, since the DM atomic state only contains the DC
		 * context and can safely be annulled, we can free the state
		 * and clear the associated private object now to free
		 * some memory and avoid a possible use-after-free later.
11295
		 */
11296

11297 11298
		for (i = 0; i < state->num_private_objs; i++) {
			struct drm_private_obj *obj = state->private_objs[i].ptr;
11299

11300 11301
			if (obj->funcs == adev->dm.atomic_obj.funcs) {
				int j = state->num_private_objs-1;
11302

11303 11304 11305 11306 11307 11308 11309 11310 11311 11312
				dm_atomic_destroy_state(obj,
						state->private_objs[i].state);

				/* If i is not at the end of the array then the
				 * last element needs to be moved to where i was
				 * before the array can safely be truncated.
				 */
				if (i != j)
					state->private_objs[i] =
						state->private_objs[j];
11313

11314 11315 11316 11317 11318 11319 11320 11321
				state->private_objs[j].ptr = NULL;
				state->private_objs[j].state = NULL;
				state->private_objs[j].old_state = NULL;
				state->private_objs[j].new_state = NULL;

				state->num_private_objs = j;
				break;
			}
11322
		}
11323 11324
	}

11325 11326 11327 11328 11329
	/* Store the overall update type for use later in atomic check. */
	for_each_new_crtc_in_state (state, crtc, new_crtc_state, i) {
		struct dm_crtc_state *dm_new_crtc_state =
			to_dm_crtc_state(new_crtc_state);

11330 11331 11332
		dm_new_crtc_state->update_type = lock_and_validation_needed ?
							 UPDATE_TYPE_FULL :
							 UPDATE_TYPE_FAST;
11333 11334 11335 11336
	}

	/* Must be success */
	WARN_ON(ret);
11337 11338 11339

	trace_amdgpu_dm_atomic_check_finish(state, ret);

11340 11341 11342 11343
	return ret;

fail:
	if (ret == -EDEADLK)
11344
		DRM_DEBUG_DRIVER("Atomic check stopped to avoid deadlock.\n");
11345
	else if (ret == -EINTR || ret == -EAGAIN || ret == -ERESTARTSYS)
11346
		DRM_DEBUG_DRIVER("Atomic check stopped due to signal.\n");
11347
	else
11348
		DRM_DEBUG_DRIVER("Atomic check failed with err: %d \n", ret);
11349

11350 11351
	trace_amdgpu_dm_atomic_check_finish(state, ret);

11352 11353 11354
	return ret;
}

11355 11356
static bool is_dp_capable_without_timing_msa(struct dc *dc,
					     struct amdgpu_dm_connector *amdgpu_dm_connector)
11357 11358 11359 11360
{
	uint8_t dpcd_data;
	bool capable = false;

11361
	if (amdgpu_dm_connector->dc_link &&
11362 11363
		dm_helpers_dp_read_dpcd(
				NULL,
11364
				amdgpu_dm_connector->dc_link,
11365 11366 11367 11368 11369 11370 11371 11372
				DP_DOWN_STREAM_PORT_COUNT,
				&dpcd_data,
				sizeof(dpcd_data))) {
		capable = (dpcd_data & DP_MSA_TIMING_PAR_IGNORED) ? true:false;
	}

	return capable;
}
11373

11374 11375 11376 11377 11378 11379 11380 11381 11382 11383 11384 11385 11386 11387 11388 11389 11390 11391 11392 11393 11394 11395 11396 11397 11398
static bool dm_edid_parser_send_cea(struct amdgpu_display_manager *dm,
		unsigned int offset,
		unsigned int total_length,
		uint8_t *data,
		unsigned int length,
		struct amdgpu_hdmi_vsdb_info *vsdb)
{
	bool res;
	union dmub_rb_cmd cmd;
	struct dmub_cmd_send_edid_cea *input;
	struct dmub_cmd_edid_cea_output *output;

	if (length > DMUB_EDID_CEA_DATA_CHUNK_BYTES)
		return false;

	memset(&cmd, 0, sizeof(cmd));

	input = &cmd.edid_cea.data.input;

	cmd.edid_cea.header.type = DMUB_CMD__EDID_CEA;
	cmd.edid_cea.header.sub_type = 0;
	cmd.edid_cea.header.payload_bytes =
		sizeof(cmd.edid_cea) - sizeof(cmd.edid_cea.header);
	input->offset = offset;
	input->length = length;
11399
	input->cea_total_length = total_length;
11400 11401 11402 11403 11404 11405 11406 11407 11408 11409 11410 11411 11412 11413 11414 11415 11416 11417 11418 11419 11420 11421 11422 11423
	memcpy(input->payload, data, length);

	res = dc_dmub_srv_cmd_with_reply_data(dm->dc->ctx->dmub_srv, &cmd);
	if (!res) {
		DRM_ERROR("EDID CEA parser failed\n");
		return false;
	}

	output = &cmd.edid_cea.data.output;

	if (output->type == DMUB_CMD__EDID_CEA_ACK) {
		if (!output->ack.success) {
			DRM_ERROR("EDID CEA ack failed at offset %d\n",
					output->ack.offset);
		}
	} else if (output->type == DMUB_CMD__EDID_CEA_AMD_VSDB) {
		if (!output->amd_vsdb.vsdb_found)
			return false;

		vsdb->freesync_supported = output->amd_vsdb.freesync_supported;
		vsdb->amd_vsdb_version = output->amd_vsdb.amd_vsdb_version;
		vsdb->min_refresh_rate_hz = output->amd_vsdb.min_frame_rate;
		vsdb->max_refresh_rate_hz = output->amd_vsdb.max_frame_rate;
	} else {
11424
		DRM_WARN("Unknown EDID CEA parser results\n");
11425 11426 11427 11428 11429 11430 11431
		return false;
	}

	return true;
}

static bool parse_edid_cea_dmcu(struct amdgpu_display_manager *dm,
11432 11433 11434 11435 11436 11437 11438 11439 11440 11441 11442
		uint8_t *edid_ext, int len,
		struct amdgpu_hdmi_vsdb_info *vsdb_info)
{
	int i;

	/* send extension block to DMCU for parsing */
	for (i = 0; i < len; i += 8) {
		bool res;
		int offset;

		/* send 8 bytes a time */
11443
		if (!dc_edid_parser_send_cea(dm->dc, i, len, &edid_ext[i], 8))
11444 11445 11446 11447 11448 11449
			return false;

		if (i+8 == len) {
			/* EDID block sent completed, expect result */
			int version, min_rate, max_rate;

11450
			res = dc_edid_parser_recv_amd_vsdb(dm->dc, &version, &min_rate, &max_rate);
11451 11452 11453 11454 11455 11456 11457 11458 11459 11460 11461 11462 11463
			if (res) {
				/* amd vsdb found */
				vsdb_info->freesync_supported = 1;
				vsdb_info->amd_vsdb_version = version;
				vsdb_info->min_refresh_rate_hz = min_rate;
				vsdb_info->max_refresh_rate_hz = max_rate;
				return true;
			}
			/* not amd vsdb */
			return false;
		}

		/* check for ack*/
11464
		res = dc_edid_parser_recv_cea_ack(dm->dc, &offset);
11465 11466 11467 11468 11469 11470 11471
		if (!res)
			return false;
	}

	return false;
}

11472 11473 11474 11475 11476 11477 11478 11479 11480 11481 11482 11483 11484 11485 11486 11487 11488 11489 11490 11491 11492 11493 11494 11495 11496 11497 11498 11499
static bool parse_edid_cea_dmub(struct amdgpu_display_manager *dm,
		uint8_t *edid_ext, int len,
		struct amdgpu_hdmi_vsdb_info *vsdb_info)
{
	int i;

	/* send extension block to DMCU for parsing */
	for (i = 0; i < len; i += 8) {
		/* send 8 bytes a time */
		if (!dm_edid_parser_send_cea(dm, i, len, &edid_ext[i], 8, vsdb_info))
			return false;
	}

	return vsdb_info->freesync_supported;
}

static bool parse_edid_cea(struct amdgpu_dm_connector *aconnector,
		uint8_t *edid_ext, int len,
		struct amdgpu_hdmi_vsdb_info *vsdb_info)
{
	struct amdgpu_device *adev = drm_to_adev(aconnector->base.dev);

	if (adev->dm.dmub_srv)
		return parse_edid_cea_dmub(&adev->dm, edid_ext, len, vsdb_info);
	else
		return parse_edid_cea_dmcu(&adev->dm, edid_ext, len, vsdb_info);
}

11500
static int parse_hdmi_amd_vsdb(struct amdgpu_dm_connector *aconnector,
11501 11502 11503 11504 11505 11506 11507 11508 11509
		struct edid *edid, struct amdgpu_hdmi_vsdb_info *vsdb_info)
{
	uint8_t *edid_ext = NULL;
	int i;
	bool valid_vsdb_found = false;

	/*----- drm_find_cea_extension() -----*/
	/* No EDID or EDID extensions */
	if (edid == NULL || edid->extensions == 0)
11510
		return -ENODEV;
11511 11512 11513 11514 11515 11516 11517 11518 11519

	/* Find CEA extension */
	for (i = 0; i < edid->extensions; i++) {
		edid_ext = (uint8_t *)edid + EDID_LENGTH * (i + 1);
		if (edid_ext[0] == CEA_EXT)
			break;
	}

	if (i == edid->extensions)
11520
		return -ENODEV;
11521 11522 11523

	/*----- cea_db_offsets() -----*/
	if (edid_ext[0] != CEA_EXT)
11524
		return -ENODEV;
11525 11526

	valid_vsdb_found = parse_edid_cea(aconnector, edid_ext, EDID_LENGTH, vsdb_info);
11527 11528

	return valid_vsdb_found ? i : -ENODEV;
11529 11530
}

11531 11532
void amdgpu_dm_update_freesync_caps(struct drm_connector *connector,
					struct edid *edid)
11533
{
11534
	int i = 0;
11535 11536 11537
	struct detailed_timing *timing;
	struct detailed_non_pixel *data;
	struct detailed_data_monitor_range *range;
11538 11539
	struct amdgpu_dm_connector *amdgpu_dm_connector =
			to_amdgpu_dm_connector(connector);
11540
	struct dm_connector_state *dm_con_state = NULL;
11541
	struct dc_sink *sink;
11542 11543

	struct drm_device *dev = connector->dev;
11544
	struct amdgpu_device *adev = drm_to_adev(dev);
11545
	bool freesync_capable = false;
11546
	struct amdgpu_hdmi_vsdb_info vsdb_info = {0};
11547

11548 11549
	if (!connector->state) {
		DRM_ERROR("%s - Connector has no state", __func__);
11550
		goto update;
11551 11552
	}

11553 11554 11555 11556 11557
	sink = amdgpu_dm_connector->dc_sink ?
		amdgpu_dm_connector->dc_sink :
		amdgpu_dm_connector->dc_em_sink;

	if (!edid || !sink) {
11558 11559 11560 11561 11562
		dm_con_state = to_dm_connector_state(connector->state);

		amdgpu_dm_connector->min_vfreq = 0;
		amdgpu_dm_connector->max_vfreq = 0;
		amdgpu_dm_connector->pixel_clock_mhz = 0;
11563 11564 11565
		connector->display_info.monitor_range.min_vfreq = 0;
		connector->display_info.monitor_range.max_vfreq = 0;
		freesync_capable = false;
11566

11567
		goto update;
11568 11569
	}

11570 11571
	dm_con_state = to_dm_connector_state(connector->state);

11572
	if (!adev->dm.freesync_module)
11573
		goto update;
11574 11575


11576 11577
	if (sink->sink_signal == SIGNAL_TYPE_DISPLAY_PORT
		|| sink->sink_signal == SIGNAL_TYPE_EDP) {
11578 11579 11580
		bool edid_check_required = false;

		if (edid) {
11581 11582
			edid_check_required = is_dp_capable_without_timing_msa(
						adev->dm.dc,
11583
						amdgpu_dm_connector);
11584 11585
		}

11586 11587 11588
		if (edid_check_required == true && (edid->version > 1 ||
		   (edid->version == 1 && edid->revision > 1))) {
			for (i = 0; i < 4; i++) {
11589

11590 11591 11592 11593 11594 11595 11596 11597 11598 11599 11600 11601 11602 11603 11604 11605
				timing	= &edid->detailed_timings[i];
				data	= &timing->data.other_data;
				range	= &data->data.range;
				/*
				 * Check if monitor has continuous frequency mode
				 */
				if (data->type != EDID_DETAIL_MONITOR_RANGE)
					continue;
				/*
				 * Check for flag range limits only. If flag == 1 then
				 * no additional timing information provided.
				 * Default GTF, GTF Secondary curve and CVT are not
				 * supported
				 */
				if (range->flags != 1)
					continue;
11606

11607 11608 11609 11610
				amdgpu_dm_connector->min_vfreq = range->min_vfreq;
				amdgpu_dm_connector->max_vfreq = range->max_vfreq;
				amdgpu_dm_connector->pixel_clock_mhz =
					range->pixel_clock_mhz * 10;
11611

11612 11613
				connector->display_info.monitor_range.min_vfreq = range->min_vfreq;
				connector->display_info.monitor_range.max_vfreq = range->max_vfreq;
11614

11615 11616
				break;
			}
11617

11618 11619
			if (amdgpu_dm_connector->max_vfreq -
			    amdgpu_dm_connector->min_vfreq > 10) {
11620

11621 11622 11623
				freesync_capable = true;
			}
		}
11624
	} else if (edid && sink->sink_signal == SIGNAL_TYPE_HDMI_TYPE_A) {
11625 11626
		i = parse_hdmi_amd_vsdb(amdgpu_dm_connector, edid, &vsdb_info);
		if (i >= 0 && vsdb_info.freesync_supported) {
11627 11628 11629 11630 11631 11632 11633 11634 11635 11636
			timing  = &edid->detailed_timings[i];
			data    = &timing->data.other_data;

			amdgpu_dm_connector->min_vfreq = vsdb_info.min_refresh_rate_hz;
			amdgpu_dm_connector->max_vfreq = vsdb_info.max_refresh_rate_hz;
			if (amdgpu_dm_connector->max_vfreq - amdgpu_dm_connector->min_vfreq > 10)
				freesync_capable = true;

			connector->display_info.monitor_range.min_vfreq = vsdb_info.min_refresh_rate_hz;
			connector->display_info.monitor_range.max_vfreq = vsdb_info.max_refresh_rate_hz;
11637 11638
		}
	}
11639 11640 11641 11642 11643 11644 11645 11646

update:
	if (dm_con_state)
		dm_con_state->freesync_capable = freesync_capable;

	if (connector->vrr_capable_property)
		drm_connector_set_vrr_capable_property(connector,
						       freesync_capable);
11647 11648
}

11649 11650
void amdgpu_dm_trigger_timing_sync(struct drm_device *dev)
{
11651
	struct amdgpu_device *adev = drm_to_adev(dev);
11652 11653 11654 11655 11656 11657 11658 11659 11660 11661 11662 11663 11664 11665 11666
	struct dc *dc = adev->dm.dc;
	int i;

	mutex_lock(&adev->dm.dc_lock);
	if (dc->current_state) {
		for (i = 0; i < dc->current_state->stream_count; ++i)
			dc->current_state->streams[i]
				->triggered_crtc_reset.enabled =
				adev->dm.force_timing_sync;

		dm_enable_per_frame_crtc_master_sync(dc->current_state);
		dc_trigger_sync(dc, dc->current_state);
	}
	mutex_unlock(&adev->dm.dc_lock);
}
11667 11668 11669 11670 11671 11672 11673 11674 11675 11676 11677 11678 11679 11680 11681 11682 11683 11684 11685 11686 11687 11688 11689 11690 11691 11692 11693 11694 11695 11696 11697 11698 11699 11700 11701 11702 11703 11704

void dm_write_reg_func(const struct dc_context *ctx, uint32_t address,
		       uint32_t value, const char *func_name)
{
#ifdef DM_CHECK_ADDR_0
	if (address == 0) {
		DC_ERR("invalid register write. address = 0");
		return;
	}
#endif
	cgs_write_register(ctx->cgs_device, address, value);
	trace_amdgpu_dc_wreg(&ctx->perf_trace->write_count, address, value);
}

uint32_t dm_read_reg_func(const struct dc_context *ctx, uint32_t address,
			  const char *func_name)
{
	uint32_t value;
#ifdef DM_CHECK_ADDR_0
	if (address == 0) {
		DC_ERR("invalid register read; address = 0\n");
		return 0;
	}
#endif

	if (ctx->dmub_srv &&
	    ctx->dmub_srv->reg_helper_offload.gather_in_progress &&
	    !ctx->dmub_srv->reg_helper_offload.should_burst_write) {
		ASSERT(false);
		return 0;
	}

	value = cgs_read_register(ctx->cgs_device, address);

	trace_amdgpu_dc_rreg(&ctx->perf_trace->read_count, address, value);

	return value;
}
11705

11706 11707 11708 11709
static int amdgpu_dm_set_dmub_async_sync_status(bool is_cmd_aux,
						struct dc_context *ctx,
						uint8_t status_type,
						uint32_t *operation_result)
11710 11711 11712 11713 11714 11715 11716 11717 11718 11719 11720 11721 11722 11723 11724 11725 11726 11727 11728 11729 11730 11731 11732 11733 11734 11735 11736 11737 11738 11739
{
	struct amdgpu_device *adev = ctx->driver_context;
	int return_status = -1;
	struct dmub_notification *p_notify = adev->dm.dmub_notify;

	if (is_cmd_aux) {
		if (status_type == DMUB_ASYNC_TO_SYNC_ACCESS_SUCCESS) {
			return_status = p_notify->aux_reply.length;
			*operation_result = p_notify->result;
		} else if (status_type == DMUB_ASYNC_TO_SYNC_ACCESS_TIMEOUT) {
			*operation_result = AUX_RET_ERROR_TIMEOUT;
		} else if (status_type == DMUB_ASYNC_TO_SYNC_ACCESS_FAIL) {
			*operation_result = AUX_RET_ERROR_ENGINE_ACQUIRE;
		} else {
			*operation_result = AUX_RET_ERROR_UNKNOWN;
		}
	} else {
		if (status_type == DMUB_ASYNC_TO_SYNC_ACCESS_SUCCESS) {
			return_status = 0;
			*operation_result = p_notify->sc_status;
		} else {
			*operation_result = SET_CONFIG_UNKNOWN_ERROR;
		}
	}

	return return_status;
}

int amdgpu_dm_process_dmub_aux_transfer_sync(bool is_cmd_aux, struct dc_context *ctx,
	unsigned int link_index, void *cmd_payload, void *operation_result)
11740 11741 11742 11743
{
	struct amdgpu_device *adev = ctx->driver_context;
	int ret = 0;

11744 11745 11746 11747 11748 11749 11750 11751 11752 11753 11754
	if (is_cmd_aux) {
		dc_process_dmub_aux_transfer_async(ctx->dc,
			link_index, (struct aux_payload *)cmd_payload);
	} else if (dc_process_dmub_set_config_async(ctx->dc, link_index,
					(struct set_config_cmd_payload *)cmd_payload,
					adev->dm.dmub_notify)) {
		return amdgpu_dm_set_dmub_async_sync_status(is_cmd_aux,
					ctx, DMUB_ASYNC_TO_SYNC_ACCESS_SUCCESS,
					(uint32_t *)operation_result);
	}

11755
	ret = wait_for_completion_timeout(&adev->dm.dmub_aux_transfer_done, 10 * HZ);
11756
	if (ret == 0) {
11757
		DRM_ERROR("wait_for_completion_timeout timeout!");
11758 11759 11760
		return amdgpu_dm_set_dmub_async_sync_status(is_cmd_aux,
				ctx, DMUB_ASYNC_TO_SYNC_ACCESS_TIMEOUT,
				(uint32_t *)operation_result);
11761 11762
	}

11763 11764 11765
	if (is_cmd_aux) {
		if (adev->dm.dmub_notify->result == AUX_RET_SUCCESS) {
			struct aux_payload *payload = (struct aux_payload *)cmd_payload;
11766

11767 11768 11769 11770 11771 11772 11773
			payload->reply[0] = adev->dm.dmub_notify->aux_reply.command;
			if (!payload->write && adev->dm.dmub_notify->aux_reply.length &&
			    payload->reply[0] == AUX_TRANSACTION_REPLY_AUX_ACK) {
				memcpy(payload->data, adev->dm.dmub_notify->aux_reply.data,
				       adev->dm.dmub_notify->aux_reply.length);
			}
		}
11774 11775
	}

11776 11777 11778
	return amdgpu_dm_set_dmub_async_sync_status(is_cmd_aux,
			ctx, DMUB_ASYNC_TO_SYNC_ACCESS_SUCCESS,
			(uint32_t *)operation_result);
11779
}
11780 11781 11782 11783 11784 11785 11786 11787 11788 11789 11790 11791 11792 11793 11794 11795 11796 11797 11798 11799 11800

/*
 * Check whether seamless boot is supported.
 *
 * So far we only support seamless boot on CHIP_VANGOGH.
 * If everything goes well, we may consider expanding
 * seamless boot to other ASICs.
 */
bool check_seamless_boot_capability(struct amdgpu_device *adev)
{
	switch (adev->asic_type) {
	case CHIP_VANGOGH:
		if (!adev->mman.keep_stolen_vga_memory)
			return true;
		break;
	default:
		break;
	}

	return false;
}