| /* |
| * 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 |
| */ |
| #include "priv.h" |
| |
| #include <core/client.h> |
| #include <core/option.h> |
| |
| #include <nvif/class.h> |
| #include <nvif/if0002.h> |
| #include <nvif/if0003.h> |
| #include <nvif/ioctl.h> |
| #include <nvif/unpack.h> |
| |
| static u8 |
| nvkm_pm_count_perfdom(struct nvkm_pm *pm) |
| { |
| struct nvkm_perfdom *dom; |
| u8 domain_nr = 0; |
| |
| list_for_each_entry(dom, &pm->domains, head) |
| domain_nr++; |
| return domain_nr; |
| } |
| |
| static u16 |
| nvkm_perfdom_count_perfsig(struct nvkm_perfdom *dom) |
| { |
| u16 signal_nr = 0; |
| 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 * |
| nvkm_perfdom_find(struct nvkm_pm *pm, int di) |
| { |
| struct nvkm_perfdom *dom; |
| int tmp = 0; |
| |
| list_for_each_entry(dom, &pm->domains, head) { |
| if (tmp++ == di) |
| return dom; |
| } |
| return NULL; |
| } |
| |
| static struct nvkm_perfsig * |
| nvkm_perfsig_find(struct nvkm_pm *pm, u8 di, u8 si, struct nvkm_perfdom **pdom) |
| { |
| struct nvkm_perfdom *dom = *pdom; |
| |
| if (dom == NULL) { |
| dom = nvkm_perfdom_find(pm, di); |
| if (dom == NULL) |
| return NULL; |
| *pdom = dom; |
| } |
| |
| if (!dom->signal[si].name) |
| return NULL; |
| return &dom->signal[si]; |
| } |
| |
| 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; |
| } |
| |
| static struct nvkm_perfsrc * |
| nvkm_perfsrc_find(struct nvkm_pm *pm, struct nvkm_perfsig *sig, int si) |
| { |
| 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) { |
| list_for_each_entry(src, &pm->sources, head) { |
| if (tmp++ == si) |
| return src; |
| } |
| } |
| |
| return NULL; |
| } |
| |
| static int |
| nvkm_perfsrc_enable(struct nvkm_pm *pm, struct nvkm_perfctr *ctr) |
| { |
| struct nvkm_subdev *subdev = &pm->engine.subdev; |
| struct nvkm_device *device = subdev->device; |
| struct nvkm_perfdom *dom = NULL; |
| struct nvkm_perfsig *sig; |
| struct nvkm_perfsrc *src; |
| u32 mask, value; |
| int i, j; |
| |
| for (i = 0; i < 4; i++) { |
| for (j = 0; j < 8 && ctr->source[i][j]; j++) { |
| sig = nvkm_perfsig_find(pm, ctr->domain, |
| ctr->signal[i], &dom); |
| if (!sig) |
| return -EINVAL; |
| |
| src = nvkm_perfsrc_find(pm, sig, ctr->source[i][j]); |
| 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 */ |
| nvkm_mask(device, src->addr, mask, value); |
| nvkm_debug(subdev, |
| "enabled source %08x %08x %08x\n", |
| src->addr, mask, value); |
| } |
| } |
| return 0; |
| } |
| |
| static int |
| nvkm_perfsrc_disable(struct nvkm_pm *pm, struct nvkm_perfctr *ctr) |
| { |
| struct nvkm_subdev *subdev = &pm->engine.subdev; |
| struct nvkm_device *device = subdev->device; |
| struct nvkm_perfdom *dom = NULL; |
| struct nvkm_perfsig *sig; |
| struct nvkm_perfsrc *src; |
| u32 mask; |
| int i, j; |
| |
| for (i = 0; i < 4; i++) { |
| for (j = 0; j < 8 && ctr->source[i][j]; j++) { |
| sig = nvkm_perfsig_find(pm, ctr->domain, |
| ctr->signal[i], &dom); |
| if (!sig) |
| return -EINVAL; |
| |
| src = nvkm_perfsrc_find(pm, sig, ctr->source[i][j]); |
| if (!src) |
| return -EINVAL; |
| |
| /* unset enable bit if needed */ |
| mask = 0x00000000; |
| if (src->enable) |
| mask = 0x80000000; |
| mask |= (src->mask << src->shift); |
| |
| /* disable the source */ |
| nvkm_mask(device, src->addr, mask, 0); |
| nvkm_debug(subdev, "disabled source %08x %08x\n", |
| src->addr, mask); |
| } |
| } |
| return 0; |
| } |
| |
| /******************************************************************************* |
| * Perfdom object classes |
| ******************************************************************************/ |
| static int |
| nvkm_perfdom_init(struct nvkm_perfdom *dom, void *data, u32 size) |
| { |
| union { |
| struct nvif_perfdom_init none; |
| } *args = data; |
| struct nvkm_object *object = &dom->object; |
| struct nvkm_pm *pm = dom->perfmon->pm; |
| int ret = -ENOSYS, i; |
| |
| nvif_ioctl(object, "perfdom init size %d\n", size); |
| if (!(ret = nvif_unvers(ret, &data, &size, args->none))) { |
| nvif_ioctl(object, "perfdom init\n"); |
| } else |
| return ret; |
| |
| for (i = 0; i < 4; i++) { |
| if (dom->ctr[i]) { |
| dom->func->init(pm, dom, dom->ctr[i]); |
| |
| /* enable sources */ |
| nvkm_perfsrc_enable(pm, dom->ctr[i]); |
| } |
| } |
| |
| /* start next batch of counters for sampling */ |
| dom->func->next(pm, dom); |
| return 0; |
| } |
| |
| static int |
| nvkm_perfdom_sample(struct nvkm_perfdom *dom, void *data, u32 size) |
| { |
| union { |
| struct nvif_perfdom_sample none; |
| } *args = data; |
| struct nvkm_object *object = &dom->object; |
| struct nvkm_pm *pm = dom->perfmon->pm; |
| int ret = -ENOSYS; |
| |
| nvif_ioctl(object, "perfdom sample size %d\n", size); |
| if (!(ret = nvif_unvers(ret, &data, &size, args->none))) { |
| nvif_ioctl(object, "perfdom sample\n"); |
| } else |
| return ret; |
| pm->sequence++; |
| |
| /* sample previous batch of counters */ |
| list_for_each_entry(dom, &pm->domains, head) |
| dom->func->next(pm, dom); |
| |
| return 0; |
| } |
| |
| static int |
| nvkm_perfdom_read(struct nvkm_perfdom *dom, void *data, u32 size) |
| { |
| union { |
| struct nvif_perfdom_read_v0 v0; |
| } *args = data; |
| struct nvkm_object *object = &dom->object; |
| struct nvkm_pm *pm = dom->perfmon->pm; |
| int ret = -ENOSYS, i; |
| |
| nvif_ioctl(object, "perfdom read size %d\n", size); |
| if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) { |
| nvif_ioctl(object, "perfdom read vers %d\n", args->v0.version); |
| } else |
| return ret; |
| |
| for (i = 0; i < 4; i++) { |
| if (dom->ctr[i]) |
| dom->func->read(pm, dom, dom->ctr[i]); |
| } |
| |
| if (!dom->clk) |
| return -EAGAIN; |
| |
| for (i = 0; i < 4; i++) |
| if (dom->ctr[i]) |
| args->v0.ctr[i] = dom->ctr[i]->ctr; |
| args->v0.clk = dom->clk; |
| return 0; |
| } |
| |
| static int |
| nvkm_perfdom_mthd(struct nvkm_object *object, u32 mthd, void *data, u32 size) |
| { |
| struct nvkm_perfdom *dom = nvkm_perfdom(object); |
| switch (mthd) { |
| case NVIF_PERFDOM_V0_INIT: |
| return nvkm_perfdom_init(dom, data, size); |
| case NVIF_PERFDOM_V0_SAMPLE: |
| return nvkm_perfdom_sample(dom, data, size); |
| case NVIF_PERFDOM_V0_READ: |
| return nvkm_perfdom_read(dom, data, size); |
| default: |
| break; |
| } |
| return -EINVAL; |
| } |
| |
| static void * |
| nvkm_perfdom_dtor(struct nvkm_object *object) |
| { |
| struct nvkm_perfdom *dom = nvkm_perfdom(object); |
| struct nvkm_pm *pm = dom->perfmon->pm; |
| int i; |
| |
| for (i = 0; i < 4; i++) { |
| struct nvkm_perfctr *ctr = dom->ctr[i]; |
| if (ctr) { |
| nvkm_perfsrc_disable(pm, ctr); |
| if (ctr->head.next) |
| list_del(&ctr->head); |
| } |
| kfree(ctr); |
| } |
| |
| return dom; |
| } |
| |
| static int |
| 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) |
| { |
| struct nvkm_perfctr *ctr; |
| int i, j; |
| |
| if (!dom) |
| return -EINVAL; |
| |
| ctr = *pctr = kzalloc(sizeof(*ctr), GFP_KERNEL); |
| if (!ctr) |
| return -ENOMEM; |
| |
| ctr->domain = domain; |
| ctr->logic_op = logic_op; |
| ctr->slot = slot; |
| for (i = 0; i < 4; i++) { |
| if (signal[i]) { |
| ctr->signal[i] = signal[i] - dom->signal; |
| for (j = 0; j < 8; j++) |
| ctr->source[i][j] = source[i][j]; |
| } |
| } |
| list_add_tail(&ctr->head, &dom->list); |
| |
| return 0; |
| } |
| |
| static const struct nvkm_object_func |
| nvkm_perfdom = { |
| .dtor = nvkm_perfdom_dtor, |
| .mthd = nvkm_perfdom_mthd, |
| }; |
| |
| static int |
| nvkm_perfdom_new_(struct nvkm_perfmon *perfmon, |
| const struct nvkm_oclass *oclass, void *data, u32 size, |
| struct nvkm_object **pobject) |
| { |
| union { |
| struct nvif_perfdom_v0 v0; |
| } *args = data; |
| struct nvkm_pm *pm = perfmon->pm; |
| struct nvkm_object *parent = oclass->parent; |
| struct nvkm_perfdom *sdom = NULL; |
| struct nvkm_perfctr *ctr[4] = {}; |
| struct nvkm_perfdom *dom; |
| int c, s, m; |
| int ret = -ENOSYS; |
| |
| nvif_ioctl(parent, "create perfdom size %d\n", size); |
| if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) { |
| nvif_ioctl(parent, "create perfdom vers %d dom %d mode %02x\n", |
| args->v0.version, args->v0.domain, args->v0.mode); |
| } else |
| return ret; |
| |
| for (c = 0; c < ARRAY_SIZE(args->v0.ctr); c++) { |
| struct nvkm_perfsig *sig[4] = {}; |
| u64 src[4][8] = {}; |
| |
| for (s = 0; s < ARRAY_SIZE(args->v0.ctr[c].signal); s++) { |
| sig[s] = nvkm_perfsig_find(pm, args->v0.domain, |
| args->v0.ctr[c].signal[s], |
| &sdom); |
| if (args->v0.ctr[c].signal[s] && !sig[s]) |
| return -EINVAL; |
| |
| for (m = 0; m < 8; m++) { |
| src[s][m] = args->v0.ctr[c].source[s][m]; |
| if (src[s][m] && !nvkm_perfsrc_find(pm, sig[s], |
| src[s][m])) |
| return -EINVAL; |
| } |
| } |
| |
| ret = nvkm_perfctr_new(sdom, c, args->v0.domain, sig, src, |
| args->v0.ctr[c].logic_op, &ctr[c]); |
| if (ret) |
| return ret; |
| } |
| |
| if (!sdom) |
| return -EINVAL; |
| |
| if (!(dom = kzalloc(sizeof(*dom), GFP_KERNEL))) |
| return -ENOMEM; |
| nvkm_object_ctor(&nvkm_perfdom, oclass, &dom->object); |
| dom->perfmon = perfmon; |
| *pobject = &dom->object; |
| |
| 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]; |
| return 0; |
| } |
| |
| /******************************************************************************* |
| * Perfmon object classes |
| ******************************************************************************/ |
| static int |
| nvkm_perfmon_mthd_query_domain(struct nvkm_perfmon *perfmon, |
| void *data, u32 size) |
| { |
| union { |
| struct nvif_perfmon_query_domain_v0 v0; |
| } *args = data; |
| struct nvkm_object *object = &perfmon->object; |
| struct nvkm_pm *pm = perfmon->pm; |
| struct nvkm_perfdom *dom; |
| u8 domain_nr; |
| int di, ret = -ENOSYS; |
| |
| nvif_ioctl(object, "perfmon query domain size %d\n", size); |
| if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) { |
| nvif_ioctl(object, "perfmon domain vers %d iter %02x\n", |
| args->v0.version, args->v0.iter); |
| di = (args->v0.iter & 0xff) - 1; |
| } else |
| return ret; |
| |
| domain_nr = nvkm_pm_count_perfdom(pm); |
| if (di >= (int)domain_nr) |
| return -EINVAL; |
| |
| if (di >= 0) { |
| dom = nvkm_perfdom_find(pm, di); |
| if (dom == NULL) |
| return -EINVAL; |
| |
| args->v0.id = di; |
| args->v0.signal_nr = nvkm_perfdom_count_perfsig(dom); |
| strncpy(args->v0.name, dom->name, sizeof(args->v0.name) - 1); |
| |
| /* 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_perfmon *perfmon, |
| void *data, u32 size) |
| { |
| union { |
| struct nvif_perfmon_query_signal_v0 v0; |
| } *args = data; |
| struct nvkm_object *object = &perfmon->object; |
| struct nvkm_pm *pm = perfmon->pm; |
| struct nvkm_device *device = pm->engine.subdev.device; |
| 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 = -ENOSYS, si; |
| |
| nvif_ioctl(object, "perfmon query signal size %d\n", size); |
| if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) { |
| nvif_ioctl(object, |
| "perfmon query signal vers %d dom %d iter %04x\n", |
| args->v0.version, args->v0.domain, args->v0.iter); |
| si = (args->v0.iter & 0xffff) - 1; |
| } else |
| return ret; |
| |
| dom = nvkm_perfdom_find(pm, args->v0.domain); |
| 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) - 1); |
| } |
| |
| 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_perfmon *perfmon, |
| void *data, u32 size) |
| { |
| union { |
| struct nvif_perfmon_query_source_v0 v0; |
| } *args = data; |
| struct nvkm_object *object = &perfmon->object; |
| struct nvkm_pm *pm = perfmon->pm; |
| struct nvkm_perfdom *dom = NULL; |
| struct nvkm_perfsig *sig; |
| struct nvkm_perfsrc *src; |
| u8 source_nr = 0; |
| int si, ret = -ENOSYS; |
| |
| nvif_ioctl(object, "perfmon query source size %d\n", size); |
| if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) { |
| 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); |
| si = (args->v0.iter & 0xff) - 1; |
| } else |
| return ret; |
| |
| sig = nvkm_perfsig_find(pm, args->v0.domain, args->v0.signal, &dom); |
| if (!sig) |
| return -EINVAL; |
| |
| source_nr = nvkm_perfsig_count_perfsrc(sig); |
| if (si >= (int)source_nr) |
| return -EINVAL; |
| |
| if (si >= 0) { |
| src = nvkm_perfsrc_find(pm, sig, sig->source[si]); |
| 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) - 1); |
| } |
| |
| 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) |
| { |
| struct nvkm_perfmon *perfmon = nvkm_perfmon(object); |
| switch (mthd) { |
| case NVIF_PERFMON_V0_QUERY_DOMAIN: |
| return nvkm_perfmon_mthd_query_domain(perfmon, data, size); |
| case NVIF_PERFMON_V0_QUERY_SIGNAL: |
| return nvkm_perfmon_mthd_query_signal(perfmon, data, size); |
| case NVIF_PERFMON_V0_QUERY_SOURCE: |
| return nvkm_perfmon_mthd_query_source(perfmon, data, size); |
| default: |
| break; |
| } |
| return -EINVAL; |
| } |
| |
| static int |
| nvkm_perfmon_child_new(const struct nvkm_oclass *oclass, void *data, u32 size, |
| struct nvkm_object **pobject) |
| { |
| struct nvkm_perfmon *perfmon = nvkm_perfmon(oclass->parent); |
| return nvkm_perfdom_new_(perfmon, oclass, data, size, pobject); |
| } |
| |
| static int |
| nvkm_perfmon_child_get(struct nvkm_object *object, int index, |
| struct nvkm_oclass *oclass) |
| { |
| if (index == 0) { |
| oclass->base.oclass = NVIF_CLASS_PERFDOM; |
| oclass->base.minver = 0; |
| oclass->base.maxver = 0; |
| oclass->ctor = nvkm_perfmon_child_new; |
| return 0; |
| } |
| return -EINVAL; |
| } |
| |
| static void * |
| nvkm_perfmon_dtor(struct nvkm_object *object) |
| { |
| struct nvkm_perfmon *perfmon = nvkm_perfmon(object); |
| struct nvkm_pm *pm = perfmon->pm; |
| spin_lock(&pm->client.lock); |
| if (pm->client.object == &perfmon->object) |
| pm->client.object = NULL; |
| spin_unlock(&pm->client.lock); |
| return perfmon; |
| } |
| |
| static const struct nvkm_object_func |
| nvkm_perfmon = { |
| .dtor = nvkm_perfmon_dtor, |
| .mthd = nvkm_perfmon_mthd, |
| .sclass = nvkm_perfmon_child_get, |
| }; |
| |
| static int |
| nvkm_perfmon_new(struct nvkm_pm *pm, const struct nvkm_oclass *oclass, |
| void *data, u32 size, struct nvkm_object **pobject) |
| { |
| struct nvkm_perfmon *perfmon; |
| |
| if (!(perfmon = kzalloc(sizeof(*perfmon), GFP_KERNEL))) |
| return -ENOMEM; |
| nvkm_object_ctor(&nvkm_perfmon, oclass, &perfmon->object); |
| perfmon->pm = pm; |
| *pobject = &perfmon->object; |
| return 0; |
| } |
| |
| /******************************************************************************* |
| * PPM engine/subdev functions |
| ******************************************************************************/ |
| |
| static int |
| nvkm_pm_oclass_new(struct nvkm_device *device, const struct nvkm_oclass *oclass, |
| void *data, u32 size, struct nvkm_object **pobject) |
| { |
| struct nvkm_pm *pm = nvkm_pm(oclass->engine); |
| int ret; |
| |
| ret = nvkm_perfmon_new(pm, oclass, data, size, pobject); |
| if (ret) |
| return ret; |
| |
| spin_lock(&pm->client.lock); |
| if (pm->client.object == NULL) |
| pm->client.object = *pobject; |
| ret = (pm->client.object == *pobject) ? 0 : -EBUSY; |
| spin_unlock(&pm->client.lock); |
| return ret; |
| } |
| |
| static const struct nvkm_device_oclass |
| nvkm_pm_oclass = { |
| .base.oclass = NVIF_CLASS_PERFMON, |
| .base.minver = -1, |
| .base.maxver = -1, |
| .ctor = nvkm_pm_oclass_new, |
| }; |
| |
| static int |
| nvkm_pm_oclass_get(struct nvkm_oclass *oclass, int index, |
| const struct nvkm_device_oclass **class) |
| { |
| if (index == 0) { |
| oclass->base = nvkm_pm_oclass.base; |
| *class = &nvkm_pm_oclass; |
| return index; |
| } |
| return 1; |
| } |
| |
| static int |
| nvkm_perfsrc_new(struct nvkm_pm *pm, struct nvkm_perfsig *sig, |
| 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; |
| |
| list_for_each_entry(src, &pm->sources, head) { |
| 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); |
| if (!src->name) { |
| kfree(src); |
| return -ENOMEM; |
| } |
| snprintf(src->name, len, "%s_%s", ssrc->name, |
| smux->name); |
| |
| list_add_tail(&src->head, &pm->sources); |
| } |
| |
| sig->source[source_nr++] = source_id + 1; |
| smux++; |
| } |
| ssrc++; |
| } |
| |
| return 0; |
| } |
| |
| int |
| nvkm_perfdom_new(struct nvkm_pm *pm, const char *name, u32 mask, |
| u32 base, u32 size_unit, u32 size_domain, |
| const struct nvkm_specdom *spec) |
| { |
| const struct nvkm_specdom *sdom; |
| const struct nvkm_specsig *ssig; |
| struct nvkm_perfdom *dom; |
| int ret, i; |
| |
| 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(struct_size(dom, signal, sdom->signal_nr), |
| 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)); |
| } |
| |
| list_add_tail(&dom->head, &pm->domains); |
| INIT_LIST_HEAD(&dom->list); |
| dom->func = sdom->func; |
| dom->addr = addr; |
| dom->signal_nr = sdom->signal_nr; |
| |
| ssig = (sdom++)->signal; |
| while (ssig->name) { |
| struct nvkm_perfsig *sig = |
| &dom->signal[ssig->signal]; |
| sig->name = ssig->name; |
| ret = nvkm_perfsrc_new(pm, sig, ssig->source); |
| if (ret) |
| return ret; |
| ssig++; |
| } |
| |
| addr += size_domain; |
| } |
| |
| mask &= ~(1 << i); |
| } |
| |
| return 0; |
| } |
| |
| static int |
| nvkm_pm_fini(struct nvkm_engine *engine, bool suspend) |
| { |
| struct nvkm_pm *pm = nvkm_pm(engine); |
| if (pm->func->fini) |
| pm->func->fini(pm); |
| return 0; |
| } |
| |
| static void * |
| nvkm_pm_dtor(struct nvkm_engine *engine) |
| { |
| struct nvkm_pm *pm = nvkm_pm(engine); |
| struct nvkm_perfdom *dom, *next_dom; |
| struct nvkm_perfsrc *src, *next_src; |
| |
| list_for_each_entry_safe(dom, next_dom, &pm->domains, head) { |
| list_del(&dom->head); |
| kfree(dom); |
| } |
| |
| list_for_each_entry_safe(src, next_src, &pm->sources, head) { |
| list_del(&src->head); |
| kfree(src->name); |
| kfree(src); |
| } |
| |
| return pm; |
| } |
| |
| static const struct nvkm_engine_func |
| nvkm_pm = { |
| .dtor = nvkm_pm_dtor, |
| .fini = nvkm_pm_fini, |
| .base.sclass = nvkm_pm_oclass_get, |
| }; |
| |
| int |
| nvkm_pm_ctor(const struct nvkm_pm_func *func, struct nvkm_device *device, |
| enum nvkm_subdev_type type, int inst, struct nvkm_pm *pm) |
| { |
| pm->func = func; |
| INIT_LIST_HEAD(&pm->domains); |
| INIT_LIST_HEAD(&pm->sources); |
| spin_lock_init(&pm->client.lock); |
| return nvkm_engine_ctor(&nvkm_pm, device, type, inst, true, &pm->engine); |
| } |