1*800ac1f8SBen Skeggs /* 2*800ac1f8SBen Skeggs * Copyright 2020 Red Hat Inc. 3*800ac1f8SBen Skeggs * 4*800ac1f8SBen Skeggs * Permission is hereby granted, free of charge, to any person obtaining a 5*800ac1f8SBen Skeggs * copy of this software and associated documentation files (the "Software"), 6*800ac1f8SBen Skeggs * to deal in the Software without restriction, including without limitation 7*800ac1f8SBen Skeggs * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8*800ac1f8SBen Skeggs * and/or sell copies of the Software, and to permit persons to whom the 9*800ac1f8SBen Skeggs * Software is furnished to do so, subject to the following conditions: 10*800ac1f8SBen Skeggs * 11*800ac1f8SBen Skeggs * The above copyright notice and this permission notice shall be included in 12*800ac1f8SBen Skeggs * all copies or substantial portions of the Software. 13*800ac1f8SBen Skeggs * 14*800ac1f8SBen Skeggs * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 15*800ac1f8SBen Skeggs * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 16*800ac1f8SBen Skeggs * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 17*800ac1f8SBen Skeggs * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 18*800ac1f8SBen Skeggs * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 19*800ac1f8SBen Skeggs * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 20*800ac1f8SBen Skeggs * OTHER DEALINGS IN THE SOFTWARE. 21*800ac1f8SBen Skeggs */ 22*800ac1f8SBen Skeggs #include "chid.h" 23*800ac1f8SBen Skeggs 24*800ac1f8SBen Skeggs static void 25*800ac1f8SBen Skeggs nvkm_chid_del(struct kref *kref) 26*800ac1f8SBen Skeggs { 27*800ac1f8SBen Skeggs struct nvkm_chid *chid = container_of(kref, typeof(*chid), kref); 28*800ac1f8SBen Skeggs 29*800ac1f8SBen Skeggs nvkm_event_fini(&chid->event); 30*800ac1f8SBen Skeggs 31*800ac1f8SBen Skeggs kvfree(chid->data); 32*800ac1f8SBen Skeggs kfree(chid); 33*800ac1f8SBen Skeggs } 34*800ac1f8SBen Skeggs 35*800ac1f8SBen Skeggs void 36*800ac1f8SBen Skeggs nvkm_chid_unref(struct nvkm_chid **pchid) 37*800ac1f8SBen Skeggs { 38*800ac1f8SBen Skeggs struct nvkm_chid *chid = *pchid; 39*800ac1f8SBen Skeggs 40*800ac1f8SBen Skeggs if (!chid) 41*800ac1f8SBen Skeggs return; 42*800ac1f8SBen Skeggs 43*800ac1f8SBen Skeggs kref_put(&chid->kref, nvkm_chid_del); 44*800ac1f8SBen Skeggs *pchid = NULL; 45*800ac1f8SBen Skeggs } 46*800ac1f8SBen Skeggs 47*800ac1f8SBen Skeggs struct nvkm_chid * 48*800ac1f8SBen Skeggs nvkm_chid_ref(struct nvkm_chid *chid) 49*800ac1f8SBen Skeggs { 50*800ac1f8SBen Skeggs if (chid) 51*800ac1f8SBen Skeggs kref_get(&chid->kref); 52*800ac1f8SBen Skeggs 53*800ac1f8SBen Skeggs return chid; 54*800ac1f8SBen Skeggs } 55*800ac1f8SBen Skeggs 56*800ac1f8SBen Skeggs int 57*800ac1f8SBen Skeggs nvkm_chid_new(const struct nvkm_event_func *func, struct nvkm_subdev *subdev, 58*800ac1f8SBen Skeggs int nr, int first, int count, struct nvkm_chid **pchid) 59*800ac1f8SBen Skeggs { 60*800ac1f8SBen Skeggs struct nvkm_chid *chid; 61*800ac1f8SBen Skeggs int id; 62*800ac1f8SBen Skeggs 63*800ac1f8SBen Skeggs if (!(chid = *pchid = kzalloc(struct_size(chid, used, nr), GFP_KERNEL))) 64*800ac1f8SBen Skeggs return -ENOMEM; 65*800ac1f8SBen Skeggs 66*800ac1f8SBen Skeggs kref_init(&chid->kref); 67*800ac1f8SBen Skeggs chid->nr = nr; 68*800ac1f8SBen Skeggs chid->mask = chid->nr - 1; 69*800ac1f8SBen Skeggs spin_lock_init(&chid->lock); 70*800ac1f8SBen Skeggs 71*800ac1f8SBen Skeggs if (!(chid->data = kvzalloc(sizeof(*chid->data) * nr, GFP_KERNEL))) { 72*800ac1f8SBen Skeggs nvkm_chid_unref(pchid); 73*800ac1f8SBen Skeggs return -ENOMEM; 74*800ac1f8SBen Skeggs } 75*800ac1f8SBen Skeggs 76*800ac1f8SBen Skeggs for (id = 0; id < first; id++) 77*800ac1f8SBen Skeggs __set_bit(id, chid->used); 78*800ac1f8SBen Skeggs for (id = first + count; id < nr; id++) 79*800ac1f8SBen Skeggs __set_bit(id, chid->used); 80*800ac1f8SBen Skeggs 81*800ac1f8SBen Skeggs return nvkm_event_init(func, subdev, 1, nr, &chid->event); 82*800ac1f8SBen Skeggs } 83