Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 | /* * LEDs driver for Dialog Semiconductor DA9030/DA9034 * * Copyright (C) 2008 Compulab, Ltd. * Mike Rapoport <mike@compulab.co.il> * * Copyright (C) 2006-2008 Marvell International Ltd. * Eric Miao <eric.miao@marvell.com> * * 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/module.h> #include <linux/kernel.h> #include <linux/platform_device.h> #include <linux/leds.h> #include <linux/mfd/da903x.h> #include <linux/slab.h> #define DA9030_LED1_CONTROL 0x20 #define DA9030_LED2_CONTROL 0x21 #define DA9030_LED3_CONTROL 0x22 #define DA9030_LED4_CONTROL 0x23 #define DA9030_LEDPC_CONTROL 0x24 #define DA9030_MISC_CONTROL_A 0x26 /* Vibrator Control */ #define DA9034_LED1_CONTROL 0x35 #define DA9034_LED2_CONTROL 0x36 #define DA9034_VIBRA 0x40 struct da903x_led { struct led_classdev cdev; struct device *master; int id; int flags; }; #define DA9030_LED_OFFSET(id) ((id) - DA9030_ID_LED_1) #define DA9034_LED_OFFSET(id) ((id) - DA9034_ID_LED_1) static int da903x_led_set(struct led_classdev *led_cdev, enum led_brightness value) { struct da903x_led *led = container_of(led_cdev, struct da903x_led, cdev); uint8_t val; int offset, ret = -EINVAL; switch (led->id) { case DA9030_ID_LED_1: case DA9030_ID_LED_2: case DA9030_ID_LED_3: case DA9030_ID_LED_4: case DA9030_ID_LED_PC: offset = DA9030_LED_OFFSET(led->id); val = led->flags & ~0x87; val |= value ? 0x80 : 0; /* EN bit */ val |= (0x7 - (value >> 5)) & 0x7; /* PWM<2:0> */ ret = da903x_write(led->master, DA9030_LED1_CONTROL + offset, val); break; case DA9030_ID_VIBRA: val = led->flags & ~0x80; val |= value ? 0x80 : 0; /* EN bit */ ret = da903x_write(led->master, DA9030_MISC_CONTROL_A, val); break; case DA9034_ID_LED_1: case DA9034_ID_LED_2: offset = DA9034_LED_OFFSET(led->id); val = (value * 0x5f / LED_FULL) & 0x7f; val |= (led->flags & DA9034_LED_RAMP) ? 0x80 : 0; ret = da903x_write(led->master, DA9034_LED1_CONTROL + offset, val); break; case DA9034_ID_VIBRA: val = value & 0xfe; ret = da903x_write(led->master, DA9034_VIBRA, val); break; } return ret; } static int da903x_led_probe(struct platform_device *pdev) { struct led_info *pdata = dev_get_platdata(&pdev->dev); struct da903x_led *led; int id, ret; if (pdata == NULL) return 0; id = pdev->id; if (!((id >= DA9030_ID_LED_1 && id <= DA9030_ID_VIBRA) || (id >= DA9034_ID_LED_1 && id <= DA9034_ID_VIBRA))) { dev_err(&pdev->dev, "invalid LED ID (%d) specified\n", id); return -EINVAL; } led = devm_kzalloc(&pdev->dev, sizeof(struct da903x_led), GFP_KERNEL); if (!led) return -ENOMEM; led->cdev.name = pdata->name; led->cdev.default_trigger = pdata->default_trigger; led->cdev.brightness_set_blocking = da903x_led_set; led->cdev.brightness = LED_OFF; led->id = id; led->flags = pdata->flags; led->master = pdev->dev.parent; ret = devm_led_classdev_register(led->master, &led->cdev); if (ret) { dev_err(&pdev->dev, "failed to register LED %d\n", id); return ret; } return 0; } static struct platform_driver da903x_led_driver = { .driver = { .name = "da903x-led", }, .probe = da903x_led_probe, }; module_platform_driver(da903x_led_driver); MODULE_DESCRIPTION("LEDs driver for Dialog Semiconductor DA9030/DA9034"); MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"); MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>"); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:da903x-led"); |