[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / video / nvidia / nv_backlight.c

/*
 * Backlight code for nVidia based graphic cards
 *
 * Copyright 2004 Antonino Daplas <adaplas@pol.net>
 * Copyright (c) 2006 Michael Hanselmann <linux-kernel@hansmi.ch>
 *
 * 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/backlight.h>
#include <linux/fb.h>
#include <linux/pci.h>
#include "nv_local.h"
#include "nv_type.h"
#include "nv_proto.h"

/* We do not have any information about which values are allowed, thus
 * we used safe values.
 */
#define MIN_LEVEL 0x158
#define MAX_LEVEL 0x534
#define LEVEL_STEP ((MAX_LEVEL - MIN_LEVEL) / FB_BACKLIGHT_MAX)

static struct backlight_properties nvidia_bl_data;

static int nvidia_bl_get_level_brightness(struct nvidia_par *par,
		int level)
{
	struct fb_info *info = pci_get_drvdata(par->pci_dev);
	int nlevel;

	/* Get and convert the value */
	/* No locking of bl_curve since we read a single value */
	nlevel = MIN_LEVEL + info->bl_curve[level] * LEVEL_STEP;

	if (nlevel < 0)
		nlevel = 0;
	else if (nlevel < MIN_LEVEL)
		nlevel = MIN_LEVEL;
	else if (nlevel > MAX_LEVEL)
		nlevel = MAX_LEVEL;

	return nlevel;
}

static int nvidia_bl_update_status(struct backlight_device *bd)
{
	struct nvidia_par *par = class_get_devdata(&bd->class_dev);
	u32 tmp_pcrt, tmp_pmc, fpcontrol;
	int level;

	if (!par->FlatPanel)
		return 0;

	if (bd->props.power != FB_BLANK_UNBLANK ||
	    bd->props.fb_blank != FB_BLANK_UNBLANK)
		level = 0;
	else
		level = bd->props.brightness;

	tmp_pmc = NV_RD32(par->PMC, 0x10F0) & 0x0000FFFF;
	tmp_pcrt = NV_RD32(par->PCRTC0, 0x081C) & 0xFFFFFFFC;
	fpcontrol = NV_RD32(par->PRAMDAC, 0x0848) & 0xCFFFFFCC;

	if (level > 0) {
		tmp_pcrt |= 0x1;
		tmp_pmc |= (1 << 31); /* backlight bit */
		tmp_pmc |= nvidia_bl_get_level_brightness(par, level) << 16;
		fpcontrol |= par->fpSyncs;
	} else
		fpcontrol |= 0x20000022;

	NV_WR32(par->PCRTC0, 0x081C, tmp_pcrt);
	NV_WR32(par->PMC, 0x10F0, tmp_pmc);
	NV_WR32(par->PRAMDAC, 0x848, fpcontrol);

	return 0;
}

static int nvidia_bl_get_brightness(struct backlight_device *bd)
{
	return bd->props.brightness;
}

static struct backlight_ops nvidia_bl_ops = {
	.get_brightness = nvidia_bl_get_brightness,
	.update_status	= nvidia_bl_update_status,
};

void nvidia_bl_init(struct nvidia_par *par)
{
	struct fb_info *info = pci_get_drvdata(par->pci_dev);
	struct backlight_device *bd;
	char name[12];

	if (!par->FlatPanel)
		return;

#ifdef CONFIG_PMAC_BACKLIGHT
	if (!machine_is(powermac) ||
	    !pmac_has_backlight_type("mnca"))
		return;
#endif

	snprintf(name, sizeof(name), "nvidiabl%d", info->node);

	bd = backlight_device_register(name, info->dev, par, &nvidia_bl_ops);
	if (IS_ERR(bd)) {
		info->bl_dev = NULL;
		printk(KERN_WARNING "nvidia: Backlight registration failed\n");
		goto error;
	}

	info->bl_dev = bd;
	fb_bl_default_curve(info, 0,
		0x158 * FB_BACKLIGHT_MAX / MAX_LEVEL,
		0x534 * FB_BACKLIGHT_MAX / MAX_LEVEL);

	bd->props.max_brightness = FB_BACKLIGHT_LEVELS - 1;
	bd->props.brightness = nvidia_bl_data.max_brightness;
	bd->props.power = FB_BLANK_UNBLANK;
	backlight_update_status(bd);

	printk("nvidia: Backlight initialized (%s)\n", name);

	return;

error:
	return;
}

void nvidia_bl_exit(struct nvidia_par *par)
{
	struct fb_info *info = pci_get_drvdata(par->pci_dev);
	struct backlight_device *bd = info->bl_dev;

	backlight_device_unregister(bd);
	printk("nvidia: Backlight unloaded\n");
}
Commit	Line	Data
5474c120 MH	1	/*
	2	* Backlight code for nVidia based graphic cards
	3	*
	4	* Copyright 2004 Antonino Daplas <adaplas@pol.net>
	5	* Copyright (c) 2006 Michael Hanselmann <linux-kernel@hansmi.ch>
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License version 2 as
	9	* published by the Free Software Foundation.
	10	*/
	11
	12	#include <linux/backlight.h>
	13	#include <linux/fb.h>
	14	#include <linux/pci.h>
	15	#include "nv_local.h"
	16	#include "nv_type.h"
	17	#include "nv_proto.h"
	18
5474c120 MH	19	/* We do not have any information about which values are allowed, thus
	20	* we used safe values.
	21	*/
	22	#define MIN_LEVEL 0x158
	23	#define MAX_LEVEL 0x534
e01af038	24	#define LEVEL_STEP ((MAX_LEVEL - MIN_LEVEL) / FB_BACKLIGHT_MAX)
5474c120 MH	25
	26	static struct backlight_properties nvidia_bl_data;
	27
	28	static int nvidia_bl_get_level_brightness(struct nvidia_par *par,
	29	int level)
	30	{
	31	struct fb_info *info = pci_get_drvdata(par->pci_dev);
	32	int nlevel;
	33
	34	/* Get and convert the value */
37ce69a5	35	/* No locking of bl_curve since we read a single value */
e01af038	36	nlevel = MIN_LEVEL + info->bl_curve[level] * LEVEL_STEP;
5474c120 MH	37
	38	if (nlevel < 0)
	39	nlevel = 0;
	40	else if (nlevel < MIN_LEVEL)
	41	nlevel = MIN_LEVEL;
	42	else if (nlevel > MAX_LEVEL)
	43	nlevel = MAX_LEVEL;
	44
	45	return nlevel;
	46	}
	47
37ce69a5	48	static int nvidia_bl_update_status(struct backlight_device *bd)
5474c120 MH	49	{
	50	struct nvidia_par *par = class_get_devdata(&bd->class_dev);
	51	u32 tmp_pcrt, tmp_pmc, fpcontrol;
	52	int level;
	53
	54	if (!par->FlatPanel)
	55	return 0;
	56
599a52d1 RP	57	if (bd->props.power != FB_BLANK_UNBLANK \|\|
599a52d1 RP	58	bd->props.fb_blank != FB_BLANK_UNBLANK)
5474c120 MH	59	level = 0;
5474c120 MH	60	else
599a52d1	61	level = bd->props.brightness;
5474c120 MH	62
	63	tmp_pmc = NV_RD32(par->PMC, 0x10F0) & 0x0000FFFF;
	64	tmp_pcrt = NV_RD32(par->PCRTC0, 0x081C) & 0xFFFFFFFC;
	65	fpcontrol = NV_RD32(par->PRAMDAC, 0x0848) & 0xCFFFFFCC;
	66
	67	if (level > 0) {
	68	tmp_pcrt \|= 0x1;
	69	tmp_pmc \|= (1 << 31); /* backlight bit */
	70	tmp_pmc \|= nvidia_bl_get_level_brightness(par, level) << 16;
	71	fpcontrol \|= par->fpSyncs;
	72	} else
	73	fpcontrol \|= 0x20000022;
	74
	75	NV_WR32(par->PCRTC0, 0x081C, tmp_pcrt);
	76	NV_WR32(par->PMC, 0x10F0, tmp_pmc);
	77	NV_WR32(par->PRAMDAC, 0x848, fpcontrol);
	78
	79	return 0;
	80	}
	81
	82	static int nvidia_bl_get_brightness(struct backlight_device *bd)
	83	{
599a52d1	84	return bd->props.brightness;
5474c120 MH	85	}
5474c120 MH	86
599a52d1	87	static struct backlight_ops nvidia_bl_ops = {
5474c120 MH	88	.get_brightness = nvidia_bl_get_brightness,
5474c120 MH	89	.update_status = nvidia_bl_update_status,
5474c120 MH	90	};
	91
	92	void nvidia_bl_init(struct nvidia_par *par)
	93	{
	94	struct fb_info *info = pci_get_drvdata(par->pci_dev);
	95	struct backlight_device *bd;
	96	char name[12];
	97
	98	if (!par->FlatPanel)
	99	return;
	100
	101	#ifdef CONFIG_PMAC_BACKLIGHT
	102	if (!machine_is(powermac) \|\|
	103	!pmac_has_backlight_type("mnca"))
	104	return;
	105	#endif
	106
	107	snprintf(name, sizeof(name), "nvidiabl%d", info->node);
	108
599a52d1	109	bd = backlight_device_register(name, info->dev, par, &nvidia_bl_ops);
5474c120 MH	110	if (IS_ERR(bd)) {
5474c120 MH	111	info->bl_dev = NULL;
98a3c781	112	printk(KERN_WARNING "nvidia: Backlight registration failed\n");
5474c120 MH	113	goto error;
	114	}
	115
5474c120 MH	116	info->bl_dev = bd;
	117	fb_bl_default_curve(info, 0,
	118	0x158 * FB_BACKLIGHT_MAX / MAX_LEVEL,
	119	0x534 * FB_BACKLIGHT_MAX / MAX_LEVEL);
5474c120	120
599a52d1 RP	121	bd->props.max_brightness = FB_BACKLIGHT_LEVELS - 1;
	122	bd->props.brightness = nvidia_bl_data.max_brightness;
	123	bd->props.power = FB_BLANK_UNBLANK;
28ee086d	124	backlight_update_status(bd);
5474c120	125
5474c120 MH	126	printk("nvidia: Backlight initialized (%s)\n", name);
	127
	128	return;
	129
	130	error:
	131	return;
	132	}
	133
	134	void nvidia_bl_exit(struct nvidia_par *par)
	135	{
	136	struct fb_info *info = pci_get_drvdata(par->pci_dev);
37ce69a5	137	struct backlight_device *bd = info->bl_dev;
5474c120	138
321709c5 RP	139	backlight_device_unregister(bd);
321709c5 RP	140	printk("nvidia: Backlight unloaded\n");
5474c120	141	}