Chameleon

Chameleon Svn Source Tree

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

Archive Download this file

Revision: 2005