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 "priv.h"
25
26#include <core/firmware.h>
27#include <subdev/timer.h>
28
29bool
30nvkm_pmu_fan_controlled(struct nvkm_device *device)
31{
32 struct nvkm_pmu *pmu = device->pmu;
33
34
35
36
37 if (pmu && pmu->func->code.size)
38 return false;
39
40
41
42
43
44 return (device->chipset >= 0xc0);
45}
46
47void
48nvkm_pmu_pgob(struct nvkm_pmu *pmu, bool enable)
49{
50 if (pmu && pmu->func->pgob)
51 pmu->func->pgob(pmu, enable);
52}
53
54static void
55nvkm_pmu_recv(struct work_struct *work)
56{
57 struct nvkm_pmu *pmu = container_of(work, typeof(*pmu), recv.work);
58 return pmu->func->recv(pmu);
59}
60
61int
62nvkm_pmu_send(struct nvkm_pmu *pmu, u32 reply[2],
63 u32 process, u32 message, u32 data0, u32 data1)
64{
65 if (!pmu || !pmu->func->send)
66 return -ENODEV;
67 return pmu->func->send(pmu, reply, process, message, data0, data1);
68}
69
70static void
71nvkm_pmu_intr(struct nvkm_subdev *subdev)
72{
73 struct nvkm_pmu *pmu = nvkm_pmu(subdev);
74 if (!pmu->func->intr)
75 return;
76 pmu->func->intr(pmu);
77}
78
79static int
80nvkm_pmu_fini(struct nvkm_subdev *subdev, bool suspend)
81{
82 struct nvkm_pmu *pmu = nvkm_pmu(subdev);
83
84 if (pmu->func->fini)
85 pmu->func->fini(pmu);
86
87 flush_work(&pmu->recv.work);
88
89 reinit_completion(&pmu->wpr_ready);
90
91 nvkm_falcon_cmdq_fini(pmu->lpq);
92 nvkm_falcon_cmdq_fini(pmu->hpq);
93 pmu->initmsg_received = false;
94 return 0;
95}
96
97static int
98nvkm_pmu_reset(struct nvkm_pmu *pmu)
99{
100 struct nvkm_device *device = pmu->subdev.device;
101
102 if (!pmu->func->enabled(pmu))
103 return 0;
104
105
106 nvkm_wr32(device, 0x10a014, 0x0000ffff);
107 nvkm_msec(device, 2000,
108 if (!nvkm_rd32(device, 0x10a04c))
109 break;
110 );
111
112
113 if (pmu->func->reset)
114 pmu->func->reset(pmu);
115
116
117 nvkm_msec(device, 2000,
118 if (!(nvkm_rd32(device, 0x10a10c) & 0x00000006))
119 break;
120 );
121
122 return 0;
123}
124
125static int
126nvkm_pmu_preinit(struct nvkm_subdev *subdev)
127{
128 struct nvkm_pmu *pmu = nvkm_pmu(subdev);
129 return nvkm_pmu_reset(pmu);
130}
131
132static int
133nvkm_pmu_init(struct nvkm_subdev *subdev)
134{
135 struct nvkm_pmu *pmu = nvkm_pmu(subdev);
136 int ret = nvkm_pmu_reset(pmu);
137 if (ret == 0 && pmu->func->init)
138 ret = pmu->func->init(pmu);
139 return ret;
140}
141
142static void *
143nvkm_pmu_dtor(struct nvkm_subdev *subdev)
144{
145 struct nvkm_pmu *pmu = nvkm_pmu(subdev);
146 nvkm_falcon_msgq_del(&pmu->msgq);
147 nvkm_falcon_cmdq_del(&pmu->lpq);
148 nvkm_falcon_cmdq_del(&pmu->hpq);
149 nvkm_falcon_qmgr_del(&pmu->qmgr);
150 nvkm_falcon_dtor(&pmu->falcon);
151 mutex_destroy(&pmu->send.mutex);
152 return nvkm_pmu(subdev);
153}
154
155static const struct nvkm_subdev_func
156nvkm_pmu = {
157 .dtor = nvkm_pmu_dtor,
158 .preinit = nvkm_pmu_preinit,
159 .init = nvkm_pmu_init,
160 .fini = nvkm_pmu_fini,
161 .intr = nvkm_pmu_intr,
162};
163
164int
165nvkm_pmu_ctor(const struct nvkm_pmu_fwif *fwif, struct nvkm_device *device,
166 enum nvkm_subdev_type type, int inst, struct nvkm_pmu *pmu)
167{
168 int ret;
169
170 nvkm_subdev_ctor(&nvkm_pmu, device, type, inst, &pmu->subdev);
171
172 mutex_init(&pmu->send.mutex);
173
174 INIT_WORK(&pmu->recv.work, nvkm_pmu_recv);
175 init_waitqueue_head(&pmu->recv.wait);
176
177 fwif = nvkm_firmware_load(&pmu->subdev, fwif, "Pmu", pmu);
178 if (IS_ERR(fwif))
179 return PTR_ERR(fwif);
180
181 pmu->func = fwif->func;
182
183 ret = nvkm_falcon_ctor(pmu->func->flcn, &pmu->subdev, pmu->subdev.name,
184 0x10a000, &pmu->falcon);
185 if (ret)
186 return ret;
187
188 if ((ret = nvkm_falcon_qmgr_new(&pmu->falcon, &pmu->qmgr)) ||
189 (ret = nvkm_falcon_cmdq_new(pmu->qmgr, "hpq", &pmu->hpq)) ||
190 (ret = nvkm_falcon_cmdq_new(pmu->qmgr, "lpq", &pmu->lpq)) ||
191 (ret = nvkm_falcon_msgq_new(pmu->qmgr, "msgq", &pmu->msgq)))
192 return ret;
193
194 init_completion(&pmu->wpr_ready);
195 return 0;
196}
197
198int
199nvkm_pmu_new_(const struct nvkm_pmu_fwif *fwif, struct nvkm_device *device,
200 enum nvkm_subdev_type type, int inst, struct nvkm_pmu **ppmu)
201{
202 struct nvkm_pmu *pmu;
203 if (!(pmu = *ppmu = kzalloc(sizeof(*pmu), GFP_KERNEL)))
204 return -ENOMEM;
205 return nvkm_pmu_ctor(fwif, device, type, inst, *ppmu);
206}
207