linux-imx

/*

 * Sonics Silicon Backplane PCI-Hostbus related functions.

 *

 * Copyright (C) 2005-2006 Michael Buesch <m@bues.ch>

 * Copyright (C) 2005 Martin Langer <martin-langer@gmx.de>

 * Copyright (C) 2005 Stefano Brivio <st3@riseup.net>

 * Copyright (C) 2005 Danny van Dyk <kugelfang@gentoo.org>

 * Copyright (C) 2005 Andreas Jaggi <andreas.jaggi@waterwave.ch>

 *

 * Derived from the Broadcom 4400 device driver.

 * Copyright (C) 2002 David S. Miller (davem@redhat.com)

 * Fixed by Pekka Pietikainen (pp@ee.oulu.fi)

 * Copyright (C) 2006 Broadcom Corporation.

 *

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

 */

​

#include "ssb_private.h"

​

#include <linux/ssb/ssb.h>

#include <linux/ssb/ssb_regs.h>

#include <linux/slab.h>

#include <linux/pci.h>

#include <linux/delay.h>

​

​

/* Define the following to 1 to enable a printk on each coreswitch. */

#define SSB_VERBOSE_PCICORESWITCH_DEBUG     0

​

​

/* Lowlevel coreswitching */

int ssb_pci_switch_coreidx(struct ssb_bus *bus, u8 coreidx)

{

    int err;

    int attempts = 0;

    u32 cur_core;

​

    while (1) {

        err = pci_write_config_dword(bus->host_pci, SSB_BAR0_WIN,

                         (coreidx * SSB_CORE_SIZE)

                         + SSB_ENUM_BASE);

        if (err)

            goto error;

        err = pci_read_config_dword(bus->host_pci, SSB_BAR0_WIN,

                        &cur_core);

        if (err)

            goto error;

        cur_core = (cur_core - SSB_ENUM_BASE)

               / SSB_CORE_SIZE;

        if (cur_core == coreidx)

            break;

​

        if (attempts++ > SSB_BAR0_MAX_RETRIES)

            goto error;

        udelay(10);

    }

    return 0;

error:

    pr_err("Failed to switch to core %u\n", coreidx);

    return -ENODEV;

}

​

int ssb_pci_switch_core(struct ssb_bus *bus,