1 /* 2 * linux/arch/arm/common/locomo.c 3 * 4 * Sharp LoCoMo support 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 version 2 as 8 * published by the Free Software Foundation. 9 * 10 * This file contains all generic LoCoMo support. 11 * 12 * All initialization functions provided here are intended to be called 13 * from machine specific code with proper arguments when required. 14 * 15 * Based on sa1111.c 16 */ 17 18 #include <linux/config.h> 19 #include <linux/module.h> 20 #include <linux/init.h> 21 #include <linux/kernel.h> 22 #include <linux/delay.h> 23 #include <linux/errno.h> 24 #include <linux/ioport.h> 25 #include <linux/platform_device.h> 26 #include <linux/slab.h> 27 #include <linux/spinlock.h> 28 29 #include <asm/hardware.h> 30 #include <asm/io.h> 31 #include <asm/irq.h> 32 #include <asm/mach/irq.h> 33 34 #include <asm/hardware/locomo.h> 35 36 /* M62332 output channel selection */ 37 #define M62332_EVR_CH 1 /* M62332 volume channel number */ 38 /* 0 : CH.1 , 1 : CH. 2 */ 39 /* DAC send data */ 40 #define M62332_SLAVE_ADDR 0x4e /* Slave address */ 41 #define M62332_W_BIT 0x00 /* W bit (0 only) */ 42 #define M62332_SUB_ADDR 0x00 /* Sub address */ 43 #define M62332_A_BIT 0x00 /* A bit (0 only) */ 44 45 /* DAC setup and hold times (expressed in us) */ 46 #define DAC_BUS_FREE_TIME 5 /* 4.7 us */ 47 #define DAC_START_SETUP_TIME 5 /* 4.7 us */ 48 #define DAC_STOP_SETUP_TIME 4 /* 4.0 us */ 49 #define DAC_START_HOLD_TIME 5 /* 4.7 us */ 50 #define DAC_SCL_LOW_HOLD_TIME 5 /* 4.7 us */ 51 #define DAC_SCL_HIGH_HOLD_TIME 4 /* 4.0 us */ 52 #define DAC_DATA_SETUP_TIME 1 /* 250 ns */ 53 #define DAC_DATA_HOLD_TIME 1 /* 300 ns */ 54 #define DAC_LOW_SETUP_TIME 1 /* 300 ns */ 55 #define DAC_HIGH_SETUP_TIME 1 /* 1000 ns */ 56 57 /* the following is the overall data for the locomo chip */ 58 struct locomo { 59 struct device *dev; 60 unsigned long phys; 61 unsigned int irq; 62 spinlock_t lock; 63 void __iomem *base; 64 }; 65 66 struct locomo_dev_info { 67 unsigned long offset; 68 unsigned long length; 69 unsigned int devid; 70 unsigned int irq[1]; 71 const char * name; 72 }; 73 74 /* All the locomo devices. If offset is non-zero, the mapbase for the 75 * locomo_dev will be set to the chip base plus offset. If offset is 76 * zero, then the mapbase for the locomo_dev will be set to zero. An 77 * offset of zero means the device only uses GPIOs or other helper 78 * functions inside this file */ 79 static struct locomo_dev_info locomo_devices[] = { 80 { 81 .devid = LOCOMO_DEVID_KEYBOARD, 82 .irq = { 83 IRQ_LOCOMO_KEY, 84 }, 85 .name = "locomo-keyboard", 86 .offset = LOCOMO_KEYBOARD, 87 .length = 16, 88 }, 89 { 90 .devid = LOCOMO_DEVID_FRONTLIGHT, 91 .irq = {}, 92 .name = "locomo-frontlight", 93 .offset = LOCOMO_FRONTLIGHT, 94 .length = 8, 95 96 }, 97 { 98 .devid = LOCOMO_DEVID_BACKLIGHT, 99 .irq = {}, 100 .name = "locomo-backlight", 101 .offset = LOCOMO_BACKLIGHT, 102 .length = 8, 103 }, 104 { 105 .devid = LOCOMO_DEVID_AUDIO, 106 .irq = {}, 107 .name = "locomo-audio", 108 .offset = LOCOMO_AUDIO, 109 .length = 4, 110 }, 111 { 112 .devid = LOCOMO_DEVID_LED, 113 .irq = {}, 114 .name = "locomo-led", 115 .offset = LOCOMO_LED, 116 .length = 8, 117 }, 118 { 119 .devid = LOCOMO_DEVID_UART, 120 .irq = {}, 121 .name = "locomo-uart", 122 .offset = 0, 123 .length = 0, 124 }, 125 }; 126 127 128 /** LoCoMo interrupt handling stuff. 129 * NOTE: LoCoMo has a 1 to many mapping on all of its IRQs. 130 * that is, there is only one real hardware interrupt 131 * we determine which interrupt it is by reading some IO memory. 132 * We have two levels of expansion, first in the handler for the 133 * hardware interrupt we generate an interrupt 134 * IRQ_LOCOMO_*_BASE and those handlers generate more interrupts 135 * 136 * hardware irq reads LOCOMO_ICR & 0x0f00 137 * IRQ_LOCOMO_KEY_BASE 138 * IRQ_LOCOMO_GPIO_BASE 139 * IRQ_LOCOMO_LT_BASE 140 * IRQ_LOCOMO_SPI_BASE 141 * IRQ_LOCOMO_KEY_BASE reads LOCOMO_KIC & 0x0001 142 * IRQ_LOCOMO_KEY 143 * IRQ_LOCOMO_GPIO_BASE reads LOCOMO_GIR & LOCOMO_GPD & 0xffff 144 * IRQ_LOCOMO_GPIO[0-15] 145 * IRQ_LOCOMO_LT_BASE reads LOCOMO_LTINT & 0x0001 146 * IRQ_LOCOMO_LT 147 * IRQ_LOCOMO_SPI_BASE reads LOCOMO_SPIIR & 0x000F 148 * IRQ_LOCOMO_SPI_RFR 149 * IRQ_LOCOMO_SPI_RFW 150 * IRQ_LOCOMO_SPI_OVRN 151 * IRQ_LOCOMO_SPI_TEND 152 */ 153 154 #define LOCOMO_IRQ_START (IRQ_LOCOMO_KEY_BASE) 155 #define LOCOMO_IRQ_KEY_START (IRQ_LOCOMO_KEY) 156 #define LOCOMO_IRQ_GPIO_START (IRQ_LOCOMO_GPIO0) 157 #define LOCOMO_IRQ_LT_START (IRQ_LOCOMO_LT) 158 #define LOCOMO_IRQ_SPI_START (IRQ_LOCOMO_SPI_RFR) 159 160 static void locomo_handler(unsigned int irq, struct irqdesc *desc, 161 struct pt_regs *regs) 162 { 163 int req, i; 164 struct irqdesc *d; 165 void __iomem *mapbase = get_irq_chipdata(irq); 166 167 /* Acknowledge the parent IRQ */ 168 desc->chip->ack(irq); 169 170 /* check why this interrupt was generated */ 171 req = locomo_readl(mapbase + LOCOMO_ICR) & 0x0f00; 172 173 if (req) { 174 /* generate the next interrupt(s) */ 175 irq = LOCOMO_IRQ_START; 176 d = irq_desc + irq; 177 for (i = 0; i <= 3; i++, d++, irq++) { 178 if (req & (0x0100 << i)) { 179 desc_handle_irq(irq, d, regs); 180 } 181 182 } 183 } 184 } 185 186 static void locomo_ack_irq(unsigned int irq) 187 { 188 } 189 190 static void locomo_mask_irq(unsigned int irq) 191 { 192 void __iomem *mapbase = get_irq_chipdata(irq); 193 unsigned int r; 194 r = locomo_readl(mapbase + LOCOMO_ICR); 195 r &= ~(0x0010 << (irq - LOCOMO_IRQ_START)); 196 locomo_writel(r, mapbase + LOCOMO_ICR); 197 } 198 199 static void locomo_unmask_irq(unsigned int irq) 200 { 201 void __iomem *mapbase = get_irq_chipdata(irq); 202 unsigned int r; 203 r = locomo_readl(mapbase + LOCOMO_ICR); 204 r |= (0x0010 << (irq - LOCOMO_IRQ_START)); 205 locomo_writel(r, mapbase + LOCOMO_ICR); 206 } 207 208 static struct irqchip locomo_chip = { 209 .ack = locomo_ack_irq, 210 .mask = locomo_mask_irq, 211 .unmask = locomo_unmask_irq, 212 }; 213 214 static void locomo_key_handler(unsigned int irq, struct irqdesc *desc, 215 struct pt_regs *regs) 216 { 217 struct irqdesc *d; 218 void __iomem *mapbase = get_irq_chipdata(irq); 219 220 if (locomo_readl(mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC) & 0x0001) { 221 d = irq_desc + LOCOMO_IRQ_KEY_START; 222 desc_handle_irq(LOCOMO_IRQ_KEY_START, d, regs); 223 } 224 } 225 226 static void locomo_key_ack_irq(unsigned int irq) 227 { 228 void __iomem *mapbase = get_irq_chipdata(irq); 229 unsigned int r; 230 r = locomo_readl(mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC); 231 r &= ~(0x0100 << (irq - LOCOMO_IRQ_KEY_START)); 232 locomo_writel(r, mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC); 233 } 234 235 static void locomo_key_mask_irq(unsigned int irq) 236 { 237 void __iomem *mapbase = get_irq_chipdata(irq); 238 unsigned int r; 239 r = locomo_readl(mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC); 240 r &= ~(0x0010 << (irq - LOCOMO_IRQ_KEY_START)); 241 locomo_writel(r, mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC); 242 } 243 244 static void locomo_key_unmask_irq(unsigned int irq) 245 { 246 void __iomem *mapbase = get_irq_chipdata(irq); 247 unsigned int r; 248 r = locomo_readl(mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC); 249 r |= (0x0010 << (irq - LOCOMO_IRQ_KEY_START)); 250 locomo_writel(r, mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC); 251 } 252 253 static struct irqchip locomo_key_chip = { 254 .ack = locomo_key_ack_irq, 255 .mask = locomo_key_mask_irq, 256 .unmask = locomo_key_unmask_irq, 257 }; 258 259 static void locomo_gpio_handler(unsigned int irq, struct irqdesc *desc, 260 struct pt_regs *regs) 261 { 262 int req, i; 263 struct irqdesc *d; 264 void __iomem *mapbase = get_irq_chipdata(irq); 265 266 req = locomo_readl(mapbase + LOCOMO_GIR) & 267 locomo_readl(mapbase + LOCOMO_GPD) & 268 0xffff; 269 270 if (req) { 271 irq = LOCOMO_IRQ_GPIO_START; 272 d = irq_desc + LOCOMO_IRQ_GPIO_START; 273 for (i = 0; i <= 15; i++, irq++, d++) { 274 if (req & (0x0001 << i)) { 275 desc_handle_irq(irq, d, regs); 276 } 277 } 278 } 279 } 280 281 static void locomo_gpio_ack_irq(unsigned int irq) 282 { 283 void __iomem *mapbase = get_irq_chipdata(irq); 284 unsigned int r; 285 r = locomo_readl(mapbase + LOCOMO_GWE); 286 r |= (0x0001 << (irq - LOCOMO_IRQ_GPIO_START)); 287 locomo_writel(r, mapbase + LOCOMO_GWE); 288 289 r = locomo_readl(mapbase + LOCOMO_GIS); 290 r &= ~(0x0001 << (irq - LOCOMO_IRQ_GPIO_START)); 291 locomo_writel(r, mapbase + LOCOMO_GIS); 292 293 r = locomo_readl(mapbase + LOCOMO_GWE); 294 r &= ~(0x0001 << (irq - LOCOMO_IRQ_GPIO_START)); 295 locomo_writel(r, mapbase + LOCOMO_GWE); 296 } 297 298 static void locomo_gpio_mask_irq(unsigned int irq) 299 { 300 void __iomem *mapbase = get_irq_chipdata(irq); 301 unsigned int r; 302 r = locomo_readl(mapbase + LOCOMO_GIE); 303 r &= ~(0x0001 << (irq - LOCOMO_IRQ_GPIO_START)); 304 locomo_writel(r, mapbase + LOCOMO_GIE); 305 } 306 307 static void locomo_gpio_unmask_irq(unsigned int irq) 308 { 309 void __iomem *mapbase = get_irq_chipdata(irq); 310 unsigned int r; 311 r = locomo_readl(mapbase + LOCOMO_GIE); 312 r |= (0x0001 << (irq - LOCOMO_IRQ_GPIO_START)); 313 locomo_writel(r, mapbase + LOCOMO_GIE); 314 } 315 316 static struct irqchip locomo_gpio_chip = { 317 .ack = locomo_gpio_ack_irq, 318 .mask = locomo_gpio_mask_irq, 319 .unmask = locomo_gpio_unmask_irq, 320 }; 321 322 static void locomo_lt_handler(unsigned int irq, struct irqdesc *desc, 323 struct pt_regs *regs) 324 { 325 struct irqdesc *d; 326 void __iomem *mapbase = get_irq_chipdata(irq); 327 328 if (locomo_readl(mapbase + LOCOMO_LTINT) & 0x0001) { 329 d = irq_desc + LOCOMO_IRQ_LT_START; 330 desc_handle_irq(LOCOMO_IRQ_LT_START, d, regs); 331 } 332 } 333 334 static void locomo_lt_ack_irq(unsigned int irq) 335 { 336 void __iomem *mapbase = get_irq_chipdata(irq); 337 unsigned int r; 338 r = locomo_readl(mapbase + LOCOMO_LTINT); 339 r &= ~(0x0100 << (irq - LOCOMO_IRQ_LT_START)); 340 locomo_writel(r, mapbase + LOCOMO_LTINT); 341 } 342 343 static void locomo_lt_mask_irq(unsigned int irq) 344 { 345 void __iomem *mapbase = get_irq_chipdata(irq); 346 unsigned int r; 347 r = locomo_readl(mapbase + LOCOMO_LTINT); 348 r &= ~(0x0010 << (irq - LOCOMO_IRQ_LT_START)); 349 locomo_writel(r, mapbase + LOCOMO_LTINT); 350 } 351 352 static void locomo_lt_unmask_irq(unsigned int irq) 353 { 354 void __iomem *mapbase = get_irq_chipdata(irq); 355 unsigned int r; 356 r = locomo_readl(mapbase + LOCOMO_LTINT); 357 r |= (0x0010 << (irq - LOCOMO_IRQ_LT_START)); 358 locomo_writel(r, mapbase + LOCOMO_LTINT); 359 } 360 361 static struct irqchip locomo_lt_chip = { 362 .ack = locomo_lt_ack_irq, 363 .mask = locomo_lt_mask_irq, 364 .unmask = locomo_lt_unmask_irq, 365 }; 366 367 static void locomo_spi_handler(unsigned int irq, struct irqdesc *desc, 368 struct pt_regs *regs) 369 { 370 int req, i; 371 struct irqdesc *d; 372 void __iomem *mapbase = get_irq_chipdata(irq); 373 374 req = locomo_readl(mapbase + LOCOMO_SPIIR) & 0x000F; 375 if (req) { 376 irq = LOCOMO_IRQ_SPI_START; 377 d = irq_desc + irq; 378 379 for (i = 0; i <= 3; i++, irq++, d++) { 380 if (req & (0x0001 << i)) { 381 desc_handle_irq(irq, d, regs); 382 } 383 } 384 } 385 } 386 387 static void locomo_spi_ack_irq(unsigned int irq) 388 { 389 void __iomem *mapbase = get_irq_chipdata(irq); 390 unsigned int r; 391 r = locomo_readl(mapbase + LOCOMO_SPIWE); 392 r |= (0x0001 << (irq - LOCOMO_IRQ_SPI_START)); 393 locomo_writel(r, mapbase + LOCOMO_SPIWE); 394 395 r = locomo_readl(mapbase + LOCOMO_SPIIS); 396 r &= ~(0x0001 << (irq - LOCOMO_IRQ_SPI_START)); 397 locomo_writel(r, mapbase + LOCOMO_SPIIS); 398 399 r = locomo_readl(mapbase + LOCOMO_SPIWE); 400 r &= ~(0x0001 << (irq - LOCOMO_IRQ_SPI_START)); 401 locomo_writel(r, mapbase + LOCOMO_SPIWE); 402 } 403 404 static void locomo_spi_mask_irq(unsigned int irq) 405 { 406 void __iomem *mapbase = get_irq_chipdata(irq); 407 unsigned int r; 408 r = locomo_readl(mapbase + LOCOMO_SPIIE); 409 r &= ~(0x0001 << (irq - LOCOMO_IRQ_SPI_START)); 410 locomo_writel(r, mapbase + LOCOMO_SPIIE); 411 } 412 413 static void locomo_spi_unmask_irq(unsigned int irq) 414 { 415 void __iomem *mapbase = get_irq_chipdata(irq); 416 unsigned int r; 417 r = locomo_readl(mapbase + LOCOMO_SPIIE); 418 r |= (0x0001 << (irq - LOCOMO_IRQ_SPI_START)); 419 locomo_writel(r, mapbase + LOCOMO_SPIIE); 420 } 421 422 static struct irqchip locomo_spi_chip = { 423 .ack = locomo_spi_ack_irq, 424 .mask = locomo_spi_mask_irq, 425 .unmask = locomo_spi_unmask_irq, 426 }; 427 428 static void locomo_setup_irq(struct locomo *lchip) 429 { 430 int irq; 431 void __iomem *irqbase = lchip->base; 432 433 /* 434 * Install handler for IRQ_LOCOMO_HW. 435 */ 436 set_irq_type(lchip->irq, IRQT_FALLING); 437 set_irq_chipdata(lchip->irq, irqbase); 438 set_irq_chained_handler(lchip->irq, locomo_handler); 439 440 /* Install handlers for IRQ_LOCOMO_*_BASE */ 441 set_irq_chip(IRQ_LOCOMO_KEY_BASE, &locomo_chip); 442 set_irq_chipdata(IRQ_LOCOMO_KEY_BASE, irqbase); 443 set_irq_chained_handler(IRQ_LOCOMO_KEY_BASE, locomo_key_handler); 444 set_irq_flags(IRQ_LOCOMO_KEY_BASE, IRQF_VALID | IRQF_PROBE); 445 446 set_irq_chip(IRQ_LOCOMO_GPIO_BASE, &locomo_chip); 447 set_irq_chipdata(IRQ_LOCOMO_GPIO_BASE, irqbase); 448 set_irq_chained_handler(IRQ_LOCOMO_GPIO_BASE, locomo_gpio_handler); 449 set_irq_flags(IRQ_LOCOMO_GPIO_BASE, IRQF_VALID | IRQF_PROBE); 450 451 set_irq_chip(IRQ_LOCOMO_LT_BASE, &locomo_chip); 452 set_irq_chipdata(IRQ_LOCOMO_LT_BASE, irqbase); 453 set_irq_chained_handler(IRQ_LOCOMO_LT_BASE, locomo_lt_handler); 454 set_irq_flags(IRQ_LOCOMO_LT_BASE, IRQF_VALID | IRQF_PROBE); 455 456 set_irq_chip(IRQ_LOCOMO_SPI_BASE, &locomo_chip); 457 set_irq_chipdata(IRQ_LOCOMO_SPI_BASE, irqbase); 458 set_irq_chained_handler(IRQ_LOCOMO_SPI_BASE, locomo_spi_handler); 459 set_irq_flags(IRQ_LOCOMO_SPI_BASE, IRQF_VALID | IRQF_PROBE); 460 461 /* install handlers for IRQ_LOCOMO_KEY_BASE generated interrupts */ 462 set_irq_chip(LOCOMO_IRQ_KEY_START, &locomo_key_chip); 463 set_irq_chipdata(LOCOMO_IRQ_KEY_START, irqbase); 464 set_irq_handler(LOCOMO_IRQ_KEY_START, do_edge_IRQ); 465 set_irq_flags(LOCOMO_IRQ_KEY_START, IRQF_VALID | IRQF_PROBE); 466 467 /* install handlers for IRQ_LOCOMO_GPIO_BASE generated interrupts */ 468 for (irq = LOCOMO_IRQ_GPIO_START; irq < LOCOMO_IRQ_GPIO_START + 16; irq++) { 469 set_irq_chip(irq, &locomo_gpio_chip); 470 set_irq_chipdata(irq, irqbase); 471 set_irq_handler(irq, do_edge_IRQ); 472 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE); 473 } 474 475 /* install handlers for IRQ_LOCOMO_LT_BASE generated interrupts */ 476 set_irq_chip(LOCOMO_IRQ_LT_START, &locomo_lt_chip); 477 set_irq_chipdata(LOCOMO_IRQ_LT_START, irqbase); 478 set_irq_handler(LOCOMO_IRQ_LT_START, do_edge_IRQ); 479 set_irq_flags(LOCOMO_IRQ_LT_START, IRQF_VALID | IRQF_PROBE); 480 481 /* install handlers for IRQ_LOCOMO_SPI_BASE generated interrupts */ 482 for (irq = LOCOMO_IRQ_SPI_START; irq < LOCOMO_IRQ_SPI_START + 3; irq++) { 483 set_irq_chip(irq, &locomo_spi_chip); 484 set_irq_chipdata(irq, irqbase); 485 set_irq_handler(irq, do_edge_IRQ); 486 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE); 487 } 488 } 489 490 491 static void locomo_dev_release(struct device *_dev) 492 { 493 struct locomo_dev *dev = LOCOMO_DEV(_dev); 494 495 kfree(dev); 496 } 497 498 static int 499 locomo_init_one_child(struct locomo *lchip, struct locomo_dev_info *info) 500 { 501 struct locomo_dev *dev; 502 int ret; 503 504 dev = kzalloc(sizeof(struct locomo_dev), GFP_KERNEL); 505 if (!dev) { 506 ret = -ENOMEM; 507 goto out; 508 } 509 510 strncpy(dev->dev.bus_id,info->name,sizeof(dev->dev.bus_id)); 511 /* 512 * If the parent device has a DMA mask associated with it, 513 * propagate it down to the children. 514 */ 515 if (lchip->dev->dma_mask) { 516 dev->dma_mask = *lchip->dev->dma_mask; 517 dev->dev.dma_mask = &dev->dma_mask; 518 } 519 520 dev->devid = info->devid; 521 dev->dev.parent = lchip->dev; 522 dev->dev.bus = &locomo_bus_type; 523 dev->dev.release = locomo_dev_release; 524 dev->dev.coherent_dma_mask = lchip->dev->coherent_dma_mask; 525 526 if (info->offset) 527 dev->mapbase = lchip->base + info->offset; 528 else 529 dev->mapbase = 0; 530 dev->length = info->length; 531 532 memmove(dev->irq, info->irq, sizeof(dev->irq)); 533 534 ret = device_register(&dev->dev); 535 if (ret) { 536 out: 537 kfree(dev); 538 } 539 return ret; 540 } 541 542 #ifdef CONFIG_PM 543 544 struct locomo_save_data { 545 u16 LCM_GPO; 546 u16 LCM_SPICT; 547 u16 LCM_GPE; 548 u16 LCM_ASD; 549 u16 LCM_SPIMD; 550 }; 551 552 static int locomo_suspend(struct platform_device *dev, pm_message_t state) 553 { 554 struct locomo *lchip = platform_get_drvdata(dev); 555 struct locomo_save_data *save; 556 unsigned long flags; 557 558 save = kmalloc(sizeof(struct locomo_save_data), GFP_KERNEL); 559 if (!save) 560 return -ENOMEM; 561 562 dev->dev.power.saved_state = (void *) save; 563 564 spin_lock_irqsave(&lchip->lock, flags); 565 566 save->LCM_GPO = locomo_readl(lchip->base + LOCOMO_GPO); /* GPIO */ 567 locomo_writel(0x00, lchip->base + LOCOMO_GPO); 568 save->LCM_SPICT = locomo_readl(lchip->base + LOCOMO_SPICT); /* SPI */ 569 locomo_writel(0x40, lchip->base + LOCOMO_SPICT); 570 save->LCM_GPE = locomo_readl(lchip->base + LOCOMO_GPE); /* GPIO */ 571 locomo_writel(0x00, lchip->base + LOCOMO_GPE); 572 save->LCM_ASD = locomo_readl(lchip->base + LOCOMO_ASD); /* ADSTART */ 573 locomo_writel(0x00, lchip->base + LOCOMO_ASD); 574 save->LCM_SPIMD = locomo_readl(lchip->base + LOCOMO_SPIMD); /* SPI */ 575 locomo_writel(0x3C14, lchip->base + LOCOMO_SPIMD); 576 577 locomo_writel(0x00, lchip->base + LOCOMO_PAIF); 578 locomo_writel(0x00, lchip->base + LOCOMO_DAC); 579 locomo_writel(0x00, lchip->base + LOCOMO_BACKLIGHT + LOCOMO_TC); 580 581 if ( (locomo_readl(lchip->base + LOCOMO_LED + LOCOMO_LPT0) & 0x88) && (locomo_readl(lchip->base + LOCOMO_LED + LOCOMO_LPT1) & 0x88) ) 582 locomo_writel(0x00, lchip->base + LOCOMO_C32K); /* CLK32 off */ 583 else 584 /* 18MHz already enabled, so no wait */ 585 locomo_writel(0xc1, lchip->base + LOCOMO_C32K); /* CLK32 on */ 586 587 locomo_writel(0x00, lchip->base + LOCOMO_TADC); /* 18MHz clock off*/ 588 locomo_writel(0x00, lchip->base + LOCOMO_AUDIO + LOCOMO_ACC); /* 22MHz/24MHz clock off */ 589 locomo_writel(0x00, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); /* FL */ 590 591 spin_unlock_irqrestore(&lchip->lock, flags); 592 593 return 0; 594 } 595 596 static int locomo_resume(struct platform_device *dev) 597 { 598 struct locomo *lchip = platform_get_drvdata(dev); 599 struct locomo_save_data *save; 600 unsigned long r; 601 unsigned long flags; 602 603 save = (struct locomo_save_data *) dev->dev.power.saved_state; 604 if (!save) 605 return 0; 606 607 spin_lock_irqsave(&lchip->lock, flags); 608 609 locomo_writel(save->LCM_GPO, lchip->base + LOCOMO_GPO); 610 locomo_writel(save->LCM_SPICT, lchip->base + LOCOMO_SPICT); 611 locomo_writel(save->LCM_GPE, lchip->base + LOCOMO_GPE); 612 locomo_writel(save->LCM_ASD, lchip->base + LOCOMO_ASD); 613 locomo_writel(save->LCM_SPIMD, lchip->base + LOCOMO_SPIMD); 614 615 locomo_writel(0x00, lchip->base + LOCOMO_C32K); 616 locomo_writel(0x90, lchip->base + LOCOMO_TADC); 617 618 locomo_writel(0, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KSC); 619 r = locomo_readl(lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC); 620 r &= 0xFEFF; 621 locomo_writel(r, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC); 622 locomo_writel(0x1, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KCMD); 623 624 spin_unlock_irqrestore(&lchip->lock, flags); 625 kfree(save); 626 627 return 0; 628 } 629 #endif 630 631 632 /** 633 * locomo_probe - probe for a single LoCoMo chip. 634 * @phys_addr: physical address of device. 635 * 636 * Probe for a LoCoMo chip. This must be called 637 * before any other locomo-specific code. 638 * 639 * Returns: 640 * %-ENODEV device not found. 641 * %-EBUSY physical address already marked in-use. 642 * %0 successful. 643 */ 644 static int 645 __locomo_probe(struct device *me, struct resource *mem, int irq) 646 { 647 struct locomo *lchip; 648 unsigned long r; 649 int i, ret = -ENODEV; 650 651 lchip = kzalloc(sizeof(struct locomo), GFP_KERNEL); 652 if (!lchip) 653 return -ENOMEM; 654 655 spin_lock_init(&lchip->lock); 656 657 lchip->dev = me; 658 dev_set_drvdata(lchip->dev, lchip); 659 660 lchip->phys = mem->start; 661 lchip->irq = irq; 662 663 /* 664 * Map the whole region. This also maps the 665 * registers for our children. 666 */ 667 lchip->base = ioremap(mem->start, PAGE_SIZE); 668 if (!lchip->base) { 669 ret = -ENOMEM; 670 goto out; 671 } 672 673 /* locomo initialize */ 674 locomo_writel(0, lchip->base + LOCOMO_ICR); 675 /* KEYBOARD */ 676 locomo_writel(0, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC); 677 678 /* GPIO */ 679 locomo_writel(0, lchip->base + LOCOMO_GPO); 680 locomo_writel( (LOCOMO_GPIO(2) | LOCOMO_GPIO(3) | LOCOMO_GPIO(13) | LOCOMO_GPIO(14)) 681 , lchip->base + LOCOMO_GPE); 682 locomo_writel( (LOCOMO_GPIO(2) | LOCOMO_GPIO(3) | LOCOMO_GPIO(13) | LOCOMO_GPIO(14)) 683 , lchip->base + LOCOMO_GPD); 684 locomo_writel(0, lchip->base + LOCOMO_GIE); 685 686 /* Frontlight */ 687 locomo_writel(0, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); 688 locomo_writel(0, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALD); 689 690 /* Longtime timer */ 691 locomo_writel(0, lchip->base + LOCOMO_LTINT); 692 /* SPI */ 693 locomo_writel(0, lchip->base + LOCOMO_SPIIE); 694 695 locomo_writel(6 + 8 + 320 + 30 - 10, lchip->base + LOCOMO_ASD); 696 r = locomo_readl(lchip->base + LOCOMO_ASD); 697 r |= 0x8000; 698 locomo_writel(r, lchip->base + LOCOMO_ASD); 699 700 locomo_writel(6 + 8 + 320 + 30 - 10 - 128 + 4, lchip->base + LOCOMO_HSD); 701 r = locomo_readl(lchip->base + LOCOMO_HSD); 702 r |= 0x8000; 703 locomo_writel(r, lchip->base + LOCOMO_HSD); 704 705 locomo_writel(128 / 8, lchip->base + LOCOMO_HSC); 706 707 /* XON */ 708 locomo_writel(0x80, lchip->base + LOCOMO_TADC); 709 udelay(1000); 710 /* CLK9MEN */ 711 r = locomo_readl(lchip->base + LOCOMO_TADC); 712 r |= 0x10; 713 locomo_writel(r, lchip->base + LOCOMO_TADC); 714 udelay(100); 715 716 /* init DAC */ 717 r = locomo_readl(lchip->base + LOCOMO_DAC); 718 r |= LOCOMO_DAC_SCLOEB | LOCOMO_DAC_SDAOEB; 719 locomo_writel(r, lchip->base + LOCOMO_DAC); 720 721 r = locomo_readl(lchip->base + LOCOMO_VER); 722 printk(KERN_INFO "LoCoMo Chip: %lu%lu\n", (r >> 8), (r & 0xff)); 723 724 /* 725 * The interrupt controller must be initialised before any 726 * other device to ensure that the interrupts are available. 727 */ 728 if (lchip->irq != NO_IRQ) 729 locomo_setup_irq(lchip); 730 731 for (i = 0; i < ARRAY_SIZE(locomo_devices); i++) 732 locomo_init_one_child(lchip, &locomo_devices[i]); 733 734 return 0; 735 736 out: 737 kfree(lchip); 738 return ret; 739 } 740 741 static int locomo_remove_child(struct device *dev, void *data) 742 { 743 device_unregister(dev); 744 return 0; 745 } 746 747 static void __locomo_remove(struct locomo *lchip) 748 { 749 device_for_each_child(lchip->dev, NULL, locomo_remove_child); 750 751 if (lchip->irq != NO_IRQ) { 752 set_irq_chained_handler(lchip->irq, NULL); 753 set_irq_data(lchip->irq, NULL); 754 } 755 756 iounmap(lchip->base); 757 kfree(lchip); 758 } 759 760 static int locomo_probe(struct platform_device *dev) 761 { 762 struct resource *mem; 763 int irq; 764 765 mem = platform_get_resource(dev, IORESOURCE_MEM, 0); 766 if (!mem) 767 return -EINVAL; 768 irq = platform_get_irq(dev, 0); 769 if (irq < 0) 770 return -ENXIO; 771 772 return __locomo_probe(&dev->dev, mem, irq); 773 } 774 775 static int locomo_remove(struct platform_device *dev) 776 { 777 struct locomo *lchip = platform_get_drvdata(dev); 778 779 if (lchip) { 780 __locomo_remove(lchip); 781 platform_set_drvdata(dev, NULL); 782 } 783 784 return 0; 785 } 786 787 /* 788 * Not sure if this should be on the system bus or not yet. 789 * We really want some way to register a system device at 790 * the per-machine level, and then have this driver pick 791 * up the registered devices. 792 */ 793 static struct platform_driver locomo_device_driver = { 794 .probe = locomo_probe, 795 .remove = locomo_remove, 796 #ifdef CONFIG_PM 797 .suspend = locomo_suspend, 798 .resume = locomo_resume, 799 #endif 800 .driver = { 801 .name = "locomo", 802 }, 803 }; 804 805 /* 806 * Get the parent device driver (us) structure 807 * from a child function device 808 */ 809 static inline struct locomo *locomo_chip_driver(struct locomo_dev *ldev) 810 { 811 return (struct locomo *)dev_get_drvdata(ldev->dev.parent); 812 } 813 814 void locomo_gpio_set_dir(struct locomo_dev *ldev, unsigned int bits, unsigned int dir) 815 { 816 struct locomo *lchip = locomo_chip_driver(ldev); 817 unsigned long flags; 818 unsigned int r; 819 820 spin_lock_irqsave(&lchip->lock, flags); 821 822 r = locomo_readl(lchip->base + LOCOMO_GPD); 823 r &= ~bits; 824 locomo_writel(r, lchip->base + LOCOMO_GPD); 825 826 r = locomo_readl(lchip->base + LOCOMO_GPE); 827 if (dir) 828 r |= bits; 829 else 830 r &= ~bits; 831 locomo_writel(r, lchip->base + LOCOMO_GPE); 832 833 spin_unlock_irqrestore(&lchip->lock, flags); 834 } 835 836 unsigned int locomo_gpio_read_level(struct locomo_dev *ldev, unsigned int bits) 837 { 838 struct locomo *lchip = locomo_chip_driver(ldev); 839 unsigned long flags; 840 unsigned int ret; 841 842 spin_lock_irqsave(&lchip->lock, flags); 843 ret = locomo_readl(lchip->base + LOCOMO_GPL); 844 spin_unlock_irqrestore(&lchip->lock, flags); 845 846 ret &= bits; 847 return ret; 848 } 849 850 unsigned int locomo_gpio_read_output(struct locomo_dev *ldev, unsigned int bits) 851 { 852 struct locomo *lchip = locomo_chip_driver(ldev); 853 unsigned long flags; 854 unsigned int ret; 855 856 spin_lock_irqsave(&lchip->lock, flags); 857 ret = locomo_readl(lchip->base + LOCOMO_GPO); 858 spin_unlock_irqrestore(&lchip->lock, flags); 859 860 ret &= bits; 861 return ret; 862 } 863 864 void locomo_gpio_write(struct locomo_dev *ldev, unsigned int bits, unsigned int set) 865 { 866 struct locomo *lchip = locomo_chip_driver(ldev); 867 unsigned long flags; 868 unsigned int r; 869 870 spin_lock_irqsave(&lchip->lock, flags); 871 872 r = locomo_readl(lchip->base + LOCOMO_GPO); 873 if (set) 874 r |= bits; 875 else 876 r &= ~bits; 877 locomo_writel(r, lchip->base + LOCOMO_GPO); 878 879 spin_unlock_irqrestore(&lchip->lock, flags); 880 } 881 882 static void locomo_m62332_sendbit(void *mapbase, int bit) 883 { 884 unsigned int r; 885 886 r = locomo_readl(mapbase + LOCOMO_DAC); 887 r &= ~(LOCOMO_DAC_SCLOEB); 888 locomo_writel(r, mapbase + LOCOMO_DAC); 889 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 890 udelay(DAC_DATA_HOLD_TIME); /* 300 nsec */ 891 r = locomo_readl(mapbase + LOCOMO_DAC); 892 r &= ~(LOCOMO_DAC_SCLOEB); 893 locomo_writel(r, mapbase + LOCOMO_DAC); 894 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 895 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 896 897 if (bit & 1) { 898 r = locomo_readl(mapbase + LOCOMO_DAC); 899 r |= LOCOMO_DAC_SDAOEB; 900 locomo_writel(r, mapbase + LOCOMO_DAC); 901 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 902 } else { 903 r = locomo_readl(mapbase + LOCOMO_DAC); 904 r &= ~(LOCOMO_DAC_SDAOEB); 905 locomo_writel(r, mapbase + LOCOMO_DAC); 906 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 907 } 908 909 udelay(DAC_DATA_SETUP_TIME); /* 250 nsec */ 910 r = locomo_readl(mapbase + LOCOMO_DAC); 911 r |= LOCOMO_DAC_SCLOEB; 912 locomo_writel(r, mapbase + LOCOMO_DAC); 913 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 914 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.0 usec */ 915 } 916 917 void locomo_m62332_senddata(struct locomo_dev *ldev, unsigned int dac_data, int channel) 918 { 919 struct locomo *lchip = locomo_chip_driver(ldev); 920 int i; 921 unsigned char data; 922 unsigned int r; 923 void *mapbase = lchip->base; 924 unsigned long flags; 925 926 spin_lock_irqsave(&lchip->lock, flags); 927 928 /* Start */ 929 udelay(DAC_BUS_FREE_TIME); /* 5.0 usec */ 930 r = locomo_readl(mapbase + LOCOMO_DAC); 931 r |= LOCOMO_DAC_SCLOEB | LOCOMO_DAC_SDAOEB; 932 locomo_writel(r, mapbase + LOCOMO_DAC); 933 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 934 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.0 usec */ 935 r = locomo_readl(mapbase + LOCOMO_DAC); 936 r &= ~(LOCOMO_DAC_SDAOEB); 937 locomo_writel(r, mapbase + LOCOMO_DAC); 938 udelay(DAC_START_HOLD_TIME); /* 5.0 usec */ 939 udelay(DAC_DATA_HOLD_TIME); /* 300 nsec */ 940 941 /* Send slave address and W bit (LSB is W bit) */ 942 data = (M62332_SLAVE_ADDR << 1) | M62332_W_BIT; 943 for (i = 1; i <= 8; i++) { 944 locomo_m62332_sendbit(mapbase, data >> (8 - i)); 945 } 946 947 /* Check A bit */ 948 r = locomo_readl(mapbase + LOCOMO_DAC); 949 r &= ~(LOCOMO_DAC_SCLOEB); 950 locomo_writel(r, mapbase + LOCOMO_DAC); 951 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 952 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 953 r = locomo_readl(mapbase + LOCOMO_DAC); 954 r &= ~(LOCOMO_DAC_SDAOEB); 955 locomo_writel(r, mapbase + LOCOMO_DAC); 956 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 957 r = locomo_readl(mapbase + LOCOMO_DAC); 958 r |= LOCOMO_DAC_SCLOEB; 959 locomo_writel(r, mapbase + LOCOMO_DAC); 960 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 961 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.7 usec */ 962 if (locomo_readl(mapbase + LOCOMO_DAC) & LOCOMO_DAC_SDAOEB) { /* High is error */ 963 printk(KERN_WARNING "locomo: m62332_senddata Error 1\n"); 964 return; 965 } 966 967 /* Send Sub address (LSB is channel select) */ 968 /* channel = 0 : ch1 select */ 969 /* = 1 : ch2 select */ 970 data = M62332_SUB_ADDR + channel; 971 for (i = 1; i <= 8; i++) { 972 locomo_m62332_sendbit(mapbase, data >> (8 - i)); 973 } 974 975 /* Check A bit */ 976 r = locomo_readl(mapbase + LOCOMO_DAC); 977 r &= ~(LOCOMO_DAC_SCLOEB); 978 locomo_writel(r, mapbase + LOCOMO_DAC); 979 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 980 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 981 r = locomo_readl(mapbase + LOCOMO_DAC); 982 r &= ~(LOCOMO_DAC_SDAOEB); 983 locomo_writel(r, mapbase + LOCOMO_DAC); 984 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 985 r = locomo_readl(mapbase + LOCOMO_DAC); 986 r |= LOCOMO_DAC_SCLOEB; 987 locomo_writel(r, mapbase + LOCOMO_DAC); 988 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 989 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.7 usec */ 990 if (locomo_readl(mapbase + LOCOMO_DAC) & LOCOMO_DAC_SDAOEB) { /* High is error */ 991 printk(KERN_WARNING "locomo: m62332_senddata Error 2\n"); 992 return; 993 } 994 995 /* Send DAC data */ 996 for (i = 1; i <= 8; i++) { 997 locomo_m62332_sendbit(mapbase, dac_data >> (8 - i)); 998 } 999 1000 /* Check A bit */ 1001 r = locomo_readl(mapbase + LOCOMO_DAC); 1002 r &= ~(LOCOMO_DAC_SCLOEB); 1003 locomo_writel(r, mapbase + LOCOMO_DAC); 1004 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 1005 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 1006 r = locomo_readl(mapbase + LOCOMO_DAC); 1007 r &= ~(LOCOMO_DAC_SDAOEB); 1008 locomo_writel(r, mapbase + LOCOMO_DAC); 1009 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 1010 r = locomo_readl(mapbase + LOCOMO_DAC); 1011 r |= LOCOMO_DAC_SCLOEB; 1012 locomo_writel(r, mapbase + LOCOMO_DAC); 1013 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 1014 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.7 usec */ 1015 if (locomo_readl(mapbase + LOCOMO_DAC) & LOCOMO_DAC_SDAOEB) { /* High is error */ 1016 printk(KERN_WARNING "locomo: m62332_senddata Error 3\n"); 1017 return; 1018 } 1019 1020 /* stop */ 1021 r = locomo_readl(mapbase + LOCOMO_DAC); 1022 r &= ~(LOCOMO_DAC_SCLOEB); 1023 locomo_writel(r, mapbase + LOCOMO_DAC); 1024 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 1025 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 1026 r = locomo_readl(mapbase + LOCOMO_DAC); 1027 r |= LOCOMO_DAC_SCLOEB; 1028 locomo_writel(r, mapbase + LOCOMO_DAC); 1029 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 1030 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4 usec */ 1031 r = locomo_readl(mapbase + LOCOMO_DAC); 1032 r |= LOCOMO_DAC_SDAOEB; 1033 locomo_writel(r, mapbase + LOCOMO_DAC); 1034 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 1035 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4 usec */ 1036 1037 r = locomo_readl(mapbase + LOCOMO_DAC); 1038 r |= LOCOMO_DAC_SCLOEB | LOCOMO_DAC_SDAOEB; 1039 locomo_writel(r, mapbase + LOCOMO_DAC); 1040 udelay(DAC_LOW_SETUP_TIME); /* 1000 nsec */ 1041 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 1042 1043 spin_unlock_irqrestore(&lchip->lock, flags); 1044 } 1045 1046 /* 1047 * Frontlight control 1048 */ 1049 1050 static struct locomo *locomo_chip_driver(struct locomo_dev *ldev); 1051 1052 void locomo_frontlight_set(struct locomo_dev *dev, int duty, int vr, int bpwf) 1053 { 1054 unsigned long flags; 1055 struct locomo *lchip = locomo_chip_driver(dev); 1056 1057 if (vr) 1058 locomo_gpio_write(dev, LOCOMO_GPIO_FL_VR, 1); 1059 else 1060 locomo_gpio_write(dev, LOCOMO_GPIO_FL_VR, 0); 1061 1062 spin_lock_irqsave(&lchip->lock, flags); 1063 locomo_writel(bpwf, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); 1064 udelay(100); 1065 locomo_writel(duty, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALD); 1066 locomo_writel(bpwf | LOCOMO_ALC_EN, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); 1067 spin_unlock_irqrestore(&lchip->lock, flags); 1068 } 1069 1070 /* 1071 * LoCoMo "Register Access Bus." 1072 * 1073 * We model this as a regular bus type, and hang devices directly 1074 * off this. 1075 */ 1076 static int locomo_match(struct device *_dev, struct device_driver *_drv) 1077 { 1078 struct locomo_dev *dev = LOCOMO_DEV(_dev); 1079 struct locomo_driver *drv = LOCOMO_DRV(_drv); 1080 1081 return dev->devid == drv->devid; 1082 } 1083 1084 static int locomo_bus_suspend(struct device *dev, pm_message_t state) 1085 { 1086 struct locomo_dev *ldev = LOCOMO_DEV(dev); 1087 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 1088 int ret = 0; 1089 1090 if (drv && drv->suspend) 1091 ret = drv->suspend(ldev, state); 1092 return ret; 1093 } 1094 1095 static int locomo_bus_resume(struct device *dev) 1096 { 1097 struct locomo_dev *ldev = LOCOMO_DEV(dev); 1098 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 1099 int ret = 0; 1100 1101 if (drv && drv->resume) 1102 ret = drv->resume(ldev); 1103 return ret; 1104 } 1105 1106 static int locomo_bus_probe(struct device *dev) 1107 { 1108 struct locomo_dev *ldev = LOCOMO_DEV(dev); 1109 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 1110 int ret = -ENODEV; 1111 1112 if (drv->probe) 1113 ret = drv->probe(ldev); 1114 return ret; 1115 } 1116 1117 static int locomo_bus_remove(struct device *dev) 1118 { 1119 struct locomo_dev *ldev = LOCOMO_DEV(dev); 1120 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 1121 int ret = 0; 1122 1123 if (drv->remove) 1124 ret = drv->remove(ldev); 1125 return ret; 1126 } 1127 1128 struct bus_type locomo_bus_type = { 1129 .name = "locomo-bus", 1130 .match = locomo_match, 1131 .probe = locomo_bus_probe, 1132 .remove = locomo_bus_remove, 1133 .suspend = locomo_bus_suspend, 1134 .resume = locomo_bus_resume, 1135 }; 1136 1137 int locomo_driver_register(struct locomo_driver *driver) 1138 { 1139 driver->drv.bus = &locomo_bus_type; 1140 return driver_register(&driver->drv); 1141 } 1142 1143 void locomo_driver_unregister(struct locomo_driver *driver) 1144 { 1145 driver_unregister(&driver->drv); 1146 } 1147 1148 static int __init locomo_init(void) 1149 { 1150 int ret = bus_register(&locomo_bus_type); 1151 if (ret == 0) 1152 platform_driver_register(&locomo_device_driver); 1153 return ret; 1154 } 1155 1156 static void __exit locomo_exit(void) 1157 { 1158 platform_driver_unregister(&locomo_device_driver); 1159 bus_unregister(&locomo_bus_type); 1160 } 1161 1162 module_init(locomo_init); 1163 module_exit(locomo_exit); 1164 1165 MODULE_DESCRIPTION("Sharp LoCoMo core driver"); 1166 MODULE_LICENSE("GPL"); 1167 MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>"); 1168 1169 EXPORT_SYMBOL(locomo_driver_register); 1170 EXPORT_SYMBOL(locomo_driver_unregister); 1171 EXPORT_SYMBOL(locomo_gpio_set_dir); 1172 EXPORT_SYMBOL(locomo_gpio_read_level); 1173 EXPORT_SYMBOL(locomo_gpio_read_output); 1174 EXPORT_SYMBOL(locomo_gpio_write); 1175 EXPORT_SYMBOL(locomo_m62332_senddata); 1176