linux-imx

/*

 * LEDs driver for Freescale MC13783/MC13892/MC34708

 *

 * Copyright (C) 2010 Philippe Rétornaz

 *

 * Based on leds-da903x:

 * 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/of.h>

#include <linux/mfd/mc13xxx.h>

​

struct mc13xxx_led_devtype {

    int led_min;

    int led_max;

    int num_regs;

    u32 ledctrl_base;

};

​

struct mc13xxx_led {

    struct led_classdev cdev;

    int         id;

    struct mc13xxx_leds *leds;

};

​

struct mc13xxx_leds {

    struct mc13xxx          *master;

    struct mc13xxx_led_devtype  *devtype;

    int             num_leds;

    struct mc13xxx_led      *led;

};

​

static unsigned int mc13xxx_max_brightness(int id)

{

    if (id >= MC13783_LED_MD && id <= MC13783_LED_KP)

        return 0x0f;

    else if (id >= MC13783_LED_R1 && id <= MC13783_LED_B3)

        return 0x1f;

​

    return 0x3f;

}

​

static int mc13xxx_led_set(struct led_classdev *led_cdev,

                enum led_brightness value)

{

    struct mc13xxx_led *led =

        container_of(led_cdev, struct mc13xxx_led, cdev);

    struct mc13xxx_leds *leds = led->leds;

    unsigned int reg, bank, off, shift;

​

    switch (led->id) {

    case MC13783_LED_MD:

    case MC13783_LED_AD:

    case MC13783_LED_KP:

        reg = 2;

        shift = 9 + (led->id - MC13783_LED_MD) * 4;

        break;

    case MC13783_LED_R1:

    case MC13783_LED_G1:

    case MC13783_LED_B1:

    case MC13783_LED_R2:

    case MC13783_LED_G2:

    case MC13783_LED_B2:

    case MC13783_LED_R3:

    case MC13783_LED_G3:

    case MC13783_LED_B3:

        off = led->id - MC13783_LED_R1;

        bank = off / 3;

        reg = 3 + bank;

        shift = (off - bank * 3) * 5 + 6;

        break;

    case MC13892_LED_MD:

    case MC13892_LED_AD:

    case MC13892_LED_KP:

        off = led->id - MC13892_LED_MD;

        reg = off / 2;

        shift = 3 + (off - reg * 2) * 12;

        break;

    case MC13892_LED_R:

    case MC13892_LED_G: