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 "priv.h"
25
26 #include <core/option.h>
27 #include <subdev/vga.h>
28
29 u32
nvkm_devinit_mmio(struct nvkm_devinit * init,u32 addr)30 nvkm_devinit_mmio(struct nvkm_devinit *init, u32 addr)
31 {
32 if (init->func->mmio)
33 addr = init->func->mmio(init, addr);
34 return addr;
35 }
36
37 int
nvkm_devinit_pll_set(struct nvkm_devinit * init,u32 type,u32 khz)38 nvkm_devinit_pll_set(struct nvkm_devinit *init, u32 type, u32 khz)
39 {
40 return init->func->pll_set(init, type, khz);
41 }
42
43 void
nvkm_devinit_meminit(struct nvkm_devinit * init)44 nvkm_devinit_meminit(struct nvkm_devinit *init)
45 {
46 if (init->func->meminit)
47 init->func->meminit(init);
48 }
49
50 u64
nvkm_devinit_disable(struct nvkm_devinit * init)51 nvkm_devinit_disable(struct nvkm_devinit *init)
52 {
53 if (init && init->func->disable)
54 return init->func->disable(init);
55 return 0;
56 }
57
58 int
nvkm_devinit_post(struct nvkm_devinit * init,u64 * disable)59 nvkm_devinit_post(struct nvkm_devinit *init, u64 *disable)
60 {
61 int ret = 0;
62 if (init && init->func->post)
63 ret = init->func->post(init, init->post);
64 *disable = nvkm_devinit_disable(init);
65 return ret;
66 }
67
68 static int
nvkm_devinit_fini(struct nvkm_subdev * subdev,bool suspend)69 nvkm_devinit_fini(struct nvkm_subdev *subdev, bool suspend)
70 {
71 struct nvkm_devinit *init = nvkm_devinit(subdev);
72 /* force full reinit on resume */
73 if (suspend)
74 init->post = true;
75 return 0;
76 }
77
78 static int
nvkm_devinit_preinit(struct nvkm_subdev * subdev)79 nvkm_devinit_preinit(struct nvkm_subdev *subdev)
80 {
81 struct nvkm_devinit *init = nvkm_devinit(subdev);
82
83 if (init->func->preinit)
84 init->func->preinit(init);
85
86 /* Override the post flag during the first call if NvForcePost is set */
87 if (init->force_post) {
88 init->post = init->force_post;
89 init->force_post = false;
90 }
91
92 /* unlock the extended vga crtc regs */
93 nvkm_lockvgac(subdev->device, false);
94 return 0;
95 }
96
97 static int
nvkm_devinit_init(struct nvkm_subdev * subdev)98 nvkm_devinit_init(struct nvkm_subdev *subdev)
99 {
100 struct nvkm_devinit *init = nvkm_devinit(subdev);
101 if (init->func->init)
102 init->func->init(init);
103 return 0;
104 }
105
106 static void *
nvkm_devinit_dtor(struct nvkm_subdev * subdev)107 nvkm_devinit_dtor(struct nvkm_subdev *subdev)
108 {
109 struct nvkm_devinit *init = nvkm_devinit(subdev);
110 void *data = init;
111
112 if (init->func->dtor)
113 data = init->func->dtor(init);
114
115 /* lock crtc regs */
116 nvkm_lockvgac(subdev->device, true);
117 return data;
118 }
119
120 static const struct nvkm_subdev_func
121 nvkm_devinit = {
122 .dtor = nvkm_devinit_dtor,
123 .preinit = nvkm_devinit_preinit,
124 .init = nvkm_devinit_init,
125 .fini = nvkm_devinit_fini,
126 };
127
128 void
nvkm_devinit_ctor(const struct nvkm_devinit_func * func,struct nvkm_device * device,int index,struct nvkm_devinit * init)129 nvkm_devinit_ctor(const struct nvkm_devinit_func *func,
130 struct nvkm_device *device, int index,
131 struct nvkm_devinit *init)
132 {
133 nvkm_subdev_ctor(&nvkm_devinit, device, index, &init->subdev);
134 init->func = func;
135 init->force_post = nvkm_boolopt(device->cfgopt, "NvForcePost", false);
136 }
137