[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / nvec / nvec_paz00.c

/*
 * nvec_paz00: OEM specific driver for Compal PAZ00 based devices
 *
 * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.launchpad.net>
 *
 * Authors:  Ilya Petrov <ilya.muromec@gmail.com>
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 */

#include <linux/module.h>
#include <linux/err.h>
#include <linux/slab.h>
#include <linux/leds.h>
#include <linux/platform_device.h>
#include "nvec.h"

#define to_nvec_led(led_cdev) \
	container_of(led_cdev, struct nvec_led, cdev)

#define NVEC_LED_REQ {'\x0d', '\x10', '\x45', '\x10', '\x00'}

#define NVEC_LED_MAX 8

struct nvec_led {
	struct led_classdev cdev;
	struct nvec_chip *nvec;
};

static void nvec_led_brightness_set(struct led_classdev *led_cdev,
				    enum led_brightness value)
{
	struct nvec_led *led = to_nvec_led(led_cdev);
	unsigned char buf[] = NVEC_LED_REQ;
	buf[4] = value;

	nvec_write_async(led->nvec, buf, sizeof(buf));

	led->cdev.brightness = value;

}

static int nvec_paz00_probe(struct platform_device *pdev)
{
	struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent);
	struct nvec_led *led;
	int ret = 0;

	led = devm_kzalloc(&pdev->dev, sizeof(*led), GFP_KERNEL);
	if (led == NULL)
		return -ENOMEM;

	led->cdev.max_brightness = NVEC_LED_MAX;

	led->cdev.brightness_set = nvec_led_brightness_set;
	led->cdev.name = "paz00-led";
	led->cdev.flags |= LED_CORE_SUSPENDRESUME;
	led->nvec = nvec;

	platform_set_drvdata(pdev, led);

	ret = led_classdev_register(&pdev->dev, &led->cdev);
	if (ret < 0)
		return ret;

	/* to expose the default value to userspace */
	led->cdev.brightness = 0;

	return 0;
}

static int nvec_paz00_remove(struct platform_device *pdev)
{
	struct nvec_led *led = platform_get_drvdata(pdev);

	led_classdev_unregister(&led->cdev);

	return 0;
}

static struct platform_driver nvec_paz00_driver = {
	.probe  = nvec_paz00_probe,
	.remove = nvec_paz00_remove,
	.driver = {
		.name  = "nvec-paz00",
		.owner = THIS_MODULE,
	},
};

module_platform_driver(nvec_paz00_driver);

MODULE_AUTHOR("Ilya Petrov <ilya.muromec@gmail.com>");
MODULE_DESCRIPTION("Tegra NVEC PAZ00 driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:nvec-paz00");
Commit	Line	Data
97cc2657	1	/*
ac562680	2	* nvec_paz00: OEM specific driver for Compal PAZ00 based devices
97cc2657 IP	3	*
	4	* Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.launchpad.net>
	5	*
	6	* Authors: Ilya Petrov <ilya.muromec@gmail.com>
	7	*
	8	* This file is subject to the terms and conditions of the GNU General Public
	9	* License. See the file "COPYING" in the main directory of this archive
	10	* for more details.
	11	*
	12	*/
	13
	14	#include <linux/module.h>
	15	#include <linux/err.h>
	16	#include <linux/slab.h>
	17	#include <linux/leds.h>
	18	#include <linux/platform_device.h>
	19	#include "nvec.h"
	20
	21	#define to_nvec_led(led_cdev) \
	22	container_of(led_cdev, struct nvec_led, cdev)
	23
	24	#define NVEC_LED_REQ {'\x0d', '\x10', '\x45', '\x10', '\x00'}
	25
	26	#define NVEC_LED_MAX 8
	27
	28	struct nvec_led {
	29	struct led_classdev cdev;
	30	struct nvec_chip *nvec;
	31	};
	32
	33	static void nvec_led_brightness_set(struct led_classdev *led_cdev,
	34	enum led_brightness value)
	35	{
	36	struct nvec_led *led = to_nvec_led(led_cdev);
	37	unsigned char buf[] = NVEC_LED_REQ;
	38	buf[4] = value;
	39
	40	nvec_write_async(led->nvec, buf, sizeof(buf));
	41
	42	led->cdev.brightness = value;
	43
	44	}
	45
46620803	46	static int nvec_paz00_probe(struct platform_device *pdev)
97cc2657 IP	47	{
	48	struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent);
	49	struct nvec_led *led;
	50	int ret = 0;
	51
f5e3352e	52	led = devm_kzalloc(&pdev->dev, sizeof(*led), GFP_KERNEL);
97cc2657 IP	53	if (led == NULL)
	54	return -ENOMEM;
	55
	56	led->cdev.max_brightness = NVEC_LED_MAX;
	57
	58	led->cdev.brightness_set = nvec_led_brightness_set;
ac562680	59	led->cdev.name = "paz00-led";
97cc2657 IP	60	led->cdev.flags \|= LED_CORE_SUSPENDRESUME;
	61	led->nvec = nvec;
	62
	63	platform_set_drvdata(pdev, led);
	64
	65	ret = led_classdev_register(&pdev->dev, &led->cdev);
	66	if (ret < 0)
f5e3352e	67	return ret;
97cc2657 IP	68
	69	/* to expose the default value to userspace */
	70	led->cdev.brightness = 0;
	71
	72	return 0;
97cc2657 IP	73	}
97cc2657 IP	74
1a6a8a84	75	static int nvec_paz00_remove(struct platform_device *pdev)
97cc2657 IP	76	{
	77	struct nvec_led *led = platform_get_drvdata(pdev);
	78
	79	led_classdev_unregister(&led->cdev);
f5e3352e	80
97cc2657 IP	81	return 0;
	82	}
	83
ac562680 MD	84	static struct platform_driver nvec_paz00_driver = {
ac562680 MD	85	.probe = nvec_paz00_probe,
44b90a3f	86	.remove = nvec_paz00_remove,
97cc2657	87	.driver = {
ac562680 MD	88	.name = "nvec-paz00",
ac562680 MD	89	.owner = THIS_MODULE,
97cc2657 IP	90	},
	91	};
	92
ac562680	93	module_platform_driver(nvec_paz00_driver);
97cc2657 IP	94
97cc2657 IP	95	MODULE_AUTHOR("Ilya Petrov <ilya.muromec@gmail.com>");
ac562680	96	MODULE_DESCRIPTION("Tegra NVEC PAZ00 driver");
97cc2657	97	MODULE_LICENSE("GPL");
ac562680	98	MODULE_ALIAS("platform:nvec-paz00");