19e84561cSMike Rapoport /* 29e84561cSMike Rapoport * LEDs driver for Dialog Semiconductor DA9030/DA9034 39e84561cSMike Rapoport * 49e84561cSMike Rapoport * Copyright (C) 2008 Compulab, Ltd. 59e84561cSMike Rapoport * Mike Rapoport <mike@compulab.co.il> 69e84561cSMike Rapoport * 79e84561cSMike Rapoport * Copyright (C) 2006-2008 Marvell International Ltd. 89e84561cSMike Rapoport * Eric Miao <eric.miao@marvell.com> 99e84561cSMike Rapoport * 109e84561cSMike Rapoport * This program is free software; you can redistribute it and/or modify 119e84561cSMike Rapoport * it under the terms of the GNU General Public License version 2 as 129e84561cSMike Rapoport * published by the Free Software Foundation. 139e84561cSMike Rapoport */ 149e84561cSMike Rapoport 159e84561cSMike Rapoport #include <linux/module.h> 169e84561cSMike Rapoport #include <linux/kernel.h> 179e84561cSMike Rapoport #include <linux/init.h> 189e84561cSMike Rapoport #include <linux/platform_device.h> 199e84561cSMike Rapoport #include <linux/leds.h> 20b9b54aa2SEric Miao #include <linux/workqueue.h> 219e84561cSMike Rapoport #include <linux/mfd/da903x.h> 229e84561cSMike Rapoport 239e84561cSMike Rapoport #define DA9030_LED1_CONTROL 0x20 249e84561cSMike Rapoport #define DA9030_LED2_CONTROL 0x21 259e84561cSMike Rapoport #define DA9030_LED3_CONTROL 0x22 269e84561cSMike Rapoport #define DA9030_LED4_CONTROL 0x23 279e84561cSMike Rapoport #define DA9030_LEDPC_CONTROL 0x24 289e84561cSMike Rapoport #define DA9030_MISC_CONTROL_A 0x26 /* Vibrator Control */ 299e84561cSMike Rapoport 309e84561cSMike Rapoport #define DA9034_LED1_CONTROL 0x35 319e84561cSMike Rapoport #define DA9034_LED2_CONTROL 0x36 329e84561cSMike Rapoport #define DA9034_VIBRA 0x40 339e84561cSMike Rapoport 349e84561cSMike Rapoport struct da903x_led { 359e84561cSMike Rapoport struct led_classdev cdev; 369e84561cSMike Rapoport struct work_struct work; 379e84561cSMike Rapoport struct device *master; 389e84561cSMike Rapoport enum led_brightness new_brightness; 399e84561cSMike Rapoport int id; 409e84561cSMike Rapoport int flags; 419e84561cSMike Rapoport }; 429e84561cSMike Rapoport 439e84561cSMike Rapoport #define DA9030_LED_OFFSET(id) ((id) - DA9030_ID_LED_1) 449e84561cSMike Rapoport #define DA9034_LED_OFFSET(id) ((id) - DA9034_ID_LED_1) 459e84561cSMike Rapoport 469e84561cSMike Rapoport static void da903x_led_work(struct work_struct *work) 479e84561cSMike Rapoport { 489e84561cSMike Rapoport struct da903x_led *led = container_of(work, struct da903x_led, work); 499e84561cSMike Rapoport uint8_t val; 509e84561cSMike Rapoport int offset; 519e84561cSMike Rapoport 529e84561cSMike Rapoport switch (led->id) { 539e84561cSMike Rapoport case DA9030_ID_LED_1: 549e84561cSMike Rapoport case DA9030_ID_LED_2: 559e84561cSMike Rapoport case DA9030_ID_LED_3: 569e84561cSMike Rapoport case DA9030_ID_LED_4: 579e84561cSMike Rapoport case DA9030_ID_LED_PC: 589e84561cSMike Rapoport offset = DA9030_LED_OFFSET(led->id); 599e84561cSMike Rapoport val = led->flags & ~0x87; 609e84561cSMike Rapoport val |= (led->new_brightness) ? 0x80 : 0; /* EN bit */ 61*a0601c89SJonathan Cameron val |= (0x7 - (led->new_brightness >> 5)) & 0x7; /* PWM<2:0> */ 629e84561cSMike Rapoport da903x_write(led->master, DA9030_LED1_CONTROL + offset, val); 639e84561cSMike Rapoport break; 649e84561cSMike Rapoport case DA9030_ID_VIBRA: 659e84561cSMike Rapoport val = led->flags & ~0x80; 669e84561cSMike Rapoport val |= (led->new_brightness) ? 0x80 : 0; /* EN bit */ 679e84561cSMike Rapoport da903x_write(led->master, DA9030_MISC_CONTROL_A, val); 689e84561cSMike Rapoport break; 699e84561cSMike Rapoport case DA9034_ID_LED_1: 709e84561cSMike Rapoport case DA9034_ID_LED_2: 719e84561cSMike Rapoport offset = DA9034_LED_OFFSET(led->id); 729e84561cSMike Rapoport val = (led->new_brightness * 0x5f / LED_FULL) & 0x7f; 739e84561cSMike Rapoport val |= (led->flags & DA9034_LED_RAMP) ? 0x80 : 0; 749e84561cSMike Rapoport da903x_write(led->master, DA9034_LED1_CONTROL + offset, val); 759e84561cSMike Rapoport break; 769e84561cSMike Rapoport case DA9034_ID_VIBRA: 779e84561cSMike Rapoport val = led->new_brightness & 0xfe; 789e84561cSMike Rapoport da903x_write(led->master, DA9034_VIBRA, val); 799e84561cSMike Rapoport break; 809e84561cSMike Rapoport } 819e84561cSMike Rapoport } 829e84561cSMike Rapoport 839e84561cSMike Rapoport static void da903x_led_set(struct led_classdev *led_cdev, 849e84561cSMike Rapoport enum led_brightness value) 859e84561cSMike Rapoport { 869e84561cSMike Rapoport struct da903x_led *led; 879e84561cSMike Rapoport 889e84561cSMike Rapoport led = container_of(led_cdev, struct da903x_led, cdev); 899e84561cSMike Rapoport led->new_brightness = value; 909e84561cSMike Rapoport schedule_work(&led->work); 919e84561cSMike Rapoport } 929e84561cSMike Rapoport 939e84561cSMike Rapoport static int __devinit da903x_led_probe(struct platform_device *pdev) 949e84561cSMike Rapoport { 959e84561cSMike Rapoport struct led_info *pdata = pdev->dev.platform_data; 969e84561cSMike Rapoport struct da903x_led *led; 979e84561cSMike Rapoport int id, ret; 989e84561cSMike Rapoport 999e84561cSMike Rapoport if (pdata == NULL) 1009e84561cSMike Rapoport return 0; 1019e84561cSMike Rapoport 1029e84561cSMike Rapoport id = pdev->id; 1039e84561cSMike Rapoport 1049e84561cSMike Rapoport if (!((id >= DA9030_ID_LED_1 && id <= DA9030_ID_VIBRA) || 1059e84561cSMike Rapoport (id >= DA9034_ID_LED_1 && id <= DA9034_ID_VIBRA))) { 1069e84561cSMike Rapoport dev_err(&pdev->dev, "invalid LED ID (%d) specified\n", id); 1079e84561cSMike Rapoport return -EINVAL; 1089e84561cSMike Rapoport } 1099e84561cSMike Rapoport 1109e84561cSMike Rapoport led = kzalloc(sizeof(struct da903x_led), GFP_KERNEL); 1119e84561cSMike Rapoport if (led == NULL) { 1129e84561cSMike Rapoport dev_err(&pdev->dev, "failed to alloc memory for LED%d\n", id); 1139e84561cSMike Rapoport return -ENOMEM; 1149e84561cSMike Rapoport } 1159e84561cSMike Rapoport 1169e84561cSMike Rapoport led->cdev.name = pdata->name; 1179e84561cSMike Rapoport led->cdev.default_trigger = pdata->default_trigger; 1189e84561cSMike Rapoport led->cdev.brightness_set = da903x_led_set; 1199e84561cSMike Rapoport led->cdev.brightness = LED_OFF; 1209e84561cSMike Rapoport 1219e84561cSMike Rapoport led->id = id; 1229e84561cSMike Rapoport led->flags = pdata->flags; 1239e84561cSMike Rapoport led->master = pdev->dev.parent; 1249e84561cSMike Rapoport led->new_brightness = LED_OFF; 1259e84561cSMike Rapoport 1269e84561cSMike Rapoport INIT_WORK(&led->work, da903x_led_work); 1279e84561cSMike Rapoport 1289e84561cSMike Rapoport ret = led_classdev_register(led->master, &led->cdev); 1299e84561cSMike Rapoport if (ret) { 1309e84561cSMike Rapoport dev_err(&pdev->dev, "failed to register LED %d\n", id); 1319e84561cSMike Rapoport goto err; 1329e84561cSMike Rapoport } 1339e84561cSMike Rapoport 1349e84561cSMike Rapoport platform_set_drvdata(pdev, led); 1359e84561cSMike Rapoport return 0; 1369e84561cSMike Rapoport 1379e84561cSMike Rapoport err: 1389e84561cSMike Rapoport kfree(led); 1399e84561cSMike Rapoport return ret; 1409e84561cSMike Rapoport } 1419e84561cSMike Rapoport 1429e84561cSMike Rapoport static int __devexit da903x_led_remove(struct platform_device *pdev) 1439e84561cSMike Rapoport { 1449e84561cSMike Rapoport struct da903x_led *led = platform_get_drvdata(pdev); 1459e84561cSMike Rapoport 1469e84561cSMike Rapoport led_classdev_unregister(&led->cdev); 1479e84561cSMike Rapoport kfree(led); 1489e84561cSMike Rapoport return 0; 1499e84561cSMike Rapoport } 1509e84561cSMike Rapoport 1519e84561cSMike Rapoport static struct platform_driver da903x_led_driver = { 1529e84561cSMike Rapoport .driver = { 1539e84561cSMike Rapoport .name = "da903x-led", 1549e84561cSMike Rapoport .owner = THIS_MODULE, 1559e84561cSMike Rapoport }, 1569e84561cSMike Rapoport .probe = da903x_led_probe, 1579e84561cSMike Rapoport .remove = __devexit_p(da903x_led_remove), 1589e84561cSMike Rapoport }; 1599e84561cSMike Rapoport 1609e84561cSMike Rapoport static int __init da903x_led_init(void) 1619e84561cSMike Rapoport { 1629e84561cSMike Rapoport return platform_driver_register(&da903x_led_driver); 1639e84561cSMike Rapoport } 1649e84561cSMike Rapoport module_init(da903x_led_init); 1659e84561cSMike Rapoport 1669e84561cSMike Rapoport static void __exit da903x_led_exit(void) 1679e84561cSMike Rapoport { 1689e84561cSMike Rapoport platform_driver_unregister(&da903x_led_driver); 1699e84561cSMike Rapoport } 1709e84561cSMike Rapoport module_exit(da903x_led_exit); 1719e84561cSMike Rapoport 1729e84561cSMike Rapoport MODULE_DESCRIPTION("LEDs driver for Dialog Semiconductor DA9030/DA9034"); 1739e84561cSMike Rapoport MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>" 1749e84561cSMike Rapoport "Mike Rapoport <mike@compulab.co.il>"); 1759e84561cSMike Rapoport MODULE_LICENSE("GPL"); 1769e84561cSMike Rapoport MODULE_ALIAS("platform:da903x-led"); 177