192 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 "mxms.h"25 26#define ROM16(x) get_unaligned_le16(&(x))27#define ROM32(x) get_unaligned_le32(&(x))28 29static u8 *30mxms_data(struct nvkm_mxm *mxm)31{32 return mxm->mxms;33 34}35 36u1637mxms_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 54u1655mxms_headerlen(struct nvkm_mxm *mxm)56{57 return 8;58}59 60u1661mxms_structlen(struct nvkm_mxm *mxm)62{63 return *(u16 *)&mxms_data(mxm)[6];64}65 66bool67mxms_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 80bool81mxms_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 95bool96mxms_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 else114 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 180void181mxms_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