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/module.h> 19#include <linux/init.h> 20#include <linux/kernel.h> 21#include <linux/delay.h> 22#include <linux/errno.h> 23#include <linux/ioport.h> 24#include <linux/platform_device.h> 25#include <linux/slab.h> 26#include <linux/spinlock.h> 27#include <linux/io.h> 28 29#include <mach/hardware.h> 30#include <asm/irq.h> 31#include <asm/mach/irq.h> 32 33#include <asm/hardware/locomo.h> 34 35/* LoCoMo Interrupts */ 36#define IRQ_LOCOMO_KEY (0) 37#define IRQ_LOCOMO_GPIO (1) 38#define IRQ_LOCOMO_LT (2) 39#define IRQ_LOCOMO_SPI (3) 40 41/* M62332 output channel selection */ 42#define M62332_EVR_CH 1 /* M62332 volume channel number */ 43 /* 0 : CH.1 , 1 : CH. 2 */ 44/* DAC send data */ 45#define M62332_SLAVE_ADDR 0x4e /* Slave address */ 46#define M62332_W_BIT 0x00 /* W bit (0 only) */ 47#define M62332_SUB_ADDR 0x00 /* Sub address */ 48#define M62332_A_BIT 0x00 /* A bit (0 only) */ 49 50/* DAC setup and hold times (expressed in us) */ 51#define DAC_BUS_FREE_TIME 5 /* 4.7 us */ 52#define DAC_START_SETUP_TIME 5 /* 4.7 us */ 53#define DAC_STOP_SETUP_TIME 4 /* 4.0 us */ 54#define DAC_START_HOLD_TIME 5 /* 4.7 us */ 55#define DAC_SCL_LOW_HOLD_TIME 5 /* 4.7 us */ 56#define DAC_SCL_HIGH_HOLD_TIME 4 /* 4.0 us */ 57#define DAC_DATA_SETUP_TIME 1 /* 250 ns */ 58#define DAC_DATA_HOLD_TIME 1 /* 300 ns */ 59#define DAC_LOW_SETUP_TIME 1 /* 300 ns */ 60#define DAC_HIGH_SETUP_TIME 1 /* 1000 ns */ 61 62/* the following is the overall data for the locomo chip */ 63struct locomo { 64 struct device *dev; 65 unsigned long phys; 66 unsigned int irq; 67 int irq_base; 68 spinlock_t lock; 69 void __iomem *base; 70#ifdef CONFIG_PM 71 void *saved_state; 72#endif 73}; 74 75struct locomo_dev_info { 76 unsigned long offset; 77 unsigned long length; 78 unsigned int devid; 79 unsigned int irq[1]; 80 const char * name; 81}; 82 83/* All the locomo devices. If offset is non-zero, the mapbase for the 84 * locomo_dev will be set to the chip base plus offset. If offset is 85 * zero, then the mapbase for the locomo_dev will be set to zero. An 86 * offset of zero means the device only uses GPIOs or other helper 87 * functions inside this file */ 88static struct locomo_dev_info locomo_devices[] = { 89 { 90 .devid = LOCOMO_DEVID_KEYBOARD, 91 .irq = { IRQ_LOCOMO_KEY }, 92 .name = "locomo-keyboard", 93 .offset = LOCOMO_KEYBOARD, 94 .length = 16, 95 }, 96 { 97 .devid = LOCOMO_DEVID_FRONTLIGHT, 98 .irq = {}, 99 .name = "locomo-frontlight", 100 .offset = LOCOMO_FRONTLIGHT, 101 .length = 8, 102 103 }, 104 { 105 .devid = LOCOMO_DEVID_BACKLIGHT, 106 .irq = {}, 107 .name = "locomo-backlight", 108 .offset = LOCOMO_BACKLIGHT, 109 .length = 8, 110 }, 111 { 112 .devid = LOCOMO_DEVID_AUDIO, 113 .irq = {}, 114 .name = "locomo-audio", 115 .offset = LOCOMO_AUDIO, 116 .length = 4, 117 }, 118 { 119 .devid = LOCOMO_DEVID_LED, 120 .irq = {}, 121 .name = "locomo-led", 122 .offset = LOCOMO_LED, 123 .length = 8, 124 }, 125 { 126 .devid = LOCOMO_DEVID_UART, 127 .irq = {}, 128 .name = "locomo-uart", 129 .offset = 0, 130 .length = 0, 131 }, 132 { 133 .devid = LOCOMO_DEVID_SPI, 134 .irq = {}, 135 .name = "locomo-spi", 136 .offset = LOCOMO_SPI, 137 .length = 0x30, 138 }, 139}; 140 141static void locomo_handler(struct irq_desc *desc) 142{ 143 struct locomo *lchip = irq_desc_get_chip_data(desc); 144 int req, i; 145 146 /* Acknowledge the parent IRQ */ 147 desc->irq_data.chip->irq_ack(&desc->irq_data); 148 149 /* check why this interrupt was generated */ 150 req = locomo_readl(lchip->base + LOCOMO_ICR) & 0x0f00; 151 152 if (req) { 153 unsigned int irq; 154 155 /* generate the next interrupt(s) */ 156 irq = lchip->irq_base; 157 for (i = 0; i <= 3; i++, irq++) { 158 if (req & (0x0100 << i)) { 159 generic_handle_irq(irq); 160 } 161 162 } 163 } 164} 165 166static void locomo_ack_irq(struct irq_data *d) 167{ 168} 169 170static void locomo_mask_irq(struct irq_data *d) 171{ 172 struct locomo *lchip = irq_data_get_irq_chip_data(d); 173 unsigned int r; 174 r = locomo_readl(lchip->base + LOCOMO_ICR); 175 r &= ~(0x0010 << (d->irq - lchip->irq_base)); 176 locomo_writel(r, lchip->base + LOCOMO_ICR); 177} 178 179static void locomo_unmask_irq(struct irq_data *d) 180{ 181 struct locomo *lchip = irq_data_get_irq_chip_data(d); 182 unsigned int r; 183 r = locomo_readl(lchip->base + LOCOMO_ICR); 184 r |= (0x0010 << (d->irq - lchip->irq_base)); 185 locomo_writel(r, lchip->base + LOCOMO_ICR); 186} 187 188static struct irq_chip locomo_chip = { 189 .name = "LOCOMO", 190 .irq_ack = locomo_ack_irq, 191 .irq_mask = locomo_mask_irq, 192 .irq_unmask = locomo_unmask_irq, 193}; 194 195static void locomo_setup_irq(struct locomo *lchip) 196{ 197 int irq = lchip->irq_base; 198 199 /* 200 * Install handler for IRQ_LOCOMO_HW. 201 */ 202 irq_set_irq_type(lchip->irq, IRQ_TYPE_EDGE_FALLING); 203 irq_set_chip_data(lchip->irq, lchip); 204 irq_set_chained_handler(lchip->irq, locomo_handler); 205 206 /* Install handlers for IRQ_LOCOMO_* */ 207 for ( ; irq <= lchip->irq_base + 3; irq++) { 208 irq_set_chip_and_handler(irq, &locomo_chip, handle_level_irq); 209 irq_set_chip_data(irq, lchip); 210 irq_clear_status_flags(irq, IRQ_NOREQUEST | IRQ_NOPROBE); 211 } 212} 213 214 215static void locomo_dev_release(struct device *_dev) 216{ 217 struct locomo_dev *dev = LOCOMO_DEV(_dev); 218 219 kfree(dev); 220} 221 222static int 223locomo_init_one_child(struct locomo *lchip, struct locomo_dev_info *info) 224{ 225 struct locomo_dev *dev; 226 int ret; 227 228 dev = kzalloc(sizeof(struct locomo_dev), GFP_KERNEL); 229 if (!dev) { 230 ret = -ENOMEM; 231 goto out; 232 } 233 234 /* 235 * If the parent device has a DMA mask associated with it, 236 * propagate it down to the children. 237 */ 238 if (lchip->dev->dma_mask) { 239 dev->dma_mask = *lchip->dev->dma_mask; 240 dev->dev.dma_mask = &dev->dma_mask; 241 } 242 243 dev_set_name(&dev->dev, "%s", info->name); 244 dev->devid = info->devid; 245 dev->dev.parent = lchip->dev; 246 dev->dev.bus = &locomo_bus_type; 247 dev->dev.release = locomo_dev_release; 248 dev->dev.coherent_dma_mask = lchip->dev->coherent_dma_mask; 249 250 if (info->offset) 251 dev->mapbase = lchip->base + info->offset; 252 else 253 dev->mapbase = 0; 254 dev->length = info->length; 255 256 dev->irq[0] = (lchip->irq_base == NO_IRQ) ? 257 NO_IRQ : lchip->irq_base + info->irq[0]; 258 259 ret = device_register(&dev->dev); 260 if (ret) { 261 out: 262 kfree(dev); 263 } 264 return ret; 265} 266 267#ifdef CONFIG_PM 268 269struct locomo_save_data { 270 u16 LCM_GPO; 271 u16 LCM_SPICT; 272 u16 LCM_GPE; 273 u16 LCM_ASD; 274 u16 LCM_SPIMD; 275}; 276 277static int locomo_suspend(struct platform_device *dev, pm_message_t state) 278{ 279 struct locomo *lchip = platform_get_drvdata(dev); 280 struct locomo_save_data *save; 281 unsigned long flags; 282 283 save = kmalloc(sizeof(struct locomo_save_data), GFP_KERNEL); 284 if (!save) 285 return -ENOMEM; 286 287 lchip->saved_state = save; 288 289 spin_lock_irqsave(&lchip->lock, flags); 290 291 save->LCM_GPO = locomo_readl(lchip->base + LOCOMO_GPO); /* GPIO */ 292 locomo_writel(0x00, lchip->base + LOCOMO_GPO); 293 save->LCM_SPICT = locomo_readl(lchip->base + LOCOMO_SPI + LOCOMO_SPICT); /* SPI */ 294 locomo_writel(0x40, lchip->base + LOCOMO_SPI + LOCOMO_SPICT); 295 save->LCM_GPE = locomo_readl(lchip->base + LOCOMO_GPE); /* GPIO */ 296 locomo_writel(0x00, lchip->base + LOCOMO_GPE); 297 save->LCM_ASD = locomo_readl(lchip->base + LOCOMO_ASD); /* ADSTART */ 298 locomo_writel(0x00, lchip->base + LOCOMO_ASD); 299 save->LCM_SPIMD = locomo_readl(lchip->base + LOCOMO_SPI + LOCOMO_SPIMD); /* SPI */ 300 locomo_writel(0x3C14, lchip->base + LOCOMO_SPI + LOCOMO_SPIMD); 301 302 locomo_writel(0x00, lchip->base + LOCOMO_PAIF); 303 locomo_writel(0x00, lchip->base + LOCOMO_DAC); 304 locomo_writel(0x00, lchip->base + LOCOMO_BACKLIGHT + LOCOMO_TC); 305 306 if ((locomo_readl(lchip->base + LOCOMO_LED + LOCOMO_LPT0) & 0x88) && (locomo_readl(lchip->base + LOCOMO_LED + LOCOMO_LPT1) & 0x88)) 307 locomo_writel(0x00, lchip->base + LOCOMO_C32K); /* CLK32 off */ 308 else 309 /* 18MHz already enabled, so no wait */ 310 locomo_writel(0xc1, lchip->base + LOCOMO_C32K); /* CLK32 on */ 311 312 locomo_writel(0x00, lchip->base + LOCOMO_TADC); /* 18MHz clock off*/ 313 locomo_writel(0x00, lchip->base + LOCOMO_AUDIO + LOCOMO_ACC); /* 22MHz/24MHz clock off */ 314 locomo_writel(0x00, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); /* FL */ 315 316 spin_unlock_irqrestore(&lchip->lock, flags); 317 318 return 0; 319} 320 321static int locomo_resume(struct platform_device *dev) 322{ 323 struct locomo *lchip = platform_get_drvdata(dev); 324 struct locomo_save_data *save; 325 unsigned long r; 326 unsigned long flags; 327 328 save = lchip->saved_state; 329 if (!save) 330 return 0; 331 332 spin_lock_irqsave(&lchip->lock, flags); 333 334 locomo_writel(save->LCM_GPO, lchip->base + LOCOMO_GPO); 335 locomo_writel(save->LCM_SPICT, lchip->base + LOCOMO_SPI + LOCOMO_SPICT); 336 locomo_writel(save->LCM_GPE, lchip->base + LOCOMO_GPE); 337 locomo_writel(save->LCM_ASD, lchip->base + LOCOMO_ASD); 338 locomo_writel(save->LCM_SPIMD, lchip->base + LOCOMO_SPI + LOCOMO_SPIMD); 339 340 locomo_writel(0x00, lchip->base + LOCOMO_C32K); 341 locomo_writel(0x90, lchip->base + LOCOMO_TADC); 342 343 locomo_writel(0, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KSC); 344 r = locomo_readl(lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC); 345 r &= 0xFEFF; 346 locomo_writel(r, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC); 347 locomo_writel(0x1, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KCMD); 348 349 spin_unlock_irqrestore(&lchip->lock, flags); 350 351 lchip->saved_state = NULL; 352 kfree(save); 353 354 return 0; 355} 356#endif 357 358 359/** 360 * locomo_probe - probe for a single LoCoMo chip. 361 * @phys_addr: physical address of device. 362 * 363 * Probe for a LoCoMo chip. This must be called 364 * before any other locomo-specific code. 365 * 366 * Returns: 367 * %-ENODEV device not found. 368 * %-EBUSY physical address already marked in-use. 369 * %0 successful. 370 */ 371static int 372__locomo_probe(struct device *me, struct resource *mem, int irq) 373{ 374 struct locomo_platform_data *pdata = me->platform_data; 375 struct locomo *lchip; 376 unsigned long r; 377 int i, ret = -ENODEV; 378 379 lchip = kzalloc(sizeof(struct locomo), GFP_KERNEL); 380 if (!lchip) 381 return -ENOMEM; 382 383 spin_lock_init(&lchip->lock); 384 385 lchip->dev = me; 386 dev_set_drvdata(lchip->dev, lchip); 387 388 lchip->phys = mem->start; 389 lchip->irq = irq; 390 lchip->irq_base = (pdata) ? pdata->irq_base : NO_IRQ; 391 392 /* 393 * Map the whole region. This also maps the 394 * registers for our children. 395 */ 396 lchip->base = ioremap(mem->start, PAGE_SIZE); 397 if (!lchip->base) { 398 ret = -ENOMEM; 399 goto out; 400 } 401 402 /* locomo initialize */ 403 locomo_writel(0, lchip->base + LOCOMO_ICR); 404 /* KEYBOARD */ 405 locomo_writel(0, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC); 406 407 /* GPIO */ 408 locomo_writel(0, lchip->base + LOCOMO_GPO); 409 locomo_writel((LOCOMO_GPIO(1) | LOCOMO_GPIO(2) | LOCOMO_GPIO(13) | LOCOMO_GPIO(14)) 410 , lchip->base + LOCOMO_GPE); 411 locomo_writel((LOCOMO_GPIO(1) | LOCOMO_GPIO(2) | LOCOMO_GPIO(13) | LOCOMO_GPIO(14)) 412 , lchip->base + LOCOMO_GPD); 413 locomo_writel(0, lchip->base + LOCOMO_GIE); 414 415 /* Frontlight */ 416 locomo_writel(0, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); 417 locomo_writel(0, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALD); 418 419 /* Longtime timer */ 420 locomo_writel(0, lchip->base + LOCOMO_LTINT); 421 /* SPI */ 422 locomo_writel(0, lchip->base + LOCOMO_SPI + LOCOMO_SPIIE); 423 424 locomo_writel(6 + 8 + 320 + 30 - 10, lchip->base + LOCOMO_ASD); 425 r = locomo_readl(lchip->base + LOCOMO_ASD); 426 r |= 0x8000; 427 locomo_writel(r, lchip->base + LOCOMO_ASD); 428 429 locomo_writel(6 + 8 + 320 + 30 - 10 - 128 + 4, lchip->base + LOCOMO_HSD); 430 r = locomo_readl(lchip->base + LOCOMO_HSD); 431 r |= 0x8000; 432 locomo_writel(r, lchip->base + LOCOMO_HSD); 433 434 locomo_writel(128 / 8, lchip->base + LOCOMO_HSC); 435 436 /* XON */ 437 locomo_writel(0x80, lchip->base + LOCOMO_TADC); 438 udelay(1000); 439 /* CLK9MEN */ 440 r = locomo_readl(lchip->base + LOCOMO_TADC); 441 r |= 0x10; 442 locomo_writel(r, lchip->base + LOCOMO_TADC); 443 udelay(100); 444 445 /* init DAC */ 446 r = locomo_readl(lchip->base + LOCOMO_DAC); 447 r |= LOCOMO_DAC_SCLOEB | LOCOMO_DAC_SDAOEB; 448 locomo_writel(r, lchip->base + LOCOMO_DAC); 449 450 r = locomo_readl(lchip->base + LOCOMO_VER); 451 printk(KERN_INFO "LoCoMo Chip: %lu%lu\n", (r >> 8), (r & 0xff)); 452 453 /* 454 * The interrupt controller must be initialised before any 455 * other device to ensure that the interrupts are available. 456 */ 457 if (lchip->irq != NO_IRQ && lchip->irq_base != NO_IRQ) 458 locomo_setup_irq(lchip); 459 460 for (i = 0; i < ARRAY_SIZE(locomo_devices); i++) 461 locomo_init_one_child(lchip, &locomo_devices[i]); 462 return 0; 463 464 out: 465 kfree(lchip); 466 return ret; 467} 468 469static int locomo_remove_child(struct device *dev, void *data) 470{ 471 device_unregister(dev); 472 return 0; 473} 474 475static void __locomo_remove(struct locomo *lchip) 476{ 477 device_for_each_child(lchip->dev, NULL, locomo_remove_child); 478 479 if (lchip->irq != NO_IRQ) { 480 irq_set_chained_handler_and_data(lchip->irq, NULL, NULL); 481 } 482 483 iounmap(lchip->base); 484 kfree(lchip); 485} 486 487static int locomo_probe(struct platform_device *dev) 488{ 489 struct resource *mem; 490 int irq; 491 492 mem = platform_get_resource(dev, IORESOURCE_MEM, 0); 493 if (!mem) 494 return -EINVAL; 495 irq = platform_get_irq(dev, 0); 496 if (irq < 0) 497 return -ENXIO; 498 499 return __locomo_probe(&dev->dev, mem, irq); 500} 501 502static int locomo_remove(struct platform_device *dev) 503{ 504 struct locomo *lchip = platform_get_drvdata(dev); 505 506 if (lchip) { 507 __locomo_remove(lchip); 508 platform_set_drvdata(dev, NULL); 509 } 510 511 return 0; 512} 513 514/* 515 * Not sure if this should be on the system bus or not yet. 516 * We really want some way to register a system device at 517 * the per-machine level, and then have this driver pick 518 * up the registered devices. 519 */ 520static struct platform_driver locomo_device_driver = { 521 .probe = locomo_probe, 522 .remove = locomo_remove, 523#ifdef CONFIG_PM 524 .suspend = locomo_suspend, 525 .resume = locomo_resume, 526#endif 527 .driver = { 528 .name = "locomo", 529 }, 530}; 531 532/* 533 * Get the parent device driver (us) structure 534 * from a child function device 535 */ 536static inline struct locomo *locomo_chip_driver(struct locomo_dev *ldev) 537{ 538 return (struct locomo *)dev_get_drvdata(ldev->dev.parent); 539} 540 541void locomo_gpio_set_dir(struct device *dev, unsigned int bits, unsigned int dir) 542{ 543 struct locomo *lchip = dev_get_drvdata(dev); 544 unsigned long flags; 545 unsigned int r; 546 547 if (!lchip) 548 return; 549 550 spin_lock_irqsave(&lchip->lock, flags); 551 552 r = locomo_readl(lchip->base + LOCOMO_GPD); 553 if (dir) 554 r |= bits; 555 else 556 r &= ~bits; 557 locomo_writel(r, lchip->base + LOCOMO_GPD); 558 559 r = locomo_readl(lchip->base + LOCOMO_GPE); 560 if (dir) 561 r |= bits; 562 else 563 r &= ~bits; 564 locomo_writel(r, lchip->base + LOCOMO_GPE); 565 566 spin_unlock_irqrestore(&lchip->lock, flags); 567} 568EXPORT_SYMBOL(locomo_gpio_set_dir); 569 570int locomo_gpio_read_level(struct device *dev, unsigned int bits) 571{ 572 struct locomo *lchip = dev_get_drvdata(dev); 573 unsigned long flags; 574 unsigned int ret; 575 576 if (!lchip) 577 return -ENODEV; 578 579 spin_lock_irqsave(&lchip->lock, flags); 580 ret = locomo_readl(lchip->base + LOCOMO_GPL); 581 spin_unlock_irqrestore(&lchip->lock, flags); 582 583 ret &= bits; 584 return ret; 585} 586EXPORT_SYMBOL(locomo_gpio_read_level); 587 588int locomo_gpio_read_output(struct device *dev, unsigned int bits) 589{ 590 struct locomo *lchip = dev_get_drvdata(dev); 591 unsigned long flags; 592 unsigned int ret; 593 594 if (!lchip) 595 return -ENODEV; 596 597 spin_lock_irqsave(&lchip->lock, flags); 598 ret = locomo_readl(lchip->base + LOCOMO_GPO); 599 spin_unlock_irqrestore(&lchip->lock, flags); 600 601 ret &= bits; 602 return ret; 603} 604EXPORT_SYMBOL(locomo_gpio_read_output); 605 606void locomo_gpio_write(struct device *dev, unsigned int bits, unsigned int set) 607{ 608 struct locomo *lchip = dev_get_drvdata(dev); 609 unsigned long flags; 610 unsigned int r; 611 612 if (!lchip) 613 return; 614 615 spin_lock_irqsave(&lchip->lock, flags); 616 617 r = locomo_readl(lchip->base + LOCOMO_GPO); 618 if (set) 619 r |= bits; 620 else 621 r &= ~bits; 622 locomo_writel(r, lchip->base + LOCOMO_GPO); 623 624 spin_unlock_irqrestore(&lchip->lock, flags); 625} 626EXPORT_SYMBOL(locomo_gpio_write); 627 628static void locomo_m62332_sendbit(void *mapbase, int bit) 629{ 630 unsigned int r; 631 632 r = locomo_readl(mapbase + LOCOMO_DAC); 633 r &= ~(LOCOMO_DAC_SCLOEB); 634 locomo_writel(r, mapbase + LOCOMO_DAC); 635 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 636 udelay(DAC_DATA_HOLD_TIME); /* 300 nsec */ 637 r = locomo_readl(mapbase + LOCOMO_DAC); 638 r &= ~(LOCOMO_DAC_SCLOEB); 639 locomo_writel(r, mapbase + LOCOMO_DAC); 640 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 641 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 642 643 if (bit & 1) { 644 r = locomo_readl(mapbase + LOCOMO_DAC); 645 r |= LOCOMO_DAC_SDAOEB; 646 locomo_writel(r, mapbase + LOCOMO_DAC); 647 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 648 } else { 649 r = locomo_readl(mapbase + LOCOMO_DAC); 650 r &= ~(LOCOMO_DAC_SDAOEB); 651 locomo_writel(r, mapbase + LOCOMO_DAC); 652 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 653 } 654 655 udelay(DAC_DATA_SETUP_TIME); /* 250 nsec */ 656 r = locomo_readl(mapbase + LOCOMO_DAC); 657 r |= LOCOMO_DAC_SCLOEB; 658 locomo_writel(r, mapbase + LOCOMO_DAC); 659 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 660 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.0 usec */ 661} 662 663void locomo_m62332_senddata(struct locomo_dev *ldev, unsigned int dac_data, int channel) 664{ 665 struct locomo *lchip = locomo_chip_driver(ldev); 666 int i; 667 unsigned char data; 668 unsigned int r; 669 void *mapbase = lchip->base; 670 unsigned long flags; 671 672 spin_lock_irqsave(&lchip->lock, flags); 673 674 /* Start */ 675 udelay(DAC_BUS_FREE_TIME); /* 5.0 usec */ 676 r = locomo_readl(mapbase + LOCOMO_DAC); 677 r |= LOCOMO_DAC_SCLOEB | LOCOMO_DAC_SDAOEB; 678 locomo_writel(r, mapbase + LOCOMO_DAC); 679 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 680 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.0 usec */ 681 r = locomo_readl(mapbase + LOCOMO_DAC); 682 r &= ~(LOCOMO_DAC_SDAOEB); 683 locomo_writel(r, mapbase + LOCOMO_DAC); 684 udelay(DAC_START_HOLD_TIME); /* 5.0 usec */ 685 udelay(DAC_DATA_HOLD_TIME); /* 300 nsec */ 686 687 /* Send slave address and W bit (LSB is W bit) */ 688 data = (M62332_SLAVE_ADDR << 1) | M62332_W_BIT; 689 for (i = 1; i <= 8; i++) { 690 locomo_m62332_sendbit(mapbase, data >> (8 - i)); 691 } 692 693 /* Check A bit */ 694 r = locomo_readl(mapbase + LOCOMO_DAC); 695 r &= ~(LOCOMO_DAC_SCLOEB); 696 locomo_writel(r, mapbase + LOCOMO_DAC); 697 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 698 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 699 r = locomo_readl(mapbase + LOCOMO_DAC); 700 r &= ~(LOCOMO_DAC_SDAOEB); 701 locomo_writel(r, mapbase + LOCOMO_DAC); 702 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 703 r = locomo_readl(mapbase + LOCOMO_DAC); 704 r |= LOCOMO_DAC_SCLOEB; 705 locomo_writel(r, mapbase + LOCOMO_DAC); 706 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 707 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.7 usec */ 708 if (locomo_readl(mapbase + LOCOMO_DAC) & LOCOMO_DAC_SDAOEB) { /* High is error */ 709 printk(KERN_WARNING "locomo: m62332_senddata Error 1\n"); 710 goto out; 711 } 712 713 /* Send Sub address (LSB is channel select) */ 714 /* channel = 0 : ch1 select */ 715 /* = 1 : ch2 select */ 716 data = M62332_SUB_ADDR + channel; 717 for (i = 1; i <= 8; i++) { 718 locomo_m62332_sendbit(mapbase, data >> (8 - i)); 719 } 720 721 /* Check A bit */ 722 r = locomo_readl(mapbase + LOCOMO_DAC); 723 r &= ~(LOCOMO_DAC_SCLOEB); 724 locomo_writel(r, mapbase + LOCOMO_DAC); 725 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 726 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 727 r = locomo_readl(mapbase + LOCOMO_DAC); 728 r &= ~(LOCOMO_DAC_SDAOEB); 729 locomo_writel(r, mapbase + LOCOMO_DAC); 730 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 731 r = locomo_readl(mapbase + LOCOMO_DAC); 732 r |= LOCOMO_DAC_SCLOEB; 733 locomo_writel(r, mapbase + LOCOMO_DAC); 734 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 735 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.7 usec */ 736 if (locomo_readl(mapbase + LOCOMO_DAC) & LOCOMO_DAC_SDAOEB) { /* High is error */ 737 printk(KERN_WARNING "locomo: m62332_senddata Error 2\n"); 738 goto out; 739 } 740 741 /* Send DAC data */ 742 for (i = 1; i <= 8; i++) { 743 locomo_m62332_sendbit(mapbase, dac_data >> (8 - i)); 744 } 745 746 /* Check A bit */ 747 r = locomo_readl(mapbase + LOCOMO_DAC); 748 r &= ~(LOCOMO_DAC_SCLOEB); 749 locomo_writel(r, mapbase + LOCOMO_DAC); 750 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 751 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 752 r = locomo_readl(mapbase + LOCOMO_DAC); 753 r &= ~(LOCOMO_DAC_SDAOEB); 754 locomo_writel(r, mapbase + LOCOMO_DAC); 755 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 756 r = locomo_readl(mapbase + LOCOMO_DAC); 757 r |= LOCOMO_DAC_SCLOEB; 758 locomo_writel(r, mapbase + LOCOMO_DAC); 759 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 760 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4.7 usec */ 761 if (locomo_readl(mapbase + LOCOMO_DAC) & LOCOMO_DAC_SDAOEB) { /* High is error */ 762 printk(KERN_WARNING "locomo: m62332_senddata Error 3\n"); 763 } 764 765out: 766 /* stop */ 767 r = locomo_readl(mapbase + LOCOMO_DAC); 768 r &= ~(LOCOMO_DAC_SCLOEB); 769 locomo_writel(r, mapbase + LOCOMO_DAC); 770 udelay(DAC_LOW_SETUP_TIME); /* 300 nsec */ 771 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 772 r = locomo_readl(mapbase + LOCOMO_DAC); 773 r |= LOCOMO_DAC_SCLOEB; 774 locomo_writel(r, mapbase + LOCOMO_DAC); 775 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 776 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4 usec */ 777 r = locomo_readl(mapbase + LOCOMO_DAC); 778 r |= LOCOMO_DAC_SDAOEB; 779 locomo_writel(r, mapbase + LOCOMO_DAC); 780 udelay(DAC_HIGH_SETUP_TIME); /* 1000 nsec */ 781 udelay(DAC_SCL_HIGH_HOLD_TIME); /* 4 usec */ 782 783 r = locomo_readl(mapbase + LOCOMO_DAC); 784 r |= LOCOMO_DAC_SCLOEB | LOCOMO_DAC_SDAOEB; 785 locomo_writel(r, mapbase + LOCOMO_DAC); 786 udelay(DAC_LOW_SETUP_TIME); /* 1000 nsec */ 787 udelay(DAC_SCL_LOW_HOLD_TIME); /* 4.7 usec */ 788 789 spin_unlock_irqrestore(&lchip->lock, flags); 790} 791EXPORT_SYMBOL(locomo_m62332_senddata); 792 793/* 794 * Frontlight control 795 */ 796 797void locomo_frontlight_set(struct locomo_dev *dev, int duty, int vr, int bpwf) 798{ 799 unsigned long flags; 800 struct locomo *lchip = locomo_chip_driver(dev); 801 802 if (vr) 803 locomo_gpio_write(dev->dev.parent, LOCOMO_GPIO_FL_VR, 1); 804 else 805 locomo_gpio_write(dev->dev.parent, LOCOMO_GPIO_FL_VR, 0); 806 807 spin_lock_irqsave(&lchip->lock, flags); 808 locomo_writel(bpwf, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); 809 udelay(100); 810 locomo_writel(duty, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALD); 811 locomo_writel(bpwf | LOCOMO_ALC_EN, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS); 812 spin_unlock_irqrestore(&lchip->lock, flags); 813} 814EXPORT_SYMBOL(locomo_frontlight_set); 815 816/* 817 * LoCoMo "Register Access Bus." 818 * 819 * We model this as a regular bus type, and hang devices directly 820 * off this. 821 */ 822static int locomo_match(struct device *_dev, struct device_driver *_drv) 823{ 824 struct locomo_dev *dev = LOCOMO_DEV(_dev); 825 struct locomo_driver *drv = LOCOMO_DRV(_drv); 826 827 return dev->devid == drv->devid; 828} 829 830static int locomo_bus_suspend(struct device *dev, pm_message_t state) 831{ 832 struct locomo_dev *ldev = LOCOMO_DEV(dev); 833 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 834 int ret = 0; 835 836 if (drv && drv->suspend) 837 ret = drv->suspend(ldev, state); 838 return ret; 839} 840 841static int locomo_bus_resume(struct device *dev) 842{ 843 struct locomo_dev *ldev = LOCOMO_DEV(dev); 844 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 845 int ret = 0; 846 847 if (drv && drv->resume) 848 ret = drv->resume(ldev); 849 return ret; 850} 851 852static int locomo_bus_probe(struct device *dev) 853{ 854 struct locomo_dev *ldev = LOCOMO_DEV(dev); 855 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 856 int ret = -ENODEV; 857 858 if (drv->probe) 859 ret = drv->probe(ldev); 860 return ret; 861} 862 863static int locomo_bus_remove(struct device *dev) 864{ 865 struct locomo_dev *ldev = LOCOMO_DEV(dev); 866 struct locomo_driver *drv = LOCOMO_DRV(dev->driver); 867 int ret = 0; 868 869 if (drv->remove) 870 ret = drv->remove(ldev); 871 return ret; 872} 873 874struct bus_type locomo_bus_type = { 875 .name = "locomo-bus", 876 .match = locomo_match, 877 .probe = locomo_bus_probe, 878 .remove = locomo_bus_remove, 879 .suspend = locomo_bus_suspend, 880 .resume = locomo_bus_resume, 881}; 882 883int locomo_driver_register(struct locomo_driver *driver) 884{ 885 driver->drv.bus = &locomo_bus_type; 886 return driver_register(&driver->drv); 887} 888EXPORT_SYMBOL(locomo_driver_register); 889 890void locomo_driver_unregister(struct locomo_driver *driver) 891{ 892 driver_unregister(&driver->drv); 893} 894EXPORT_SYMBOL(locomo_driver_unregister); 895 896static int __init locomo_init(void) 897{ 898 int ret = bus_register(&locomo_bus_type); 899 if (ret == 0) 900 platform_driver_register(&locomo_device_driver); 901 return ret; 902} 903 904static void __exit locomo_exit(void) 905{ 906 platform_driver_unregister(&locomo_device_driver); 907 bus_unregister(&locomo_bus_type); 908} 909 910module_init(locomo_init); 911module_exit(locomo_exit); 912 913MODULE_DESCRIPTION("Sharp LoCoMo core driver"); 914MODULE_LICENSE("GPL"); 915MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>"); 916