drivers/pcmcia/sa1100_simpad.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /*
0003  * drivers/pcmcia/sa1100_simpad.c
0004  *
0005  * PCMCIA implementation routines for simpad
0006  *
0007  */
0008 #include <linux/module.h>
0009 #include <linux/kernel.h>
0010 #include <linux/device.h>
0011 #include <linux/init.h>
0012
0013 #include <mach/hardware.h>
0014 #include <asm/mach-types.h>
0015 #include <mach/simpad.h>
0016 #include "sa1100_generic.h"
0017
0018 static int simpad_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
0019 {
0020
0021     simpad_clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1);
0022
0023     skt->stat[SOC_STAT_CD].name = "cf-detect";
0024     skt->stat[SOC_STAT_RDY].name = "cf-ready";
0025
0026     return soc_pcmcia_request_gpiods(skt);
0027 }
0028
0029 static void simpad_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
0030 {
0031     /* Disable CF bus: */
0032     /*simpad_set_cs3_bit(PCMCIA_BUFF_DIS);*/
0033     simpad_clear_cs3_bit(PCMCIA_RESET);
0034 }
0035
0036 static void
0037 simpad_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
0038                struct pcmcia_state *state)
0039 {
0040     long cs3reg = simpad_get_cs3_ro();
0041
0042     /* bvd1 might be cs3reg & PCMCIA_BVD1 */
0043     /* bvd2 might be cs3reg & PCMCIA_BVD2 */
0044
0045     if ((cs3reg & (PCMCIA_VS1|PCMCIA_VS2)) ==
0046             (PCMCIA_VS1|PCMCIA_VS2)) {
0047         state->vs_3v=0;
0048         state->vs_Xv=0;
0049     } else {
0050         state->vs_3v=1;
0051         state->vs_Xv=0;
0052     }
0053 }
0054
0055 static int
0056 simpad_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
0057                    const socket_state_t *state)
0058 {
0059     unsigned long flags;
0060
0061     local_irq_save(flags);
0062
0063     /* Murphy: see table of MIC2562a-1 */
0064     switch (state->Vcc) {
0065     case 0:
0066         simpad_clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1);
0067         break;
0068
0069     case 33:
0070         simpad_clear_cs3_bit(VCC_3V_EN|EN1);
0071         simpad_set_cs3_bit(VCC_5V_EN|EN0);
0072         break;
0073
0074     case 50:
0075         simpad_clear_cs3_bit(VCC_5V_EN|EN1);
0076         simpad_set_cs3_bit(VCC_3V_EN|EN0);
0077         break;
0078
0079     default:
0080         printk(KERN_ERR "%s(): unrecognized Vcc %u\n",
0081             __func__, state->Vcc);
0082         simpad_clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1);
0083         local_irq_restore(flags);
0084         return -1;
0085     }
0086
0087
0088     local_irq_restore(flags);
0089
0090     return 0;
0091 }
0092
0093 static void simpad_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
0094 {
0095     simpad_set_cs3_bit(PCMCIA_RESET);
0096 }
0097
0098 static struct pcmcia_low_level simpad_pcmcia_ops = {
0099     .owner          = THIS_MODULE,
0100     .hw_init        = simpad_pcmcia_hw_init,
0101     .hw_shutdown        = simpad_pcmcia_hw_shutdown,
0102     .socket_state       = simpad_pcmcia_socket_state,
0103     .configure_socket   = simpad_pcmcia_configure_socket,
0104     .socket_suspend     = simpad_pcmcia_socket_suspend,
0105 };
0106
0107 int pcmcia_simpad_init(struct device *dev)
0108 {
0109     int ret = -ENODEV;
0110
0111     if (machine_is_simpad())
0112         ret = sa11xx_drv_pcmcia_probe(dev, &simpad_pcmcia_ops, 1, 1);
0113
0114     return ret;
0115 }