linux-imx

/*

 * LED Driver for the Freecom FSG-3

 *

 * Copyright (c) 2008 Rod Whitby <rod@whitby.id.au>

 *

 * Author: Rod Whitby <rod@whitby.id.au>

 *

 * Based on leds-spitz.c

 * Copyright 2005-2006 Openedhand Ltd.

 * Author: Richard Purdie <rpurdie@openedhand.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/platform_device.h>

#include <linux/leds.h>

#include <linux/module.h>

#include <linux/io.h>

#include <mach/hardware.h>

​

#define FSG_LED_WLAN_BIT    0

#define FSG_LED_WAN_BIT     1

#define FSG_LED_SATA_BIT    2

#define FSG_LED_USB_BIT     4

#define FSG_LED_RING_BIT    5

#define FSG_LED_SYNC_BIT    7

​

static short __iomem *latch_address;

static unsigned short latch_value;

​

​

static void fsg_led_wlan_set(struct led_classdev *led_cdev,

                 enum led_brightness value)

{

    if (value) {

        latch_value &= ~(1 << FSG_LED_WLAN_BIT);

        *latch_address = latch_value;

    } else {

        latch_value |=  (1 << FSG_LED_WLAN_BIT);

        *latch_address = latch_value;

    }

}

​

static void fsg_led_wan_set(struct led_classdev *led_cdev,

                enum led_brightness value)

{

    if (value) {

        latch_value &= ~(1 << FSG_LED_WAN_BIT);

        *latch_address = latch_value;

    } else {

        latch_value |=  (1 << FSG_LED_WAN_BIT);

        *latch_address = latch_value;

    }

}

​

static void fsg_led_sata_set(struct led_classdev *led_cdev,

                 enum led_brightness value)

{

    if (value) {