1
2
3
4
5
6
7
8
9
10
11
12#include <linux/init.h>
13#include <linux/platform_device.h>
14#include <linux/ata_platform.h>
15#include <linux/pm.h>
16#include <linux/mm.h>
17#include <asm/machvec.h>
18#include <mach-landisk/mach/iodata_landisk.h>
19#include <asm/io.h>
20
21static void landisk_power_off(void)
22{
23 __raw_writeb(0x01, PA_SHUTDOWN);
24}
25
26static struct resource cf_ide_resources[3];
27
28static struct pata_platform_info pata_info = {
29 .ioport_shift = 1,
30};
31
32static struct platform_device cf_ide_device = {
33 .name = "pata_platform",
34 .id = -1,
35 .num_resources = ARRAY_SIZE(cf_ide_resources),
36 .resource = cf_ide_resources,
37 .dev = {
38 .platform_data = &pata_info,
39 },
40};
41
42static struct platform_device rtc_device = {
43 .name = "rs5c313",
44 .id = -1,
45};
46
47static struct platform_device *landisk_devices[] __initdata = {
48 &cf_ide_device,
49 &rtc_device,
50};
51
52static int __init landisk_devices_setup(void)
53{
54 pgprot_t prot;
55 unsigned long paddrbase;
56 void *cf_ide_base;
57
58
59 paddrbase = virt_to_phys((void *)PA_AREA5_IO);
60 prot = PAGE_KERNEL_PCC(1, _PAGE_PCC_IO16);
61 cf_ide_base = ioremap_prot(paddrbase, PAGE_SIZE, pgprot_val(prot));
62 if (!cf_ide_base) {
63 printk("allocate_cf_area : can't open CF I/O window!\n");
64 return -ENOMEM;
65 }
66
67
68 cf_ide_resources[0].start = (unsigned long)cf_ide_base + 0x40;
69 cf_ide_resources[0].end = (unsigned long)cf_ide_base + 0x40 + 0x0f;
70 cf_ide_resources[0].flags = IORESOURCE_IO;
71 cf_ide_resources[1].start = (unsigned long)cf_ide_base + 0x2c;
72 cf_ide_resources[1].end = (unsigned long)cf_ide_base + 0x2c + 0x03;
73 cf_ide_resources[1].flags = IORESOURCE_IO;
74 cf_ide_resources[2].start = IRQ_FATA;
75 cf_ide_resources[2].flags = IORESOURCE_IRQ;
76
77 return platform_add_devices(landisk_devices,
78 ARRAY_SIZE(landisk_devices));
79}
80
81device_initcall(landisk_devices_setup);
82
83static void __init landisk_setup(char **cmdline_p)
84{
85
86 __set_io_port_base(0);
87
88
89 __raw_writeb(__raw_readb(PA_LED) | 0x03, PA_LED);
90
91 printk(KERN_INFO "I-O DATA DEVICE, INC. \"LANDISK Series\" support.\n");
92 pm_power_off = landisk_power_off;
93}
94
95
96
97
98static struct sh_machine_vector mv_landisk __initmv = {
99 .mv_name = "LANDISK",
100 .mv_setup = landisk_setup,
101 .mv_init_irq = init_landisk_IRQ,
102};
103