mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-30 03:27:44 -04:00
ARM: pxa/mainstone: switch PCMCIA to MAX1600 library and gpiod APIs
Convert mainstone to use the MAX1600 library and gpiod APIs for socket status and control signals. Acked-by: Dominik Brodowski <[email protected]> Signed-off-by: Russell King <[email protected]>
This commit is contained in:
parent
e2125d0517
commit
34fdbe6456
5 changed files with 93 additions and 79 deletions
|
|
@ -211,6 +211,7 @@ config PCMCIA_PXA2XX
|
|||
|| MACH_VPAC270 || MACH_BALLOON3 || MACH_COLIBRI \
|
||||
|| MACH_COLIBRI320 || MACH_H4700)
|
||||
select PCMCIA_SOC_COMMON
|
||||
select PCMCIA_MAX1600 if MACH_MAINSTONE
|
||||
help
|
||||
Say Y here to include support for the PXA2xx PCMCIA controller
|
||||
|
||||
|
|
|
|||
|
|
@ -11,56 +11,55 @@
|
|||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*/
|
||||
|
||||
#include <linux/gpio/consumer.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/platform_device.h>
|
||||
|
||||
#include <pcmcia/ss.h>
|
||||
|
||||
#include <asm/mach-types.h>
|
||||
#include <asm/irq.h>
|
||||
|
||||
#include <mach/pxa2xx-regs.h>
|
||||
#include <mach/mainstone.h>
|
||||
|
||||
#include "soc_common.h"
|
||||
|
||||
#include "max1600.h"
|
||||
|
||||
static int mst_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
|
||||
{
|
||||
/*
|
||||
* Setup default state of GPIO outputs
|
||||
* before we enable them as outputs.
|
||||
*/
|
||||
if (skt->nr == 0) {
|
||||
skt->socket.pci_irq = MAINSTONE_S0_IRQ;
|
||||
skt->stat[SOC_STAT_CD].irq = MAINSTONE_S0_CD_IRQ;
|
||||
skt->stat[SOC_STAT_CD].name = "PCMCIA0 CD";
|
||||
skt->stat[SOC_STAT_BVD1].irq = MAINSTONE_S0_STSCHG_IRQ;
|
||||
skt->stat[SOC_STAT_BVD1].name = "PCMCIA0 STSCHG";
|
||||
} else {
|
||||
skt->socket.pci_irq = MAINSTONE_S1_IRQ;
|
||||
skt->stat[SOC_STAT_CD].irq = MAINSTONE_S1_CD_IRQ;
|
||||
skt->stat[SOC_STAT_CD].name = "PCMCIA1 CD";
|
||||
skt->stat[SOC_STAT_BVD1].irq = MAINSTONE_S1_STSCHG_IRQ;
|
||||
skt->stat[SOC_STAT_BVD1].name = "PCMCIA1 STSCHG";
|
||||
}
|
||||
return 0;
|
||||
struct device *dev = skt->socket.dev.parent;
|
||||
struct max1600 *m;
|
||||
int ret;
|
||||
|
||||
skt->stat[SOC_STAT_CD].name = skt->nr ? "bdetect" : "adetect";
|
||||
skt->stat[SOC_STAT_BVD1].name = skt->nr ? "bbvd1" : "abvd1";
|
||||
skt->stat[SOC_STAT_BVD2].name = skt->nr ? "bbvd2" : "abvd2";
|
||||
skt->stat[SOC_STAT_RDY].name = skt->nr ? "bready" : "aready";
|
||||
skt->stat[SOC_STAT_VS1].name = skt->nr ? "bvs1" : "avs1";
|
||||
skt->stat[SOC_STAT_VS2].name = skt->nr ? "bvs2" : "avs2";
|
||||
|
||||
skt->gpio_reset = devm_gpiod_get(dev, skt->nr ? "breset" : "areset",
|
||||
GPIOD_OUT_HIGH);
|
||||
if (IS_ERR(skt->gpio_reset))
|
||||
return PTR_ERR(skt->gpio_reset);
|
||||
|
||||
ret = max1600_init(dev, &m, skt->nr ? MAX1600_CHAN_B : MAX1600_CHAN_A,
|
||||
MAX1600_CODE_HIGH);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
skt->driver_data = m;
|
||||
|
||||
return soc_pcmcia_request_gpiods(skt);
|
||||
}
|
||||
|
||||
static unsigned long mst_pcmcia_status[2];
|
||||
static unsigned int mst_pcmcia_bvd1_status[2];
|
||||
|
||||
static void mst_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
|
||||
struct pcmcia_state *state)
|
||||
{
|
||||
unsigned long status, flip;
|
||||
|
||||
status = (skt->nr == 0) ? MST_PCMCIA0 : MST_PCMCIA1;
|
||||
flip = (status ^ mst_pcmcia_status[skt->nr]) & MST_PCMCIA_nSTSCHG_BVD1;
|
||||
unsigned int flip = mst_pcmcia_bvd1_status[skt->nr] ^ state->bvd1;
|
||||
|
||||
/*
|
||||
* Workaround for STSCHG which can't be deasserted:
|
||||
|
|
@ -68,62 +67,18 @@ static void mst_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
|
|||
* as needed to avoid IRQ locks.
|
||||
*/
|
||||
if (flip) {
|
||||
mst_pcmcia_status[skt->nr] = status;
|
||||
if (status & MST_PCMCIA_nSTSCHG_BVD1)
|
||||
enable_irq( (skt->nr == 0) ? MAINSTONE_S0_STSCHG_IRQ
|
||||
: MAINSTONE_S1_STSCHG_IRQ );
|
||||
mst_pcmcia_bvd1_status[skt->nr] = state->bvd1;
|
||||
if (state->bvd1)
|
||||
enable_irq(skt->stat[SOC_STAT_BVD1].irq);
|
||||
else
|
||||
disable_irq( (skt->nr == 0) ? MAINSTONE_S0_STSCHG_IRQ
|
||||
: MAINSTONE_S1_STSCHG_IRQ );
|
||||
disable_irq(skt->stat[SOC_STAT_BVD2].irq);
|
||||
}
|
||||
|
||||
state->detect = (status & MST_PCMCIA_nCD) ? 0 : 1;
|
||||
state->ready = (status & MST_PCMCIA_nIRQ) ? 1 : 0;
|
||||
state->bvd1 = (status & MST_PCMCIA_nSTSCHG_BVD1) ? 1 : 0;
|
||||
state->bvd2 = (status & MST_PCMCIA_nSPKR_BVD2) ? 1 : 0;
|
||||
state->vs_3v = (status & MST_PCMCIA_nVS1) ? 0 : 1;
|
||||
state->vs_Xv = (status & MST_PCMCIA_nVS2) ? 0 : 1;
|
||||
}
|
||||
|
||||
static int mst_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
|
||||
const socket_state_t *state)
|
||||
{
|
||||
unsigned long power = 0;
|
||||
int ret = 0;
|
||||
|
||||
switch (state->Vcc) {
|
||||
case 0: power |= MST_PCMCIA_PWR_VCC_0; break;
|
||||
case 33: power |= MST_PCMCIA_PWR_VCC_33; break;
|
||||
case 50: power |= MST_PCMCIA_PWR_VCC_50; break;
|
||||
default:
|
||||
printk(KERN_ERR "%s(): bad Vcc %u\n",
|
||||
__func__, state->Vcc);
|
||||
ret = -1;
|
||||
}
|
||||
|
||||
switch (state->Vpp) {
|
||||
case 0: power |= MST_PCMCIA_PWR_VPP_0; break;
|
||||
case 120: power |= MST_PCMCIA_PWR_VPP_120; break;
|
||||
default:
|
||||
if(state->Vpp == state->Vcc) {
|
||||
power |= MST_PCMCIA_PWR_VPP_VCC;
|
||||
} else {
|
||||
printk(KERN_ERR "%s(): bad Vpp %u\n",
|
||||
__func__, state->Vpp);
|
||||
ret = -1;
|
||||
}
|
||||
}
|
||||
|
||||
if (state->flags & SS_RESET)
|
||||
power |= MST_PCMCIA_RESET;
|
||||
|
||||
switch (skt->nr) {
|
||||
case 0: MST_PCMCIA0 = power; break;
|
||||
case 1: MST_PCMCIA1 = power; break;
|
||||
default: ret = -1;
|
||||
}
|
||||
|
||||
return ret;
|
||||
return max1600_configure(skt->driver_data, state->Vcc, state->Vpp);
|
||||
}
|
||||
|
||||
static struct pcmcia_low_level mst_pcmcia_ops __initdata = {
|
||||
|
|
|
|||
Loading…
Reference in a new issue