[linux-2.6-block.git] / drivers / video / backlight / locomolcd.c

/*
 * Backlight control code for Sharp Zaurus SL-5500
 *
 * Copyright 2005 John Lenz <lenz@cs.wisc.edu>
 * Maintainer: Pavel Machek <pavel@suse.cz> (unless John wants to :-)
 * GPL v2
 *
 * This driver assumes single CPU. That's okay, because collie is
 * slightly old hardware, and noone is going to retrofit second CPU to
 * old PDA.
 */

/* LCD power functions */
#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/interrupt.h>
#include <linux/fb.h>
#include <linux/backlight.h>

#include <asm/hardware/locomo.h>
#include <asm/irq.h>
#include <asm/mach/sharpsl_param.h>
#include <asm/mach-types.h>

#include "../../../arch/arm/mach-sa1100/generic.h"

static struct backlight_device *locomolcd_bl_device;
static struct locomo_dev *locomolcd_dev;
static unsigned long locomolcd_flags;
#define LOCOMOLCD_SUSPENDED     0x01

static void locomolcd_on(int comadj)
{
	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 1);
	mdelay(2);

	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 1);
	mdelay(2);

	locomo_m62332_senddata(locomolcd_dev, comadj, 0);
	mdelay(5);

	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 1);
	mdelay(10);

	/* TFTCRST | CPSOUT=0 | CPSEN */
	locomo_writel(0x01, locomolcd_dev->mapbase + LOCOMO_TC);

	/* Set CPSD */
	locomo_writel(6, locomolcd_dev->mapbase + LOCOMO_CPSD);

	/* TFTCRST | CPSOUT=0 | CPSEN */
	locomo_writel((0x04 | 0x01), locomolcd_dev->mapbase + LOCOMO_TC);
	mdelay(10);

	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 1);
}

static void locomolcd_off(int comadj)
{
	/* TFTCRST=1 | CPSOUT=1 | CPSEN = 0 */
	locomo_writel(0x06, locomolcd_dev->mapbase + LOCOMO_TC);
	mdelay(1);

	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
	mdelay(110);

	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
	mdelay(700);

	/* TFTCRST=0 | CPSOUT=0 | CPSEN = 0 */
	locomo_writel(0, locomolcd_dev->mapbase + LOCOMO_TC);
	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
}

void locomolcd_power(int on)
{
	int comadj = sharpsl_param.comadj;
	unsigned long flags;

	local_irq_save(flags);

	if (!locomolcd_dev) {
		local_irq_restore(flags);
		return;
	}

	/* read comadj */
	if (comadj == -1 && machine_is_collie())
		comadj = 128;
	if (comadj == -1 && machine_is_poodle())
		comadj = 118;

	if (on)
		locomolcd_on(comadj);
	else
		locomolcd_off(comadj);

	local_irq_restore(flags);
}
EXPORT_SYMBOL(locomolcd_power);


static int current_intensity;

static int locomolcd_set_intensity(struct backlight_device *bd)
{
	int intensity = bd->props.brightness;

	if (bd->props.power != FB_BLANK_UNBLANK)
		intensity = 0;
	if (bd->props.fb_blank != FB_BLANK_UNBLANK)
		intensity = 0;
	if (locomolcd_flags & LOCOMOLCD_SUSPENDED)
		intensity = 0;

	switch (intensity) {
	/* AC and non-AC are handled differently, but produce same results in sharp code? */
	case 0: locomo_frontlight_set(locomolcd_dev, 0, 0, 161); break;
	case 1: locomo_frontlight_set(locomolcd_dev, 117, 0, 161); break;
	case 2: locomo_frontlight_set(locomolcd_dev, 163, 0, 148); break;
	case 3: locomo_frontlight_set(locomolcd_dev, 194, 0, 161); break;
	case 4: locomo_frontlight_set(locomolcd_dev, 194, 1, 161); break;

	default:
		return -ENODEV;
	}
	current_intensity = intensity;
	return 0;
}

static int locomolcd_get_intensity(struct backlight_device *bd)
{
	return current_intensity;
}

static const struct backlight_ops locomobl_data = {
	.get_brightness = locomolcd_get_intensity,
	.update_status  = locomolcd_set_intensity,
};

#ifdef CONFIG_PM
static int locomolcd_suspend(struct locomo_dev *dev, pm_message_t state)
{
	locomolcd_flags |= LOCOMOLCD_SUSPENDED;
	locomolcd_set_intensity(locomolcd_bl_device);
	return 0;
}

static int locomolcd_resume(struct locomo_dev *dev)
{
	locomolcd_flags &= ~LOCOMOLCD_SUSPENDED;
	locomolcd_set_intensity(locomolcd_bl_device);
	return 0;
}
#else
#define locomolcd_suspend	NULL
#define locomolcd_resume	NULL
#endif

static int locomolcd_probe(struct locomo_dev *ldev)
{
	unsigned long flags;

	local_irq_save(flags);
	locomolcd_dev = ldev;

	locomo_gpio_set_dir(ldev->dev.parent, LOCOMO_GPIO_FL_VR, 0);

	/* the poodle_lcd_power function is called for the first time
	 * from fs_initcall, which is before locomo is activated.
	 * We need to recall poodle_lcd_power here*/
	if (machine_is_poodle())
		locomolcd_power(1);

	local_irq_restore(flags);

	locomolcd_bl_device = backlight_device_register("locomo-bl", &ldev->dev, NULL, &locomobl_data);

	if (IS_ERR (locomolcd_bl_device))
		return PTR_ERR (locomolcd_bl_device);

	/* Set up frontlight so that screen is readable */
	locomolcd_bl_device->props.max_brightness = 4,
	locomolcd_bl_device->props.brightness = 2;
	locomolcd_set_intensity(locomolcd_bl_device);

	return 0;
}

static int locomolcd_remove(struct locomo_dev *dev)
{
	unsigned long flags;

	locomolcd_bl_device->props.brightness = 0;
	locomolcd_bl_device->props.power = 0;
	locomolcd_set_intensity(locomolcd_bl_device);

	backlight_device_unregister(locomolcd_bl_device);
	local_irq_save(flags);
	locomolcd_dev = NULL;
	local_irq_restore(flags);
	return 0;
}

static struct locomo_driver poodle_lcd_driver = {
	.drv = {
		.name = "locomo-backlight",
	},
	.devid	= LOCOMO_DEVID_BACKLIGHT,
	.probe	= locomolcd_probe,
	.remove	= locomolcd_remove,
	.suspend = locomolcd_suspend,
	.resume = locomolcd_resume,
};


static int __init locomolcd_init(void)
{
	int ret = locomo_driver_register(&poodle_lcd_driver);
	if (ret)
		return ret;

#ifdef CONFIG_SA1100_COLLIE
	sa1100fb_lcd_power = locomolcd_power;
#endif
	return 0;
}

static void __exit locomolcd_exit(void)
{
	locomo_driver_unregister(&poodle_lcd_driver);
}

module_init(locomolcd_init);
module_exit(locomolcd_exit);

MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>, Pavel Machek <pavel@suse.cz>");
MODULE_DESCRIPTION("Collie LCD driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
987132bb PM	1	/*
	2	* Backlight control code for Sharp Zaurus SL-5500
	3	*
	4	* Copyright 2005 John Lenz <lenz@cs.wisc.edu>
	5	* Maintainer: Pavel Machek <pavel@suse.cz> (unless John wants to :-)
	6	* GPL v2
	7	*
	8	* This driver assumes single CPU. That's okay, because collie is
	9	* slightly old hardware, and noone is going to retrofit second CPU to
	10	* old PDA.
	11	*/
	12
	13	/* LCD power functions */
987132bb PM	14	#include <linux/module.h>
	15	#include <linux/init.h>
	16	#include <linux/delay.h>
	17	#include <linux/device.h>
	18	#include <linux/interrupt.h>
e4423781 RP	19	#include <linux/fb.h>
e4423781 RP	20	#include <linux/backlight.h>
987132bb PM	21
	22	#include <asm/hardware/locomo.h>
	23	#include <asm/irq.h>
36a95bf5 PM	24	#include <asm/mach/sharpsl_param.h>
36a95bf5 PM	25	#include <asm/mach-types.h>
987132bb	26
36a95bf5	27	#include "../../../arch/arm/mach-sa1100/generic.h"
987132bb	28
e4423781	29	static struct backlight_device *locomolcd_bl_device;
987132bb	30	static struct locomo_dev *locomolcd_dev;
e4423781 RP	31	static unsigned long locomolcd_flags;
e4423781 RP	32	#define LOCOMOLCD_SUSPENDED 0x01
987132bb PM	33
	34	static void locomolcd_on(int comadj)
	35	{
8d48427e RP	36	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
8d48427e RP	37	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 1);
987132bb PM	38	mdelay(2);
987132bb PM	39
8d48427e RP	40	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
8d48427e RP	41	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 1);
987132bb PM	42	mdelay(2);
	43
	44	locomo_m62332_senddata(locomolcd_dev, comadj, 0);
	45	mdelay(5);
	46
8d48427e RP	47	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
8d48427e RP	48	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 1);
987132bb PM	49	mdelay(10);
	50
	51	/* TFTCRST \| CPSOUT=0 \| CPSEN */
	52	locomo_writel(0x01, locomolcd_dev->mapbase + LOCOMO_TC);
	53
	54	/* Set CPSD */
	55	locomo_writel(6, locomolcd_dev->mapbase + LOCOMO_CPSD);
	56
	57	/* TFTCRST \| CPSOUT=0 \| CPSEN */
	58	locomo_writel((0x04 \| 0x01), locomolcd_dev->mapbase + LOCOMO_TC);
	59	mdelay(10);
	60
8d48427e RP	61	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
8d48427e RP	62	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 1);
987132bb PM	63	}
	64
	65	static void locomolcd_off(int comadj)
	66	{
	67	/* TFTCRST=1 \| CPSOUT=1 \| CPSEN = 0 */
	68	locomo_writel(0x06, locomolcd_dev->mapbase + LOCOMO_TC);
	69	mdelay(1);
	70
8d48427e	71	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
987132bb PM	72	mdelay(110);
987132bb PM	73
8d48427e	74	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
987132bb PM	75	mdelay(700);
	76
	77	/* TFTCRST=0 \| CPSOUT=0 \| CPSEN = 0 */
	78	locomo_writel(0, locomolcd_dev->mapbase + LOCOMO_TC);
8d48427e RP	79	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
8d48427e RP	80	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
987132bb PM	81	}
	82
	83	void locomolcd_power(int on)
	84	{
36a95bf5	85	int comadj = sharpsl_param.comadj;
987132bb PM	86	unsigned long flags;
	87
	88	local_irq_save(flags);
	89
	90	if (!locomolcd_dev) {
	91	local_irq_restore(flags);
	92	return;
	93	}
	94
	95	/* read comadj */
e4423781 RP	96	if (comadj == -1 && machine_is_collie())
	97	comadj = 128;
	98	if (comadj == -1 && machine_is_poodle())
	99	comadj = 118;
987132bb PM	100
	101	if (on)
	102	locomolcd_on(comadj);
	103	else
	104	locomolcd_off(comadj);
	105
	106	local_irq_restore(flags);
	107	}
	108	EXPORT_SYMBOL(locomolcd_power);
	109
e4423781 RP	110
	111	static int current_intensity;
	112
	113	static int locomolcd_set_intensity(struct backlight_device *bd)
	114	{
599a52d1	115	int intensity = bd->props.brightness;
e4423781	116
599a52d1	117	if (bd->props.power != FB_BLANK_UNBLANK)
e4423781	118	intensity = 0;
599a52d1	119	if (bd->props.fb_blank != FB_BLANK_UNBLANK)
e4423781 RP	120	intensity = 0;
	121	if (locomolcd_flags & LOCOMOLCD_SUSPENDED)
	122	intensity = 0;
	123
	124	switch (intensity) {
	125	/* AC and non-AC are handled differently, but produce same results in sharp code? */
	126	case 0: locomo_frontlight_set(locomolcd_dev, 0, 0, 161); break;
	127	case 1: locomo_frontlight_set(locomolcd_dev, 117, 0, 161); break;
	128	case 2: locomo_frontlight_set(locomolcd_dev, 163, 0, 148); break;
	129	case 3: locomo_frontlight_set(locomolcd_dev, 194, 0, 161); break;
	130	case 4: locomo_frontlight_set(locomolcd_dev, 194, 1, 161); break;
	131
	132	default:
	133	return -ENODEV;
	134	}
	135	current_intensity = intensity;
	136	return 0;
	137	}
	138
	139	static int locomolcd_get_intensity(struct backlight_device *bd)
	140	{
	141	return current_intensity;
	142	}
	143
9905a43b	144	static const struct backlight_ops locomobl_data = {
e4423781 RP	145	.get_brightness = locomolcd_get_intensity,
e4423781 RP	146	.update_status = locomolcd_set_intensity,
e4423781 RP	147	};
	148
	149	#ifdef CONFIG_PM
	150	static int locomolcd_suspend(struct locomo_dev *dev, pm_message_t state)
	151	{
	152	locomolcd_flags \|= LOCOMOLCD_SUSPENDED;
	153	locomolcd_set_intensity(locomolcd_bl_device);
	154	return 0;
	155	}
	156
	157	static int locomolcd_resume(struct locomo_dev *dev)
	158	{
	159	locomolcd_flags &= ~LOCOMOLCD_SUSPENDED;
	160	locomolcd_set_intensity(locomolcd_bl_device);
	161	return 0;
	162	}
	163	#else
	164	#define locomolcd_suspend NULL
	165	#define locomolcd_resume NULL
	166	#endif
	167
8d48427e	168	static int locomolcd_probe(struct locomo_dev *ldev)
987132bb PM	169	{
	170	unsigned long flags;
	171
	172	local_irq_save(flags);
8d48427e	173	locomolcd_dev = ldev;
987132bb	174
8d48427e	175	locomo_gpio_set_dir(ldev->dev.parent, LOCOMO_GPIO_FL_VR, 0);
e4423781	176
987132bb PM	177	/* the poodle_lcd_power function is called for the first time
	178	* from fs_initcall, which is before locomo is activated.
	179	* We need to recall poodle_lcd_power here*/
e4423781 RP	180	if (machine_is_poodle())
	181	locomolcd_power(1);
	182
987132bb	183	local_irq_restore(flags);
e4423781	184
27c5d745	185	locomolcd_bl_device = backlight_device_register("locomo-bl", &ldev->dev, NULL, &locomobl_data);
e4423781 RP	186
	187	if (IS_ERR (locomolcd_bl_device))
	188	return PTR_ERR (locomolcd_bl_device);
	189
	190	/* Set up frontlight so that screen is readable */
599a52d1 RP	191	locomolcd_bl_device->props.max_brightness = 4,
599a52d1 RP	192	locomolcd_bl_device->props.brightness = 2;
e4423781 RP	193	locomolcd_set_intensity(locomolcd_bl_device);
e4423781 RP	194
987132bb PM	195	return 0;
	196	}
	197
e4423781	198	static int locomolcd_remove(struct locomo_dev *dev)
987132bb PM	199	{
987132bb PM	200	unsigned long flags;
e4423781	201
2a391a18 RP	202	locomolcd_bl_device->props.brightness = 0;
2a391a18 RP	203	locomolcd_bl_device->props.power = 0;
4437cd1e HMH	204	locomolcd_set_intensity(locomolcd_bl_device);
4437cd1e HMH	205
e4423781	206	backlight_device_unregister(locomolcd_bl_device);
987132bb PM	207	local_irq_save(flags);
	208	locomolcd_dev = NULL;
	209	local_irq_restore(flags);
	210	return 0;
	211	}
	212
	213	static struct locomo_driver poodle_lcd_driver = {
	214	.drv = {
	215	.name = "locomo-backlight",
	216	},
	217	.devid = LOCOMO_DEVID_BACKLIGHT,
e4423781 RP	218	.probe = locomolcd_probe,
	219	.remove = locomolcd_remove,
	220	.suspend = locomolcd_suspend,
	221	.resume = locomolcd_resume,
987132bb PM	222	};
987132bb PM	223
e4423781 RP	224
e4423781 RP	225	static int __init locomolcd_init(void)
987132bb PM	226	{
987132bb PM	227	int ret = locomo_driver_register(&poodle_lcd_driver);
e4423781 RP	228	if (ret)
e4423781 RP	229	return ret;
987132bb PM	230
	231	#ifdef CONFIG_SA1100_COLLIE
	232	sa1100fb_lcd_power = locomolcd_power;
	233	#endif
	234	return 0;
	235	}
987132bb	236
e4423781 RP	237	static void __exit locomolcd_exit(void)
	238	{
	239	locomo_driver_unregister(&poodle_lcd_driver);
	240	}
	241
	242	module_init(locomolcd_init);
	243	module_exit(locomolcd_exit);
	244
	245	MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>, Pavel Machek <pavel@suse.cz>");
	246	MODULE_DESCRIPTION("Collie LCD driver");
	247	MODULE_LICENSE("GPL");