Chameleon Applications

Chameleon Applications Svn Source Tree

Root/branches/iFabio/Chameleon/i386/libsaio/pci.c

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

Archive Download this file

Revision: 307