lib_i386/pci_type1.c

   1 /*
   2  * Support for type PCI configuration cycles.
   3  * based on pci_indirect.c
   4  *
   5  * Copyright (C) 2002 Daniel Engström, Omicron Ceti AB, daniel@omicron.se.
   6  *
   7  * This program is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU General Public License
   9  * as published by the Free Software Foundation; either version
  10  * 2 of the License, or (at your option) any later version.
  11  */
  12
  13 #include <common.h>
  14 #include <asm/io.h>
  15 #include <pci.h>
  16
  17 #define cfg_read(val, addr, op) *val = op((int)(addr))
  18 #define cfg_write(val, addr, op)        op((val), (int)(addr))
  19
  20 #define TYPE1_PCI_OP(rw, size, type, op, mask)                          \
  21 static int                                                              \
  22 type1_##rw##_config_##size(struct pci_controller *hose,                 \
  23                               pci_dev_t dev, int offset, type val)      \
  24 {                                                                       \
  25         outl(dev | (offset & 0xfc) | 0x80000000, (int)hose->cfg_addr);  \
  26         cfg_##rw(val, hose->cfg_data + (offset & mask), op);            \
  27         return 0;                                                       \
  28 }
  29
  30
  31 TYPE1_PCI_OP(read, byte, u8 *, inb, 3)
  32 TYPE1_PCI_OP(read, word, u16 *, inw, 2)
  33 TYPE1_PCI_OP(read, dword, u32 *, inl, 0)
  34
  35 TYPE1_PCI_OP(write, byte, u8, outb, 3)
  36 TYPE1_PCI_OP(write, word, u16, outw, 2)
  37 TYPE1_PCI_OP(write, dword, u32, outl, 0)
  38
  39 void pci_setup_type1(struct pci_controller* hose, u32 cfg_addr, u32 cfg_data)
  40 {
  41         pci_set_ops(hose,
  42                     type1_read_config_byte,
  43                     type1_read_config_word,
  44                     type1_read_config_dword,
  45                     type1_write_config_byte,
  46                     type1_write_config_word,
  47                     type1_write_config_dword);
  48
  49         hose->cfg_addr = (unsigned int *) cfg_addr;
  50         hose->cfg_data = (unsigned char *) cfg_data;
  51 }