git.oblomov.eu Git - linux-2.6/blob - drivers/pcmcia/au1000_generic.c

   1 /*
   2  *
   3  * Alchemy Semi Au1000 pcmcia driver
   4  *
   5  * Copyright 2001-2003 MontaVista Software Inc.
   6  * Author: MontaVista Software, Inc.
   7  *              ppopov@embeddedalley.com or source@mvista.com
   8  *
   9  * Copyright 2004 Pete Popov, Embedded Alley Solutions, Inc.
  10  * Updated the driver to 2.6. Followed the sa11xx API and largely
  11  * copied many of the hardware independent functions.
  12  *
  13  * ########################################################################
  14  *
  15  *  This program is free software; you can distribute it and/or modify it
  16  *  under the terms of the GNU General Public License (Version 2) as
  17  *  published by the Free Software Foundation.
  18  *
  19  *  This program is distributed in the hope it will be useful, but WITHOUT
  20  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  21  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  22  *  for more details.
  23  *
  24  *  You should have received a copy of the GNU General Public License along
  25  *  with this program; if not, write to the Free Software Foundation, Inc.,
  26  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  27  *
  28  * ########################################################################
  29  *
  30  *
  31  */
  32
  33 #include <linux/module.h>
  34 #include <linux/moduleparam.h>
  35 #include <linux/init.h>
  36 #include <linux/config.h>
  37 #include <linux/cpufreq.h>
  38 #include <linux/ioport.h>
  39 #include <linux/kernel.h>
  40 #include <linux/timer.h>
  41 #include <linux/mm.h>
  42 #include <linux/notifier.h>
  43 #include <linux/interrupt.h>
  44 #include <linux/spinlock.h>
  45 #include <linux/platform_device.h>
  46
  47 #include <asm/io.h>
  48 #include <asm/irq.h>
  49 #include <asm/system.h>
  50
  51 #include <asm/mach-au1x00/au1000.h>
  52 #include "au1000_generic.h"
  53
  54 MODULE_LICENSE("GPL");
  55 MODULE_AUTHOR("Pete Popov <ppopov@embeddedalley.com>");
  56 MODULE_DESCRIPTION("Linux PCMCIA Card Services: Au1x00 Socket Controller");
  57
  58 #if 0
  59 #define debug(x,args...) printk(KERN_DEBUG "%s: " x, __func__ , ##args)
  60 #else
  61 #define debug(x,args...)
  62 #endif
  63
  64 #define MAP_SIZE 0x100000
  65 extern struct au1000_pcmcia_socket au1000_pcmcia_socket[];
  66 #define PCMCIA_SOCKET(x)        (au1000_pcmcia_socket + (x))
  67 #define to_au1000_socket(x)     container_of(x, struct au1000_pcmcia_socket, socket)
  68
  69 /* Some boards like to support CF cards as IDE root devices, so they
  70  * grab pcmcia sockets directly.
  71  */
  72 u32 *pcmcia_base_vaddrs[2];
  73 extern const unsigned long mips_io_port_base;
  74
  75 DECLARE_MUTEX(pcmcia_sockets_lock);
  76
  77 static int (*au1x00_pcmcia_hw_init[])(struct device *dev) = {
  78         au1x_board_init,
  79 };
  80
  81 static int
  82 au1x00_pcmcia_skt_state(struct au1000_pcmcia_socket *skt)
  83 {
  84         struct pcmcia_state state;
  85         unsigned int stat;
  86
  87         memset(&state, 0, sizeof(struct pcmcia_state));
  88
  89         skt->ops->socket_state(skt, &state);
  90
  91         stat = state.detect  ? SS_DETECT : 0;
  92         stat |= state.ready  ? SS_READY  : 0;
  93         stat |= state.wrprot ? SS_WRPROT : 0;
  94         stat |= state.vs_3v  ? SS_3VCARD : 0;
  95         stat |= state.vs_Xv  ? SS_XVCARD : 0;
  96         stat |= skt->cs_state.Vcc ? SS_POWERON : 0;
  97
  98         if (skt->cs_state.flags & SS_IOCARD)
  99                 stat |= state.bvd1 ? SS_STSCHG : 0;
 100         else {
 101                 if (state.bvd1 == 0)
 102                         stat |= SS_BATDEAD;
 103                 else if (state.bvd2 == 0)
 104                         stat |= SS_BATWARN;
 105         }
 106         return stat;
 107 }
 108
 109 /*
 110  * au100_pcmcia_config_skt
 111  *
 112  * Convert PCMCIA socket state to our socket configure structure.
 113  */
 114 static int
 115 au1x00_pcmcia_config_skt(struct au1000_pcmcia_socket *skt, socket_state_t *state)
 116 {
 117         int ret;
 118
 119         ret = skt->ops->configure_socket(skt, state);
 120         if (ret == 0) {
 121                 skt->cs_state = *state;
 122         }
 123
 124         if (ret < 0)
 125                 debug("unable to configure socket %d\n", skt->nr);
 126
 127         return ret;
 128 }
 129
 130 /* au1x00_pcmcia_sock_init()
 131  *
 132  * (Re-)Initialise the socket, turning on status interrupts
 133  * and PCMCIA bus.  This must wait for power to stabilise
 134  * so that the card status signals report correctly.
 135  *
 136  * Returns: 0
 137  */
 138 static int au1x00_pcmcia_sock_init(struct pcmcia_socket *sock)
 139 {
 140         struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
 141
 142         debug("initializing socket %u\n", skt->nr);
 143
 144         skt->ops->socket_init(skt);
 145         return 0;
 146 }
 147
 148 /*
 149  * au1x00_pcmcia_suspend()
 150  *
 151  * Remove power on the socket, disable IRQs from the card.
 152  * Turn off status interrupts, and disable the PCMCIA bus.
 153  *
 154  * Returns: 0
 155  */
 156 static int au1x00_pcmcia_suspend(struct pcmcia_socket *sock)
 157 {
 158         struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
 159
 160         debug("suspending socket %u\n", skt->nr);
 161
 162         skt->ops->socket_suspend(skt);
 163
 164         return 0;
 165 }
 166
 167 static DEFINE_SPINLOCK(status_lock);
 168
 169 /*
 170  * au1x00_check_status()
 171  */
 172 static void au1x00_check_status(struct au1000_pcmcia_socket *skt)
 173 {
 174         unsigned int events;
 175
 176         debug("entering PCMCIA monitoring thread\n");
 177
 178         do {
 179                 unsigned int status;
 180                 unsigned long flags;
 181
 182                 status = au1x00_pcmcia_skt_state(skt);
 183
 184                 spin_lock_irqsave(&status_lock, flags);
 185                 events = (status ^ skt->status) & skt->cs_state.csc_mask;
 186                 skt->status = status;
 187                 spin_unlock_irqrestore(&status_lock, flags);
 188
 189                 debug("events: %s%s%s%s%s%s\n",
 190                         events == 0         ? "<NONE>"   : "",
 191                         events & SS_DETECT  ? "DETECT "  : "",
 192                         events & SS_READY   ? "READY "   : "",
 193                         events & SS_BATDEAD ? "BATDEAD " : "",
 194                         events & SS_BATWARN ? "BATWARN " : "",
 195                         events & SS_STSCHG  ? "STSCHG "  : "");
 196
 197                 if (events)
 198                         pcmcia_parse_events(&skt->socket, events);
 199         } while (events);
 200 }
 201
 202 /*
 203  * au1x00_pcmcia_poll_event()
 204  * Let's poll for events in addition to IRQs since IRQ only is unreliable...
 205  */
 206 static void au1x00_pcmcia_poll_event(unsigned long dummy)
 207 {
 208         struct au1000_pcmcia_socket *skt = (struct au1000_pcmcia_socket *)dummy;
 209         debug("polling for events\n");
 210
 211         mod_timer(&skt->poll_timer, jiffies + AU1000_PCMCIA_POLL_PERIOD);
 212
 213         au1x00_check_status(skt);
 214 }
 215
 216 /* au1x00_pcmcia_get_status()
 217  *
 218  * From the sa11xx_core.c:
 219  * Implements the get_status() operation for the in-kernel PCMCIA
 220  * service (formerly SS_GetStatus in Card Services). Essentially just
 221  * fills in bits in `status' according to internal driver state or
 222  * the value of the voltage detect chipselect register.
 223  *
 224  * As a debugging note, during card startup, the PCMCIA core issues
 225  * three set_socket() commands in a row the first with RESET deasserted,
 226  * the second with RESET asserted, and the last with RESET deasserted
 227  * again. Following the third set_socket(), a get_status() command will
 228  * be issued. The kernel is looking for the SS_READY flag (see
 229  * setup_socket(), reset_socket(), and unreset_socket() in cs.c).
 230  *
 231  * Returns: 0
 232  */
 233 static int
 234 au1x00_pcmcia_get_status(struct pcmcia_socket *sock, unsigned int *status)
 235 {
 236         struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
 237
 238         skt->status = au1x00_pcmcia_skt_state(skt);
 239         *status = skt->status;
 240
 241         return 0;
 242 }
 243
 244 /* au1x00_pcmcia_set_socket()
 245  * Implements the set_socket() operation for the in-kernel PCMCIA
 246  * service (formerly SS_SetSocket in Card Services). We more or
 247  * less punt all of this work and let the kernel handle the details
 248  * of power configuration, reset, &c. We also record the value of
 249  * `state' in order to regurgitate it to the PCMCIA core later.
 250  *
 251  * Returns: 0
 252  */
 253 static int
 254 au1x00_pcmcia_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
 255 {
 256   struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
 257
 258   debug("for sock %u\n", skt->nr);
 259
 260   debug("\tmask:  %s%s%s%s%s%s\n\tflags: %s%s%s%s%s%s\n",
 261         (state->csc_mask==0)?"<NONE>":"",
 262         (state->csc_mask&SS_DETECT)?"DETECT ":"",
 263         (state->csc_mask&SS_READY)?"READY ":"",
 264         (state->csc_mask&SS_BATDEAD)?"BATDEAD ":"",
 265         (state->csc_mask&SS_BATWARN)?"BATWARN ":"",
 266         (state->csc_mask&SS_STSCHG)?"STSCHG ":"",
 267         (state->flags==0)?"<NONE>":"",
 268         (state->flags&SS_PWR_AUTO)?"PWR_AUTO ":"",
 269         (state->flags&SS_IOCARD)?"IOCARD ":"",
 270         (state->flags&SS_RESET)?"RESET ":"",
 271         (state->flags&SS_SPKR_ENA)?"SPKR_ENA ":"",
 272         (state->flags&SS_OUTPUT_ENA)?"OUTPUT_ENA ":"");
 273   debug("\tVcc %d  Vpp %d  irq %d\n",
 274         state->Vcc, state->Vpp, state->io_irq);
 275
 276   return au1x00_pcmcia_config_skt(skt, state);
 277 }
 278
 279 int
 280 au1x00_pcmcia_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *map)
 281 {
 282         struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
 283         unsigned int speed;
 284
 285         if(map->map>=MAX_IO_WIN){
 286                 debug("map (%d) out of range\n", map->map);
 287                 return -1;
 288         }
 289
 290         if(map->flags&MAP_ACTIVE){
 291                 speed=(map->speed>0)?map->speed:AU1000_PCMCIA_IO_SPEED;
 292                 skt->spd_io[map->map] = speed;
 293         }
 294
 295         map->start=(ioaddr_t)(u32)skt->virt_io;
 296         map->stop=map->start+MAP_SIZE;
 297         return 0;
 298
 299 }  /* au1x00_pcmcia_set_io_map() */
 300
 301
 302 static int
 303 au1x00_pcmcia_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *map)
 304 {
 305         struct au1000_pcmcia_socket *skt = to_au1000_socket(sock);
 306         unsigned short speed = map->speed;
 307
 308         if(map->map>=MAX_WIN){
 309                 debug("map (%d) out of range\n", map->map);
 310                 return -1;
 311         }
 312
 313         if (map->flags & MAP_ATTRIB) {
 314                 skt->spd_attr[map->map] = speed;
 315                 skt->spd_mem[map->map] = 0;
 316         } else {
 317                 skt->spd_attr[map->map] = 0;
 318                 skt->spd_mem[map->map] = speed;
 319         }
 320
 321         if (map->flags & MAP_ATTRIB) {
 322                 map->static_start = skt->phys_attr + map->card_start;
 323         }
 324         else {
 325                 map->static_start = skt->phys_mem + map->card_start;
 326         }
 327
 328         debug("set_mem_map %d start %08lx card_start %08x\n",
 329                         map->map, map->static_start, map->card_start);
 330         return 0;
 331
 332 }  /* au1x00_pcmcia_set_mem_map() */
 333
 334 static struct pccard_operations au1x00_pcmcia_operations = {
 335         .init                   = au1x00_pcmcia_sock_init,
 336         .suspend                = au1x00_pcmcia_suspend,
 337         .get_status             = au1x00_pcmcia_get_status,
 338         .set_socket             = au1x00_pcmcia_set_socket,
 339         .set_io_map             = au1x00_pcmcia_set_io_map,
 340         .set_mem_map            = au1x00_pcmcia_set_mem_map,
 341 };
 342
 343 static const char *skt_names[] = {
 344         "PCMCIA socket 0",
 345         "PCMCIA socket 1",
 346 };
 347
 348 struct skt_dev_info {
 349         int nskt;
 350 };
 351
 352 int au1x00_pcmcia_socket_probe(struct device *dev, struct pcmcia_low_level *ops, int first, int nr)
 353 {
 354         struct skt_dev_info *sinfo;
 355         int ret, i;
 356
 357         sinfo = kzalloc(sizeof(struct skt_dev_info), GFP_KERNEL);
 358         if (!sinfo) {
 359                 ret = -ENOMEM;
 360                 goto out;
 361         }
 362
 363         sinfo->nskt = nr;
 364
 365         /*
 366          * Initialise the per-socket structure.
 367          */
 368         for (i = 0; i < nr; i++) {
 369                 struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i);
 370                 memset(skt, 0, sizeof(*skt));
 371
 372                 skt->socket.resource_ops = &pccard_static_ops;
 373                 skt->socket.ops = &au1x00_pcmcia_operations;
 374                 skt->socket.owner = ops->owner;
 375                 skt->socket.dev.dev = dev;
 376
 377                 init_timer(&skt->poll_timer);
 378                 skt->poll_timer.function = au1x00_pcmcia_poll_event;
 379                 skt->poll_timer.data = (unsigned long)skt;
 380                 skt->poll_timer.expires = jiffies + AU1000_PCMCIA_POLL_PERIOD;
 381
 382                 skt->nr         = first + i;
 383                 skt->irq        = 255;
 384                 skt->dev        = dev;
 385                 skt->ops        = ops;
 386
 387                 skt->res_skt.name       = skt_names[skt->nr];
 388                 skt->res_io.name        = "io";
 389                 skt->res_io.flags       = IORESOURCE_MEM | IORESOURCE_BUSY;
 390                 skt->res_mem.name       = "memory";
 391                 skt->res_mem.flags      = IORESOURCE_MEM;
 392                 skt->res_attr.name      = "attribute";
 393                 skt->res_attr.flags     = IORESOURCE_MEM;
 394
 395                 /*
 396                  * PCMCIA client drivers use the inb/outb macros to access the
 397                  * IO registers. Since mips_io_port_base is added to the
 398                  * access address of the mips implementation of inb/outb,
 399                  * we need to subtract it here because we want to access the
 400                  * I/O or MEM address directly, without going through this
 401                  * "mips_io_port_base" mechanism.
 402                  */
 403                 if (i == 0) {
 404                         skt->virt_io = (void *)
 405                                 (ioremap((phys_t)AU1X_SOCK0_IO, 0x1000) -
 406                                 (u32)mips_io_port_base);
 407                         skt->phys_attr = AU1X_SOCK0_PSEUDO_PHYS_ATTR;
 408                         skt->phys_mem = AU1X_SOCK0_PSEUDO_PHYS_MEM;
 409                 }
 410 #ifndef CONFIG_MIPS_XXS1500
 411                 else  {
 412                         skt->virt_io = (void *)
 413                                 (ioremap((phys_t)AU1X_SOCK1_IO, 0x1000) -
 414                                 (u32)mips_io_port_base);
 415                         skt->phys_attr = AU1X_SOCK1_PSEUDO_PHYS_ATTR;
 416                         skt->phys_mem = AU1X_SOCK1_PSEUDO_PHYS_MEM;
 417                 }
 418 #endif
 419                 pcmcia_base_vaddrs[i] = (u32 *)skt->virt_io;
 420                 ret = ops->hw_init(skt);
 421
 422                 skt->socket.features = SS_CAP_STATIC_MAP|SS_CAP_PCCARD;
 423                 skt->socket.irq_mask = 0;
 424                 skt->socket.map_size = MAP_SIZE;
 425                 skt->socket.pci_irq = skt->irq;
 426                 skt->socket.io_offset = (unsigned long)skt->virt_io;
 427
 428                 skt->status = au1x00_pcmcia_skt_state(skt);
 429
 430                 ret = pcmcia_register_socket(&skt->socket);
 431                 if (ret)
 432                         goto out_err;
 433
 434                 WARN_ON(skt->socket.sock != i);
 435
 436                 add_timer(&skt->poll_timer);
 437         }
 438
 439         dev_set_drvdata(dev, sinfo);
 440         return 0;
 441
 442         do {
 443                 struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i);
 444
 445                 del_timer_sync(&skt->poll_timer);
 446                 pcmcia_unregister_socket(&skt->socket);
 447 out_err:
 448                 flush_scheduled_work();
 449                 ops->hw_shutdown(skt);
 450
 451                 i--;
 452         } while (i > 0);
 453         kfree(sinfo);
 454 out:
 455         return ret;
 456 }
 457
 458 int au1x00_drv_pcmcia_remove(struct device *dev)
 459 {
 460         struct skt_dev_info *sinfo = dev_get_drvdata(dev);
 461         int i;
 462
 463         down(&pcmcia_sockets_lock);
 464         dev_set_drvdata(dev, NULL);
 465
 466         for (i = 0; i < sinfo->nskt; i++) {
 467                 struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i);
 468
 469                 del_timer_sync(&skt->poll_timer);
 470                 pcmcia_unregister_socket(&skt->socket);
 471                 flush_scheduled_work();
 472                 skt->ops->hw_shutdown(skt);
 473                 au1x00_pcmcia_config_skt(skt, &dead_socket);
 474                 iounmap(skt->virt_io + (u32)mips_io_port_base);
 475                 skt->virt_io = NULL;
 476         }
 477
 478         kfree(sinfo);
 479         up(&pcmcia_sockets_lock);
 480         return 0;
 481 }
 482
 483
 484 /*
 485  * PCMCIA "Driver" API
 486  */
 487
 488 static int au1x00_drv_pcmcia_probe(struct device *dev)
 489 {
 490         int i, ret = -ENODEV;
 491
 492         down(&pcmcia_sockets_lock);
 493         for (i=0; i < ARRAY_SIZE(au1x00_pcmcia_hw_init); i++) {
 494                 ret = au1x00_pcmcia_hw_init[i](dev);
 495                 if (ret == 0)
 496                         break;
 497         }
 498         up(&pcmcia_sockets_lock);
 499         return ret;
 500 }
 501
 502
 503 static struct device_driver au1x00_pcmcia_driver = {
 504         .probe          = au1x00_drv_pcmcia_probe,
 505         .remove         = au1x00_drv_pcmcia_remove,
 506         .name           = "au1x00-pcmcia",
 507         .bus            = &platform_bus_type,
 508         .suspend        = pcmcia_socket_dev_suspend,
 509         .resume         = pcmcia_socket_dev_resume,
 510 };
 511
 512
 513 /* au1x00_pcmcia_init()
 514  *
 515  * This routine performs low-level PCMCIA initialization and then
 516  * registers this socket driver with Card Services.
 517  *
 518  * Returns: 0 on success, -ve error code on failure
 519  */
 520 static int __init au1x00_pcmcia_init(void)
 521 {
 522         int error = 0;
 523         if ((error = driver_register(&au1x00_pcmcia_driver)))
 524                 return error;
 525         return error;
 526 }
 527
 528 /* au1x00_pcmcia_exit()
 529  * Invokes the low-level kernel service to free IRQs associated with this
 530  * socket controller and reset GPIO edge detection.
 531  */
 532 static void __exit au1x00_pcmcia_exit(void)
 533 {
 534         driver_unregister(&au1x00_pcmcia_driver);
 535 }
 536
 537 module_init(au1x00_pcmcia_init);
 538 module_exit(au1x00_pcmcia_exit);