base.c 19.8 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
/*
 * Copyright 2013 Red Hat 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: Ben Skeggs
 */
24
#include "priv.h"
25

26
#include <core/client.h>
27
#include <core/option.h>
28
#include <core/parent.h>
29

30 31
#include <nvif/class.h>
#include <nvif/ioctl.h>
32
#include <nvif/unpack.h>
33

34
static u8
B
Ben Skeggs 已提交
35
nvkm_pm_count_perfdom(struct nvkm_pm *pm)
36 37 38 39
{
	struct nvkm_perfdom *dom;
	u8 domain_nr = 0;

B
Ben Skeggs 已提交
40
	list_for_each_entry(dom, &pm->domains, head)
41 42 43 44
		domain_nr++;
	return domain_nr;
}

45
static u16
46 47
nvkm_perfdom_count_perfsig(struct nvkm_perfdom *dom)
{
48
	u16 signal_nr = 0;
49 50 51 52 53 54 55 56 57 58 59 60
	int i;

	if (dom) {
		for (i = 0; i < dom->signal_nr; i++) {
			if (dom->signal[i].name)
				signal_nr++;
		}
	}
	return signal_nr;
}

static struct nvkm_perfdom *
B
Ben Skeggs 已提交
61
nvkm_perfdom_find(struct nvkm_pm *pm, int di)
62 63 64 65
{
	struct nvkm_perfdom *dom;
	int tmp = 0;

B
Ben Skeggs 已提交
66
	list_for_each_entry(dom, &pm->domains, head) {
67 68 69 70 71 72
		if (tmp++ == di)
			return dom;
	}
	return NULL;
}

73
struct nvkm_perfsig *
B
Ben Skeggs 已提交
74
nvkm_perfsig_find(struct nvkm_pm *pm, u8 di, u8 si, struct nvkm_perfdom **pdom)
75
{
76
	struct nvkm_perfdom *dom = *pdom;
77 78

	if (dom == NULL) {
B
Ben Skeggs 已提交
79
		dom = nvkm_perfdom_find(pm, di);
80 81 82
		if (dom == NULL)
			return NULL;
		*pdom = dom;
83 84
	}

85 86 87
	if (!dom->signal[si].name)
		return NULL;
	return &dom->signal[si];
88 89
}

90 91 92 93 94 95 96 97 98 99 100 101
static u8
nvkm_perfsig_count_perfsrc(struct nvkm_perfsig *sig)
{
	u8 source_nr = 0, i;

	for (i = 0; i < ARRAY_SIZE(sig->source); i++) {
		if (sig->source[i])
			source_nr++;
	}
	return source_nr;
}

102
static struct nvkm_perfsrc *
B
Ben Skeggs 已提交
103
nvkm_perfsrc_find(struct nvkm_pm *pm, struct nvkm_perfsig *sig, int si)
104 105 106 107 108 109 110 111 112 113 114 115 116 117
{
	struct nvkm_perfsrc *src;
	bool found = false;
	int tmp = 1; /* Sources ID start from 1 */
	u8 i;

	for (i = 0; i < ARRAY_SIZE(sig->source) && sig->source[i]; i++) {
		if (sig->source[i] == si) {
			found = true;
			break;
		}
	}

	if (found) {
B
Ben Skeggs 已提交
118
		list_for_each_entry(src, &pm->sources, head) {
119 120 121 122 123 124 125 126
			if (tmp++ == si)
				return src;
		}
	}

	return NULL;
}

127
static int
B
Ben Skeggs 已提交
128
nvkm_perfsrc_enable(struct nvkm_pm *pm, struct nvkm_perfctr *ctr)
129
{
130 131
	struct nvkm_subdev *subdev = &pm->engine.subdev;
	struct nvkm_device *device = subdev->device;
132 133 134 135 136 137
	struct nvkm_perfdom *dom = NULL;
	struct nvkm_perfsig *sig;
	struct nvkm_perfsrc *src;
	u32 mask, value;
	int i, j;

138
	for (i = 0; i < 4; i++) {
139
		for (j = 0; j < 8 && ctr->source[i][j]; j++) {
B
Ben Skeggs 已提交
140
			sig = nvkm_perfsig_find(pm, ctr->domain,
141 142 143 144
						ctr->signal[i], &dom);
			if (!sig)
				return -EINVAL;

B
Ben Skeggs 已提交
145
			src = nvkm_perfsrc_find(pm, sig, ctr->source[i][j]);
146 147 148 149 150 151 152 153 154 155 156
			if (!src)
				return -EINVAL;

			/* set enable bit if needed */
			mask = value = 0x00000000;
			if (src->enable)
				mask = value = 0x80000000;
			mask  |= (src->mask << src->shift);
			value |= ((ctr->source[i][j] >> 32) << src->shift);

			/* enable the source */
157
			nvkm_mask(device, src->addr, mask, value);
158 159 160
			nvkm_debug(subdev,
				   "enabled source %08x %08x %08x\n",
				   src->addr, mask, value);
161 162 163 164 165 166
		}
	}
	return 0;
}

static int
B
Ben Skeggs 已提交
167
nvkm_perfsrc_disable(struct nvkm_pm *pm, struct nvkm_perfctr *ctr)
168
{
169 170
	struct nvkm_subdev *subdev = &pm->engine.subdev;
	struct nvkm_device *device = subdev->device;
171 172 173
	struct nvkm_perfdom *dom = NULL;
	struct nvkm_perfsig *sig;
	struct nvkm_perfsrc *src;
174
	u32 mask;
175 176
	int i, j;

177
	for (i = 0; i < 4; i++) {
178
		for (j = 0; j < 8 && ctr->source[i][j]; j++) {
B
Ben Skeggs 已提交
179
			sig = nvkm_perfsig_find(pm, ctr->domain,
180 181 182 183
						ctr->signal[i], &dom);
			if (!sig)
				return -EINVAL;

B
Ben Skeggs 已提交
184
			src = nvkm_perfsrc_find(pm, sig, ctr->source[i][j]);
185 186 187
			if (!src)
				return -EINVAL;

188 189 190 191 192 193
			/* unset enable bit if needed */
			mask = 0x00000000;
			if (src->enable)
				mask = 0x80000000;
			mask |= (src->mask << src->shift);

194
			/* disable the source */
195
			nvkm_mask(device, src->addr, mask, 0);
196 197
			nvkm_debug(subdev, "disabled source %08x %08x\n",
				   src->addr, mask);
198 199 200 201 202
		}
	}
	return 0;
}

203
/*******************************************************************************
204
 * Perfdom object classes
205
 ******************************************************************************/
206
static int
207
nvkm_perfdom_init(struct nvkm_object *object, void *data, u32 size)
208 209
{
	union {
210
		struct nvif_perfdom_init none;
211
	} *args = data;
B
Ben Skeggs 已提交
212
	struct nvkm_pm *pm = (void *)object->engine;
213 214
	struct nvkm_perfdom *dom = (void *)object;
	int ret, i;
215

216
	nvif_ioctl(object, "perfdom init size %d\n", size);
217
	if (nvif_unvers(args->none)) {
218
		nvif_ioctl(object, "perfdom init\n");
219 220 221
	} else
		return ret;

222 223
	for (i = 0; i < 4; i++) {
		if (dom->ctr[i]) {
B
Ben Skeggs 已提交
224
			dom->func->init(pm, dom, dom->ctr[i]);
225

226
			/* enable sources */
B
Ben Skeggs 已提交
227
			nvkm_perfsrc_enable(pm, dom->ctr[i]);
228 229 230
		}
	}

231
	/* start next batch of counters for sampling */
B
Ben Skeggs 已提交
232
	dom->func->next(pm, dom);
233 234 235
	return 0;
}

236
static int
237
nvkm_perfdom_sample(struct nvkm_object *object, void *data, u32 size)
238
{
239
	union {
240
		struct nvif_perfdom_sample none;
241
	} *args = data;
B
Ben Skeggs 已提交
242
	struct nvkm_pm *pm = (void *)object->engine;
243
	struct nvkm_perfdom *dom;
244
	int ret;
245

246
	nvif_ioctl(object, "perfdom sample size %d\n", size);
247
	if (nvif_unvers(args->none)) {
248
		nvif_ioctl(object, "perfdom sample\n");
249 250
	} else
		return ret;
B
Ben Skeggs 已提交
251
	pm->sequence++;
252

253
	/* sample previous batch of counters */
B
Ben Skeggs 已提交
254 255
	list_for_each_entry(dom, &pm->domains, head)
		dom->func->next(pm, dom);
256 257 258 259 260

	return 0;
}

static int
261
nvkm_perfdom_read(struct nvkm_object *object, void *data, u32 size)
262
{
263
	union {
264
		struct nvif_perfdom_read_v0 v0;
265
	} *args = data;
B
Ben Skeggs 已提交
266
	struct nvkm_pm *pm = (void *)object->engine;
267 268
	struct nvkm_perfdom *dom = (void *)object;
	int ret, i;
269

270
	nvif_ioctl(object, "perfdom read size %d\n", size);
271
	if (nvif_unpack(args->v0, 0, 0, false)) {
272
		nvif_ioctl(object, "perfdom read vers %d\n", args->v0.version);
273 274
	} else
		return ret;
275

276 277
	for (i = 0; i < 4; i++) {
		if (dom->ctr[i])
B
Ben Skeggs 已提交
278
			dom->func->read(pm, dom, dom->ctr[i]);
279 280 281
	}

	if (!dom->clk)
282 283
		return -EAGAIN;

284 285 286 287
	for (i = 0; i < 4; i++)
		if (dom->ctr[i])
			args->v0.ctr[i] = dom->ctr[i]->ctr;
	args->v0.clk = dom->clk;
288 289 290
	return 0;
}

291
static int
292
nvkm_perfdom_mthd(struct nvkm_object *object, u32 mthd, void *data, u32 size)
293 294
{
	switch (mthd) {
295 296 297 298 299 300
	case NVIF_PERFDOM_V0_INIT:
		return nvkm_perfdom_init(object, data, size);
	case NVIF_PERFDOM_V0_SAMPLE:
		return nvkm_perfdom_sample(object, data, size);
	case NVIF_PERFDOM_V0_READ:
		return nvkm_perfdom_read(object, data, size);
301 302 303 304 305 306
	default:
		break;
	}
	return -EINVAL;
}

307
static void
308
nvkm_perfdom_dtor(struct nvkm_object *object)
309
{
B
Ben Skeggs 已提交
310
	struct nvkm_pm *pm = (void *)object->engine;
311 312 313 314 315
	struct nvkm_perfdom *dom = (void *)object;
	int i;

	for (i = 0; i < 4; i++) {
		struct nvkm_perfctr *ctr = dom->ctr[i];
316
		if (ctr) {
B
Ben Skeggs 已提交
317
			nvkm_perfsrc_disable(pm, ctr);
318 319 320
			if (ctr->head.next)
				list_del(&ctr->head);
		}
321 322 323
		kfree(ctr);
	}
	nvkm_object_destroy(&dom->base);
324 325 326
}

static int
B
Ben Skeggs 已提交
327 328 329
nvkm_perfctr_new(struct nvkm_perfdom *dom, int slot, u8 domain,
		 struct nvkm_perfsig *signal[4], u64 source[4][8],
		 u16 logic_op, struct nvkm_perfctr **pctr)
330 331
{
	struct nvkm_perfctr *ctr;
332
	int i, j;
333 334 335 336 337 338 339 340

	if (!dom)
		return -EINVAL;

	ctr = *pctr = kzalloc(sizeof(*ctr), GFP_KERNEL);
	if (!ctr)
		return -ENOMEM;

341
	ctr->domain   = domain;
342 343 344
	ctr->logic_op = logic_op;
	ctr->slot     = slot;
	for (i = 0; i < 4; i++) {
345
		if (signal[i]) {
346
			ctr->signal[i] = signal[i] - dom->signal;
347 348 349
			for (j = 0; j < 8; j++)
				ctr->source[i][j] = source[i][j];
		}
350 351 352 353 354 355 356 357
	}
	list_add_tail(&ctr->head, &dom->list);

	return 0;
}

static int
nvkm_perfdom_ctor(struct nvkm_object *parent, struct nvkm_object *engine,
358 359
		  struct nvkm_oclass *oclass, void *data, u32 size,
		  struct nvkm_object **pobject)
360
{
361
	union {
362
		struct nvif_perfdom_v0 v0;
363
	} *args = data;
B
Ben Skeggs 已提交
364
	struct nvkm_pm *pm = (void *)engine;
365 366 367
	struct nvkm_perfdom *sdom = NULL;
	struct nvkm_perfctr *ctr[4] = {};
	struct nvkm_perfdom *dom;
368
	int c, s, m;
369
	int ret;
370

371
	nvif_ioctl(parent, "create perfdom size %d\n", size);
372
	if (nvif_unpack(args->v0, 0, 0, false)) {
373 374
		nvif_ioctl(parent, "create perfdom vers %d dom %d mode %02x\n",
			   args->v0.version, args->v0.domain, args->v0.mode);
375 376
	} else
		return ret;
377

378 379
	for (c = 0; c < ARRAY_SIZE(args->v0.ctr); c++) {
		struct nvkm_perfsig *sig[4] = {};
380
		u64 src[4][8] = {};
381

382
		for (s = 0; s < ARRAY_SIZE(args->v0.ctr[c].signal); s++) {
B
Ben Skeggs 已提交
383
			sig[s] = nvkm_perfsig_find(pm, args->v0.domain,
384 385 386 387
						   args->v0.ctr[c].signal[s],
						   &sdom);
			if (args->v0.ctr[c].signal[s] && !sig[s])
				return -EINVAL;
388 389 390

			for (m = 0; m < 8; m++) {
				src[s][m] = args->v0.ctr[c].source[s][m];
B
Ben Skeggs 已提交
391
				if (src[s][m] && !nvkm_perfsrc_find(pm, sig[s],
392 393 394
							            src[s][m]))
					return -EINVAL;
			}
395 396
		}

397
		ret = nvkm_perfctr_new(sdom, c, args->v0.domain, sig, src,
398 399 400
				       args->v0.ctr[c].logic_op, &ctr[c]);
		if (ret)
			return ret;
401 402
	}

403
	if (!sdom)
404 405
		return -EINVAL;

406 407
	ret = nvkm_object_create(parent, engine, oclass, 0, &dom);
	*pobject = nv_object(dom);
408 409 410
	if (ret)
		return ret;

411 412 413 414 415
	dom->func = sdom->func;
	dom->addr = sdom->addr;
	dom->mode = args->v0.mode;
	for (c = 0; c < ARRAY_SIZE(ctr); c++)
		dom->ctr[c] = ctr[c];
416 417 418
	return 0;
}

419
static struct nvkm_ofuncs
420 421 422
nvkm_perfdom_ofuncs = {
	.ctor = nvkm_perfdom_ctor,
	.dtor = nvkm_perfdom_dtor,
423 424
	.init = _nvkm_object_init,
	.fini = _nvkm_object_fini,
425
	.mthd = nvkm_perfdom_mthd,
426 427
};

428 429 430 431 432 433 434 435 436
/*******************************************************************************
 * Perfmon object classes
 ******************************************************************************/
static int
nvkm_perfmon_mthd_query_domain(struct nvkm_object *object, void *data, u32 size)
{
	union {
		struct nvif_perfmon_query_domain_v0 v0;
	} *args = data;
B
Ben Skeggs 已提交
437
	struct nvkm_pm *pm = (void *)object->engine;
438 439 440 441
	struct nvkm_perfdom *dom;
	u8 domain_nr;
	int di, ret;

442
	nvif_ioctl(object, "perfmon query domain size %d\n", size);
443
	if (nvif_unpack(args->v0, 0, 0, false)) {
444 445
		nvif_ioctl(object, "perfmon domain vers %d iter %02x\n",
			   args->v0.version, args->v0.iter);
446 447 448 449
		di = (args->v0.iter & 0xff) - 1;
	} else
		return ret;

B
Ben Skeggs 已提交
450
	domain_nr = nvkm_pm_count_perfdom(pm);
451 452 453 454
	if (di >= (int)domain_nr)
		return -EINVAL;

	if (di >= 0) {
B
Ben Skeggs 已提交
455
		dom = nvkm_perfdom_find(pm, di);
456 457 458 459 460
		if (dom == NULL)
			return -EINVAL;

		args->v0.id         = di;
		args->v0.signal_nr  = nvkm_perfdom_count_perfsig(dom);
461
		strncpy(args->v0.name, dom->name, sizeof(args->v0.name));
462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483

		/* Currently only global counters (PCOUNTER) are implemented
		 * but this will be different for local counters (MP). */
		args->v0.counter_nr = 4;
	}

	if (++di < domain_nr) {
		args->v0.iter = ++di;
		return 0;
	}

	args->v0.iter = 0xff;
	return 0;
}

static int
nvkm_perfmon_mthd_query_signal(struct nvkm_object *object, void *data, u32 size)
{
	union {
		struct nvif_perfmon_query_signal_v0 v0;
	} *args = data;
	struct nvkm_device *device = nv_device(object);
B
Ben Skeggs 已提交
484
	struct nvkm_pm *pm = (void *)object->engine;
485 486 487 488 489 490
	struct nvkm_perfdom *dom;
	struct nvkm_perfsig *sig;
	const bool all = nvkm_boolopt(device->cfgopt, "NvPmShowAll", false);
	const bool raw = nvkm_boolopt(device->cfgopt, "NvPmUnnamed", all);
	int ret, si;

491
	nvif_ioctl(object, "perfmon query signal size %d\n", size);
492
	if (nvif_unpack(args->v0, 0, 0, false)) {
493 494 495
		nvif_ioctl(object,
			   "perfmon query signal vers %d dom %d iter %04x\n",
			   args->v0.version, args->v0.domain, args->v0.iter);
496 497 498 499
		si = (args->v0.iter & 0xffff) - 1;
	} else
		return ret;

B
Ben Skeggs 已提交
500
	dom = nvkm_perfdom_find(pm, args->v0.domain);
501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534
	if (dom == NULL || si >= (int)dom->signal_nr)
		return -EINVAL;

	if (si >= 0) {
		sig = &dom->signal[si];
		if (raw || !sig->name) {
			snprintf(args->v0.name, sizeof(args->v0.name),
				 "/%s/%02x", dom->name, si);
		} else {
			strncpy(args->v0.name, sig->name,
				sizeof(args->v0.name));
		}

		args->v0.signal = si;
		args->v0.source_nr = nvkm_perfsig_count_perfsrc(sig);
	}

	while (++si < dom->signal_nr) {
		if (all || dom->signal[si].name) {
			args->v0.iter = ++si;
			return 0;
		}
	}

	args->v0.iter = 0xffff;
	return 0;
}

static int
nvkm_perfmon_mthd_query_source(struct nvkm_object *object, void *data, u32 size)
{
	union {
		struct nvif_perfmon_query_source_v0 v0;
	} *args = data;
B
Ben Skeggs 已提交
535
	struct nvkm_pm *pm = (void *)object->engine;
536 537 538 539 540 541
	struct nvkm_perfdom *dom = NULL;
	struct nvkm_perfsig *sig;
	struct nvkm_perfsrc *src;
	u8 source_nr = 0;
	int si, ret;

542
	nvif_ioctl(object, "perfmon query source size %d\n", size);
543
	if (nvif_unpack(args->v0, 0, 0, false)) {
544 545 546 547
		nvif_ioctl(object,
			   "perfmon source vers %d dom %d sig %02x iter %02x\n",
			   args->v0.version, args->v0.domain, args->v0.signal,
			   args->v0.iter);
548 549 550 551
		si = (args->v0.iter & 0xff) - 1;
	} else
		return ret;

B
Ben Skeggs 已提交
552
	sig = nvkm_perfsig_find(pm, args->v0.domain, args->v0.signal, &dom);
553 554 555 556 557 558 559 560
	if (!sig)
		return -EINVAL;

	source_nr = nvkm_perfsig_count_perfsrc(sig);
	if (si >= (int)source_nr)
		return -EINVAL;

	if (si >= 0) {
B
Ben Skeggs 已提交
561
		src = nvkm_perfsrc_find(pm, sig, sig->source[si]);
562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594
		if (!src)
			return -EINVAL;

		args->v0.source = sig->source[si];
		args->v0.mask   = src->mask;
		strncpy(args->v0.name, src->name, sizeof(args->v0.name));
	}

	if (++si < source_nr) {
		args->v0.iter = ++si;
		return 0;
	}

	args->v0.iter = 0xff;
	return 0;
}

static int
nvkm_perfmon_mthd(struct nvkm_object *object, u32 mthd, void *data, u32 size)
{
	switch (mthd) {
	case NVIF_PERFMON_V0_QUERY_DOMAIN:
		return nvkm_perfmon_mthd_query_domain(object, data, size);
	case NVIF_PERFMON_V0_QUERY_SIGNAL:
		return nvkm_perfmon_mthd_query_signal(object, data, size);
	case NVIF_PERFMON_V0_QUERY_SOURCE:
		return nvkm_perfmon_mthd_query_source(object, data, size);
	default:
		break;
	}
	return -EINVAL;
}

595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614
static struct nvkm_oclass
nvkm_perfmon_sclass[] = {
	{ .handle = NVIF_IOCTL_NEW_V0_PERFDOM,
	  .ofuncs = &nvkm_perfdom_ofuncs,
	},
	{}
};

static int
nvkm_perfmon_ctor(struct nvkm_object *parent, struct nvkm_object *engine,
		  struct nvkm_oclass *oclass, void *data, u32 size,
		  struct nvkm_object **pobject)
{
	struct nvkm_parent *perfmon;
	int ret = nvkm_parent_create(parent, engine, oclass, 0,
				     nvkm_perfmon_sclass, 0, &perfmon);
	*pobject = perfmon ? &perfmon->object : NULL;
	return ret;
}

615 616
static struct nvkm_ofuncs
nvkm_perfmon_ofuncs = {
617 618 619 620
	.ctor = nvkm_perfmon_ctor,
	.dtor = _nvkm_parent_dtor,
	.init = _nvkm_parent_init,
	.fini = _nvkm_parent_fini,
621 622 623
	.mthd = nvkm_perfmon_mthd,
};

624 625
struct nvkm_oclass
nvkm_pm_sclass[] = {
626 627 628 629
	{
	  .handle = NVIF_IOCTL_NEW_V0_PERFMON,
	  .ofuncs = &nvkm_perfmon_ofuncs,
	},
630 631 632 633 634 635 636
	{},
};

/*******************************************************************************
 * PPM context
 ******************************************************************************/
static void
637
nvkm_perfctx_dtor(struct nvkm_object *object)
638
{
B
Ben Skeggs 已提交
639
	struct nvkm_pm *pm = (void *)object->engine;
640 641
	struct nvkm_perfctx *ctx = (void *)object;

642
	nvkm_gpuobj_destroy(&ctx->base);
643
	mutex_lock(&nv_subdev(pm)->mutex);
B
Ben Skeggs 已提交
644 645 646
	if (pm->context == ctx)
		pm->context = NULL;
	mutex_unlock(&nv_subdev(pm)->mutex);
647 648 649
}

static int
650 651 652
nvkm_perfctx_ctor(struct nvkm_object *parent, struct nvkm_object *engine,
		  struct nvkm_oclass *oclass, void *data, u32 size,
		  struct nvkm_object **pobject)
653
{
B
Ben Skeggs 已提交
654
	struct nvkm_pm *pm = (void *)engine;
655
	struct nvkm_perfctx *ctx;
656 657
	int ret;

658
	/* no context needed for perfdom objects... */
659
	if (parent->parent != &nvkm_client(parent)->object) {
660 661 662 663 664
		atomic_inc(&parent->refcount);
		*pobject = parent;
		return 1;
	}

665
	ret = nvkm_gpuobj_create(parent, engine, oclass, 0, NULL, 0, 0, 0, &ctx);
666 667 668 669
	*pobject = nv_object(ctx);
	if (ret)
		return ret;

B
Ben Skeggs 已提交
670 671 672 673
	mutex_lock(&nv_subdev(pm)->mutex);
	if (pm->context == NULL)
		pm->context = ctx;
	if (ctx != pm->context)
674
		ret = -EBUSY;
B
Ben Skeggs 已提交
675
	mutex_unlock(&nv_subdev(pm)->mutex);
676

677
	return ret;
678 679
}

680 681 682 683 684
struct nvkm_oclass
nvkm_pm_cclass = {
	.ofuncs = &(struct nvkm_ofuncs) {
		.ctor = nvkm_perfctx_ctor,
		.dtor = nvkm_perfctx_dtor,
685 686
		.init = _nvkm_gpuobj_init,
		.fini = _nvkm_gpuobj_fini,
687 688 689 690 691 692
	},
};

/*******************************************************************************
 * PPM engine/subdev functions
 ******************************************************************************/
693
int
B
Ben Skeggs 已提交
694
nvkm_perfsrc_new(struct nvkm_pm *pm, struct nvkm_perfsig *sig,
695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714
		 const struct nvkm_specsrc *spec)
{
	const struct nvkm_specsrc *ssrc;
	const struct nvkm_specmux *smux;
	struct nvkm_perfsrc *src;
	u8 source_nr = 0;

	if (!spec) {
		/* No sources are defined for this signal. */
		return 0;
	}

	ssrc = spec;
	while (ssrc->name) {
		smux = ssrc->mux;
		while (smux->name) {
			bool found = false;
			u8 source_id = 0;
			u32 len;

B
Ben Skeggs 已提交
715
			list_for_each_entry(src, &pm->sources, head) {
716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736
				if (src->addr == ssrc->addr &&
				    src->shift == smux->shift) {
					found = true;
					break;
				}
				source_id++;
			}

			if (!found) {
				src = kzalloc(sizeof(*src), GFP_KERNEL);
				if (!src)
					return -ENOMEM;

				src->addr   = ssrc->addr;
				src->mask   = smux->mask;
				src->shift  = smux->shift;
				src->enable = smux->enable;

				len = strlen(ssrc->name) +
				      strlen(smux->name) + 2;
				src->name = kzalloc(len, GFP_KERNEL);
B
Ben Skeggs 已提交
737 738
				if (!src->name) {
					kfree(src);
739
					return -ENOMEM;
B
Ben Skeggs 已提交
740
				}
741 742 743
				snprintf(src->name, len, "%s_%s", ssrc->name,
					 smux->name);

B
Ben Skeggs 已提交
744
				list_add_tail(&src->head, &pm->sources);
745 746 747 748 749 750 751 752 753 754 755
			}

			sig->source[source_nr++] = source_id + 1;
			smux++;
		}
		ssrc++;
	}

	return 0;
}

756
int
B
Ben Skeggs 已提交
757
nvkm_perfdom_new(struct nvkm_pm *pm, const char *name, u32 mask,
758 759
		 u32 base, u32 size_unit, u32 size_domain,
		 const struct nvkm_specdom *spec)
760
{
761 762 763
	const struct nvkm_specdom *sdom;
	const struct nvkm_specsig *ssig;
	struct nvkm_perfdom *dom;
764
	int ret, i;
765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786

	for (i = 0; i == 0 || mask; i++) {
		u32 addr = base + (i * size_unit);
		if (i && !(mask & (1 << i)))
			continue;

		sdom = spec;
		while (sdom->signal_nr) {
			dom = kzalloc(sizeof(*dom) + sdom->signal_nr *
				      sizeof(*dom->signal), GFP_KERNEL);
			if (!dom)
				return -ENOMEM;

			if (mask) {
				snprintf(dom->name, sizeof(dom->name),
					 "%s/%02x/%02x", name, i,
					 (int)(sdom - spec));
			} else {
				snprintf(dom->name, sizeof(dom->name),
					 "%s/%02x", name, (int)(sdom - spec));
			}

B
Ben Skeggs 已提交
787
			list_add_tail(&dom->head, &pm->domains);
788 789 790 791 792 793 794
			INIT_LIST_HEAD(&dom->list);
			dom->func = sdom->func;
			dom->addr = addr;
			dom->signal_nr = sdom->signal_nr;

			ssig = (sdom++)->signal;
			while (ssig->name) {
795 796 797
				struct nvkm_perfsig *sig =
					&dom->signal[ssig->signal];
				sig->name = ssig->name;
B
Ben Skeggs 已提交
798
				ret = nvkm_perfsrc_new(pm, sig, ssig->source);
799 800
				if (ret)
					return ret;
801 802 803 804 805 806 807 808 809 810 811 812 813
				ssig++;
			}

			addr += size_domain;
		}

		mask &= ~(1 << i);
	}

	return 0;
}

int
814
_nvkm_pm_fini(struct nvkm_object *object, bool suspend)
815
{
B
Ben Skeggs 已提交
816
	struct nvkm_pm *pm = (void *)object;
817
	return nvkm_engine_fini_old(&pm->engine, suspend);
818 819 820
}

int
821
_nvkm_pm_init(struct nvkm_object *object)
822
{
B
Ben Skeggs 已提交
823
	struct nvkm_pm *pm = (void *)object;
824
	return nvkm_engine_init_old(&pm->engine);
825 826 827
}

void
828
_nvkm_pm_dtor(struct nvkm_object *object)
829
{
B
Ben Skeggs 已提交
830
	struct nvkm_pm *pm = (void *)object;
831 832
	struct nvkm_perfdom *dom, *next_dom;
	struct nvkm_perfsrc *src, *next_src;
833

B
Ben Skeggs 已提交
834
	list_for_each_entry_safe(dom, next_dom, &pm->domains, head) {
835 836 837 838
		list_del(&dom->head);
		kfree(dom);
	}

B
Ben Skeggs 已提交
839
	list_for_each_entry_safe(src, next_src, &pm->sources, head) {
840 841 842 843 844
		list_del(&src->head);
		kfree(src->name);
		kfree(src);
	}

B
Ben Skeggs 已提交
845
	nvkm_engine_destroy(&pm->engine);
846 847 848
}

int
849 850
nvkm_pm_create_(struct nvkm_object *parent, struct nvkm_object *engine,
		struct nvkm_oclass *oclass, int length, void **pobject)
851
{
B
Ben Skeggs 已提交
852
	struct nvkm_pm *pm;
853 854
	int ret;

855 856
	ret = nvkm_engine_create_(parent, engine, oclass, true, "PPM",
				  "pm", length, pobject);
B
Ben Skeggs 已提交
857
	pm = *pobject;
858 859 860
	if (ret)
		return ret;

B
Ben Skeggs 已提交
861 862
	INIT_LIST_HEAD(&pm->domains);
	INIT_LIST_HEAD(&pm->sources);
863 864
	return 0;
}