• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /netgear-WNDR4500-V1.0.1.40_1.0.68/src/linux/linux-2.6/arch/mips/vr41xx/nec-cmbvr4133/
1/*
2 * arch/mips/vr41xx/nec-cmbvr4133/m1535plus.c
3 *
4 * Initialize for ALi M1535+(included M5229 and M5237).
5 *
6 * Author: Yoichi Yuasa <yyuasa@mvista.com, or source@mvista.com> and
7 *         Alex Sapkov <asapkov@ru.mvista.com>
8 *
9 * 2003-2004 (c) MontaVista, Software, Inc. This file is licensed under
10 * the terms of the GNU General Public License version 2. This program
11 * is licensed "as is" without any warranty of any kind, whether express
12 * or implied.
13 *
14 * Support for NEC-CMBVR4133 in 2.6
15 * Author: Manish Lachwani (mlachwani@mvista.com)
16 */
17#include <linux/init.h>
18#include <linux/types.h>
19#include <linux/serial.h>
20
21#include <asm/vr41xx/cmbvr4133.h>
22#include <linux/pci.h>
23#include <asm/io.h>
24
25#define CONFIG_PORT(port)	((port) ? 0x3f0 : 0x370)
26#define DATA_PORT(port)		((port) ? 0x3f1 : 0x371)
27#define INDEX_PORT(port)	CONFIG_PORT(port)
28
29#define ENTER_CONFIG_MODE(port)				\
30	do {						\
31		outb_p(0x51, CONFIG_PORT(port));	\
32		outb_p(0x23, CONFIG_PORT(port));	\
33	} while(0)
34
35#define SELECT_LOGICAL_DEVICE(port, dev_no)		\
36	do {						\
37		outb_p(0x07, INDEX_PORT(port));		\
38		outb_p((dev_no), DATA_PORT(port));	\
39	} while(0)
40
41#define WRITE_CONFIG_DATA(port,index,data)		\
42	do {						\
43		outb_p((index), INDEX_PORT(port));	\
44		outb_p((data), DATA_PORT(port));	\
45	} while(0)
46
47#define EXIT_CONFIG_MODE(port)	outb(0xbb, CONFIG_PORT(port))
48
49#define PCI_CONFIG_ADDR	KSEG1ADDR(0x0f000c18)
50#define PCI_CONFIG_DATA	KSEG1ADDR(0x0f000c14)
51
52#ifdef CONFIG_BLK_DEV_FD
53
54void __devinit ali_m1535plus_fdc_init(int port)
55{
56	ENTER_CONFIG_MODE(port);
57	SELECT_LOGICAL_DEVICE(port, 0);		/* FDC */
58	WRITE_CONFIG_DATA(port, 0x30, 0x01);	/* FDC: enable */
59	WRITE_CONFIG_DATA(port, 0x60, 0x03);	/* I/O port base: 0x3f0 */
60	WRITE_CONFIG_DATA(port, 0x61, 0xf0);
61	WRITE_CONFIG_DATA(port, 0x70, 0x06);	/* IRQ: 6 */
62	WRITE_CONFIG_DATA(port, 0x74, 0x02);	/* DMA: channel 2 */
63	WRITE_CONFIG_DATA(port, 0xf0, 0x08);
64	WRITE_CONFIG_DATA(port, 0xf1, 0x00);
65	WRITE_CONFIG_DATA(port, 0xf2, 0xff);
66	WRITE_CONFIG_DATA(port, 0xf4, 0x00);
67	EXIT_CONFIG_MODE(port);
68}
69
70#endif
71
72void __devinit ali_m1535plus_parport_init(int port)
73{
74	ENTER_CONFIG_MODE(port);
75	SELECT_LOGICAL_DEVICE(port, 3);		/* Parallel Port */
76	WRITE_CONFIG_DATA(port, 0x30, 0x01);
77	WRITE_CONFIG_DATA(port, 0x60, 0x03);	/* I/O port base: 0x378 */
78	WRITE_CONFIG_DATA(port, 0x61, 0x78);
79	WRITE_CONFIG_DATA(port, 0x70, 0x07);	/* IRQ: 7 */
80	WRITE_CONFIG_DATA(port, 0x74, 0x04);	/* DMA: None */
81	WRITE_CONFIG_DATA(port, 0xf0, 0x8c);	/* IRQ polarity: Active Low */
82	WRITE_CONFIG_DATA(port, 0xf1, 0xc5);
83	EXIT_CONFIG_MODE(port);
84}
85
86void __devinit ali_m1535plus_keyboard_init(int port)
87{
88	ENTER_CONFIG_MODE(port);
89	SELECT_LOGICAL_DEVICE(port, 7);		/* KEYBOARD */
90	WRITE_CONFIG_DATA(port, 0x30, 0x01);	/* KEYBOARD: eable */
91	WRITE_CONFIG_DATA(port, 0x70, 0x01);	/* IRQ: 1 */
92	WRITE_CONFIG_DATA(port, 0x72, 0x0c);	/* PS/2 Mouse IRQ: 12 */
93	WRITE_CONFIG_DATA(port, 0xf0, 0x00);
94	EXIT_CONFIG_MODE(port);
95}
96
97void __devinit ali_m1535plus_hotkey_init(int port)
98{
99	ENTER_CONFIG_MODE(port);
100	SELECT_LOGICAL_DEVICE(port, 0xc);	/* HOTKEY */
101	WRITE_CONFIG_DATA(port, 0x30, 0x00);
102	WRITE_CONFIG_DATA(port, 0xf0, 0x35);
103	WRITE_CONFIG_DATA(port, 0xf1, 0x14);
104	WRITE_CONFIG_DATA(port, 0xf2, 0x11);
105	WRITE_CONFIG_DATA(port, 0xf3, 0x71);
106	WRITE_CONFIG_DATA(port, 0xf5, 0x05);
107	EXIT_CONFIG_MODE(port);
108}
109
110void ali_m1535plus_init(struct pci_dev *dev)
111{
112	pci_write_config_byte(dev, 0x40, 0x18); /* PCI Interface Control */
113	pci_write_config_byte(dev, 0x41, 0xc0); /* PS2 keyb & mouse enable */
114	pci_write_config_byte(dev, 0x42, 0x41); /* ISA bus cycle control */
115	pci_write_config_byte(dev, 0x43, 0x00); /* ISA bus cycle control 2 */
116	pci_write_config_byte(dev, 0x44, 0x5d); /* IDE enable & IRQ 14 */
117	pci_write_config_byte(dev, 0x45, 0x0b); /* PCI int polling mode */
118	pci_write_config_byte(dev, 0x47, 0x00); /* BIOS chip select control */
119
120	/* IRQ routing */
121	pci_write_config_byte(dev, 0x48, 0x03); /* INTA IRQ10, INTB disable */
122	pci_write_config_byte(dev, 0x49, 0x00); /* INTC and INTD disable */
123	pci_write_config_byte(dev, 0x4a, 0x00); /* INTE and INTF disable */
124	pci_write_config_byte(dev, 0x4b, 0x90); /* Audio IRQ11, Modem disable */
125
126	pci_write_config_word(dev, 0x50, 0x4000); /* Parity check IDE enable */
127	pci_write_config_word(dev, 0x52, 0x0000); /* USB & RTC disable */
128	pci_write_config_word(dev, 0x54, 0x0002); /* ??? no info */
129	pci_write_config_word(dev, 0x56, 0x0002); /* PCS1J signal disable */
130
131	pci_write_config_byte(dev, 0x59, 0x00); /* PCSDS */
132	pci_write_config_byte(dev, 0x5a, 0x00);
133	pci_write_config_byte(dev, 0x5b, 0x00);
134	pci_write_config_word(dev, 0x5c, 0x0000);
135	pci_write_config_byte(dev, 0x5e, 0x00);
136	pci_write_config_byte(dev, 0x5f, 0x00);
137	pci_write_config_word(dev, 0x60, 0x0000);
138
139	pci_write_config_byte(dev, 0x6c, 0x00);
140	pci_write_config_byte(dev, 0x6d, 0x48); /* ROM address mapping */
141	pci_write_config_byte(dev, 0x6e, 0x00); /* ??? what for? */
142
143	pci_write_config_byte(dev, 0x70, 0x12); /* Serial IRQ control */
144	pci_write_config_byte(dev, 0x71, 0xEF); /* DMA channel select */
145	pci_write_config_byte(dev, 0x72, 0x03); /* USB IDSEL */
146	pci_write_config_byte(dev, 0x73, 0x00); /* ??? no info */
147
148	/*
149	 * IRQ setup ALi M5237 USB Host Controller
150	 * IRQ: 9
151	 */
152	pci_write_config_byte(dev, 0x74, 0x01); /* USB IRQ9 */
153
154	pci_write_config_byte(dev, 0x75, 0x1f); /* IDE2 IRQ 15  */
155	pci_write_config_byte(dev, 0x76, 0x80); /* ACPI disable */
156	pci_write_config_byte(dev, 0x77, 0x40); /* Modem disable */
157	pci_write_config_dword(dev, 0x78, 0x20000000); /* Pin select 2 */
158	pci_write_config_byte(dev, 0x7c, 0x00); /* Pin select 3 */
159	pci_write_config_byte(dev, 0x81, 0x00); /* ID read/write control */
160	pci_write_config_byte(dev, 0x90, 0x00); /* PCI PM block control */
161	pci_write_config_word(dev, 0xa4, 0x0000); /* PMSCR */
162
163#ifdef CONFIG_BLK_DEV_FD
164	ali_m1535plus_fdc_init(1);
165#endif
166
167	ali_m1535plus_keyboard_init(1);
168	ali_m1535plus_hotkey_init(1);
169}
170
171static inline void ali_config_writeb(u8 reg, u8 val, int devfn)
172{
173	u32 data;
174	int shift;
175
176	writel((1 << 16) | (devfn << 8) | (reg & 0xfc) | 1UL, PCI_CONFIG_ADDR);
177        data = readl(PCI_CONFIG_DATA);
178
179	shift = (reg & 3) << 3;
180	data &= ~(0xff << shift);
181	data |= (((u32)val) << shift);
182
183	writel(data, PCI_CONFIG_DATA);
184}
185
186static inline u8 ali_config_readb(u8 reg, int devfn)
187{
188	u32 data;
189
190	writel((1 << 16) | (devfn << 8) | (reg & 0xfc) | 1UL, PCI_CONFIG_ADDR);
191	data = readl(PCI_CONFIG_DATA);
192
193	return (u8)(data >> ((reg & 3) << 3));
194}
195
196static inline u16 ali_config_readw(u8 reg, int devfn)
197{
198	u32 data;
199
200	writel((1 << 16) | (devfn << 8) | (reg & 0xfc) | 1UL, PCI_CONFIG_ADDR);
201	data = readl(PCI_CONFIG_DATA);
202
203	return (u16)(data >> ((reg & 2) << 3));
204}
205
206int vr4133_rockhopper = 0;
207void __init ali_m5229_preinit(void)
208{
209	if (ali_config_readw(PCI_VENDOR_ID,16) == PCI_VENDOR_ID_AL &&
210	    ali_config_readw(PCI_DEVICE_ID,16) == PCI_DEVICE_ID_AL_M1533) {
211		printk(KERN_INFO "Found an NEC Rockhopper \n");
212		vr4133_rockhopper = 1;
213		/*
214		 * Enable ALi M5229 IDE Controller (both channels)
215		 * IDSEL: A27
216		 */
217		ali_config_writeb(0x58, 0x4c, 16);
218	}
219}
220
221void __init ali_m5229_init(struct pci_dev *dev)
222{
223	/*
224	 * Enable Primary/Secondary Channel Cable Detect 40-Pin
225	 */
226	pci_write_config_word(dev, 0x4a, 0xc023);
227
228	/*
229	 * Set only the 3rd byteis for the master IDE's cycle and
230	 * enable Internal IDE Function
231	 */
232	pci_write_config_byte(dev, 0x50, 0x23); /* Class code attr register */
233
234	pci_write_config_byte(dev, 0x09, 0xff); /* Set native mode & stuff */
235	pci_write_config_byte(dev, 0x52, 0x00); /* use timing registers */
236	pci_write_config_byte(dev, 0x58, 0x02); /* Primary addr setup timing */
237	pci_write_config_byte(dev, 0x59, 0x22); /* Primary cmd block timing */
238	pci_write_config_byte(dev, 0x5a, 0x22); /* Pr drv 0 R/W timing */
239	pci_write_config_byte(dev, 0x5b, 0x22); /* Pr drv 1 R/W timing */
240	pci_write_config_byte(dev, 0x5c, 0x02); /* Sec addr setup timing */
241	pci_write_config_byte(dev, 0x5d, 0x22); /* Sec cmd block timing */
242	pci_write_config_byte(dev, 0x5e, 0x22); /* Sec drv 0 R/W timing */
243	pci_write_config_byte(dev, 0x5f, 0x22); /* Sec drv 1 R/W timing */
244	pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x20);
245	pci_write_config_word(dev, PCI_COMMAND,
246	                           PCI_COMMAND_PARITY | PCI_COMMAND_MASTER |
247				   PCI_COMMAND_IO);
248}
249