1a8c4362bSBen Skeggs /*
2a8c4362bSBen Skeggs * Copyright 2013 Red Hat Inc.
3a8c4362bSBen Skeggs *
4a8c4362bSBen Skeggs * Permission is hereby granted, free of charge, to any person obtaining a
5a8c4362bSBen Skeggs * copy of this software and associated documentation files (the "Software"),
6a8c4362bSBen Skeggs * to deal in the Software without restriction, including without limitation
7a8c4362bSBen Skeggs * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8a8c4362bSBen Skeggs * and/or sell copies of the Software, and to permit persons to whom the
9a8c4362bSBen Skeggs * Software is furnished to do so, subject to the following conditions:
10a8c4362bSBen Skeggs *
11a8c4362bSBen Skeggs * The above copyright notice and this permission notice shall be included in
12a8c4362bSBen Skeggs * all copies or substantial portions of the Software.
13a8c4362bSBen Skeggs *
14a8c4362bSBen Skeggs * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15a8c4362bSBen Skeggs * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16a8c4362bSBen Skeggs * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17a8c4362bSBen Skeggs * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18a8c4362bSBen Skeggs * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19a8c4362bSBen Skeggs * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20a8c4362bSBen Skeggs * OTHER DEALINGS IN THE SOFTWARE.
21a8c4362bSBen Skeggs *
22a8c4362bSBen Skeggs * Authors: Ben Skeggs
23a8c4362bSBen Skeggs */
24a8c4362bSBen Skeggs #include "nv50.h"
25a8c4362bSBen Skeggs
26a8c4362bSBen Skeggs #include <subdev/bios.h>
27a8c4362bSBen Skeggs #include <subdev/bios/init.h>
28a8c4362bSBen Skeggs #include <subdev/bios/pll.h>
29a8c4362bSBen Skeggs #include <subdev/clk/pll.h>
30a8c4362bSBen Skeggs
31a8c4362bSBen Skeggs int
gf100_devinit_pll_set(struct nvkm_devinit * init,u32 type,u32 freq)328ac3f64fSBen Skeggs gf100_devinit_pll_set(struct nvkm_devinit *init, u32 type, u32 freq)
33a8c4362bSBen Skeggs {
348ac3f64fSBen Skeggs struct nvkm_subdev *subdev = &init->subdev;
358ac3f64fSBen Skeggs struct nvkm_device *device = subdev->device;
36a8c4362bSBen Skeggs struct nvbios_pll info;
37a8c4362bSBen Skeggs int N, fN, M, P;
38a8c4362bSBen Skeggs int ret;
39a8c4362bSBen Skeggs
408ac3f64fSBen Skeggs ret = nvbios_pll_parse(device->bios, type, &info);
41a8c4362bSBen Skeggs if (ret)
42a8c4362bSBen Skeggs return ret;
43a8c4362bSBen Skeggs
448ac3f64fSBen Skeggs ret = gt215_pll_calc(subdev, &info, freq, &N, &fN, &M, &P);
45a8c4362bSBen Skeggs if (ret < 0)
46a8c4362bSBen Skeggs return ret;
47a8c4362bSBen Skeggs
48a8c4362bSBen Skeggs switch (info.type) {
49a8c4362bSBen Skeggs case PLL_VPLL0:
50a8c4362bSBen Skeggs case PLL_VPLL1:
51a8c4362bSBen Skeggs case PLL_VPLL2:
52a8c4362bSBen Skeggs case PLL_VPLL3:
538ac3f64fSBen Skeggs nvkm_mask(device, info.reg + 0x0c, 0x00000000, 0x00000100);
548ac3f64fSBen Skeggs nvkm_wr32(device, info.reg + 0x04, (P << 16) | (N << 8) | M);
558ac3f64fSBen Skeggs nvkm_wr32(device, info.reg + 0x10, fN << 16);
56a8c4362bSBen Skeggs break;
57a8c4362bSBen Skeggs default:
58aa860e4bSBen Skeggs nvkm_warn(subdev, "%08x/%dKhz unimplemented\n", type, freq);
59a8c4362bSBen Skeggs ret = -EINVAL;
60a8c4362bSBen Skeggs break;
61a8c4362bSBen Skeggs }
62a8c4362bSBen Skeggs
63a8c4362bSBen Skeggs return ret;
64a8c4362bSBen Skeggs }
65a8c4362bSBen Skeggs
66*da2b1a0aSDeepak R Varma static void
gf100_devinit_disable(struct nvkm_devinit * init)678ac3f64fSBen Skeggs gf100_devinit_disable(struct nvkm_devinit *init)
68a8c4362bSBen Skeggs {
698ac3f64fSBen Skeggs struct nvkm_device *device = init->subdev.device;
708ac3f64fSBen Skeggs u32 r022500 = nvkm_rd32(device, 0x022500);
71a8c4362bSBen Skeggs
72a8c4362bSBen Skeggs if (r022500 & 0x00000001)
73a7f000ecSBen Skeggs nvkm_subdev_disable(device, NVKM_ENGINE_DISP, 0);
74a8c4362bSBen Skeggs
75a8c4362bSBen Skeggs if (r022500 & 0x00000002) {
7696321606SBen Skeggs nvkm_subdev_disable(device, NVKM_ENGINE_MSPDEC, 0);
7707a356bbSBen Skeggs nvkm_subdev_disable(device, NVKM_ENGINE_MSPPP, 0);
78a8c4362bSBen Skeggs }
79a8c4362bSBen Skeggs
80a8c4362bSBen Skeggs if (r022500 & 0x00000004)
81b15147bdSBen Skeggs nvkm_subdev_disable(device, NVKM_ENGINE_MSVLD, 0);
82a8c4362bSBen Skeggs if (r022500 & 0x00000008)
83e9e9a219SBen Skeggs nvkm_subdev_disable(device, NVKM_ENGINE_MSENC, 0);
84a8c4362bSBen Skeggs if (r022500 & 0x00000100)
8550551b15SBen Skeggs nvkm_subdev_disable(device, NVKM_ENGINE_CE, 0);
86a8c4362bSBen Skeggs if (r022500 & 0x00000200)
8750551b15SBen Skeggs nvkm_subdev_disable(device, NVKM_ENGINE_CE, 1);
88a8c4362bSBen Skeggs }
89a8c4362bSBen Skeggs
90a6a0f67cSAlexandre Courbot void
gf100_devinit_preinit(struct nvkm_devinit * base)91a6a0f67cSAlexandre Courbot gf100_devinit_preinit(struct nvkm_devinit *base)
92a6a0f67cSAlexandre Courbot {
93a6a0f67cSAlexandre Courbot struct nv50_devinit *init = nv50_devinit(base);
94a6a0f67cSAlexandre Courbot struct nvkm_subdev *subdev = &init->base.subdev;
95a6a0f67cSAlexandre Courbot struct nvkm_device *device = subdev->device;
96a6a0f67cSAlexandre Courbot
97c6007dc4SAlexandre Courbot /*
98c6007dc4SAlexandre Courbot * This bit is set by devinit, and flips back to 0 on suspend. We
99c6007dc4SAlexandre Courbot * can use it as a reliable way to know whether we should run devinit.
100c6007dc4SAlexandre Courbot */
101a6a0f67cSAlexandre Courbot base->post = ((nvkm_rd32(device, 0x2240c) & BIT(1)) == 0);
102a6a0f67cSAlexandre Courbot }
103a6a0f67cSAlexandre Courbot
104151abd44SBen Skeggs static const struct nvkm_devinit_func
105151abd44SBen Skeggs gf100_devinit = {
106a6a0f67cSAlexandre Courbot .preinit = gf100_devinit_preinit,
107a8c4362bSBen Skeggs .init = nv50_devinit_init,
108151abd44SBen Skeggs .post = nv04_devinit_post,
109a8c4362bSBen Skeggs .pll_set = gf100_devinit_pll_set,
110a8c4362bSBen Skeggs .disable = gf100_devinit_disable,
111151abd44SBen Skeggs };
112151abd44SBen Skeggs
113151abd44SBen Skeggs int
gf100_devinit_new(struct nvkm_device * device,enum nvkm_subdev_type type,int inst,struct nvkm_devinit ** pinit)1144a34fd0eSBen Skeggs gf100_devinit_new(struct nvkm_device *device, enum nvkm_subdev_type type, int inst,
115151abd44SBen Skeggs struct nvkm_devinit **pinit)
116151abd44SBen Skeggs {
1174a34fd0eSBen Skeggs return nv50_devinit_new_(&gf100_devinit, device, type, inst, pinit);
118151abd44SBen Skeggs }
119