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/platform_device.h>
18 #include <asm/hardware/scoop.h>
20 #define SCOOP_REG(d,adr) (*(volatile unsigned short*)(d +(adr)))
24 spinlock_t scoop_lock;
25 unsigned short suspend_clr;
26 unsigned short suspend_set;
30 void reset_scoop(struct device *dev)
32 struct scoop_dev *sdev = dev_get_drvdata(dev);
34 SCOOP_REG(sdev->base,SCOOP_MCR) = 0x0100; // 00
35 SCOOP_REG(sdev->base,SCOOP_CDR) = 0x0000; // 04
36 SCOOP_REG(sdev->base,SCOOP_CCR) = 0x0000; // 10
37 SCOOP_REG(sdev->base,SCOOP_IMR) = 0x0000; // 18
38 SCOOP_REG(sdev->base,SCOOP_IRM) = 0x00FF; // 14
39 SCOOP_REG(sdev->base,SCOOP_ISR) = 0x0000; // 1C
40 SCOOP_REG(sdev->base,SCOOP_IRM) = 0x0000;
43 unsigned short set_scoop_gpio(struct device *dev, unsigned short bit)
45 unsigned short gpio_bit;
47 struct scoop_dev *sdev = dev_get_drvdata(dev);
49 spin_lock_irqsave(&sdev->scoop_lock, flag);
50 gpio_bit = SCOOP_REG(sdev->base, SCOOP_GPWR) | bit;
51 SCOOP_REG(sdev->base, SCOOP_GPWR) = gpio_bit;
52 spin_unlock_irqrestore(&sdev->scoop_lock, flag);
57 unsigned short reset_scoop_gpio(struct device *dev, unsigned short bit)
59 unsigned short gpio_bit;
61 struct scoop_dev *sdev = dev_get_drvdata(dev);
63 spin_lock_irqsave(&sdev->scoop_lock, flag);
64 gpio_bit = SCOOP_REG(sdev->base, SCOOP_GPWR) & ~bit;
65 SCOOP_REG(sdev->base,SCOOP_GPWR) = gpio_bit;
66 spin_unlock_irqrestore(&sdev->scoop_lock, flag);
71 EXPORT_SYMBOL(set_scoop_gpio);
72 EXPORT_SYMBOL(reset_scoop_gpio);
74 unsigned short read_scoop_reg(struct device *dev, unsigned short reg)
76 struct scoop_dev *sdev = dev_get_drvdata(dev);
77 return SCOOP_REG(sdev->base,reg);
80 void write_scoop_reg(struct device *dev, unsigned short reg, unsigned short data)
82 struct scoop_dev *sdev = dev_get_drvdata(dev);
83 SCOOP_REG(sdev->base,reg)=data;
86 EXPORT_SYMBOL(reset_scoop);
87 EXPORT_SYMBOL(read_scoop_reg);
88 EXPORT_SYMBOL(write_scoop_reg);
90 static void check_scoop_reg(struct scoop_dev *sdev)
94 mcr = SCOOP_REG(sdev->base, SCOOP_MCR);
95 if ((mcr & 0x100) == 0)
96 SCOOP_REG(sdev->base, SCOOP_MCR) = 0x0101;
100 static int scoop_suspend(struct platform_device *dev, pm_message_t state)
102 struct scoop_dev *sdev = platform_get_drvdata(dev);
104 check_scoop_reg(sdev);
105 sdev->scoop_gpwr = SCOOP_REG(sdev->base, SCOOP_GPWR);
106 SCOOP_REG(sdev->base, SCOOP_GPWR) = (sdev->scoop_gpwr & ~sdev->suspend_clr) | sdev->suspend_set;
111 static int scoop_resume(struct platform_device *dev)
113 struct scoop_dev *sdev = platform_get_drvdata(dev);
115 check_scoop_reg(sdev);
116 SCOOP_REG(sdev->base,SCOOP_GPWR) = sdev->scoop_gpwr;
121 #define scoop_suspend NULL
122 #define scoop_resume NULL
125 int __init scoop_probe(struct platform_device *pdev)
127 struct scoop_dev *devptr;
128 struct scoop_config *inf;
129 struct resource *mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
134 devptr = kmalloc(sizeof(struct scoop_dev), GFP_KERNEL);
139 memset(devptr, 0, sizeof(struct scoop_dev));
140 spin_lock_init(&devptr->scoop_lock);
142 inf = pdev->dev.platform_data;
143 devptr->base = ioremap(mem->start, mem->end - mem->start + 1);
150 platform_set_drvdata(pdev, devptr);
152 printk("Sharp Scoop Device found at 0x%08x -> 0x%08x\n",(unsigned int)mem->start,(unsigned int)devptr->base);
154 SCOOP_REG(devptr->base, SCOOP_MCR) = 0x0140;
155 reset_scoop(&pdev->dev);
156 SCOOP_REG(devptr->base, SCOOP_CPR) = 0x0000;
157 SCOOP_REG(devptr->base, SCOOP_GPCR) = inf->io_dir & 0xffff;
158 SCOOP_REG(devptr->base, SCOOP_GPWR) = inf->io_out & 0xffff;
160 devptr->suspend_clr = inf->suspend_clr;
161 devptr->suspend_set = inf->suspend_set;
166 static int scoop_remove(struct platform_device *pdev)
168 struct scoop_dev *sdev = platform_get_drvdata(pdev);
172 platform_set_drvdata(pdev, NULL);
177 static struct platform_driver scoop_driver = {
178 .probe = scoop_probe,
179 .remove = scoop_remove,
180 .suspend = scoop_suspend,
181 .resume = scoop_resume,
183 .name = "sharp-scoop",
187 int __init scoop_init(void)
189 return platform_driver_register(&scoop_driver);
192 subsys_initcall(scoop_init);