| 16,281 → 16,257 |
|---|
| #include "internal.h" |
| |
| static struct pci_methods *pci_methods[PCI_ACCESS_MAX] = { |
| &pm_intel_conf1, |
| &pm_intel_conf2, |
| &pm_intel_conf1, |
| &pm_intel_conf2, |
| }; |
| |
| struct pci_access * |
| pci_alloc(void) |
| struct pci_access *pci_alloc(void) |
| { |
| struct pci_access *a = malloc(sizeof(struct pci_access)); |
| int i; |
| struct pci_access *a = malloc(sizeof(struct pci_access)); |
| int i; |
| |
| bzero(a, sizeof(*a)); |
| for(i=0; i<PCI_ACCESS_MAX; i++) |
| if (pci_methods[i] && pci_methods[i]->config) |
| pci_methods[i]->config(a); |
| return a; |
| bzero(a, sizeof(*a)); |
| for (i = 0; i < PCI_ACCESS_MAX; i++) |
| if (pci_methods[i] && pci_methods[i]->config) |
| pci_methods[i]->config(a); |
| return a; |
| } |
| |
| void * |
| pci_malloc(struct pci_access *a, int size) |
| void *pci_malloc(struct pci_access *a, int size) |
| { |
| void *x = malloc(size); |
| void *x = malloc(size); |
| |
| if (!x) |
| a->error("Out of memory (allocation of %d bytes failed)", size); |
| return x; |
| if (!x) |
| a->error("Out of memory (allocation of %d bytes failed)", |
| size); |
| return x; |
| } |
| |
| void |
| pci_mfree(void *x) |
| void pci_mfree(void *x) |
| { |
| if (x) |
| free(x); |
| if (x) |
| free(x); |
| } |
| |
| static void |
| pci_generic_error(char *msg, ...) |
| static void pci_generic_error(char *msg, ...) |
| { |
| va_list args; |
| va_list args; |
| |
| va_start(args, msg); |
| puts("pcilib: "); |
| vprintf(msg, args); |
| putchar('\n'); |
| exit(1); |
| va_start(args, msg); |
| puts("pcilib: "); |
| vprintf(msg, args); |
| putchar('\n'); |
| exit(1); |
| } |
| |
| static void |
| pci_generic_warn(char *msg, ...) |
| static void pci_generic_warn(char *msg, ...) |
| { |
| va_list args; |
| va_list args; |
| |
| va_start(args, msg); |
| puts("pcilib: "); |
| vprintf(msg, args); |
| putchar('\n'); |
| va_start(args, msg); |
| puts("pcilib: "); |
| vprintf(msg, args); |
| putchar('\n'); |
| } |
| |
| static void |
| pci_generic_debug(char *msg, ...) |
| static void pci_generic_debug(char *msg, ...) |
| { |
| va_list args; |
| va_list args; |
| |
| va_start(args, msg); |
| vprintf(msg, args); |
| va_end(args); |
| va_start(args, msg); |
| vprintf(msg, args); |
| va_end(args); |
| } |
| |
| static void |
| pci_null_debug(char *msg UNUSED, ...) |
| static void pci_null_debug(char *msg UNUSED, ...) |
| { |
| } |
| |
| void |
| pci_init(struct pci_access *a) |
| void pci_init(struct pci_access *a) |
| { |
| if (!a->error) |
| a->error = pci_generic_error; |
| if (!a->warning) |
| a->warning = pci_generic_warn; |
| if (!a->debug) |
| a->debug = pci_generic_debug; |
| if (!a->debugging) |
| a->debug = pci_null_debug; |
| if (!a->error) |
| a->error = pci_generic_error; |
| if (!a->warning) |
| a->warning = pci_generic_warn; |
| if (!a->debug) |
| a->debug = pci_generic_debug; |
| if (!a->debugging) |
| a->debug = pci_null_debug; |
| |
| if (a->method) |
| { |
| if (a->method >= PCI_ACCESS_MAX || !pci_methods[a->method]) |
| a->error("This access method is not supported."); |
| a->methods = pci_methods[a->method]; |
| } |
| else |
| { |
| unsigned int i; |
| for(i=0; i<PCI_ACCESS_MAX; i++) |
| if (pci_methods[i]) |
| { |
| a->debug("Trying method %d...", i); |
| if (pci_methods[i]->detect(a)) |
| { |
| a->debug("...OK\n"); |
| a->methods = pci_methods[i]; |
| a->method = i; |
| break; |
| } |
| a->debug("...No.\n"); |
| } |
| if (!a->methods) |
| a->error("Cannot find any working access method."); |
| } |
| a->debug("Decided to use %s\n", a->methods->name); |
| a->methods->init(a); |
| if (a->method) { |
| if (a->method >= PCI_ACCESS_MAX || !pci_methods[a->method]) |
| a->error("This access method is not supported."); |
| a->methods = pci_methods[a->method]; |
| } else { |
| unsigned int i; |
| for (i = 0; i < PCI_ACCESS_MAX; i++) |
| if (pci_methods[i]) { |
| a->debug("Trying method %d...", i); |
| if (pci_methods[i]->detect(a)) { |
| a->debug("...OK\n"); |
| a->methods = pci_methods[i]; |
| a->method = i; |
| break; |
| } |
| a->debug("...No.\n"); |
| } |
| if (!a->methods) |
| a->error("Cannot find any working access method."); |
| } |
| a->debug("Decided to use %s\n", a->methods->name); |
| a->methods->init(a); |
| } |
| |
| void |
| pci_cleanup(struct pci_access *a) |
| void pci_cleanup(struct pci_access *a) |
| { |
| struct pci_dev *d, *e; |
| struct pci_dev *d, *e; |
| |
| for(d=a->devices; d; d=e) |
| { |
| e = d->next; |
| pci_free_dev(d); |
| } |
| if (a->methods) |
| a->methods->cleanup(a); |
| pci_free_name_list(a); |
| pci_mfree(a); |
| for (d = a->devices; d; d = e) { |
| e = d->next; |
| pci_free_dev(d); |
| } |
| if (a->methods) |
| a->methods->cleanup(a); |
| pci_free_name_list(a); |
| pci_mfree(a); |
| } |
| |
| void |
| pci_scan_bus(struct pci_access *a) |
| void pci_scan_bus(struct pci_access *a) |
| { |
| a->methods->scan(a); |
| a->methods->scan(a); |
| } |
| |
| struct pci_dev * |
| pci_alloc_dev(struct pci_access *a) |
| struct pci_dev *pci_alloc_dev(struct pci_access *a) |
| { |
| struct pci_dev *d = pci_malloc(a, sizeof(struct pci_dev)); |
| struct pci_dev *d = pci_malloc(a, sizeof(struct pci_dev)); |
| |
| bzero(d, sizeof(*d)); |
| d->access = a; |
| d->methods = a->methods; |
| d->hdrtype = -1; |
| if (d->methods->init_dev) |
| d->methods->init_dev(d); |
| return d; |
| bzero(d, sizeof(*d)); |
| d->access = a; |
| d->methods = a->methods; |
| d->hdrtype = -1; |
| if (d->methods->init_dev) |
| d->methods->init_dev(d); |
| return d; |
| } |
| |
| int |
| pci_link_dev(struct pci_access *a, struct pci_dev *d) |
| int pci_link_dev(struct pci_access *a, struct pci_dev *d) |
| { |
| d->next = a->devices; |
| a->devices = d; |
| d->next = a->devices; |
| a->devices = d; |
| |
| return 1; |
| return 1; |
| } |
| |
| struct pci_dev * |
| pci_get_dev(struct pci_access *a, int domain, int bus, int dev, int func) |
| struct pci_dev *pci_get_dev(struct pci_access *a, int domain, int bus, |
| int dev, int func) |
| { |
| struct pci_dev *d = pci_alloc_dev(a); |
| struct pci_dev *d = pci_alloc_dev(a); |
| |
| d->domain = domain; |
| d->bus = bus; |
| d->dev = dev; |
| d->func = func; |
| return d; |
| d->domain = domain; |
| d->bus = bus; |
| d->dev = dev; |
| d->func = func; |
| return d; |
| } |
| |
| void pci_free_dev(struct pci_dev *d) |
| { |
| if (d->methods->cleanup_dev) |
| d->methods->cleanup_dev(d); |
| pci_mfree(d); |
| if (d->methods->cleanup_dev) |
| d->methods->cleanup_dev(d); |
| pci_mfree(d); |
| } |
| |
| static inline void |
| pci_read_data(struct pci_dev *d, void *buf, int pos, int len) |
| { |
| if (pos & (len-1)) |
| d->access->error("Unaligned read: pos=%02x, len=%d", pos, len); |
| if (pos + len <= d->cache_len) |
| memcpy(buf, d->cache + pos, len); |
| else if (!d->methods->read(d, pos, buf, len)) |
| memset(buf, 0xff, len); |
| if (pos & (len - 1)) |
| d->access->error("Unaligned read: pos=%02x, len=%d", pos, |
| len); |
| if (pos + len <= d->cache_len) |
| memcpy(buf, d->cache + pos, len); |
| else if (!d->methods->read(d, pos, buf, len)) |
| memset(buf, 0xff, len); |
| } |
| |
| byte |
| pci_read_byte(struct pci_dev *d, int pos) |
| byte pci_read_byte(struct pci_dev *d, int pos) |
| { |
| byte buf; |
| pci_read_data(d, &buf, pos, 1); |
| return buf; |
| byte buf; |
| pci_read_data(d, &buf, pos, 1); |
| return buf; |
| } |
| |
| word |
| pci_read_word(struct pci_dev *d, int pos) |
| word pci_read_word(struct pci_dev * d, int pos) |
| { |
| word buf; |
| pci_read_data(d, &buf, pos, 2); |
| return le16_to_cpu(buf); |
| word buf; |
| pci_read_data(d, &buf, pos, 2); |
| return le16_to_cpu(buf); |
| } |
| |
| u32 |
| pci_read_long(struct pci_dev *d, int pos) |
| u32 pci_read_long(struct pci_dev * d, int pos) |
| { |
| u32 buf; |
| pci_read_data(d, &buf, pos, 4); |
| return le32_to_cpu(buf); |
| u32 buf; |
| pci_read_data(d, &buf, pos, 4); |
| return le32_to_cpu(buf); |
| } |
| |
| int |
| pci_read_block(struct pci_dev *d, int pos, byte *buf, int len) |
| int pci_read_block(struct pci_dev *d, int pos, byte * buf, int len) |
| { |
| return d->methods->read(d, pos, buf, len); |
| return d->methods->read(d, pos, buf, len); |
| } |
| |
| static inline int |
| pci_write_data(struct pci_dev *d, void *buf, int pos, int len) |
| { |
| if (pos & (len-1)) |
| d->access->error("Unaligned write: pos=%02x,len=%d", pos, len); |
| if (pos + len <= d->cache_len) |
| memcpy(d->cache + pos, buf, len); |
| return d->methods->write(d, pos, buf, len); |
| if (pos & (len - 1)) |
| d->access->error("Unaligned write: pos=%02x,len=%d", pos, |
| len); |
| if (pos + len <= d->cache_len) |
| memcpy(d->cache + pos, buf, len); |
| return d->methods->write(d, pos, buf, len); |
| } |
| |
| int |
| pci_write_byte(struct pci_dev *d, int pos, byte data) |
| int pci_write_byte(struct pci_dev *d, int pos, byte data) |
| { |
| return pci_write_data(d, &data, pos, 1); |
| return pci_write_data(d, &data, pos, 1); |
| } |
| |
| int |
| pci_write_word(struct pci_dev *d, int pos, word data) |
| int pci_write_word(struct pci_dev *d, int pos, word data) |
| { |
| word buf = cpu_to_le16(data); |
| return pci_write_data(d, &buf, pos, 2); |
| word buf = cpu_to_le16(data); |
| return pci_write_data(d, &buf, pos, 2); |
| } |
| |
| int |
| pci_write_long(struct pci_dev *d, int pos, u32 data) |
| int pci_write_long(struct pci_dev *d, int pos, u32 data) |
| { |
| u32 buf = cpu_to_le32(data); |
| return pci_write_data(d, &buf, pos, 4); |
| u32 buf = cpu_to_le32(data); |
| return pci_write_data(d, &buf, pos, 4); |
| } |
| |
| int |
| pci_write_block(struct pci_dev *d, int pos, byte *buf, int len) |
| int pci_write_block(struct pci_dev *d, int pos, byte * buf, int len) |
| { |
| if (pos < d->cache_len) |
| { |
| int l = (pos + len >= d->cache_len) ? (d->cache_len - pos) : len; |
| memcpy(d->cache + pos, buf, l); |
| } |
| return d->methods->write(d, pos, buf, len); |
| if (pos < d->cache_len) { |
| int l = |
| (pos + len >= |
| d->cache_len) ? (d->cache_len - pos) : len; |
| memcpy(d->cache + pos, buf, l); |
| } |
| return d->methods->write(d, pos, buf, len); |
| } |
| |
| int |
| pci_fill_info(struct pci_dev *d, int flags) |
| int pci_fill_info(struct pci_dev *d, int flags) |
| { |
| if (flags & PCI_FILL_RESCAN) |
| { |
| flags &= ~PCI_FILL_RESCAN; |
| d->known_fields = 0; |
| } |
| if (flags & ~d->known_fields) |
| d->known_fields |= d->methods->fill_info(d, flags & ~d->known_fields); |
| return d->known_fields; |
| if (flags & PCI_FILL_RESCAN) { |
| flags &= ~PCI_FILL_RESCAN; |
| d->known_fields = 0; |
| } |
| if (flags & ~d->known_fields) |
| d->known_fields |= |
| d->methods->fill_info(d, flags & ~d->known_fields); |
| return d->known_fields; |
| } |
| |
| void |
| pci_setup_cache(struct pci_dev *d, byte *cache, int len) |
| void pci_setup_cache(struct pci_dev *d, byte * cache, int len) |
| { |
| d->cache = cache; |
| d->cache_len = len; |
| d->cache = cache; |
| d->cache_len = len; |
| } |