1eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo/* 2eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * TI LP8788 MFD - keyled driver 3eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * 4eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * Copyright 2012 Texas Instruments 5eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * 6eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * Author: Milo(Woogyom) Kim <milo.kim@ti.com> 7eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * 8eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * This program is free software; you can redistribute it and/or modify 9eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * it under the terms of the GNU General Public License version 2 as 10eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * published by the Free Software Foundation. 11eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo * 12eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo */ 13eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 14eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/module.h> 15eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/slab.h> 16eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/err.h> 17eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/platform_device.h> 18eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/leds.h> 19eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/mutex.h> 20eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/mfd/lp8788.h> 21eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#include <linux/mfd/lp8788-isink.h> 22eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 23eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#define MAX_BRIGHTNESS LP8788_ISINK_MAX_PWM 24eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo#define DEFAULT_LED_NAME "keyboard-backlight" 25eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 26eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostruct lp8788_led { 27eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788 *lp; 28eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct mutex lock; 29eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct work_struct work; 30eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct led_classdev led_dev; 31eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enum lp8788_isink_number isink_num; 32eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enum led_brightness brightness; 33eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo int on; 34eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo}; 35eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 36eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostruct lp8788_led_config { 37eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enum lp8788_isink_scale scale; 38eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enum lp8788_isink_number num; 39eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo int iout; 40eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo}; 41eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 42eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostatic struct lp8788_led_config default_led_config = { 43eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo .scale = LP8788_ISINK_SCALE_100mA, 44eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo .num = LP8788_ISINK_3, 45eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo .iout = 0, 46eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo}; 47eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 48eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostatic int lp8788_led_init_device(struct lp8788_led *led, 49eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788_led_platform_data *pdata) 50eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo{ 51eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788_led_config *cfg = &default_led_config; 52eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo u8 addr, mask, val; 53eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo int ret; 54eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 55eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (pdata) { 56eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo cfg->scale = pdata->scale; 57eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo cfg->num = pdata->num; 58eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo cfg->iout = pdata->iout_code; 59eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo } 60eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 61eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->isink_num = cfg->num; 62eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 63eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo /* scale configuration */ 64eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo addr = LP8788_ISINK_CTRL; 65eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo mask = 1 << (cfg->num + LP8788_ISINK_SCALE_OFFSET); 664df7309af6f7988da15fc9a0175fc60b997cc0d7Axel Lin val = cfg->scale << (cfg->num + LP8788_ISINK_SCALE_OFFSET); 67eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo ret = lp8788_update_bits(led->lp, addr, mask, val); 68eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (ret) 69eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return ret; 70eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 71eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo /* current configuration */ 72eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo addr = lp8788_iout_addr[cfg->num]; 73eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo mask = lp8788_iout_mask[cfg->num]; 74eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo val = cfg->iout; 75eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 76eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return lp8788_update_bits(led->lp, addr, mask, val); 77eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo} 78eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 79eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostatic void lp8788_led_enable(struct lp8788_led *led, 80eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enum lp8788_isink_number num, int on) 81eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo{ 82eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo u8 mask = 1 << num; 83eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo u8 val = on << num; 84eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 85eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (lp8788_update_bits(led->lp, LP8788_ISINK_CTRL, mask, val)) 86eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return; 87eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 88eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->on = on; 89eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo} 90eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 91eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostatic void lp8788_led_work(struct work_struct *work) 92eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo{ 93eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788_led *led = container_of(work, struct lp8788_led, work); 94eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enum lp8788_isink_number num = led->isink_num; 95eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo int enable; 96eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo u8 val = led->brightness; 97eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 98eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo mutex_lock(&led->lock); 99eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 100eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo switch (num) { 101eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo case LP8788_ISINK_1: 102eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo case LP8788_ISINK_2: 103eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo case LP8788_ISINK_3: 104eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo lp8788_write_byte(led->lp, lp8788_pwm_addr[num], val); 105eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo break; 106eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo default: 107d45bb11616c94c76c6e40960a120c0687b708a2eDevendra Naga mutex_unlock(&led->lock); 108eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return; 109eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo } 110eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 111eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enable = (val > 0) ? 1 : 0; 112eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (enable != led->on) 113eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo lp8788_led_enable(led, num, enable); 114eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 115eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo mutex_unlock(&led->lock); 116eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo} 117eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 118eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostatic void lp8788_brightness_set(struct led_classdev *led_cdev, 119eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo enum led_brightness brt_val) 120eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo{ 121eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788_led *led = 122eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo container_of(led_cdev, struct lp8788_led, led_dev); 123eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 124eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->brightness = brt_val; 125eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo schedule_work(&led->work); 126eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo} 127eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 12898ea1ea20cb7090d5ae2003c23fc8a7f14fca4c7Bill Pembertonstatic int lp8788_led_probe(struct platform_device *pdev) 129eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo{ 130eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788 *lp = dev_get_drvdata(pdev->dev.parent); 131eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788_led_platform_data *led_pdata; 132eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788_led *led; 133a1932edf8baaf2b09ad72b119c1f9749ad4397f2Kim, Milo struct device *dev = &pdev->dev; 134eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo int ret; 135eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 136a1932edf8baaf2b09ad72b119c1f9749ad4397f2Kim, Milo led = devm_kzalloc(dev, sizeof(struct lp8788_led), GFP_KERNEL); 137eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (!led) 138eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return -ENOMEM; 139eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 140eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->lp = lp; 141eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->led_dev.max_brightness = MAX_BRIGHTNESS; 142eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->led_dev.brightness_set = lp8788_brightness_set; 143eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 144eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led_pdata = lp->pdata ? lp->pdata->led_pdata : NULL; 145eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 146eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (!led_pdata || !led_pdata->name) 147eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->led_dev.name = DEFAULT_LED_NAME; 148eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo else 149eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led->led_dev.name = led_pdata->name; 150eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 151eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo mutex_init(&led->lock); 152eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo INIT_WORK(&led->work, lp8788_led_work); 153eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 154eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo platform_set_drvdata(pdev, led); 155eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 156eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo ret = lp8788_led_init_device(led, led_pdata); 157eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (ret) { 158a1932edf8baaf2b09ad72b119c1f9749ad4397f2Kim, Milo dev_err(dev, "led init device err: %d\n", ret); 159eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return ret; 160eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo } 161eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 162a1932edf8baaf2b09ad72b119c1f9749ad4397f2Kim, Milo ret = led_classdev_register(dev, &led->led_dev); 163eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo if (ret) { 164a1932edf8baaf2b09ad72b119c1f9749ad4397f2Kim, Milo dev_err(dev, "led register err: %d\n", ret); 165eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return ret; 166eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo } 167eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 168eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return 0; 169eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo} 170eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 171678e8a6be911dd8684b894687ae88ff3b0ae4659Bill Pembertonstatic int lp8788_led_remove(struct platform_device *pdev) 172eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo{ 173eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo struct lp8788_led *led = platform_get_drvdata(pdev); 174eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 175eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo led_classdev_unregister(&led->led_dev); 17643829731dd372d04d6706c51052b9dabab9ca356Tejun Heo flush_work(&led->work); 177eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 178eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo return 0; 179eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo} 180eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 181eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milostatic struct platform_driver lp8788_led_driver = { 182eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo .probe = lp8788_led_probe, 183df07cf81268192e42c4cdf91f5f4bf9aaac1b2f0Bill Pemberton .remove = lp8788_led_remove, 184eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo .driver = { 185eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo .name = LP8788_DEV_KEYLED, 186eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo .owner = THIS_MODULE, 187eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo }, 188eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo}; 189eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milomodule_platform_driver(lp8788_led_driver); 190eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, Milo 191eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, MiloMODULE_DESCRIPTION("Texas Instruments LP8788 Keyboard LED Driver"); 192eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, MiloMODULE_AUTHOR("Milo Kim"); 193eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, MiloMODULE_LICENSE("GPL"); 194eb80411b54fde031e9a8b368ff7b32c774ecfc5cKim, MiloMODULE_ALIAS("platform:lp8788-keyled"); 195