diff options
Diffstat (limited to 'arch/arm/mach-pxa/palmt5.c')
-rw-r--r-- | arch/arm/mach-pxa/palmt5.c | 111 |
1 files changed, 7 insertions, 104 deletions
diff --git a/arch/arm/mach-pxa/palmt5.c b/arch/arm/mach-pxa/palmt5.c index 33f726ff55e5..2dd7ce28556b 100644 --- a/arch/arm/mach-pxa/palmt5.c +++ b/arch/arm/mach-pxa/palmt5.c | |||
@@ -124,83 +124,12 @@ static unsigned long palmt5_pin_config[] __initdata = { | |||
124 | /****************************************************************************** | 124 | /****************************************************************************** |
125 | * SD/MMC card controller | 125 | * SD/MMC card controller |
126 | ******************************************************************************/ | 126 | ******************************************************************************/ |
127 | static int palmt5_mci_init(struct device *dev, irq_handler_t palmt5_detect_int, | ||
128 | void *data) | ||
129 | { | ||
130 | int err = 0; | ||
131 | |||
132 | /* Setup an interrupt for detecting card insert/remove events */ | ||
133 | err = gpio_request(GPIO_NR_PALMT5_SD_DETECT_N, "SD IRQ"); | ||
134 | if (err) | ||
135 | goto err; | ||
136 | err = gpio_direction_input(GPIO_NR_PALMT5_SD_DETECT_N); | ||
137 | if (err) | ||
138 | goto err2; | ||
139 | err = request_irq(gpio_to_irq(GPIO_NR_PALMT5_SD_DETECT_N), | ||
140 | palmt5_detect_int, IRQF_DISABLED | IRQF_SAMPLE_RANDOM | | ||
141 | IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING, | ||
142 | "SD/MMC card detect", data); | ||
143 | if (err) { | ||
144 | printk(KERN_ERR "%s: cannot request SD/MMC card detect IRQ\n", | ||
145 | __func__); | ||
146 | goto err2; | ||
147 | } | ||
148 | |||
149 | err = gpio_request(GPIO_NR_PALMT5_SD_POWER, "SD_POWER"); | ||
150 | if (err) | ||
151 | goto err3; | ||
152 | err = gpio_direction_output(GPIO_NR_PALMT5_SD_POWER, 0); | ||
153 | if (err) | ||
154 | goto err4; | ||
155 | |||
156 | err = gpio_request(GPIO_NR_PALMT5_SD_READONLY, "SD_READONLY"); | ||
157 | if (err) | ||
158 | goto err4; | ||
159 | err = gpio_direction_input(GPIO_NR_PALMT5_SD_READONLY); | ||
160 | if (err) | ||
161 | goto err5; | ||
162 | |||
163 | printk(KERN_DEBUG "%s: irq registered\n", __func__); | ||
164 | |||
165 | return 0; | ||
166 | |||
167 | err5: | ||
168 | gpio_free(GPIO_NR_PALMT5_SD_READONLY); | ||
169 | err4: | ||
170 | gpio_free(GPIO_NR_PALMT5_SD_POWER); | ||
171 | err3: | ||
172 | free_irq(gpio_to_irq(GPIO_NR_PALMT5_SD_DETECT_N), data); | ||
173 | err2: | ||
174 | gpio_free(GPIO_NR_PALMT5_SD_DETECT_N); | ||
175 | err: | ||
176 | return err; | ||
177 | } | ||
178 | |||
179 | static void palmt5_mci_exit(struct device *dev, void *data) | ||
180 | { | ||
181 | gpio_free(GPIO_NR_PALMT5_SD_READONLY); | ||
182 | gpio_free(GPIO_NR_PALMT5_SD_POWER); | ||
183 | free_irq(IRQ_GPIO_PALMT5_SD_DETECT_N, data); | ||
184 | gpio_free(GPIO_NR_PALMT5_SD_DETECT_N); | ||
185 | } | ||
186 | |||
187 | static void palmt5_mci_power(struct device *dev, unsigned int vdd) | ||
188 | { | ||
189 | struct pxamci_platform_data *p_d = dev->platform_data; | ||
190 | gpio_set_value(GPIO_NR_PALMT5_SD_POWER, p_d->ocr_mask & (1 << vdd)); | ||
191 | } | ||
192 | |||
193 | static int palmt5_mci_get_ro(struct device *dev) | ||
194 | { | ||
195 | return gpio_get_value(GPIO_NR_PALMT5_SD_READONLY); | ||
196 | } | ||
197 | |||
198 | static struct pxamci_platform_data palmt5_mci_platform_data = { | 127 | static struct pxamci_platform_data palmt5_mci_platform_data = { |
199 | .ocr_mask = MMC_VDD_32_33 | MMC_VDD_33_34, | 128 | .ocr_mask = MMC_VDD_32_33 | MMC_VDD_33_34, |
200 | .setpower = palmt5_mci_power, | 129 | .gpio_card_detect = GPIO_NR_PALMT5_SD_DETECT_N, |
201 | .get_ro = palmt5_mci_get_ro, | 130 | .gpio_card_ro = GPIO_NR_PALMT5_SD_READONLY, |
202 | .init = palmt5_mci_init, | 131 | .gpio_power = GPIO_NR_PALMT5_SD_POWER, |
203 | .exit = palmt5_mci_exit, | 132 | .detect_delay = 20, |
204 | }; | 133 | }; |
205 | 134 | ||
206 | /****************************************************************************** | 135 | /****************************************************************************** |
@@ -314,35 +243,9 @@ static struct platform_device palmt5_backlight = { | |||
314 | /****************************************************************************** | 243 | /****************************************************************************** |
315 | * IrDA | 244 | * IrDA |
316 | ******************************************************************************/ | 245 | ******************************************************************************/ |
317 | static int palmt5_irda_startup(struct device *dev) | ||
318 | { | ||
319 | int err; | ||
320 | err = gpio_request(GPIO_NR_PALMT5_IR_DISABLE, "IR DISABLE"); | ||
321 | if (err) | ||
322 | goto err; | ||
323 | err = gpio_direction_output(GPIO_NR_PALMT5_IR_DISABLE, 1); | ||
324 | if (err) | ||
325 | gpio_free(GPIO_NR_PALMT5_IR_DISABLE); | ||
326 | err: | ||
327 | return err; | ||
328 | } | ||
329 | |||
330 | static void palmt5_irda_shutdown(struct device *dev) | ||
331 | { | ||
332 | gpio_free(GPIO_NR_PALMT5_IR_DISABLE); | ||
333 | } | ||
334 | |||
335 | static void palmt5_irda_transceiver_mode(struct device *dev, int mode) | ||
336 | { | ||
337 | gpio_set_value(GPIO_NR_PALMT5_IR_DISABLE, mode & IR_OFF); | ||
338 | pxa2xx_transceiver_mode(dev, mode); | ||
339 | } | ||
340 | |||
341 | static struct pxaficp_platform_data palmt5_ficp_platform_data = { | 246 | static struct pxaficp_platform_data palmt5_ficp_platform_data = { |
342 | .startup = palmt5_irda_startup, | 247 | .gpio_pwdown = GPIO_NR_PALMT5_IR_DISABLE, |
343 | .shutdown = palmt5_irda_shutdown, | 248 | .transceiver_cap = IR_SIRMODE | IR_OFF, |
344 | .transceiver_cap = IR_SIRMODE | IR_FIRMODE | IR_OFF, | ||
345 | .transceiver_mode = palmt5_irda_transceiver_mode, | ||
346 | }; | 249 | }; |
347 | 250 | ||
348 | /****************************************************************************** | 251 | /****************************************************************************** |