[IA64] replace kmalloc+memset with kzalloc
[linux-2.6.git] / arch / sh / boards / landisk / setup.c
1 /*
2  * arch/sh/boards/landisk/setup.c
3  *
4  * Copyright (C) 2000 Kazumoto Kojima
5  * Copyright (C) 2002 Paul Mundt
6  *
7  * I-O DATA Device, Inc. LANDISK Support.
8  *
9  * Modified for LANDISK by
10  * Atom Create Engineering Co., Ltd. 2002.
11  *
12  * modifed by kogiidena
13  * 2005.09.16
14  *
15  * This file is subject to the terms and conditions of the GNU General Public
16  * License.  See the file "COPYING" in the main directory of this archive
17  * for more details.
18  */
19 #include <linux/init.h>
20 #include <linux/pm.h>
21 #include <linux/mm.h>
22 #include <asm/machvec.h>
23 #include <asm/rtc.h>
24 #include <asm/landisk/iodata_landisk.h>
25 #include <asm/io.h>
26
27 void landisk_time_init(void);
28 void init_landisk_IRQ(void);
29
30 int landisk_ledparam;
31 int landisk_buzzerparam;
32 int landisk_arch;
33
34 /* cycle the led's in the clasic knightrider/sun pattern */
35 static void heartbeat_landisk(void)
36 {
37         static unsigned int cnt = 0, blink = 0x00, period = 25;
38         volatile u8 *p = (volatile u8 *)PA_LED;
39         char data;
40
41         if ((landisk_ledparam & 0x080) == 0)
42                 return;
43
44         cnt += 1;
45
46         if (cnt < period)
47                 return;
48
49         cnt = 0;
50         blink++;
51
52         data = (blink & 0x01) ? (landisk_ledparam >> 16) : 0;
53         data |= (blink & 0x02) ? (landisk_ledparam >> 8) : 0;
54         data |= landisk_ledparam;
55
56         /* buzzer */
57         if (landisk_buzzerparam & 0x1) {
58                 data |= 0x80;
59         } else {
60                 data &= 0x7f;
61         }
62         *p = data;
63
64         if (((landisk_ledparam & 0x007f7f00) == 0) &&
65              (landisk_buzzerparam == 0))
66                 landisk_ledparam &= (~0x0080);
67
68         landisk_buzzerparam >>= 1;
69 }
70
71 static void landisk_power_off(void)
72 {
73         ctrl_outb(0x01, PA_SHUTDOWN);
74 }
75
76 static void check_usl5p(void)
77 {
78         volatile u8 *p = (volatile u8 *)PA_LED;
79         u8 tmp1, tmp2;
80
81         tmp1 = *p;
82         *p = 0x40;
83         tmp2 = *p;
84         *p = tmp1;
85
86         landisk_arch = (tmp2 == 0x40);
87         if (landisk_arch == 1) {
88                 /* arch == usl-5p */
89                 landisk_ledparam = 0x00000380;
90                 landisk_ledparam |= (tmp1 & 0x07c);
91         } else {
92                 /* arch == landisk */
93                 landisk_ledparam = 0x02000180;
94                 landisk_ledparam |= 0x04;
95         }
96 }
97
98 void *area5_io_base;
99 void *area6_io_base;
100
101 static int __init landisk_cf_init(void)
102 {
103         pgprot_t prot;
104         unsigned long paddrbase, psize;
105
106         /* open I/O area window */
107         paddrbase = virt_to_phys((void *)PA_AREA5_IO);
108         psize = PAGE_SIZE;
109         prot = PAGE_KERNEL_PCC(1, _PAGE_PCC_IO16);
110         area5_io_base = p3_ioremap(paddrbase, psize, prot.pgprot);
111         if (!area5_io_base) {
112                 printk("allocate_cf_area : can't open CF I/O window!\n");
113                 return -ENOMEM;
114         }
115
116         paddrbase = virt_to_phys((void *)PA_AREA6_IO);
117         psize = PAGE_SIZE;
118         prot = PAGE_KERNEL_PCC(0, _PAGE_PCC_IO16);
119         area6_io_base = p3_ioremap(paddrbase, psize, prot.pgprot);
120         if (!area6_io_base) {
121                 printk("allocate_cf_area : can't open HDD I/O window!\n");
122                 return -ENOMEM;
123         }
124
125         printk(KERN_INFO "Allocate Area5/6 success.\n");
126
127         /* XXX : do we need attribute and common-memory area also? */
128
129         return 0;
130 }
131
132 static void __init landisk_setup(char **cmdline_p)
133 {
134         device_initcall(landisk_cf_init);
135
136         landisk_buzzerparam = 0;
137         check_usl5p();
138
139         printk(KERN_INFO "I-O DATA DEVICE, INC. \"LANDISK Series\" support.\n");
140
141         board_time_init = landisk_time_init;
142         pm_power_off = landisk_power_off;
143 }
144
145 /*
146  * The Machine Vector
147  */
148 struct sh_machine_vector mv_landisk __initmv = {
149         .mv_name = "LANDISK",
150         .mv_setup = landisk_setup,
151         .mv_nr_irqs = 72,
152         .mv_inb = landisk_inb,
153         .mv_inw = landisk_inw,
154         .mv_inl = landisk_inl,
155         .mv_outb = landisk_outb,
156         .mv_outw = landisk_outw,
157         .mv_outl = landisk_outl,
158         .mv_inb_p = landisk_inb_p,
159         .mv_inw_p = landisk_inw,
160         .mv_inl_p = landisk_inl,
161         .mv_outb_p = landisk_outb_p,
162         .mv_outw_p = landisk_outw,
163         .mv_outl_p = landisk_outl,
164         .mv_insb = landisk_insb,
165         .mv_insw = landisk_insw,
166         .mv_insl = landisk_insl,
167         .mv_outsb = landisk_outsb,
168         .mv_outsw = landisk_outsw,
169         .mv_outsl = landisk_outsl,
170         .mv_ioport_map = landisk_ioport_map,
171         .mv_init_irq = init_landisk_IRQ,
172 #ifdef CONFIG_HEARTBEAT
173         .mv_heartbeat = heartbeat_landisk,
174 #endif
175 };
176 ALIAS_MV(landisk)