1a04d0423SBen Skeggs /* 2a04d0423SBen Skeggs * Copyright 2014 Red Hat Inc. 3a04d0423SBen Skeggs * 4a04d0423SBen Skeggs * Permission is hereby granted, free of charge, to any person obtaining a 5a04d0423SBen Skeggs * copy of this software and associated documentation files (the "Software"), 6a04d0423SBen Skeggs * to deal in the Software without restriction, including without limitation 7a04d0423SBen Skeggs * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8a04d0423SBen Skeggs * and/or sell copies of the Software, and to permit persons to whom the 9a04d0423SBen Skeggs * Software is furnished to do so, subject to the following conditions: 10a04d0423SBen Skeggs * 11a04d0423SBen Skeggs * The above copyright notice and this permission notice shall be included in 12a04d0423SBen Skeggs * all copies or substantial portions of the Software. 13a04d0423SBen Skeggs * 14a04d0423SBen Skeggs * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 15a04d0423SBen Skeggs * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 16a04d0423SBen Skeggs * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 17a04d0423SBen Skeggs * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 18a04d0423SBen Skeggs * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 19a04d0423SBen Skeggs * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 20a04d0423SBen Skeggs * OTHER DEALINGS IN THE SOFTWARE. 21a04d0423SBen Skeggs * 22a04d0423SBen Skeggs * Authors: Ben Skeggs <bskeggs@redhat.com> 23a04d0423SBen Skeggs */ 24a04d0423SBen Skeggs 25*c39f472eSBen Skeggs #include <nvif/object.h> 26*c39f472eSBen Skeggs #include <nvif/client.h> 27*c39f472eSBen Skeggs #include <nvif/driver.h> 28*c39f472eSBen Skeggs #include <nvif/ioctl.h> 29a04d0423SBen Skeggs 30a04d0423SBen Skeggs int 31a04d0423SBen Skeggs nvif_object_ioctl(struct nvif_object *object, void *data, u32 size, void **hack) 32a04d0423SBen Skeggs { 33a04d0423SBen Skeggs struct nvif_client *client = nvif_client(object); 34a04d0423SBen Skeggs union { 35a04d0423SBen Skeggs struct nvif_ioctl_v0 v0; 36a04d0423SBen Skeggs } *args = data; 37a04d0423SBen Skeggs 38a04d0423SBen Skeggs if (size >= sizeof(*args) && args->v0.version == 0) { 39a04d0423SBen Skeggs args->v0.owner = NVIF_IOCTL_V0_OWNER_ANY; 40a04d0423SBen Skeggs args->v0.path_nr = 0; 41a04d0423SBen Skeggs while (args->v0.path_nr < ARRAY_SIZE(args->v0.path)) { 42a04d0423SBen Skeggs args->v0.path[args->v0.path_nr++] = object->handle; 43a04d0423SBen Skeggs if (object->parent == object) 44a04d0423SBen Skeggs break; 45a04d0423SBen Skeggs object = object->parent; 46a04d0423SBen Skeggs } 47a04d0423SBen Skeggs } else 48a04d0423SBen Skeggs return -ENOSYS; 49a04d0423SBen Skeggs 50a04d0423SBen Skeggs return client->driver->ioctl(client->base.priv, client->super, data, size, hack); 51a04d0423SBen Skeggs } 52a04d0423SBen Skeggs 53a04d0423SBen Skeggs int 54a04d0423SBen Skeggs nvif_object_sclass(struct nvif_object *object, u32 *oclass, int count) 55a04d0423SBen Skeggs { 56a04d0423SBen Skeggs struct { 57a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 58a04d0423SBen Skeggs struct nvif_ioctl_sclass_v0 sclass; 59a04d0423SBen Skeggs } *args; 60a04d0423SBen Skeggs u32 size = count * sizeof(args->sclass.oclass[0]); 61a04d0423SBen Skeggs int ret; 62a04d0423SBen Skeggs 63a04d0423SBen Skeggs if (!(args = kmalloc(sizeof(*args) + size, GFP_KERNEL))) 64a04d0423SBen Skeggs return -ENOMEM; 65a04d0423SBen Skeggs args->ioctl.version = 0; 66a04d0423SBen Skeggs args->ioctl.type = NVIF_IOCTL_V0_SCLASS; 67a04d0423SBen Skeggs args->sclass.version = 0; 68a04d0423SBen Skeggs args->sclass.count = count; 69a04d0423SBen Skeggs 70a04d0423SBen Skeggs memcpy(args->sclass.oclass, oclass, size); 71a04d0423SBen Skeggs ret = nvif_object_ioctl(object, args, sizeof(*args) + size, NULL); 72a04d0423SBen Skeggs ret = ret ? ret : args->sclass.count; 73a04d0423SBen Skeggs memcpy(oclass, args->sclass.oclass, size); 74a04d0423SBen Skeggs kfree(args); 75a04d0423SBen Skeggs return ret; 76a04d0423SBen Skeggs } 77a04d0423SBen Skeggs 78a04d0423SBen Skeggs u32 79a04d0423SBen Skeggs nvif_object_rd(struct nvif_object *object, int size, u64 addr) 80a04d0423SBen Skeggs { 81a04d0423SBen Skeggs struct { 82a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 83a04d0423SBen Skeggs struct nvif_ioctl_rd_v0 rd; 84a04d0423SBen Skeggs } args = { 85a04d0423SBen Skeggs .ioctl.type = NVIF_IOCTL_V0_RD, 86a04d0423SBen Skeggs .rd.size = size, 87a04d0423SBen Skeggs .rd.addr = addr, 88a04d0423SBen Skeggs }; 89a04d0423SBen Skeggs int ret = nvif_object_ioctl(object, &args, sizeof(args), NULL); 90a04d0423SBen Skeggs if (ret) { 91a04d0423SBen Skeggs /*XXX: warn? */ 92a04d0423SBen Skeggs return 0; 93a04d0423SBen Skeggs } 94a04d0423SBen Skeggs return args.rd.data; 95a04d0423SBen Skeggs } 96a04d0423SBen Skeggs 97a04d0423SBen Skeggs void 98a04d0423SBen Skeggs nvif_object_wr(struct nvif_object *object, int size, u64 addr, u32 data) 99a04d0423SBen Skeggs { 100a04d0423SBen Skeggs struct { 101a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 102a04d0423SBen Skeggs struct nvif_ioctl_wr_v0 wr; 103a04d0423SBen Skeggs } args = { 104a04d0423SBen Skeggs .ioctl.type = NVIF_IOCTL_V0_WR, 105a04d0423SBen Skeggs .wr.size = size, 106a04d0423SBen Skeggs .wr.addr = addr, 107a04d0423SBen Skeggs .wr.data = data, 108a04d0423SBen Skeggs }; 109a04d0423SBen Skeggs int ret = nvif_object_ioctl(object, &args, sizeof(args), NULL); 110a04d0423SBen Skeggs if (ret) { 111a04d0423SBen Skeggs /*XXX: warn? */ 112a04d0423SBen Skeggs } 113a04d0423SBen Skeggs } 114a04d0423SBen Skeggs 115a04d0423SBen Skeggs int 116a04d0423SBen Skeggs nvif_object_mthd(struct nvif_object *object, u32 mthd, void *data, u32 size) 117a04d0423SBen Skeggs { 118a04d0423SBen Skeggs struct { 119a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 120a04d0423SBen Skeggs struct nvif_ioctl_mthd_v0 mthd; 121a04d0423SBen Skeggs } *args; 122a04d0423SBen Skeggs u8 stack[128]; 123a04d0423SBen Skeggs int ret; 124a04d0423SBen Skeggs 125a04d0423SBen Skeggs if (sizeof(*args) + size > sizeof(stack)) { 126a04d0423SBen Skeggs if (!(args = kmalloc(sizeof(*args) + size, GFP_KERNEL))) 127a04d0423SBen Skeggs return -ENOMEM; 128a04d0423SBen Skeggs } else { 129a04d0423SBen Skeggs args = (void *)stack; 130a04d0423SBen Skeggs } 131a04d0423SBen Skeggs args->ioctl.version = 0; 132a04d0423SBen Skeggs args->ioctl.type = NVIF_IOCTL_V0_MTHD; 133a04d0423SBen Skeggs args->mthd.version = 0; 134a04d0423SBen Skeggs args->mthd.method = mthd; 135a04d0423SBen Skeggs 136a04d0423SBen Skeggs memcpy(args->mthd.data, data, size); 137a04d0423SBen Skeggs ret = nvif_object_ioctl(object, args, sizeof(*args) + size, NULL); 138a04d0423SBen Skeggs memcpy(data, args->mthd.data, size); 139a04d0423SBen Skeggs if (args != (void *)stack) 140a04d0423SBen Skeggs kfree(args); 141a04d0423SBen Skeggs return ret; 142a04d0423SBen Skeggs } 143a04d0423SBen Skeggs 144a04d0423SBen Skeggs void 145a04d0423SBen Skeggs nvif_object_unmap(struct nvif_object *object) 146a04d0423SBen Skeggs { 147a04d0423SBen Skeggs if (object->map.size) { 148a04d0423SBen Skeggs struct nvif_client *client = nvif_client(object); 149a04d0423SBen Skeggs struct { 150a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 151a04d0423SBen Skeggs struct nvif_ioctl_unmap unmap; 152a04d0423SBen Skeggs } args = { 153a04d0423SBen Skeggs .ioctl.type = NVIF_IOCTL_V0_UNMAP, 154a04d0423SBen Skeggs }; 155a04d0423SBen Skeggs 156a04d0423SBen Skeggs if (object->map.ptr) { 157a04d0423SBen Skeggs client->driver->unmap(client, object->map.ptr, 158a04d0423SBen Skeggs object->map.size); 159a04d0423SBen Skeggs object->map.ptr = NULL; 160a04d0423SBen Skeggs } 161a04d0423SBen Skeggs 162a04d0423SBen Skeggs nvif_object_ioctl(object, &args, sizeof(args), NULL); 163a04d0423SBen Skeggs object->map.size = 0; 164a04d0423SBen Skeggs } 165a04d0423SBen Skeggs } 166a04d0423SBen Skeggs 167a04d0423SBen Skeggs int 168a04d0423SBen Skeggs nvif_object_map(struct nvif_object *object) 169a04d0423SBen Skeggs { 170a04d0423SBen Skeggs struct nvif_client *client = nvif_client(object); 171a04d0423SBen Skeggs struct { 172a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 173a04d0423SBen Skeggs struct nvif_ioctl_map_v0 map; 174a04d0423SBen Skeggs } args = { 175a04d0423SBen Skeggs .ioctl.type = NVIF_IOCTL_V0_MAP, 176a04d0423SBen Skeggs }; 177a04d0423SBen Skeggs int ret = nvif_object_ioctl(object, &args, sizeof(args), NULL); 178a04d0423SBen Skeggs if (ret == 0) { 179a04d0423SBen Skeggs object->map.size = args.map.length; 180a04d0423SBen Skeggs object->map.ptr = client->driver->map(client, args.map.handle, 181a04d0423SBen Skeggs object->map.size); 182a04d0423SBen Skeggs if (ret = -ENOMEM, object->map.ptr) 183a04d0423SBen Skeggs return 0; 184a04d0423SBen Skeggs nvif_object_unmap(object); 185a04d0423SBen Skeggs } 186a04d0423SBen Skeggs return ret; 187a04d0423SBen Skeggs } 188a04d0423SBen Skeggs 189a04d0423SBen Skeggs struct ctor { 190a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 191a04d0423SBen Skeggs struct nvif_ioctl_new_v0 new; 192a04d0423SBen Skeggs }; 193a04d0423SBen Skeggs 194a04d0423SBen Skeggs void 195a04d0423SBen Skeggs nvif_object_fini(struct nvif_object *object) 196a04d0423SBen Skeggs { 197a04d0423SBen Skeggs struct ctor *ctor = container_of(object->data, typeof(*ctor), new.data); 198a04d0423SBen Skeggs if (object->parent) { 199a04d0423SBen Skeggs struct { 200a04d0423SBen Skeggs struct nvif_ioctl_v0 ioctl; 201a04d0423SBen Skeggs struct nvif_ioctl_del del; 202a04d0423SBen Skeggs } args = { 203a04d0423SBen Skeggs .ioctl.type = NVIF_IOCTL_V0_DEL, 204a04d0423SBen Skeggs }; 205a04d0423SBen Skeggs 206a04d0423SBen Skeggs nvif_object_unmap(object); 207a04d0423SBen Skeggs nvif_object_ioctl(object, &args, sizeof(args), NULL); 208a04d0423SBen Skeggs if (object->data) { 209a04d0423SBen Skeggs object->size = 0; 210a04d0423SBen Skeggs object->data = NULL; 211a04d0423SBen Skeggs kfree(ctor); 212a04d0423SBen Skeggs } 213a04d0423SBen Skeggs nvif_object_ref(NULL, &object->parent); 214a04d0423SBen Skeggs } 215a04d0423SBen Skeggs } 216a04d0423SBen Skeggs 217a04d0423SBen Skeggs int 218a04d0423SBen Skeggs nvif_object_init(struct nvif_object *parent, void (*dtor)(struct nvif_object *), 219a04d0423SBen Skeggs u32 handle, u32 oclass, void *data, u32 size, 220a04d0423SBen Skeggs struct nvif_object *object) 221a04d0423SBen Skeggs { 222a04d0423SBen Skeggs struct ctor *ctor; 223a04d0423SBen Skeggs int ret = 0; 224a04d0423SBen Skeggs 225a04d0423SBen Skeggs object->parent = NULL; 226a04d0423SBen Skeggs object->object = object; 227a04d0423SBen Skeggs nvif_object_ref(parent, &object->parent); 228a04d0423SBen Skeggs kref_init(&object->refcount); 229a04d0423SBen Skeggs object->handle = handle; 230a04d0423SBen Skeggs object->oclass = oclass; 231a04d0423SBen Skeggs object->data = NULL; 232a04d0423SBen Skeggs object->size = 0; 233a04d0423SBen Skeggs object->dtor = dtor; 234a04d0423SBen Skeggs object->map.ptr = NULL; 235a04d0423SBen Skeggs object->map.size = 0; 236a04d0423SBen Skeggs 237a04d0423SBen Skeggs if (object->parent) { 238a04d0423SBen Skeggs if (!(ctor = kmalloc(sizeof(*ctor) + size, GFP_KERNEL))) { 239a04d0423SBen Skeggs nvif_object_fini(object); 240a04d0423SBen Skeggs return -ENOMEM; 241a04d0423SBen Skeggs } 242a04d0423SBen Skeggs object->data = ctor->new.data; 243a04d0423SBen Skeggs object->size = size; 244a04d0423SBen Skeggs memcpy(object->data, data, size); 245a04d0423SBen Skeggs 246a04d0423SBen Skeggs ctor->ioctl.version = 0; 247a04d0423SBen Skeggs ctor->ioctl.type = NVIF_IOCTL_V0_NEW; 248a04d0423SBen Skeggs ctor->new.version = 0; 249a04d0423SBen Skeggs ctor->new.route = NVIF_IOCTL_V0_ROUTE_NVIF; 250a04d0423SBen Skeggs ctor->new.token = (unsigned long)(void *)object; 251a04d0423SBen Skeggs ctor->new.handle = handle; 252a04d0423SBen Skeggs ctor->new.oclass = oclass; 253a04d0423SBen Skeggs 254a04d0423SBen Skeggs ret = nvif_object_ioctl(parent, ctor, sizeof(*ctor) + 255a04d0423SBen Skeggs object->size, &object->priv); 256a04d0423SBen Skeggs } 257a04d0423SBen Skeggs 258a04d0423SBen Skeggs if (ret) 259a04d0423SBen Skeggs nvif_object_fini(object); 260a04d0423SBen Skeggs return ret; 261a04d0423SBen Skeggs } 262a04d0423SBen Skeggs 263a04d0423SBen Skeggs static void 264a04d0423SBen Skeggs nvif_object_del(struct nvif_object *object) 265a04d0423SBen Skeggs { 266a04d0423SBen Skeggs nvif_object_fini(object); 267a04d0423SBen Skeggs kfree(object); 268a04d0423SBen Skeggs } 269a04d0423SBen Skeggs 270a04d0423SBen Skeggs int 271a04d0423SBen Skeggs nvif_object_new(struct nvif_object *parent, u32 handle, u32 oclass, 272a04d0423SBen Skeggs void *data, u32 size, struct nvif_object **pobject) 273a04d0423SBen Skeggs { 274a04d0423SBen Skeggs struct nvif_object *object = kzalloc(sizeof(*object), GFP_KERNEL); 275a04d0423SBen Skeggs if (object) { 276a04d0423SBen Skeggs int ret = nvif_object_init(parent, nvif_object_del, handle, 277a04d0423SBen Skeggs oclass, data, size, object); 278ef07ceaeSBen Skeggs if (ret) { 279a04d0423SBen Skeggs kfree(object); 280ef07ceaeSBen Skeggs object = NULL; 281ef07ceaeSBen Skeggs } 282a04d0423SBen Skeggs *pobject = object; 283a04d0423SBen Skeggs return ret; 284a04d0423SBen Skeggs } 285a04d0423SBen Skeggs return -ENOMEM; 286a04d0423SBen Skeggs } 287a04d0423SBen Skeggs 288a04d0423SBen Skeggs static void 289a04d0423SBen Skeggs nvif_object_put(struct kref *kref) 290a04d0423SBen Skeggs { 291a04d0423SBen Skeggs struct nvif_object *object = 292a04d0423SBen Skeggs container_of(kref, typeof(*object), refcount); 293a04d0423SBen Skeggs object->dtor(object); 294a04d0423SBen Skeggs } 295a04d0423SBen Skeggs 296a04d0423SBen Skeggs void 297a04d0423SBen Skeggs nvif_object_ref(struct nvif_object *object, struct nvif_object **pobject) 298a04d0423SBen Skeggs { 299a04d0423SBen Skeggs if (object) 300a04d0423SBen Skeggs kref_get(&object->refcount); 301a04d0423SBen Skeggs if (*pobject) 302a04d0423SBen Skeggs kref_put(&(*pobject)->refcount, nvif_object_put); 303a04d0423SBen Skeggs *pobject = object; 304a04d0423SBen Skeggs } 305