base.c

  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		init->func->disable(init);
 55
 56	return 0;
 57}
 58
 59int
 60nvkm_devinit_post(struct nvkm_devinit *init)
 61{
 62	int ret = 0;
 63	if (init && init->func->post)
 64		ret = init->func->post(init, init->post);
 65	nvkm_devinit_disable(init);
 66	return ret;
 67}
 68
 69static int
 70nvkm_devinit_fini(struct nvkm_subdev *subdev, enum nvkm_suspend_state suspend)
 71{
 72	struct nvkm_devinit *init = nvkm_devinit(subdev);
 73	/* force full reinit on resume */
 74	if (suspend != NVKM_POWEROFF)
 75		init->post = true;
 76	return 0;
 77}
 78
 79static int
 80nvkm_devinit_preinit(struct nvkm_subdev *subdev)
 81{
 82	struct nvkm_devinit *init = nvkm_devinit(subdev);
 83
 84	if (init->func->preinit)
 85		init->func->preinit(init);
 86
 87	/* Override the post flag during the first call if NvForcePost is set */
 88	if (init->force_post) {
 89		init->post = init->force_post;
 90		init->force_post = false;
 91	}
 92
 93	/* unlock the extended vga crtc regs */
 94	nvkm_lockvgac(subdev->device, false);
 95	return 0;
 96}
 97
 98static int
 99nvkm_devinit_init(struct nvkm_subdev *subdev)
100{
101	struct nvkm_devinit *init = nvkm_devinit(subdev);
102	if (init->func->init)
103		init->func->init(init);
104	return 0;
105}
106
107static void *
108nvkm_devinit_dtor(struct nvkm_subdev *subdev)
109{
110	struct nvkm_devinit *init = nvkm_devinit(subdev);
111	void *data = init;
112
113	if (init->func->dtor)
114		data = init->func->dtor(init);
115
116	/* lock crtc regs */
117	nvkm_lockvgac(subdev->device, true);
118	return data;
119}
120
121static const struct nvkm_subdev_func
122nvkm_devinit = {
123	.dtor = nvkm_devinit_dtor,
124	.preinit = nvkm_devinit_preinit,
125	.init = nvkm_devinit_init,
126	.fini = nvkm_devinit_fini,
127};
128
129void
130nvkm_devinit_ctor(const struct nvkm_devinit_func *func, struct nvkm_device *device,
131		  enum nvkm_subdev_type type, int inst, struct nvkm_devinit *init)
132{
133	nvkm_subdev_ctor(&nvkm_devinit, device, type, inst, &init->subdev);
134	init->func = func;
135	init->force_post = nvkm_boolopt(device->cfgopt, "NvForcePost", false);
136}