Linux Audio

Check our new training course

Yocto distribution development and maintenance

Need a Yocto distribution for your embedded project?
Loading...
v3.1
 
  1/*
  2 * at91_cf.c -- AT91 CompactFlash controller driver
  3 *
  4 * Copyright (C) 2005 David Brownell
  5 *
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License as published by
  8 * the Free Software Foundation; either version 2 of the License, or
  9 * (at your option) any later version.
 10 */
 11
 12#include <linux/module.h>
 13#include <linux/kernel.h>
 14#include <linux/platform_device.h>
 15#include <linux/errno.h>
 16#include <linux/init.h>
 17#include <linux/interrupt.h>
 18#include <linux/slab.h>
 
 
 
 
 
 
 
 
 
 19
 20#include <pcmcia/ss.h>
 21
 22#include <mach/hardware.h>
 23#include <asm/io.h>
 24#include <asm/sizes.h>
 25#include <asm/gpio.h>
 26
 27#include <mach/board.h>
 28#include <mach/at91rm9200_mc.h>
 29
 30
 31/*
 32 * A0..A10 work in each range; A23 indicates I/O space;  A25 is CFRNW;
 33 * some other bit in {A24,A22..A11} is nREG to flag memory access
 34 * (vs attributes).  So more than 2KB/region would just be waste.
 35 * Note: These are offsets from the physical base address.
 36 */
 37#define	CF_ATTR_PHYS	(0)
 38#define	CF_IO_PHYS	(1 << 23)
 39#define	CF_MEM_PHYS	(0x017ff800)
 40
 41/*--------------------------------------------------------------------------*/
 
 
 
 
 
 
 
 
 
 
 
 42
 43static const char driver_name[] = "at91_cf";
 44
 45struct at91_cf_socket {
 46	struct pcmcia_socket	socket;
 47
 48	unsigned		present:1;
 49
 50	struct platform_device	*pdev;
 51	struct at91_cf_data	*board;
 52
 53	unsigned long		phys_baseaddr;
 54};
 55
 56static inline int at91_cf_present(struct at91_cf_socket *cf)
 57{
 58	return !gpio_get_value(cf->board->det_pin);
 59}
 60
 61/*--------------------------------------------------------------------------*/
 62
 63static int at91_cf_ss_init(struct pcmcia_socket *s)
 64{
 65	return 0;
 66}
 67
 68static irqreturn_t at91_cf_irq(int irq, void *_cf)
 69{
 70	struct at91_cf_socket *cf = _cf;
 71
 72	if (irq == cf->board->det_pin) {
 73		unsigned present = at91_cf_present(cf);
 74
 75		/* kick pccard as needed */
 76		if (present != cf->present) {
 77			cf->present = present;
 78			pr_debug("%s: card %s\n", driver_name,
 79					present ? "present" : "gone");
 80			pcmcia_parse_events(&cf->socket, SS_DETECT);
 81		}
 82	}
 83
 84	return IRQ_HANDLED;
 85}
 86
 87static int at91_cf_get_status(struct pcmcia_socket *s, u_int *sp)
 88{
 89	struct at91_cf_socket	*cf;
 90
 91	if (!sp)
 92		return -EINVAL;
 93
 94	cf = container_of(s, struct at91_cf_socket, socket);
 95
 96	/* NOTE: CF is always 3VCARD */
 97	if (at91_cf_present(cf)) {
 98		int rdy	= cf->board->irq_pin;	/* RDY/nIRQ */
 99		int vcc	= cf->board->vcc_pin;
100
101		*sp = SS_DETECT | SS_3VCARD;
102		if (!rdy || gpio_get_value(rdy))
103			*sp |= SS_READY;
104		if (!vcc || gpio_get_value(vcc))
105			*sp |= SS_POWERON;
106	} else
107		*sp = 0;
108
109	return 0;
110}
111
112static int
113at91_cf_set_socket(struct pcmcia_socket *sock, struct socket_state_t *s)
114{
115	struct at91_cf_socket	*cf;
116
117	cf = container_of(sock, struct at91_cf_socket, socket);
118
119	/* switch Vcc if needed and possible */
120	if (cf->board->vcc_pin) {
121		switch (s->Vcc) {
122			case 0:
123				gpio_set_value(cf->board->vcc_pin, 0);
124				break;
125			case 33:
126				gpio_set_value(cf->board->vcc_pin, 1);
127				break;
128			default:
129				return -EINVAL;
130		}
131	}
132
133	/* toggle reset if needed */
134	gpio_set_value(cf->board->rst_pin, s->flags & SS_RESET);
135
136	pr_debug("%s: Vcc %d, io_irq %d, flags %04x csc %04x\n",
137		driver_name, s->Vcc, s->io_irq, s->flags, s->csc_mask);
138
139	return 0;
140}
141
142static int at91_cf_ss_suspend(struct pcmcia_socket *s)
143{
144	return at91_cf_set_socket(s, &dead_socket);
145}
146
147/* we already mapped the I/O region */
148static int at91_cf_set_io_map(struct pcmcia_socket *s, struct pccard_io_map *io)
149{
150	struct at91_cf_socket	*cf;
151	u32			csr;
152
153	cf = container_of(s, struct at91_cf_socket, socket);
154	io->flags &= (MAP_ACTIVE | MAP_16BIT | MAP_AUTOSZ);
155
156	/*
157	 * Use 16 bit accesses unless/until we need 8-bit i/o space.
158	 */
159	csr = at91_sys_read(AT91_SMC_CSR(cf->board->chipselect)) & ~AT91_SMC_DBW;
160
161	/*
162	 * NOTE: this CF controller ignores IOIS16, so we can't really do
163	 * MAP_AUTOSZ.  The 16bit mode allows single byte access on either
164	 * D0-D7 (even addr) or D8-D15 (odd), so it's close enough for many
165	 * purposes (and handles ide-cs).
166	 *
167	 * The 8bit mode is needed for odd byte access on D0-D7.  It seems
168	 * some cards only like that way to get at the odd byte, despite
169	 * CF 3.0 spec table 35 also giving the D8-D15 option.
170	 */
171	if (!(io->flags & (MAP_16BIT | MAP_AUTOSZ))) {
172		csr |= AT91_SMC_DBW_8;
173		pr_debug("%s: 8bit i/o bus\n", driver_name);
174	} else {
175		csr |= AT91_SMC_DBW_16;
176		pr_debug("%s: 16bit i/o bus\n", driver_name);
177	}
178	at91_sys_write(AT91_SMC_CSR(cf->board->chipselect), csr);
 
179
180	io->start = cf->socket.io_offset;
181	io->stop = io->start + SZ_2K - 1;
182
183	return 0;
184}
185
186/* pcmcia layer maps/unmaps mem regions */
187static int
188at91_cf_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *map)
189{
190	struct at91_cf_socket	*cf;
191
192	if (map->card_start)
193		return -EINVAL;
194
195	cf = container_of(s, struct at91_cf_socket, socket);
196
197	map->flags &= (MAP_ACTIVE | MAP_ATTRIB | MAP_16BIT);
198	if (map->flags & MAP_ATTRIB)
199		map->static_start = cf->phys_baseaddr + CF_ATTR_PHYS;
200	else
201		map->static_start = cf->phys_baseaddr + CF_MEM_PHYS;
202
203	return 0;
204}
205
206static struct pccard_operations at91_cf_ops = {
207	.init			= at91_cf_ss_init,
208	.suspend		= at91_cf_ss_suspend,
209	.get_status		= at91_cf_get_status,
210	.set_socket		= at91_cf_set_socket,
211	.set_io_map		= at91_cf_set_io_map,
212	.set_mem_map		= at91_cf_set_mem_map,
213};
214
215/*--------------------------------------------------------------------------*/
216
217static int __init at91_cf_probe(struct platform_device *pdev)
 
 
 
 
 
 
218{
219	struct at91_cf_socket	*cf;
220	struct at91_cf_data	*board = pdev->dev.platform_data;
221	struct resource		*io;
222	int			status;
223
224	if (!board || !board->det_pin || !board->rst_pin)
 
 
 
 
 
 
 
 
 
 
 
 
 
225		return -ENODEV;
226
227	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
228	if (!io)
229		return -ENODEV;
230
231	cf = kzalloc(sizeof *cf, GFP_KERNEL);
232	if (!cf)
233		return -ENOMEM;
234
235	cf->board = board;
236	cf->pdev = pdev;
237	cf->phys_baseaddr = io->start;
238	platform_set_drvdata(pdev, cf);
239
240	/* must be a GPIO; ergo must trigger on both edges */
241	status = gpio_request(board->det_pin, "cf_det");
242	if (status < 0)
243		goto fail0;
244	status = request_irq(board->det_pin, at91_cf_irq, 0, driver_name, cf);
 
 
245	if (status < 0)
246		goto fail00;
 
247	device_init_wakeup(&pdev->dev, 1);
248
249	status = gpio_request(board->rst_pin, "cf_rst");
250	if (status < 0)
251		goto fail0a;
252
253	if (board->vcc_pin) {
254		status = gpio_request(board->vcc_pin, "cf_vcc");
255		if (status < 0)
256			goto fail0b;
257	}
258
259	/*
260	 * The card driver will request this irq later as needed.
261	 * but it causes lots of "irqNN: nobody cared" messages
262	 * unless we report that we handle everything (sigh).
263	 * (Note:  DK board doesn't wire the IRQ pin...)
264	 */
265	if (board->irq_pin) {
266		status = gpio_request(board->irq_pin, "cf_irq");
267		if (status < 0)
268			goto fail0c;
269		status = request_irq(board->irq_pin, at91_cf_irq,
270				IRQF_SHARED, driver_name, cf);
 
271		if (status < 0)
272			goto fail0d;
273		cf->socket.pci_irq = board->irq_pin;
274	} else
275		cf->socket.pci_irq = nr_irqs + 1;
276
277	/* pcmcia layer only remaps "real" memory not iospace */
278	cf->socket.io_offset = (unsigned long)
279			ioremap(cf->phys_baseaddr + CF_IO_PHYS, SZ_2K);
280	if (!cf->socket.io_offset) {
281		status = -ENXIO;
282		goto fail1;
283	}
 
284
285	/* reserve chip-select regions */
286	if (!request_mem_region(io->start, resource_size(io), driver_name)) {
287		status = -ENXIO;
288		goto fail1;
289	}
290
291	pr_info("%s: irqs det #%d, io #%d\n", driver_name,
292		board->det_pin, board->irq_pin);
293
294	cf->socket.owner = THIS_MODULE;
295	cf->socket.dev.parent = &pdev->dev;
296	cf->socket.ops = &at91_cf_ops;
297	cf->socket.resource_ops = &pccard_static_ops;
298	cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP
299				| SS_CAP_MEM_ALIGN;
300	cf->socket.map_size = SZ_2K;
301	cf->socket.io[0].res = io;
302
303	status = pcmcia_register_socket(&cf->socket);
304	if (status < 0)
305		goto fail2;
306
307	return 0;
308
309fail2:
310	release_mem_region(io->start, resource_size(io));
311fail1:
312	if (cf->socket.io_offset)
313		iounmap((void __iomem *) cf->socket.io_offset);
314	if (board->irq_pin) {
315		free_irq(board->irq_pin, cf);
316fail0d:
317		gpio_free(board->irq_pin);
318	}
319fail0c:
320	if (board->vcc_pin)
321		gpio_free(board->vcc_pin);
322fail0b:
323	gpio_free(board->rst_pin);
324fail0a:
325	device_init_wakeup(&pdev->dev, 0);
326	free_irq(board->det_pin, cf);
327fail00:
328	gpio_free(board->det_pin);
329fail0:
330	kfree(cf);
331	return status;
332}
333
334static int __exit at91_cf_remove(struct platform_device *pdev)
335{
336	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
337	struct at91_cf_data	*board = cf->board;
338	struct resource		*io = cf->socket.io[0].res;
339
340	pcmcia_unregister_socket(&cf->socket);
341	release_mem_region(io->start, resource_size(io));
342	iounmap((void __iomem *) cf->socket.io_offset);
343	if (board->irq_pin) {
344		free_irq(board->irq_pin, cf);
345		gpio_free(board->irq_pin);
346	}
347	if (board->vcc_pin)
348		gpio_free(board->vcc_pin);
349	gpio_free(board->rst_pin);
350	device_init_wakeup(&pdev->dev, 0);
351	free_irq(board->det_pin, cf);
352	gpio_free(board->det_pin);
353	kfree(cf);
354	return 0;
355}
356
357#ifdef	CONFIG_PM
358
359static int at91_cf_suspend(struct platform_device *pdev, pm_message_t mesg)
360{
361	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
362	struct at91_cf_data	*board = cf->board;
363
364	if (device_may_wakeup(&pdev->dev)) {
365		enable_irq_wake(board->det_pin);
366		if (board->irq_pin)
367			enable_irq_wake(board->irq_pin);
368	}
369	return 0;
370}
371
372static int at91_cf_resume(struct platform_device *pdev)
373{
374	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
375	struct at91_cf_data	*board = cf->board;
376
377	if (device_may_wakeup(&pdev->dev)) {
378		disable_irq_wake(board->det_pin);
379		if (board->irq_pin)
380			disable_irq_wake(board->irq_pin);
381	}
382
383	return 0;
384}
385
386#else
387#define	at91_cf_suspend		NULL
388#define	at91_cf_resume		NULL
389#endif
390
391static struct platform_driver at91_cf_driver = {
392	.driver = {
393		.name		= (char *) driver_name,
394		.owner		= THIS_MODULE,
395	},
396	.remove		= __exit_p(at91_cf_remove),
 
397	.suspend	= at91_cf_suspend,
398	.resume		= at91_cf_resume,
399};
400
401/*--------------------------------------------------------------------------*/
402
403static int __init at91_cf_init(void)
404{
405	return platform_driver_probe(&at91_cf_driver, at91_cf_probe);
406}
407module_init(at91_cf_init);
408
409static void __exit at91_cf_exit(void)
410{
411	platform_driver_unregister(&at91_cf_driver);
412}
413module_exit(at91_cf_exit);
414
415MODULE_DESCRIPTION("AT91 Compact Flash Driver");
416MODULE_AUTHOR("David Brownell");
417MODULE_LICENSE("GPL");
418MODULE_ALIAS("platform:at91_cf");
v5.14.15
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * at91_cf.c -- AT91 CompactFlash controller driver
  4 *
  5 * Copyright (C) 2005 David Brownell
 
 
 
 
 
  6 */
  7
  8#include <linux/module.h>
  9#include <linux/kernel.h>
 10#include <linux/platform_device.h>
 11#include <linux/errno.h>
 12#include <linux/init.h>
 13#include <linux/interrupt.h>
 14#include <linux/slab.h>
 15#include <linux/gpio.h>
 16#include <linux/io.h>
 17#include <linux/sizes.h>
 18#include <linux/mfd/syscon.h>
 19#include <linux/mfd/syscon/atmel-mc.h>
 20#include <linux/of.h>
 21#include <linux/of_device.h>
 22#include <linux/of_gpio.h>
 23#include <linux/regmap.h>
 24
 25#include <pcmcia/ss.h>
 26
 
 
 
 
 
 
 
 
 
 27/*
 28 * A0..A10 work in each range; A23 indicates I/O space;  A25 is CFRNW;
 29 * some other bit in {A24,A22..A11} is nREG to flag memory access
 30 * (vs attributes).  So more than 2KB/region would just be waste.
 31 * Note: These are offsets from the physical base address.
 32 */
 33#define	CF_ATTR_PHYS	(0)
 34#define	CF_IO_PHYS	(1 << 23)
 35#define	CF_MEM_PHYS	(0x017ff800)
 36
 37struct at91_cf_data {
 38	int	irq_pin;		/* I/O IRQ */
 39	int	det_pin;		/* Card detect */
 40	int	vcc_pin;		/* power switching */
 41	int	rst_pin;		/* card reset */
 42	u8	chipselect;		/* EBI Chip Select number */
 43	u8	flags;
 44#define AT91_CF_TRUE_IDE	0x01
 45#define AT91_IDE_SWAP_A0_A2	0x02
 46};
 47
 48struct regmap *mc;
 49
 50/*--------------------------------------------------------------------------*/
 51
 52struct at91_cf_socket {
 53	struct pcmcia_socket	socket;
 54
 55	unsigned		present:1;
 56
 57	struct platform_device	*pdev;
 58	struct at91_cf_data	*board;
 59
 60	unsigned long		phys_baseaddr;
 61};
 62
 63static inline int at91_cf_present(struct at91_cf_socket *cf)
 64{
 65	return !gpio_get_value(cf->board->det_pin);
 66}
 67
 68/*--------------------------------------------------------------------------*/
 69
 70static int at91_cf_ss_init(struct pcmcia_socket *s)
 71{
 72	return 0;
 73}
 74
 75static irqreturn_t at91_cf_irq(int irq, void *_cf)
 76{
 77	struct at91_cf_socket *cf = _cf;
 78
 79	if (irq == gpio_to_irq(cf->board->det_pin)) {
 80		unsigned present = at91_cf_present(cf);
 81
 82		/* kick pccard as needed */
 83		if (present != cf->present) {
 84			cf->present = present;
 85			dev_dbg(&cf->pdev->dev, "card %s\n",
 86					present ? "present" : "gone");
 87			pcmcia_parse_events(&cf->socket, SS_DETECT);
 88		}
 89	}
 90
 91	return IRQ_HANDLED;
 92}
 93
 94static int at91_cf_get_status(struct pcmcia_socket *s, u_int *sp)
 95{
 96	struct at91_cf_socket	*cf;
 97
 98	if (!sp)
 99		return -EINVAL;
100
101	cf = container_of(s, struct at91_cf_socket, socket);
102
103	/* NOTE: CF is always 3VCARD */
104	if (at91_cf_present(cf)) {
105		int rdy	= gpio_is_valid(cf->board->irq_pin);	/* RDY/nIRQ */
106		int vcc	= gpio_is_valid(cf->board->vcc_pin);
107
108		*sp = SS_DETECT | SS_3VCARD;
109		if (!rdy || gpio_get_value(cf->board->irq_pin))
110			*sp |= SS_READY;
111		if (!vcc || gpio_get_value(cf->board->vcc_pin))
112			*sp |= SS_POWERON;
113	} else
114		*sp = 0;
115
116	return 0;
117}
118
119static int
120at91_cf_set_socket(struct pcmcia_socket *sock, struct socket_state_t *s)
121{
122	struct at91_cf_socket	*cf;
123
124	cf = container_of(sock, struct at91_cf_socket, socket);
125
126	/* switch Vcc if needed and possible */
127	if (gpio_is_valid(cf->board->vcc_pin)) {
128		switch (s->Vcc) {
129		case 0:
130			gpio_set_value(cf->board->vcc_pin, 0);
131			break;
132		case 33:
133			gpio_set_value(cf->board->vcc_pin, 1);
134			break;
135		default:
136			return -EINVAL;
137		}
138	}
139
140	/* toggle reset if needed */
141	gpio_set_value(cf->board->rst_pin, s->flags & SS_RESET);
142
143	dev_dbg(&cf->pdev->dev, "Vcc %d, io_irq %d, flags %04x csc %04x\n",
144				s->Vcc, s->io_irq, s->flags, s->csc_mask);
145
146	return 0;
147}
148
149static int at91_cf_ss_suspend(struct pcmcia_socket *s)
150{
151	return at91_cf_set_socket(s, &dead_socket);
152}
153
154/* we already mapped the I/O region */
155static int at91_cf_set_io_map(struct pcmcia_socket *s, struct pccard_io_map *io)
156{
157	struct at91_cf_socket	*cf;
158	u32			csr;
159
160	cf = container_of(s, struct at91_cf_socket, socket);
161	io->flags &= (MAP_ACTIVE | MAP_16BIT | MAP_AUTOSZ);
162
163	/*
164	 * Use 16 bit accesses unless/until we need 8-bit i/o space.
165	 *
 
 
 
166	 * NOTE: this CF controller ignores IOIS16, so we can't really do
167	 * MAP_AUTOSZ.  The 16bit mode allows single byte access on either
168	 * D0-D7 (even addr) or D8-D15 (odd), so it's close enough for many
169	 * purposes (and handles ide-cs).
170	 *
171	 * The 8bit mode is needed for odd byte access on D0-D7.  It seems
172	 * some cards only like that way to get at the odd byte, despite
173	 * CF 3.0 spec table 35 also giving the D8-D15 option.
174	 */
175	if (!(io->flags & (MAP_16BIT | MAP_AUTOSZ))) {
176		csr = AT91_MC_SMC_DBW_8;
177		dev_dbg(&cf->pdev->dev, "8bit i/o bus\n");
178	} else {
179		csr = AT91_MC_SMC_DBW_16;
180		dev_dbg(&cf->pdev->dev, "16bit i/o bus\n");
181	}
182	regmap_update_bits(mc, AT91_MC_SMC_CSR(cf->board->chipselect),
183			   AT91_MC_SMC_DBW, csr);
184
185	io->start = cf->socket.io_offset;
186	io->stop = io->start + SZ_2K - 1;
187
188	return 0;
189}
190
191/* pcmcia layer maps/unmaps mem regions */
192static int
193at91_cf_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *map)
194{
195	struct at91_cf_socket	*cf;
196
197	if (map->card_start)
198		return -EINVAL;
199
200	cf = container_of(s, struct at91_cf_socket, socket);
201
202	map->flags &= (MAP_ACTIVE | MAP_ATTRIB | MAP_16BIT);
203	if (map->flags & MAP_ATTRIB)
204		map->static_start = cf->phys_baseaddr + CF_ATTR_PHYS;
205	else
206		map->static_start = cf->phys_baseaddr + CF_MEM_PHYS;
207
208	return 0;
209}
210
211static struct pccard_operations at91_cf_ops = {
212	.init			= at91_cf_ss_init,
213	.suspend		= at91_cf_ss_suspend,
214	.get_status		= at91_cf_get_status,
215	.set_socket		= at91_cf_set_socket,
216	.set_io_map		= at91_cf_set_io_map,
217	.set_mem_map		= at91_cf_set_mem_map,
218};
219
220/*--------------------------------------------------------------------------*/
221
222static const struct of_device_id at91_cf_dt_ids[] = {
223	{ .compatible = "atmel,at91rm9200-cf" },
224	{ /* sentinel */ }
225};
226MODULE_DEVICE_TABLE(of, at91_cf_dt_ids);
227
228static int at91_cf_probe(struct platform_device *pdev)
229{
230	struct at91_cf_socket	*cf;
231	struct at91_cf_data	*board;
232	struct resource		*io;
233	int			status;
234
235	board = devm_kzalloc(&pdev->dev, sizeof(*board), GFP_KERNEL);
236	if (!board)
237		return -ENOMEM;
238
239	board->irq_pin = of_get_gpio(pdev->dev.of_node, 0);
240	board->det_pin = of_get_gpio(pdev->dev.of_node, 1);
241	board->vcc_pin = of_get_gpio(pdev->dev.of_node, 2);
242	board->rst_pin = of_get_gpio(pdev->dev.of_node, 3);
243
244	mc = syscon_regmap_lookup_by_compatible("atmel,at91rm9200-sdramc");
245	if (IS_ERR(mc))
246		return PTR_ERR(mc);
247
248	if (!gpio_is_valid(board->det_pin) || !gpio_is_valid(board->rst_pin))
249		return -ENODEV;
250
251	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
252	if (!io)
253		return -ENODEV;
254
255	cf = devm_kzalloc(&pdev->dev, sizeof(*cf), GFP_KERNEL);
256	if (!cf)
257		return -ENOMEM;
258
259	cf->board = board;
260	cf->pdev = pdev;
261	cf->phys_baseaddr = io->start;
262	platform_set_drvdata(pdev, cf);
263
264	/* must be a GPIO; ergo must trigger on both edges */
265	status = devm_gpio_request(&pdev->dev, board->det_pin, "cf_det");
266	if (status < 0)
267		return status;
268
269	status = devm_request_irq(&pdev->dev, gpio_to_irq(board->det_pin),
270					at91_cf_irq, 0, "at91_cf detect", cf);
271	if (status < 0)
272		return status;
273
274	device_init_wakeup(&pdev->dev, 1);
275
276	status = devm_gpio_request(&pdev->dev, board->rst_pin, "cf_rst");
277	if (status < 0)
278		goto fail0a;
279
280	if (gpio_is_valid(board->vcc_pin)) {
281		status = devm_gpio_request(&pdev->dev, board->vcc_pin, "cf_vcc");
282		if (status < 0)
283			goto fail0a;
284	}
285
286	/*
287	 * The card driver will request this irq later as needed.
288	 * but it causes lots of "irqNN: nobody cared" messages
289	 * unless we report that we handle everything (sigh).
290	 * (Note:  DK board doesn't wire the IRQ pin...)
291	 */
292	if (gpio_is_valid(board->irq_pin)) {
293		status = devm_gpio_request(&pdev->dev, board->irq_pin, "cf_irq");
294		if (status < 0)
295			goto fail0a;
296
297		status = devm_request_irq(&pdev->dev, gpio_to_irq(board->irq_pin),
298					at91_cf_irq, IRQF_SHARED, "at91_cf", cf);
299		if (status < 0)
300			goto fail0a;
301		cf->socket.pci_irq = gpio_to_irq(board->irq_pin);
302	} else
303		cf->socket.pci_irq = nr_irqs + 1;
304
305	/*
306	 * pcmcia layer only remaps "real" memory not iospace
307	 * io_offset is set to 0x10000 to avoid the check in static_find_io().
308	 * */
309	cf->socket.io_offset = 0x10000;
310	status = pci_ioremap_io(0x10000, cf->phys_baseaddr + CF_IO_PHYS);
311	if (status)
312		goto fail0a;
313
314	/* reserve chip-select regions */
315	if (!devm_request_mem_region(&pdev->dev, io->start, resource_size(io), "at91_cf")) {
316		status = -ENXIO;
317		goto fail0a;
318	}
319
320	dev_info(&pdev->dev, "irqs det #%d, io #%d\n",
321		gpio_to_irq(board->det_pin), gpio_to_irq(board->irq_pin));
322
323	cf->socket.owner = THIS_MODULE;
324	cf->socket.dev.parent = &pdev->dev;
325	cf->socket.ops = &at91_cf_ops;
326	cf->socket.resource_ops = &pccard_static_ops;
327	cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP
328				| SS_CAP_MEM_ALIGN;
329	cf->socket.map_size = SZ_2K;
330	cf->socket.io[0].res = io;
331
332	status = pcmcia_register_socket(&cf->socket);
333	if (status < 0)
334		goto fail0a;
335
336	return 0;
337
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
338fail0a:
339	device_init_wakeup(&pdev->dev, 0);
 
 
 
 
 
340	return status;
341}
342
343static int at91_cf_remove(struct platform_device *pdev)
344{
345	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
 
 
346
347	pcmcia_unregister_socket(&cf->socket);
 
 
 
 
 
 
 
 
 
348	device_init_wakeup(&pdev->dev, 0);
349
 
 
350	return 0;
351}
352
353#ifdef	CONFIG_PM
354
355static int at91_cf_suspend(struct platform_device *pdev, pm_message_t mesg)
356{
357	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
358	struct at91_cf_data	*board = cf->board;
359
360	if (device_may_wakeup(&pdev->dev)) {
361		enable_irq_wake(gpio_to_irq(board->det_pin));
362		if (gpio_is_valid(board->irq_pin))
363			enable_irq_wake(gpio_to_irq(board->irq_pin));
364	}
365	return 0;
366}
367
368static int at91_cf_resume(struct platform_device *pdev)
369{
370	struct at91_cf_socket	*cf = platform_get_drvdata(pdev);
371	struct at91_cf_data	*board = cf->board;
372
373	if (device_may_wakeup(&pdev->dev)) {
374		disable_irq_wake(gpio_to_irq(board->det_pin));
375		if (gpio_is_valid(board->irq_pin))
376			disable_irq_wake(gpio_to_irq(board->irq_pin));
377	}
378
379	return 0;
380}
381
382#else
383#define	at91_cf_suspend		NULL
384#define	at91_cf_resume		NULL
385#endif
386
387static struct platform_driver at91_cf_driver = {
388	.driver = {
389		.name		= "at91_cf",
390		.of_match_table = at91_cf_dt_ids,
391	},
392	.probe		= at91_cf_probe,
393	.remove		= at91_cf_remove,
394	.suspend	= at91_cf_suspend,
395	.resume		= at91_cf_resume,
396};
397
398module_platform_driver(at91_cf_driver);
 
 
 
 
 
 
 
 
 
 
 
 
399
400MODULE_DESCRIPTION("AT91 Compact Flash Driver");
401MODULE_AUTHOR("David Brownell");
402MODULE_LICENSE("GPL");
403MODULE_ALIAS("platform:at91_cf");