mainstone.c 14.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14
/*
 *  linux/arch/arm/mach-pxa/mainstone.c
 *
 *  Support for the Intel HCDDBBVA0 Development Platform.
 *  (go figure how they came up with such name...)
 *
 *  Author:	Nicolas Pitre
 *  Created:	Nov 05, 2002
 *  Copyright:	MontaVista Software Inc.
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 */
15
#include <linux/gpio.h>
L
Linus Torvalds 已提交
16
#include <linux/init.h>
17
#include <linux/platform_device.h>
18
#include <linux/syscore_ops.h>
L
Linus Torvalds 已提交
19 20 21 22
#include <linux/interrupt.h>
#include <linux/sched.h>
#include <linux/bitops.h>
#include <linux/fb.h>
23 24 25
#include <linux/ioport.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/partitions.h>
26 27
#include <linux/input.h>
#include <linux/gpio_keys.h>
28
#include <linux/pwm_backlight.h>
29
#include <linux/smc91x.h>
30
#include <linux/i2c/pxa-i2c.h>
L
Linus Torvalds 已提交
31 32 33 34 35

#include <asm/types.h>
#include <asm/setup.h>
#include <asm/memory.h>
#include <asm/mach-types.h>
36
#include <mach/hardware.h>
L
Linus Torvalds 已提交
37
#include <asm/irq.h>
38
#include <asm/sizes.h>
L
Linus Torvalds 已提交
39 40 41 42

#include <asm/mach/arch.h>
#include <asm/mach/map.h>
#include <asm/mach/irq.h>
43
#include <asm/mach/flash.h>
L
Linus Torvalds 已提交
44

45
#include <mach/pxa27x.h>
46 47 48 49 50 51
#include <mach/mainstone.h>
#include <mach/audio.h>
#include <mach/pxafb.h>
#include <mach/mmc.h>
#include <mach/irda.h>
#include <mach/ohci.h>
52
#include <plat/pxa27x_keypad.h>
53
#include <mach/smemc.h>
L
Linus Torvalds 已提交
54 55

#include "generic.h"
56
#include "devices.h"
L
Linus Torvalds 已提交
57

58 59 60 61 62
static unsigned long mainstone_pin_config[] = {
	/* Chip Select */
	GPIO15_nCS_1,

	/* LCD - 16bpp Active TFT */
63
	GPIOxx_LCD_TFT_16BPP,
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
	GPIO16_PWM0_OUT,	/* Backlight */

	/* MMC */
	GPIO32_MMC_CLK,
	GPIO112_MMC_CMD,
	GPIO92_MMC_DAT_0,
	GPIO109_MMC_DAT_1,
	GPIO110_MMC_DAT_2,
	GPIO111_MMC_DAT_3,

	/* USB Host Port 1 */
	GPIO88_USBH1_PWR,
	GPIO89_USBH1_PEN,

	/* PC Card */
	GPIO48_nPOE,
	GPIO49_nPWE,
	GPIO50_nPIOR,
	GPIO51_nPIOW,
	GPIO85_nPCE_1,
	GPIO54_nPCE_2,
	GPIO79_PSKTSEL,
	GPIO55_nPREG,
	GPIO56_nPWAIT,
	GPIO57_nIOIS16,

	/* AC97 */
91 92 93 94
	GPIO28_AC97_BITCLK,
	GPIO29_AC97_SDATA_IN_0,
	GPIO30_AC97_SDATA_OUT,
	GPIO31_AC97_SYNC,
95 96 97
	GPIO45_AC97_SYSCLK,

	/* Keypad */
98 99 100
	GPIO93_KP_DKIN_0,
	GPIO94_KP_DKIN_1,
	GPIO95_KP_DKIN_2,
101 102 103 104 105 106 107 108 109 110 111 112 113 114
	GPIO100_KP_MKIN_0	| WAKEUP_ON_LEVEL_HIGH,
	GPIO101_KP_MKIN_1	| WAKEUP_ON_LEVEL_HIGH,
	GPIO102_KP_MKIN_2	| WAKEUP_ON_LEVEL_HIGH,
	GPIO97_KP_MKIN_3	| WAKEUP_ON_LEVEL_HIGH,
	GPIO98_KP_MKIN_4	| WAKEUP_ON_LEVEL_HIGH,
	GPIO99_KP_MKIN_5	| WAKEUP_ON_LEVEL_HIGH,
	GPIO103_KP_MKOUT_0,
	GPIO104_KP_MKOUT_1,
	GPIO105_KP_MKOUT_2,
	GPIO106_KP_MKOUT_3,
	GPIO107_KP_MKOUT_4,
	GPIO108_KP_MKOUT_5,
	GPIO96_KP_MKOUT_6,

115 116 117 118
	/* I2C */
	GPIO117_I2C_SCL,
	GPIO118_I2C_SDA,

119 120 121
	/* GPIO */
	GPIO1_GPIO | WAKEUP_ON_EDGE_BOTH,
};
L
Linus Torvalds 已提交
122 123 124

static unsigned long mainstone_irq_enabled;

125
static void mainstone_mask_irq(struct irq_data *d)
L
Linus Torvalds 已提交
126
{
127
	int mainstone_irq = (d->irq - MAINSTONE_IRQ(0));
L
Linus Torvalds 已提交
128 129 130
	MST_INTMSKENA = (mainstone_irq_enabled &= ~(1 << mainstone_irq));
}

131
static void mainstone_unmask_irq(struct irq_data *d)
L
Linus Torvalds 已提交
132
{
133
	int mainstone_irq = (d->irq - MAINSTONE_IRQ(0));
L
Linus Torvalds 已提交
134 135 136 137 138
	/* the irq can be acknowledged only if deasserted, so it's done here */
	MST_INTSETCLR &= ~(1 << mainstone_irq);
	MST_INTMSKENA = (mainstone_irq_enabled |= (1 << mainstone_irq));
}

139 140
static struct irq_chip mainstone_irq_chip = {
	.name		= "FPGA",
141 142 143
	.irq_ack	= mainstone_mask_irq,
	.irq_mask	= mainstone_mask_irq,
	.irq_unmask	= mainstone_unmask_irq,
L
Linus Torvalds 已提交
144 145
};

146
static void mainstone_irq_handler(unsigned int irq, struct irq_desc *desc)
L
Linus Torvalds 已提交
147 148 149
{
	unsigned long pending = MST_INTSETCLR & mainstone_irq_enabled;
	do {
150 151
		/* clear useless edge notification */
		desc->irq_data.chip->irq_ack(&desc->irq_data);
L
Linus Torvalds 已提交
152 153
		if (likely(pending)) {
			irq = MAINSTONE_IRQ(0) + __ffs(pending);
154
			generic_handle_irq(irq);
L
Linus Torvalds 已提交
155 156 157 158 159 160 161 162 163
		}
		pending = MST_INTSETCLR & mainstone_irq_enabled;
	} while (pending);
}

static void __init mainstone_init_irq(void)
{
	int irq;

164
	pxa27x_init_irq();
L
Linus Torvalds 已提交
165 166 167

	/* setup extra Mainstone irqs */
	for(irq = MAINSTONE_IRQ(0); irq <= MAINSTONE_IRQ(15); irq++) {
168 169
		irq_set_chip_and_handler(irq, &mainstone_irq_chip,
					 handle_level_irq);
170 171 172 173
		if (irq == MAINSTONE_IRQ(10) || irq == MAINSTONE_IRQ(14))
			set_irq_flags(irq, IRQF_VALID | IRQF_PROBE | IRQF_NOAUTOEN);
		else
			set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
L
Linus Torvalds 已提交
174 175 176 177 178 179 180
	}
	set_irq_flags(MAINSTONE_IRQ(8), 0);
	set_irq_flags(MAINSTONE_IRQ(12), 0);

	MST_INTMSKENA = 0;
	MST_INTSETCLR = 0;

181 182
	irq_set_chained_handler(PXA_GPIO_TO_IRQ(0), mainstone_irq_handler);
	irq_set_irq_type(PXA_GPIO_TO_IRQ(0), IRQ_TYPE_EDGE_FALLING);
L
Linus Torvalds 已提交
183 184
}

185 186
#ifdef CONFIG_PM

187
static void mainstone_irq_resume(void)
188 189 190 191
{
	MST_INTMSKENA = mainstone_irq_enabled;
}

192
static struct syscore_ops mainstone_irq_syscore_ops = {
193 194 195 196 197
	.resume = mainstone_irq_resume,
};

static int __init mainstone_irq_device_init(void)
{
198 199
	if (machine_is_mainstone())
		register_syscore_ops(&mainstone_irq_syscore_ops);
200

201
	return 0;
202 203 204 205 206 207
}

device_initcall(mainstone_irq_device_init);

#endif

L
Linus Torvalds 已提交
208 209 210 211 212 213 214 215 216 217

static struct resource smc91x_resources[] = {
	[0] = {
		.start	= (MST_ETH_PHYS + 0x300),
		.end	= (MST_ETH_PHYS + 0xfffff),
		.flags	= IORESOURCE_MEM,
	},
	[1] = {
		.start	= MAINSTONE_IRQ(3),
		.end	= MAINSTONE_IRQ(3),
218
		.flags	= IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE,
L
Linus Torvalds 已提交
219 220 221
	}
};

222 223 224 225 226
static struct smc91x_platdata mainstone_smc91x_info = {
	.flags	= SMC91X_USE_8BIT | SMC91X_USE_16BIT | SMC91X_USE_32BIT |
		  SMC91X_NOWAIT | SMC91X_USE_DMA,
};

L
Linus Torvalds 已提交
227 228 229 230 231
static struct platform_device smc91x_device = {
	.name		= "smc91x",
	.id		= 0,
	.num_resources	= ARRAY_SIZE(smc91x_resources),
	.resource	= smc91x_resources,
232 233 234
	.dev		= {
		.platform_data = &mainstone_smc91x_info,
	},
L
Linus Torvalds 已提交
235 236
};

T
Takashi Iwai 已提交
237
static int mst_audio_startup(struct snd_pcm_substream *substream, void *priv)
L
Linus Torvalds 已提交
238 239 240 241 242 243
{
	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
		MST_MSCWR2 &= ~MST_MSCWR2_AC97_SPKROFF;
	return 0;
}

T
Takashi Iwai 已提交
244
static void mst_audio_shutdown(struct snd_pcm_substream *substream, void *priv)
L
Linus Torvalds 已提交
245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269
{
	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
		MST_MSCWR2 |= MST_MSCWR2_AC97_SPKROFF;
}

static long mst_audio_suspend_mask;

static void mst_audio_suspend(void *priv)
{
	mst_audio_suspend_mask = MST_MSCWR2;
	MST_MSCWR2 |= MST_MSCWR2_AC97_SPKROFF;
}

static void mst_audio_resume(void *priv)
{
	MST_MSCWR2 &= mst_audio_suspend_mask | ~MST_MSCWR2_AC97_SPKROFF;
}

static pxa2xx_audio_ops_t mst_audio_ops = {
	.startup	= mst_audio_startup,
	.shutdown	= mst_audio_shutdown,
	.suspend	= mst_audio_suspend,
	.resume		= mst_audio_resume,
};

270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332
static struct resource flash_resources[] = {
	[0] = {
		.start	= PXA_CS0_PHYS,
		.end	= PXA_CS0_PHYS + SZ_64M - 1,
		.flags	= IORESOURCE_MEM,
	},
	[1] = {
		.start	= PXA_CS1_PHYS,
		.end	= PXA_CS1_PHYS + SZ_64M - 1,
		.flags	= IORESOURCE_MEM,
	},
};

static struct mtd_partition mainstoneflash0_partitions[] = {
	{
		.name =		"Bootloader",
		.size =		0x00040000,
		.offset =	0,
		.mask_flags =	MTD_WRITEABLE  /* force read-only */
	},{
		.name =		"Kernel",
		.size =		0x00400000,
		.offset =	0x00040000,
	},{
		.name =		"Filesystem",
		.size =		MTDPART_SIZ_FULL,
		.offset =	0x00440000
	}
};

static struct flash_platform_data mst_flash_data[2] = {
	{
		.map_name	= "cfi_probe",
		.parts		= mainstoneflash0_partitions,
		.nr_parts	= ARRAY_SIZE(mainstoneflash0_partitions),
	}, {
		.map_name	= "cfi_probe",
		.parts		= NULL,
		.nr_parts	= 0,
	}
};

static struct platform_device mst_flash_device[2] = {
	{
		.name		= "pxa2xx-flash",
		.id		= 0,
		.dev = {
			.platform_data = &mst_flash_data[0],
		},
		.resource = &flash_resources[0],
		.num_resources = 1,
	},
	{
		.name		= "pxa2xx-flash",
		.id		= 1,
		.dev = {
			.platform_data = &mst_flash_data[1],
		},
		.resource = &flash_resources[1],
		.num_resources = 1,
	},
};

333 334 335 336 337 338 339
#if defined(CONFIG_FB_PXA) || defined(CONFIG_FB_PXA_MODULE)
static struct platform_pwm_backlight_data mainstone_backlight_data = {
	.pwm_id		= 0,
	.max_brightness	= 1023,
	.dft_brightness	= 1023,
	.pwm_period_ns	= 78770,
};
340

341 342 343 344 345 346
static struct platform_device mainstone_backlight_device = {
	.name		= "pwm-backlight",
	.dev		= {
		.parent = &pxa27x_device_pwm0.dev,
		.platform_data = &mainstone_backlight_data,
	},
347 348 349 350
};

static void __init mainstone_backlight_register(void)
{
351 352 353
	int ret = platform_device_register(&mainstone_backlight_device);
	if (ret)
		printk(KERN_ERR "mainstone: failed to register backlight device: %d\n", ret);
L
Linus Torvalds 已提交
354
}
355 356 357
#else
#define mainstone_backlight_register()	do { } while (0)
#endif
L
Linus Torvalds 已提交
358

359
static struct pxafb_mode_info toshiba_ltm04c380k_mode = {
L
Linus Torvalds 已提交
360 361 362 363 364 365 366 367 368 369 370 371 372
	.pixclock		= 50000,
	.xres			= 640,
	.yres			= 480,
	.bpp			= 16,
	.hsync_len		= 1,
	.left_margin		= 0x9f,
	.right_margin		= 1,
	.vsync_len		= 44,
	.upper_margin		= 0,
	.lower_margin		= 0,
	.sync			= FB_SYNC_HOR_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
};

373
static struct pxafb_mode_info toshiba_ltm035a776c_mode = {
L
Linus Torvalds 已提交
374 375 376 377 378 379 380 381 382 383 384
	.pixclock		= 110000,
	.xres			= 240,
	.yres			= 320,
	.bpp			= 16,
	.hsync_len		= 4,
	.left_margin		= 8,
	.right_margin		= 20,
	.vsync_len		= 3,
	.upper_margin		= 1,
	.lower_margin		= 10,
	.sync			= FB_SYNC_HOR_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
385 386 387 388
};

static struct pxafb_mach_info mainstone_pxafb_info = {
	.num_modes      	= 1,
389
	.lcd_conn		= LCD_COLOR_TFT_16BPP | LCD_PCLK_EDGE_FALL,
L
Linus Torvalds 已提交
390 391
};

392
static int mainstone_mci_init(struct device *dev, irq_handler_t mstone_detect_int, void *data)
L
Linus Torvalds 已提交
393 394 395 396 397 398 399 400
{
	int err;

	/* make sure SD/Memory Stick multiplexer's signals
	 * are routed to MMC controller
	 */
	MST_MSCWR1 &= ~MST_MSCWR1_MS_SEL;

401
	err = request_irq(MAINSTONE_MMC_IRQ, mstone_detect_int, IRQF_DISABLED,
L
Linus Torvalds 已提交
402
			     "MMC card detect", data);
403
	if (err)
L
Linus Torvalds 已提交
404 405
		printk(KERN_ERR "mainstone_mci_init: MMC/SD: can't request MMC card detect IRQ\n");

406
	return err;
L
Linus Torvalds 已提交
407 408 409 410 411 412 413
}

static void mainstone_mci_setpower(struct device *dev, unsigned int vdd)
{
	struct pxamci_platform_data* p_d = dev->platform_data;

	if (( 1 << vdd) & p_d->ocr_mask) {
414
		printk(KERN_DEBUG "%s: on\n", __func__);
L
Linus Torvalds 已提交
415 416 417
		MST_MSCWR1 |= MST_MSCWR1_MMC_ON;
		MST_MSCWR1 &= ~MST_MSCWR1_MS_SEL;
	} else {
418
		printk(KERN_DEBUG "%s: off\n", __func__);
L
Linus Torvalds 已提交
419 420 421 422 423 424 425 426 427 428
		MST_MSCWR1 &= ~MST_MSCWR1_MMC_ON;
	}
}

static void mainstone_mci_exit(struct device *dev, void *data)
{
	free_irq(MAINSTONE_MMC_IRQ, data);
}

static struct pxamci_platform_data mainstone_mci_platform_data = {
429 430 431 432 433 434 435
	.ocr_mask		= MMC_VDD_32_33|MMC_VDD_33_34,
	.init 			= mainstone_mci_init,
	.setpower 		= mainstone_mci_setpower,
	.exit			= mainstone_mci_exit,
	.gpio_card_detect	= -1,
	.gpio_card_ro		= -1,
	.gpio_power		= -1,
L
Linus Torvalds 已提交
436 437
};

N
Nicolas Pitre 已提交
438 439 440 441 442 443 444 445 446 447
static void mainstone_irda_transceiver_mode(struct device *dev, int mode)
{
	unsigned long flags;

	local_irq_save(flags);
	if (mode & IR_SIRMODE) {
		MST_MSCWR1 &= ~MST_MSCWR1_IRDA_FIR;
	} else if (mode & IR_FIRMODE) {
		MST_MSCWR1 |= MST_MSCWR1_IRDA_FIR;
	}
448
	pxa2xx_transceiver_mode(dev, mode);
N
Nicolas Pitre 已提交
449 450 451 452 453 454 455 456 457
	if (mode & IR_OFF) {
		MST_MSCWR1 = (MST_MSCWR1 & ~MST_MSCWR1_IRDA_MASK) | MST_MSCWR1_IRDA_OFF;
	} else {
		MST_MSCWR1 = (MST_MSCWR1 & ~MST_MSCWR1_IRDA_MASK) | MST_MSCWR1_IRDA_FULL;
	}
	local_irq_restore(flags);
}

static struct pxaficp_platform_data mainstone_ficp_platform_data = {
458 459 460
	.gpio_pwdown		= -1,
	.transceiver_cap	= IR_SIRMODE | IR_FIRMODE | IR_OFF,
	.transceiver_mode	= mainstone_irda_transceiver_mode,
N
Nicolas Pitre 已提交
461 462
};

463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485
static struct gpio_keys_button gpio_keys_button[] = {
	[0] = {
		.desc	= "wakeup",
		.code	= KEY_SUSPEND,
		.type	= EV_KEY,
		.gpio	= 1,
		.wakeup	= 1,
	},
};

static struct gpio_keys_platform_data mainstone_gpio_keys = {
	.buttons	= gpio_keys_button,
	.nbuttons	= 1,
};

static struct platform_device mst_gpio_keys_device = {
	.name		= "gpio-keys",
	.id		= -1,
	.dev		= {
		.platform_data	= &mainstone_gpio_keys,
	},
};

486 487 488 489
static struct platform_device *platform_devices[] __initdata = {
	&smc91x_device,
	&mst_flash_device[0],
	&mst_flash_device[1],
490
	&mst_gpio_keys_device,
491 492
};

493 494
static struct pxaohci_platform_data mainstone_ohci_platform_data = {
	.port_mode	= PMM_PERPORT_MODE,
495
	.flags		= ENABLE_PORT_ALL | POWER_CONTROL_LOW | POWER_SENSE_LOW,
496 497
};

498
#if defined(CONFIG_KEYBOARD_PXA27x) || defined(CONFIG_KEYBOARD_PXA27x_MODULE)
499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548
static unsigned int mainstone_matrix_keys[] = {
	KEY(0, 0, KEY_A), KEY(1, 0, KEY_B), KEY(2, 0, KEY_C),
	KEY(3, 0, KEY_D), KEY(4, 0, KEY_E), KEY(5, 0, KEY_F),
	KEY(0, 1, KEY_G), KEY(1, 1, KEY_H), KEY(2, 1, KEY_I),
	KEY(3, 1, KEY_J), KEY(4, 1, KEY_K), KEY(5, 1, KEY_L),
	KEY(0, 2, KEY_M), KEY(1, 2, KEY_N), KEY(2, 2, KEY_O),
	KEY(3, 2, KEY_P), KEY(4, 2, KEY_Q), KEY(5, 2, KEY_R),
	KEY(0, 3, KEY_S), KEY(1, 3, KEY_T), KEY(2, 3, KEY_U),
	KEY(3, 3, KEY_V), KEY(4, 3, KEY_W), KEY(5, 3, KEY_X),
	KEY(2, 4, KEY_Y), KEY(3, 4, KEY_Z),

	KEY(0, 4, KEY_DOT),	/* . */
	KEY(1, 4, KEY_CLOSE),	/* @ */
	KEY(4, 4, KEY_SLASH),
	KEY(5, 4, KEY_BACKSLASH),
	KEY(0, 5, KEY_HOME),
	KEY(1, 5, KEY_LEFTSHIFT),
	KEY(2, 5, KEY_SPACE),
	KEY(3, 5, KEY_SPACE),
	KEY(4, 5, KEY_ENTER),
	KEY(5, 5, KEY_BACKSPACE),

	KEY(0, 6, KEY_UP),
	KEY(1, 6, KEY_DOWN),
	KEY(2, 6, KEY_LEFT),
	KEY(3, 6, KEY_RIGHT),
	KEY(4, 6, KEY_SELECT),
};

struct pxa27x_keypad_platform_data mainstone_keypad_info = {
	.matrix_key_rows	= 6,
	.matrix_key_cols	= 7,
	.matrix_key_map		= mainstone_matrix_keys,
	.matrix_key_map_size	= ARRAY_SIZE(mainstone_matrix_keys),

	.enable_rotary0		= 1,
	.rotary0_up_key		= KEY_UP,
	.rotary0_down_key	= KEY_DOWN,

	.debounce_interval	= 30,
};

static void __init mainstone_init_keypad(void)
{
	pxa_set_keypad_info(&mainstone_keypad_info);
}
#else
static inline void mainstone_init_keypad(void) {}
#endif

L
Linus Torvalds 已提交
549 550
static void __init mainstone_init(void)
{
551 552
	int SW7 = 0;  /* FIXME: get from SCR (Mst doc section 3.2.1.1) */

553 554
	pxa2xx_mfp_config(ARRAY_AND_SIZE(mainstone_pin_config));

555 556 557 558
	pxa_set_ffuart_info(NULL);
	pxa_set_btuart_info(NULL);
	pxa_set_stuart_info(NULL);

559
	mst_flash_data[0].width = (__raw_readl(BOOT_DEF) & 1) ? 2 : 4;
560 561 562 563 564 565 566 567 568
	mst_flash_data[1].width = 4;

	/* Compensate for SW7 which swaps the flash banks */
	mst_flash_data[SW7].name = "processor-flash";
	mst_flash_data[SW7 ^ 1].name = "mainboard-flash";

	printk(KERN_NOTICE "Mainstone configured to boot from %s\n",
	       mst_flash_data[0].name);

569 570 571 572 573 574
	/* system bus arbiter setting
	 * - Core_Park
	 * - LCD_wt:DMA_wt:CORE_Wt = 2:3:4
	 */
	ARB_CNTRL = ARB_CORE_PARK | 0x234;

575
	platform_add_devices(platform_devices, ARRAY_SIZE(platform_devices));
L
Linus Torvalds 已提交
576 577 578 579

	/* reading Mainstone's "Virtual Configuration Register"
	   might be handy to select LCD type here */
	if (0)
580
		mainstone_pxafb_info.modes = &toshiba_ltm04c380k_mode;
L
Linus Torvalds 已提交
581
	else
582 583
		mainstone_pxafb_info.modes = &toshiba_ltm035a776c_mode;

584
	pxa_set_fb_info(NULL, &mainstone_pxafb_info);
585
	mainstone_backlight_register();
L
Linus Torvalds 已提交
586 587

	pxa_set_mci_info(&mainstone_mci_platform_data);
N
Nicolas Pitre 已提交
588
	pxa_set_ficp_info(&mainstone_ficp_platform_data);
589
	pxa_set_ohci_info(&mainstone_ohci_platform_data);
590
	pxa_set_i2c_info(NULL);
591
	pxa_set_ac97_info(&mst_audio_ops);
592 593

	mainstone_init_keypad();
L
Linus Torvalds 已提交
594 595 596 597
}


static struct map_desc mainstone_io_desc[] __initdata = {
598 599 600 601 602 603
  	{	/* CPLD */
		.virtual	=  MST_FPGA_VIRT,
		.pfn		= __phys_to_pfn(MST_FPGA_PHYS),
		.length		= 0x00100000,
		.type		= MT_DEVICE
	}
L
Linus Torvalds 已提交
604 605 606 607
};

static void __init mainstone_map_io(void)
{
608
	pxa27x_map_io();
L
Linus Torvalds 已提交
609 610
	iotable_init(mainstone_io_desc, ARRAY_SIZE(mainstone_io_desc));

611 612 613
 	/*	for use I SRAM as framebuffer.	*/
 	PSLR |= 0xF04;
 	PCFR = 0x66;
L
Linus Torvalds 已提交
614 615 616
}

MACHINE_START(MAINSTONE, "Intel HCDDBBVA0 Development Platform (aka Mainstone)")
617
	/* Maintainer: MontaVista Software Inc. */
618
	.atag_offset	= 0x100,	/* BLOB boot parameter setting */
619
	.map_io		= mainstone_map_io,
620
	.nr_irqs	= MAINSTONE_NR_IRQS,
621
	.init_irq	= mainstone_init_irq,
622
	.handle_irq	= pxa27x_handle_irq,
L
Linus Torvalds 已提交
623
	.timer		= &pxa_timer,
624
	.init_machine	= mainstone_init,
625
	.restart	= pxa_restart,
L
Linus Torvalds 已提交
626
MACHINE_END