From e690b9d312ea684170aeb6e92e6b025be95e51d9 Mon Sep 17 00:00:00 2001 From: lars Date: Tue, 13 Apr 2010 20:52:41 +0000 Subject: [PATCH] [mx2] vp6500: Add backlight device git-svn-id: svn://svn.openwrt.org/openwrt/trunk@20843 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- .../mx2/files/arch/arm/mach-mx2/mach-vp6500.c | 40 +++++- .../arch/arm/plat-mxc/include/mach/board-vp6500.h | 18 +-- target/linux/mx2/patches-2.6.34/040-pwm.patch | 137 +++++++++++++++++++++ 3 files changed, 187 insertions(+), 8 deletions(-) create mode 100644 target/linux/mx2/patches-2.6.34/040-pwm.patch diff --git a/target/linux/mx2/files/arch/arm/mach-mx2/mach-vp6500.c b/target/linux/mx2/files/arch/arm/mach-mx2/mach-vp6500.c index 4ca5c0fd9a..fb4464eb8e 100644 --- a/target/linux/mx2/files/arch/arm/mach-mx2/mach-vp6500.c +++ b/target/linux/mx2/files/arch/arm/mach-mx2/mach-vp6500.c @@ -20,9 +20,9 @@ #include #include #include +#include static unsigned int vp6500_pins[] = { - /* UART1 */ PE12_PF_UART1_TXD, PE13_PF_UART1_RXD, @@ -52,8 +52,14 @@ static unsigned int vp6500_pins[] = { PA30_PF_CONTRAST, PA31_PF_OE_ACD, #endif + + /* LCD Backlight */ + PE5_PF_PWMO, + VP6500_GPIO_BACKLIGHT_EN | GPIO_GPIO | GPIO_OUT, }; +/* Flash */ + static struct physmap_flash_data vp6500_flash_data = { .width = 2, }; @@ -74,6 +80,8 @@ static struct platform_device vp6500_nor_mtd_device = { .resource = &vp6500_flash_resource, }; +/* LEDs */ + static struct gpio_led vp6500_leds[] = { { .name = "vp6500:orange:keypad", @@ -108,6 +116,8 @@ static struct platform_device vp6500_leds_device = { }, }; +/* Keypad */ + static const uint32_t vp6500_keypad_keys[] = { KEY(0, 3, KEY_F2), KEY(0, 4, KEY_RIGHT), @@ -180,11 +190,38 @@ static struct platform_device vp6500_key_device = { }, }; +/* LCD backlight */ + +static int vp6500_backlight_notify(struct device *dev, int brightness) +{ + gpio_set_value(VP6500_GPIO_BACKLIGHT_EN, !!brightness); + + return brightness; +} + +static struct platform_pwm_backlight_data vp6500_backlight_data = { + .max_brightness = 255, + .dft_brightness = 100, + .pwm_period_ns = 15000000, + .notify = vp6500_backlight_notify, +}; + +static struct platform_device vp6500_backlight_device = { + .name = "pwm-backlight", + .id = -1, + .dev = { + .parent = &mxc_pwm_device.dev, + .platform_data = &vp6500_backlight_data, + }, +}; + + static struct platform_device *platform_devices[] __initdata = { &vp6500_nor_mtd_device, &vp6500_leds_device, &vp6500_keypad_device, &vp6500_key_device, + &vp6500_backlight_device, }; static void __init vp6500_board_init(void) @@ -193,6 +230,7 @@ static void __init vp6500_board_init(void) "vp6500"); mxc_register_device(&mxc_uart_device0, NULL); + mxc_register_device(&mxc_pwm_device, NULL); platform_add_devices(platform_devices, ARRAY_SIZE(platform_devices)); } diff --git a/target/linux/mx2/files/arch/arm/plat-mxc/include/mach/board-vp6500.h b/target/linux/mx2/files/arch/arm/plat-mxc/include/mach/board-vp6500.h index 700f9c101b..c11d053a5c 100644 --- a/target/linux/mx2/files/arch/arm/plat-mxc/include/mach/board-vp6500.h +++ b/target/linux/mx2/files/arch/arm/plat-mxc/include/mach/board-vp6500.h @@ -2,12 +2,16 @@ #ifndef __BOARD_VP6500__ #define __BOARD_VP6500__ -#define VP6500_GPIO_POWER_KEY 39 -#define VP6500_GPIO_CAMERA_DIRECTION 45 -#define VP6500_GPIO_LED_KEYPAD 82 -#define VP6500_GPIO_AMP_ENABLE 89 -#define VP6500_GPIO_LED_RED 91 -#define VP6500_GPIO_LED_GREEN 92 -#define VP6500_GPIO_LED_CAMERA 93 +#define VP6500_GPIO_POWER_KEY GPIO_PORTB | 5 +#define VP6500_GPIO_CAMERA_DIRECTION GPIO_PORTB | 13 +#define VP6500_GPIO_LED_KEYPAD GPIO_PORTC | 18 +#define VP6500_GPIO_AMP_ENABLE GPIO_PORTC | 25 +#define VP6500_GPIO_LED_RED GPIO_PORTC | 27 +#define VP6500_GPIO_LED_GREEN GPIO_PORTC | 28 +#define VP6500_GPIO_LED_CAMERA GPIO_PORTC | 29 +#define VP6500_GPIO_BACKLIGHT_EN GPIO_PORTE | 10 + +#define VP6500_GPIO_TLV_RESET GPIO_PORTB | 27 +#define VP6500_GPIO_TLV_ENABLE GPIO_PORTC | 25 #endif diff --git a/target/linux/mx2/patches-2.6.34/040-pwm.patch b/target/linux/mx2/patches-2.6.34/040-pwm.patch new file mode 100644 index 0000000000..55e846ec17 --- /dev/null +++ b/target/linux/mx2/patches-2.6.34/040-pwm.patch @@ -0,0 +1,137 @@ +diff --git a/arch/arm/plat-mxc/pwm.c b/arch/arm/plat-mxc/pwm.c +index c36f263..acc5dc1 100644 +--- a/arch/arm/plat-mxc/pwm.c ++++ b/arch/arm/plat-mxc/pwm.c +@@ -25,6 +25,11 @@ + #define MX1_PWMS 0x04 /* PWM Sample Register */ + #define MX1_PWMP 0x08 /* PWM Period Register */ + ++#define MX1_PWMC_EN (1 << 4) ++#define MX1_PWMC_PRESCALER_MASK (0x7f << 8) ++#define MX1_PWMC_PRESCALER(x) ((x & 0x7f) << 8) ++#define MX1_PWMC_CLKSEL_MASK 0x3 ++#define MX1_PWMC_CLKSEL(x) ((x & 0x3)) + + /* i.MX27, i.MX31, i.MX35 share the same PWM function block: */ + +@@ -54,25 +59,32 @@ struct pwm_device { + + int pwm_config(struct pwm_device *pwm, int duty_ns, int period_ns) + { ++ unsigned long long c; ++ unsigned long period_cycles, duty_cycles, prescale; ++ + if (pwm == NULL || period_ns == 0 || duty_ns > period_ns) + return -EINVAL; + +- if (cpu_is_mx27() || cpu_is_mx3() || cpu_is_mx25()) { +- unsigned long long c; +- unsigned long period_cycles, duty_cycles, prescale; +- u32 cr; ++ c = clk_get_rate(pwm->clk); ++ ++ c = c * period_ns; ++ ++ if (cpu_is_mx1() || cpu_is_mx2()) ++ c >>= 1; + +- c = clk_get_rate(pwm->clk); +- c = c * period_ns; +- do_div(c, 1000000000); +- period_cycles = c; ++ do_div(c, 1000000000); ++ period_cycles = c; + +- prescale = period_cycles / 0x10000 + 1; ++ prescale = period_cycles / 0x10000 + 1; + +- period_cycles /= prescale; +- c = (unsigned long long)period_cycles * duty_ns; +- do_div(c, period_ns); +- duty_cycles = c; ++ period_cycles /= prescale; ++ c = (unsigned long long)period_cycles * duty_ns; ++ do_div(c, period_ns); ++ duty_cycles = c; ++ ++ ++ if (cpu_is_mx27() || cpu_is_mx3() || cpu_is_mx25()) { ++ u32 cr; + + writel(duty_cycles, pwm->mmio_base + MX3_PWMSAR); + writel(period_cycles, pwm->mmio_base + MX3_PWMPR); +@@ -86,25 +98,28 @@ int pwm_config(struct pwm_device *pwm, int duty_ns, int period_ns) + + writel(cr, pwm->mmio_base + MX3_PWMCR); + } else if (cpu_is_mx1() || cpu_is_mx21()) { +- /* The PWM subsystem allows for exact frequencies. However, +- * I cannot connect a scope on my device to the PWM line and +- * thus cannot provide the program the PWM controller +- * exactly. Instead, I'm relying on the fact that the +- * Bootloader (u-boot or WinCE+haret) has programmed the PWM +- * function group already. So I'll just modify the PWM sample +- * register to follow the ratio of duty_ns vs. period_ns +- * accordingly. +- * +- * This is good enough for programming the brightness of +- * the LCD backlight. +- * +- * The real implementation would divide PERCLK[0] first by +- * both the prescaler (/1 .. /128) and then by CLKSEL +- * (/2 .. /16). +- */ +- u32 max = readl(pwm->mmio_base + MX1_PWMP); +- u32 p = max * duty_ns / period_ns; +- writel(max - p, pwm->mmio_base + MX1_PWMS); ++ unsigned long clksel = 0; ++ u32 ctrl; ++ ++ while (prescale >= 0x80 && clksel < 4) { ++ prescale >>= 1; ++ ++clksel; ++ } ++ ++ if (clksel > 3) ++ return -EINVAL; ++ ++ ctrl = readl(pwm->mmio_base + MX1_PWMC); ++ writel(ctrl & ~MX1_PWMC_EN, pwm->mmio_base + MX1_PWMC); ++ ++ writel(duty_cycles, pwm->mmio_base + MX1_PWMS); ++ writel(period_cycles, pwm->mmio_base + MX1_PWMP); ++ ++ ctrl &= ~(MX1_PWMC_PRESCALER_MASK | MX1_PWMC_CLKSEL_MASK); ++ ctrl |= MX1_PWMC_PRESCALER(prescale); ++ ctrl |= MX1_PWMC_CLKSEL(clksel); ++ writel(ctrl, pwm->mmio_base + MX1_PWMC); ++ + } else { + BUG(); + } +@@ -116,6 +130,11 @@ EXPORT_SYMBOL(pwm_config); + int pwm_enable(struct pwm_device *pwm) + { + int rc = 0; ++ if (cpu_is_mx1() || cpu_is_mx2()) { ++ u32 ctrl; ++ ctrl = readl(pwm->mmio_base + MX1_PWMC); ++ writel(ctrl | MX1_PWMC_EN, pwm->mmio_base + MX1_PWMC); ++ } + + if (!pwm->clk_enabled) { + rc = clk_enable(pwm->clk); +@@ -128,7 +147,13 @@ EXPORT_SYMBOL(pwm_enable); + + void pwm_disable(struct pwm_device *pwm) + { +- writel(0, pwm->mmio_base + MX3_PWMCR); ++ if (cpu_is_mx27() || cpu_is_mx3() || cpu_is_mx25()) { ++ writel(0, pwm->mmio_base + MX3_PWMCR); ++ } else if (cpu_is_mx1() || cpu_is_mx2()) { ++ u32 ctrl; ++ ctrl = readl(pwm->mmio_base + MX1_PWMC); ++ writel(ctrl & ~MX1_PWMC_EN, pwm->mmio_base + MX1_PWMC); ++ } + + if (pwm->clk_enabled) { + clk_disable(pwm->clk); -- 2.11.0