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