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
nvkm_subdev_intr(struct nvkm_subdev * subdev)39 nvkm_subdev_intr(struct nvkm_subdev *subdev)
40 {
41 if (subdev->func->intr)
42 subdev->func->intr(subdev);
43 }
44
45 int
nvkm_subdev_info(struct nvkm_subdev * subdev,u64 mthd,u64 * data)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
nvkm_subdev_fini(struct nvkm_subdev * subdev,bool suspend)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
nvkm_subdev_preinit(struct nvkm_subdev * subdev)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
nvkm_subdev_init(struct nvkm_subdev * subdev)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
nvkm_subdev_del(struct nvkm_subdev ** psubdev)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
nvkm_subdev_disable(struct nvkm_device * device,enum nvkm_subdev_type type,int inst)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
nvkm_subdev_ctor(const struct nvkm_subdev_func * func,struct nvkm_device * device,enum nvkm_subdev_type type,int inst,struct nvkm_subdev * subdev)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
nvkm_subdev_new_(const struct nvkm_subdev_func * func,struct nvkm_device * device,enum nvkm_subdev_type type,int inst,struct nvkm_subdev ** psubdev)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