1/*
2 * Copyright 2021 Advanced Micro Devices, Inc.
3 *
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
10 *
11 * The above copyright notice and this permission notice shall be included in
12 * all copies or substantial portions of the Software.
13 *
14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20 * OTHER DEALINGS IN THE SOFTWARE.
21 *
22 * Authors: AMD
23 *
24 */
25
26#include "amdgpu_dm_psr.h"
27#include "dc_dmub_srv.h"
28#include "dc.h"
29#include "dm_helpers.h"
30#include "amdgpu_dm.h"
31#include "modules/power/power_helpers.h"
32
33static bool link_supports_psrsu(struct dc_link *link)
34{
35	struct dc *dc = link->ctx->dc;
36
37	if (!dc->caps.dmcub_support)
38		return false;
39
40	if (dc->ctx->dce_version < DCN_VERSION_3_1)
41		return false;
42
43	if (!is_psr_su_specific_panel(link))
44		return false;
45
46	if (!link->dpcd_caps.alpm_caps.bits.AUX_WAKE_ALPM_CAP ||
47	    !link->dpcd_caps.psr_info.psr_dpcd_caps.bits.Y_COORDINATE_REQUIRED)
48		return false;
49
50	if (link->dpcd_caps.psr_info.psr_dpcd_caps.bits.SU_GRANULARITY_REQUIRED &&
51	    !link->dpcd_caps.psr_info.psr2_su_y_granularity_cap)
52		return false;
53
54	if (amdgpu_dc_debug_mask & DC_DISABLE_PSR_SU)
55		return false;
56
57	return dc_dmub_check_min_version(dc->ctx->dmub_srv->dmub);
58}
59
60/*
61 * amdgpu_dm_set_psr_caps() - set link psr capabilities
62 * @link: link
63 *
64 */
65void amdgpu_dm_set_psr_caps(struct dc_link *link)
66{
67	if (!(link->connector_signal & SIGNAL_TYPE_EDP)) {
68		link->psr_settings.psr_feature_enabled = false;
69		return;
70	}
71
72	if (link->type == dc_connection_none) {
73		link->psr_settings.psr_feature_enabled = false;
74		return;
75	}
76
77	if (link->dpcd_caps.psr_info.psr_version == 0) {
78		link->psr_settings.psr_version = DC_PSR_VERSION_UNSUPPORTED;
79		link->psr_settings.psr_feature_enabled = false;
80
81	} else {
82		if (link_supports_psrsu(link))
83			link->psr_settings.psr_version = DC_PSR_VERSION_SU_1;
84		else
85			link->psr_settings.psr_version = DC_PSR_VERSION_1;
86
87		link->psr_settings.psr_feature_enabled = true;
88	}
89
90	DRM_INFO("PSR support %d, DC PSR ver %d, sink PSR ver %d DPCD caps 0x%x su_y_granularity %d\n",
91		link->psr_settings.psr_feature_enabled,
92		link->psr_settings.psr_version,
93		link->dpcd_caps.psr_info.psr_version,
94		link->dpcd_caps.psr_info.psr_dpcd_caps.raw,
95		link->dpcd_caps.psr_info.psr2_su_y_granularity_cap);
96
97}
98
99/*
100 * amdgpu_dm_link_setup_psr() - configure psr link
101 * @stream: stream state
102 *
103 * Return: true if success
104 */
105bool amdgpu_dm_link_setup_psr(struct dc_stream_state *stream)
106{
107	struct dc_link *link = NULL;
108	struct psr_config psr_config = {0};
109	struct psr_context psr_context = {0};
110	struct dc *dc = NULL;
111	bool ret = false;
112
113	if (stream == NULL)
114		return false;
115
116	link = stream->link;
117	dc = link->ctx->dc;
118
119	if (link->psr_settings.psr_version != DC_PSR_VERSION_UNSUPPORTED) {
120		mod_power_calc_psr_configs(&psr_config, link, stream);
121
122		/* linux DM specific updating for psr config fields */
123		psr_config.allow_smu_optimizations =
124			(amdgpu_dc_feature_mask & DC_PSR_ALLOW_SMU_OPT) &&
125			mod_power_only_edp(dc->current_state, stream);
126		psr_config.allow_multi_disp_optimizations =
127			(amdgpu_dc_feature_mask & DC_PSR_ALLOW_MULTI_DISP_OPT);
128
129		if (!psr_su_set_dsc_slice_height(dc, link, stream, &psr_config))
130			return false;
131
132		ret = dc_link_setup_psr(link, stream, &psr_config, &psr_context);
133
134	}
135	DRM_DEBUG_DRIVER("PSR link: %d\n",	link->psr_settings.psr_feature_enabled);
136
137	return ret;
138}
139
140/*
141 * amdgpu_dm_psr_enable() - enable psr f/w
142 * @stream: stream state
143 *
144 */
145void amdgpu_dm_psr_enable(struct dc_stream_state *stream)
146{
147	struct dc_link *link = stream->link;
148	unsigned int vsync_rate_hz = 0;
149	struct dc_static_screen_params params = {0};
150	/* Calculate number of static frames before generating interrupt to
151	 * enter PSR.
152	 */
153	// Init fail safe of 2 frames static
154	unsigned int num_frames_static = 2;
155	unsigned int power_opt = 0;
156	bool psr_enable = true;
157
158	DRM_DEBUG_DRIVER("Enabling psr...\n");
159
160	vsync_rate_hz = div64_u64(div64_u64((
161			stream->timing.pix_clk_100hz * 100),
162			stream->timing.v_total),
163			stream->timing.h_total);
164
165	/* Round up
166	 * Calculate number of frames such that at least 30 ms of time has
167	 * passed.
168	 */
169	if (vsync_rate_hz != 0) {
170		unsigned int frame_time_microsec = 1000000 / vsync_rate_hz;
171
172		num_frames_static = (30000 / frame_time_microsec) + 1;
173	}
174
175	params.triggers.cursor_update = true;
176	params.triggers.overlay_update = true;
177	params.triggers.surface_update = true;
178	params.num_frames = num_frames_static;
179
180	dc_stream_set_static_screen_params(link->ctx->dc,
181					   &stream, 1,
182					   &params);
183
184	/*
185	 * Only enable static-screen optimizations for PSR1. For PSR SU, this
186	 * causes vstartup interrupt issues, used by amdgpu_dm to send vblank
187	 * events.
188	 */
189	if (link->psr_settings.psr_version < DC_PSR_VERSION_SU_1)
190		power_opt |= psr_power_opt_z10_static_screen;
191
192	dc_link_set_psr_allow_active(link, &psr_enable, false, false, &power_opt);
193
194	if (link->ctx->dc->caps.ips_support)
195		dc_allow_idle_optimizations(link->ctx->dc, true);
196}
197
198/*
199 * amdgpu_dm_psr_disable() - disable psr f/w
200 * @stream:  stream state
201 *
202 * Return: true if success
203 */
204bool amdgpu_dm_psr_disable(struct dc_stream_state *stream)
205{
206	unsigned int power_opt = 0;
207	bool psr_enable = false;
208
209	DRM_DEBUG_DRIVER("Disabling psr...\n");
210
211	return dc_link_set_psr_allow_active(stream->link, &psr_enable, true, false, &power_opt);
212}
213
214/*
215 * amdgpu_dm_psr_disable() - disable psr f/w
216 * if psr is enabled on any stream
217 *
218 * Return: true if success
219 */
220bool amdgpu_dm_psr_disable_all(struct amdgpu_display_manager *dm)
221{
222	DRM_DEBUG_DRIVER("Disabling psr if psr is enabled on any stream\n");
223	return dc_set_psr_allow_active(dm->dc, false);
224}
225
226