Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 1 | /* |
| 2 | * This file is part of the coreinfo project. |
| 3 | * |
| 4 | * Copyright (C) 2008 Advanced Micro Devices, Inc. |
| 5 | * |
| 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. |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 9 | * |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 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. |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 14 | */ |
| 15 | |
| 16 | #include <arch/io.h> |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 17 | #include <pci.h> |
Uwe Hermann | 754edf7 | 2008-08-04 21:02:07 +0000 | [diff] [blame] | 18 | #include <libpayload.h> |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 19 | #include "coreinfo.h" |
| 20 | |
Julius Werner | eab2a29 | 2019-03-05 16:55:15 -0800 | [diff] [blame] | 21 | #if CONFIG(MODULE_PCI) |
Uwe Hermann | ab5b3e0 | 2008-03-31 20:30:18 +0000 | [diff] [blame] | 22 | |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 23 | struct pci_devices { |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 24 | pcidev_t device; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 25 | unsigned int id; |
| 26 | }; |
| 27 | |
Stefan Reinauer | 10d0a81 | 2008-09-05 15:18:15 +0000 | [diff] [blame] | 28 | #define MAX_PCI_DEVICES 64 |
| 29 | static struct pci_devices devices[MAX_PCI_DEVICES]; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 30 | static int devices_index; |
| 31 | |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 32 | /* Number of entries to show in the list */ |
| 33 | #define MENU_VISIBLE 16 |
| 34 | |
| 35 | static int menu_selected = 0; |
| 36 | static int menu_first = 0; |
| 37 | |
| 38 | static void swap(struct pci_devices *a, struct pci_devices *b) |
| 39 | { |
| 40 | struct pci_devices tmp; |
| 41 | |
| 42 | tmp.device = a->device; |
| 43 | tmp.id = a->id; |
| 44 | |
| 45 | a->device = b->device; |
| 46 | a->id = b->id; |
| 47 | |
| 48 | b->device = tmp.device; |
| 49 | b->id = tmp.id; |
| 50 | } |
| 51 | |
| 52 | static int partition(struct pci_devices *list, int len) |
| 53 | { |
Jacob Garber | a711e9c | 2019-06-28 10:58:56 -0600 | [diff] [blame] | 54 | pcidev_t val = list[len / 2].device; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 55 | int index = 0; |
| 56 | int i; |
| 57 | |
| 58 | swap(&list[len / 2], &list[len - 1]); |
| 59 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 60 | for (i = 0; i < len - 1; i++) { |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 61 | if (list[i].device < val) { |
| 62 | swap(&list[i], &list[index]); |
| 63 | index++; |
| 64 | } |
| 65 | } |
| 66 | |
| 67 | swap(&list[index], &list[len - 1]); |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 68 | |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 69 | return index; |
| 70 | } |
| 71 | |
| 72 | static void quicksort(struct pci_devices *list, int len) |
| 73 | { |
| 74 | int index; |
| 75 | |
| 76 | if (len <= 1) |
| 77 | return; |
| 78 | |
| 79 | index = partition(list, len); |
| 80 | |
| 81 | quicksort(list, index); |
| 82 | quicksort(&(list[index]), len - index); |
| 83 | } |
| 84 | |
Uwe Hermann | 35845a2 | 2008-03-20 20:05:22 +0000 | [diff] [blame] | 85 | static void show_config_space(WINDOW *win, int row, int col, int index) |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 86 | { |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 87 | unsigned char cspace[256]; |
| 88 | pcidev_t dev; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 89 | int i, x, y; |
| 90 | |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 91 | dev = devices[index].device; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 92 | |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 93 | for (i = 0; i < 256; i ++) |
| 94 | cspace[i] = pci_read_config8(dev, i); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 95 | |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 96 | for (y = 0; y < 16; y++) { |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 97 | for (x = 0; x < 16; x++) |
| 98 | mvwprintw(win, row + y, col + (x * 3), "%2.2X ", |
| 99 | cspace[(y * 16) + x]); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 100 | } |
| 101 | } |
| 102 | |
Uwe Hermann | 0bfb5c4 | 2008-03-23 15:34:04 +0000 | [diff] [blame] | 103 | static int pci_module_redraw(WINDOW *win) |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 104 | { |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 105 | unsigned int bus, slot, func; |
Jacob Garber | dce10f8 | 2019-04-06 16:10:36 -0600 | [diff] [blame] | 106 | int i; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 107 | |
| 108 | print_module_title(win, "PCI Device List"); |
| 109 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 110 | for (i = 0; i < MENU_VISIBLE; i++) { |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 111 | int item = menu_first + i; |
| 112 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 113 | /* Draw a blank space. */ |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 114 | if (item >= devices_index) { |
| 115 | wattrset(win, COLOR_PAIR(2)); |
| 116 | mvwprintw(win, 2 + i, 1, " "); |
| 117 | continue; |
| 118 | } |
| 119 | |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 120 | bus = PCI_BUS(devices[item].device); |
| 121 | slot = PCI_SLOT(devices[item].device); |
| 122 | func = PCI_FUNC(devices[item].device); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 123 | |
| 124 | if (item == menu_selected) |
| 125 | wattrset(win, COLOR_PAIR(3) | A_BOLD); |
| 126 | else |
| 127 | wattrset(win, COLOR_PAIR(2)); |
| 128 | |
Uwe Hermann | a0c0093 | 2008-03-27 20:46:49 +0000 | [diff] [blame] | 129 | mvwprintw(win, 2 + i, 1, "%X:%2.2X.%2.2X %04X:%04X ", |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 130 | bus, slot, func, |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 131 | devices[item].id & 0xffff, |
| 132 | (devices[item].id >> 16) & 0xffff); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 133 | |
| 134 | wattrset(win, COLOR_PAIR(2)); |
| 135 | |
| 136 | if (i == 0) { |
| 137 | if (item != 0) |
Ulf Jordan | d133d9a | 2008-08-11 20:35:32 +0000 | [diff] [blame] | 138 | mvwaddch(win, 2 + i, 19, ACS_UARROW); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 139 | } |
| 140 | if (i == MENU_VISIBLE - 1) { |
| 141 | if ((item + 1) < devices_index) |
Ulf Jordan | d133d9a | 2008-08-11 20:35:32 +0000 | [diff] [blame] | 142 | mvwaddch(win, 2 + i, 19, ACS_DARROW); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 143 | } |
| 144 | } |
| 145 | |
| 146 | wattrset(win, COLOR_PAIR(2)); |
| 147 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 148 | for (i = 0; i < 16; i++) |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 149 | mvwprintw(win, 2, 26 + (i * 3), "%2.2X ", i); |
| 150 | |
| 151 | wmove(win, 3, 25); |
| 152 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 153 | for (i = 0; i < 48; i++) |
Ulf Jordan | d133d9a | 2008-08-11 20:35:32 +0000 | [diff] [blame] | 154 | waddch(win, (i == 0) ? ACS_ULCORNER : ACS_HLINE); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 155 | |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 156 | for (i = 0; i < 16; i++) { |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 157 | mvwprintw(win, 4 + i, 23, "%2.2X", i * 16); |
| 158 | wmove(win, 4 + i, 25); |
Ulf Jordan | d133d9a | 2008-08-11 20:35:32 +0000 | [diff] [blame] | 159 | waddch(win, ACS_VLINE); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 160 | } |
| 161 | |
| 162 | show_config_space(win, 4, 26, menu_selected); |
| 163 | |
| 164 | return 0; |
| 165 | } |
| 166 | |
| 167 | static void pci_scan_bus(int bus) |
| 168 | { |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 169 | int slot, func; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 170 | unsigned int val; |
| 171 | unsigned char hdr; |
| 172 | |
Stefan Reinauer | bc5379a | 2008-08-13 09:38:12 +0000 | [diff] [blame] | 173 | for (slot = 0; slot < 0x20; slot++) { |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 174 | for (func = 0; func < 8; func++) { |
| 175 | pcidev_t dev = PCI_DEV(bus, slot, func); |
Stefan Reinauer | 88ad6b0 | 2008-08-07 19:09:17 +0000 | [diff] [blame] | 176 | |
| 177 | val = pci_read_config32(dev, REG_VENDOR_ID); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 178 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 179 | /* Nobody home. */ |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 180 | if (val == 0xffffffff || val == 0x00000000 || |
Kyösti Mälkki | 1dc5ce3 | 2018-06-09 08:25:03 +0300 | [diff] [blame] | 181 | val == 0x0000ffff || val == 0xffff0000) { |
| 182 | |
| 183 | /* If function 0 is not present, no need |
| 184 | * to test other functions. */ |
| 185 | if (func == 0) |
| 186 | func = 8; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 187 | continue; |
Kyösti Mälkki | 1dc5ce3 | 2018-06-09 08:25:03 +0300 | [diff] [blame] | 188 | } |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 189 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 190 | /* FIXME: Remove this arbitrary limitation. */ |
Stefan Reinauer | 10d0a81 | 2008-09-05 15:18:15 +0000 | [diff] [blame] | 191 | if (devices_index >= MAX_PCI_DEVICES) |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 192 | return; |
| 193 | |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 194 | devices[devices_index].device = |
Stefan Reinauer | 28dff39 | 2008-08-13 08:23:06 +0000 | [diff] [blame] | 195 | PCI_DEV(bus, slot, func); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 196 | |
| 197 | devices[devices_index++].id = val; |
| 198 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 199 | /* If this is a bridge, then follow it. */ |
Stefan Reinauer | 88ad6b0 | 2008-08-07 19:09:17 +0000 | [diff] [blame] | 200 | hdr = pci_read_config8(dev, REG_HEADER_TYPE); |
Kyösti Mälkki | 1dc5ce3 | 2018-06-09 08:25:03 +0300 | [diff] [blame] | 201 | |
| 202 | if ((func == 0) && !(hdr & HEADER_TYPE_MULTIFUNCTION)) |
| 203 | func = 8; |
| 204 | |
| 205 | hdr &= ~HEADER_TYPE_MULTIFUNCTION; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 206 | if (hdr == HEADER_TYPE_BRIDGE || |
| 207 | hdr == HEADER_TYPE_CARDBUS) { |
| 208 | unsigned int busses; |
| 209 | |
Stefan Reinauer | 88ad6b0 | 2008-08-07 19:09:17 +0000 | [diff] [blame] | 210 | busses = pci_read_config32(dev, REG_PRIMARY_BUS); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 211 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 212 | pci_scan_bus((busses >> 8) & 0xff); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 213 | |
| 214 | } |
| 215 | } |
| 216 | } |
| 217 | |
| 218 | quicksort(devices, devices_index); |
| 219 | } |
| 220 | |
Uwe Hermann | 0bfb5c4 | 2008-03-23 15:34:04 +0000 | [diff] [blame] | 221 | static int pci_module_handle(int key) |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 222 | { |
| 223 | int ret = 0; |
| 224 | |
Uwe Hermann | 3a406fe | 2008-03-20 01:11:28 +0000 | [diff] [blame] | 225 | switch (key) { |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 226 | case KEY_DOWN: |
| 227 | if (menu_selected + 1 < devices_index) { |
| 228 | menu_selected++; |
| 229 | ret = 1; |
| 230 | } |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 231 | break; |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 232 | case KEY_UP: |
| 233 | if (menu_selected > 0) { |
| 234 | menu_selected--; |
| 235 | ret = 1; |
| 236 | } |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 237 | break; |
| 238 | } |
| 239 | |
| 240 | if (!ret) |
| 241 | return ret; |
| 242 | |
| 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); |
| 247 | if (menu_first < 0) |
| 248 | menu_first = 0; |
| 249 | } |
| 250 | |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 251 | return ret; |
| 252 | } |
| 253 | |
Uwe Hermann | 0bfb5c4 | 2008-03-23 15:34:04 +0000 | [diff] [blame] | 254 | static int pci_module_init(void) |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 255 | { |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 256 | pci_scan_bus(0); |
Jordan Crouse | 7249f79 | 2008-03-20 00:11:05 +0000 | [diff] [blame] | 257 | return 0; |
| 258 | } |
| 259 | |
| 260 | struct coreinfo_module pci_module = { |
| 261 | .name = "PCI", |
| 262 | .init = pci_module_init, |
| 263 | .redraw = pci_module_redraw, |
| 264 | .handle = pci_module_handle, |
| 265 | }; |
Uwe Hermann | ab5b3e0 | 2008-03-31 20:30:18 +0000 | [diff] [blame] | 266 | |
| 267 | #else |
| 268 | |
| 269 | struct coreinfo_module pci_module = { |
| 270 | }; |
| 271 | |
| 272 | #endif |