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/subdev.h> 25 #include <core/device.h> 26 #include <core/option.h> 27 #include <subdev/mc.h> 28 29 const char * 30 nvkm_subdev_type[NVKM_SUBDEV_NR] = { 31 #define NVKM_LAYOUT_ONCE(type,data,ptr,...) [type] = #ptr, 32 #define NVKM_LAYOUT_INST(A...) NVKM_LAYOUT_ONCE(A) 33 #include <core/layout.h> 34 #undef NVKM_LAYOUT_ONCE 35 #undef NVKM_LAYOUT_INST 36 }; 37 38 void 39 nvkm_subdev_intr(struct nvkm_subdev *subdev) 40 { 41 if (subdev->func->intr) 42 subdev->func->intr(subdev); 43 } 44 45 int 46 nvkm_subdev_info(struct nvkm_subdev *subdev, u64 mthd, u64 *data) 47 { 48 if (subdev->func->info) 49 return subdev->func->info(subdev, mthd, data); 50 return -ENOSYS; 51 } 52 53 int 54 nvkm_subdev_fini(struct nvkm_subdev *subdev, bool suspend) 55 { 56 struct nvkm_device *device = subdev->device; 57 const char *action = suspend ? "suspend" : "fini"; 58 s64 time; 59 60 nvkm_trace(subdev, "%s running...\n", action); 61 time = ktime_to_us(ktime_get()); 62 63 if (subdev->func->fini) { 64 int ret = subdev->func->fini(subdev, suspend); 65 if (ret) { 66 nvkm_error(subdev, "%s failed, %d\n", action, ret); 67 if (suspend) 68 return ret; 69 } 70 } 71 72 nvkm_mc_reset(device, subdev->type, subdev->inst); 73 74 time = ktime_to_us(ktime_get()) - time; 75 nvkm_trace(subdev, "%s completed in %lldus\n", action, time); 76 return 0; 77 } 78 79 int 80 nvkm_subdev_preinit(struct nvkm_subdev *subdev) 81 { 82 s64 time; 83 84 nvkm_trace(subdev, "preinit running...\n"); 85 time = ktime_to_us(ktime_get()); 86 87 if (subdev->func->preinit) { 88 int ret = subdev->func->preinit(subdev); 89 if (ret) { 90 nvkm_error(subdev, "preinit failed, %d\n", ret); 91 return ret; 92 } 93 } 94 95 time = ktime_to_us(ktime_get()) - time; 96 nvkm_trace(subdev, "preinit completed in %lldus\n", time); 97 return 0; 98 } 99 100 int 101 nvkm_subdev_init(struct nvkm_subdev *subdev) 102 { 103 s64 time; 104 int ret; 105 106 nvkm_trace(subdev, "init running...\n"); 107 time = ktime_to_us(ktime_get()); 108 109 if (subdev->func->oneinit && !subdev->oneinit) { 110 s64 time; 111 nvkm_trace(subdev, "one-time init running...\n"); 112 time = ktime_to_us(ktime_get()); 113 ret = subdev->func->oneinit(subdev); 114 if (ret) { 115 nvkm_error(subdev, "one-time init failed, %d\n", ret); 116 return ret; 117 } 118 119 subdev->oneinit = true; 120 time = ktime_to_us(ktime_get()) - time; 121 nvkm_trace(subdev, "one-time init completed in %lldus\n", time); 122 } 123 124 if (subdev->func->init) { 125 ret = subdev->func->init(subdev); 126 if (ret) { 127 nvkm_error(subdev, "init failed, %d\n", ret); 128 return ret; 129 } 130 } 131 132 time = ktime_to_us(ktime_get()) - time; 133 nvkm_trace(subdev, "init completed in %lldus\n", time); 134 return 0; 135 } 136 137 void 138 nvkm_subdev_del(struct nvkm_subdev **psubdev) 139 { 140 struct nvkm_subdev *subdev = *psubdev; 141 s64 time; 142 143 if (subdev && !WARN_ON(!subdev->func)) { 144 nvkm_trace(subdev, "destroy running...\n"); 145 time = ktime_to_us(ktime_get()); 146 list_del(&subdev->head); 147 if (subdev->func->dtor) 148 *psubdev = subdev->func->dtor(subdev); 149 time = ktime_to_us(ktime_get()) - time; 150 nvkm_trace(subdev, "destroy completed in %lldus\n", time); 151 kfree(*psubdev); 152 *psubdev = NULL; 153 } 154 } 155 156 void 157 nvkm_subdev_disable(struct nvkm_device *device, enum nvkm_subdev_type type, int inst) 158 { 159 struct nvkm_subdev *subdev; 160 list_for_each_entry(subdev, &device->subdev, head) { 161 if (subdev->type == type && subdev->inst == inst) { 162 *subdev->pself = NULL; 163 nvkm_subdev_del(&subdev); 164 break; 165 } 166 } 167 } 168 169 void 170 nvkm_subdev_ctor(const struct nvkm_subdev_func *func, struct nvkm_device *device, 171 enum nvkm_subdev_type type, int inst, struct nvkm_subdev *subdev) 172 { 173 subdev->func = func; 174 subdev->device = device; 175 subdev->type = type; 176 subdev->inst = inst < 0 ? 0 : inst; 177 178 if (inst >= 0) 179 snprintf(subdev->name, sizeof(subdev->name), "%s%d", nvkm_subdev_type[type], inst); 180 else 181 strscpy(subdev->name, nvkm_subdev_type[type], sizeof(subdev->name)); 182 subdev->debug = nvkm_dbgopt(device->dbgopt, subdev->name); 183 list_add_tail(&subdev->head, &device->subdev); 184 } 185 186 int 187 nvkm_subdev_new_(const struct nvkm_subdev_func *func, struct nvkm_device *device, 188 enum nvkm_subdev_type type, int inst, struct nvkm_subdev **psubdev) 189 { 190 if (!(*psubdev = kzalloc(sizeof(**psubdev), GFP_KERNEL))) 191 return -ENOMEM; 192 nvkm_subdev_ctor(func, device, type, inst, *psubdev); 193 return 0; 194 } 195