Eric Lee / smarc-fsl-linux-kernel

Blame view

drivers/pcmcia/pxa2xx_cm_x255.c 3.01 KB
edit raw normal view history
81f7e3824   Eric Lee   Initial Release, ... 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
 
  /*
   * linux/drivers/pcmcia/pxa/pxa_cm_x255.c
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   *
   * Compulab Ltd., 2003, 2007, 2008
   * Mike Rapoport <mike@compulab.co.il>
   *
   */
  
  #include <linux/platform_device.h>
  #include <linux/irq.h>
  #include <linux/delay.h>
  #include <linux/gpio.h>
  #include <linux/export.h>
  
  #include "soc_common.h"
  
  #define GPIO_PCMCIA_SKTSEL	(54)
  #define GPIO_PCMCIA_S0_CD_VALID	(16)
  #define GPIO_PCMCIA_S1_CD_VALID	(17)
  #define GPIO_PCMCIA_S0_RDYINT	(6)
  #define GPIO_PCMCIA_S1_RDYINT	(8)
  #define GPIO_PCMCIA_RESET	(9)
  
  static int cmx255_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
  {
  	int ret = gpio_request(GPIO_PCMCIA_RESET, "PCCard reset");
  	if (ret)
  		return ret;
  	gpio_direction_output(GPIO_PCMCIA_RESET, 0);
  
  	if (skt->nr == 0) {
  		skt->stat[SOC_STAT_CD].gpio = GPIO_PCMCIA_S0_CD_VALID;
  		skt->stat[SOC_STAT_CD].name = "PCMCIA0 CD";
  		skt->stat[SOC_STAT_RDY].gpio = GPIO_PCMCIA_S0_RDYINT;
  		skt->stat[SOC_STAT_RDY].name = "PCMCIA0 RDY";
  	} else {
  		skt->stat[SOC_STAT_CD].gpio = GPIO_PCMCIA_S1_CD_VALID;
  		skt->stat[SOC_STAT_CD].name = "PCMCIA1 CD";
  		skt->stat[SOC_STAT_RDY].gpio = GPIO_PCMCIA_S1_RDYINT;
  		skt->stat[SOC_STAT_RDY].name = "PCMCIA1 RDY";
  	}
  
  	return 0;
  }
  
  static void cmx255_pcmcia_shutdown(struct soc_pcmcia_socket *skt)
  {
  	gpio_free(GPIO_PCMCIA_RESET);
  }
  
  
  static void cmx255_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
  				       struct pcmcia_state *state)
  {
  	state->vs_3v  = 0;
  	state->vs_Xv  = 0;
  }
  
  
  static int cmx255_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
  					  const socket_state_t *state)
  {
  	switch (skt->nr) {
  	case 0:
  		if (state->flags & SS_RESET) {
  			gpio_set_value(GPIO_PCMCIA_SKTSEL, 0);
  			udelay(1);
  			gpio_set_value(GPIO_PCMCIA_RESET, 1);
  			udelay(10);
  			gpio_set_value(GPIO_PCMCIA_RESET, 0);
  		}
  		break;
  	case 1:
  		if (state->flags & SS_RESET) {
  			gpio_set_value(GPIO_PCMCIA_SKTSEL, 1);
  			udelay(1);
  			gpio_set_value(GPIO_PCMCIA_RESET, 1);
  			udelay(10);
  			gpio_set_value(GPIO_PCMCIA_RESET, 0);
  		}
  		break;
  	}
  
  	return 0;
  }
  
  static struct pcmcia_low_level cmx255_pcmcia_ops __initdata = {
  	.owner			= THIS_MODULE,
  	.hw_init		= cmx255_pcmcia_hw_init,
  	.hw_shutdown		= cmx255_pcmcia_shutdown,
  	.socket_state		= cmx255_pcmcia_socket_state,
  	.configure_socket	= cmx255_pcmcia_configure_socket,
  	.nr			= 1,
  };
  
  static struct platform_device *cmx255_pcmcia_device;
  
  int __init cmx255_pcmcia_init(void)
  {
  	int ret;
  
  	cmx255_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
  
  	if (!cmx255_pcmcia_device)
  		return -ENOMEM;
  
  	ret = platform_device_add_data(cmx255_pcmcia_device, &cmx255_pcmcia_ops,
  				       sizeof(cmx255_pcmcia_ops));
  
  	if (ret == 0) {
  		printk(KERN_INFO "Registering cm-x255 PCMCIA interface.
  ");
  		ret = platform_device_add(cmx255_pcmcia_device);
  	}
  
  	if (ret)
  		platform_device_put(cmx255_pcmcia_device);
  
  	return ret;
  }
  
  void __exit cmx255_pcmcia_exit(void)
  {
  	platform_device_unregister(cmx255_pcmcia_device);
  }