1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <core/subdev.h>
25#include <core/device.h>
26#include <core/option.h>
27#include <subdev/mc.h>
28
29const char *
30nvkm_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
38void
39nvkm_subdev_intr(struct nvkm_subdev *subdev)
40{
41 if (subdev->func->intr)
42 subdev->func->intr(subdev);
43}
44
45int
46nvkm_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
53int
54nvkm_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
79int
80nvkm_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
100int
101nvkm_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
137void
138nvkm_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
156void
157nvkm_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
169void
170nvkm_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
186int
187nvkm_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