subdev/bios/M0209.c

0001 /*
0002  * Copyright 2013 Red Hat Inc.
0003  *
0004  * Permission is hereby granted, free of charge, to any person obtaining a
0005  * copy of this software and associated documentation files (the "Software"),
0006  * to deal in the Software without restriction, including without limitation
0007  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
0008  * and/or sell copies of the Software, and to permit persons to whom the
0009  * Software is furnished to do so, subject to the following conditions:
0010  *
0011  * The above copyright notice and this permission notice shall be included in
0012  * all copies or substantial portions of the Software.
0013  *
0014  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
0015  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
0016  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
0017  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
0018  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
0019  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
0020  * OTHER DEALINGS IN THE SOFTWARE.
0021  *
0022  * Authors: Ben Skeggs
0023  */
0024 #include <subdev/bios.h>
0025 #include <subdev/bios/bit.h>
0026 #include <subdev/bios/M0209.h>
0027
0028 u32
0029 nvbios_M0209Te(struct nvkm_bios *bios,
0030            u8 *ver, u8 *hdr, u8 *cnt, u8 *len, u8 *snr, u8 *ssz)
0031 {
0032     struct bit_entry bit_M;
0033     u32 data = 0x00000000;
0034
0035     if (!bit_entry(bios, 'M', &bit_M)) {
0036         if (bit_M.version == 2 && bit_M.length > 0x0c)
0037             data = nvbios_rd32(bios, bit_M.offset + 0x09);
0038         if (data) {
0039             *ver = nvbios_rd08(bios, data + 0x00);
0040             switch (*ver) {
0041             case 0x10:
0042                 *hdr = nvbios_rd08(bios, data + 0x01);
0043                 *len = nvbios_rd08(bios, data + 0x02);
0044                 *ssz = nvbios_rd08(bios, data + 0x03);
0045                 *snr = 1;
0046                 *cnt = nvbios_rd08(bios, data + 0x04);
0047                 return data;
0048             default:
0049                 break;
0050             }
0051         }
0052     }
0053
0054     return 0x00000000;
0055 }
0056
0057 u32
0058 nvbios_M0209Ee(struct nvkm_bios *bios, int idx,
0059            u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
0060 {
0061     u8  snr, ssz;
0062     u32 data = nvbios_M0209Te(bios, ver, hdr, cnt, len, &snr, &ssz);
0063     if (data && idx < *cnt) {
0064         data = data + *hdr + idx * (*len + (snr * ssz));
0065         *hdr = *len;
0066         *cnt = snr;
0067         *len = ssz;
0068         return data;
0069     }
0070     return 0x00000000;
0071 }
0072
0073 u32
0074 nvbios_M0209Ep(struct nvkm_bios *bios, int idx,
0075            u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_M0209E *info)
0076 {
0077     u32 data = nvbios_M0209Ee(bios, idx, ver, hdr, cnt, len);
0078     memset(info, 0x00, sizeof(*info));
0079     switch (!!data * *ver) {
0080     case 0x10:
0081         info->v00_40 = (nvbios_rd08(bios, data + 0x00) & 0x40) >> 6;
0082         info->bits   =  nvbios_rd08(bios, data + 0x00) & 0x3f;
0083         info->modulo =  nvbios_rd08(bios, data + 0x01);
0084         info->v02_40 = (nvbios_rd08(bios, data + 0x02) & 0x40) >> 6;
0085         info->v02_07 =  nvbios_rd08(bios, data + 0x02) & 0x07;
0086         info->v03    =  nvbios_rd08(bios, data + 0x03);
0087         return data;
0088     default:
0089         break;
0090     }
0091     return 0x00000000;
0092 }
0093
0094 u32
0095 nvbios_M0209Se(struct nvkm_bios *bios, int ent, int idx, u8 *ver, u8 *hdr)
0096 {
0097
0098     u8  cnt, len;
0099     u32 data = nvbios_M0209Ee(bios, ent, ver, hdr, &cnt, &len);
0100     if (data && idx < cnt) {
0101         data = data + *hdr + idx * len;
0102         *hdr = len;
0103         return data;
0104     }
0105     return 0x00000000;
0106 }
0107
0108 u32
0109 nvbios_M0209Sp(struct nvkm_bios *bios, int ent, int idx, u8 *ver, u8 *hdr,
0110            struct nvbios_M0209S *info)
0111 {
0112     struct nvbios_M0209E M0209E;
0113     u8  cnt, len;
0114     u32 data = nvbios_M0209Ep(bios, ent, ver, hdr, &cnt, &len, &M0209E);
0115     if (data) {
0116         u32 i, data = nvbios_M0209Se(bios, ent, idx, ver, hdr);
0117         memset(info, 0x00, sizeof(*info));
0118         switch (!!data * *ver) {
0119         case 0x10:
0120             for (i = 0; i < ARRAY_SIZE(info->data); i++) {
0121                 u32 bits = (i % M0209E.modulo) * M0209E.bits;
0122                 u32 mask = (1ULL << M0209E.bits) - 1;
0123                 u16  off = bits / 8;
0124                 u8   mod = bits % 8;
0125                 info->data[i] = nvbios_rd32(bios, data + off);
0126                 info->data[i] = info->data[i] >> mod;
0127                 info->data[i] = info->data[i] & mask;
0128             }
0129             return data;
0130         default:
0131             break;
0132         }
0133     }
0134     return 0x00000000;
0135 }