static int __init lubbock_irq_device_init(void)
{
if (machine_is_lubbock()) {
register_syscore_ops(&lubbock_irq_syscore_ops);
return 0;
}
return -ENODEV;
}
static int __init lubbock_irq_device_init(void)
{
int ret = -ENODEV;
if (machine_is_lubbock()) {
ret = sysdev_class_register(&lubbock_irq_sysclass);
if (ret == 0)
ret = sysdev_register(&lubbock_irq_device);
}
return ret;
}
static int __init
pxa_leds_init(void)
{
if (machine_is_lubbock())
leds_event = lubbock_leds_event;
if (machine_is_mainstone())
leds_event = mainstone_leds_event;
if (machine_is_pxa_idp())
leds_event = idp_leds_event;
leds_event(led_start);
return 0;
}
static int pcmcia_probe(struct sa1111_dev *dev)
{
void __iomem *base;
int ret;
ret = sa1111_enable_device(dev);
if (ret)
return ret;
dev_set_drvdata(&dev->dev, NULL);
if (!request_mem_region(dev->res.start, 512, SA1111_DRIVER_NAME(dev))) {
sa1111_disable_device(dev);
return -EBUSY;
}
base = dev->mapbase;
/*
* Initialise the suspend state.
*/
writel_relaxed(PCSSR_S0_SLEEP | PCSSR_S1_SLEEP, base + PCSSR);
writel_relaxed(PCCR_S0_FLT | PCCR_S1_FLT, base + PCCR);
ret = -ENODEV;
#ifdef CONFIG_SA1100_BADGE4
if (machine_is_badge4())
ret = pcmcia_badge4_init(dev);
#endif
#ifdef CONFIG_SA1100_JORNADA720
if (machine_is_jornada720())
ret = pcmcia_jornada720_init(dev);
#endif
#ifdef CONFIG_ARCH_LUBBOCK
if (machine_is_lubbock())
ret = pcmcia_lubbock_init(dev);
#endif
#ifdef CONFIG_ASSABET_NEPONSET
if (machine_is_assabet())
ret = pcmcia_neponset_init(dev);
#endif
if (ret) {
release_mem_region(dev->res.start, 512);
sa1111_disable_device(dev);
}
return ret;
}
int pcmcia_lubbock_init(struct sa1111_dev *sadev)
{
int ret = -ENODEV;
if (machine_is_lubbock()) {
sa1111_set_io_dir(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0, 0);
sa1111_set_io(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0);
sa1111_set_sleep_io(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0);
lubbock_set_misc_wr((1 << 15) | (1 << 14), 0);
sadev->dev.platform_data = &lubbock_pcmcia_ops;
ret = __pxa2xx_drv_pcmcia_probe(&sadev->dev);
}
return ret;
}
static void pxa250_do_fir_GPIO_config(void)
{
/*
* Modify GPIO 46 and 47 Alternate Function
*/
__ECHO_IN;
/*Switch AF*/
set_GPIO_mode (GPIO46_ICPRXD_MD);
set_GPIO_mode (GPIO47_ICPTXD_MD);
if (machine_is_lubbock())
LUB_MISC_WR |= 1 << 4;
/*init clock*/
CKEN |= CKEN13_FICP;
__ECHO_OUT;
}
int __init pcmcia_lubbock_init(struct sa1111_dev *sadev)
{
int ret = -ENODEV;
if (machine_is_lubbock()) {
/*
* Set GPIO_A<3:0> to be outputs for the MAX1600,
* and switch to standby mode.
*/
sa1111_set_io_dir(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0, 0);
sa1111_set_io(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0);
sa1111_set_sleep_io(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0);
/* Set CF Socket 1 power to standby mode. */
lubbock_set_misc_wr((1 << 15) | (1 << 14), 0);
sadev->dev.platform_data = &lubbock_pcmcia_ops;
ret = pxa2xx_drv_pcmcia_probe(&sadev->dev);
}
return ret;
}
int pcmcia_lubbock_init(struct sa1111_dev *sadev)
{
int ret = -ENODEV;
if (machine_is_lubbock()) {
/*
* Set GPIO_A<3:0> to be outputs for the MAX1600,
* and switch to standby mode.
*/
sa1111_set_io_dir(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0, 0);
sa1111_set_io(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0);
sa1111_set_sleep_io(sadev, GPIO_A0|GPIO_A1|GPIO_A2|GPIO_A3, 0);
/* Set CF Socket 1 power to standby mode. */
lubbock_set_misc_wr((1 << 15) | (1 << 14), 0);
pxa2xx_drv_pcmcia_ops(&lubbock_pcmcia_ops);
ret = sa1111_pcmcia_add(sadev, &lubbock_pcmcia_ops,
pxa2xx_drv_pcmcia_add_one);
}
return ret;
}
/* pxa_pcmcia_driver_init()
* ^^^^^^^^^^^^^^^^^^^^^^^^^^^
*
* This routine performs a basic sanity check to ensure that this
* kernel has been built with the appropriate board-specific low-level
* PCMCIA support, performs low-level PCMCIA initialization, registers
* this socket driver with Card Services, and then spawns the daemon
* thread which is the real workhorse of the socket driver.
*
* Please see linux/Documentation/arm/SA1100/PCMCIA for more information
* on the low-level kernel interface.
*
* Returns: 0 on success, -1 on error
*/
static int __init pxa_pcmcia_driver_init(void){
servinfo_t info;
struct pcmcia_init pcmcia_init;
struct pcmcia_state state[PXA_PCMCIA_MAX_SOCK];
struct pcmcia_state_array state_array;
unsigned int i, clock;
unsigned long mecr;
printk(KERN_INFO "Intel PXA250/210 PCMCIA (CS release %s)\n", CS_RELEASE);
CardServices(GetCardServicesInfo, &info);
if(info.Revision!=CS_RELEASE_CODE){
printk(KERN_ERR "Card Services release codes do not match\n");
return -1;
}
/* Setup GPIOs for PCMCIA/CF alternate function mode.
*
* It would be nice if set_GPIO_mode included support
* for driving GPIO outputs to default high/low state
* before programming GPIOs as outputs. Setting GPIO
* outputs to default high/low state via GPSR/GPCR
* before defining them as outputs should reduce
* the possibility of glitching outputs during GPIO
* setup. This of course assumes external terminators
* are present to hold GPIOs in a defined state.
*
* In the meantime, setup default state of GPIO
* outputs before we enable them as outputs.
*/
GPSR(GPIO48_nPOE) = GPIO_bit(GPIO48_nPOE) |
GPIO_bit(GPIO49_nPWE) |
GPIO_bit(GPIO50_nPIOR) |
GPIO_bit(GPIO51_nPIOW) |
GPIO_bit(GPIO52_nPCE_1) |
GPIO_bit(GPIO53_nPCE_2);
set_GPIO_mode(GPIO48_nPOE_MD);
set_GPIO_mode(GPIO49_nPWE_MD);
set_GPIO_mode(GPIO50_nPIOR_MD);
set_GPIO_mode(GPIO51_nPIOW_MD);
set_GPIO_mode(GPIO52_nPCE_1_MD);
set_GPIO_mode(GPIO53_nPCE_2_MD);
set_GPIO_mode(GPIO54_pSKTSEL_MD); /* REVISIT: s/b dependent on num sockets */
set_GPIO_mode(GPIO55_nPREG_MD);
set_GPIO_mode(GPIO56_nPWAIT_MD);
set_GPIO_mode(GPIO57_nIOIS16_MD);
if(machine_is_lubbock()){
#ifdef CONFIG_ARCH_LUBBOCK
pcmcia_low_level=&lubbock_pcmcia_ops;
#endif
} else if (machine_is_pxa_idp()) {
pcmcia_low_level=&pxa_idp_pcmcia_ops;
} else if( machine_is_pxa_cerf()){
pcmcia_low_level=&cerf_pcmcia_ops;
}
if (!pcmcia_low_level) {
printk(KERN_ERR "This hardware is not supported by the PXA250/210 Card Service driver\n");
return -ENODEV;
}
pcmcia_init.handler=pxa_pcmcia_interrupt;
if((pxa_pcmcia_socket_count=pcmcia_low_level->init(&pcmcia_init))<0){
printk(KERN_ERR "Unable to initialize kernel PCMCIA service.\n");
return -EIO;
}
state_array.size=pxa_pcmcia_socket_count;
state_array.state=state;
/* Configure MECR based on the number of sockets present. */
if (pxa_pcmcia_socket_count == 2) {
MECR |= GPIO_bit(0);
} else {
MECR &= ~GPIO_bit(0);
}
if(pcmcia_low_level->socket_state(&state_array)<0){
printk(KERN_ERR "Unable to get PCMCIA status from kernel.\n");
return -EIO;
}
/* Well, it looks good to go. So we can now enable the PCMCIA
* controller.
*/
MECR |= GPIO_bit(1);
/* We need to initialize the MCXX registers to default values
* here because we're not guaranteed to see a SetIOMap operation
* at runtime.
*/
clock = get_lclk_frequency_10khz();
for(i=0; i<pxa_pcmcia_socket_count; ++i){
pxa_pcmcia_socket[i].k_state=state[i];
/* This is an interim fix. Apparently, SetSocket is no longer
* called to initialize each socket (prior to the first detect
* event). For now, we'll just manually set up the mask.
*/
pxa_pcmcia_socket[i].cs_state.csc_mask=SS_DETECT;
pxa_pcmcia_socket[i].virt_io=(i==0)?PCMCIA_IO_0_BASE:PCMCIA_IO_1_BASE;
pxa_pcmcia_socket[i].phys_attr=_PCMCIAAttr(i);
pxa_pcmcia_socket[i].phys_mem=_PCMCIAMem(i);
/* REVISIT: cleanup these macros */
//MCIO_SET(i, PXA_PCMCIA_IO_ACCESS, clock);
//MCATTR_SET(i, PXA_PCMCIA_5V_MEM_ACCESS, clock);
//MCMEM_SET(i, PXA_PCMCIA_5V_MEM_ACCESS, clock);
pxa_pcmcia_socket[i].speed_io=PXA_PCMCIA_IO_ACCESS;
pxa_pcmcia_socket[i].speed_attr=PXA_PCMCIA_5V_MEM_ACCESS;
pxa_pcmcia_socket[i].speed_mem=PXA_PCMCIA_5V_MEM_ACCESS;
}
/* REVISIT: cleanup these macros */
MCMEM0 = ((pxa_mcxx_setup(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
| ((pxa_mcxx_asst(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
| ((pxa_mcxx_hold(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
MCMEM1 = ((pxa_mcxx_setup(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
| ((pxa_mcxx_asst(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
| ((pxa_mcxx_hold(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
MCATT0 = ((pxa_mcxx_setup(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
| ((pxa_mcxx_asst(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
| ((pxa_mcxx_hold(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
MCATT1 = ((pxa_mcxx_setup(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
| ((pxa_mcxx_asst(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
| ((pxa_mcxx_hold(PXA_PCMCIA_5V_MEM_ACCESS, clock)
& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
MCIO0 = ((pxa_mcxx_setup(PXA_PCMCIA_IO_ACCESS, clock)
& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
| ((pxa_mcxx_asst(PXA_PCMCIA_IO_ACCESS, clock)
& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
| ((pxa_mcxx_hold(PXA_PCMCIA_IO_ACCESS, clock)
& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
MCIO1 = ((pxa_mcxx_setup(PXA_PCMCIA_IO_ACCESS, clock)
& MCXX_SETUP_MASK) << MCXX_SETUP_SHIFT)
| ((pxa_mcxx_asst(PXA_PCMCIA_IO_ACCESS, clock)
& MCXX_ASST_MASK) << MCXX_ASST_SHIFT)
| ((pxa_mcxx_hold(PXA_PCMCIA_IO_ACCESS, clock)
& MCXX_HOLD_MASK) << MCXX_HOLD_SHIFT);
#ifdef CONFIG_CPU_FREQ
if(cpufreq_register_notifier(&pxa_pcmcia_notifier_block) < 0){
printk(KERN_ERR "Unable to register CPU frequency change notifier\n");
return -ENXIO;
}
#endif
/* Only advertise as many sockets as we can detect: */
if(register_ss_entry(pxa_pcmcia_socket_count,
&pxa_pcmcia_operations)<0){
printk(KERN_ERR "Unable to register socket service routine\n");
return -ENXIO;
}
/* Start the event poll timer. It will reschedule by itself afterwards. */
pxa_pcmcia_poll_event(0);
DEBUG(1, "pxa_cs: initialization complete\n");
return 0;
} /* pxa_pcmcia_driver_init() */
