radeon_pm.c 25.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/*
 * 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: Rafał Miłecki <zajec5@gmail.com>
21
 *          Alex Deucher <alexdeucher@gmail.com>
22 23 24
 */
#include "drmP.h"
#include "radeon.h"
25
#include "avivod.h"
26
#include "atom.h"
27
#include <linux/power_supply.h>
28 29
#include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h>
30

31 32
#define RADEON_IDLE_LOOP_MS 100
#define RADEON_RECLOCK_DELAY_MS 200
33
#define RADEON_WAIT_VBLANK_TIMEOUT 200
34

35 36 37 38 39 40 41 42
static const char *radeon_pm_state_type_name[5] = {
	"Default",
	"Powersave",
	"Battery",
	"Balanced",
	"Performance",
};

43
static void radeon_dynpm_idle_work_handler(struct work_struct *work);
44
static int radeon_debugfs_pm_init(struct radeon_device *rdev);
45 46 47 48 49
static bool radeon_pm_in_vbl(struct radeon_device *rdev);
static bool radeon_pm_debug_check_in_vbl(struct radeon_device *rdev, bool finish);
static void radeon_pm_update_profile(struct radeon_device *rdev);
static void radeon_pm_set_clocks(struct radeon_device *rdev);

50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67
int radeon_pm_get_type_index(struct radeon_device *rdev,
			     enum radeon_pm_state_type ps_type,
			     int instance)
{
	int i;
	int found_instance = -1;

	for (i = 0; i < rdev->pm.num_power_states; i++) {
		if (rdev->pm.power_state[i].type == ps_type) {
			found_instance++;
			if (found_instance == instance)
				return i;
		}
	}
	/* return default if no match */
	return rdev->pm.default_power_state_index;
}

68
void radeon_pm_acpi_event_handler(struct radeon_device *rdev)
69
{
70 71 72 73 74 75
	if (rdev->pm.pm_method == PM_METHOD_PROFILE) {
		if (rdev->pm.profile == PM_PROFILE_AUTO) {
			mutex_lock(&rdev->pm.mutex);
			radeon_pm_update_profile(rdev);
			radeon_pm_set_clocks(rdev);
			mutex_unlock(&rdev->pm.mutex);
76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93
		}
	}
}

static void radeon_pm_update_profile(struct radeon_device *rdev)
{
	switch (rdev->pm.profile) {
	case PM_PROFILE_DEFAULT:
		rdev->pm.profile_index = PM_PROFILE_DEFAULT_IDX;
		break;
	case PM_PROFILE_AUTO:
		if (power_supply_is_system_supplied() > 0) {
			if (rdev->pm.active_crtc_count > 1)
				rdev->pm.profile_index = PM_PROFILE_HIGH_MH_IDX;
			else
				rdev->pm.profile_index = PM_PROFILE_HIGH_SH_IDX;
		} else {
			if (rdev->pm.active_crtc_count > 1)
94
				rdev->pm.profile_index = PM_PROFILE_MID_MH_IDX;
95
			else
96
				rdev->pm.profile_index = PM_PROFILE_MID_SH_IDX;
97 98 99 100 101 102 103 104
		}
		break;
	case PM_PROFILE_LOW:
		if (rdev->pm.active_crtc_count > 1)
			rdev->pm.profile_index = PM_PROFILE_LOW_MH_IDX;
		else
			rdev->pm.profile_index = PM_PROFILE_LOW_SH_IDX;
		break;
105 106 107 108 109 110
	case PM_PROFILE_MID:
		if (rdev->pm.active_crtc_count > 1)
			rdev->pm.profile_index = PM_PROFILE_MID_MH_IDX;
		else
			rdev->pm.profile_index = PM_PROFILE_MID_SH_IDX;
		break;
111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130
	case PM_PROFILE_HIGH:
		if (rdev->pm.active_crtc_count > 1)
			rdev->pm.profile_index = PM_PROFILE_HIGH_MH_IDX;
		else
			rdev->pm.profile_index = PM_PROFILE_HIGH_SH_IDX;
		break;
	}

	if (rdev->pm.active_crtc_count == 0) {
		rdev->pm.requested_power_state_index =
			rdev->pm.profiles[rdev->pm.profile_index].dpms_off_ps_idx;
		rdev->pm.requested_clock_mode_index =
			rdev->pm.profiles[rdev->pm.profile_index].dpms_off_cm_idx;
	} else {
		rdev->pm.requested_power_state_index =
			rdev->pm.profiles[rdev->pm.profile_index].dpms_on_ps_idx;
		rdev->pm.requested_clock_mode_index =
			rdev->pm.profiles[rdev->pm.profile_index].dpms_on_cm_idx;
	}
}
131

132 133 134 135 136 137 138 139 140 141 142 143 144
static void radeon_unmap_vram_bos(struct radeon_device *rdev)
{
	struct radeon_bo *bo, *n;

	if (list_empty(&rdev->gem.objects))
		return;

	list_for_each_entry_safe(bo, n, &rdev->gem.objects, list) {
		if (bo->tbo.mem.mem_type == TTM_PL_VRAM)
			ttm_bo_unmap_virtual(&bo->tbo);
	}
}

145
static void radeon_sync_with_vblank(struct radeon_device *rdev)
146
{
147 148 149 150 151 152 153 154 155 156 157
	if (rdev->pm.active_crtcs) {
		rdev->pm.vblank_sync = false;
		wait_event_timeout(
			rdev->irq.vblank_queue, rdev->pm.vblank_sync,
			msecs_to_jiffies(RADEON_WAIT_VBLANK_TIMEOUT));
	}
}

static void radeon_set_power_state(struct radeon_device *rdev)
{
	u32 sclk, mclk;
158
	bool misc_after = false;
159 160 161 162 163 164 165 166

	if ((rdev->pm.requested_clock_mode_index == rdev->pm.current_clock_mode_index) &&
	    (rdev->pm.requested_power_state_index == rdev->pm.current_power_state_index))
		return;

	if (radeon_gui_idle(rdev)) {
		sclk = rdev->pm.power_state[rdev->pm.requested_power_state_index].
			clock_info[rdev->pm.requested_clock_mode_index].sclk;
167 168
		if (sclk > rdev->pm.default_sclk)
			sclk = rdev->pm.default_sclk;
169 170 171

		mclk = rdev->pm.power_state[rdev->pm.requested_power_state_index].
			clock_info[rdev->pm.requested_clock_mode_index].mclk;
172 173
		if (mclk > rdev->pm.default_mclk)
			mclk = rdev->pm.default_mclk;
174

175 176 177
		/* upvolt before raising clocks, downvolt after lowering clocks */
		if (sclk < rdev->pm.current_sclk)
			misc_after = true;
178

179
		radeon_sync_with_vblank(rdev);
180

181
		if (rdev->pm.pm_method == PM_METHOD_DYNPM) {
182 183
			if (!radeon_pm_in_vbl(rdev))
				return;
184
		}
185

186
		radeon_pm_prepare(rdev);
187

188 189 190 191 192 193 194 195 196 197
		if (!misc_after)
			/* voltage, pcie lanes, etc.*/
			radeon_pm_misc(rdev);

		/* set engine clock */
		if (sclk != rdev->pm.current_sclk) {
			radeon_pm_debug_check_in_vbl(rdev, false);
			radeon_set_engine_clock(rdev, sclk);
			radeon_pm_debug_check_in_vbl(rdev, true);
			rdev->pm.current_sclk = sclk;
198
			DRM_DEBUG_DRIVER("Setting: e: %d\n", sclk);
199 200 201
		}

		/* set memory clock */
202
		if (rdev->asic->pm.set_memory_clock && (mclk != rdev->pm.current_mclk)) {
203 204 205 206
			radeon_pm_debug_check_in_vbl(rdev, false);
			radeon_set_memory_clock(rdev, mclk);
			radeon_pm_debug_check_in_vbl(rdev, true);
			rdev->pm.current_mclk = mclk;
207
			DRM_DEBUG_DRIVER("Setting: m: %d\n", mclk);
208
		}
M
Matthew Garrett 已提交
209

210 211 212 213 214 215
		if (misc_after)
			/* voltage, pcie lanes, etc.*/
			radeon_pm_misc(rdev);

		radeon_pm_finish(rdev);

216 217 218
		rdev->pm.current_power_state_index = rdev->pm.requested_power_state_index;
		rdev->pm.current_clock_mode_index = rdev->pm.requested_clock_mode_index;
	} else
219
		DRM_DEBUG_DRIVER("pm: GUI not idle!!!\n");
220 221 222 223 224
}

static void radeon_pm_set_clocks(struct radeon_device *rdev)
{
	int i;
225

226 227 228 229 230
	/* no need to take locks, etc. if nothing's going to change */
	if ((rdev->pm.requested_clock_mode_index == rdev->pm.current_clock_mode_index) &&
	    (rdev->pm.requested_power_state_index == rdev->pm.current_power_state_index))
		return;

231
	mutex_lock(&rdev->ddev->struct_mutex);
232
	down_write(&rdev->pm.mclk_lock);
233
	mutex_lock(&rdev->ring_lock);
234

235 236 237 238 239
	/* wait for the rings to drain */
	for (i = 0; i < RADEON_NUM_RINGS; i++) {
		struct radeon_ring *ring = &rdev->ring[i];
		if (ring->ready)
			radeon_fence_wait_empty_locked(rdev, i);
240
	}
241

242 243
	radeon_unmap_vram_bos(rdev);

244
	if (rdev->irq.installed) {
M
Matthew Garrett 已提交
245 246 247 248 249 250 251
		for (i = 0; i < rdev->num_crtc; i++) {
			if (rdev->pm.active_crtcs & (1 << i)) {
				rdev->pm.req_vblank |= (1 << i);
				drm_vblank_get(rdev->ddev, i);
			}
		}
	}
A
Alex Deucher 已提交
252

253
	radeon_set_power_state(rdev);
M
Matthew Garrett 已提交
254

255
	if (rdev->irq.installed) {
M
Matthew Garrett 已提交
256 257 258 259 260 261 262
		for (i = 0; i < rdev->num_crtc; i++) {
			if (rdev->pm.req_vblank & (1 << i)) {
				rdev->pm.req_vblank &= ~(1 << i);
				drm_vblank_put(rdev->ddev, i);
			}
		}
	}
263

264 265 266 267 268
	/* update display watermarks based on new power state */
	radeon_update_bandwidth_info(rdev);
	if (rdev->pm.active_crtc_count)
		radeon_bandwidth_update(rdev);

269
	rdev->pm.dynpm_planned_action = DYNPM_ACTION_NONE;
M
Matthew Garrett 已提交
270

271
	mutex_unlock(&rdev->ring_lock);
272
	up_write(&rdev->pm.mclk_lock);
273
	mutex_unlock(&rdev->ddev->struct_mutex);
274 275
}

276 277 278 279 280 281
static void radeon_pm_print_states(struct radeon_device *rdev)
{
	int i, j;
	struct radeon_power_state *power_state;
	struct radeon_pm_clock_info *clock_info;

282
	DRM_DEBUG_DRIVER("%d Power State(s)\n", rdev->pm.num_power_states);
283 284
	for (i = 0; i < rdev->pm.num_power_states; i++) {
		power_state = &rdev->pm.power_state[i];
285
		DRM_DEBUG_DRIVER("State %d: %s\n", i,
286 287
			radeon_pm_state_type_name[power_state->type]);
		if (i == rdev->pm.default_power_state_index)
288
			DRM_DEBUG_DRIVER("\tDefault");
289
		if ((rdev->flags & RADEON_IS_PCIE) && !(rdev->flags & RADEON_IS_IGP))
290
			DRM_DEBUG_DRIVER("\t%d PCIE Lanes\n", power_state->pcie_lanes);
291
		if (power_state->flags & RADEON_PM_STATE_SINGLE_DISPLAY_ONLY)
292 293
			DRM_DEBUG_DRIVER("\tSingle display only\n");
		DRM_DEBUG_DRIVER("\t%d Clock Mode(s)\n", power_state->num_clock_modes);
294 295 296
		for (j = 0; j < power_state->num_clock_modes; j++) {
			clock_info = &(power_state->clock_info[j]);
			if (rdev->flags & RADEON_IS_IGP)
297
				DRM_DEBUG_DRIVER("\t\t%d e: %d%s\n",
298 299 300 301
					j,
					clock_info->sclk * 10,
					clock_info->flags & RADEON_PM_MODE_NO_DISPLAY ? "\tNo display only" : "");
			else
302
				DRM_DEBUG_DRIVER("\t\t%d e: %d\tm: %d\tv: %d%s\n",
303 304 305 306 307 308 309 310 311
					j,
					clock_info->sclk * 10,
					clock_info->mclk * 10,
					clock_info->voltage.voltage,
					clock_info->flags & RADEON_PM_MODE_NO_DISPLAY ? "\tNo display only" : "");
		}
	}
}

312 313 314
static ssize_t radeon_get_pm_profile(struct device *dev,
				     struct device_attribute *attr,
				     char *buf)
315 316 317
{
	struct drm_device *ddev = pci_get_drvdata(to_pci_dev(dev));
	struct radeon_device *rdev = ddev->dev_private;
318
	int cp = rdev->pm.profile;
319

320 321 322
	return snprintf(buf, PAGE_SIZE, "%s\n",
			(cp == PM_PROFILE_AUTO) ? "auto" :
			(cp == PM_PROFILE_LOW) ? "low" :
323
			(cp == PM_PROFILE_MID) ? "mid" :
324
			(cp == PM_PROFILE_HIGH) ? "high" : "default");
325 326
}

327 328 329 330
static ssize_t radeon_set_pm_profile(struct device *dev,
				     struct device_attribute *attr,
				     const char *buf,
				     size_t count)
331 332 333 334 335
{
	struct drm_device *ddev = pci_get_drvdata(to_pci_dev(dev));
	struct radeon_device *rdev = ddev->dev_private;

	mutex_lock(&rdev->pm.mutex);
336 337 338 339 340 341 342
	if (rdev->pm.pm_method == PM_METHOD_PROFILE) {
		if (strncmp("default", buf, strlen("default")) == 0)
			rdev->pm.profile = PM_PROFILE_DEFAULT;
		else if (strncmp("auto", buf, strlen("auto")) == 0)
			rdev->pm.profile = PM_PROFILE_AUTO;
		else if (strncmp("low", buf, strlen("low")) == 0)
			rdev->pm.profile = PM_PROFILE_LOW;
343 344
		else if (strncmp("mid", buf, strlen("mid")) == 0)
			rdev->pm.profile = PM_PROFILE_MID;
345 346 347
		else if (strncmp("high", buf, strlen("high")) == 0)
			rdev->pm.profile = PM_PROFILE_HIGH;
		else {
348
			count = -EINVAL;
349
			goto fail;
350
		}
351 352
		radeon_pm_update_profile(rdev);
		radeon_pm_set_clocks(rdev);
353 354 355
	} else
		count = -EINVAL;

356
fail:
357 358 359 360 361
	mutex_unlock(&rdev->pm.mutex);

	return count;
}

362 363 364
static ssize_t radeon_get_pm_method(struct device *dev,
				    struct device_attribute *attr,
				    char *buf)
365 366 367
{
	struct drm_device *ddev = pci_get_drvdata(to_pci_dev(dev));
	struct radeon_device *rdev = ddev->dev_private;
368
	int pm = rdev->pm.pm_method;
369 370

	return snprintf(buf, PAGE_SIZE, "%s\n",
371
			(pm == PM_METHOD_DYNPM) ? "dynpm" : "profile");
372 373
}

374 375 376 377
static ssize_t radeon_set_pm_method(struct device *dev,
				    struct device_attribute *attr,
				    const char *buf,
				    size_t count)
378 379 380 381
{
	struct drm_device *ddev = pci_get_drvdata(to_pci_dev(dev));
	struct radeon_device *rdev = ddev->dev_private;

382 383

	if (strncmp("dynpm", buf, strlen("dynpm")) == 0) {
384
		mutex_lock(&rdev->pm.mutex);
385 386 387
		rdev->pm.pm_method = PM_METHOD_DYNPM;
		rdev->pm.dynpm_state = DYNPM_STATE_PAUSED;
		rdev->pm.dynpm_planned_action = DYNPM_ACTION_DEFAULT;
388
		mutex_unlock(&rdev->pm.mutex);
389 390 391 392 393
	} else if (strncmp("profile", buf, strlen("profile")) == 0) {
		mutex_lock(&rdev->pm.mutex);
		/* disable dynpm */
		rdev->pm.dynpm_state = DYNPM_STATE_DISABLED;
		rdev->pm.dynpm_planned_action = DYNPM_ACTION_NONE;
394
		rdev->pm.pm_method = PM_METHOD_PROFILE;
395
		mutex_unlock(&rdev->pm.mutex);
396
		cancel_delayed_work_sync(&rdev->pm.dynpm_idle_work);
397
	} else {
398
		count = -EINVAL;
399 400 401 402
		goto fail;
	}
	radeon_pm_compute_clocks(rdev);
fail:
403 404 405
	return count;
}

406 407
static DEVICE_ATTR(power_profile, S_IRUGO | S_IWUSR, radeon_get_pm_profile, radeon_set_pm_profile);
static DEVICE_ATTR(power_method, S_IRUGO | S_IWUSR, radeon_get_pm_method, radeon_set_pm_method);
408

409 410 411 412 413 414
static ssize_t radeon_hwmon_show_temp(struct device *dev,
				      struct device_attribute *attr,
				      char *buf)
{
	struct drm_device *ddev = pci_get_drvdata(to_pci_dev(dev));
	struct radeon_device *rdev = ddev->dev_private;
415
	int temp;
416 417 418 419 420 421 422 423 424

	switch (rdev->pm.int_thermal_type) {
	case THERMAL_TYPE_RV6XX:
		temp = rv6xx_get_temp(rdev);
		break;
	case THERMAL_TYPE_RV770:
		temp = rv770_get_temp(rdev);
		break;
	case THERMAL_TYPE_EVERGREEN:
425
	case THERMAL_TYPE_NI:
426 427
		temp = evergreen_get_temp(rdev);
		break;
428 429 430
	case THERMAL_TYPE_SUMO:
		temp = sumo_get_temp(rdev);
		break;
431 432 433
	case THERMAL_TYPE_SI:
		temp = si_get_temp(rdev);
		break;
434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
	default:
		temp = 0;
		break;
	}

	return snprintf(buf, PAGE_SIZE, "%d\n", temp);
}

static ssize_t radeon_hwmon_show_name(struct device *dev,
				      struct device_attribute *attr,
				      char *buf)
{
	return sprintf(buf, "radeon\n");
}

static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, radeon_hwmon_show_temp, NULL, 0);
static SENSOR_DEVICE_ATTR(name, S_IRUGO, radeon_hwmon_show_name, NULL, 0);

static struct attribute *hwmon_attributes[] = {
	&sensor_dev_attr_temp1_input.dev_attr.attr,
	&sensor_dev_attr_name.dev_attr.attr,
	NULL
};

static const struct attribute_group hwmon_attrgroup = {
	.attrs = hwmon_attributes,
};

462
static int radeon_hwmon_init(struct radeon_device *rdev)
463
{
464
	int err = 0;
465 466 467 468 469 470 471

	rdev->pm.int_hwmon_dev = NULL;

	switch (rdev->pm.int_thermal_type) {
	case THERMAL_TYPE_RV6XX:
	case THERMAL_TYPE_RV770:
	case THERMAL_TYPE_EVERGREEN:
472
	case THERMAL_TYPE_NI:
473
	case THERMAL_TYPE_SUMO:
474
	case THERMAL_TYPE_SI:
475 476 477
		/* No support for TN yet */
		if (rdev->family == CHIP_ARUBA)
			return err;
478
		rdev->pm.int_hwmon_dev = hwmon_device_register(rdev->dev);
479 480 481 482 483 484
		if (IS_ERR(rdev->pm.int_hwmon_dev)) {
			err = PTR_ERR(rdev->pm.int_hwmon_dev);
			dev_err(rdev->dev,
				"Unable to register hwmon device: %d\n", err);
			break;
		}
485 486 487
		dev_set_drvdata(rdev->pm.int_hwmon_dev, rdev->ddev);
		err = sysfs_create_group(&rdev->pm.int_hwmon_dev->kobj,
					 &hwmon_attrgroup);
488 489 490 491 492
		if (err) {
			dev_err(rdev->dev,
				"Unable to create hwmon sysfs file: %d\n", err);
			hwmon_device_unregister(rdev->dev);
		}
493 494 495 496
		break;
	default:
		break;
	}
497 498

	return err;
499 500 501 502 503 504 505 506 507 508
}

static void radeon_hwmon_fini(struct radeon_device *rdev)
{
	if (rdev->pm.int_hwmon_dev) {
		sysfs_remove_group(&rdev->pm.int_hwmon_dev->kobj, &hwmon_attrgroup);
		hwmon_device_unregister(rdev->pm.int_hwmon_dev);
	}
}

509
void radeon_pm_suspend(struct radeon_device *rdev)
510
{
511
	mutex_lock(&rdev->pm.mutex);
512 513 514 515
	if (rdev->pm.pm_method == PM_METHOD_DYNPM) {
		if (rdev->pm.dynpm_state == DYNPM_STATE_ACTIVE)
			rdev->pm.dynpm_state = DYNPM_STATE_SUSPENDED;
	}
516
	mutex_unlock(&rdev->pm.mutex);
517 518

	cancel_delayed_work_sync(&rdev->pm.dynpm_idle_work);
519 520
}

521
void radeon_pm_resume(struct radeon_device *rdev)
522
{
523
	/* set up the default clocks if the MC ucode is loaded */
524 525 526
	if ((rdev->family >= CHIP_BARTS) &&
	    (rdev->family <= CHIP_CAYMAN) &&
	    rdev->mc_fw) {
527
		if (rdev->pm.default_vddc)
528 529
			radeon_atom_set_voltage(rdev, rdev->pm.default_vddc,
						SET_VOLTAGE_TYPE_ASIC_VDDC);
530 531 532
		if (rdev->pm.default_vddci)
			radeon_atom_set_voltage(rdev, rdev->pm.default_vddci,
						SET_VOLTAGE_TYPE_ASIC_VDDCI);
533 534 535 536 537
		if (rdev->pm.default_sclk)
			radeon_set_engine_clock(rdev, rdev->pm.default_sclk);
		if (rdev->pm.default_mclk)
			radeon_set_memory_clock(rdev, rdev->pm.default_mclk);
	}
A
Alex Deucher 已提交
538 539 540 541
	/* asic init will reset the default power state */
	mutex_lock(&rdev->pm.mutex);
	rdev->pm.current_power_state_index = rdev->pm.default_power_state_index;
	rdev->pm.current_clock_mode_index = 0;
542 543
	rdev->pm.current_sclk = rdev->pm.default_sclk;
	rdev->pm.current_mclk = rdev->pm.default_mclk;
544
	rdev->pm.current_vddc = rdev->pm.power_state[rdev->pm.default_power_state_index].clock_info[0].voltage.voltage;
545
	rdev->pm.current_vddci = rdev->pm.power_state[rdev->pm.default_power_state_index].clock_info[0].voltage.vddci;
546 547 548
	if (rdev->pm.pm_method == PM_METHOD_DYNPM
	    && rdev->pm.dynpm_state == DYNPM_STATE_SUSPENDED) {
		rdev->pm.dynpm_state = DYNPM_STATE_ACTIVE;
549 550
		schedule_delayed_work(&rdev->pm.dynpm_idle_work,
				      msecs_to_jiffies(RADEON_IDLE_LOOP_MS));
551
	}
A
Alex Deucher 已提交
552
	mutex_unlock(&rdev->pm.mutex);
553
	radeon_pm_compute_clocks(rdev);
554 555
}

556 557
int radeon_pm_init(struct radeon_device *rdev)
{
558
	int ret;
559

560 561
	/* default to profile method */
	rdev->pm.pm_method = PM_METHOD_PROFILE;
A
Alex Deucher 已提交
562
	rdev->pm.profile = PM_PROFILE_DEFAULT;
563 564 565 566
	rdev->pm.dynpm_state = DYNPM_STATE_DISABLED;
	rdev->pm.dynpm_planned_action = DYNPM_ACTION_NONE;
	rdev->pm.dynpm_can_upclock = true;
	rdev->pm.dynpm_can_downclock = true;
567 568
	rdev->pm.default_sclk = rdev->clock.default_sclk;
	rdev->pm.default_mclk = rdev->clock.default_mclk;
A
Alex Deucher 已提交
569 570
	rdev->pm.current_sclk = rdev->clock.default_sclk;
	rdev->pm.current_mclk = rdev->clock.default_mclk;
571
	rdev->pm.int_thermal_type = THERMAL_TYPE_NONE;
572

573 574 575 576 577
	if (rdev->bios) {
		if (rdev->is_atom_bios)
			radeon_atombios_get_power_modes(rdev);
		else
			radeon_combios_get_power_modes(rdev);
578
		radeon_pm_print_states(rdev);
579
		radeon_pm_init_profile(rdev);
580
		/* set up the default clocks if the MC ucode is loaded */
581 582 583
		if ((rdev->family >= CHIP_BARTS) &&
		    (rdev->family <= CHIP_CAYMAN) &&
		    rdev->mc_fw) {
584
			if (rdev->pm.default_vddc)
585 586
				radeon_atom_set_voltage(rdev, rdev->pm.default_vddc,
							SET_VOLTAGE_TYPE_ASIC_VDDC);
587 588 589
			if (rdev->pm.default_vddci)
				radeon_atom_set_voltage(rdev, rdev->pm.default_vddci,
							SET_VOLTAGE_TYPE_ASIC_VDDCI);
590 591 592 593 594
			if (rdev->pm.default_sclk)
				radeon_set_engine_clock(rdev, rdev->pm.default_sclk);
			if (rdev->pm.default_mclk)
				radeon_set_memory_clock(rdev, rdev->pm.default_mclk);
		}
595 596
	}

597
	/* set up the internal thermal sensor if applicable */
598 599 600
	ret = radeon_hwmon_init(rdev);
	if (ret)
		return ret;
601 602 603

	INIT_DELAYED_WORK(&rdev->pm.dynpm_idle_work, radeon_dynpm_idle_work_handler);

604 605
	if (rdev->pm.num_power_states > 1) {
		/* where's the best place to put these? */
606 607 608 609 610 611
		ret = device_create_file(rdev->dev, &dev_attr_power_profile);
		if (ret)
			DRM_ERROR("failed to create device file for power profile\n");
		ret = device_create_file(rdev->dev, &dev_attr_power_method);
		if (ret)
			DRM_ERROR("failed to create device file for power method\n");
612

613 614 615
		if (radeon_debugfs_pm_init(rdev)) {
			DRM_ERROR("Failed to register debugfs file for PM!\n");
		}
616

617 618
		DRM_INFO("radeon: power management initialized\n");
	}
619

620 621 622
	return 0;
}

623 624
void radeon_pm_fini(struct radeon_device *rdev)
{
625
	if (rdev->pm.num_power_states > 1) {
626
		mutex_lock(&rdev->pm.mutex);
627 628 629 630 631 632 633 634 635 636
		if (rdev->pm.pm_method == PM_METHOD_PROFILE) {
			rdev->pm.profile = PM_PROFILE_DEFAULT;
			radeon_pm_update_profile(rdev);
			radeon_pm_set_clocks(rdev);
		} else if (rdev->pm.pm_method == PM_METHOD_DYNPM) {
			/* reset default clocks */
			rdev->pm.dynpm_state = DYNPM_STATE_DISABLED;
			rdev->pm.dynpm_planned_action = DYNPM_ACTION_DEFAULT;
			radeon_pm_set_clocks(rdev);
		}
637
		mutex_unlock(&rdev->pm.mutex);
638 639

		cancel_delayed_work_sync(&rdev->pm.dynpm_idle_work);
640

641 642 643
		device_remove_file(rdev->dev, &dev_attr_power_profile);
		device_remove_file(rdev->dev, &dev_attr_power_method);
	}
644

645 646 647
	if (rdev->pm.power_state)
		kfree(rdev->pm.power_state);

648
	radeon_hwmon_fini(rdev);
649 650
}

651 652 653
void radeon_pm_compute_clocks(struct radeon_device *rdev)
{
	struct drm_device *ddev = rdev->ddev;
654
	struct drm_crtc *crtc;
655 656
	struct radeon_crtc *radeon_crtc;

657 658 659
	if (rdev->pm.num_power_states < 2)
		return;

660 661 662
	mutex_lock(&rdev->pm.mutex);

	rdev->pm.active_crtcs = 0;
663 664 665 666 667
	rdev->pm.active_crtc_count = 0;
	list_for_each_entry(crtc,
		&ddev->mode_config.crtc_list, head) {
		radeon_crtc = to_radeon_crtc(crtc);
		if (radeon_crtc->enabled) {
668
			rdev->pm.active_crtcs |= (1 << radeon_crtc->crtc_id);
669
			rdev->pm.active_crtc_count++;
670 671 672
		}
	}

673 674 675 676 677 678 679 680 681 682 683 684 685 686
	if (rdev->pm.pm_method == PM_METHOD_PROFILE) {
		radeon_pm_update_profile(rdev);
		radeon_pm_set_clocks(rdev);
	} else if (rdev->pm.pm_method == PM_METHOD_DYNPM) {
		if (rdev->pm.dynpm_state != DYNPM_STATE_DISABLED) {
			if (rdev->pm.active_crtc_count > 1) {
				if (rdev->pm.dynpm_state == DYNPM_STATE_ACTIVE) {
					cancel_delayed_work(&rdev->pm.dynpm_idle_work);

					rdev->pm.dynpm_state = DYNPM_STATE_PAUSED;
					rdev->pm.dynpm_planned_action = DYNPM_ACTION_DEFAULT;
					radeon_pm_get_dynpm_state(rdev);
					radeon_pm_set_clocks(rdev);

687
					DRM_DEBUG_DRIVER("radeon: dynamic power management deactivated\n");
688 689 690 691 692 693 694 695 696 697
				}
			} else if (rdev->pm.active_crtc_count == 1) {
				/* TODO: Increase clocks if needed for current mode */

				if (rdev->pm.dynpm_state == DYNPM_STATE_MINIMUM) {
					rdev->pm.dynpm_state = DYNPM_STATE_ACTIVE;
					rdev->pm.dynpm_planned_action = DYNPM_ACTION_UPCLOCK;
					radeon_pm_get_dynpm_state(rdev);
					radeon_pm_set_clocks(rdev);

698 699
					schedule_delayed_work(&rdev->pm.dynpm_idle_work,
							      msecs_to_jiffies(RADEON_IDLE_LOOP_MS));
700 701
				} else if (rdev->pm.dynpm_state == DYNPM_STATE_PAUSED) {
					rdev->pm.dynpm_state = DYNPM_STATE_ACTIVE;
702 703
					schedule_delayed_work(&rdev->pm.dynpm_idle_work,
							      msecs_to_jiffies(RADEON_IDLE_LOOP_MS));
704
					DRM_DEBUG_DRIVER("radeon: dynamic power management activated\n");
705 706 707 708 709 710 711 712 713 714 715
				}
			} else { /* count == 0 */
				if (rdev->pm.dynpm_state != DYNPM_STATE_MINIMUM) {
					cancel_delayed_work(&rdev->pm.dynpm_idle_work);

					rdev->pm.dynpm_state = DYNPM_STATE_MINIMUM;
					rdev->pm.dynpm_planned_action = DYNPM_ACTION_MINIMUM;
					radeon_pm_get_dynpm_state(rdev);
					radeon_pm_set_clocks(rdev);
				}
			}
716 717
		}
	}
718 719

	mutex_unlock(&rdev->pm.mutex);
720 721
}

722
static bool radeon_pm_in_vbl(struct radeon_device *rdev)
723
{
724
	int  crtc, vpos, hpos, vbl_status;
725 726
	bool in_vbl = true;

727 728 729 730 731
	/* Iterate over all active crtc's. All crtc's must be in vblank,
	 * otherwise return in_vbl == false.
	 */
	for (crtc = 0; (crtc < rdev->num_crtc) && in_vbl; crtc++) {
		if (rdev->pm.active_crtcs & (1 << crtc)) {
732 733 734
			vbl_status = radeon_get_crtc_scanoutpos(rdev->ddev, crtc, &vpos, &hpos);
			if ((vbl_status & DRM_SCANOUTPOS_VALID) &&
			    !(vbl_status & DRM_SCANOUTPOS_INVBL))
735 736 737
				in_vbl = false;
		}
	}
738 739 740 741

	return in_vbl;
}

742
static bool radeon_pm_debug_check_in_vbl(struct radeon_device *rdev, bool finish)
743 744 745 746
{
	u32 stat_crtc = 0;
	bool in_vbl = radeon_pm_in_vbl(rdev);

747
	if (in_vbl == false)
748
		DRM_DEBUG_DRIVER("not in vbl for pm change %08x at %s\n", stat_crtc,
749
			 finish ? "exit" : "entry");
750 751
	return in_vbl;
}
752

753
static void radeon_dynpm_idle_work_handler(struct work_struct *work)
754 755
{
	struct radeon_device *rdev;
756
	int resched;
757
	rdev = container_of(work, struct radeon_device,
758
				pm.dynpm_idle_work.work);
759

760
	resched = ttm_bo_lock_delayed_workqueue(&rdev->mman.bdev);
761
	mutex_lock(&rdev->pm.mutex);
762
	if (rdev->pm.dynpm_state == DYNPM_STATE_ACTIVE) {
763
		int not_processed = 0;
764 765 766
		int i;

		for (i = 0; i < RADEON_NUM_RINGS; ++i) {
767 768 769 770 771 772 773
			struct radeon_ring *ring = &rdev->ring[i];

			if (ring->ready) {
				not_processed += radeon_fence_count_emitted(rdev, i);
				if (not_processed >= 3)
					break;
			}
774 775 776
		}

		if (not_processed >= 3) { /* should upclock */
777 778 779 780 781 782 783
			if (rdev->pm.dynpm_planned_action == DYNPM_ACTION_DOWNCLOCK) {
				rdev->pm.dynpm_planned_action = DYNPM_ACTION_NONE;
			} else if (rdev->pm.dynpm_planned_action == DYNPM_ACTION_NONE &&
				   rdev->pm.dynpm_can_upclock) {
				rdev->pm.dynpm_planned_action =
					DYNPM_ACTION_UPCLOCK;
				rdev->pm.dynpm_action_timeout = jiffies +
784 785 786
				msecs_to_jiffies(RADEON_RECLOCK_DELAY_MS);
			}
		} else if (not_processed == 0) { /* should downclock */
787 788 789 790 791 792 793
			if (rdev->pm.dynpm_planned_action == DYNPM_ACTION_UPCLOCK) {
				rdev->pm.dynpm_planned_action = DYNPM_ACTION_NONE;
			} else if (rdev->pm.dynpm_planned_action == DYNPM_ACTION_NONE &&
				   rdev->pm.dynpm_can_downclock) {
				rdev->pm.dynpm_planned_action =
					DYNPM_ACTION_DOWNCLOCK;
				rdev->pm.dynpm_action_timeout = jiffies +
794 795 796 797
				msecs_to_jiffies(RADEON_RECLOCK_DELAY_MS);
			}
		}

798 799 800
		/* Note, radeon_pm_set_clocks is called with static_switch set
		 * to false since we want to wait for vbl to avoid flicker.
		 */
801 802 803 804
		if (rdev->pm.dynpm_planned_action != DYNPM_ACTION_NONE &&
		    jiffies > rdev->pm.dynpm_action_timeout) {
			radeon_pm_get_dynpm_state(rdev);
			radeon_pm_set_clocks(rdev);
805
		}
806

807 808
		schedule_delayed_work(&rdev->pm.dynpm_idle_work,
				      msecs_to_jiffies(RADEON_IDLE_LOOP_MS));
809 810
	}
	mutex_unlock(&rdev->pm.mutex);
811
	ttm_bo_unlock_delayed_workqueue(&rdev->mman.bdev, resched);
812 813
}

814 815 816 817 818 819 820 821 822 823 824
/*
 * Debugfs info
 */
#if defined(CONFIG_DEBUG_FS)

static int radeon_debugfs_pm_info(struct seq_file *m, void *data)
{
	struct drm_info_node *node = (struct drm_info_node *) m->private;
	struct drm_device *dev = node->minor->dev;
	struct radeon_device *rdev = dev->dev_private;

825
	seq_printf(m, "default engine clock: %u0 kHz\n", rdev->pm.default_sclk);
826
	seq_printf(m, "current engine clock: %u0 kHz\n", radeon_get_engine_clock(rdev));
827
	seq_printf(m, "default memory clock: %u0 kHz\n", rdev->pm.default_mclk);
828
	if (rdev->asic->pm.get_memory_clock)
829
		seq_printf(m, "current memory clock: %u0 kHz\n", radeon_get_memory_clock(rdev));
830 831
	if (rdev->pm.current_vddc)
		seq_printf(m, "voltage: %u mV\n", rdev->pm.current_vddc);
832
	if (rdev->asic->pm.get_pcie_lanes)
833
		seq_printf(m, "PCIE lanes: %d\n", radeon_get_pcie_lanes(rdev));
834 835 836 837 838 839 840 841 842

	return 0;
}

static struct drm_info_list radeon_pm_info_list[] = {
	{"radeon_pm_info", radeon_debugfs_pm_info, 0, NULL},
};
#endif

843
static int radeon_debugfs_pm_init(struct radeon_device *rdev)
844 845 846 847 848 849 850
{
#if defined(CONFIG_DEBUG_FS)
	return radeon_debugfs_add_files(rdev, radeon_pm_info_list, ARRAY_SIZE(radeon_pm_info_list));
#else
	return 0;
#endif
}