mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-20 10:44:23 +08:00
a1c0a6adbc
Transition the PXA25x, PXA27x and PXA3xx CPUs to the clock framework. This transition still enables legacy platforms to run without device tree as before, ie relying on platform data encoded in board specific files. This is the last step of clock framework transition for pxa platforms. It was tested on lubbock (pxa25x), mioa701 (pxa27x) and zylonite (pxa3xx). Signed-off-by: Robert Jarzmik <robert.jarzmik@free.fr>
659 lines
15 KiB
C
659 lines
15 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/gpio.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 <mach/pxa25x.h>
|
|
#include <mach/audio.h>
|
|
#include <mach/lubbock.h>
|
|
#include <mach/udc.h>
|
|
#include <linux/platform_data/irda-pxaficp.h>
|
|
#include <linux/platform_data/video-pxafb.h>
|
|
#include <linux/platform_data/mmc-pxamci.h>
|
|
#include <mach/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 unsigned long lubbock_irq_enabled;
|
|
|
|
static void lubbock_mask_irq(struct irq_data *d)
|
|
{
|
|
int lubbock_irq = (d->irq - LUBBOCK_IRQ(0));
|
|
LUB_IRQ_MASK_EN = (lubbock_irq_enabled &= ~(1 << lubbock_irq));
|
|
}
|
|
|
|
static void lubbock_unmask_irq(struct irq_data *d)
|
|
{
|
|
int lubbock_irq = (d->irq - LUBBOCK_IRQ(0));
|
|
/* 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));
|
|
}
|
|
|
|
static struct irq_chip lubbock_irq_chip = {
|
|
.name = "FPGA",
|
|
.irq_ack = lubbock_mask_irq,
|
|
.irq_mask = lubbock_mask_irq,
|
|
.irq_unmask = lubbock_unmask_irq,
|
|
};
|
|
|
|
static void lubbock_irq_handler(unsigned int irq, struct irq_desc *desc)
|
|
{
|
|
unsigned long pending = LUB_IRQ_SET_CLR & lubbock_irq_enabled;
|
|
do {
|
|
/* clear our parent irq */
|
|
desc->irq_data.chip->irq_ack(&desc->irq_data);
|
|
if (likely(pending)) {
|
|
irq = LUBBOCK_IRQ(0) + __ffs(pending);
|
|
generic_handle_irq(irq);
|
|
}
|
|
pending = LUB_IRQ_SET_CLR & lubbock_irq_enabled;
|
|
} while (pending);
|
|
}
|
|
|
|
static void __init lubbock_init_irq(void)
|
|
{
|
|
int irq;
|
|
|
|
pxa25x_init_irq();
|
|
|
|
/* setup extra lubbock irqs */
|
|
for (irq = LUBBOCK_IRQ(0); irq <= LUBBOCK_LAST_IRQ; irq++) {
|
|
irq_set_chip_and_handler(irq, &lubbock_irq_chip,
|
|
handle_level_irq);
|
|
set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
|
|
static void lubbock_irq_resume(void)
|
|
{
|
|
LUB_IRQ_MASK_EN = lubbock_irq_enabled;
|
|
}
|
|
|
|
static struct syscore_ops lubbock_irq_syscore_ops = {
|
|
.resume = lubbock_irq_resume,
|
|
};
|
|
|
|
static int __init lubbock_irq_device_init(void)
|
|
{
|
|
if (machine_is_lubbock()) {
|
|
register_syscore_ops(&lubbock_irq_syscore_ops);
|
|
return 0;
|
|
}
|
|
return -ENODEV;
|
|
}
|
|
|
|
device_initcall(lubbock_irq_device_init);
|
|
|
|
#endif
|
|
|
|
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,
|
|
},
|
|
};
|
|
|
|
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 platform_device *devices[] __initdata = {
|
|
&sa1111_device,
|
|
&smc91x_device,
|
|
&lubbock_flash_device[0],
|
|
&lubbock_flash_device[1],
|
|
};
|
|
|
|
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);
|
|
|
|
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 = lubbock_init_irq,
|
|
.handle_irq = pxa25x_handle_irq,
|
|
.init_time = pxa_timer_init,
|
|
.init_machine = lubbock_init,
|
|
.restart = pxa_restart,
|
|
MACHINE_END
|