linux-imx

/*

 * LED driver for Marvell 88PM860x

 *

 * Copyright (C) 2009 Marvell International Ltd.

 *  Haojian Zhuang <haojian.zhuang@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/kernel.h>

#include <linux/of.h>

#include <linux/platform_device.h>

#include <linux/i2c.h>

#include <linux/leds.h>

#include <linux/slab.h>

#include <linux/mfd/88pm860x.h>

#include <linux/module.h>

​

#define LED_PWM_MASK        (0x1F)

#define LED_CURRENT_MASK    (0x07 << 5)

​

#define LED_BLINK_MASK      (0x7F)

​

#define LED_ON_CONTINUOUS   (0x0F << 3)

​

#define LED1_BLINK_EN       (1 << 1)

#define LED2_BLINK_EN       (1 << 2)

​

struct pm860x_led {

    struct led_classdev cdev;

    struct i2c_client *i2c;

    struct pm860x_chip *chip;

    struct mutex lock;

    char name[MFD_NAME_SIZE];

​

    int port;

    int iset;

    unsigned char brightness;

    unsigned char current_brightness;

​

    int reg_control;

    int reg_blink;

    int blink_mask;

};

​

static int led_power_set(struct pm860x_chip *chip, int port, int on)

{

    int ret = -EINVAL;

​

    switch (port) {

    case 0:

    case 1:

    case 2:

        ret = on ? pm8606_osc_enable(chip, RGB1_ENABLE) :

            pm8606_osc_disable(chip, RGB1_ENABLE);

        break;

    case 3:

    case 4:

    case 5:

        ret = on ? pm8606_osc_enable(chip, RGB2_ENABLE) :

            pm8606_osc_disable(chip, RGB2_ENABLE);

        break;

    }

    return ret;

}

​

static int pm860x_led_set(struct led_classdev *cdev,

               enum led_brightness value)

{

    struct pm860x_led *led = container_of(cdev, struct pm860x_led, cdev);

    struct pm860x_chip *chip;

    unsigned char buf[3];

    int ret;

​

    chip = led->chip;

    mutex_lock(&led->lock);

    led->brightness = value >> 3;

​

    if ((led->current_brightness == 0) && led->brightness) {

        led_power_set(chip, led->port, 1);

        if (led->iset) {

            pm860x_set_bits(led->i2c, led->reg_control,

                    LED_CURRENT_MASK, led->iset);

        }

        pm860x_set_bits(led->i2c, led->reg_blink,

                LED_BLINK_MASK, LED_ON_CONTINUOUS);

        pm860x_set_bits(led->i2c, PM8606_WLED3B, led->blink_mask,

                led->blink_mask);

    }