1 /* 2 * Copyright 2012 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 23 */ 24 #include <core/client.h> 25 #include <core/device.h> 26 #include <core/notify.h> 27 #include <core/option.h> 28 29 #include <nvif/class.h> 30 #include <nvif/event.h> 31 #include <nvif/if0000.h> 32 #include <nvif/unpack.h> 33 34 struct nvkm_client_notify { 35 struct nvkm_client *client; 36 struct nvkm_notify n; 37 u8 version; 38 u8 size; 39 union { 40 struct nvif_notify_rep_v0 v0; 41 } rep; 42 }; 43 44 static int 45 nvkm_client_notify(struct nvkm_notify *n) 46 { 47 struct nvkm_client_notify *notify = container_of(n, typeof(*notify), n); 48 struct nvkm_client *client = notify->client; 49 return client->ntfy(¬ify->rep, notify->size, n->data, n->size); 50 } 51 52 int 53 nvkm_client_notify_put(struct nvkm_client *client, int index) 54 { 55 if (index < ARRAY_SIZE(client->notify)) { 56 if (client->notify[index]) { 57 nvkm_notify_put(&client->notify[index]->n); 58 return 0; 59 } 60 } 61 return -ENOENT; 62 } 63 64 int 65 nvkm_client_notify_get(struct nvkm_client *client, int index) 66 { 67 if (index < ARRAY_SIZE(client->notify)) { 68 if (client->notify[index]) { 69 nvkm_notify_get(&client->notify[index]->n); 70 return 0; 71 } 72 } 73 return -ENOENT; 74 } 75 76 int 77 nvkm_client_notify_del(struct nvkm_client *client, int index) 78 { 79 if (index < ARRAY_SIZE(client->notify)) { 80 if (client->notify[index]) { 81 nvkm_notify_fini(&client->notify[index]->n); 82 kfree(client->notify[index]); 83 client->notify[index] = NULL; 84 return 0; 85 } 86 } 87 return -ENOENT; 88 } 89 90 int 91 nvkm_client_notify_new(struct nvkm_object *object, 92 struct nvkm_event *event, void *data, u32 size) 93 { 94 struct nvkm_client *client = object->client; 95 struct nvkm_client_notify *notify; 96 union { 97 struct nvif_notify_req_v0 v0; 98 } *req = data; 99 u8 index, reply; 100 int ret = -ENOSYS; 101 102 for (index = 0; index < ARRAY_SIZE(client->notify); index++) { 103 if (!client->notify[index]) 104 break; 105 } 106 107 if (index == ARRAY_SIZE(client->notify)) 108 return -ENOSPC; 109 110 notify = kzalloc(sizeof(*notify), GFP_KERNEL); 111 if (!notify) 112 return -ENOMEM; 113 114 nvif_ioctl(object, "notify new size %d\n", size); 115 if (!(ret = nvif_unpack(ret, &data, &size, req->v0, 0, 0, true))) { 116 nvif_ioctl(object, "notify new vers %d reply %d route %02x " 117 "token %llx\n", req->v0.version, 118 req->v0.reply, req->v0.route, req->v0.token); 119 notify->version = req->v0.version; 120 notify->size = sizeof(notify->rep.v0); 121 notify->rep.v0.version = req->v0.version; 122 notify->rep.v0.route = req->v0.route; 123 notify->rep.v0.token = req->v0.token; 124 reply = req->v0.reply; 125 } 126 127 if (ret == 0) { 128 ret = nvkm_notify_init(object, event, nvkm_client_notify, 129 false, data, size, reply, ¬ify->n); 130 if (ret == 0) { 131 client->notify[index] = notify; 132 notify->client = client; 133 return index; 134 } 135 } 136 137 kfree(notify); 138 return ret; 139 } 140 141 static int 142 nvkm_client_mthd_devlist(struct nvkm_object *object, void *data, u32 size) 143 { 144 union { 145 struct nv_client_devlist_v0 v0; 146 } *args = data; 147 int ret = -ENOSYS; 148 149 nvif_ioctl(object, "client devlist size %d\n", size); 150 if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, true))) { 151 nvif_ioctl(object, "client devlist vers %d count %d\n", 152 args->v0.version, args->v0.count); 153 if (size == sizeof(args->v0.device[0]) * args->v0.count) { 154 ret = nvkm_device_list(args->v0.device, args->v0.count); 155 if (ret >= 0) { 156 args->v0.count = ret; 157 ret = 0; 158 } 159 } else { 160 ret = -EINVAL; 161 } 162 } 163 164 return ret; 165 } 166 167 static int 168 nvkm_client_mthd(struct nvkm_object *object, u32 mthd, void *data, u32 size) 169 { 170 switch (mthd) { 171 case NV_CLIENT_DEVLIST: 172 return nvkm_client_mthd_devlist(object, data, size); 173 default: 174 break; 175 } 176 return -EINVAL; 177 } 178 179 static int 180 nvkm_client_child_new(const struct nvkm_oclass *oclass, 181 void *data, u32 size, struct nvkm_object **pobject) 182 { 183 return oclass->base.ctor(oclass, data, size, pobject); 184 } 185 186 static int 187 nvkm_client_child_get(struct nvkm_object *object, int index, 188 struct nvkm_oclass *oclass) 189 { 190 const struct nvkm_sclass *sclass; 191 192 switch (index) { 193 case 0: sclass = &nvkm_udevice_sclass; break; 194 default: 195 return -EINVAL; 196 } 197 198 oclass->ctor = nvkm_client_child_new; 199 oclass->base = *sclass; 200 return 0; 201 } 202 203 static const struct nvkm_object_func 204 nvkm_client_object_func = { 205 .mthd = nvkm_client_mthd, 206 .sclass = nvkm_client_child_get, 207 }; 208 209 void 210 nvkm_client_remove(struct nvkm_client *client, struct nvkm_object *object) 211 { 212 if (!RB_EMPTY_NODE(&object->node)) 213 rb_erase(&object->node, &client->objroot); 214 } 215 216 bool 217 nvkm_client_insert(struct nvkm_client *client, struct nvkm_object *object) 218 { 219 struct rb_node **ptr = &client->objroot.rb_node; 220 struct rb_node *parent = NULL; 221 222 while (*ptr) { 223 struct nvkm_object *this = 224 container_of(*ptr, typeof(*this), node); 225 parent = *ptr; 226 if (object->object < this->object) 227 ptr = &parent->rb_left; 228 else 229 if (object->object > this->object) 230 ptr = &parent->rb_right; 231 else 232 return false; 233 } 234 235 rb_link_node(&object->node, parent, ptr); 236 rb_insert_color(&object->node, &client->objroot); 237 return true; 238 } 239 240 struct nvkm_object * 241 nvkm_client_search(struct nvkm_client *client, u64 handle) 242 { 243 struct rb_node *node = client->objroot.rb_node; 244 while (node) { 245 struct nvkm_object *object = 246 container_of(node, typeof(*object), node); 247 if (handle < object->object) 248 node = node->rb_left; 249 else 250 if (handle > object->object) 251 node = node->rb_right; 252 else 253 return object; 254 } 255 return NULL; 256 } 257 258 int 259 nvkm_client_fini(struct nvkm_client *client, bool suspend) 260 { 261 struct nvkm_object *object = &client->object; 262 const char *name[2] = { "fini", "suspend" }; 263 int i; 264 nvif_debug(object, "%s notify\n", name[suspend]); 265 for (i = 0; i < ARRAY_SIZE(client->notify); i++) 266 nvkm_client_notify_put(client, i); 267 return nvkm_object_fini(&client->object, suspend); 268 } 269 270 int 271 nvkm_client_init(struct nvkm_client *client) 272 { 273 return nvkm_object_init(&client->object); 274 } 275 276 void 277 nvkm_client_del(struct nvkm_client **pclient) 278 { 279 struct nvkm_client *client = *pclient; 280 int i; 281 if (client) { 282 nvkm_client_fini(client, false); 283 for (i = 0; i < ARRAY_SIZE(client->notify); i++) 284 nvkm_client_notify_del(client, i); 285 nvkm_object_dtor(&client->object); 286 kfree(*pclient); 287 *pclient = NULL; 288 } 289 } 290 291 int 292 nvkm_client_new(const char *name, u64 device, const char *cfg, 293 const char *dbg, struct nvkm_client **pclient) 294 { 295 struct nvkm_oclass oclass = {}; 296 struct nvkm_client *client; 297 298 if (!(client = *pclient = kzalloc(sizeof(*client), GFP_KERNEL))) 299 return -ENOMEM; 300 oclass.client = client; 301 302 nvkm_object_ctor(&nvkm_client_object_func, &oclass, &client->object); 303 snprintf(client->name, sizeof(client->name), "%s", name); 304 client->device = device; 305 client->debug = nvkm_dbgopt(dbg, "CLIENT"); 306 client->objroot = RB_ROOT; 307 client->dmaroot = RB_ROOT; 308 return 0; 309 } 310