Commit | Line | Data |
---|---|---|
112a12aa BS |
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 | */ | |
112a12aa BS |
24 | #include <subdev/bios.h> |
25 | #include <subdev/bios/gpio.h> | |
26 | #include <subdev/bios/xpio.h> | |
27 | ||
28 | static u16 | |
d390b480 | 29 | dcb_xpiod_table(struct nvkm_bios *bios, u8 *ver, u8 *hdr, u8 *cnt, u8 *len) |
112a12aa BS |
30 | { |
31 | u16 data = dcb_gpio_table(bios, ver, hdr, cnt, len); | |
32 | if (data && *ver >= 0x40 && *hdr >= 0x06) { | |
7f5f518f | 33 | u16 xpio = nvbios_rd16(bios, data + 0x04); |
112a12aa | 34 | if (xpio) { |
7f5f518f BS |
35 | *ver = nvbios_rd08(bios, data + 0x00); |
36 | *hdr = nvbios_rd08(bios, data + 0x01); | |
37 | *cnt = nvbios_rd08(bios, data + 0x02); | |
38 | *len = nvbios_rd08(bios, data + 0x03); | |
112a12aa BS |
39 | return xpio; |
40 | } | |
41 | } | |
42 | return 0x0000; | |
43 | } | |
44 | ||
45 | u16 | |
d390b480 | 46 | dcb_xpio_table(struct nvkm_bios *bios, u8 idx, |
112a12aa BS |
47 | u8 *ver, u8 *hdr, u8 *cnt, u8 *len) |
48 | { | |
49 | u16 data = dcb_xpiod_table(bios, ver, hdr, cnt, len); | |
50 | if (data && idx < *cnt) { | |
7f5f518f | 51 | u16 xpio = nvbios_rd16(bios, data + *hdr + (idx * *len)); |
112a12aa | 52 | if (xpio) { |
7f5f518f BS |
53 | *ver = nvbios_rd08(bios, data + 0x00); |
54 | *hdr = nvbios_rd08(bios, data + 0x01); | |
55 | *cnt = nvbios_rd08(bios, data + 0x02); | |
56 | *len = nvbios_rd08(bios, data + 0x03); | |
112a12aa BS |
57 | return xpio; |
58 | } | |
59 | } | |
60 | return 0x0000; | |
61 | } | |
62 | ||
63 | u16 | |
d390b480 BS |
64 | dcb_xpio_parse(struct nvkm_bios *bios, u8 idx, |
65 | u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_xpio *info) | |
112a12aa BS |
66 | { |
67 | u16 data = dcb_xpio_table(bios, idx, ver, hdr, cnt, len); | |
68 | if (data && *len >= 6) { | |
7f5f518f BS |
69 | info->type = nvbios_rd08(bios, data + 0x04); |
70 | info->addr = nvbios_rd08(bios, data + 0x05); | |
71 | info->flags = nvbios_rd08(bios, data + 0x06); | |
112a12aa BS |
72 | } |
73 | return 0x0000; | |
74 | } |