624 lines
14 KiB
C
624 lines
14 KiB
C
|
/*
|
||
|
* 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.
|
||
|
*/
|
||
|
#include <linux/clkdev.h>
|
||
|
#include <linux/gpio.h>
|
||
|
#include <linux/gpio/machine.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/io.h>
|
||
|
#include <linux/platform_device.h>
|
||
|
#include <linux/syscore_ops.h>
|
||
|
#include <linux/major.h>
|
||
|
#include <linux/fb.h>
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/mtd/mtd.h>
|
||
|
#include <linux/mtd/partitions.h>
|
||
|
#include <linux/smc91x.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/leds.h>
|
||
|
|
||
|
#include <linux/spi/spi.h>
|
||
|
#include <linux/spi/ads7846.h>
|
||
|
#include <linux/spi/pxa2xx_spi.h>
|
||
|
|
||
|
#include <asm/setup.h>
|
||
|
#include <asm/memory.h>
|
||
|
#include <asm/mach-types.h>
|
||
|
#include <mach/hardware.h>
|
||
|
#include <asm/irq.h>
|
||
|
#include <asm/sizes.h>
|
||
|
|
||
|
#include <asm/mach/arch.h>
|
||
|
#include <asm/mach/map.h>
|
||
|
#include <asm/mach/irq.h>
|
||
|
#include <asm/mach/flash.h>
|
||
|
|
||
|
#include <asm/hardware/sa1111.h>
|
||
|
|
||
|
#include "pxa25x.h"
|
||
|
#include <mach/audio.h>
|
||
|
#include <mach/lubbock.h>
|
||
|
#include "udc.h"
|
||
|
#include <linux/platform_data/irda-pxaficp.h>
|
||
|
#include <linux/platform_data/video-pxafb.h>
|
||
|
#include <linux/platform_data/mmc-pxamci.h>
|
||
|
#include "pm.h"
|
||
|
#include <mach/smemc.h>
|
||
|
|
||
|
#include "generic.h"
|
||
|
#include "devices.h"
|
||
|
|
||
|
static unsigned long lubbock_pin_config[] __initdata = {
|
||
|
GPIO15_nCS_1, /* CS1 - Flash */
|
||
|
GPIO78_nCS_2, /* CS2 - Baseboard FGPA */
|
||
|
GPIO79_nCS_3, /* CS3 - SMC ethernet */
|
||
|
GPIO80_nCS_4, /* CS4 - SA1111 */
|
||
|
|
||
|
/* SSP data pins */
|
||
|
GPIO23_SSP1_SCLK,
|
||
|
GPIO25_SSP1_TXD,
|
||
|
GPIO26_SSP1_RXD,
|
||
|
|
||
|
/* AC97 */
|
||
|
GPIO28_AC97_BITCLK,
|
||
|
GPIO29_AC97_SDATA_IN_0,
|
||
|
GPIO30_AC97_SDATA_OUT,
|
||
|
GPIO31_AC97_SYNC,
|
||
|
|
||
|
/* LCD - 16bpp DSTN */
|
||
|
GPIOxx_LCD_DSTN_16BPP,
|
||
|
|
||
|
/* 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,
|
||
|
|
||
|
/* SA1111 chip */
|
||
|
GPIO11_3_6MHz,
|
||
|
|
||
|
/* wakeup */
|
||
|
GPIO1_GPIO | WAKEUP_ON_EDGE_RISE,
|
||
|
};
|
||
|
|
||
|
#define LUB_HEXLED __LUB_REG(LUBBOCK_FPGA_PHYS + 0x010)
|
||
|
#define LUB_MISC_WR __LUB_REG(LUBBOCK_FPGA_PHYS + 0x080)
|
||
|
|
||
|
void lubbock_set_hexled(uint32_t value)
|
||
|
{
|
||
|
LUB_HEXLED = value;
|
||
|
}
|
||
|
|
||
|
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 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 void lubbock_init_pcmcia(void)
|
||
|
{
|
||
|
struct clk *clk;
|
||
|
|
||
|
/* Add an alias for the SA1111 PCMCIA clock */
|
||
|
clk = clk_get_sys("pxa2xx-pcmcia", NULL);
|
||
|
if (!IS_ERR(clk)) {
|
||
|
clkdev_create(clk, NULL, "1800");
|
||
|
clk_put(clk);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
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,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static struct sa1111_platform_data sa1111_info = {
|
||
|
.irq_base = LUBBOCK_SA1111_IRQ_BASE,
|
||
|
.disable_devs = SA1111_DEVID_SAC,
|
||
|
};
|
||
|
|
||
|
static struct platform_device sa1111_device = {
|
||
|
.name = "sa1111",
|
||
|
.id = -1,
|
||
|
.num_resources = ARRAY_SIZE(sa1111_resources),
|
||
|
.resource = sa1111_resources,
|
||
|
.dev = {
|
||
|
.platform_data = &sa1111_info,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
/* 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 = {
|
||
|
.num_chipselect = 1,
|
||
|
};
|
||
|
|
||
|
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,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
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,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static struct smc91x_platdata lubbock_smc91x_info = {
|
||
|
.flags = SMC91X_USE_16BIT | SMC91X_NOWAIT | SMC91X_IO_SHIFT_2,
|
||
|
};
|
||
|
|
||
|
static struct platform_device smc91x_device = {
|
||
|
.name = "smc91x",
|
||
|
.id = -1,
|
||
|
.num_resources = ARRAY_SIZE(smc91x_resources),
|
||
|
.resource = smc91x_resources,
|
||
|
.dev = {
|
||
|
.platform_data = &lubbock_smc91x_info,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
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,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static struct resource lubbock_cplds_resources[] = {
|
||
|
[0] = {
|
||
|
.start = LUBBOCK_FPGA_PHYS + 0xc0,
|
||
|
.end = LUBBOCK_FPGA_PHYS + 0xe0 - 1,
|
||
|
.flags = IORESOURCE_MEM,
|
||
|
},
|
||
|
[1] = {
|
||
|
.start = PXA_GPIO_TO_IRQ(0),
|
||
|
.end = PXA_GPIO_TO_IRQ(0),
|
||
|
.flags = IORESOURCE_IRQ | IORESOURCE_IRQ_LOWEDGE,
|
||
|
},
|
||
|
[2] = {
|
||
|
.start = LUBBOCK_IRQ(0),
|
||
|
.end = LUBBOCK_IRQ(6),
|
||
|
.flags = IORESOURCE_IRQ,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static struct platform_device lubbock_cplds_device = {
|
||
|
.name = "pxa_cplds_irqs",
|
||
|
.id = -1,
|
||
|
.resource = &lubbock_cplds_resources[0],
|
||
|
.num_resources = 3,
|
||
|
};
|
||
|
|
||
|
|
||
|
static struct platform_device *devices[] __initdata = {
|
||
|
&sa1111_device,
|
||
|
&smc91x_device,
|
||
|
&lubbock_flash_device[0],
|
||
|
&lubbock_flash_device[1],
|
||
|
&lubbock_cplds_device,
|
||
|
};
|
||
|
|
||
|
static struct pxafb_mode_info sharp_lm8v31_mode = {
|
||
|
.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,
|
||
|
};
|
||
|
|
||
|
static struct pxafb_mach_info sharp_lm8v31 = {
|
||
|
.modes = &sharp_lm8v31_mode,
|
||
|
.num_modes = 1,
|
||
|
.cmap_inverse = 0,
|
||
|
.cmap_static = 0,
|
||
|
.lcd_conn = LCD_COLOR_DSTN_16BPP | LCD_PCLK_EDGE_FALL |
|
||
|
LCD_AC_BIAS_FREQ(255),
|
||
|
};
|
||
|
|
||
|
#define MMC_POLL_RATE msecs_to_jiffies(1000)
|
||
|
|
||
|
static void lubbock_mmc_poll(unsigned long);
|
||
|
static irq_handler_t mmc_detect_int;
|
||
|
|
||
|
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 {
|
||
|
(void) mmc_detect_int(LUBBOCK_SD_IRQ, (void *)data);
|
||
|
enable_irq(LUBBOCK_SD_IRQ);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static irqreturn_t lubbock_detect_int(int irq, void *data)
|
||
|
{
|
||
|
/* IRQ is level triggered; disable, and poll for removal */
|
||
|
disable_irq(irq);
|
||
|
mod_timer(&mmc_timer, jiffies + MMC_POLL_RATE);
|
||
|
|
||
|
return mmc_detect_int(irq, data);
|
||
|
}
|
||
|
|
||
|
static int lubbock_mci_init(struct device *dev,
|
||
|
irq_handler_t detect_int,
|
||
|
void *data)
|
||
|
{
|
||
|
/* 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,
|
||
|
0, "lubbock-sd-detect", data);
|
||
|
}
|
||
|
|
||
|
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);
|
||
|
}
|
||
|
|
||
|
static struct pxamci_platform_data lubbock_mci_platform_data = {
|
||
|
.ocr_mask = MMC_VDD_32_33|MMC_VDD_33_34,
|
||
|
.detect_delay_ms = 10,
|
||
|
.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,
|
||
|
};
|
||
|
|
||
|
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;
|
||
|
}
|
||
|
pxa2xx_transceiver_mode(dev, mode);
|
||
|
local_irq_restore(flags);
|
||
|
}
|
||
|
|
||
|
static struct pxaficp_platform_data lubbock_ficp_platform_data = {
|
||
|
.gpio_pwdown = -1,
|
||
|
.transceiver_cap = IR_SIRMODE | IR_FIRMODE,
|
||
|
.transceiver_mode = lubbock_irda_transceiver_mode,
|
||
|
};
|
||
|
|
||
|
static void __init lubbock_init(void)
|
||
|
{
|
||
|
int flashboot = (LUB_CONF_SWITCHES & 1);
|
||
|
|
||
|
pxa2xx_mfp_config(ARRAY_AND_SIZE(lubbock_pin_config));
|
||
|
|
||
|
pxa_set_ffuart_info(NULL);
|
||
|
pxa_set_btuart_info(NULL);
|
||
|
pxa_set_stuart_info(NULL);
|
||
|
|
||
|
lubbock_init_pcmcia();
|
||
|
|
||
|
clk_add_alias("SA1111_CLK", NULL, "GPIO11_CLK", NULL);
|
||
|
pxa_set_udc_info(&udc_info);
|
||
|
pxa_set_fb_info(NULL, &sharp_lm8v31);
|
||
|
pxa_set_mci_info(&lubbock_mci_platform_data);
|
||
|
pxa_set_ficp_info(&lubbock_ficp_platform_data);
|
||
|
pxa_set_ac97_info(NULL);
|
||
|
|
||
|
lubbock_flash_data[0].width = lubbock_flash_data[1].width =
|
||
|
(__raw_readl(BOOT_DEF) & 1) ? 2 : 4;
|
||
|
/* 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";
|
||
|
(void) platform_add_devices(devices, ARRAY_SIZE(devices));
|
||
|
|
||
|
pxa2xx_set_spi_info(1, &pxa_ssp_master_info);
|
||
|
spi_register_board_info(spi_board_info, ARRAY_SIZE(spi_board_info));
|
||
|
}
|
||
|
|
||
|
static struct map_desc lubbock_io_desc[] __initdata = {
|
||
|
{ /* CPLD */
|
||
|
.virtual = LUBBOCK_FPGA_VIRT,
|
||
|
.pfn = __phys_to_pfn(LUBBOCK_FPGA_PHYS),
|
||
|
.length = 0x00100000,
|
||
|
.type = MT_DEVICE
|
||
|
}
|
||
|
};
|
||
|
|
||
|
static void __init lubbock_map_io(void)
|
||
|
{
|
||
|
pxa25x_map_io();
|
||
|
iotable_init(lubbock_io_desc, ARRAY_SIZE(lubbock_io_desc));
|
||
|
|
||
|
PCFR |= PCFR_OPDE;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* 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
|
||
|
|
||
|
MACHINE_START(LUBBOCK, "Intel DBPXA250 Development Platform (aka Lubbock)")
|
||
|
/* Maintainer: MontaVista Software Inc. */
|
||
|
.map_io = lubbock_map_io,
|
||
|
.nr_irqs = LUBBOCK_NR_IRQS,
|
||
|
.init_irq = pxa25x_init_irq,
|
||
|
.handle_irq = pxa25x_handle_irq,
|
||
|
.init_time = pxa_timer_init,
|
||
|
.init_machine = lubbock_init,
|
||
|
.restart = pxa_restart,
|
||
|
MACHINE_END
|