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 "mxms.h"
25
26 #define ROM16(x) get_unaligned_le16(&(x))
27 #define ROM32(x) get_unaligned_le32(&(x))
28
29 static u8 *
mxms_data(struct nvkm_mxm * mxm)30 mxms_data(struct nvkm_mxm *mxm)
31 {
32 return mxm->mxms;
33
34 }
35
36 u16
mxms_version(struct nvkm_mxm * mxm)37 mxms_version(struct nvkm_mxm *mxm)
38 {
39 u8 *mxms = mxms_data(mxm);
40 u16 version = (mxms[4] << 8) | mxms[5];
41 switch (version ) {
42 case 0x0200:
43 case 0x0201:
44 case 0x0300:
45 return version;
46 default:
47 break;
48 }
49
50 nvkm_debug(&mxm->subdev, "unknown version %d.%d\n", mxms[4], mxms[5]);
51 return 0x0000;
52 }
53
54 u16
mxms_headerlen(struct nvkm_mxm * mxm)55 mxms_headerlen(struct nvkm_mxm *mxm)
56 {
57 return 8;
58 }
59
60 u16
mxms_structlen(struct nvkm_mxm * mxm)61 mxms_structlen(struct nvkm_mxm *mxm)
62 {
63 return *(u16 *)&mxms_data(mxm)[6];
64 }
65
66 bool
mxms_checksum(struct nvkm_mxm * mxm)67 mxms_checksum(struct nvkm_mxm *mxm)
68 {
69 u16 size = mxms_headerlen(mxm) + mxms_structlen(mxm);
70 u8 *mxms = mxms_data(mxm), sum = 0;
71 while (size--)
72 sum += *mxms++;
73 if (sum) {
74 nvkm_debug(&mxm->subdev, "checksum invalid\n");
75 return false;
76 }
77 return true;
78 }
79
80 bool
mxms_valid(struct nvkm_mxm * mxm)81 mxms_valid(struct nvkm_mxm *mxm)
82 {
83 u8 *mxms = mxms_data(mxm);
84 if (*(u32 *)mxms != 0x5f4d584d) {
85 nvkm_debug(&mxm->subdev, "signature invalid\n");
86 return false;
87 }
88
89 if (!mxms_version(mxm) || !mxms_checksum(mxm))
90 return false;
91
92 return true;
93 }
94
95 bool
mxms_foreach(struct nvkm_mxm * mxm,u8 types,bool (* exec)(struct nvkm_mxm *,u8 *,void *),void * info)96 mxms_foreach(struct nvkm_mxm *mxm, u8 types,
97 bool (*exec)(struct nvkm_mxm *, u8 *, void *), void *info)
98 {
99 struct nvkm_subdev *subdev = &mxm->subdev;
100 u8 *mxms = mxms_data(mxm);
101 u8 *desc = mxms + mxms_headerlen(mxm);
102 u8 *fini = desc + mxms_structlen(mxm) - 1;
103 while (desc < fini) {
104 u8 type = desc[0] & 0x0f;
105 u8 headerlen = 0;
106 u8 recordlen = 0;
107 u8 entries = 0;
108
109 switch (type) {
110 case 0: /* Output Device Structure */
111 if (mxms_version(mxm) >= 0x0300)
112 headerlen = 8;
113 else
114 headerlen = 6;
115 break;
116 case 1: /* System Cooling Capability Structure */
117 case 2: /* Thermal Structure */
118 case 3: /* Input Power Structure */
119 headerlen = 4;
120 break;
121 case 4: /* GPIO Device Structure */
122 headerlen = 4;
123 recordlen = 2;
124 entries = (ROM32(desc[0]) & 0x01f00000) >> 20;
125 break;
126 case 5: /* Vendor Specific Structure */
127 headerlen = 8;
128 break;
129 case 6: /* Backlight Control Structure */
130 if (mxms_version(mxm) >= 0x0300) {
131 headerlen = 4;
132 recordlen = 8;
133 entries = (desc[1] & 0xf0) >> 4;
134 } else {
135 headerlen = 8;
136 }
137 break;
138 case 7: /* Fan Control Structure */
139 headerlen = 8;
140 recordlen = 4;
141 entries = desc[1] & 0x07;
142 break;
143 default:
144 nvkm_debug(subdev, "unknown descriptor type %d\n", type);
145 return false;
146 }
147
148 if (mxm->subdev.debug >= NV_DBG_DEBUG && (exec == NULL)) {
149 static const char * mxms_desc[] = {
150 "ODS", "SCCS", "TS", "IPS",
151 "GSD", "VSS", "BCS", "FCS",
152 };
153 u8 *dump = desc;
154 char data[32], *ptr;
155 int i, j;
156
157 for (j = headerlen - 1, ptr = data; j >= 0; j--)
158 ptr += sprintf(ptr, "%02x", dump[j]);
159 dump += headerlen;
160
161 nvkm_debug(subdev, "%4s: %s\n", mxms_desc[type], data);
162 for (i = 0; i < entries; i++, dump += recordlen) {
163 for (j = recordlen - 1, ptr = data; j >= 0; j--)
164 ptr += sprintf(ptr, "%02x", dump[j]);
165 nvkm_debug(subdev, " %s\n", data);
166 }
167 }
168
169 if (types & (1 << type)) {
170 if (!exec(mxm, desc, info))
171 return false;
172 }
173
174 desc += headerlen + (entries * recordlen);
175 }
176
177 return true;
178 }
179
180 void
mxms_output_device(struct nvkm_mxm * mxm,u8 * pdata,struct mxms_odev * desc)181 mxms_output_device(struct nvkm_mxm *mxm, u8 *pdata, struct mxms_odev *desc)
182 {
183 u64 data = ROM32(pdata[0]);
184 if (mxms_version(mxm) >= 0x0300)
185 data |= (u64)ROM16(pdata[4]) << 32;
186
187 desc->outp_type = (data & 0x00000000000000f0ULL) >> 4;
188 desc->ddc_port = (data & 0x0000000000000f00ULL) >> 8;
189 desc->conn_type = (data & 0x000000000001f000ULL) >> 12;
190 desc->dig_conn = (data & 0x0000000000780000ULL) >> 19;
191 }
192