1
2
3
4
5
6
7
8
9
10
11
12#include <linux/gpio.h>
13#include <linux/gpio/machine.h>
14#include <linux/module.h>
15#include <linux/kernel.h>
16#include <linux/init.h>
17#include <linux/delay.h>
18#include <linux/dma-mapping.h>
19#include <linux/pm.h>
20#include <linux/cpufreq.h>
21#include <linux/ioport.h>
22#include <linux/platform_device.h>
23#include <linux/reboot.h>
24#include <linux/regulator/fixed.h>
25#include <linux/regulator/machine.h>
26#include <linux/irqchip/irq-sa11x0.h>
27
28#include <video/sa1100fb.h>
29
30#include <soc/sa1100/pwer.h>
31
32#include <asm/div64.h>
33#include <asm/mach/map.h>
34#include <asm/mach/flash.h>
35#include <asm/irq.h>
36#include <asm/system_misc.h>
37
38#include <mach/hardware.h>
39#include <mach/irqs.h>
40#include <mach/reset.h>
41
42#include "generic.h"
43#include <clocksource/pxa.h>
44
45unsigned int reset_status;
46EXPORT_SYMBOL(reset_status);
47
48#define NR_FREQS 16
49
50
51
52
53struct cpufreq_frequency_table sa11x0_freq_table[NR_FREQS+1] = {
54 { .frequency = 59000, },
55 { .frequency = 73700, },
56 { .frequency = 88500, },
57 { .frequency = 103200, },
58 { .frequency = 118000, },
59 { .frequency = 132700, },
60 { .frequency = 147500, },
61 { .frequency = 162200, },
62 { .frequency = 176900, },
63 { .frequency = 191700, },
64 { .frequency = 206400, },
65 { .frequency = 221200, },
66 { .frequency = 235900, },
67 { .frequency = 250700, },
68 { .frequency = 265400, },
69 { .frequency = 280200, },
70 { .frequency = CPUFREQ_TABLE_END, },
71};
72
73unsigned int sa11x0_getspeed(unsigned int cpu)
74{
75 if (cpu)
76 return 0;
77 return sa11x0_freq_table[PPCR & 0xf].frequency;
78}
79
80
81
82
83static void sa1100_power_off(void)
84{
85 mdelay(100);
86 local_irq_disable();
87
88 PCFR = (PCFR_OPDE | PCFR_FP | PCFR_FS);
89
90 PWER = GFER = GRER = 1;
91
92
93
94
95 PSPR = 0;
96
97 PMCR = PMCR_SF;
98}
99
100void sa11x0_restart(enum reboot_mode mode, const char *cmd)
101{
102 clear_reset_status(RESET_STATUS_ALL);
103
104 if (mode == REBOOT_SOFT) {
105
106 soft_restart(0);
107 } else {
108
109 RSRR = RSRR_SWR;
110 }
111}
112
113static void sa11x0_register_device(struct platform_device *dev, void *data)
114{
115 int err;
116 dev->dev.platform_data = data;
117 err = platform_device_register(dev);
118 if (err)
119 printk(KERN_ERR "Unable to register device %s: %d\n",
120 dev->name, err);
121}
122
123
124static struct resource sa11x0udc_resources[] = {
125 [0] = DEFINE_RES_MEM(__PREG(Ser0UDCCR), SZ_64K),
126 [1] = DEFINE_RES_IRQ(IRQ_Ser0UDC),
127};
128
129static u64 sa11x0udc_dma_mask = 0xffffffffUL;
130
131static struct platform_device sa11x0udc_device = {
132 .name = "sa11x0-udc",
133 .id = -1,
134 .dev = {
135 .dma_mask = &sa11x0udc_dma_mask,
136 .coherent_dma_mask = 0xffffffff,
137 },
138 .num_resources = ARRAY_SIZE(sa11x0udc_resources),
139 .resource = sa11x0udc_resources,
140};
141
142static struct resource sa11x0uart1_resources[] = {
143 [0] = DEFINE_RES_MEM(__PREG(Ser1UTCR0), SZ_64K),
144 [1] = DEFINE_RES_IRQ(IRQ_Ser1UART),
145};
146
147static struct platform_device sa11x0uart1_device = {
148 .name = "sa11x0-uart",
149 .id = 1,
150 .num_resources = ARRAY_SIZE(sa11x0uart1_resources),
151 .resource = sa11x0uart1_resources,
152};
153
154static struct resource sa11x0uart3_resources[] = {
155 [0] = DEFINE_RES_MEM(__PREG(Ser3UTCR0), SZ_64K),
156 [1] = DEFINE_RES_IRQ(IRQ_Ser3UART),
157};
158
159static struct platform_device sa11x0uart3_device = {
160 .name = "sa11x0-uart",
161 .id = 3,
162 .num_resources = ARRAY_SIZE(sa11x0uart3_resources),
163 .resource = sa11x0uart3_resources,
164};
165
166static struct resource sa11x0mcp_resources[] = {
167 [0] = DEFINE_RES_MEM(__PREG(Ser4MCCR0), SZ_64K),
168 [1] = DEFINE_RES_MEM(__PREG(Ser4MCCR1), 4),
169 [2] = DEFINE_RES_IRQ(IRQ_Ser4MCP),
170};
171
172static u64 sa11x0mcp_dma_mask = 0xffffffffUL;
173
174static struct platform_device sa11x0mcp_device = {
175 .name = "sa11x0-mcp",
176 .id = -1,
177 .dev = {
178 .dma_mask = &sa11x0mcp_dma_mask,
179 .coherent_dma_mask = 0xffffffff,
180 },
181 .num_resources = ARRAY_SIZE(sa11x0mcp_resources),
182 .resource = sa11x0mcp_resources,
183};
184
185void __init sa11x0_ppc_configure_mcp(void)
186{
187
188 PPDR &= ~PPC_RXD4;
189 PPDR |= PPC_TXD4 | PPC_SCLK | PPC_SFRM;
190 PSDR |= PPC_RXD4;
191 PSDR &= ~(PPC_TXD4 | PPC_SCLK | PPC_SFRM);
192 PPSR &= ~(PPC_TXD4 | PPC_SCLK | PPC_SFRM);
193}
194
195void sa11x0_register_mcp(struct mcp_plat_data *data)
196{
197 sa11x0_register_device(&sa11x0mcp_device, data);
198}
199
200static struct resource sa11x0ssp_resources[] = {
201 [0] = DEFINE_RES_MEM(0x80070000, SZ_64K),
202 [1] = DEFINE_RES_IRQ(IRQ_Ser4SSP),
203};
204
205static u64 sa11x0ssp_dma_mask = 0xffffffffUL;
206
207static struct platform_device sa11x0ssp_device = {
208 .name = "sa11x0-ssp",
209 .id = -1,
210 .dev = {
211 .dma_mask = &sa11x0ssp_dma_mask,
212 .coherent_dma_mask = 0xffffffff,
213 },
214 .num_resources = ARRAY_SIZE(sa11x0ssp_resources),
215 .resource = sa11x0ssp_resources,
216};
217
218static struct resource sa11x0fb_resources[] = {
219 [0] = DEFINE_RES_MEM(0xb0100000, SZ_64K),
220 [1] = DEFINE_RES_IRQ(IRQ_LCD),
221};
222
223static struct platform_device sa11x0fb_device = {
224 .name = "sa11x0-fb",
225 .id = -1,
226 .dev = {
227 .coherent_dma_mask = 0xffffffff,
228 },
229 .num_resources = ARRAY_SIZE(sa11x0fb_resources),
230 .resource = sa11x0fb_resources,
231};
232
233void sa11x0_register_lcd(struct sa1100fb_mach_info *inf)
234{
235 sa11x0_register_device(&sa11x0fb_device, inf);
236}
237
238static bool sa11x0pcmcia_legacy = true;
239static struct platform_device sa11x0pcmcia_device = {
240 .name = "sa11x0-pcmcia",
241 .id = -1,
242};
243
244void sa11x0_register_pcmcia(int socket, struct gpiod_lookup_table *table)
245{
246 if (table)
247 gpiod_add_lookup_table(table);
248 platform_device_register_simple("sa11x0-pcmcia", socket, NULL, 0);
249 sa11x0pcmcia_legacy = false;
250}
251
252static struct platform_device sa11x0mtd_device = {
253 .name = "sa1100-mtd",
254 .id = -1,
255};
256
257void sa11x0_register_mtd(struct flash_platform_data *flash,
258 struct resource *res, int nr)
259{
260 flash->name = "sa1100";
261 sa11x0mtd_device.resource = res;
262 sa11x0mtd_device.num_resources = nr;
263 sa11x0_register_device(&sa11x0mtd_device, flash);
264}
265
266static struct resource sa11x0ir_resources[] = {
267 DEFINE_RES_MEM(__PREG(Ser2UTCR0), 0x24),
268 DEFINE_RES_MEM(__PREG(Ser2HSCR0), 0x1c),
269 DEFINE_RES_MEM(__PREG(Ser2HSCR2), 0x04),
270 DEFINE_RES_IRQ(IRQ_Ser2ICP),
271};
272
273static struct platform_device sa11x0ir_device = {
274 .name = "sa11x0-ir",
275 .id = -1,
276 .num_resources = ARRAY_SIZE(sa11x0ir_resources),
277 .resource = sa11x0ir_resources,
278};
279
280void sa11x0_register_irda(struct irda_platform_data *irda)
281{
282 sa11x0_register_device(&sa11x0ir_device, irda);
283}
284
285static struct resource sa1100_rtc_resources[] = {
286 DEFINE_RES_MEM(0x90010000, 0x40),
287 DEFINE_RES_IRQ_NAMED(IRQ_RTC1Hz, "rtc 1Hz"),
288 DEFINE_RES_IRQ_NAMED(IRQ_RTCAlrm, "rtc alarm"),
289};
290
291static struct platform_device sa11x0rtc_device = {
292 .name = "sa1100-rtc",
293 .id = -1,
294 .num_resources = ARRAY_SIZE(sa1100_rtc_resources),
295 .resource = sa1100_rtc_resources,
296};
297
298static struct resource sa11x0dma_resources[] = {
299 DEFINE_RES_MEM(DMA_PHYS, DMA_SIZE),
300 DEFINE_RES_IRQ(IRQ_DMA0),
301 DEFINE_RES_IRQ(IRQ_DMA1),
302 DEFINE_RES_IRQ(IRQ_DMA2),
303 DEFINE_RES_IRQ(IRQ_DMA3),
304 DEFINE_RES_IRQ(IRQ_DMA4),
305 DEFINE_RES_IRQ(IRQ_DMA5),
306};
307
308static u64 sa11x0dma_dma_mask = DMA_BIT_MASK(32);
309
310static struct platform_device sa11x0dma_device = {
311 .name = "sa11x0-dma",
312 .id = -1,
313 .dev = {
314 .dma_mask = &sa11x0dma_dma_mask,
315 .coherent_dma_mask = 0xffffffff,
316 },
317 .num_resources = ARRAY_SIZE(sa11x0dma_resources),
318 .resource = sa11x0dma_resources,
319};
320
321static struct platform_device *sa11x0_devices[] __initdata = {
322 &sa11x0udc_device,
323 &sa11x0uart1_device,
324 &sa11x0uart3_device,
325 &sa11x0ssp_device,
326 &sa11x0rtc_device,
327 &sa11x0dma_device,
328};
329
330static int __init sa1100_init(void)
331{
332 pm_power_off = sa1100_power_off;
333
334 if (sa11x0pcmcia_legacy)
335 platform_device_register(&sa11x0pcmcia_device);
336
337 regulator_has_full_constraints();
338
339 return platform_add_devices(sa11x0_devices, ARRAY_SIZE(sa11x0_devices));
340}
341
342arch_initcall(sa1100_init);
343
344void __init sa11x0_init_late(void)
345{
346 sa11x0_pm_init();
347}
348
349int __init sa11x0_register_fixed_regulator(int n,
350 struct fixed_voltage_config *cfg,
351 struct regulator_consumer_supply *supplies, unsigned num_supplies)
352{
353 struct regulator_init_data *id;
354
355 cfg->init_data = id = kzalloc(sizeof(*cfg->init_data), GFP_KERNEL);
356 if (!cfg->init_data)
357 return -ENOMEM;
358
359 if (cfg->gpio < 0)
360 id->constraints.always_on = 1;
361 id->constraints.name = cfg->supply_name;
362 id->constraints.min_uV = cfg->microvolts;
363 id->constraints.max_uV = cfg->microvolts;
364 id->constraints.valid_modes_mask = REGULATOR_MODE_NORMAL;
365 id->constraints.valid_ops_mask = REGULATOR_CHANGE_STATUS;
366 id->consumer_supplies = supplies;
367 id->num_consumer_supplies = num_supplies;
368
369 platform_device_register_resndata(NULL, "reg-fixed-voltage", n,
370 NULL, 0, cfg, sizeof(*cfg));
371 return 0;
372}
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392static struct map_desc standard_io_desc[] __initdata = {
393 {
394 .virtual = 0xf8000000,
395 .pfn = __phys_to_pfn(0x80000000),
396 .length = 0x00100000,
397 .type = MT_DEVICE
398 }, {
399 .virtual = 0xfa000000,
400 .pfn = __phys_to_pfn(0x90000000),
401 .length = 0x00100000,
402 .type = MT_DEVICE
403 }, {
404 .virtual = 0xfc000000,
405 .pfn = __phys_to_pfn(0xa0000000),
406 .length = 0x00100000,
407 .type = MT_DEVICE
408 }, {
409 .virtual = 0xfe000000,
410 .pfn = __phys_to_pfn(0xb0000000),
411 .length = 0x00200000,
412 .type = MT_DEVICE
413 },
414};
415
416void __init sa1100_map_io(void)
417{
418 iotable_init(standard_io_desc, ARRAY_SIZE(standard_io_desc));
419}
420
421void __init sa1100_timer_init(void)
422{
423 pxa_timer_nodt_init(IRQ_OST0, io_p2v(0x90000000));
424}
425
426static struct resource irq_resource =
427 DEFINE_RES_MEM_NAMED(0x90050000, SZ_64K, "irqs");
428
429void __init sa1100_init_irq(void)
430{
431 request_resource(&iomem_resource, &irq_resource);
432
433 sa11x0_init_irq_nodt(IRQ_GPIO0_SC, irq_resource.start);
434
435 sa1100_init_gpio();
436 sa11xx_clk_init();
437}
438
439
440
441
442
443
444
445void sa1110_mb_disable(void)
446{
447 unsigned long flags;
448
449 local_irq_save(flags);
450
451 PGSR &= ~GPIO_MBGNT;
452 GPCR = GPIO_MBGNT;
453 GPDR = (GPDR & ~GPIO_MBREQ) | GPIO_MBGNT;
454
455 GAFR &= ~(GPIO_MBGNT | GPIO_MBREQ);
456
457 local_irq_restore(flags);
458}
459
460
461
462
463
464void sa1110_mb_enable(void)
465{
466 unsigned long flags;
467
468 local_irq_save(flags);
469
470 PGSR &= ~GPIO_MBGNT;
471 GPCR = GPIO_MBGNT;
472 GPDR = (GPDR & ~GPIO_MBREQ) | GPIO_MBGNT;
473
474 GAFR |= (GPIO_MBGNT | GPIO_MBREQ);
475 TUCR |= TUCR_MR;
476
477 local_irq_restore(flags);
478}
479
480int sa11x0_gpio_set_wake(unsigned int gpio, unsigned int on)
481{
482 if (on)
483 PWER |= BIT(gpio);
484 else
485 PWER &= ~BIT(gpio);
486
487 return 0;
488}
489
490int sa11x0_sc_set_wake(unsigned int irq, unsigned int on)
491{
492 if (BIT(irq) != IC_RTCAlrm)
493 return -EINVAL;
494
495 if (on)
496 PWER |= PWER_RTC;
497 else
498 PWER &= ~PWER_RTC;
499
500 return 0;
501}
502