2 * Support code for the SCOOP interface found on various Sharp PDAs
4 * Copyright (c) 2004 Richard Purdie
6 * Based on code written by Sharp/Lineo for 2.4 kernels
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
14 #include <linux/device.h>
15 #include <linux/string.h>
16 #include <linux/slab.h>
17 #include <linux/platform_device.h>
19 #include <asm/hardware/scoop.h>
21 /* PCMCIA to Scoop linkage
23 There is no easy way to link multiple scoop devices into one
24 single entity for the pxa2xx_pcmcia device so this structure
25 is used which is setup by the platform code.
27 This file is never modular so this symbol is always
28 accessile to the board support files.
30 struct scoop_pcmcia_config *platform_scoop_config;
31 EXPORT_SYMBOL(platform_scoop_config);
35 spinlock_t scoop_lock;
36 unsigned short suspend_clr;
37 unsigned short suspend_set;
41 void reset_scoop(struct device *dev)
43 struct scoop_dev *sdev = dev_get_drvdata(dev);
45 iowrite16(0x0100, sdev->base + SCOOP_MCR); // 00
46 iowrite16(0x0000, sdev->base + SCOOP_CDR); // 04
47 iowrite16(0x0000, sdev->base + SCOOP_CCR); // 10
48 iowrite16(0x0000, sdev->base + SCOOP_IMR); // 18
49 iowrite16(0x00FF, sdev->base + SCOOP_IRM); // 14
50 iowrite16(0x0000, sdev->base + SCOOP_ISR); // 1C
51 iowrite16(0x0000, sdev->base + SCOOP_IRM);
54 unsigned short set_scoop_gpio(struct device *dev, unsigned short bit)
56 unsigned short gpio_bit;
58 struct scoop_dev *sdev = dev_get_drvdata(dev);
60 spin_lock_irqsave(&sdev->scoop_lock, flag);
61 gpio_bit = ioread16(sdev->base + SCOOP_GPWR) | bit;
62 iowrite16(gpio_bit, sdev->base + SCOOP_GPWR);
63 spin_unlock_irqrestore(&sdev->scoop_lock, flag);
68 unsigned short reset_scoop_gpio(struct device *dev, unsigned short bit)
70 unsigned short gpio_bit;
72 struct scoop_dev *sdev = dev_get_drvdata(dev);
74 spin_lock_irqsave(&sdev->scoop_lock, flag);
75 gpio_bit = ioread16(sdev->base + SCOOP_GPWR) & ~bit;
76 iowrite16(gpio_bit, sdev->base + SCOOP_GPWR);
77 spin_unlock_irqrestore(&sdev->scoop_lock, flag);
82 EXPORT_SYMBOL(set_scoop_gpio);
83 EXPORT_SYMBOL(reset_scoop_gpio);
85 unsigned short read_scoop_reg(struct device *dev, unsigned short reg)
87 struct scoop_dev *sdev = dev_get_drvdata(dev);
88 return ioread16(sdev->base + reg);
91 void write_scoop_reg(struct device *dev, unsigned short reg, unsigned short data)
93 struct scoop_dev *sdev = dev_get_drvdata(dev);
94 iowrite16(data, sdev->base + reg);
97 EXPORT_SYMBOL(reset_scoop);
98 EXPORT_SYMBOL(read_scoop_reg);
99 EXPORT_SYMBOL(write_scoop_reg);
101 static void check_scoop_reg(struct scoop_dev *sdev)
105 mcr = ioread16(sdev->base + SCOOP_MCR);
106 if ((mcr & 0x100) == 0)
107 iowrite16(0x0101, sdev->base + SCOOP_MCR);
111 static int scoop_suspend(struct platform_device *dev, pm_message_t state)
113 struct scoop_dev *sdev = platform_get_drvdata(dev);
115 check_scoop_reg(sdev);
116 sdev->scoop_gpwr = ioread16(sdev->base + SCOOP_GPWR);
117 iowrite16((sdev->scoop_gpwr & ~sdev->suspend_clr) | sdev->suspend_set, sdev->base + SCOOP_GPWR);
122 static int scoop_resume(struct platform_device *dev)
124 struct scoop_dev *sdev = platform_get_drvdata(dev);
126 check_scoop_reg(sdev);
127 iowrite16(sdev->scoop_gpwr, sdev->base + SCOOP_GPWR);
132 #define scoop_suspend NULL
133 #define scoop_resume NULL
136 static int __devinit scoop_probe(struct platform_device *pdev)
138 struct scoop_dev *devptr;
139 struct scoop_config *inf;
140 struct resource *mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
145 devptr = kzalloc(sizeof(struct scoop_dev), GFP_KERNEL);
149 spin_lock_init(&devptr->scoop_lock);
151 inf = pdev->dev.platform_data;
152 devptr->base = ioremap(mem->start, mem->end - mem->start + 1);
159 platform_set_drvdata(pdev, devptr);
161 printk("Sharp Scoop Device found at 0x%08x -> 0x%8p\n",(unsigned int)mem->start, devptr->base);
163 iowrite16(0x0140, devptr->base + SCOOP_MCR);
164 reset_scoop(&pdev->dev);
165 iowrite16(0x0000, devptr->base + SCOOP_CPR);
166 iowrite16(inf->io_dir & 0xffff, devptr->base + SCOOP_GPCR);
167 iowrite16(inf->io_out & 0xffff, devptr->base + SCOOP_GPWR);
169 devptr->suspend_clr = inf->suspend_clr;
170 devptr->suspend_set = inf->suspend_set;
175 static int __devexit scoop_remove(struct platform_device *pdev)
177 struct scoop_dev *sdev = platform_get_drvdata(pdev);
181 platform_set_drvdata(pdev, NULL);
186 static struct platform_driver scoop_driver = {
187 .probe = scoop_probe,
188 .remove = __devexit_p(scoop_remove),
189 .suspend = scoop_suspend,
190 .resume = scoop_resume,
192 .name = "sharp-scoop",
196 static int __init scoop_init(void)
198 return platform_driver_register(&scoop_driver);
201 subsys_initcall(scoop_init);