1c39f472eSBen Skeggs /*
2c39f472eSBen Skeggs * Copyright 2013 Red Hat Inc.
3c39f472eSBen Skeggs *
4c39f472eSBen Skeggs * Permission is hereby granted, free of charge, to any person obtaining a
5c39f472eSBen Skeggs * copy of this software and associated documentation files (the "Software"),
6c39f472eSBen Skeggs * to deal in the Software without restriction, including without limitation
7c39f472eSBen Skeggs * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8c39f472eSBen Skeggs * and/or sell copies of the Software, and to permit persons to whom the
9c39f472eSBen Skeggs * Software is furnished to do so, subject to the following conditions:
10c39f472eSBen Skeggs *
11c39f472eSBen Skeggs * The above copyright notice and this permission notice shall be included in
12c39f472eSBen Skeggs * all copies or substantial portions of the Software.
13c39f472eSBen Skeggs *
14c39f472eSBen Skeggs * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15c39f472eSBen Skeggs * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16c39f472eSBen Skeggs * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17c39f472eSBen Skeggs * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18c39f472eSBen Skeggs * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19c39f472eSBen Skeggs * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20c39f472eSBen Skeggs * OTHER DEALINGS IN THE SOFTWARE.
21c39f472eSBen Skeggs *
22c39f472eSBen Skeggs * Authors: Ben Skeggs <bskeggs@redhat.com>
23c39f472eSBen Skeggs */
240e29998aSBen Skeggs #include "ctrl.h"
25c39f472eSBen Skeggs
269719047bSBen Skeggs #include <core/client.h>
279719047bSBen Skeggs #include <subdev/clk.h>
289719047bSBen Skeggs
299719047bSBen Skeggs #include <nvif/class.h>
30671e9696SBen Skeggs #include <nvif/if0001.h>
319719047bSBen Skeggs #include <nvif/ioctl.h>
329719047bSBen Skeggs #include <nvif/unpack.h>
339719047bSBen Skeggs
34c39f472eSBen Skeggs static int
nvkm_control_mthd_pstate_info(struct nvkm_control * ctrl,void * data,u32 size)350e29998aSBen Skeggs nvkm_control_mthd_pstate_info(struct nvkm_control *ctrl, void *data, u32 size)
36c39f472eSBen Skeggs {
37c39f472eSBen Skeggs union {
38c39f472eSBen Skeggs struct nvif_control_pstate_info_v0 v0;
39c39f472eSBen Skeggs } *args = data;
400e29998aSBen Skeggs struct nvkm_clk *clk = ctrl->device->clk;
41f01c4e68SBen Skeggs int ret = -ENOSYS;
42c39f472eSBen Skeggs
430e29998aSBen Skeggs nvif_ioctl(&ctrl->object, "control pstate info size %d\n", size);
44f01c4e68SBen Skeggs if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) {
450e29998aSBen Skeggs nvif_ioctl(&ctrl->object, "control pstate info vers %d\n",
46c39f472eSBen Skeggs args->v0.version);
47c39f472eSBen Skeggs } else
48c39f472eSBen Skeggs return ret;
49c39f472eSBen Skeggs
50c39f472eSBen Skeggs if (clk) {
51c39f472eSBen Skeggs args->v0.count = clk->state_nr;
52c39f472eSBen Skeggs args->v0.ustate_ac = clk->ustate_ac;
53c39f472eSBen Skeggs args->v0.ustate_dc = clk->ustate_dc;
54c39f472eSBen Skeggs args->v0.pwrsrc = clk->pwrsrc;
55c39f472eSBen Skeggs args->v0.pstate = clk->pstate;
56c39f472eSBen Skeggs } else {
57c39f472eSBen Skeggs args->v0.count = 0;
58c39f472eSBen Skeggs args->v0.ustate_ac = NVIF_CONTROL_PSTATE_INFO_V0_USTATE_DISABLE;
59c39f472eSBen Skeggs args->v0.ustate_dc = NVIF_CONTROL_PSTATE_INFO_V0_USTATE_DISABLE;
60*e8f71f89SGuenter Roeck args->v0.pwrsrc = -ENODEV;
61c39f472eSBen Skeggs args->v0.pstate = NVIF_CONTROL_PSTATE_INFO_V0_PSTATE_UNKNOWN;
62c39f472eSBen Skeggs }
63c39f472eSBen Skeggs
64c39f472eSBen Skeggs return 0;
65c39f472eSBen Skeggs }
66c39f472eSBen Skeggs
67c39f472eSBen Skeggs static int
nvkm_control_mthd_pstate_attr(struct nvkm_control * ctrl,void * data,u32 size)680e29998aSBen Skeggs nvkm_control_mthd_pstate_attr(struct nvkm_control *ctrl, void *data, u32 size)
69c39f472eSBen Skeggs {
70c39f472eSBen Skeggs union {
71c39f472eSBen Skeggs struct nvif_control_pstate_attr_v0 v0;
72c39f472eSBen Skeggs } *args = data;
730e29998aSBen Skeggs struct nvkm_clk *clk = ctrl->device->clk;
746625f55cSBen Skeggs const struct nvkm_domain *domain;
759719047bSBen Skeggs struct nvkm_pstate *pstate;
769719047bSBen Skeggs struct nvkm_cstate *cstate;
77c39f472eSBen Skeggs int i = 0, j = -1;
78c39f472eSBen Skeggs u32 lo, hi;
79f01c4e68SBen Skeggs int ret = -ENOSYS;
80c39f472eSBen Skeggs
810e29998aSBen Skeggs nvif_ioctl(&ctrl->object, "control pstate attr size %d\n", size);
82f01c4e68SBen Skeggs if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) {
830e29998aSBen Skeggs nvif_ioctl(&ctrl->object,
840e29998aSBen Skeggs "control pstate attr vers %d state %d index %d\n",
85c39f472eSBen Skeggs args->v0.version, args->v0.state, args->v0.index);
86c39f472eSBen Skeggs if (!clk)
87c39f472eSBen Skeggs return -ENODEV;
88c39f472eSBen Skeggs if (args->v0.state < NVIF_CONTROL_PSTATE_ATTR_V0_STATE_CURRENT)
89c39f472eSBen Skeggs return -EINVAL;
90c39f472eSBen Skeggs if (args->v0.state >= clk->state_nr)
91c39f472eSBen Skeggs return -EINVAL;
92c39f472eSBen Skeggs } else
93c39f472eSBen Skeggs return ret;
94c39f472eSBen Skeggs domain = clk->domains;
95c39f472eSBen Skeggs
96c39f472eSBen Skeggs while (domain->name != nv_clk_src_max) {
97c39f472eSBen Skeggs if (domain->mname && ++j == args->v0.index)
98c39f472eSBen Skeggs break;
99c39f472eSBen Skeggs domain++;
100c39f472eSBen Skeggs }
101c39f472eSBen Skeggs
102c39f472eSBen Skeggs if (domain->name == nv_clk_src_max)
103c39f472eSBen Skeggs return -EINVAL;
104c39f472eSBen Skeggs
105c39f472eSBen Skeggs if (args->v0.state != NVIF_CONTROL_PSTATE_ATTR_V0_STATE_CURRENT) {
106c39f472eSBen Skeggs list_for_each_entry(pstate, &clk->states, head) {
107c39f472eSBen Skeggs if (i++ == args->v0.state)
108c39f472eSBen Skeggs break;
109c39f472eSBen Skeggs }
110c39f472eSBen Skeggs
111c39f472eSBen Skeggs lo = pstate->base.domain[domain->name];
112c39f472eSBen Skeggs hi = lo;
113c39f472eSBen Skeggs list_for_each_entry(cstate, &pstate->list, head) {
114c39f472eSBen Skeggs lo = min(lo, cstate->domain[domain->name]);
115c39f472eSBen Skeggs hi = max(hi, cstate->domain[domain->name]);
116c39f472eSBen Skeggs }
117c39f472eSBen Skeggs
118c39f472eSBen Skeggs args->v0.state = pstate->pstate;
119c39f472eSBen Skeggs } else {
1206625f55cSBen Skeggs lo = max(nvkm_clk_read(clk, domain->name), 0);
121c39f472eSBen Skeggs hi = lo;
122c39f472eSBen Skeggs }
123c39f472eSBen Skeggs
124c39f472eSBen Skeggs snprintf(args->v0.name, sizeof(args->v0.name), "%s", domain->mname);
125c39f472eSBen Skeggs snprintf(args->v0.unit, sizeof(args->v0.unit), "MHz");
126c39f472eSBen Skeggs args->v0.min = lo / domain->mdiv;
127c39f472eSBen Skeggs args->v0.max = hi / domain->mdiv;
128c39f472eSBen Skeggs
129c39f472eSBen Skeggs args->v0.index = 0;
130c39f472eSBen Skeggs while ((++domain)->name != nv_clk_src_max) {
131c39f472eSBen Skeggs if (domain->mname) {
132c39f472eSBen Skeggs args->v0.index = ++j;
133c39f472eSBen Skeggs break;
134c39f472eSBen Skeggs }
135c39f472eSBen Skeggs }
136c39f472eSBen Skeggs
137c39f472eSBen Skeggs return 0;
138c39f472eSBen Skeggs }
139c39f472eSBen Skeggs
140c39f472eSBen Skeggs static int
nvkm_control_mthd_pstate_user(struct nvkm_control * ctrl,void * data,u32 size)1410e29998aSBen Skeggs nvkm_control_mthd_pstate_user(struct nvkm_control *ctrl, void *data, u32 size)
142c39f472eSBen Skeggs {
143c39f472eSBen Skeggs union {
144c39f472eSBen Skeggs struct nvif_control_pstate_user_v0 v0;
145c39f472eSBen Skeggs } *args = data;
1460e29998aSBen Skeggs struct nvkm_clk *clk = ctrl->device->clk;
147f01c4e68SBen Skeggs int ret = -ENOSYS;
148c39f472eSBen Skeggs
1490e29998aSBen Skeggs nvif_ioctl(&ctrl->object, "control pstate user size %d\n", size);
150f01c4e68SBen Skeggs if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) {
1510e29998aSBen Skeggs nvif_ioctl(&ctrl->object,
1520e29998aSBen Skeggs "control pstate user vers %d ustate %d pwrsrc %d\n",
1530e29998aSBen Skeggs args->v0.version, args->v0.ustate, args->v0.pwrsrc);
154c39f472eSBen Skeggs if (!clk)
155c39f472eSBen Skeggs return -ENODEV;
156c39f472eSBen Skeggs } else
157c39f472eSBen Skeggs return ret;
158c39f472eSBen Skeggs
159c39f472eSBen Skeggs if (args->v0.pwrsrc >= 0) {
1609719047bSBen Skeggs ret |= nvkm_clk_ustate(clk, args->v0.ustate, args->v0.pwrsrc);
161c39f472eSBen Skeggs } else {
1629719047bSBen Skeggs ret |= nvkm_clk_ustate(clk, args->v0.ustate, 0);
1639719047bSBen Skeggs ret |= nvkm_clk_ustate(clk, args->v0.ustate, 1);
164c39f472eSBen Skeggs }
165c39f472eSBen Skeggs
166c39f472eSBen Skeggs return ret;
167c39f472eSBen Skeggs }
168c39f472eSBen Skeggs
169c39f472eSBen Skeggs static int
nvkm_control_mthd(struct nvkm_object * object,u32 mthd,void * data,u32 size)1709719047bSBen Skeggs nvkm_control_mthd(struct nvkm_object *object, u32 mthd, void *data, u32 size)
171c39f472eSBen Skeggs {
1720e29998aSBen Skeggs struct nvkm_control *ctrl = nvkm_control(object);
173c39f472eSBen Skeggs switch (mthd) {
174c39f472eSBen Skeggs case NVIF_CONTROL_PSTATE_INFO:
1750e29998aSBen Skeggs return nvkm_control_mthd_pstate_info(ctrl, data, size);
176c39f472eSBen Skeggs case NVIF_CONTROL_PSTATE_ATTR:
1770e29998aSBen Skeggs return nvkm_control_mthd_pstate_attr(ctrl, data, size);
178c39f472eSBen Skeggs case NVIF_CONTROL_PSTATE_USER:
1790e29998aSBen Skeggs return nvkm_control_mthd_pstate_user(ctrl, data, size);
180c39f472eSBen Skeggs default:
181c39f472eSBen Skeggs break;
182c39f472eSBen Skeggs }
183c39f472eSBen Skeggs return -EINVAL;
184c39f472eSBen Skeggs }
185c39f472eSBen Skeggs
1860e29998aSBen Skeggs static const struct nvkm_object_func
1870e29998aSBen Skeggs nvkm_control = {
1889719047bSBen Skeggs .mthd = nvkm_control_mthd,
189c39f472eSBen Skeggs };
190c39f472eSBen Skeggs
1910e29998aSBen Skeggs static int
nvkm_control_new(struct nvkm_device * device,const struct nvkm_oclass * oclass,void * data,u32 size,struct nvkm_object ** pobject)1920e29998aSBen Skeggs nvkm_control_new(struct nvkm_device *device, const struct nvkm_oclass *oclass,
1930e29998aSBen Skeggs void *data, u32 size, struct nvkm_object **pobject)
1940e29998aSBen Skeggs {
1950e29998aSBen Skeggs struct nvkm_control *ctrl;
1960e29998aSBen Skeggs
1970e29998aSBen Skeggs if (!(ctrl = kzalloc(sizeof(*ctrl), GFP_KERNEL)))
1980e29998aSBen Skeggs return -ENOMEM;
1990e29998aSBen Skeggs *pobject = &ctrl->object;
2000e29998aSBen Skeggs ctrl->device = device;
2010e29998aSBen Skeggs
2020e29998aSBen Skeggs nvkm_object_ctor(&nvkm_control, oclass, &ctrl->object);
2030e29998aSBen Skeggs return 0;
2040e29998aSBen Skeggs }
2050e29998aSBen Skeggs
2060e29998aSBen Skeggs const struct nvkm_device_oclass
2070e29998aSBen Skeggs nvkm_control_oclass = {
20808f7633cSBen Skeggs .base.oclass = NVIF_CLASS_CONTROL,
2090e29998aSBen Skeggs .base.minver = -1,
2100e29998aSBen Skeggs .base.maxver = -1,
2110e29998aSBen Skeggs .ctor = nvkm_control_new,
212c39f472eSBen Skeggs };
213