mirror of https://github.com/hak5/openwrt.git
145 lines
3.2 KiB
C
145 lines
3.2 KiB
C
/*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file "COPYING" in the main directory of this archive
|
|
* for more details.
|
|
*
|
|
* Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr>
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/log2.h>
|
|
#include <bcm63xx_cpu.h>
|
|
#include <bcm63xx_io.h>
|
|
#include <bcm63xx_regs.h>
|
|
#include <bcm63xx_cs.h>
|
|
|
|
static DEFINE_SPINLOCK(bcm63xx_cs_lock);
|
|
|
|
/*
|
|
* check if given chip select exists
|
|
*/
|
|
static int is_valid_cs(unsigned int cs)
|
|
{
|
|
if (cs > 6)
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
* Configure chipselect base address and size (bytes).
|
|
* Size must be a power of two between 8k and 256M.
|
|
*/
|
|
int bcm63xx_set_cs_base(unsigned int cs, u32 base, unsigned int size)
|
|
{
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
if (!is_valid_cs(cs))
|
|
return -EINVAL;
|
|
|
|
/* sanity check on size */
|
|
if (size != roundup_pow_of_two(size))
|
|
return -EINVAL;
|
|
|
|
if (size < 8 * 1024 || size > 256 * 1024 * 1024)
|
|
return -EINVAL;
|
|
|
|
val = (base & MPI_CSBASE_BASE_MASK);
|
|
/* 8k => 0 - 256M => 15 */
|
|
val |= (ilog2(size) - ilog2(8 * 1024)) << MPI_CSBASE_SIZE_SHIFT;
|
|
|
|
spin_lock_irqsave(&bcm63xx_cs_lock, flags);
|
|
bcm_mpi_writel(val, MPI_CSBASE_REG(cs));
|
|
spin_unlock_irqrestore(&bcm63xx_cs_lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_SYMBOL(bcm63xx_set_cs_base);
|
|
|
|
/*
|
|
* configure chipselect timing (ns)
|
|
*/
|
|
int bcm63xx_set_cs_timing(unsigned int cs, unsigned int wait,
|
|
unsigned int setup, unsigned int hold)
|
|
{
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
if (!is_valid_cs(cs))
|
|
return -EINVAL;
|
|
|
|
spin_lock_irqsave(&bcm63xx_cs_lock, flags);
|
|
val = bcm_mpi_readl(MPI_CSCTL_REG(cs));
|
|
val &= ~(MPI_CSCTL_WAIT_MASK);
|
|
val &= ~(MPI_CSCTL_SETUP_MASK);
|
|
val &= ~(MPI_CSCTL_HOLD_MASK);
|
|
val |= wait << MPI_CSCTL_WAIT_SHIFT;
|
|
val |= setup << MPI_CSCTL_SETUP_SHIFT;
|
|
val |= hold << MPI_CSCTL_HOLD_SHIFT;
|
|
bcm_mpi_writel(val, MPI_CSCTL_REG(cs));
|
|
spin_unlock_irqrestore(&bcm63xx_cs_lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_SYMBOL(bcm63xx_set_cs_timing);
|
|
|
|
/*
|
|
* configure other chipselect parameter (data bus size, ...)
|
|
*/
|
|
int bcm63xx_set_cs_param(unsigned int cs, u32 params)
|
|
{
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
if (!is_valid_cs(cs))
|
|
return -EINVAL;
|
|
|
|
/* none of this fields apply to pcmcia */
|
|
if (cs == MPI_CS_PCMCIA_COMMON ||
|
|
cs == MPI_CS_PCMCIA_ATTR ||
|
|
cs == MPI_CS_PCMCIA_IO)
|
|
return -EINVAL;
|
|
|
|
spin_lock_irqsave(&bcm63xx_cs_lock, flags);
|
|
val = bcm_mpi_readl(MPI_CSCTL_REG(cs));
|
|
val &= ~(MPI_CSCTL_DATA16_MASK);
|
|
val &= ~(MPI_CSCTL_SYNCMODE_MASK);
|
|
val &= ~(MPI_CSCTL_TSIZE_MASK);
|
|
val &= ~(MPI_CSCTL_ENDIANSWAP_MASK);
|
|
val |= params;
|
|
bcm_mpi_writel(val, MPI_CSCTL_REG(cs));
|
|
spin_unlock_irqrestore(&bcm63xx_cs_lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_SYMBOL(bcm63xx_set_cs_param);
|
|
|
|
/*
|
|
* set cs status (enable/disable)
|
|
*/
|
|
int bcm63xx_set_cs_status(unsigned int cs, int enable)
|
|
{
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
if (!is_valid_cs(cs))
|
|
return -EINVAL;
|
|
|
|
spin_lock_irqsave(&bcm63xx_cs_lock, flags);
|
|
val = bcm_mpi_readl(MPI_CSCTL_REG(cs));
|
|
if (enable)
|
|
val |= MPI_CSCTL_ENABLE_MASK;
|
|
else
|
|
val &= ~MPI_CSCTL_ENABLE_MASK;
|
|
bcm_mpi_writel(val, MPI_CSCTL_REG(cs));
|
|
spin_unlock_irqrestore(&bcm63xx_cs_lock, flags);
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_SYMBOL(bcm63xx_set_cs_status);
|