18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * at91_cf.c -- AT91 CompactFlash controller driver 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright (C) 2005 David Brownell 68c2ecf20Sopenharmony_ci */ 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci#include <linux/module.h> 98c2ecf20Sopenharmony_ci#include <linux/kernel.h> 108c2ecf20Sopenharmony_ci#include <linux/platform_device.h> 118c2ecf20Sopenharmony_ci#include <linux/errno.h> 128c2ecf20Sopenharmony_ci#include <linux/init.h> 138c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 148c2ecf20Sopenharmony_ci#include <linux/slab.h> 158c2ecf20Sopenharmony_ci#include <linux/gpio.h> 168c2ecf20Sopenharmony_ci#include <linux/platform_data/atmel.h> 178c2ecf20Sopenharmony_ci#include <linux/io.h> 188c2ecf20Sopenharmony_ci#include <linux/sizes.h> 198c2ecf20Sopenharmony_ci#include <linux/mfd/syscon.h> 208c2ecf20Sopenharmony_ci#include <linux/mfd/syscon/atmel-mc.h> 218c2ecf20Sopenharmony_ci#include <linux/of.h> 228c2ecf20Sopenharmony_ci#include <linux/of_device.h> 238c2ecf20Sopenharmony_ci#include <linux/of_gpio.h> 248c2ecf20Sopenharmony_ci#include <linux/regmap.h> 258c2ecf20Sopenharmony_ci 268c2ecf20Sopenharmony_ci#include <pcmcia/ss.h> 278c2ecf20Sopenharmony_ci 288c2ecf20Sopenharmony_ci/* 298c2ecf20Sopenharmony_ci * A0..A10 work in each range; A23 indicates I/O space; A25 is CFRNW; 308c2ecf20Sopenharmony_ci * some other bit in {A24,A22..A11} is nREG to flag memory access 318c2ecf20Sopenharmony_ci * (vs attributes). So more than 2KB/region would just be waste. 328c2ecf20Sopenharmony_ci * Note: These are offsets from the physical base address. 338c2ecf20Sopenharmony_ci */ 348c2ecf20Sopenharmony_ci#define CF_ATTR_PHYS (0) 358c2ecf20Sopenharmony_ci#define CF_IO_PHYS (1 << 23) 368c2ecf20Sopenharmony_ci#define CF_MEM_PHYS (0x017ff800) 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_cistruct regmap *mc; 398c2ecf20Sopenharmony_ci 408c2ecf20Sopenharmony_ci/*--------------------------------------------------------------------------*/ 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_cistruct at91_cf_socket { 438c2ecf20Sopenharmony_ci struct pcmcia_socket socket; 448c2ecf20Sopenharmony_ci 458c2ecf20Sopenharmony_ci unsigned present:1; 468c2ecf20Sopenharmony_ci 478c2ecf20Sopenharmony_ci struct platform_device *pdev; 488c2ecf20Sopenharmony_ci struct at91_cf_data *board; 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_ci unsigned long phys_baseaddr; 518c2ecf20Sopenharmony_ci}; 528c2ecf20Sopenharmony_ci 538c2ecf20Sopenharmony_cistatic inline int at91_cf_present(struct at91_cf_socket *cf) 548c2ecf20Sopenharmony_ci{ 558c2ecf20Sopenharmony_ci return !gpio_get_value(cf->board->det_pin); 568c2ecf20Sopenharmony_ci} 578c2ecf20Sopenharmony_ci 588c2ecf20Sopenharmony_ci/*--------------------------------------------------------------------------*/ 598c2ecf20Sopenharmony_ci 608c2ecf20Sopenharmony_cistatic int at91_cf_ss_init(struct pcmcia_socket *s) 618c2ecf20Sopenharmony_ci{ 628c2ecf20Sopenharmony_ci return 0; 638c2ecf20Sopenharmony_ci} 648c2ecf20Sopenharmony_ci 658c2ecf20Sopenharmony_cistatic irqreturn_t at91_cf_irq(int irq, void *_cf) 668c2ecf20Sopenharmony_ci{ 678c2ecf20Sopenharmony_ci struct at91_cf_socket *cf = _cf; 688c2ecf20Sopenharmony_ci 698c2ecf20Sopenharmony_ci if (irq == gpio_to_irq(cf->board->det_pin)) { 708c2ecf20Sopenharmony_ci unsigned present = at91_cf_present(cf); 718c2ecf20Sopenharmony_ci 728c2ecf20Sopenharmony_ci /* kick pccard as needed */ 738c2ecf20Sopenharmony_ci if (present != cf->present) { 748c2ecf20Sopenharmony_ci cf->present = present; 758c2ecf20Sopenharmony_ci dev_dbg(&cf->pdev->dev, "card %s\n", 768c2ecf20Sopenharmony_ci present ? "present" : "gone"); 778c2ecf20Sopenharmony_ci pcmcia_parse_events(&cf->socket, SS_DETECT); 788c2ecf20Sopenharmony_ci } 798c2ecf20Sopenharmony_ci } 808c2ecf20Sopenharmony_ci 818c2ecf20Sopenharmony_ci return IRQ_HANDLED; 828c2ecf20Sopenharmony_ci} 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_cistatic int at91_cf_get_status(struct pcmcia_socket *s, u_int *sp) 858c2ecf20Sopenharmony_ci{ 868c2ecf20Sopenharmony_ci struct at91_cf_socket *cf; 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci if (!sp) 898c2ecf20Sopenharmony_ci return -EINVAL; 908c2ecf20Sopenharmony_ci 918c2ecf20Sopenharmony_ci cf = container_of(s, struct at91_cf_socket, socket); 928c2ecf20Sopenharmony_ci 938c2ecf20Sopenharmony_ci /* NOTE: CF is always 3VCARD */ 948c2ecf20Sopenharmony_ci if (at91_cf_present(cf)) { 958c2ecf20Sopenharmony_ci int rdy = gpio_is_valid(cf->board->irq_pin); /* RDY/nIRQ */ 968c2ecf20Sopenharmony_ci int vcc = gpio_is_valid(cf->board->vcc_pin); 978c2ecf20Sopenharmony_ci 988c2ecf20Sopenharmony_ci *sp = SS_DETECT | SS_3VCARD; 998c2ecf20Sopenharmony_ci if (!rdy || gpio_get_value(cf->board->irq_pin)) 1008c2ecf20Sopenharmony_ci *sp |= SS_READY; 1018c2ecf20Sopenharmony_ci if (!vcc || gpio_get_value(cf->board->vcc_pin)) 1028c2ecf20Sopenharmony_ci *sp |= SS_POWERON; 1038c2ecf20Sopenharmony_ci } else 1048c2ecf20Sopenharmony_ci *sp = 0; 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_ci return 0; 1078c2ecf20Sopenharmony_ci} 1088c2ecf20Sopenharmony_ci 1098c2ecf20Sopenharmony_cistatic int 1108c2ecf20Sopenharmony_ciat91_cf_set_socket(struct pcmcia_socket *sock, struct socket_state_t *s) 1118c2ecf20Sopenharmony_ci{ 1128c2ecf20Sopenharmony_ci struct at91_cf_socket *cf; 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_ci cf = container_of(sock, struct at91_cf_socket, socket); 1158c2ecf20Sopenharmony_ci 1168c2ecf20Sopenharmony_ci /* switch Vcc if needed and possible */ 1178c2ecf20Sopenharmony_ci if (gpio_is_valid(cf->board->vcc_pin)) { 1188c2ecf20Sopenharmony_ci switch (s->Vcc) { 1198c2ecf20Sopenharmony_ci case 0: 1208c2ecf20Sopenharmony_ci gpio_set_value(cf->board->vcc_pin, 0); 1218c2ecf20Sopenharmony_ci break; 1228c2ecf20Sopenharmony_ci case 33: 1238c2ecf20Sopenharmony_ci gpio_set_value(cf->board->vcc_pin, 1); 1248c2ecf20Sopenharmony_ci break; 1258c2ecf20Sopenharmony_ci default: 1268c2ecf20Sopenharmony_ci return -EINVAL; 1278c2ecf20Sopenharmony_ci } 1288c2ecf20Sopenharmony_ci } 1298c2ecf20Sopenharmony_ci 1308c2ecf20Sopenharmony_ci /* toggle reset if needed */ 1318c2ecf20Sopenharmony_ci gpio_set_value(cf->board->rst_pin, s->flags & SS_RESET); 1328c2ecf20Sopenharmony_ci 1338c2ecf20Sopenharmony_ci dev_dbg(&cf->pdev->dev, "Vcc %d, io_irq %d, flags %04x csc %04x\n", 1348c2ecf20Sopenharmony_ci s->Vcc, s->io_irq, s->flags, s->csc_mask); 1358c2ecf20Sopenharmony_ci 1368c2ecf20Sopenharmony_ci return 0; 1378c2ecf20Sopenharmony_ci} 1388c2ecf20Sopenharmony_ci 1398c2ecf20Sopenharmony_cistatic int at91_cf_ss_suspend(struct pcmcia_socket *s) 1408c2ecf20Sopenharmony_ci{ 1418c2ecf20Sopenharmony_ci return at91_cf_set_socket(s, &dead_socket); 1428c2ecf20Sopenharmony_ci} 1438c2ecf20Sopenharmony_ci 1448c2ecf20Sopenharmony_ci/* we already mapped the I/O region */ 1458c2ecf20Sopenharmony_cistatic int at91_cf_set_io_map(struct pcmcia_socket *s, struct pccard_io_map *io) 1468c2ecf20Sopenharmony_ci{ 1478c2ecf20Sopenharmony_ci struct at91_cf_socket *cf; 1488c2ecf20Sopenharmony_ci u32 csr; 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_ci cf = container_of(s, struct at91_cf_socket, socket); 1518c2ecf20Sopenharmony_ci io->flags &= (MAP_ACTIVE | MAP_16BIT | MAP_AUTOSZ); 1528c2ecf20Sopenharmony_ci 1538c2ecf20Sopenharmony_ci /* 1548c2ecf20Sopenharmony_ci * Use 16 bit accesses unless/until we need 8-bit i/o space. 1558c2ecf20Sopenharmony_ci * 1568c2ecf20Sopenharmony_ci * NOTE: this CF controller ignores IOIS16, so we can't really do 1578c2ecf20Sopenharmony_ci * MAP_AUTOSZ. The 16bit mode allows single byte access on either 1588c2ecf20Sopenharmony_ci * D0-D7 (even addr) or D8-D15 (odd), so it's close enough for many 1598c2ecf20Sopenharmony_ci * purposes (and handles ide-cs). 1608c2ecf20Sopenharmony_ci * 1618c2ecf20Sopenharmony_ci * The 8bit mode is needed for odd byte access on D0-D7. It seems 1628c2ecf20Sopenharmony_ci * some cards only like that way to get at the odd byte, despite 1638c2ecf20Sopenharmony_ci * CF 3.0 spec table 35 also giving the D8-D15 option. 1648c2ecf20Sopenharmony_ci */ 1658c2ecf20Sopenharmony_ci if (!(io->flags & (MAP_16BIT | MAP_AUTOSZ))) { 1668c2ecf20Sopenharmony_ci csr = AT91_MC_SMC_DBW_8; 1678c2ecf20Sopenharmony_ci dev_dbg(&cf->pdev->dev, "8bit i/o bus\n"); 1688c2ecf20Sopenharmony_ci } else { 1698c2ecf20Sopenharmony_ci csr = AT91_MC_SMC_DBW_16; 1708c2ecf20Sopenharmony_ci dev_dbg(&cf->pdev->dev, "16bit i/o bus\n"); 1718c2ecf20Sopenharmony_ci } 1728c2ecf20Sopenharmony_ci regmap_update_bits(mc, AT91_MC_SMC_CSR(cf->board->chipselect), 1738c2ecf20Sopenharmony_ci AT91_MC_SMC_DBW, csr); 1748c2ecf20Sopenharmony_ci 1758c2ecf20Sopenharmony_ci io->start = cf->socket.io_offset; 1768c2ecf20Sopenharmony_ci io->stop = io->start + SZ_2K - 1; 1778c2ecf20Sopenharmony_ci 1788c2ecf20Sopenharmony_ci return 0; 1798c2ecf20Sopenharmony_ci} 1808c2ecf20Sopenharmony_ci 1818c2ecf20Sopenharmony_ci/* pcmcia layer maps/unmaps mem regions */ 1828c2ecf20Sopenharmony_cistatic int 1838c2ecf20Sopenharmony_ciat91_cf_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *map) 1848c2ecf20Sopenharmony_ci{ 1858c2ecf20Sopenharmony_ci struct at91_cf_socket *cf; 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_ci if (map->card_start) 1888c2ecf20Sopenharmony_ci return -EINVAL; 1898c2ecf20Sopenharmony_ci 1908c2ecf20Sopenharmony_ci cf = container_of(s, struct at91_cf_socket, socket); 1918c2ecf20Sopenharmony_ci 1928c2ecf20Sopenharmony_ci map->flags &= (MAP_ACTIVE | MAP_ATTRIB | MAP_16BIT); 1938c2ecf20Sopenharmony_ci if (map->flags & MAP_ATTRIB) 1948c2ecf20Sopenharmony_ci map->static_start = cf->phys_baseaddr + CF_ATTR_PHYS; 1958c2ecf20Sopenharmony_ci else 1968c2ecf20Sopenharmony_ci map->static_start = cf->phys_baseaddr + CF_MEM_PHYS; 1978c2ecf20Sopenharmony_ci 1988c2ecf20Sopenharmony_ci return 0; 1998c2ecf20Sopenharmony_ci} 2008c2ecf20Sopenharmony_ci 2018c2ecf20Sopenharmony_cistatic struct pccard_operations at91_cf_ops = { 2028c2ecf20Sopenharmony_ci .init = at91_cf_ss_init, 2038c2ecf20Sopenharmony_ci .suspend = at91_cf_ss_suspend, 2048c2ecf20Sopenharmony_ci .get_status = at91_cf_get_status, 2058c2ecf20Sopenharmony_ci .set_socket = at91_cf_set_socket, 2068c2ecf20Sopenharmony_ci .set_io_map = at91_cf_set_io_map, 2078c2ecf20Sopenharmony_ci .set_mem_map = at91_cf_set_mem_map, 2088c2ecf20Sopenharmony_ci}; 2098c2ecf20Sopenharmony_ci 2108c2ecf20Sopenharmony_ci/*--------------------------------------------------------------------------*/ 2118c2ecf20Sopenharmony_ci 2128c2ecf20Sopenharmony_ci#if defined(CONFIG_OF) 2138c2ecf20Sopenharmony_cistatic const struct of_device_id at91_cf_dt_ids[] = { 2148c2ecf20Sopenharmony_ci { .compatible = "atmel,at91rm9200-cf" }, 2158c2ecf20Sopenharmony_ci { /* sentinel */ } 2168c2ecf20Sopenharmony_ci}; 2178c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, at91_cf_dt_ids); 2188c2ecf20Sopenharmony_ci 2198c2ecf20Sopenharmony_cistatic int at91_cf_dt_init(struct platform_device *pdev) 2208c2ecf20Sopenharmony_ci{ 2218c2ecf20Sopenharmony_ci struct at91_cf_data *board; 2228c2ecf20Sopenharmony_ci 2238c2ecf20Sopenharmony_ci board = devm_kzalloc(&pdev->dev, sizeof(*board), GFP_KERNEL); 2248c2ecf20Sopenharmony_ci if (!board) 2258c2ecf20Sopenharmony_ci return -ENOMEM; 2268c2ecf20Sopenharmony_ci 2278c2ecf20Sopenharmony_ci board->irq_pin = of_get_gpio(pdev->dev.of_node, 0); 2288c2ecf20Sopenharmony_ci board->det_pin = of_get_gpio(pdev->dev.of_node, 1); 2298c2ecf20Sopenharmony_ci board->vcc_pin = of_get_gpio(pdev->dev.of_node, 2); 2308c2ecf20Sopenharmony_ci board->rst_pin = of_get_gpio(pdev->dev.of_node, 3); 2318c2ecf20Sopenharmony_ci 2328c2ecf20Sopenharmony_ci pdev->dev.platform_data = board; 2338c2ecf20Sopenharmony_ci 2348c2ecf20Sopenharmony_ci mc = syscon_regmap_lookup_by_compatible("atmel,at91rm9200-sdramc"); 2358c2ecf20Sopenharmony_ci 2368c2ecf20Sopenharmony_ci return PTR_ERR_OR_ZERO(mc); 2378c2ecf20Sopenharmony_ci} 2388c2ecf20Sopenharmony_ci#else 2398c2ecf20Sopenharmony_cistatic int at91_cf_dt_init(struct platform_device *pdev) 2408c2ecf20Sopenharmony_ci{ 2418c2ecf20Sopenharmony_ci return -ENODEV; 2428c2ecf20Sopenharmony_ci} 2438c2ecf20Sopenharmony_ci#endif 2448c2ecf20Sopenharmony_ci 2458c2ecf20Sopenharmony_cistatic int at91_cf_probe(struct platform_device *pdev) 2468c2ecf20Sopenharmony_ci{ 2478c2ecf20Sopenharmony_ci struct at91_cf_socket *cf; 2488c2ecf20Sopenharmony_ci struct at91_cf_data *board = pdev->dev.platform_data; 2498c2ecf20Sopenharmony_ci struct resource *io; 2508c2ecf20Sopenharmony_ci int status; 2518c2ecf20Sopenharmony_ci 2528c2ecf20Sopenharmony_ci if (!board) { 2538c2ecf20Sopenharmony_ci status = at91_cf_dt_init(pdev); 2548c2ecf20Sopenharmony_ci if (status) 2558c2ecf20Sopenharmony_ci return status; 2568c2ecf20Sopenharmony_ci 2578c2ecf20Sopenharmony_ci board = pdev->dev.platform_data; 2588c2ecf20Sopenharmony_ci } 2598c2ecf20Sopenharmony_ci 2608c2ecf20Sopenharmony_ci if (!gpio_is_valid(board->det_pin) || !gpio_is_valid(board->rst_pin)) 2618c2ecf20Sopenharmony_ci return -ENODEV; 2628c2ecf20Sopenharmony_ci 2638c2ecf20Sopenharmony_ci io = platform_get_resource(pdev, IORESOURCE_MEM, 0); 2648c2ecf20Sopenharmony_ci if (!io) 2658c2ecf20Sopenharmony_ci return -ENODEV; 2668c2ecf20Sopenharmony_ci 2678c2ecf20Sopenharmony_ci cf = devm_kzalloc(&pdev->dev, sizeof(*cf), GFP_KERNEL); 2688c2ecf20Sopenharmony_ci if (!cf) 2698c2ecf20Sopenharmony_ci return -ENOMEM; 2708c2ecf20Sopenharmony_ci 2718c2ecf20Sopenharmony_ci cf->board = board; 2728c2ecf20Sopenharmony_ci cf->pdev = pdev; 2738c2ecf20Sopenharmony_ci cf->phys_baseaddr = io->start; 2748c2ecf20Sopenharmony_ci platform_set_drvdata(pdev, cf); 2758c2ecf20Sopenharmony_ci 2768c2ecf20Sopenharmony_ci /* must be a GPIO; ergo must trigger on both edges */ 2778c2ecf20Sopenharmony_ci status = devm_gpio_request(&pdev->dev, board->det_pin, "cf_det"); 2788c2ecf20Sopenharmony_ci if (status < 0) 2798c2ecf20Sopenharmony_ci return status; 2808c2ecf20Sopenharmony_ci 2818c2ecf20Sopenharmony_ci status = devm_request_irq(&pdev->dev, gpio_to_irq(board->det_pin), 2828c2ecf20Sopenharmony_ci at91_cf_irq, 0, "at91_cf detect", cf); 2838c2ecf20Sopenharmony_ci if (status < 0) 2848c2ecf20Sopenharmony_ci return status; 2858c2ecf20Sopenharmony_ci 2868c2ecf20Sopenharmony_ci device_init_wakeup(&pdev->dev, 1); 2878c2ecf20Sopenharmony_ci 2888c2ecf20Sopenharmony_ci status = devm_gpio_request(&pdev->dev, board->rst_pin, "cf_rst"); 2898c2ecf20Sopenharmony_ci if (status < 0) 2908c2ecf20Sopenharmony_ci goto fail0a; 2918c2ecf20Sopenharmony_ci 2928c2ecf20Sopenharmony_ci if (gpio_is_valid(board->vcc_pin)) { 2938c2ecf20Sopenharmony_ci status = devm_gpio_request(&pdev->dev, board->vcc_pin, "cf_vcc"); 2948c2ecf20Sopenharmony_ci if (status < 0) 2958c2ecf20Sopenharmony_ci goto fail0a; 2968c2ecf20Sopenharmony_ci } 2978c2ecf20Sopenharmony_ci 2988c2ecf20Sopenharmony_ci /* 2998c2ecf20Sopenharmony_ci * The card driver will request this irq later as needed. 3008c2ecf20Sopenharmony_ci * but it causes lots of "irqNN: nobody cared" messages 3018c2ecf20Sopenharmony_ci * unless we report that we handle everything (sigh). 3028c2ecf20Sopenharmony_ci * (Note: DK board doesn't wire the IRQ pin...) 3038c2ecf20Sopenharmony_ci */ 3048c2ecf20Sopenharmony_ci if (gpio_is_valid(board->irq_pin)) { 3058c2ecf20Sopenharmony_ci status = devm_gpio_request(&pdev->dev, board->irq_pin, "cf_irq"); 3068c2ecf20Sopenharmony_ci if (status < 0) 3078c2ecf20Sopenharmony_ci goto fail0a; 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_ci status = devm_request_irq(&pdev->dev, gpio_to_irq(board->irq_pin), 3108c2ecf20Sopenharmony_ci at91_cf_irq, IRQF_SHARED, "at91_cf", cf); 3118c2ecf20Sopenharmony_ci if (status < 0) 3128c2ecf20Sopenharmony_ci goto fail0a; 3138c2ecf20Sopenharmony_ci cf->socket.pci_irq = gpio_to_irq(board->irq_pin); 3148c2ecf20Sopenharmony_ci } else 3158c2ecf20Sopenharmony_ci cf->socket.pci_irq = nr_irqs + 1; 3168c2ecf20Sopenharmony_ci 3178c2ecf20Sopenharmony_ci /* 3188c2ecf20Sopenharmony_ci * pcmcia layer only remaps "real" memory not iospace 3198c2ecf20Sopenharmony_ci * io_offset is set to 0x10000 to avoid the check in static_find_io(). 3208c2ecf20Sopenharmony_ci * */ 3218c2ecf20Sopenharmony_ci cf->socket.io_offset = 0x10000; 3228c2ecf20Sopenharmony_ci status = pci_ioremap_io(0x10000, cf->phys_baseaddr + CF_IO_PHYS); 3238c2ecf20Sopenharmony_ci if (status) 3248c2ecf20Sopenharmony_ci goto fail0a; 3258c2ecf20Sopenharmony_ci 3268c2ecf20Sopenharmony_ci /* reserve chip-select regions */ 3278c2ecf20Sopenharmony_ci if (!devm_request_mem_region(&pdev->dev, io->start, resource_size(io), "at91_cf")) { 3288c2ecf20Sopenharmony_ci status = -ENXIO; 3298c2ecf20Sopenharmony_ci goto fail0a; 3308c2ecf20Sopenharmony_ci } 3318c2ecf20Sopenharmony_ci 3328c2ecf20Sopenharmony_ci dev_info(&pdev->dev, "irqs det #%d, io #%d\n", 3338c2ecf20Sopenharmony_ci gpio_to_irq(board->det_pin), gpio_to_irq(board->irq_pin)); 3348c2ecf20Sopenharmony_ci 3358c2ecf20Sopenharmony_ci cf->socket.owner = THIS_MODULE; 3368c2ecf20Sopenharmony_ci cf->socket.dev.parent = &pdev->dev; 3378c2ecf20Sopenharmony_ci cf->socket.ops = &at91_cf_ops; 3388c2ecf20Sopenharmony_ci cf->socket.resource_ops = &pccard_static_ops; 3398c2ecf20Sopenharmony_ci cf->socket.features = SS_CAP_PCCARD | SS_CAP_STATIC_MAP 3408c2ecf20Sopenharmony_ci | SS_CAP_MEM_ALIGN; 3418c2ecf20Sopenharmony_ci cf->socket.map_size = SZ_2K; 3428c2ecf20Sopenharmony_ci cf->socket.io[0].res = io; 3438c2ecf20Sopenharmony_ci 3448c2ecf20Sopenharmony_ci status = pcmcia_register_socket(&cf->socket); 3458c2ecf20Sopenharmony_ci if (status < 0) 3468c2ecf20Sopenharmony_ci goto fail0a; 3478c2ecf20Sopenharmony_ci 3488c2ecf20Sopenharmony_ci return 0; 3498c2ecf20Sopenharmony_ci 3508c2ecf20Sopenharmony_cifail0a: 3518c2ecf20Sopenharmony_ci device_init_wakeup(&pdev->dev, 0); 3528c2ecf20Sopenharmony_ci return status; 3538c2ecf20Sopenharmony_ci} 3548c2ecf20Sopenharmony_ci 3558c2ecf20Sopenharmony_cistatic int at91_cf_remove(struct platform_device *pdev) 3568c2ecf20Sopenharmony_ci{ 3578c2ecf20Sopenharmony_ci struct at91_cf_socket *cf = platform_get_drvdata(pdev); 3588c2ecf20Sopenharmony_ci 3598c2ecf20Sopenharmony_ci pcmcia_unregister_socket(&cf->socket); 3608c2ecf20Sopenharmony_ci device_init_wakeup(&pdev->dev, 0); 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci return 0; 3638c2ecf20Sopenharmony_ci} 3648c2ecf20Sopenharmony_ci 3658c2ecf20Sopenharmony_ci#ifdef CONFIG_PM 3668c2ecf20Sopenharmony_ci 3678c2ecf20Sopenharmony_cistatic int at91_cf_suspend(struct platform_device *pdev, pm_message_t mesg) 3688c2ecf20Sopenharmony_ci{ 3698c2ecf20Sopenharmony_ci struct at91_cf_socket *cf = platform_get_drvdata(pdev); 3708c2ecf20Sopenharmony_ci struct at91_cf_data *board = cf->board; 3718c2ecf20Sopenharmony_ci 3728c2ecf20Sopenharmony_ci if (device_may_wakeup(&pdev->dev)) { 3738c2ecf20Sopenharmony_ci enable_irq_wake(gpio_to_irq(board->det_pin)); 3748c2ecf20Sopenharmony_ci if (gpio_is_valid(board->irq_pin)) 3758c2ecf20Sopenharmony_ci enable_irq_wake(gpio_to_irq(board->irq_pin)); 3768c2ecf20Sopenharmony_ci } 3778c2ecf20Sopenharmony_ci return 0; 3788c2ecf20Sopenharmony_ci} 3798c2ecf20Sopenharmony_ci 3808c2ecf20Sopenharmony_cistatic int at91_cf_resume(struct platform_device *pdev) 3818c2ecf20Sopenharmony_ci{ 3828c2ecf20Sopenharmony_ci struct at91_cf_socket *cf = platform_get_drvdata(pdev); 3838c2ecf20Sopenharmony_ci struct at91_cf_data *board = cf->board; 3848c2ecf20Sopenharmony_ci 3858c2ecf20Sopenharmony_ci if (device_may_wakeup(&pdev->dev)) { 3868c2ecf20Sopenharmony_ci disable_irq_wake(gpio_to_irq(board->det_pin)); 3878c2ecf20Sopenharmony_ci if (gpio_is_valid(board->irq_pin)) 3888c2ecf20Sopenharmony_ci disable_irq_wake(gpio_to_irq(board->irq_pin)); 3898c2ecf20Sopenharmony_ci } 3908c2ecf20Sopenharmony_ci 3918c2ecf20Sopenharmony_ci return 0; 3928c2ecf20Sopenharmony_ci} 3938c2ecf20Sopenharmony_ci 3948c2ecf20Sopenharmony_ci#else 3958c2ecf20Sopenharmony_ci#define at91_cf_suspend NULL 3968c2ecf20Sopenharmony_ci#define at91_cf_resume NULL 3978c2ecf20Sopenharmony_ci#endif 3988c2ecf20Sopenharmony_ci 3998c2ecf20Sopenharmony_cistatic struct platform_driver at91_cf_driver = { 4008c2ecf20Sopenharmony_ci .driver = { 4018c2ecf20Sopenharmony_ci .name = "at91_cf", 4028c2ecf20Sopenharmony_ci .of_match_table = of_match_ptr(at91_cf_dt_ids), 4038c2ecf20Sopenharmony_ci }, 4048c2ecf20Sopenharmony_ci .probe = at91_cf_probe, 4058c2ecf20Sopenharmony_ci .remove = at91_cf_remove, 4068c2ecf20Sopenharmony_ci .suspend = at91_cf_suspend, 4078c2ecf20Sopenharmony_ci .resume = at91_cf_resume, 4088c2ecf20Sopenharmony_ci}; 4098c2ecf20Sopenharmony_ci 4108c2ecf20Sopenharmony_cimodule_platform_driver(at91_cf_driver); 4118c2ecf20Sopenharmony_ci 4128c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("AT91 Compact Flash Driver"); 4138c2ecf20Sopenharmony_ciMODULE_AUTHOR("David Brownell"); 4148c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 4158c2ecf20Sopenharmony_ciMODULE_ALIAS("platform:at91_cf"); 416