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/platform_device.h> 189e84561cSMike Rapoport #include <linux/leds.h> 199e84561cSMike Rapoport #include <linux/mfd/da903x.h> 205a0e3ad6STejun Heo #include <linux/slab.h> 219e84561cSMike Rapoport 229e84561cSMike Rapoport #define DA9030_LED1_CONTROL 0x20 239e84561cSMike Rapoport #define DA9030_LED2_CONTROL 0x21 249e84561cSMike Rapoport #define DA9030_LED3_CONTROL 0x22 259e84561cSMike Rapoport #define DA9030_LED4_CONTROL 0x23 269e84561cSMike Rapoport #define DA9030_LEDPC_CONTROL 0x24 279e84561cSMike Rapoport #define DA9030_MISC_CONTROL_A 0x26 /* Vibrator Control */ 289e84561cSMike Rapoport 299e84561cSMike Rapoport #define DA9034_LED1_CONTROL 0x35 309e84561cSMike Rapoport #define DA9034_LED2_CONTROL 0x36 319e84561cSMike Rapoport #define DA9034_VIBRA 0x40 329e84561cSMike Rapoport 339e84561cSMike Rapoport struct da903x_led { 349e84561cSMike Rapoport struct led_classdev cdev; 359e84561cSMike Rapoport struct device *master; 369e84561cSMike Rapoport int id; 379e84561cSMike Rapoport int flags; 389e84561cSMike Rapoport }; 399e84561cSMike Rapoport 409e84561cSMike Rapoport #define DA9030_LED_OFFSET(id) ((id) - DA9030_ID_LED_1) 419e84561cSMike Rapoport #define DA9034_LED_OFFSET(id) ((id) - DA9034_ID_LED_1) 429e84561cSMike Rapoport 43*803bb384SAndrew Lunn static int da903x_led_set(struct led_classdev *led_cdev, 44*803bb384SAndrew Lunn enum led_brightness value) 459e84561cSMike Rapoport { 46*803bb384SAndrew Lunn struct da903x_led *led = 47*803bb384SAndrew Lunn container_of(led_cdev, struct da903x_led, cdev); 489e84561cSMike Rapoport uint8_t val; 49*803bb384SAndrew Lunn int offset, ret = -EINVAL; 509e84561cSMike Rapoport 519e84561cSMike Rapoport switch (led->id) { 529e84561cSMike Rapoport case DA9030_ID_LED_1: 539e84561cSMike Rapoport case DA9030_ID_LED_2: 549e84561cSMike Rapoport case DA9030_ID_LED_3: 559e84561cSMike Rapoport case DA9030_ID_LED_4: 569e84561cSMike Rapoport case DA9030_ID_LED_PC: 579e84561cSMike Rapoport offset = DA9030_LED_OFFSET(led->id); 589e84561cSMike Rapoport val = led->flags & ~0x87; 59*803bb384SAndrew Lunn val |= value ? 0x80 : 0; /* EN bit */ 60*803bb384SAndrew Lunn val |= (0x7 - (value >> 5)) & 0x7; /* PWM<2:0> */ 61*803bb384SAndrew Lunn ret = da903x_write(led->master, DA9030_LED1_CONTROL + offset, 62*803bb384SAndrew Lunn val); 639e84561cSMike Rapoport break; 649e84561cSMike Rapoport case DA9030_ID_VIBRA: 659e84561cSMike Rapoport val = led->flags & ~0x80; 66*803bb384SAndrew Lunn val |= value ? 0x80 : 0; /* EN bit */ 67*803bb384SAndrew Lunn ret = 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); 72*803bb384SAndrew Lunn val = (value * 0x5f / LED_FULL) & 0x7f; 739e84561cSMike Rapoport val |= (led->flags & DA9034_LED_RAMP) ? 0x80 : 0; 74*803bb384SAndrew Lunn ret = da903x_write(led->master, DA9034_LED1_CONTROL + offset, 75*803bb384SAndrew Lunn val); 769e84561cSMike Rapoport break; 779e84561cSMike Rapoport case DA9034_ID_VIBRA: 78*803bb384SAndrew Lunn val = value & 0xfe; 79*803bb384SAndrew Lunn ret = da903x_write(led->master, DA9034_VIBRA, val); 809e84561cSMike Rapoport break; 819e84561cSMike Rapoport } 829e84561cSMike Rapoport 83*803bb384SAndrew Lunn return ret; 849e84561cSMike Rapoport } 859e84561cSMike Rapoport 8698ea1ea2SBill Pemberton static int da903x_led_probe(struct platform_device *pdev) 879e84561cSMike Rapoport { 8887aae1eaSJingoo Han struct led_info *pdata = dev_get_platdata(&pdev->dev); 899e84561cSMike Rapoport struct da903x_led *led; 909e84561cSMike Rapoport int id, ret; 919e84561cSMike Rapoport 929e84561cSMike Rapoport if (pdata == NULL) 939e84561cSMike Rapoport return 0; 949e84561cSMike Rapoport 959e84561cSMike Rapoport id = pdev->id; 969e84561cSMike Rapoport 979e84561cSMike Rapoport if (!((id >= DA9030_ID_LED_1 && id <= DA9030_ID_VIBRA) || 989e84561cSMike Rapoport (id >= DA9034_ID_LED_1 && id <= DA9034_ID_VIBRA))) { 999e84561cSMike Rapoport dev_err(&pdev->dev, "invalid LED ID (%d) specified\n", id); 1009e84561cSMike Rapoport return -EINVAL; 1019e84561cSMike Rapoport } 1029e84561cSMike Rapoport 103bad1c898SBryan Wu led = devm_kzalloc(&pdev->dev, sizeof(struct da903x_led), GFP_KERNEL); 1040c9a03b6SXiubo Li if (!led) 1059e84561cSMike Rapoport return -ENOMEM; 1069e84561cSMike Rapoport 1079e84561cSMike Rapoport led->cdev.name = pdata->name; 1089e84561cSMike Rapoport led->cdev.default_trigger = pdata->default_trigger; 109*803bb384SAndrew Lunn led->cdev.brightness_set_blocking = da903x_led_set; 1109e84561cSMike Rapoport led->cdev.brightness = LED_OFF; 1119e84561cSMike Rapoport 1129e84561cSMike Rapoport led->id = id; 1139e84561cSMike Rapoport led->flags = pdata->flags; 1149e84561cSMike Rapoport led->master = pdev->dev.parent; 1159e84561cSMike Rapoport 1169e84561cSMike Rapoport ret = led_classdev_register(led->master, &led->cdev); 1179e84561cSMike Rapoport if (ret) { 1189e84561cSMike Rapoport dev_err(&pdev->dev, "failed to register LED %d\n", id); 119bad1c898SBryan Wu return ret; 1209e84561cSMike Rapoport } 1219e84561cSMike Rapoport 1229e84561cSMike Rapoport platform_set_drvdata(pdev, led); 1239e84561cSMike Rapoport return 0; 1249e84561cSMike Rapoport } 1259e84561cSMike Rapoport 126678e8a6bSBill Pemberton static int da903x_led_remove(struct platform_device *pdev) 1279e84561cSMike Rapoport { 1289e84561cSMike Rapoport struct da903x_led *led = platform_get_drvdata(pdev); 1299e84561cSMike Rapoport 1309e84561cSMike Rapoport led_classdev_unregister(&led->cdev); 1319e84561cSMike Rapoport return 0; 1329e84561cSMike Rapoport } 1339e84561cSMike Rapoport 1349e84561cSMike Rapoport static struct platform_driver da903x_led_driver = { 1359e84561cSMike Rapoport .driver = { 1369e84561cSMike Rapoport .name = "da903x-led", 1379e84561cSMike Rapoport }, 1389e84561cSMike Rapoport .probe = da903x_led_probe, 139df07cf81SBill Pemberton .remove = da903x_led_remove, 1409e84561cSMike Rapoport }; 1419e84561cSMike Rapoport 142892a8843SAxel Lin module_platform_driver(da903x_led_driver); 1439e84561cSMike Rapoport 1449e84561cSMike Rapoport MODULE_DESCRIPTION("LEDs driver for Dialog Semiconductor DA9030/DA9034"); 145141bfeeaSSachin Kamat MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"); 146141bfeeaSSachin Kamat MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>"); 1479e84561cSMike Rapoport MODULE_LICENSE("GPL"); 1489e84561cSMike Rapoport MODULE_ALIAS("platform:da903x-led"); 149