Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2013 Red Hat 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: Ben Skeggs <bskeggs@redhat.com> |
| 23 | */ |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 24 | #include "priv.h" |
| 25 | |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 26 | #include <core/client.h> |
| 27 | #include <subdev/clk.h> |
| 28 | |
| 29 | #include <nvif/class.h> |
| 30 | #include <nvif/ioctl.h> |
| 31 | #include <nvif/unpack.h> |
| 32 | |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 33 | static int |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 34 | nvkm_control_mthd_pstate_info(struct nvkm_object *object, void *data, u32 size) |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 35 | { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 36 | union { |
| 37 | struct nvif_control_pstate_info_v0 v0; |
| 38 | } *args = data; |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 39 | struct nvkm_clk *clk = nvkm_clk(object); |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 40 | int ret; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 41 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 42 | nv_ioctl(object, "control pstate info size %d\n", size); |
| 43 | if (nvif_unpack(args->v0, 0, 0, false)) { |
| 44 | nv_ioctl(object, "control pstate info vers %d\n", |
| 45 | args->v0.version); |
| 46 | } else |
| 47 | return ret; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 48 | |
| 49 | if (clk) { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 50 | args->v0.count = clk->state_nr; |
| 51 | args->v0.ustate_ac = clk->ustate_ac; |
| 52 | args->v0.ustate_dc = clk->ustate_dc; |
| 53 | args->v0.pwrsrc = clk->pwrsrc; |
| 54 | args->v0.pstate = clk->pstate; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 55 | } else { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 56 | args->v0.count = 0; |
| 57 | args->v0.ustate_ac = NVIF_CONTROL_PSTATE_INFO_V0_USTATE_DISABLE; |
| 58 | args->v0.ustate_dc = NVIF_CONTROL_PSTATE_INFO_V0_USTATE_DISABLE; |
| 59 | args->v0.pwrsrc = -ENOSYS; |
| 60 | args->v0.pstate = NVIF_CONTROL_PSTATE_INFO_V0_PSTATE_UNKNOWN; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 61 | } |
| 62 | |
| 63 | return 0; |
| 64 | } |
| 65 | |
| 66 | static int |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 67 | nvkm_control_mthd_pstate_attr(struct nvkm_object *object, void *data, u32 size) |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 68 | { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 69 | union { |
| 70 | struct nvif_control_pstate_attr_v0 v0; |
| 71 | } *args = data; |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 72 | struct nvkm_clk *clk = nvkm_clk(object); |
| 73 | struct nvkm_domain *domain; |
| 74 | struct nvkm_pstate *pstate; |
| 75 | struct nvkm_cstate *cstate; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 76 | int i = 0, j = -1; |
| 77 | u32 lo, hi; |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 78 | int ret; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 79 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 80 | nv_ioctl(object, "control pstate attr size %d\n", size); |
| 81 | if (nvif_unpack(args->v0, 0, 0, false)) { |
| 82 | nv_ioctl(object, "control pstate attr vers %d state %d " |
| 83 | "index %d\n", |
| 84 | args->v0.version, args->v0.state, args->v0.index); |
| 85 | if (!clk) |
| 86 | return -ENODEV; |
| 87 | if (args->v0.state < NVIF_CONTROL_PSTATE_ATTR_V0_STATE_CURRENT) |
| 88 | return -EINVAL; |
| 89 | if (args->v0.state >= clk->state_nr) |
| 90 | return -EINVAL; |
| 91 | } else |
| 92 | return ret; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 93 | domain = clk->domains; |
| 94 | |
| 95 | while (domain->name != nv_clk_src_max) { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 96 | if (domain->mname && ++j == args->v0.index) |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 97 | break; |
| 98 | domain++; |
| 99 | } |
| 100 | |
| 101 | if (domain->name == nv_clk_src_max) |
| 102 | return -EINVAL; |
| 103 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 104 | if (args->v0.state != NVIF_CONTROL_PSTATE_ATTR_V0_STATE_CURRENT) { |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 105 | list_for_each_entry(pstate, &clk->states, head) { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 106 | if (i++ == args->v0.state) |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 107 | break; |
| 108 | } |
| 109 | |
| 110 | lo = pstate->base.domain[domain->name]; |
| 111 | hi = lo; |
| 112 | list_for_each_entry(cstate, &pstate->list, head) { |
| 113 | lo = min(lo, cstate->domain[domain->name]); |
| 114 | hi = max(hi, cstate->domain[domain->name]); |
| 115 | } |
| 116 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 117 | args->v0.state = pstate->pstate; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 118 | } else { |
| 119 | lo = max(clk->read(clk, domain->name), 0); |
| 120 | hi = lo; |
| 121 | } |
| 122 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 123 | snprintf(args->v0.name, sizeof(args->v0.name), "%s", domain->mname); |
| 124 | snprintf(args->v0.unit, sizeof(args->v0.unit), "MHz"); |
| 125 | args->v0.min = lo / domain->mdiv; |
| 126 | args->v0.max = hi / domain->mdiv; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 127 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 128 | args->v0.index = 0; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 129 | while ((++domain)->name != nv_clk_src_max) { |
| 130 | if (domain->mname) { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 131 | args->v0.index = ++j; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 132 | break; |
| 133 | } |
| 134 | } |
| 135 | |
| 136 | return 0; |
| 137 | } |
| 138 | |
| 139 | static int |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 140 | nvkm_control_mthd_pstate_user(struct nvkm_object *object, void *data, u32 size) |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 141 | { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 142 | union { |
| 143 | struct nvif_control_pstate_user_v0 v0; |
| 144 | } *args = data; |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 145 | struct nvkm_clk *clk = nvkm_clk(object); |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 146 | int ret; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 147 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 148 | nv_ioctl(object, "control pstate user size %d\n", size); |
| 149 | if (nvif_unpack(args->v0, 0, 0, false)) { |
| 150 | nv_ioctl(object, "control pstate user vers %d ustate %d " |
| 151 | "pwrsrc %d\n", args->v0.version, |
| 152 | args->v0.ustate, args->v0.pwrsrc); |
| 153 | if (!clk) |
| 154 | return -ENODEV; |
| 155 | } else |
| 156 | return ret; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 157 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 158 | if (args->v0.pwrsrc >= 0) { |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 159 | ret |= nvkm_clk_ustate(clk, args->v0.ustate, args->v0.pwrsrc); |
Ben Skeggs | 7238eca | 2014-06-13 14:17:09 +1000 | [diff] [blame] | 160 | } else { |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 161 | ret |= nvkm_clk_ustate(clk, args->v0.ustate, 0); |
| 162 | ret |= nvkm_clk_ustate(clk, args->v0.ustate, 1); |
Ben Skeggs | 7238eca | 2014-06-13 14:17:09 +1000 | [diff] [blame] | 163 | } |
| 164 | |
| 165 | return ret; |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 166 | } |
| 167 | |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 168 | static int |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 169 | nvkm_control_mthd(struct nvkm_object *object, u32 mthd, void *data, u32 size) |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 170 | { |
| 171 | switch (mthd) { |
| 172 | case NVIF_CONTROL_PSTATE_INFO: |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 173 | return nvkm_control_mthd_pstate_info(object, data, size); |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 174 | case NVIF_CONTROL_PSTATE_ATTR: |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 175 | return nvkm_control_mthd_pstate_attr(object, data, size); |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 176 | case NVIF_CONTROL_PSTATE_USER: |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 177 | return nvkm_control_mthd_pstate_user(object, data, size); |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 178 | default: |
| 179 | break; |
| 180 | } |
| 181 | return -EINVAL; |
| 182 | } |
| 183 | |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 184 | static struct nvkm_ofuncs |
| 185 | nvkm_control_ofuncs = { |
| 186 | .ctor = _nvkm_object_ctor, |
| 187 | .dtor = nvkm_object_destroy, |
| 188 | .init = nvkm_object_init, |
| 189 | .fini = nvkm_object_fini, |
| 190 | .mthd = nvkm_control_mthd, |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 191 | }; |
| 192 | |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 193 | struct nvkm_oclass |
| 194 | nvkm_control_oclass[] = { |
Ben Skeggs | a532da9 | 2014-08-10 04:10:25 +1000 | [diff] [blame] | 195 | { .handle = NVIF_IOCTL_NEW_V0_CONTROL, |
Ben Skeggs | 9719047 | 2015-01-14 15:35:00 +1000 | [diff] [blame^] | 196 | .ofuncs = &nvkm_control_ofuncs |
Ben Skeggs | 9838366 | 2013-10-17 09:56:02 +1000 | [diff] [blame] | 197 | }, |
| 198 | {} |
| 199 | }; |