Chameleon

Chameleon Svn Source Tree

Root/branches/rekursor/i386/libsaio/pci.c

1/*␊
2 *␊
3 * Copyright 2008 by Islam M. Ahmed Zaid. All rights reserved.␊
4 *␊
5 */␊
6␊
7#include "libsaio.h"␊
8#include "bootstruct.h"␊
9#include "pci.h"␊
10␊
11uint32_t pci_config_read(uint32_t pci_addr, uint8_t reg, uint8_t bytes)␊
12{␊
13␉uint32_t data = -1;␊
14␊
15␉pci_addr |= reg & ~3;␊
16␉outl(PCI_ADDR_REG, pci_addr);␊
17␊
18␉switch (bytes)␊
19␉{␊
20␉␉case 1:␊
21␉␉␉data = inb(PCI_DATA_REG + (reg & 3));␊
22␉␉␉break;␊
23␉␉case 2:␊
24␉␉␉data = inw(PCI_DATA_REG + (reg & 2));␊
25␉␉␉break;␊
26␉␉case 4:␊
27␉␉␉data = inl(PCI_DATA_REG);␊
28␉␉␉break;␊
29␉}␊
30␊
31␉return data;␊
32}␊
33␊
34void pci_config_write(uint32_t pci_addr, uint8_t reg, uint32_t data, uint8_t bytes)␊
35{␊
36␉pci_addr |= reg & ~3;␊
37␉outl(PCI_ADDR_REG, pci_addr);␊
38␊
39␉switch (bytes)␊
40␉{␊
41␉␉case 1:␊
42␉␉␉outb(PCI_DATA_REG + (reg & 3), data);␊
43␉␉␉break;␊
44␉␉case 2:␊
45␉␉␉outw(PCI_DATA_REG + (reg & 2), data);␊
46␉␉␉break;␊
47␉␉case 4:␊
48␉␉␉outl(PCI_DATA_REG, data);␊
49␉␉␉break;␊
50␉}␊
51}␊
52␊
53pci_dt_t *root_pci_dev;␊
54␊
55void scan_pci_bus(pci_dt_t *start, uint8_t bus)␊
56{␊
57␉uint8_t dev, func, secondary_bus, header_type;␊
58␉uint32_t id, pci_addr;␊
59␉pci_dt_t *new;␊
60␉pci_dt_t **current = &start->children;␊
61␉␊
62␉for (dev = 0; dev < 32; dev++)␊
63␉␉for (func = 0; func < 8; func++)␊
64␉␉{␊
65␉␉␉pci_addr = PCIADDR(bus, dev, func);␊
66␉␉␉id = pci_config_read32(pci_addr, PCI_VENDOR_ID);␊
67␉␉␉if (!id || id == 0xffffffff)␊
68␉␉␉␉continue;␊
69␊
70␉␉␉new = (pci_dt_t*)MALLOC(sizeof(pci_dt_t));␊
71␉␉␉if (!new)␊
72␉␉␉␉return;␊
73␉␉␉memset(new, 0, sizeof(pci_dt_t));␊
74␉␉␉␊
75␉␉␉new->dev.addr␉= pci_addr;␊
76␉␉␉new->vendor_id␉= id & 0xffff;␊
77␉␉␉new->device_id␉= (id >> 16) & 0xffff;␊
78␉␉␉new->class_id␉= pci_config_read16(pci_addr, PCI_CLASS_DEVICE);␊
79␉␉␉new->parent␉␉= start;␊
80␊
81␉␉␉header_type = pci_config_read8(pci_addr, PCI_HEADER_TYPE);␊
82␉␉␉switch (header_type & 0x7f)␊
83␉␉␉{␊
84␉␉␉␉case PCI_HEADER_TYPE_BRIDGE:␊
85␉␉␉␉case PCI_HEADER_TYPE_CARDBUS:␊
86␉␉␉␉␉secondary_bus = pci_config_read8(pci_addr, PCI_SECONDARY_BUS);␊
87␉␉␉␉␉if (secondary_bus != 0)␊
88␉␉␉␉␉␉scan_pci_bus(new, secondary_bus);␊
89␉␉␉␉␉break;␊
90␉␉␉}␊
91␊
92␉␉␉*current = new;␊
93␉␉␉current = &new->next;␊
94␊
95␉␉␉if ((func == 0) && ((header_type & 0x80) == 0))␊
96␉␉␉␉break;␊
97␉␉}␊
98}␊
99␊
100void enable_pci_devs(void)␊
101{␊
102␉uint16_t id;␊
103␉uint32_t rcba, *fd;␊
104␊
105␉id = pci_config_read16(PCIADDR(0, 0x00, 0), 0x00);␊
106␉/* make sure we're on Intel chipset */␊
107␉if (id != 0x8086)␊
108␉␉return;␊
109␉rcba = pci_config_read32(PCIADDR(0, 0x1f, 0), 0xf0) & ~1;␊
110␉fd = (uint32_t *)(rcba + 0x3418);␊
111␉/* set SMBus Disable (SD) to 0 */␊
112␉*fd &= ~0x8;␊
113␉/* and all devices? */␊
114␉//*fd = 0x1;␊
115}␊
116␊
117void build_pci_dt(void)␊
118{␊
119␉root_pci_dev = MALLOC(sizeof(pci_dt_t));␊
120␉␊
121␉if (!root_pci_dev)␊
122␉␉return;␊
123␉␊
124␉bzero(root_pci_dev, sizeof(pci_dt_t));␊
125␉enable_pci_devs();␊
126␉scan_pci_bus(root_pci_dev, 0);␊
127}␊
128␊
129char dev_path[80];␊
130␊
131char *get_pci_dev_path(pci_dt_t *pci_dt)␊
132{␊
133␉pci_dt_t *current, *end;␊
134␉char tmp[30];␊
135␉int uid = 0;␊
136␊
137␉dev_path[0] = 0;␊
138␉end = root_pci_dev;␊
139␊
140␉uid = getPciRootUID();␊
141␊
142␉while (end != pci_dt)␊
143␉{␊
144␉␉current = pci_dt;␊
145␉␉while (current->parent != end)␊
146␉␉␉current = current->parent;␉␉␉␊
147␉␉end = current;␊
148␉␉if (current->parent == root_pci_dev)␊
149␉␉{␊
150␉␉␉sprintf(tmp, "PciRoot(0x%x)/Pci(0x%x,0x%x)", uid, ␊
151␉␉␉current->dev.bits.dev, current->dev.bits.func);␊
152␉␉} else {␊
153␉␉␉sprintf(tmp, "/Pci(0x%x,0x%x)", ␊
154␉␉␉␉current->dev.bits.dev, current->dev.bits.func);␊
155␉␉}␊
156␉␉strcat(dev_path, tmp);␊
157␉}␊
158␊
159␉return dev_path;␊
160}␊
161␊
162void dump_pci_dt(pci_dt_t *pci_dt)␊
163{␊
164␉pci_dt_t *current = pci_dt;␊
165␊
166␉while (current)␊
167␉{␊
168␉␉printf("%02x:%02x.%x [%04x] [%04x:%04x] :: %s\n", ␊
169␉␉␉current->dev.bits.bus, current->dev.bits.dev, current->dev.bits.func, ␊
170␉␉␉current->class_id, current->vendor_id, current->device_id, ␊
171␉␉␉get_pci_dev_path(current));␊
172␉␉dump_pci_dt(current->children);␊
173␉␉current = current->next;␊
174␉}␊
175}␊
176␊
177␊
178void lspci(const char *booterParam)␊
179{␊
180␉if(bootArgs->Video.v_display == VGA_TEXT_MODE)␊
181␉{ ␊
182␉␉setActiveDisplayPage(1);␊
183␉␉clearScreenRows(0, 24);␊
184␉␉setCursorPosition(0, 0, 1);␊
185␉}␊
186␉␉␊
187␉dump_pci_dt(root_pci_dev->children);␊
188␉␊
189␉printf("(Press a key to continue...)");␊
190␉getc();␊
191␉␊
192␉if(bootArgs->Video.v_display == VGA_TEXT_MODE)␊
193␉␉setActiveDisplayPage(0);␊
194}␊
195␊
196int check_vga_nvidia(pci_dt_t *pci_dt)␊
197{␊
198␉pci_dt_t *current = pci_dt;␊
199␉while (current)␊
200␉{␊
201␉␉if(current->vendor_id == PCI_CLASS_DISPLAY_VGA)␊
202␉␉␉if(current->class_id == PCI_VENDOR_ID_NVIDIA)␊
203␉␉␉␉return 1;␊
204␉␉␊
205␉␉check_vga_nvidia(current->children);␊
206␉␉current = current->next;␊
207␉}␊
208␉return 0;␊
209}␊
210␊
211

Archive Download this file

Revision: 4