]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Support code for the SCOOP interface found on various Sharp PDAs | |
3 | * | |
4 | * Copyright (c) 2004 Richard Purdie | |
5 | * | |
6 | * Based on code written by Sharp/Lineo for 2.4 kernels | |
7 | * | |
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. | |
11 | * | |
12 | */ | |
13 | ||
14 | #include <linux/device.h> | |
15 | #include <asm/io.h> | |
16 | #include <asm/hardware/scoop.h> | |
17 | ||
18 | #define SCOOP_REG(d,adr) (*(volatile unsigned short*)(d +(adr))) | |
19 | ||
0ce7625f RP |
20 | /* PCMCIA to Scoop linkage structures for pxa2xx_sharpsl.c |
21 | There is no easy way to link multiple scoop devices into one | |
22 | single entity for the pxa2xx_pcmcia device */ | |
23 | int scoop_num; | |
24 | struct scoop_pcmcia_dev *scoop_devs; | |
25 | ||
1da177e4 LT |
26 | struct scoop_dev { |
27 | void *base; | |
28 | spinlock_t scoop_lock; | |
7c398988 RP |
29 | unsigned short suspend_clr; |
30 | unsigned short suspend_set; | |
1da177e4 LT |
31 | u32 scoop_gpwr; |
32 | }; | |
33 | ||
34 | void reset_scoop(struct device *dev) | |
35 | { | |
36 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
37 | ||
38 | SCOOP_REG(sdev->base,SCOOP_MCR) = 0x0100; // 00 | |
39 | SCOOP_REG(sdev->base,SCOOP_CDR) = 0x0000; // 04 | |
40 | SCOOP_REG(sdev->base,SCOOP_CPR) = 0x0000; // 0C | |
41 | SCOOP_REG(sdev->base,SCOOP_CCR) = 0x0000; // 10 | |
42 | SCOOP_REG(sdev->base,SCOOP_IMR) = 0x0000; // 18 | |
43 | SCOOP_REG(sdev->base,SCOOP_IRM) = 0x00FF; // 14 | |
44 | SCOOP_REG(sdev->base,SCOOP_ISR) = 0x0000; // 1C | |
45 | SCOOP_REG(sdev->base,SCOOP_IRM) = 0x0000; | |
46 | } | |
47 | ||
48 | unsigned short set_scoop_gpio(struct device *dev, unsigned short bit) | |
49 | { | |
50 | unsigned short gpio_bit; | |
51 | unsigned long flag; | |
52 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
53 | ||
54 | spin_lock_irqsave(&sdev->scoop_lock, flag); | |
55 | gpio_bit = SCOOP_REG(sdev->base, SCOOP_GPWR) | bit; | |
56 | SCOOP_REG(sdev->base, SCOOP_GPWR) = gpio_bit; | |
57 | spin_unlock_irqrestore(&sdev->scoop_lock, flag); | |
58 | ||
59 | return gpio_bit; | |
60 | } | |
61 | ||
62 | unsigned short reset_scoop_gpio(struct device *dev, unsigned short bit) | |
63 | { | |
64 | unsigned short gpio_bit; | |
65 | unsigned long flag; | |
66 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
67 | ||
68 | spin_lock_irqsave(&sdev->scoop_lock, flag); | |
69 | gpio_bit = SCOOP_REG(sdev->base, SCOOP_GPWR) & ~bit; | |
70 | SCOOP_REG(sdev->base,SCOOP_GPWR) = gpio_bit; | |
71 | spin_unlock_irqrestore(&sdev->scoop_lock, flag); | |
72 | ||
73 | return gpio_bit; | |
74 | } | |
75 | ||
76 | EXPORT_SYMBOL(set_scoop_gpio); | |
77 | EXPORT_SYMBOL(reset_scoop_gpio); | |
78 | ||
79 | unsigned short read_scoop_reg(struct device *dev, unsigned short reg) | |
80 | { | |
81 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
82 | return SCOOP_REG(sdev->base,reg); | |
83 | } | |
84 | ||
85 | void write_scoop_reg(struct device *dev, unsigned short reg, unsigned short data) | |
86 | { | |
87 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
88 | SCOOP_REG(sdev->base,reg)=data; | |
89 | } | |
90 | ||
91 | EXPORT_SYMBOL(reset_scoop); | |
92 | EXPORT_SYMBOL(read_scoop_reg); | |
93 | EXPORT_SYMBOL(write_scoop_reg); | |
94 | ||
7c398988 RP |
95 | static void check_scoop_reg(struct scoop_dev *sdev) |
96 | { | |
97 | unsigned short mcr; | |
98 | ||
99 | mcr = SCOOP_REG(sdev->base, SCOOP_MCR); | |
100 | if ((mcr & 0x100) == 0) | |
101 | SCOOP_REG(sdev->base, SCOOP_MCR) = 0x0101; | |
102 | } | |
103 | ||
1da177e4 | 104 | #ifdef CONFIG_PM |
daad5666 | 105 | static int scoop_suspend(struct device *dev, pm_message_t state, uint32_t level) |
1da177e4 LT |
106 | { |
107 | if (level == SUSPEND_POWER_DOWN) { | |
108 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
109 | ||
7c398988 RP |
110 | check_scoop_reg(sdev); |
111 | sdev->scoop_gpwr = SCOOP_REG(sdev->base, SCOOP_GPWR); | |
112 | SCOOP_REG(sdev->base, SCOOP_GPWR) = (sdev->scoop_gpwr & ~sdev->suspend_clr) | sdev->suspend_set; | |
1da177e4 LT |
113 | } |
114 | return 0; | |
115 | } | |
116 | ||
117 | static int scoop_resume(struct device *dev, uint32_t level) | |
118 | { | |
119 | if (level == RESUME_POWER_ON) { | |
120 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
121 | ||
7c398988 | 122 | check_scoop_reg(sdev); |
1da177e4 LT |
123 | SCOOP_REG(sdev->base,SCOOP_GPWR) = sdev->scoop_gpwr; |
124 | } | |
125 | return 0; | |
126 | } | |
127 | #else | |
128 | #define scoop_suspend NULL | |
129 | #define scoop_resume NULL | |
130 | #endif | |
131 | ||
132 | int __init scoop_probe(struct device *dev) | |
133 | { | |
134 | struct scoop_dev *devptr; | |
135 | struct scoop_config *inf; | |
136 | struct platform_device *pdev = to_platform_device(dev); | |
137 | struct resource *mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
138 | ||
139 | if (!mem) | |
140 | return -EINVAL; | |
141 | ||
142 | devptr = kmalloc(sizeof(struct scoop_dev), GFP_KERNEL); | |
143 | ||
144 | if (!devptr) | |
145 | return -ENOMEM; | |
146 | ||
147 | memset(devptr, 0, sizeof(struct scoop_dev)); | |
148 | spin_lock_init(&devptr->scoop_lock); | |
149 | ||
150 | inf = dev->platform_data; | |
151 | devptr->base = ioremap(mem->start, mem->end - mem->start + 1); | |
152 | ||
153 | if (!devptr->base) { | |
154 | kfree(devptr); | |
155 | return -ENOMEM; | |
156 | } | |
157 | ||
158 | dev_set_drvdata(dev, devptr); | |
159 | ||
160 | printk("Sharp Scoop Device found at 0x%08x -> 0x%08x\n",(unsigned int)mem->start,(unsigned int)devptr->base); | |
161 | ||
162 | SCOOP_REG(devptr->base, SCOOP_MCR) = 0x0140; | |
163 | reset_scoop(dev); | |
164 | SCOOP_REG(devptr->base, SCOOP_GPCR) = inf->io_dir & 0xffff; | |
165 | SCOOP_REG(devptr->base, SCOOP_GPWR) = inf->io_out & 0xffff; | |
166 | ||
7c398988 RP |
167 | devptr->suspend_clr = inf->suspend_clr; |
168 | devptr->suspend_set = inf->suspend_set; | |
169 | ||
1da177e4 LT |
170 | return 0; |
171 | } | |
172 | ||
173 | static int scoop_remove(struct device *dev) | |
174 | { | |
175 | struct scoop_dev *sdev = dev_get_drvdata(dev); | |
176 | if (sdev) { | |
177 | iounmap(sdev->base); | |
178 | kfree(sdev); | |
179 | dev_set_drvdata(dev, NULL); | |
180 | } | |
181 | return 0; | |
182 | } | |
183 | ||
184 | static struct device_driver scoop_driver = { | |
185 | .name = "sharp-scoop", | |
186 | .bus = &platform_bus_type, | |
187 | .probe = scoop_probe, | |
188 | .remove = scoop_remove, | |
189 | .suspend = scoop_suspend, | |
190 | .resume = scoop_resume, | |
191 | }; | |
192 | ||
193 | int __init scoop_init(void) | |
194 | { | |
195 | return driver_register(&scoop_driver); | |
196 | } | |
197 | ||
198 | subsys_initcall(scoop_init); |