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
29u32
30nvkm_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
37int
38nvkm_devinit_pll_set(struct nvkm_devinit *init, u32 type, u32 khz)
39{
40	return init->func->pll_set(init, type, khz);
41}
42
43void
44nvkm_devinit_meminit(struct nvkm_devinit *init)
45{
46	if (init->func->meminit)
47		init->func->meminit(init);
48}
49
50u64
51nvkm_devinit_disable(struct nvkm_devinit *init)
52{
53	if (init && init->func->disable)
54		return init->func->disable(init);
55	return 0;
56}
57
58int
59nvkm_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
68static int
69nvkm_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
78static int
79nvkm_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	/* unlock the extended vga crtc regs */
87	nvkm_lockvgac(subdev->device, false);
88	return 0;
89}
90
91static int
92nvkm_devinit_init(struct nvkm_subdev *subdev)
93{
94	struct nvkm_devinit *init = nvkm_devinit(subdev);
95	if (init->func->init)
96		init->func->init(init);
97	return 0;
98}
99
100static void *
101nvkm_devinit_dtor(struct nvkm_subdev *subdev)
102{
103	struct nvkm_devinit *init = nvkm_devinit(subdev);
104	void *data = init;
105
106	if (init->func->dtor)
107		data = init->func->dtor(init);
108
109	/* lock crtc regs */
110	nvkm_lockvgac(subdev->device, true);
111	return data;
112}
113
114static const struct nvkm_subdev_func
115nvkm_devinit = {
116	.dtor = nvkm_devinit_dtor,
117	.preinit = nvkm_devinit_preinit,
118	.init = nvkm_devinit_init,
119	.fini = nvkm_devinit_fini,
120};
121
122void
123nvkm_devinit_ctor(const struct nvkm_devinit_func *func,
124		  struct nvkm_device *device, int index,
125		  struct nvkm_devinit *init)
126{
127	nvkm_subdev_ctor(&nvkm_devinit, device, index, 0, &init->subdev);
128	init->func = func;
129	init->post = nvkm_boolopt(device->cfgopt, "NvForcePost", false);
130}
131