2 * This file is part of the coreinfo project.
4 * Copyright (C) 2008 Advanced Micro Devices, Inc.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; version 2 of the License.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
18 #include <libpayload.h>
21 #if CONFIG(MODULE_PCI)
28 #define MAX_PCI_DEVICES 64
29 static struct pci_devices devices
[MAX_PCI_DEVICES
];
30 static int devices_index
;
32 /* Number of entries to show in the list */
33 #define MENU_VISIBLE 16
35 static int menu_selected
= 0;
36 static int menu_first
= 0;
38 static void swap(struct pci_devices
*a
, struct pci_devices
*b
)
40 struct pci_devices tmp
;
42 tmp
.device
= a
->device
;
45 a
->device
= b
->device
;
48 b
->device
= tmp
.device
;
52 static int partition(struct pci_devices
*list
, int len
)
54 pcidev_t val
= list
[len
/ 2].device
;
58 swap(&list
[len
/ 2], &list
[len
- 1]);
60 for (i
= 0; i
< len
- 1; i
++) {
61 if (list
[i
].device
< val
) {
62 swap(&list
[i
], &list
[index
]);
67 swap(&list
[index
], &list
[len
- 1]);
72 static void quicksort(struct pci_devices
*list
, int len
)
79 index
= partition(list
, len
);
81 quicksort(list
, index
);
82 quicksort(&(list
[index
]), len
- index
);
85 static void show_config_space(WINDOW
*win
, int row
, int col
, int index
)
87 unsigned char cspace
[256];
91 dev
= devices
[index
].device
;
93 for (i
= 0; i
< 256; i
++)
94 cspace
[i
] = pci_read_config8(dev
, i
);
96 for (y
= 0; y
< 16; y
++) {
97 for (x
= 0; x
< 16; x
++)
98 mvwprintw(win
, row
+ y
, col
+ (x
* 3), "%2.2X ",
99 cspace
[(y
* 16) + x
]);
103 static int pci_module_redraw(WINDOW
*win
)
105 unsigned int bus
, slot
, func
;
108 print_module_title(win
, "PCI Device List");
110 for (i
= 0; i
< MENU_VISIBLE
; i
++) {
111 int item
= menu_first
+ i
;
113 /* Draw a blank space. */
114 if (item
>= devices_index
) {
115 wattrset(win
, COLOR_PAIR(2));
116 mvwprintw(win
, 2 + i
, 1, " ");
120 bus
= PCI_BUS(devices
[item
].device
);
121 slot
= PCI_SLOT(devices
[item
].device
);
122 func
= PCI_FUNC(devices
[item
].device
);
124 if (item
== menu_selected
)
125 wattrset(win
, COLOR_PAIR(3) | A_BOLD
);
127 wattrset(win
, COLOR_PAIR(2));
129 mvwprintw(win
, 2 + i
, 1, "%X:%2.2X.%2.2X %04X:%04X ",
131 devices
[item
].id
& 0xffff,
132 (devices
[item
].id
>> 16) & 0xffff);
134 wattrset(win
, COLOR_PAIR(2));
138 mvwaddch(win
, 2 + i
, 19, ACS_UARROW
);
140 if (i
== MENU_VISIBLE
- 1) {
141 if ((item
+ 1) < devices_index
)
142 mvwaddch(win
, 2 + i
, 19, ACS_DARROW
);
146 wattrset(win
, COLOR_PAIR(2));
148 for (i
= 0; i
< 16; i
++)
149 mvwprintw(win
, 2, 26 + (i
* 3), "%2.2X ", i
);
153 for (i
= 0; i
< 48; i
++)
154 waddch(win
, (i
== 0) ? ACS_ULCORNER
: ACS_HLINE
);
156 for (i
= 0; i
< 16; i
++) {
157 mvwprintw(win
, 4 + i
, 23, "%2.2X", i
* 16);
158 wmove(win
, 4 + i
, 25);
159 waddch(win
, ACS_VLINE
);
162 show_config_space(win
, 4, 26, menu_selected
);
167 static void pci_scan_bus(int bus
)
173 for (slot
= 0; slot
< 0x20; slot
++) {
174 for (func
= 0; func
< 8; func
++) {
175 pcidev_t dev
= PCI_DEV(bus
, slot
, func
);
177 val
= pci_read_config32(dev
, REG_VENDOR_ID
);
180 if (val
== 0xffffffff || val
== 0x00000000 ||
181 val
== 0x0000ffff || val
== 0xffff0000) {
183 /* If function 0 is not present, no need
184 * to test other functions. */
190 /* FIXME: Remove this arbitrary limitation. */
191 if (devices_index
>= MAX_PCI_DEVICES
)
194 devices
[devices_index
].device
=
195 PCI_DEV(bus
, slot
, func
);
197 devices
[devices_index
++].id
= val
;
199 /* If this is a bridge, then follow it. */
200 hdr
= pci_read_config8(dev
, REG_HEADER_TYPE
);
202 if ((func
== 0) && !(hdr
& HEADER_TYPE_MULTIFUNCTION
))
205 hdr
&= ~HEADER_TYPE_MULTIFUNCTION
;
206 if (hdr
== HEADER_TYPE_BRIDGE
||
207 hdr
== HEADER_TYPE_CARDBUS
) {
210 busses
= pci_read_config32(dev
, REG_PRIMARY_BUS
);
212 pci_scan_bus((busses
>> 8) & 0xff);
218 quicksort(devices
, devices_index
);
221 static int pci_module_handle(int key
)
227 if (menu_selected
+ 1 < devices_index
) {
233 if (menu_selected
> 0) {
243 if (menu_selected
< menu_first
)
244 menu_first
= menu_selected
;
245 else if (menu_selected
>= menu_first
+ MENU_VISIBLE
) {
246 menu_first
= menu_selected
- (MENU_VISIBLE
- 1);
254 static int pci_module_init(void)
260 struct coreinfo_module pci_module
= {
262 .init
= pci_module_init
,
263 .redraw
= pci_module_redraw
,
264 .handle
= pci_module_handle
,
269 struct coreinfo_module pci_module
= {