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