root/drivers/pcmcia/at91_cf.c

DEFINITIONS

1. at91_cf_present
2. at91_cf_ss_init
3. at91_cf_irq
4. at91_cf_get_status
5. at91_cf_set_socket
6. at91_cf_ss_suspend
7. at91_cf_set_io_map
8. at91_cf_set_mem_map
9. at91_cf_dt_init
10. at91_cf_dt_init
11. at91_cf_probe
12. at91_cf_remove
13. at91_cf_suspend
14. at91_cf_resume

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