lubbock.c 14.8 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 *  linux/arch/arm/mach-pxa/lubbock.c
 *
 *  Support for the Intel DBPXA250 Development Platform.
 *
 *  Author:	Nicolas Pitre
 *  Created:	Jun 15, 2001
 *  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.
 */
14
#include <linux/gpio.h>
L
Linus Torvalds 已提交
15 16 17
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
B
Bryan Wu 已提交
18
#include <linux/io.h>
19
#include <linux/platform_device.h>
20
#include <linux/syscore_ops.h>
L
Linus Torvalds 已提交
21 22 23
#include <linux/major.h>
#include <linux/fb.h>
#include <linux/interrupt.h>
24 25
#include <linux/mtd/mtd.h>
#include <linux/mtd/partitions.h>
26
#include <linux/smc91x.h>
B
Bryan Wu 已提交
27 28
#include <linux/slab.h>
#include <linux/leds.h>
L
Linus Torvalds 已提交
29

30 31
#include <linux/spi/spi.h>
#include <linux/spi/ads7846.h>
32
#include <linux/spi/pxa2xx_spi.h>
33

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

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

#include <asm/hardware/sa1111.h>

48
#include <mach/pxa25x.h>
49 50 51 52 53 54
#include <mach/audio.h>
#include <mach/lubbock.h>
#include <mach/udc.h>
#include <mach/irda.h>
#include <mach/pxafb.h>
#include <mach/mmc.h>
55
#include <mach/pm.h>
56
#include <mach/smemc.h>
L
Linus Torvalds 已提交
57 58

#include "generic.h"
59
#include "clock.h"
60
#include "devices.h"
L
Linus Torvalds 已提交
61

62 63
static unsigned long lubbock_pin_config[] __initdata = {
	GPIO15_nCS_1,	/* CS1 - Flash */
64
	GPIO78_nCS_2,	/* CS2 - Baseboard FGPA */
65
	GPIO79_nCS_3,	/* CS3 - SMC ethernet */
66
	GPIO80_nCS_4,	/* CS4 - SA1111 */
67 68 69 70 71 72

	/* SSP data pins */
	GPIO23_SSP1_SCLK,
	GPIO25_SSP1_TXD,
	GPIO26_SSP1_RXD,

73 74 75 76 77 78
	/* AC97 */
	GPIO28_AC97_BITCLK,
	GPIO29_AC97_SDATA_IN_0,
	GPIO30_AC97_SDATA_OUT,
	GPIO31_AC97_SYNC,

79
	/* LCD - 16bpp DSTN */
80
	GPIOxx_LCD_DSTN_16BPP,
81

82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106
	/* BTUART */
	GPIO42_BTUART_RXD,
	GPIO43_BTUART_TXD,
	GPIO44_BTUART_CTS,
	GPIO45_BTUART_RTS,

	/* PC Card */
	GPIO48_nPOE,
	GPIO49_nPWE,
	GPIO50_nPIOR,
	GPIO51_nPIOW,
	GPIO52_nPCE_1,
	GPIO53_nPCE_2,
	GPIO54_nPSKTSEL,
	GPIO55_nPREG,
	GPIO56_nPWAIT,
	GPIO57_nIOIS16,

	/* MMC */
	GPIO6_MMC_CLK,
	GPIO8_MMC_CS0,

	/* wakeup */
	GPIO1_GPIO | WAKEUP_ON_EDGE_RISE,
};
L
Linus Torvalds 已提交
107

108
#define LUB_HEXLED		__LUB_REG(LUBBOCK_FPGA_PHYS + 0x010)
L
Linus Torvalds 已提交
109 110
#define LUB_MISC_WR		__LUB_REG(LUBBOCK_FPGA_PHYS + 0x080)

111 112 113 114 115
void lubbock_set_hexled(uint32_t value)
{
	LUB_HEXLED = value;
}

L
Linus Torvalds 已提交
116 117 118 119 120 121 122 123 124 125 126 127
void lubbock_set_misc_wr(unsigned int mask, unsigned int set)
{
	unsigned long flags;

	local_irq_save(flags);
	LUB_MISC_WR = (LUB_MISC_WR & ~mask) | (set & mask);
	local_irq_restore(flags);
}
EXPORT_SYMBOL(lubbock_set_misc_wr);

static unsigned long lubbock_irq_enabled;

128
static void lubbock_mask_irq(struct irq_data *d)
L
Linus Torvalds 已提交
129
{
130
	int lubbock_irq = (d->irq - LUBBOCK_IRQ(0));
L
Linus Torvalds 已提交
131 132 133
	LUB_IRQ_MASK_EN = (lubbock_irq_enabled &= ~(1 << lubbock_irq));
}

134
static void lubbock_unmask_irq(struct irq_data *d)
L
Linus Torvalds 已提交
135
{
136
	int lubbock_irq = (d->irq - LUBBOCK_IRQ(0));
L
Linus Torvalds 已提交
137 138 139 140 141
	/* the irq can be acknowledged only if deasserted, so it's done here */
	LUB_IRQ_SET_CLR &= ~(1 << lubbock_irq);
	LUB_IRQ_MASK_EN = (lubbock_irq_enabled |= (1 << lubbock_irq));
}

142 143
static struct irq_chip lubbock_irq_chip = {
	.name		= "FPGA",
144 145 146
	.irq_ack	= lubbock_mask_irq,
	.irq_mask	= lubbock_mask_irq,
	.irq_unmask	= lubbock_unmask_irq,
L
Linus Torvalds 已提交
147 148
};

149
static void lubbock_irq_handler(unsigned int irq, struct irq_desc *desc)
L
Linus Torvalds 已提交
150 151 152
{
	unsigned long pending = LUB_IRQ_SET_CLR & lubbock_irq_enabled;
	do {
153 154
		/* clear our parent irq */
		desc->irq_data.chip->irq_ack(&desc->irq_data);
L
Linus Torvalds 已提交
155 156
		if (likely(pending)) {
			irq = LUBBOCK_IRQ(0) + __ffs(pending);
157
			generic_handle_irq(irq);
L
Linus Torvalds 已提交
158 159 160 161 162 163 164 165 166
		}
		pending = LUB_IRQ_SET_CLR & lubbock_irq_enabled;
	} while (pending);
}

static void __init lubbock_init_irq(void)
{
	int irq;

167
	pxa25x_init_irq();
L
Linus Torvalds 已提交
168 169 170

	/* setup extra lubbock irqs */
	for (irq = LUBBOCK_IRQ(0); irq <= LUBBOCK_LAST_IRQ; irq++) {
171 172
		irq_set_chip_and_handler(irq, &lubbock_irq_chip,
					 handle_level_irq);
L
Linus Torvalds 已提交
173 174 175
		set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
	}

176 177
	irq_set_chained_handler(PXA_GPIO_TO_IRQ(0), lubbock_irq_handler);
	irq_set_irq_type(PXA_GPIO_TO_IRQ(0), IRQ_TYPE_EDGE_FALLING);
L
Linus Torvalds 已提交
178 179
}

180 181
#ifdef CONFIG_PM

182
static void lubbock_irq_resume(void)
183 184 185 186
{
	LUB_IRQ_MASK_EN = lubbock_irq_enabled;
}

187
static struct syscore_ops lubbock_irq_syscore_ops = {
188 189 190 191 192
	.resume = lubbock_irq_resume,
};

static int __init lubbock_irq_device_init(void)
{
193
	if (machine_is_lubbock()) {
194 195
		register_syscore_ops(&lubbock_irq_syscore_ops);
		return 0;
196
	}
197
	return -ENODEV;
198 199 200 201 202 203
}

device_initcall(lubbock_irq_device_init);

#endif

L
Linus Torvalds 已提交
204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226
static int lubbock_udc_is_connected(void)
{
	return (LUB_MISC_RD & (1 << 9)) == 0;
}

static struct pxa2xx_udc_mach_info udc_info __initdata = {
	.udc_is_connected	= lubbock_udc_is_connected,
	// no D+ pullup; lubbock can't connect/disconnect in software
};

static struct resource sa1111_resources[] = {
	[0] = {
		.start	= 0x10000000,
		.end	= 0x10001fff,
		.flags	= IORESOURCE_MEM,
	},
	[1] = {
		.start	= LUBBOCK_SA1111_IRQ,
		.end	= LUBBOCK_SA1111_IRQ,
		.flags	= IORESOURCE_IRQ,
	},
};

227
static struct sa1111_platform_data sa1111_info = {
228
	.irq_base	= LUBBOCK_SA1111_IRQ_BASE,
229
	.disable_devs	= SA1111_DEVID_SAC,
230 231
};

L
Linus Torvalds 已提交
232 233 234 235 236
static struct platform_device sa1111_device = {
	.name		= "sa1111",
	.id		= -1,
	.num_resources	= ARRAY_SIZE(sa1111_resources),
	.resource	= sa1111_resources,
237 238 239
	.dev		= {
		.platform_data	= &sa1111_info,
	},
L
Linus Torvalds 已提交
240 241
};

242 243 244 245 246 247
/* ADS7846 is connected through SSP ... and if your board has J5 populated,
 * you can select it to replace the ucb1400 by switching the touchscreen cable
 * (to J5) and poking board registers (as done below).  Else it's only useful
 * for the temperature sensors.
 */
static struct pxa2xx_spi_master pxa_ssp_master_info = {
248
	.num_chipselect	= 1,
249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288
};

static int lubbock_ads7846_pendown_state(void)
{
	/* TS_BUSY is bit 8 in LUB_MISC_RD, but pendown is irq-only */
	return 0;
}

static struct ads7846_platform_data ads_info = {
	.model			= 7846,
	.vref_delay_usecs	= 100,		/* internal, no cap */
	.get_pendown_state	= lubbock_ads7846_pendown_state,
	// .x_plate_ohms		= 500,	/* GUESS! */
	// .y_plate_ohms		= 500,	/* GUESS! */
};

static void ads7846_cs(u32 command)
{
	static const unsigned	TS_nCS = 1 << 11;
	lubbock_set_misc_wr(TS_nCS, (command == PXA2XX_CS_ASSERT) ? 0 : TS_nCS);
}

static struct pxa2xx_spi_chip ads_hw = {
	.tx_threshold		= 1,
	.rx_threshold		= 2,
	.cs_control		= ads7846_cs,
};

static struct spi_board_info spi_board_info[] __initdata = { {
	.modalias	= "ads7846",
	.platform_data	= &ads_info,
	.controller_data = &ads_hw,
	.irq		= LUBBOCK_BB_IRQ,
	.max_speed_hz	= 120000 /* max sample rate at 3V */
				* 26 /* command + data + overhead */,
	.bus_num	= 1,
	.chip_select	= 0,
},
};

289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308
static struct resource smc91x_resources[] = {
	[0] = {
		.name	= "smc91x-regs",
		.start	= 0x0c000c00,
		.end	= 0x0c0fffff,
		.flags	= IORESOURCE_MEM,
	},
	[1] = {
		.start	= LUBBOCK_ETH_IRQ,
		.end	= LUBBOCK_ETH_IRQ,
		.flags	= IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE,
	},
	[2] = {
		.name	= "smc91x-attrib",
		.start	= 0x0e000000,
		.end	= 0x0e0fffff,
		.flags	= IORESOURCE_MEM,
	},
};

309 310 311 312
static struct smc91x_platdata lubbock_smc91x_info = {
	.flags	= SMC91X_USE_16BIT | SMC91X_NOWAIT | SMC91X_IO_SHIFT_2,
};

L
Linus Torvalds 已提交
313 314 315 316 317
static struct platform_device smc91x_device = {
	.name		= "smc91x",
	.id		= -1,
	.num_resources	= ARRAY_SIZE(smc91x_resources),
	.resource	= smc91x_resources,
318 319 320
	.dev		= {
		.platform_data = &lubbock_smc91x_info,
	},
L
Linus Torvalds 已提交
321 322
};

323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385
static struct resource flash_resources[] = {
	[0] = {
		.start	= 0x00000000,
		.end	= SZ_64M - 1,
		.flags	= IORESOURCE_MEM,
	},
	[1] = {
		.start	= 0x04000000,
		.end	= 0x04000000 + SZ_64M - 1,
		.flags	= IORESOURCE_MEM,
	},
};

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

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

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

L
Linus Torvalds 已提交
386 387 388
static struct platform_device *devices[] __initdata = {
	&sa1111_device,
	&smc91x_device,
389 390
	&lubbock_flash_device[0],
	&lubbock_flash_device[1],
L
Linus Torvalds 已提交
391 392
};

393
static struct pxafb_mode_info sharp_lm8v31_mode = {
L
Linus Torvalds 已提交
394 395 396 397 398 399 400 401 402 403 404 405
	.pixclock	= 270000,
	.xres		= 640,
	.yres		= 480,
	.bpp		= 16,
	.hsync_len	= 1,
	.left_margin	= 3,
	.right_margin	= 3,
	.vsync_len	= 1,
	.upper_margin	= 0,
	.lower_margin	= 0,
	.sync		= FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
	.cmap_greyscale	= 0,
406 407 408 409 410
};

static struct pxafb_mach_info sharp_lm8v31 = {
	.modes		= &sharp_lm8v31_mode,
	.num_modes	= 1,
L
Linus Torvalds 已提交
411 412
	.cmap_inverse	= 0,
	.cmap_static	= 0,
413
	.lcd_conn	= LCD_COLOR_DSTN_16BPP | LCD_PCLK_EDGE_FALL |
A
Alexey Dobriyan 已提交
414
			  LCD_AC_BIAS_FREQ(255),
L
Linus Torvalds 已提交
415 416
};

417 418 419
#define	MMC_POLL_RATE		msecs_to_jiffies(1000)

static void lubbock_mmc_poll(unsigned long);
420
static irq_handler_t mmc_detect_int;
421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438

static struct timer_list mmc_timer = {
	.function	= lubbock_mmc_poll,
};

static void lubbock_mmc_poll(unsigned long data)
{
	unsigned long flags;

	/* clear any previous irq state, then ... */
	local_irq_save(flags);
	LUB_IRQ_SET_CLR &= ~(1 << 0);
	local_irq_restore(flags);

	/* poll until mmc/sd card is removed */
	if (LUB_IRQ_SET_CLR & (1 << 0))
		mod_timer(&mmc_timer, jiffies + MMC_POLL_RATE);
	else {
439
		(void) mmc_detect_int(LUBBOCK_SD_IRQ, (void *)data);
440 441 442 443
		enable_irq(LUBBOCK_SD_IRQ);
	}
}

444
static irqreturn_t lubbock_detect_int(int irq, void *data)
445 446 447 448 449
{
	/* IRQ is level triggered; disable, and poll for removal */
	disable_irq(irq);
	mod_timer(&mmc_timer, jiffies + MMC_POLL_RATE);

450
	return mmc_detect_int(irq, data);
451 452 453
}

static int lubbock_mci_init(struct device *dev,
454
		irq_handler_t detect_int,
455
		void *data)
L
Linus Torvalds 已提交
456
{
457 458 459 460 461
	/* detect card insert/eject */
	mmc_detect_int = detect_int;
	init_timer(&mmc_timer);
	mmc_timer.data = (unsigned long) data;
	return request_irq(LUBBOCK_SD_IRQ, lubbock_detect_int,
462
			IRQF_SAMPLE_RANDOM, "lubbock-sd-detect", data);
463 464 465 466 467 468 469 470 471 472 473
}

static int lubbock_mci_get_ro(struct device *dev)
{
	return (LUB_MISC_RD & (1 << 2)) != 0;
}

static void lubbock_mci_exit(struct device *dev, void *data)
{
	free_irq(LUBBOCK_SD_IRQ, data);
	del_timer_sync(&mmc_timer);
L
Linus Torvalds 已提交
474 475 476
}

static struct pxamci_platform_data lubbock_mci_platform_data = {
477
	.ocr_mask		= MMC_VDD_32_33|MMC_VDD_33_34,
478
	.detect_delay_ms	= 10,
479 480 481 482 483 484
	.init 			= lubbock_mci_init,
	.get_ro			= lubbock_mci_get_ro,
	.exit 			= lubbock_mci_exit,
	.gpio_card_detect	= -1,
	.gpio_card_ro		= -1,
	.gpio_power		= -1,
L
Linus Torvalds 已提交
485 486
};

N
Nicolas Pitre 已提交
487 488 489 490 491 492 493 494 495 496
static void lubbock_irda_transceiver_mode(struct device *dev, int mode)
{
	unsigned long flags;

	local_irq_save(flags);
	if (mode & IR_SIRMODE) {
		LUB_MISC_WR &= ~(1 << 4);
	} else if (mode & IR_FIRMODE) {
		LUB_MISC_WR |= 1 << 4;
	}
497
	pxa2xx_transceiver_mode(dev, mode);
N
Nicolas Pitre 已提交
498 499 500 501
	local_irq_restore(flags);
}

static struct pxaficp_platform_data lubbock_ficp_platform_data = {
502 503 504
	.gpio_pwdown		= -1,
	.transceiver_cap	= IR_SIRMODE | IR_FIRMODE,
	.transceiver_mode	= lubbock_irda_transceiver_mode,
N
Nicolas Pitre 已提交
505 506
};

L
Linus Torvalds 已提交
507 508
static void __init lubbock_init(void)
{
509 510
	int flashboot = (LUB_CONF_SWITCHES & 1);

511 512
	pxa2xx_mfp_config(ARRAY_AND_SIZE(lubbock_pin_config));

513 514 515 516
	pxa_set_ffuart_info(NULL);
	pxa_set_btuart_info(NULL);
	pxa_set_stuart_info(NULL);

517
	clk_add_alias("SA1111_CLK", NULL, "GPIO11_CLK", NULL);
L
Linus Torvalds 已提交
518
	pxa_set_udc_info(&udc_info);
519
	pxa_set_fb_info(NULL, &sharp_lm8v31);
L
Linus Torvalds 已提交
520
	pxa_set_mci_info(&lubbock_mci_platform_data);
N
Nicolas Pitre 已提交
521
	pxa_set_ficp_info(&lubbock_ficp_platform_data);
522
	pxa_set_ac97_info(NULL);
523 524

	lubbock_flash_data[0].width = lubbock_flash_data[1].width =
525
		(__raw_readl(BOOT_DEF) & 1) ? 2 : 4;
526 527 528 529 530 531
	/* Compensate for the nROMBT switch which swaps the flash banks */
	printk(KERN_NOTICE "Lubbock configured to boot from %s (bank %d)\n",
	       flashboot?"Flash":"ROM", flashboot);

	lubbock_flash_data[flashboot^1].name = "application-flash";
	lubbock_flash_data[flashboot].name = "boot-rom";
L
Linus Torvalds 已提交
532
	(void) platform_add_devices(devices, ARRAY_SIZE(devices));
533

534
	pxa2xx_set_spi_info(1, &pxa_ssp_master_info);
535
	spi_register_board_info(spi_board_info, ARRAY_SIZE(spi_board_info));
L
Linus Torvalds 已提交
536 537 538
}

static struct map_desc lubbock_io_desc[] __initdata = {
539 540 541 542 543 544
  	{	/* CPLD */
		.virtual	=  LUBBOCK_FPGA_VIRT,
		.pfn		= __phys_to_pfn(LUBBOCK_FPGA_PHYS),
		.length		= 0x00100000,
		.type		= MT_DEVICE
	}
L
Linus Torvalds 已提交
545 546 547 548
};

static void __init lubbock_map_io(void)
{
549
	pxa25x_map_io();
L
Linus Torvalds 已提交
550 551 552 553 554
	iotable_init(lubbock_io_desc, ARRAY_SIZE(lubbock_io_desc));

	PCFR |= PCFR_OPDE;
}

B
Bryan Wu 已提交
555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646
/*
 * Driver for the 8 discrete LEDs available for general use:
 * Note: bits [15-8] are used to enable/blank the 8 7 segment hex displays
 * so be sure to not monkey with them here.
 */

#if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS)
struct lubbock_led {
	struct led_classdev	cdev;
	u8			mask;
};

/*
 * The triggers lines up below will only be used if the
 * LED triggers are compiled in.
 */
static const struct {
	const char *name;
	const char *trigger;
} lubbock_leds[] = {
	{ "lubbock:D28", "default-on", },
	{ "lubbock:D27", "cpu0", },
	{ "lubbock:D26", "heartbeat" },
	{ "lubbock:D25", },
	{ "lubbock:D24", },
	{ "lubbock:D23", },
	{ "lubbock:D22", },
	{ "lubbock:D21", },
};

static void lubbock_led_set(struct led_classdev *cdev,
			      enum led_brightness b)
{
	struct lubbock_led *led = container_of(cdev,
					 struct lubbock_led, cdev);
	u32 reg = LUB_DISC_BLNK_LED;

	if (b != LED_OFF)
		reg |= led->mask;
	else
		reg &= ~led->mask;

	LUB_DISC_BLNK_LED = reg;
}

static enum led_brightness lubbock_led_get(struct led_classdev *cdev)
{
	struct lubbock_led *led = container_of(cdev,
					 struct lubbock_led, cdev);
	u32 reg = LUB_DISC_BLNK_LED;

	return (reg & led->mask) ? LED_FULL : LED_OFF;
}

static int __init lubbock_leds_init(void)
{
	int i;

	if (!machine_is_lubbock())
		return -ENODEV;

	/* All ON */
	LUB_DISC_BLNK_LED |= 0xff;
	for (i = 0; i < ARRAY_SIZE(lubbock_leds); i++) {
		struct lubbock_led *led;

		led = kzalloc(sizeof(*led), GFP_KERNEL);
		if (!led)
			break;

		led->cdev.name = lubbock_leds[i].name;
		led->cdev.brightness_set = lubbock_led_set;
		led->cdev.brightness_get = lubbock_led_get;
		led->cdev.default_trigger = lubbock_leds[i].trigger;
		led->mask = BIT(i);

		if (led_classdev_register(NULL, &led->cdev) < 0) {
			kfree(led);
			break;
		}
	}

	return 0;
}

/*
 * Since we may have triggers on any subsystem, defer registration
 * until after subsystem_init.
 */
fs_initcall(lubbock_leds_init);
#endif

L
Linus Torvalds 已提交
647
MACHINE_START(LUBBOCK, "Intel DBPXA250 Development Platform (aka Lubbock)")
648 649
	/* Maintainer: MontaVista Software Inc. */
	.map_io		= lubbock_map_io,
650
	.nr_irqs	= LUBBOCK_NR_IRQS,
651
	.init_irq	= lubbock_init_irq,
652
	.handle_irq	= pxa25x_handle_irq,
L
Linus Torvalds 已提交
653
	.timer		= &pxa_timer,
654
	.init_machine	= lubbock_init,
655
	.restart	= pxa_restart,
L
Linus Torvalds 已提交
656
MACHINE_END