1 | /* $NetBSD: nouveau_subdev_bios_cstep.c,v 1.1.1.1 2014/08/06 12:36:28 riastradh Exp $ */ |
2 | |
3 | /* |
4 | * Copyright 2013 Red Hat Inc. |
5 | * |
6 | * Permission is hereby granted, free of charge, to any person obtaining a |
7 | * copy of this software and associated documentation files (the "Software"), |
8 | * to deal in the Software without restriction, including without limitation |
9 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
10 | * and/or sell copies of the Software, and to permit persons to whom the |
11 | * Software is furnished to do so, subject to the following conditions: |
12 | * |
13 | * The above copyright notice and this permission notice shall be included in |
14 | * all copies or substantial portions of the Software. |
15 | * |
16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
19 | * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR |
20 | * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
21 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
22 | * OTHER DEALINGS IN THE SOFTWARE. |
23 | * |
24 | * Authors: Ben Skeggs |
25 | */ |
26 | |
27 | #include <sys/cdefs.h> |
28 | __KERNEL_RCSID(0, "$NetBSD: nouveau_subdev_bios_cstep.c,v 1.1.1.1 2014/08/06 12:36:28 riastradh Exp $" ); |
29 | |
30 | #include <subdev/bios.h> |
31 | #include <subdev/bios/bit.h> |
32 | #include <subdev/bios/cstep.h> |
33 | |
34 | u16 |
35 | nvbios_cstepTe(struct nouveau_bios *bios, |
36 | u8 *ver, u8 *hdr, u8 *cnt, u8 *len, u8 *xnr, u8 *xsz) |
37 | { |
38 | struct bit_entry bit_P; |
39 | u16 cstep = 0x0000; |
40 | |
41 | if (!bit_entry(bios, 'P', &bit_P)) { |
42 | if (bit_P.version == 2) |
43 | cstep = nv_ro16(bios, bit_P.offset + 0x34); |
44 | |
45 | if (cstep) { |
46 | *ver = nv_ro08(bios, cstep + 0); |
47 | switch (*ver) { |
48 | case 0x10: |
49 | *hdr = nv_ro08(bios, cstep + 1); |
50 | *cnt = nv_ro08(bios, cstep + 3); |
51 | *len = nv_ro08(bios, cstep + 2); |
52 | *xnr = nv_ro08(bios, cstep + 5); |
53 | *xsz = nv_ro08(bios, cstep + 4); |
54 | return cstep; |
55 | default: |
56 | break; |
57 | } |
58 | } |
59 | } |
60 | |
61 | return 0x0000; |
62 | } |
63 | |
64 | u16 |
65 | nvbios_cstepEe(struct nouveau_bios *bios, int idx, u8 *ver, u8 *hdr) |
66 | { |
67 | u8 cnt, len, xnr, xsz; |
68 | u16 data = nvbios_cstepTe(bios, ver, hdr, &cnt, &len, &xnr, &xsz); |
69 | if (data && idx < cnt) { |
70 | data = data + *hdr + (idx * len); |
71 | *hdr = len; |
72 | return data; |
73 | } |
74 | return 0x0000; |
75 | } |
76 | |
77 | u16 |
78 | nvbios_cstepEp(struct nouveau_bios *bios, int idx, u8 *ver, u8 *hdr, |
79 | struct nvbios_cstepE *info) |
80 | { |
81 | u16 data = nvbios_cstepEe(bios, idx, ver, hdr); |
82 | memset(info, 0x00, sizeof(*info)); |
83 | if (data) { |
84 | info->pstate = (nv_ro16(bios, data + 0x00) & 0x01e0) >> 5; |
85 | info->index = nv_ro08(bios, data + 0x03); |
86 | } |
87 | return data; |
88 | } |
89 | |
90 | u16 |
91 | nvbios_cstepEm(struct nouveau_bios *bios, u8 pstate, u8 *ver, u8 *hdr, |
92 | struct nvbios_cstepE *info) |
93 | { |
94 | u32 data, idx = 0; |
95 | while ((data = nvbios_cstepEp(bios, idx++, ver, hdr, info))) { |
96 | if (info->pstate == pstate) |
97 | break; |
98 | } |
99 | return data; |
100 | } |
101 | |
102 | u16 |
103 | nvbios_cstepXe(struct nouveau_bios *bios, int idx, u8 *ver, u8 *hdr) |
104 | { |
105 | u8 cnt, len, xnr, xsz; |
106 | u16 data = nvbios_cstepTe(bios, ver, hdr, &cnt, &len, &xnr, &xsz); |
107 | if (data && idx < xnr) { |
108 | data = data + *hdr + (cnt * len) + (idx * xsz); |
109 | *hdr = xsz; |
110 | return data; |
111 | } |
112 | return 0x0000; |
113 | } |
114 | |
115 | u16 |
116 | nvbios_cstepXp(struct nouveau_bios *bios, int idx, u8 *ver, u8 *hdr, |
117 | struct nvbios_cstepX *info) |
118 | { |
119 | u16 data = nvbios_cstepXe(bios, idx, ver, hdr); |
120 | memset(info, 0x00, sizeof(*info)); |
121 | if (data) { |
122 | info->freq = nv_ro16(bios, data + 0x00) * 1000; |
123 | info->unkn[0] = nv_ro08(bios, data + 0x02); |
124 | info->unkn[1] = nv_ro08(bios, data + 0x03); |
125 | info->voltage = nv_ro08(bios, data + 0x04); |
126 | } |
127 | return data; |
128 | } |
129 | |