Blame view

kernel/linux-rt-4.4.41/arch/sh/boards/mach-landisk/setup.c 2.61 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
  /*
   * arch/sh/boards/landisk/setup.c
   *
   * I-O DATA Device, Inc. LANDISK Support.
   *
   * Copyright (C) 2000 Kazumoto Kojima
   * Copyright (C) 2002 Paul Mundt
   * Copylight (C) 2002 Atom Create Engineering Co., Ltd.
   * Copyright (C) 2005-2007 kogiidena
   *
   * This file is subject to the terms and conditions of the GNU General Public
   * License.  See the file "COPYING" in the main directory of this archive
   * for more details.
   */
  #include <linux/init.h>
  #include <linux/platform_device.h>
  #include <linux/ata_platform.h>
  #include <linux/pm.h>
  #include <linux/mm.h>
  #include <asm/machvec.h>
  #include <mach-landisk/mach/iodata_landisk.h>
  #include <asm/io.h>
  
  static void landisk_power_off(void)
  {
  	__raw_writeb(0x01, PA_SHUTDOWN);
  }
  
  static struct resource cf_ide_resources[3];
  
  static struct pata_platform_info pata_info = {
  	.ioport_shift	= 1,
  };
  
  static struct platform_device cf_ide_device = {
  	.name		= "pata_platform",
  	.id		= -1,
  	.num_resources	= ARRAY_SIZE(cf_ide_resources),
  	.resource	= cf_ide_resources,
  	.dev		= {
  		.platform_data = &pata_info,
  	},
  };
  
  static struct platform_device rtc_device = {
  	.name		= "rs5c313",
  	.id		= -1,
  };
  
  static struct platform_device *landisk_devices[] __initdata = {
  	&cf_ide_device,
  	&rtc_device,
  };
  
  static int __init landisk_devices_setup(void)
  {
  	pgprot_t prot;
  	unsigned long paddrbase;
  	void *cf_ide_base;
  
  	/* open I/O area window */
  	paddrbase = virt_to_phys((void *)PA_AREA5_IO);
  	prot = PAGE_KERNEL_PCC(1, _PAGE_PCC_IO16);
  	cf_ide_base = ioremap_prot(paddrbase, PAGE_SIZE, pgprot_val(prot));
  	if (!cf_ide_base) {
  		printk("allocate_cf_area : can't open CF I/O window!
  ");
  		return -ENOMEM;
  	}
  
  	/* IDE cmd address : 0x1f0-0x1f7 and 0x3f6 */
  	cf_ide_resources[0].start = (unsigned long)cf_ide_base + 0x40;
  	cf_ide_resources[0].end   = (unsigned long)cf_ide_base + 0x40 + 0x0f;
  	cf_ide_resources[0].flags = IORESOURCE_IO;
  	cf_ide_resources[1].start = (unsigned long)cf_ide_base + 0x2c;
  	cf_ide_resources[1].end   = (unsigned long)cf_ide_base + 0x2c + 0x03;
  	cf_ide_resources[1].flags = IORESOURCE_IO;
  	cf_ide_resources[2].start = IRQ_FATA;
  	cf_ide_resources[2].flags = IORESOURCE_IRQ;
  
  	return platform_add_devices(landisk_devices,
  				    ARRAY_SIZE(landisk_devices));
  }
  
  device_initcall(landisk_devices_setup);
  
  static void __init landisk_setup(char **cmdline_p)
  {
  	/* LED ON */
  	__raw_writeb(__raw_readb(PA_LED) | 0x03, PA_LED);
  
  	printk(KERN_INFO "I-O DATA DEVICE, INC. \"LANDISK Series\" support.
  ");
  	pm_power_off = landisk_power_off;
  }
  
  /*
   * The Machine Vector
   */
  static struct sh_machine_vector mv_landisk __initmv = {
  	.mv_name = "LANDISK",
  	.mv_setup = landisk_setup,
  	.mv_init_irq = init_landisk_IRQ,
  };