1c39f472eSBen Skeggs /*
2c39f472eSBen Skeggs * Copyright 2012 Red Hat Inc.
3c39f472eSBen Skeggs *
4c39f472eSBen Skeggs * Permission is hereby granted, free of charge, to any person obtaining a
5c39f472eSBen Skeggs * copy of this software and associated documentation files (the "Software"),
6c39f472eSBen Skeggs * to deal in the Software without restriction, including without limitation
7c39f472eSBen Skeggs * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8c39f472eSBen Skeggs * and/or sell copies of the Software, and to permit persons to whom the
9c39f472eSBen Skeggs * Software is furnished to do so, subject to the following conditions:
10c39f472eSBen Skeggs *
11c39f472eSBen Skeggs * The above copyright notice and this permission notice shall be included in
12c39f472eSBen Skeggs * all copies or substantial portions of the Software.
13c39f472eSBen Skeggs *
14c39f472eSBen Skeggs * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15c39f472eSBen Skeggs * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16c39f472eSBen Skeggs * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17c39f472eSBen Skeggs * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18c39f472eSBen Skeggs * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19c39f472eSBen Skeggs * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20c39f472eSBen Skeggs * OTHER DEALINGS IN THE SOFTWARE.
21c39f472eSBen Skeggs *
22c39f472eSBen Skeggs * Authors: Ben Skeggs
23c39f472eSBen Skeggs */
24c39f472eSBen Skeggs #include "priv.h"
25c39f472eSBen Skeggs
26a8c4362bSBen Skeggs #include <core/option.h>
27a8c4362bSBen Skeggs #include <subdev/vga.h>
28a8c4362bSBen Skeggs
29151abd44SBen Skeggs u32
nvkm_devinit_mmio(struct nvkm_devinit * init,u32 addr)30151abd44SBen Skeggs nvkm_devinit_mmio(struct nvkm_devinit *init, u32 addr)
31c39f472eSBen Skeggs {
32151abd44SBen Skeggs if (init->func->mmio)
33151abd44SBen Skeggs addr = init->func->mmio(init, addr);
34151abd44SBen Skeggs return addr;
35c39f472eSBen Skeggs }
36c39f472eSBen Skeggs
37c39f472eSBen Skeggs int
nvkm_devinit_pll_set(struct nvkm_devinit * init,u32 type,u32 khz)38151abd44SBen Skeggs nvkm_devinit_pll_set(struct nvkm_devinit *init, u32 type, u32 khz)
39c39f472eSBen Skeggs {
40151abd44SBen Skeggs return init->func->pll_set(init, type, khz);
41c39f472eSBen Skeggs }
42c39f472eSBen Skeggs
43c39f472eSBen Skeggs void
nvkm_devinit_meminit(struct nvkm_devinit * init)44151abd44SBen Skeggs nvkm_devinit_meminit(struct nvkm_devinit *init)
45c39f472eSBen Skeggs {
46151abd44SBen Skeggs if (init->func->meminit)
47151abd44SBen Skeggs init->func->meminit(init);
48c39f472eSBen Skeggs }
49c39f472eSBen Skeggs
50151abd44SBen Skeggs u64
nvkm_devinit_disable(struct nvkm_devinit * init)51151abd44SBen Skeggs nvkm_devinit_disable(struct nvkm_devinit *init)
52c39f472eSBen Skeggs {
538de65bd0SBen Skeggs if (init && init->func->disable)
54*da2b1a0aSDeepak R Varma init->func->disable(init);
55*da2b1a0aSDeepak R Varma
56151abd44SBen Skeggs return 0;
57151abd44SBen Skeggs }
58151abd44SBen Skeggs
598de65bd0SBen Skeggs int
nvkm_devinit_post(struct nvkm_devinit * init)600fa5680cSBen Skeggs nvkm_devinit_post(struct nvkm_devinit *init)
618de65bd0SBen Skeggs {
628de65bd0SBen Skeggs int ret = 0;
638de65bd0SBen Skeggs if (init && init->func->post)
648de65bd0SBen Skeggs ret = init->func->post(init, init->post);
650fa5680cSBen Skeggs nvkm_devinit_disable(init);
668de65bd0SBen Skeggs return ret;
678de65bd0SBen Skeggs }
688de65bd0SBen Skeggs
69151abd44SBen Skeggs static int
nvkm_devinit_fini(struct nvkm_subdev * subdev,bool suspend)70151abd44SBen Skeggs nvkm_devinit_fini(struct nvkm_subdev *subdev, bool suspend)
71151abd44SBen Skeggs {
72151abd44SBen Skeggs struct nvkm_devinit *init = nvkm_devinit(subdev);
73151abd44SBen Skeggs /* force full reinit on resume */
74151abd44SBen Skeggs if (suspend)
75151abd44SBen Skeggs init->post = true;
76151abd44SBen Skeggs return 0;
77151abd44SBen Skeggs }
78151abd44SBen Skeggs
79151abd44SBen Skeggs static int
nvkm_devinit_preinit(struct nvkm_subdev * subdev)80151abd44SBen Skeggs nvkm_devinit_preinit(struct nvkm_subdev *subdev)
81151abd44SBen Skeggs {
82151abd44SBen Skeggs struct nvkm_devinit *init = nvkm_devinit(subdev);
83151abd44SBen Skeggs
84151abd44SBen Skeggs if (init->func->preinit)
85151abd44SBen Skeggs init->func->preinit(init);
86151abd44SBen Skeggs
87c6007dc4SAlexandre Courbot /* Override the post flag during the first call if NvForcePost is set */
88c6007dc4SAlexandre Courbot if (init->force_post) {
89c6007dc4SAlexandre Courbot init->post = init->force_post;
90c6007dc4SAlexandre Courbot init->force_post = false;
91c6007dc4SAlexandre Courbot }
92c6007dc4SAlexandre Courbot
93151abd44SBen Skeggs /* unlock the extended vga crtc regs */
94151abd44SBen Skeggs nvkm_lockvgac(subdev->device, false);
95151abd44SBen Skeggs return 0;
96151abd44SBen Skeggs }
97151abd44SBen Skeggs
98151abd44SBen Skeggs static int
nvkm_devinit_init(struct nvkm_subdev * subdev)99151abd44SBen Skeggs nvkm_devinit_init(struct nvkm_subdev *subdev)
100151abd44SBen Skeggs {
101151abd44SBen Skeggs struct nvkm_devinit *init = nvkm_devinit(subdev);
102151abd44SBen Skeggs if (init->func->init)
103151abd44SBen Skeggs init->func->init(init);
104c39f472eSBen Skeggs return 0;
105c39f472eSBen Skeggs }
106151abd44SBen Skeggs
107151abd44SBen Skeggs static void *
nvkm_devinit_dtor(struct nvkm_subdev * subdev)108151abd44SBen Skeggs nvkm_devinit_dtor(struct nvkm_subdev *subdev)
109151abd44SBen Skeggs {
110151abd44SBen Skeggs struct nvkm_devinit *init = nvkm_devinit(subdev);
111151abd44SBen Skeggs void *data = init;
112151abd44SBen Skeggs
113151abd44SBen Skeggs if (init->func->dtor)
114151abd44SBen Skeggs data = init->func->dtor(init);
115151abd44SBen Skeggs
116151abd44SBen Skeggs /* lock crtc regs */
117151abd44SBen Skeggs nvkm_lockvgac(subdev->device, true);
118151abd44SBen Skeggs return data;
119151abd44SBen Skeggs }
120151abd44SBen Skeggs
121151abd44SBen Skeggs static const struct nvkm_subdev_func
122151abd44SBen Skeggs nvkm_devinit = {
123151abd44SBen Skeggs .dtor = nvkm_devinit_dtor,
124151abd44SBen Skeggs .preinit = nvkm_devinit_preinit,
125151abd44SBen Skeggs .init = nvkm_devinit_init,
126151abd44SBen Skeggs .fini = nvkm_devinit_fini,
127151abd44SBen Skeggs };
128151abd44SBen Skeggs
129151abd44SBen Skeggs void
nvkm_devinit_ctor(const struct nvkm_devinit_func * func,struct nvkm_device * device,enum nvkm_subdev_type type,int inst,struct nvkm_devinit * init)1304a34fd0eSBen Skeggs nvkm_devinit_ctor(const struct nvkm_devinit_func *func, struct nvkm_device *device,
1314a34fd0eSBen Skeggs enum nvkm_subdev_type type, int inst, struct nvkm_devinit *init)
132151abd44SBen Skeggs {
1334a34fd0eSBen Skeggs nvkm_subdev_ctor(&nvkm_devinit, device, type, inst, &init->subdev);
134151abd44SBen Skeggs init->func = func;
135c6007dc4SAlexandre Courbot init->force_post = nvkm_boolopt(device->cfgopt, "NvForcePost", false);
136151abd44SBen Skeggs }
137