| Maxime Bizon | e7300d0 | 2009-08-18 13:23:37 +0100 | [diff] [blame] | 1 | /* | 
 | 2 |  * This file is subject to the terms and conditions of the GNU General Public | 
 | 3 |  * License.  See the file "COPYING" in the main directory of this archive | 
 | 4 |  * for more details. | 
 | 5 |  * | 
 | 6 |  * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr> | 
 | 7 |  */ | 
 | 8 |  | 
 | 9 | #include <linux/kernel.h> | 
 | 10 | #include <linux/module.h> | 
 | 11 | #include <linux/spinlock.h> | 
 | 12 | #include <linux/log2.h> | 
 | 13 | #include <bcm63xx_cpu.h> | 
 | 14 | #include <bcm63xx_io.h> | 
 | 15 | #include <bcm63xx_regs.h> | 
 | 16 | #include <bcm63xx_cs.h> | 
 | 17 |  | 
 | 18 | static DEFINE_SPINLOCK(bcm63xx_cs_lock); | 
 | 19 |  | 
 | 20 | /* | 
 | 21 |  * check if given chip select exists | 
 | 22 |  */ | 
 | 23 | static int is_valid_cs(unsigned int cs) | 
 | 24 | { | 
 | 25 | 	if (cs > 6) | 
 | 26 | 		return 0; | 
 | 27 | 	return 1; | 
 | 28 | } | 
 | 29 |  | 
 | 30 | /* | 
 | 31 |  * Configure chipselect base address and size (bytes). | 
 | 32 |  * Size must be a power of two between 8k and 256M. | 
 | 33 |  */ | 
 | 34 | int bcm63xx_set_cs_base(unsigned int cs, u32 base, unsigned int size) | 
 | 35 | { | 
 | 36 | 	unsigned long flags; | 
 | 37 | 	u32 val; | 
 | 38 |  | 
 | 39 | 	if (!is_valid_cs(cs)) | 
 | 40 | 		return -EINVAL; | 
 | 41 |  | 
 | 42 | 	/* sanity check on size */ | 
 | 43 | 	if (size != roundup_pow_of_two(size)) | 
 | 44 | 		return -EINVAL; | 
 | 45 |  | 
 | 46 | 	if (size < 8 * 1024 || size > 256 * 1024 * 1024) | 
 | 47 | 		return -EINVAL; | 
 | 48 |  | 
 | 49 | 	val = (base & MPI_CSBASE_BASE_MASK); | 
 | 50 | 	/* 8k => 0 - 256M => 15 */ | 
 | 51 | 	val |= (ilog2(size) - ilog2(8 * 1024)) << MPI_CSBASE_SIZE_SHIFT; | 
 | 52 |  | 
 | 53 | 	spin_lock_irqsave(&bcm63xx_cs_lock, flags); | 
 | 54 | 	bcm_mpi_writel(val, MPI_CSBASE_REG(cs)); | 
 | 55 | 	spin_unlock_irqrestore(&bcm63xx_cs_lock, flags); | 
 | 56 |  | 
 | 57 | 	return 0; | 
 | 58 | } | 
 | 59 |  | 
 | 60 | EXPORT_SYMBOL(bcm63xx_set_cs_base); | 
 | 61 |  | 
 | 62 | /* | 
 | 63 |  * configure chipselect timing (ns) | 
 | 64 |  */ | 
 | 65 | int bcm63xx_set_cs_timing(unsigned int cs, unsigned int wait, | 
 | 66 | 			   unsigned int setup, unsigned int hold) | 
 | 67 | { | 
 | 68 | 	unsigned long flags; | 
 | 69 | 	u32 val; | 
 | 70 |  | 
 | 71 | 	if (!is_valid_cs(cs)) | 
 | 72 | 		return -EINVAL; | 
 | 73 |  | 
 | 74 | 	spin_lock_irqsave(&bcm63xx_cs_lock, flags); | 
 | 75 | 	val = bcm_mpi_readl(MPI_CSCTL_REG(cs)); | 
 | 76 | 	val &= ~(MPI_CSCTL_WAIT_MASK); | 
 | 77 | 	val &= ~(MPI_CSCTL_SETUP_MASK); | 
 | 78 | 	val &= ~(MPI_CSCTL_HOLD_MASK); | 
 | 79 | 	val |= wait << MPI_CSCTL_WAIT_SHIFT; | 
 | 80 | 	val |= setup << MPI_CSCTL_SETUP_SHIFT; | 
 | 81 | 	val |= hold << MPI_CSCTL_HOLD_SHIFT; | 
 | 82 | 	bcm_mpi_writel(val, MPI_CSCTL_REG(cs)); | 
 | 83 | 	spin_unlock_irqrestore(&bcm63xx_cs_lock, flags); | 
 | 84 |  | 
 | 85 | 	return 0; | 
 | 86 | } | 
 | 87 |  | 
 | 88 | EXPORT_SYMBOL(bcm63xx_set_cs_timing); | 
 | 89 |  | 
 | 90 | /* | 
 | 91 |  * configure other chipselect parameter (data bus size, ...) | 
 | 92 |  */ | 
 | 93 | int bcm63xx_set_cs_param(unsigned int cs, u32 params) | 
 | 94 | { | 
 | 95 | 	unsigned long flags; | 
 | 96 | 	u32 val; | 
 | 97 |  | 
 | 98 | 	if (!is_valid_cs(cs)) | 
 | 99 | 		return -EINVAL; | 
 | 100 |  | 
 | 101 | 	/* none of this fields apply to pcmcia */ | 
 | 102 | 	if (cs == MPI_CS_PCMCIA_COMMON || | 
 | 103 | 	    cs == MPI_CS_PCMCIA_ATTR || | 
 | 104 | 	    cs == MPI_CS_PCMCIA_IO) | 
 | 105 | 		return -EINVAL; | 
 | 106 |  | 
 | 107 | 	spin_lock_irqsave(&bcm63xx_cs_lock, flags); | 
 | 108 | 	val = bcm_mpi_readl(MPI_CSCTL_REG(cs)); | 
 | 109 | 	val &= ~(MPI_CSCTL_DATA16_MASK); | 
 | 110 | 	val &= ~(MPI_CSCTL_SYNCMODE_MASK); | 
 | 111 | 	val &= ~(MPI_CSCTL_TSIZE_MASK); | 
 | 112 | 	val &= ~(MPI_CSCTL_ENDIANSWAP_MASK); | 
 | 113 | 	val |= params; | 
 | 114 | 	bcm_mpi_writel(val, MPI_CSCTL_REG(cs)); | 
 | 115 | 	spin_unlock_irqrestore(&bcm63xx_cs_lock, flags); | 
 | 116 |  | 
 | 117 | 	return 0; | 
 | 118 | } | 
 | 119 |  | 
 | 120 | EXPORT_SYMBOL(bcm63xx_set_cs_param); | 
 | 121 |  | 
 | 122 | /* | 
 | 123 |  * set cs status (enable/disable) | 
 | 124 |  */ | 
 | 125 | int bcm63xx_set_cs_status(unsigned int cs, int enable) | 
 | 126 | { | 
 | 127 | 	unsigned long flags; | 
 | 128 | 	u32 val; | 
 | 129 |  | 
 | 130 | 	if (!is_valid_cs(cs)) | 
 | 131 | 		return -EINVAL; | 
 | 132 |  | 
 | 133 | 	spin_lock_irqsave(&bcm63xx_cs_lock, flags); | 
 | 134 | 	val = bcm_mpi_readl(MPI_CSCTL_REG(cs)); | 
 | 135 | 	if (enable) | 
 | 136 | 		val |= MPI_CSCTL_ENABLE_MASK; | 
 | 137 | 	else | 
 | 138 | 		val &= ~MPI_CSCTL_ENABLE_MASK; | 
 | 139 | 	bcm_mpi_writel(val, MPI_CSCTL_REG(cs)); | 
 | 140 | 	spin_unlock_irqrestore(&bcm63xx_cs_lock, flags); | 
 | 141 | 	return 0; | 
 | 142 | } | 
 | 143 |  | 
 | 144 | EXPORT_SYMBOL(bcm63xx_set_cs_status); |