1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/types.h>
24#include <linux/memory.h>
25#include <linux/cpu.h>
26#include <linux/cpufreq.h>
27#include <linux/delay.h>
28#include <linux/fs.h>
29#include <linux/init.h>
30#include <linux/slab.h>
31#include <linux/interrupt.h>
32#include <linux/major.h>
33#include <linux/module.h>
34#include <linux/pm.h>
35#include <linux/sched.h>
36#include <linux/gpio.h>
37#include <linux/jiffies.h>
38#include <linux/i2c-gpio.h>
39#include <linux/i2c/pxa-i2c.h>
40#include <linux/serial_8250.h>
41#include <linux/smc91x.h>
42#include <linux/pwm_backlight.h>
43#include <linux/usb/isp116x.h>
44#include <linux/mtd/mtd.h>
45#include <linux/mtd/partitions.h>
46#include <linux/mtd/physmap.h>
47#include <linux/syscore_ops.h>
48
49#include <mach/pxa25x.h>
50#include <mach/audio.h>
51#include <linux/platform_data/video-pxafb.h>
52#include <mach/regs-uart.h>
53#include <linux/platform_data/pcmcia-pxa2xx_viper.h>
54#include <mach/viper.h>
55
56#include <asm/setup.h>
57#include <asm/mach-types.h>
58#include <asm/irq.h>
59#include <asm/sizes.h>
60#include <asm/system_info.h>
61
62#include <asm/mach/arch.h>
63#include <asm/mach/map.h>
64#include <asm/mach/irq.h>
65
66#include "generic.h"
67#include "devices.h"
68
69static unsigned int icr;
70
71static void viper_icr_set_bit(unsigned int bit)
72{
73 icr |= bit;
74 VIPER_ICR = icr;
75}
76
77static void viper_icr_clear_bit(unsigned int bit)
78{
79 icr &= ~bit;
80 VIPER_ICR = icr;
81}
82
83
84static void viper_cf_reset(int state)
85{
86 if (state)
87 viper_icr_set_bit(VIPER_ICR_CF_RST);
88 else
89 viper_icr_clear_bit(VIPER_ICR_CF_RST);
90}
91
92static struct arcom_pcmcia_pdata viper_pcmcia_info = {
93 .cd_gpio = VIPER_CF_CD_GPIO,
94 .rdy_gpio = VIPER_CF_RDY_GPIO,
95 .pwr_gpio = VIPER_CF_POWER_GPIO,
96 .reset = viper_cf_reset,
97};
98
99static struct platform_device viper_pcmcia_device = {
100 .name = "viper-pcmcia",
101 .id = -1,
102 .dev = {
103 .platform_data = &viper_pcmcia_info,
104 },
105};
106
107
108
109
110
111
112
113
114
115
116
117static u8 viper_hw_version(void)
118{
119 u8 v1, v2;
120 unsigned long flags;
121
122 local_irq_save(flags);
123
124 VIPER_VERSION = 0;
125 v1 = VIPER_VERSION;
126 VIPER_VERSION = 0xff;
127 v2 = VIPER_VERSION;
128
129 v1 = (v1 != v2 || v1 == 0xff) ? 0 : v1;
130
131 local_irq_restore(flags);
132 return v1;
133}
134
135
136static int viper_cpu_suspend(void)
137{
138 viper_icr_set_bit(VIPER_ICR_R_DIS);
139 return 0;
140}
141
142static void viper_cpu_resume(void)
143{
144 viper_icr_clear_bit(VIPER_ICR_R_DIS);
145}
146
147static struct syscore_ops viper_cpu_syscore_ops = {
148 .suspend = viper_cpu_suspend,
149 .resume = viper_cpu_resume,
150};
151
152static unsigned int current_voltage_divisor;
153
154
155
156
157
158
159
160
161
162
163
164
165static void viper_set_core_cpu_voltage(unsigned long khz, int force)
166{
167 int i = 0;
168 unsigned int divisor = 0;
169 const char *v;
170
171 if (khz < 200000) {
172 v = "1.0"; divisor = 0xfff;
173 } else if (khz < 300000) {
174 v = "1.1"; divisor = 0xde5;
175 } else {
176 v = "1.3"; divisor = 0x325;
177 }
178
179 pr_debug("viper: setting CPU core voltage to %sV at %d.%03dMHz\n",
180 v, (int)khz / 1000, (int)khz % 1000);
181
182#define STEP 0x100
183 do {
184 int step;
185
186 if (force)
187 step = divisor;
188 else if (current_voltage_divisor < divisor - STEP)
189 step = current_voltage_divisor + STEP;
190 else if (current_voltage_divisor > divisor + STEP)
191 step = current_voltage_divisor - STEP;
192 else
193 step = divisor;
194 force = 0;
195
196 gpio_set_value(VIPER_PSU_CLK_GPIO, 0);
197 gpio_set_value(VIPER_PSU_nCS_LD_GPIO, 0);
198
199 for (i = 1 << 11 ; i > 0 ; i >>= 1) {
200 udelay(1);
201
202 gpio_set_value(VIPER_PSU_DATA_GPIO, step & i);
203 udelay(1);
204
205 gpio_set_value(VIPER_PSU_CLK_GPIO, 1);
206 udelay(1);
207
208 gpio_set_value(VIPER_PSU_CLK_GPIO, 0);
209 }
210 udelay(1);
211
212 gpio_set_value(VIPER_PSU_nCS_LD_GPIO, 1);
213 udelay(1);
214
215 gpio_set_value(VIPER_PSU_nCS_LD_GPIO, 0);
216
217 current_voltage_divisor = step;
218 } while (current_voltage_divisor != divisor);
219}
220
221
222static unsigned long viper_irq_enabled_mask;
223static const int viper_isa_irqs[] = { 3, 4, 5, 6, 7, 10, 11, 12, 9, 14, 15 };
224static const int viper_isa_irq_map[] = {
225 0,
226 0,
227 0,
228 1 << 0,
229 1 << 1,
230 1 << 2,
231 1 << 3,
232 1 << 4,
233 0,
234 1 << 8,
235 1 << 5,
236 1 << 6,
237 1 << 7,
238 0,
239 1 << 9,
240 1 << 10,
241};
242
243static inline int viper_irq_to_bitmask(unsigned int irq)
244{
245 return viper_isa_irq_map[irq - PXA_ISA_IRQ(0)];
246}
247
248static inline int viper_bit_to_irq(int bit)
249{
250 return viper_isa_irqs[bit] + PXA_ISA_IRQ(0);
251}
252
253static void viper_ack_irq(struct irq_data *d)
254{
255 int viper_irq = viper_irq_to_bitmask(d->irq);
256
257 if (viper_irq & 0xff)
258 VIPER_LO_IRQ_STATUS = viper_irq;
259 else
260 VIPER_HI_IRQ_STATUS = (viper_irq >> 8);
261}
262
263static void viper_mask_irq(struct irq_data *d)
264{
265 viper_irq_enabled_mask &= ~(viper_irq_to_bitmask(d->irq));
266}
267
268static void viper_unmask_irq(struct irq_data *d)
269{
270 viper_irq_enabled_mask |= viper_irq_to_bitmask(d->irq);
271}
272
273static inline unsigned long viper_irq_pending(void)
274{
275 return (VIPER_HI_IRQ_STATUS << 8 | VIPER_LO_IRQ_STATUS) &
276 viper_irq_enabled_mask;
277}
278
279static void viper_irq_handler(unsigned int irq, struct irq_desc *desc)
280{
281 unsigned long pending;
282
283 pending = viper_irq_pending();
284 do {
285
286
287 desc->irq_data.chip->irq_ack(&desc->irq_data);
288
289 if (likely(pending)) {
290 irq = viper_bit_to_irq(__ffs(pending));
291 generic_handle_irq(irq);
292 }
293 pending = viper_irq_pending();
294 } while (pending);
295}
296
297static struct irq_chip viper_irq_chip = {
298 .name = "ISA",
299 .irq_ack = viper_ack_irq,
300 .irq_mask = viper_mask_irq,
301 .irq_unmask = viper_unmask_irq
302};
303
304static void __init viper_init_irq(void)
305{
306 int level;
307 int isa_irq;
308
309 pxa25x_init_irq();
310
311
312 for (level = 0; level < ARRAY_SIZE(viper_isa_irqs); level++) {
313 isa_irq = viper_bit_to_irq(level);
314 irq_set_chip_and_handler(isa_irq, &viper_irq_chip,
315 handle_edge_irq);
316 set_irq_flags(isa_irq, IRQF_VALID | IRQF_PROBE);
317 }
318
319 irq_set_chained_handler(gpio_to_irq(VIPER_CPLD_GPIO),
320 viper_irq_handler);
321 irq_set_irq_type(gpio_to_irq(VIPER_CPLD_GPIO), IRQ_TYPE_EDGE_BOTH);
322}
323
324
325static struct pxafb_mode_info fb_mode_info[] = {
326 {
327 .pixclock = 157500,
328
329 .xres = 320,
330 .yres = 240,
331
332 .bpp = 16,
333
334 .hsync_len = 63,
335 .left_margin = 7,
336 .right_margin = 13,
337
338 .vsync_len = 20,
339 .upper_margin = 0,
340 .lower_margin = 0,
341
342 .sync = 0,
343 },
344};
345
346static struct pxafb_mach_info fb_info = {
347 .modes = fb_mode_info,
348 .num_modes = 1,
349 .lcd_conn = LCD_COLOR_TFT_16BPP | LCD_PCLK_EDGE_FALL,
350};
351
352static int viper_backlight_init(struct device *dev)
353{
354 int ret;
355
356
357 ret = gpio_request(VIPER_BCKLIGHT_EN_GPIO, "Backlight");
358 if (ret)
359 goto err_request_bckl;
360
361 ret = gpio_request(VIPER_LCD_EN_GPIO, "LCD");
362 if (ret)
363 goto err_request_lcd;
364
365 ret = gpio_direction_output(VIPER_BCKLIGHT_EN_GPIO, 0);
366 if (ret)
367 goto err_dir;
368
369 ret = gpio_direction_output(VIPER_LCD_EN_GPIO, 0);
370 if (ret)
371 goto err_dir;
372
373 return 0;
374
375err_dir:
376 gpio_free(VIPER_LCD_EN_GPIO);
377err_request_lcd:
378 gpio_free(VIPER_BCKLIGHT_EN_GPIO);
379err_request_bckl:
380 dev_err(dev, "Failed to setup LCD GPIOs\n");
381
382 return ret;
383}
384
385static int viper_backlight_notify(struct device *dev, int brightness)
386{
387 gpio_set_value(VIPER_LCD_EN_GPIO, !!brightness);
388 gpio_set_value(VIPER_BCKLIGHT_EN_GPIO, !!brightness);
389
390 return brightness;
391}
392
393static void viper_backlight_exit(struct device *dev)
394{
395 gpio_free(VIPER_LCD_EN_GPIO);
396 gpio_free(VIPER_BCKLIGHT_EN_GPIO);
397}
398
399static struct platform_pwm_backlight_data viper_backlight_data = {
400 .pwm_id = 0,
401 .max_brightness = 100,
402 .dft_brightness = 100,
403 .pwm_period_ns = 1000000,
404 .init = viper_backlight_init,
405 .notify = viper_backlight_notify,
406 .exit = viper_backlight_exit,
407};
408
409static struct platform_device viper_backlight_device = {
410 .name = "pwm-backlight",
411 .dev = {
412 .parent = &pxa25x_device_pwm0.dev,
413 .platform_data = &viper_backlight_data,
414 },
415};
416
417
418static struct resource smc91x_resources[] = {
419 [0] = {
420 .name = "smc91x-regs",
421 .start = VIPER_ETH_PHYS + 0x300,
422 .end = VIPER_ETH_PHYS + 0x30f,
423 .flags = IORESOURCE_MEM,
424 },
425 [1] = {
426 .start = PXA_GPIO_TO_IRQ(VIPER_ETH_GPIO),
427 .end = PXA_GPIO_TO_IRQ(VIPER_ETH_GPIO),
428 .flags = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE,
429 },
430 [2] = {
431 .name = "smc91x-data32",
432 .start = VIPER_ETH_DATA_PHYS,
433 .end = VIPER_ETH_DATA_PHYS + 3,
434 .flags = IORESOURCE_MEM,
435 },
436};
437
438static struct smc91x_platdata viper_smc91x_info = {
439 .flags = SMC91X_USE_16BIT | SMC91X_NOWAIT,
440 .leda = RPC_LED_100_10,
441 .ledb = RPC_LED_TX_RX,
442};
443
444static struct platform_device smc91x_device = {
445 .name = "smc91x",
446 .id = -1,
447 .num_resources = ARRAY_SIZE(smc91x_resources),
448 .resource = smc91x_resources,
449 .dev = {
450 .platform_data = &viper_smc91x_info,
451 },
452};
453
454
455static struct i2c_gpio_platform_data i2c_bus_data = {
456 .sda_pin = VIPER_RTC_I2C_SDA_GPIO,
457 .scl_pin = VIPER_RTC_I2C_SCL_GPIO,
458 .udelay = 10,
459 .timeout = HZ,
460};
461
462static struct platform_device i2c_bus_device = {
463 .name = "i2c-gpio",
464 .id = 1,
465 .dev = {
466 .platform_data = &i2c_bus_data,
467 }
468};
469
470static struct i2c_board_info __initdata viper_i2c_devices[] = {
471 {
472 I2C_BOARD_INFO("ds1338", 0x68),
473 },
474};
475
476
477
478
479
480
481
482
483static struct resource viper_serial_resources[] = {
484#ifndef CONFIG_SERIAL_PXA
485 {
486 .start = 0x40100000,
487 .end = 0x4010001f,
488 .flags = IORESOURCE_MEM,
489 },
490 {
491 .start = 0x40200000,
492 .end = 0x4020001f,
493 .flags = IORESOURCE_MEM,
494 },
495 {
496 .start = 0x40700000,
497 .end = 0x4070001f,
498 .flags = IORESOURCE_MEM,
499 },
500 {
501 .start = VIPER_UARTA_PHYS,
502 .end = VIPER_UARTA_PHYS + 0xf,
503 .flags = IORESOURCE_MEM,
504 },
505 {
506 .start = VIPER_UARTB_PHYS,
507 .end = VIPER_UARTB_PHYS + 0xf,
508 .flags = IORESOURCE_MEM,
509 },
510#else
511 {
512 0,
513 },
514#endif
515};
516
517static struct plat_serial8250_port serial_platform_data[] = {
518#ifndef CONFIG_SERIAL_PXA
519
520 {
521 .membase = (void *)&FFUART,
522 .mapbase = __PREG(FFUART),
523 .irq = IRQ_FFUART,
524 .uartclk = 921600 * 16,
525 .regshift = 2,
526 .flags = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST,
527 .iotype = UPIO_MEM,
528 },
529 {
530 .membase = (void *)&BTUART,
531 .mapbase = __PREG(BTUART),
532 .irq = IRQ_BTUART,
533 .uartclk = 921600 * 16,
534 .regshift = 2,
535 .flags = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST,
536 .iotype = UPIO_MEM,
537 },
538 {
539 .membase = (void *)&STUART,
540 .mapbase = __PREG(STUART),
541 .irq = IRQ_STUART,
542 .uartclk = 921600 * 16,
543 .regshift = 2,
544 .flags = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST,
545 .iotype = UPIO_MEM,
546 },
547
548 {
549 .mapbase = VIPER_UARTA_PHYS,
550 .irq = PXA_GPIO_TO_IRQ(VIPER_UARTA_GPIO),
551 .irqflags = IRQF_TRIGGER_RISING,
552 .uartclk = 1843200,
553 .regshift = 1,
554 .iotype = UPIO_MEM,
555 .flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP |
556 UPF_SKIP_TEST,
557 },
558 {
559 .mapbase = VIPER_UARTB_PHYS,
560 .irq = PXA_GPIO_TO_IRQ(VIPER_UARTB_GPIO),
561 .irqflags = IRQF_TRIGGER_RISING,
562 .uartclk = 1843200,
563 .regshift = 1,
564 .iotype = UPIO_MEM,
565 .flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP |
566 UPF_SKIP_TEST,
567 },
568#endif
569 { },
570};
571
572static struct platform_device serial_device = {
573 .name = "serial8250",
574 .id = 0,
575 .dev = {
576 .platform_data = serial_platform_data,
577 },
578 .num_resources = ARRAY_SIZE(viper_serial_resources),
579 .resource = viper_serial_resources,
580};
581
582
583static void isp116x_delay(struct device *dev, int delay)
584{
585 ndelay(delay);
586}
587
588static struct resource isp116x_resources[] = {
589 [0] = {
590 .start = VIPER_USB_PHYS + 0,
591 .end = VIPER_USB_PHYS + 1,
592 .flags = IORESOURCE_MEM,
593 },
594 [1] = {
595 .start = VIPER_USB_PHYS + 2,
596 .end = VIPER_USB_PHYS + 3,
597 .flags = IORESOURCE_MEM,
598 },
599 [2] = {
600 .start = PXA_GPIO_TO_IRQ(VIPER_USB_GPIO),
601 .end = PXA_GPIO_TO_IRQ(VIPER_USB_GPIO),
602 .flags = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE,
603 },
604};
605
606
607static struct isp116x_platform_data isp116x_platform_data = {
608
609 .sel15Kres = 1,
610
611 .oc_enable = 1,
612
613 .int_act_high = 1,
614
615 .int_edge_triggered = 0,
616
617
618
619
620 .remote_wakeup_enable = 0,
621 .delay = isp116x_delay,
622};
623
624static struct platform_device isp116x_device = {
625 .name = "isp116x-hcd",
626 .id = -1,
627 .num_resources = ARRAY_SIZE(isp116x_resources),
628 .resource = isp116x_resources,
629 .dev = {
630 .platform_data = &isp116x_platform_data,
631 },
632
633};
634
635
636static struct resource mtd_resources[] = {
637 [0] = {
638 .start = VIPER_FLASH_PHYS,
639 .end = VIPER_FLASH_PHYS + SZ_32M - 1,
640 .flags = IORESOURCE_MEM,
641 },
642 [1] = {
643 .start = VIPER_BOOT_PHYS,
644 .end = VIPER_BOOT_PHYS + SZ_1M - 1,
645 .flags = IORESOURCE_MEM,
646 },
647 [2] = {
648
649
650
651 .start = _VIPER_SRAM_BASE,
652 .end = _VIPER_SRAM_BASE + SZ_512K - 1,
653 .flags = IORESOURCE_MEM,
654 },
655};
656
657static struct mtd_partition viper_boot_flash_partition = {
658 .name = "RedBoot",
659 .size = SZ_1M,
660 .offset = 0,
661 .mask_flags = MTD_WRITEABLE,
662};
663
664static struct physmap_flash_data viper_flash_data[] = {
665 [0] = {
666 .width = 2,
667 .parts = NULL,
668 .nr_parts = 0,
669 },
670 [1] = {
671 .width = 2,
672 .parts = &viper_boot_flash_partition,
673 .nr_parts = 1,
674 },
675};
676
677static struct platform_device viper_mtd_devices[] = {
678 [0] = {
679 .name = "physmap-flash",
680 .id = 0,
681 .dev = {
682 .platform_data = &viper_flash_data[0],
683 },
684 .resource = &mtd_resources[0],
685 .num_resources = 1,
686 },
687 [1] = {
688 .name = "physmap-flash",
689 .id = 1,
690 .dev = {
691 .platform_data = &viper_flash_data[1],
692 },
693 .resource = &mtd_resources[1],
694 .num_resources = 1,
695 },
696};
697
698static struct platform_device *viper_devs[] __initdata = {
699 &smc91x_device,
700 &i2c_bus_device,
701 &serial_device,
702 &isp116x_device,
703 &viper_mtd_devices[0],
704 &viper_mtd_devices[1],
705 &viper_backlight_device,
706 &viper_pcmcia_device,
707};
708
709static mfp_cfg_t viper_pin_config[] __initdata = {
710
711 GPIO15_nCS_1,
712 GPIO78_nCS_2,
713 GPIO79_nCS_3,
714 GPIO80_nCS_4,
715 GPIO33_nCS_5,
716
717
718 GPIO28_AC97_BITCLK,
719 GPIO29_AC97_SDATA_IN_0,
720 GPIO30_AC97_SDATA_OUT,
721 GPIO31_AC97_SYNC,
722
723
724 GPIO9_GPIO,
725 GPIO10_GPIO,
726 GPIO16_PWM0_OUT,
727
728
729 GPIO18_RDY,
730
731
732 GPIO12_GPIO | MFP_LPM_DRIVE_HIGH,
733
734
735 GPIO48_nPOE,
736 GPIO49_nPWE,
737 GPIO50_nPIOR,
738 GPIO51_nPIOW,
739 GPIO52_nPCE_1,
740 GPIO53_nPCE_2,
741 GPIO54_nPSKTSEL,
742 GPIO55_nPREG,
743 GPIO56_nPWAIT,
744 GPIO57_nIOIS16,
745 GPIO8_GPIO,
746 GPIO32_GPIO,
747 GPIO82_GPIO,
748
749
750 GPIO20_GPIO,
751
752
753 GPIO6_GPIO,
754 GPIO11_GPIO,
755 GPIO19_GPIO,
756
757
758 GPIO26_GPIO,
759 GPIO27_GPIO,
760 GPIO83_GPIO,
761 GPIO84_GPIO,
762
763
764 GPIO1_GPIO | WAKEUP_ON_EDGE_RISE,
765};
766
767static unsigned long viper_tpm;
768
769static int __init viper_tpm_setup(char *str)
770{
771 return strict_strtoul(str, 10, &viper_tpm) >= 0;
772}
773
774__setup("tpm=", viper_tpm_setup);
775
776static void __init viper_tpm_init(void)
777{
778 struct platform_device *tpm_device;
779 struct i2c_gpio_platform_data i2c_tpm_data = {
780 .sda_pin = VIPER_TPM_I2C_SDA_GPIO,
781 .scl_pin = VIPER_TPM_I2C_SCL_GPIO,
782 .udelay = 10,
783 .timeout = HZ,
784 };
785 char *errstr;
786
787
788 if (!viper_tpm)
789 return;
790
791 tpm_device = platform_device_alloc("i2c-gpio", 2);
792 if (tpm_device) {
793 if (!platform_device_add_data(tpm_device,
794 &i2c_tpm_data,
795 sizeof(i2c_tpm_data))) {
796 if (platform_device_add(tpm_device)) {
797 errstr = "register TPM i2c bus";
798 goto error_free_tpm;
799 }
800 } else {
801 errstr = "allocate TPM i2c bus data";
802 goto error_free_tpm;
803 }
804 } else {
805 errstr = "allocate TPM i2c device";
806 goto error_tpm;
807 }
808
809 return;
810
811error_free_tpm:
812 kfree(tpm_device);
813error_tpm:
814 pr_err("viper: Couldn't %s, giving up\n", errstr);
815}
816
817static void __init viper_init_vcore_gpios(void)
818{
819 if (gpio_request(VIPER_PSU_DATA_GPIO, "PSU data"))
820 goto err_request_data;
821
822 if (gpio_request(VIPER_PSU_CLK_GPIO, "PSU clock"))
823 goto err_request_clk;
824
825 if (gpio_request(VIPER_PSU_nCS_LD_GPIO, "PSU cs"))
826 goto err_request_cs;
827
828 if (gpio_direction_output(VIPER_PSU_DATA_GPIO, 0) ||
829 gpio_direction_output(VIPER_PSU_CLK_GPIO, 0) ||
830 gpio_direction_output(VIPER_PSU_nCS_LD_GPIO, 0))
831 goto err_dir;
832
833
834 viper_set_core_cpu_voltage(get_clk_frequency_khz(0), 1);
835
836 return;
837
838err_dir:
839 gpio_free(VIPER_PSU_nCS_LD_GPIO);
840err_request_cs:
841 gpio_free(VIPER_PSU_CLK_GPIO);
842err_request_clk:
843 gpio_free(VIPER_PSU_DATA_GPIO);
844err_request_data:
845 pr_err("viper: Failed to setup vcore control GPIOs\n");
846}
847
848static void __init viper_init_serial_gpio(void)
849{
850 if (gpio_request(VIPER_UART_SHDN_GPIO, "UARTs shutdown"))
851 goto err_request;
852
853 if (gpio_direction_output(VIPER_UART_SHDN_GPIO, 0))
854 goto err_dir;
855
856 return;
857
858err_dir:
859 gpio_free(VIPER_UART_SHDN_GPIO);
860err_request:
861 pr_err("viper: Failed to setup UART shutdown GPIO\n");
862}
863
864#ifdef CONFIG_CPU_FREQ
865static int viper_cpufreq_notifier(struct notifier_block *nb,
866 unsigned long val, void *data)
867{
868 struct cpufreq_freqs *freq = data;
869
870
871
872 switch (val) {
873 case CPUFREQ_PRECHANGE:
874 if (freq->old < freq->new) {
875
876
877 viper_set_core_cpu_voltage(freq->new, 0);
878 }
879 break;
880 case CPUFREQ_POSTCHANGE:
881 if (freq->old > freq->new) {
882
883
884 viper_set_core_cpu_voltage(freq->new, 0);
885 }
886 break;
887 case CPUFREQ_RESUMECHANGE:
888 viper_set_core_cpu_voltage(freq->new, 0);
889 break;
890 default:
891
892 break;
893 }
894
895 return 0;
896}
897
898static struct notifier_block viper_cpufreq_notifier_block = {
899 .notifier_call = viper_cpufreq_notifier
900};
901
902static void __init viper_init_cpufreq(void)
903{
904 if (cpufreq_register_notifier(&viper_cpufreq_notifier_block,
905 CPUFREQ_TRANSITION_NOTIFIER))
906 pr_err("viper: Failed to setup cpufreq notifier\n");
907}
908#else
909static inline void viper_init_cpufreq(void) {}
910#endif
911
912static void viper_power_off(void)
913{
914 pr_notice("Shutting off UPS\n");
915 gpio_set_value(VIPER_UPS_GPIO, 1);
916
917 while (1);
918}
919
920static void __init viper_init(void)
921{
922 u8 version;
923
924 pm_power_off = viper_power_off;
925
926 pxa2xx_mfp_config(ARRAY_AND_SIZE(viper_pin_config));
927
928 pxa_set_ffuart_info(NULL);
929 pxa_set_btuart_info(NULL);
930 pxa_set_stuart_info(NULL);
931
932
933 viper_init_serial_gpio();
934
935 pxa_set_fb_info(NULL, &fb_info);
936
937
938 version = viper_hw_version();
939 if (version == 0)
940 smc91x_device.num_resources--;
941
942 pxa_set_i2c_info(NULL);
943 platform_add_devices(viper_devs, ARRAY_SIZE(viper_devs));
944
945 viper_init_vcore_gpios();
946 viper_init_cpufreq();
947
948 register_syscore_ops(&viper_cpu_syscore_ops);
949
950 if (version) {
951 pr_info("viper: hardware v%di%d detected. "
952 "CPLD revision %d.\n",
953 VIPER_BOARD_VERSION(version),
954 VIPER_BOARD_ISSUE(version),
955 VIPER_CPLD_REVISION(version));
956 system_rev = (VIPER_BOARD_VERSION(version) << 8) |
957 (VIPER_BOARD_ISSUE(version) << 4) |
958 VIPER_CPLD_REVISION(version);
959 } else {
960 pr_info("viper: No version register.\n");
961 }
962
963 i2c_register_board_info(1, ARRAY_AND_SIZE(viper_i2c_devices));
964
965 viper_tpm_init();
966 pxa_set_ac97_info(NULL);
967}
968
969static struct map_desc viper_io_desc[] __initdata = {
970 {
971 .virtual = VIPER_CPLD_BASE,
972 .pfn = __phys_to_pfn(VIPER_CPLD_PHYS),
973 .length = 0x00300000,
974 .type = MT_DEVICE,
975 },
976 {
977 .virtual = VIPER_PC104IO_BASE,
978 .pfn = __phys_to_pfn(0x30000000),
979 .length = 0x00800000,
980 .type = MT_DEVICE,
981 },
982};
983
984static void __init viper_map_io(void)
985{
986 pxa25x_map_io();
987
988 iotable_init(viper_io_desc, ARRAY_SIZE(viper_io_desc));
989
990 PCFR |= PCFR_OPDE;
991}
992
993MACHINE_START(VIPER, "Arcom/Eurotech VIPER SBC")
994
995 .atag_offset = 0x100,
996 .map_io = viper_map_io,
997 .nr_irqs = PXA_NR_IRQS,
998 .init_irq = viper_init_irq,
999 .handle_irq = pxa25x_handle_irq,
1000 .init_time = pxa_timer_init,
1001 .init_machine = viper_init,
1002 .restart = pxa_restart,
1003MACHINE_END
1004
