Subversion Repositories or1k

/*

 * Copyright 2001 MontaVista Software Inc.

 * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net

 *

 * arch/mips/ddb5xxx/ddb5476/pci_ops.c

 *     Define the pci_ops for DB5477.

 *

 * Much of the code is derived from the original DDB5074 port by

 * Geert Uytterhoeven <geert@sonycom.com>

 *

 * This program is free software; you can redistribute  it and/or modify it

 * under  the terms of  the GNU General  Public License as published by the

 * Free Software Foundation;  either version 2 of the  License, or (at your

 * option) any later version.

 *

 */

#include <linux/config.h>

#include <linux/pci.h>

#include <linux/kernel.h>

#include <linux/types.h>

#include <asm/addrspace.h>

#include <asm/debug.h>

#include <asm/ddb5xxx/ddb5xxx.h>

/*

 * config_swap structure records what set of pdar/pmr are used

 * to access pci config space.  It also provides a place hold the

 * original values for future restoring.

 */

struct pci_config_swap {

        u32     pdar;

        u32     pmr;

        u32     config_base;

        u32     config_size;

        u32     pdar_backup;

        u32     pmr_backup;

};

/*

 * On DDB5476, we have one set of swap registers

 */

struct pci_config_swap ext_pci_swap = {

        DDB_PCIW0,

        DDB_PCIINIT0,

        DDB_PCI_CONFIG_BASE,

        DDB_PCI_CONFIG_SIZE

};

/*

 * access config space

 */

static inline u32 ddb_access_config_base(struct pci_config_swap *swap,

                                         u32 bus,/* 0 means top level bus */

                                         u32 slot_num)

{

        u32 pci_addr = 0;

        u32 pciinit_offset = 0;

        u32 virt_addr = swap->config_base;

        u32 option;

        /*

         * BUG: skip host PCI controller.  Its BARS are bogus.

         */

        if (slot_num == 12)

                slot_num = 0;

        /* minimum pdar (window) size is 2MB */

        db_assert(swap->config_size >= (2 << 20));

        db_assert(slot_num < (1 << 5));

        db_assert(bus < (1 << 8));

        /* backup registers */

        swap->pdar_backup = ddb_in32(swap->pdar);

        swap->pmr_backup = ddb_in32(swap->pmr);

        /* set the pdar (pci window) register */

        ddb_set_pdar(swap->pdar,

                     swap->config_base,

                     swap->config_size,

                     32,        /* 32 bit wide */

                     0,          /* not on local memory bus */

                     0); /* not visible from PCI bus (N/A) */

        /*

         * calcuate the absolute pci config addr;

         * according to the spec, we start scanning from adr:11 (0x800)

         */

        if (bus == 0) {

                /* type 0 config */

                pci_addr = 0x800 << slot_num;

        } else {

                /* type 1 config */

                pci_addr = (bus << 16) | (slot_num << 11);

                /* panic("ddb_access_config_base: we don't support type 1 config Yet"); */

        }

        /*

         * if pci_addr is less than pci config window size,  we set

         * pciinit_offset to 0 and adjust the virt_address.

         * Otherwise we will try to adjust pciinit_offset.

         */

        if (pci_addr < swap->config_size) {

                virt_addr = KSEG1ADDR(swap->config_base + pci_addr);

                pciinit_offset = 0;

        } else {

                db_assert( (pci_addr & (swap->config_size - 1)) == 0);

                virt_addr = KSEG1ADDR(swap->config_base);

                pciinit_offset = pci_addr;

        }

        /* set the pmr register */

        option = DDB_PCI_ACCESS_32;

        if (bus != 0) option |= DDB_PCI_CFGTYPE1;

        ddb_set_pmr(swap->pmr, DDB_PCICMD_CFG, pciinit_offset, option);

        return virt_addr;

}

static inline void ddb_close_config_base(struct pci_config_swap *swap)

{

        ddb_out32(swap->pdar, swap->pdar_backup);

        ddb_out32(swap->pmr, swap->pmr_backup);

}

static int read_config_dword(struct pci_config_swap *swap,

                             struct pci_dev *dev,

                             u32 where,

                             u32 *val)

{

        u32 bus, slot_num, func_num;

        u32 base;

        db_assert((where & 3) == 0);

        db_assert(where < (1 << 8));

        /* check if the bus is top-level */

        if (dev->bus->parent != NULL) {

                bus = dev->bus->number;

                db_assert(bus != 0);

        } else {

                bus = 0;

        }

        slot_num = PCI_SLOT(dev->devfn);

        func_num = PCI_FUNC(dev->devfn);

        base = ddb_access_config_base(swap, bus, slot_num);

        *val = *(volatile u32*) (base + (func_num << 8) + where);

        ddb_close_config_base(swap);

        return PCIBIOS_SUCCESSFUL;

}

static int read_config_word(struct pci_config_swap *swap,

                            struct pci_dev *dev,

                            u32 where,

                            u16 *val)

{

        int status;

        u32 result;

        db_assert((where & 1) == 0);

        status = read_config_dword(swap, dev, where & ~3, &result);

        if (where & 2) result >>= 16;

        *val = result & 0xffff;

        return status;

}

static int read_config_byte(struct pci_config_swap *swap,

                            struct pci_dev *dev,

                            u32 where,

                            u8 *val)

{

        int status;

        u32 result;

        status = read_config_dword(swap, dev, where & ~3, &result);

        if (where & 1) result >>= 8;

        if (where & 2) result >>= 16;

        *val = result & 0xff;

        return status;

}

static int write_config_dword(struct pci_config_swap *swap,

                              struct pci_dev *dev,

                              u32 where,

                              u32 val)

{

        u32 bus, slot_num, func_num;

        u32 base;

        db_assert((where & 3) == 0);

        db_assert(where < (1 << 8));

        /* check if the bus is top-level */

        if (dev->bus->parent != NULL) {

                bus = dev->bus->number;

                db_assert(bus != 0);

        } else {

                bus = 0;

        }

        slot_num = PCI_SLOT(dev->devfn);

        func_num = PCI_FUNC(dev->devfn);

        base = ddb_access_config_base(swap, bus, slot_num);

        *(volatile u32*) (base + (func_num << 8) + where) = val;

        ddb_close_config_base(swap);

        return PCIBIOS_SUCCESSFUL;

}

static int write_config_word(struct pci_config_swap *swap,

                             struct pci_dev *dev,

                             u32 where,

                             u16 val)

{

        int status, shift=0;

        u32 result;

        db_assert((where & 1) == 0);

        status = read_config_dword(swap, dev, where & ~3, &result);

        if (status != PCIBIOS_SUCCESSFUL) return status;

        if (where & 2)

                shift += 16;

        result &= ~(0xffff << shift);

        result |= val << shift;

        return write_config_dword(swap, dev, where & ~3, result);

}

static int write_config_byte(struct pci_config_swap *swap,

                             struct pci_dev *dev,

                             u32 where,

                             u8 val)

{

        int status, shift=0;

        u32 result;

        status = read_config_dword(swap, dev, where & ~3, &result);

        if (status != PCIBIOS_SUCCESSFUL) return status;

        if (where & 2)

                shift += 16;

        if (where & 1)

                shift += 8;

        result &= ~(0xff << shift);

        result |= val << shift;

        return write_config_dword(swap, dev, where & ~3, result);

}

#define MAKE_PCI_OPS(prefix, rw, unitname, unittype, pciswap) \

static int prefix##_##rw##_config_##unitname(struct pci_dev *dev, int where, unittype val) \

{ \

     return rw##_config_##unitname(pciswap, \

                                   dev, \

                                   where, \

                                   val); \

}

MAKE_PCI_OPS(extpci, read, byte, u8 *, &ext_pci_swap)

MAKE_PCI_OPS(extpci, read, word, u16 *, &ext_pci_swap)

MAKE_PCI_OPS(extpci, read, dword, u32 *, &ext_pci_swap)

MAKE_PCI_OPS(extpci, write, byte, u8, &ext_pci_swap)

MAKE_PCI_OPS(extpci, write, word, u16, &ext_pci_swap)

MAKE_PCI_OPS(extpci, write, dword, u32, &ext_pci_swap)

struct pci_ops ddb5476_ext_pci_ops ={

        extpci_read_config_byte,

        extpci_read_config_word,

        extpci_read_config_dword,

        extpci_write_config_byte,

        extpci_write_config_word,

        extpci_write_config_dword

};