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 <subdev/bios.h> 25 #include <subdev/bios/bit.h> 26 #include <subdev/bios/disp.h> 27 28 u16 29 nvbios_disp_table(struct nvkm_bios *bios, 30 u8 *ver, u8 *hdr, u8 *cnt, u8 *len, u8 *sub) 31 { 32 struct bit_entry U; 33 34 if (!bit_entry(bios, 'U', &U)) { 35 if (U.version == 1) { 36 u16 data = nvbios_rd16(bios, U.offset); 37 if (data) { 38 *ver = nvbios_rd08(bios, data + 0x00); 39 switch (*ver) { 40 case 0x20: 41 case 0x21: 42 case 0x22: 43 *hdr = nvbios_rd08(bios, data + 0x01); 44 *len = nvbios_rd08(bios, data + 0x02); 45 *cnt = nvbios_rd08(bios, data + 0x03); 46 *sub = nvbios_rd08(bios, data + 0x04); 47 return data; 48 default: 49 break; 50 } 51 } 52 } 53 } 54 55 return 0x0000; 56 } 57 58 u16 59 nvbios_disp_entry(struct nvkm_bios *bios, u8 idx, u8 *ver, u8 *len, u8 *sub) 60 { 61 u8 hdr, cnt; 62 u16 data = nvbios_disp_table(bios, ver, &hdr, &cnt, len, sub); 63 if (data && idx < cnt) 64 return data + hdr + (idx * *len); 65 *ver = 0x00; 66 return 0x0000; 67 } 68 69 u16 70 nvbios_disp_parse(struct nvkm_bios *bios, u8 idx, u8 *ver, u8 *len, u8 *sub, 71 struct nvbios_disp *info) 72 { 73 u16 data = nvbios_disp_entry(bios, idx, ver, len, sub); 74 if (data && *len >= 2) { 75 info->data = nvbios_rd16(bios, data + 0); 76 return data; 77 } 78 return 0x0000; 79 } 80 81 u16 82 nvbios_outp_entry(struct nvkm_bios *bios, u8 idx, 83 u8 *ver, u8 *hdr, u8 *cnt, u8 *len) 84 { 85 struct nvbios_disp info; 86 u16 data = nvbios_disp_parse(bios, idx, ver, len, hdr, &info); 87 if (data) { 88 *cnt = nvbios_rd08(bios, info.data + 0x05); 89 *len = 0x06; 90 data = info.data; 91 } 92 return data; 93 } 94 95 u16 96 nvbios_outp_parse(struct nvkm_bios *bios, u8 idx, 97 u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_outp *info) 98 { 99 u16 data = nvbios_outp_entry(bios, idx, ver, hdr, cnt, len); 100 if (data && *hdr >= 0x0a) { 101 info->type = nvbios_rd16(bios, data + 0x00); 102 info->mask = nvbios_rd32(bios, data + 0x02); 103 if (*ver <= 0x20) /* match any link */ 104 info->mask |= 0x00c0; 105 info->script[0] = nvbios_rd16(bios, data + 0x06); 106 info->script[1] = nvbios_rd16(bios, data + 0x08); 107 info->script[2] = 0x0000; 108 if (*hdr >= 0x0c) 109 info->script[2] = nvbios_rd16(bios, data + 0x0a); 110 return data; 111 } 112 return 0x0000; 113 } 114 115 u16 116 nvbios_outp_match(struct nvkm_bios *bios, u16 type, u16 mask, 117 u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_outp *info) 118 { 119 u16 data, idx = 0; 120 while ((data = nvbios_outp_parse(bios, idx++, ver, hdr, cnt, len, info)) || *ver) { 121 if (data && info->type == type) { 122 if ((info->mask & mask) == mask) 123 break; 124 } 125 } 126 return data; 127 } 128 129 u16 130 nvbios_ocfg_entry(struct nvkm_bios *bios, u16 outp, u8 idx, 131 u8 *ver, u8 *hdr, u8 *cnt, u8 *len) 132 { 133 if (idx < *cnt) 134 return outp + *hdr + (idx * *len); 135 return 0x0000; 136 } 137 138 u16 139 nvbios_ocfg_parse(struct nvkm_bios *bios, u16 outp, u8 idx, 140 u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_ocfg *info) 141 { 142 u16 data = nvbios_ocfg_entry(bios, outp, idx, ver, hdr, cnt, len); 143 if (data) { 144 info->proto = nvbios_rd08(bios, data + 0x00); 145 info->flags = nvbios_rd16(bios, data + 0x01); 146 info->clkcmp[0] = nvbios_rd16(bios, data + 0x02); 147 info->clkcmp[1] = nvbios_rd16(bios, data + 0x04); 148 } 149 return data; 150 } 151 152 u16 153 nvbios_ocfg_match(struct nvkm_bios *bios, u16 outp, u8 proto, u8 flags, 154 u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_ocfg *info) 155 { 156 u16 data, idx = 0; 157 while ((data = nvbios_ocfg_parse(bios, outp, idx++, ver, hdr, cnt, len, info))) { 158 if ((info->proto == proto || info->proto == 0xff) && 159 (info->flags == flags)) 160 break; 161 } 162 return data; 163 } 164 165 u16 166 nvbios_oclk_match(struct nvkm_bios *bios, u16 cmp, u32 khz) 167 { 168 while (cmp) { 169 if (khz / 10 >= nvbios_rd16(bios, cmp + 0x00)) 170 return nvbios_rd16(bios, cmp + 0x02); 171 cmp += 0x04; 172 } 173 return 0x0000; 174 } 175