137 lines · c
1/*2 * Copyright 2012 Red Hat Inc.3 *4 * Permission is hereby granted, free of charge, to any person obtaining a5 * copy of this software and associated documentation files (the "Software"),6 * to deal in the Software without restriction, including without limitation7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,8 * and/or sell copies of the Software, and to permit persons to whom the9 * Software is furnished to do so, subject to the following conditions:10 *11 * The above copyright notice and this permission notice shall be included in12 * all copies or substantial portions of the Software.13 *14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR18 * 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 OR20 * OTHER DEALINGS IN THE SOFTWARE.21 *22 * Authors: Ben Skeggs23 */24#include "priv.h"25 26#include <core/option.h>27#include <subdev/vga.h>28 29u3230nvkm_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 37int38nvkm_devinit_pll_set(struct nvkm_devinit *init, u32 type, u32 khz)39{40 return init->func->pll_set(init, type, khz);41}42 43void44nvkm_devinit_meminit(struct nvkm_devinit *init)45{46 if (init->func->meminit)47 init->func->meminit(init);48}49 50u6451nvkm_devinit_disable(struct nvkm_devinit *init)52{53 if (init && init->func->disable)54 init->func->disable(init);55 56 return 0;57}58 59int60nvkm_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 int70nvkm_devinit_fini(struct nvkm_subdev *subdev, bool suspend)71{72 struct nvkm_devinit *init = nvkm_devinit(subdev);73 /* force full reinit on resume */74 if (suspend)75 init->post = true;76 return 0;77}78 79static int80nvkm_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 int99nvkm_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_func122nvkm_devinit = {123 .dtor = nvkm_devinit_dtor,124 .preinit = nvkm_devinit_preinit,125 .init = nvkm_devinit_init,126 .fini = nvkm_devinit_fini,127};128 129void130nvkm_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}137