linux-imx

/*

 * Broadcom specific AMBA

 * PCI Core in hostmode

 *

 * Copyright 2005 - 2011, Broadcom Corporation

 * Copyright 2006, 2007, Michael Buesch <m@bues.ch>

 * Copyright 2011, 2012, Hauke Mehrtens <hauke@hauke-m.de>

 *

 * Licensed under the GNU/GPL. See COPYING for details.

 */

​

#include "bcma_private.h"

#include <linux/pci.h>

#include <linux/slab.h>

#include <linux/export.h>

#include <linux/bcma/bcma.h>

#include <asm/paccess.h>

​

/* Probe a 32bit value on the bus and catch bus exceptions.

 * Returns nonzero on a bus exception.

 * This is MIPS specific */

#define mips_busprobe32(val, addr)  get_dbe((val), ((u32 *)(addr)))

​

/* Assume one-hot slot wiring */

#define BCMA_PCI_SLOT_MAX   16

#define PCI_CONFIG_SPACE_SIZE   256

​

bool bcma_core_pci_is_in_hostmode(struct bcma_drv_pci *pc)

{

    struct bcma_bus *bus = pc->core->bus;

    u16 chipid_top;

    u32 tmp;

​

    chipid_top = (bus->chipinfo.id & 0xFF00);

    if (chipid_top != 0x4700 &&

        chipid_top != 0x5300)

        return false;

​

    bcma_core_enable(pc->core, 0);

​

    return !mips_busprobe32(tmp, pc->core->io_addr);

}

​

static u32 bcma_pcie_read_config(struct bcma_drv_pci *pc, u32 address)

{

    pcicore_write32(pc, BCMA_CORE_PCI_CONFIG_ADDR, address);

    pcicore_read32(pc, BCMA_CORE_PCI_CONFIG_ADDR);

    return pcicore_read32(pc, BCMA_CORE_PCI_CONFIG_DATA);

}

​

static void bcma_pcie_write_config(struct bcma_drv_pci *pc, u32 address,

                   u32 data)

{

    pcicore_write32(pc, BCMA_CORE_PCI_CONFIG_ADDR, address);

    pcicore_read32(pc, BCMA_CORE_PCI_CONFIG_ADDR);

    pcicore_write32(pc, BCMA_CORE_PCI_CONFIG_DATA, data);

}

​

static u32 bcma_get_cfgspace_addr(struct bcma_drv_pci *pc, unsigned int dev,

                 unsigned int func, unsigned int off)

{

    u32 addr = 0;

​

    /* Issue config commands only when the data link is up (atleast

     * one external pcie device is present).

     */

    if (dev >= 2 || !(bcma_pcie_read(pc, BCMA_CORE_PCI_DLLP_LSREG)

              & BCMA_CORE_PCI_DLLP_LSREG_LINKUP))

        goto out;

​

    /* Type 0 transaction */

    /* Slide the PCI window to the appropriate slot */

    pcicore_write32(pc, BCMA_CORE_PCI_SBTOPCI1, BCMA_CORE_PCI_SBTOPCI_CFG0);

    /* Calculate the address */

    addr = pc->host_controller->host_cfg_addr;

    addr |= (dev << BCMA_CORE_PCI_CFG_SLOT_SHIFT);

    addr |= (func << BCMA_CORE_PCI_CFG_FUN_SHIFT);

    addr |= (off & ~3);

​

out:

    return addr;

}

​

static int bcma_extpci_read_config(struct bcma_drv_pci *pc, unsigned int dev,

                  unsigned int func, unsigned int off,

                  void *buf, int len)

{

    int err = -EINVAL;

    u32 addr, val;

    void __iomem *mmio = 0;

​

    WARN_ON(!pc->hostmode);