1
2
3
4
5
6
7
8
9
10
11
12#include <linux/module.h>
13#include <linux/kernel.h>
14#include <linux/init.h>
15#include <linux/delay.h>
16#include <linux/pm.h>
17#include <linux/cpufreq.h>
18#include <linux/ioport.h>
19#include <linux/platform_device.h>
20
21#include <asm/div64.h>
22#include <mach/hardware.h>
23#include <asm/system.h>
24#include <asm/mach/map.h>
25#include <asm/mach/flash.h>
26#include <asm/irq.h>
27#include <asm/gpio.h>
28
29#include "generic.h"
30
31unsigned int reset_status;
32EXPORT_SYMBOL(reset_status);
33
34#define NR_FREQS 16
35
36
37
38
39static const unsigned short cclk_frequency_100khz[NR_FREQS] = {
40 590,
41 737,
42 885,
43 1032,
44 1180,
45 1327,
46 1475,
47 1622,
48 1769,
49 1917,
50 2064,
51 2212,
52 2359,
53 2507,
54 2654,
55 2802
56};
57
58
59unsigned int sa11x0_freq_to_ppcr(unsigned int khz)
60{
61 int i;
62
63 khz /= 100;
64
65 for (i = 0; i < NR_FREQS; i++)
66 if (cclk_frequency_100khz[i] >= khz)
67 break;
68
69 return i;
70}
71
72unsigned int sa11x0_ppcr_to_freq(unsigned int idx)
73{
74 unsigned int freq = 0;
75 if (idx < NR_FREQS)
76 freq = cclk_frequency_100khz[idx] * 100;
77 return freq;
78}
79
80
81
82
83
84int sa11x0_verify_speed(struct cpufreq_policy *policy)
85{
86 unsigned int tmp;
87 if (policy->cpu)
88 return -EINVAL;
89
90 cpufreq_verify_within_limits(policy, policy->cpuinfo.min_freq, policy->cpuinfo.max_freq);
91
92
93 tmp = cclk_frequency_100khz[sa11x0_freq_to_ppcr(policy->min)] * 100;
94 if (tmp > policy->max)
95 policy->max = tmp;
96
97 cpufreq_verify_within_limits(policy, policy->cpuinfo.min_freq, policy->cpuinfo.max_freq);
98
99 return 0;
100}
101
102unsigned int sa11x0_getspeed(unsigned int cpu)
103{
104 if (cpu)
105 return 0;
106 return cclk_frequency_100khz[PPCR & 0xf] * 100;
107}
108
109
110
111
112static void sa1100_power_off(void)
113{
114 mdelay(100);
115 local_irq_disable();
116
117 PCFR = (PCFR_OPDE | PCFR_FP | PCFR_FS);
118
119 PWER = GFER = GRER = 1;
120
121
122
123
124 PSPR = 0;
125
126 PMCR = PMCR_SF;
127}
128
129static void sa11x0_register_device(struct platform_device *dev, void *data)
130{
131 int err;
132 dev->dev.platform_data = data;
133 err = platform_device_register(dev);
134 if (err)
135 printk(KERN_ERR "Unable to register device %s: %d\n",
136 dev->name, err);
137}
138
139
140static struct resource sa11x0udc_resources[] = {
141 [0] = {
142 .start = __PREG(Ser0UDCCR),
143 .end = __PREG(Ser0UDCCR) + 0xffff,
144 .flags = IORESOURCE_MEM,
145 },
146 [1] = {
147 .start = IRQ_Ser0UDC,
148 .end = IRQ_Ser0UDC,
149 .flags = IORESOURCE_IRQ,
150 },
151};
152
153static u64 sa11x0udc_dma_mask = 0xffffffffUL;
154
155static struct platform_device sa11x0udc_device = {
156 .name = "sa11x0-udc",
157 .id = -1,
158 .dev = {
159 .dma_mask = &sa11x0udc_dma_mask,
160 .coherent_dma_mask = 0xffffffff,
161 },
162 .num_resources = ARRAY_SIZE(sa11x0udc_resources),
163 .resource = sa11x0udc_resources,
164};
165
166static struct resource sa11x0uart1_resources[] = {
167 [0] = {
168 .start = __PREG(Ser1UTCR0),
169 .end = __PREG(Ser1UTCR0) + 0xffff,
170 .flags = IORESOURCE_MEM,
171 },
172 [1] = {
173 .start = IRQ_Ser1UART,
174 .end = IRQ_Ser1UART,
175 .flags = IORESOURCE_IRQ,
176 },
177};
178
179static struct platform_device sa11x0uart1_device = {
180 .name = "sa11x0-uart",
181 .id = 1,
182 .num_resources = ARRAY_SIZE(sa11x0uart1_resources),
183 .resource = sa11x0uart1_resources,
184};
185
186static struct resource sa11x0uart3_resources[] = {
187 [0] = {
188 .start = __PREG(Ser3UTCR0),
189 .end = __PREG(Ser3UTCR0) + 0xffff,
190 .flags = IORESOURCE_MEM,
191 },
192 [1] = {
193 .start = IRQ_Ser3UART,
194 .end = IRQ_Ser3UART,
195 .flags = IORESOURCE_IRQ,
196 },
197};
198
199static struct platform_device sa11x0uart3_device = {
200 .name = "sa11x0-uart",
201 .id = 3,
202 .num_resources = ARRAY_SIZE(sa11x0uart3_resources),
203 .resource = sa11x0uart3_resources,
204};
205
206static struct resource sa11x0mcp_resources[] = {
207 [0] = {
208 .start = __PREG(Ser4MCCR0),
209 .end = __PREG(Ser4MCCR0) + 0xffff,
210 .flags = IORESOURCE_MEM,
211 },
212 [1] = {
213 .start = IRQ_Ser4MCP,
214 .end = IRQ_Ser4MCP,
215 .flags = IORESOURCE_IRQ,
216 },
217};
218
219static u64 sa11x0mcp_dma_mask = 0xffffffffUL;
220
221static struct platform_device sa11x0mcp_device = {
222 .name = "sa11x0-mcp",
223 .id = -1,
224 .dev = {
225 .dma_mask = &sa11x0mcp_dma_mask,
226 .coherent_dma_mask = 0xffffffff,
227 },
228 .num_resources = ARRAY_SIZE(sa11x0mcp_resources),
229 .resource = sa11x0mcp_resources,
230};
231
232void sa11x0_register_mcp(struct mcp_plat_data *data)
233{
234 sa11x0_register_device(&sa11x0mcp_device, data);
235}
236
237static struct resource sa11x0ssp_resources[] = {
238 [0] = {
239 .start = 0x80070000,
240 .end = 0x8007ffff,
241 .flags = IORESOURCE_MEM,
242 },
243 [1] = {
244 .start = IRQ_Ser4SSP,
245 .end = IRQ_Ser4SSP,
246 .flags = IORESOURCE_IRQ,
247 },
248};
249
250static u64 sa11x0ssp_dma_mask = 0xffffffffUL;
251
252static struct platform_device sa11x0ssp_device = {
253 .name = "sa11x0-ssp",
254 .id = -1,
255 .dev = {
256 .dma_mask = &sa11x0ssp_dma_mask,
257 .coherent_dma_mask = 0xffffffff,
258 },
259 .num_resources = ARRAY_SIZE(sa11x0ssp_resources),
260 .resource = sa11x0ssp_resources,
261};
262
263static struct resource sa11x0fb_resources[] = {
264 [0] = {
265 .start = 0xb0100000,
266 .end = 0xb010ffff,
267 .flags = IORESOURCE_MEM,
268 },
269 [1] = {
270 .start = IRQ_LCD,
271 .end = IRQ_LCD,
272 .flags = IORESOURCE_IRQ,
273 },
274};
275
276static struct platform_device sa11x0fb_device = {
277 .name = "sa11x0-fb",
278 .id = -1,
279 .dev = {
280 .coherent_dma_mask = 0xffffffff,
281 },
282 .num_resources = ARRAY_SIZE(sa11x0fb_resources),
283 .resource = sa11x0fb_resources,
284};
285
286static struct platform_device sa11x0pcmcia_device = {
287 .name = "sa11x0-pcmcia",
288 .id = -1,
289};
290
291static struct platform_device sa11x0mtd_device = {
292 .name = "sa1100-mtd",
293 .id = -1,
294};
295
296void sa11x0_register_mtd(struct flash_platform_data *flash,
297 struct resource *res, int nr)
298{
299 flash->name = "sa1100";
300 sa11x0mtd_device.resource = res;
301 sa11x0mtd_device.num_resources = nr;
302 sa11x0_register_device(&sa11x0mtd_device, flash);
303}
304
305static struct resource sa11x0ir_resources[] = {
306 {
307 .start = __PREG(Ser2UTCR0),
308 .end = __PREG(Ser2UTCR0) + 0x24 - 1,
309 .flags = IORESOURCE_MEM,
310 }, {
311 .start = __PREG(Ser2HSCR0),
312 .end = __PREG(Ser2HSCR0) + 0x1c - 1,
313 .flags = IORESOURCE_MEM,
314 }, {
315 .start = __PREG(Ser2HSCR2),
316 .end = __PREG(Ser2HSCR2) + 0x04 - 1,
317 .flags = IORESOURCE_MEM,
318 }, {
319 .start = IRQ_Ser2ICP,
320 .end = IRQ_Ser2ICP,
321 .flags = IORESOURCE_IRQ,
322 }
323};
324
325static struct platform_device sa11x0ir_device = {
326 .name = "sa11x0-ir",
327 .id = -1,
328 .num_resources = ARRAY_SIZE(sa11x0ir_resources),
329 .resource = sa11x0ir_resources,
330};
331
332void sa11x0_register_irda(struct irda_platform_data *irda)
333{
334 sa11x0_register_device(&sa11x0ir_device, irda);
335}
336
337static struct platform_device sa11x0rtc_device = {
338 .name = "sa1100-rtc",
339 .id = -1,
340};
341
342static struct platform_device *sa11x0_devices[] __initdata = {
343 &sa11x0udc_device,
344 &sa11x0uart1_device,
345 &sa11x0uart3_device,
346 &sa11x0ssp_device,
347 &sa11x0pcmcia_device,
348 &sa11x0fb_device,
349 &sa11x0rtc_device,
350};
351
352static int __init sa1100_init(void)
353{
354 pm_power_off = sa1100_power_off;
355 return platform_add_devices(sa11x0_devices, ARRAY_SIZE(sa11x0_devices));
356}
357
358arch_initcall(sa1100_init);
359
360void (*sa1100fb_backlight_power)(int on);
361void (*sa1100fb_lcd_power)(int on);
362
363EXPORT_SYMBOL(sa1100fb_backlight_power);
364EXPORT_SYMBOL(sa1100fb_lcd_power);
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385static struct map_desc standard_io_desc[] __initdata = {
386 {
387 .virtual = 0xf8000000,
388 .pfn = __phys_to_pfn(0x80000000),
389 .length = 0x00100000,
390 .type = MT_DEVICE
391 }, {
392 .virtual = 0xfa000000,
393 .pfn = __phys_to_pfn(0x90000000),
394 .length = 0x00100000,
395 .type = MT_DEVICE
396 }, {
397 .virtual = 0xfc000000,
398 .pfn = __phys_to_pfn(0xa0000000),
399 .length = 0x00100000,
400 .type = MT_DEVICE
401 }, {
402 .virtual = 0xfe000000,
403 .pfn = __phys_to_pfn(0xb0000000),
404 .length = 0x00200000,
405 .type = MT_DEVICE
406 },
407};
408
409void __init sa1100_map_io(void)
410{
411 iotable_init(standard_io_desc, ARRAY_SIZE(standard_io_desc));
412}
413
414
415
416
417
418
419
420void __init sa1110_mb_disable(void)
421{
422 unsigned long flags;
423
424 local_irq_save(flags);
425
426 PGSR &= ~GPIO_MBGNT;
427 GPCR = GPIO_MBGNT;
428 GPDR = (GPDR & ~GPIO_MBREQ) | GPIO_MBGNT;
429
430 GAFR &= ~(GPIO_MBGNT | GPIO_MBREQ);
431
432 local_irq_restore(flags);
433}
434
435
436
437
438
439void __devinit sa1110_mb_enable(void)
440{
441 unsigned long flags;
442
443 local_irq_save(flags);
444
445 PGSR &= ~GPIO_MBGNT;
446 GPCR = GPIO_MBGNT;
447 GPDR = (GPDR & ~GPIO_MBREQ) | GPIO_MBGNT;
448
449 GAFR |= (GPIO_MBGNT | GPIO_MBREQ);
450 TUCR |= TUCR_MR;
451
452 local_irq_restore(flags);
453}
454
455