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 | } |
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 = { |
85 | .probe = nvec_paz00_probe, | |
44b90a3f | 86 | .remove = nvec_paz00_remove, |
97cc2657 | 87 | .driver = { |
ac562680 MD |
88 | .name = "nvec-paz00", |
89 | .owner = THIS_MODULE, | |
97cc2657 IP |
90 | }, |
91 | }; | |
92 | ||
ac562680 | 93 | module_platform_driver(nvec_paz00_driver); |
97cc2657 IP |
94 | |
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"); |