forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
145 lines
3.2 KiB
145 lines
3.2 KiB
/* |
|
* 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 <[email protected]> |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/errno.h> |
|
#include <linux/export.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);
|
|
|