more danube 2 ifxmips transitions

[openwrt.git] / target / linux / danube / files / drivers / char / danube_led.c

diff --git a/target/linux/danube/files/drivers/char/danube_led.c b/target/linux/danube/files/drivers/char/danube_led.c
index f832fa0..86a92d5 100644 (file)
--- a/target/linux/danube/files/drivers/char/danube_led.c
+++ b/target/linux/danube/files/drivers/char/danube_led.c
@@ -18,1082 +18,180 @@
  *
  */
 
  *
  */
 

-#include <linux/config.h>

 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/version.h>
 #include <linux/types.h>
 #include <linux/fs.h>
 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/version.h>
 #include <linux/types.h>
 #include <linux/fs.h>

-#include <linux/miscdevice.h>

 #include <linux/init.h>
 #include <asm/uaccess.h>
 #include <asm/unistd.h>
 #include <linux/errno.h>
 #include <linux/init.h>
 #include <asm/uaccess.h>
 #include <asm/unistd.h>
 #include <linux/errno.h>

+#include <asm/danube/danube.h>
+#include <asm/danube/danube_gpio.h>
+#include <asm/danube/danube_pmu.h>

 
 

-/*
- *  Chip Specific Head File
- */
-#include <asm/danube/port.h>
-
-#include <asm/danube/danube_led.h>
-#include <asm/danube/danube_gptu.h>
-
-
-/*
- * ####################################
- *              Definition
- * ####################################
- */
-
-#define DEBUG_ON_AMAZON                 0
-
-#define DATA_CLOCKING_EDGE              FALLING_EDGE
-
-#define BOARD_TYPE                      REFERENCE_BOARD
-
-#define DEBUG_WRITE_REGISTER            0
-
-#define RISING_EDGE                     0
-#define FALLING_EDGE                    1
-
-#define EVALUATION_BOARD                0
-#define REFERENCE_BOARD                 1
-
-/*
- *  GPIO Driver Function Wrapping
- */
-#define port_reserve_pin                danube_port_reserve_pin
-#define port_free_pin                   danube_port_free_pin
-#define port_set_altsel0                danube_port_set_altsel0
-#define port_clear_altsel0              danube_port_clear_altsel0
-#define port_set_altsel1                danube_port_set_altsel1
-#define port_clear_altsel1              danube_port_clear_altsel1
-#define port_set_dir_out                danube_port_set_dir_out
-#define port_clear_dir_out              danube_port_clear_dir_out
-#define port_set_open_drain             danube_port_set_open_drain
-#define port_clear_open_drain           danube_port_clear_open_drain
-
-/*
- *  GPIO Port Used By LED
- */
-#define LED_SH_PORT                     0
-#define LED_SH_PIN                      4
-#define LED_SH_DIR                      1
-#define LED_SH_ALTSEL0                  1
-#define LED_SH_ALTSEL1                  0
-#define LED_SH_OPENDRAIN                1
-#define LED_D_PORT                      0
-#define LED_D_PIN                       5
-#define LED_D_DIR                       1
-#define LED_D_ALTSEL0                   1
-#define LED_D_ALTSEL1                   0
-#define LED_D_OPENDRAIN                 1
-#define LED_ST_PORT                     0
-#define LED_ST_PIN                      6
-#define LED_ST_DIR                      1
-#define LED_ST_ALTSEL0                  1
-#define LED_ST_ALTSEL1                  0
-#define LED_ST_OPENDRAIN                1
-
-#define LED_ADSL0_PORT                  0
-#define LED_ADSL0_PIN                   4
-#define LED_ADSL0_DIR                   1
-#define LED_ADSL0_ALTSEL0               0
-#define LED_ADSL0_ALTSEL1               1
-#define LED_ADSL0_OPENDRAIN             1
-#define LED_ADSL1_PORT                  0
-#define LED_ADSL1_PIN                   5
-#define LED_ADSL1_DIR                   1
-#define LED_ADSL1_ALTSEL0               1
-#define LED_ADSL1_ALTSEL1               1
-#define LED_ADSL1_OPENDRAIN             1
-
-#if (LED_SH_PORT == LED_ADSL0_PORT && LED_SH_PIN == LED_ADSL0_PIN)      \
-    || (LED_D_PORT == LED_ADSL0_PORT && LED_D_PIN == LED_ADSL0_PIN)     \
-    || (LED_ST_PORT == LED_ADSL0_PORT && LED_ST_PIN == LED_ADSL0_PIN)   \
-    || (LED_SH_PORT == LED_ADSL1_PORT && LED_SH_PIN == LED_ADSL1_PIN)   \
-    || (LED_D_PORT == LED_ADSL1_PORT && LED_D_PIN == LED_ADSL1_PIN)     \
-    || (LED_ST_PORT == LED_ADSL1_PORT && LED_ST_PIN == LED_ADSL1_PIN)
-  #define ADSL_LED_IS_EXCLUSIVE         1
-#else
-  #define ADSL_LED_IS_EXCLUSIVE         0
-#endif
-
-/*
- *  Define GPIO Functions
- */
-#if LED_SH_DIR
-  #define LED_SH_DIR_SETUP              port_set_dir_out
-#else
-  #define LED_SH_DIR_SETUP              port_clear_dir_out
-#endif
-#if LED_SH_ALTSEL0
-  #define LED_SH_ALTSEL0_SETUP          port_set_altsel0
-#else
-  #define LED_SH_ALTSEL0_SETUP          port_clear_altsel0
-#endif
-#if LED_SH_ALTSEL1
-  #define LED_SH_ALTSEL1_SETUP          port_set_altsel1
-#else
-  #define LED_SH_ALTSEL1_SETUP          port_clear_altsel1
-#endif
-#if LED_SH_OPENDRAIN
-  #define LED_SH_OPENDRAIN_SETUP        port_set_open_drain
-#else
-  #define LED_SH_OPENDRAIN_SETUP        port_clear_open_drain
-#endif
-
-#if LED_D_DIR
-  #define LED_D_DIR_SETUP               port_set_dir_out
-#else
-  #define LED_D_DIR_SETUP               port_clear_dir_out
-#endif
-#if LED_D_ALTSEL0
-  #define LED_D_ALTSEL0_SETUP           port_set_altsel0
-#else
-  #define LED_D_ALTSEL0_SETUP           port_clear_altsel0
-#endif
-#if LED_D_ALTSEL1
-  #define LED_D_ALTSEL1_SETUP           port_set_altsel1
-#else
-  #define LED_D_ALTSEL1_SETUP           port_clear_altsel1
-#endif
-#if LED_D_OPENDRAIN
-  #define LED_D_OPENDRAIN_SETUP         port_set_open_drain
-#else
-  #define LED_D_OPENDRAIN_SETUP         port_clear_open_drain
-#endif
-
-#if LED_ST_DIR
-  #define LED_ST_DIR_SETUP              port_set_dir_out
-#else
-  #define LED_ST_DIR_SETUP              port_clear_dir_out
-#endif
-#if LED_ST_ALTSEL0
-  #define LED_ST_ALTSEL0_SETUP          port_set_altsel0
-#else
-  #define LED_ST_ALTSEL0_SETUP          port_clear_altsel0
-#endif
-#if LED_ST_ALTSEL1
-  #define LED_ST_ALTSEL1_SETUP          port_set_altsel1
-#else
-  #define LED_ST_ALTSEL1_SETUP          port_clear_altsel1
-#endif
-#if LED_ST_OPENDRAIN
-  #define LED_ST_OPENDRAIN_SETUP        port_set_open_drain
-#else
-  #define LED_ST_OPENDRAIN_SETUP        port_clear_open_drain
-#endif
-
-#if LED_ADSL0_DIR
-  #define LED_ADSL0_DIR_SETUP           port_set_dir_out
-#else
-  #define LED_ADSL0_DIR_SETUP           port_clear_dir_out
-#endif
-#if LED_ADSL0_ALTSEL0
-  #define LED_ADSL0_ALTSEL0_SETUP       port_set_altsel0
-#else
-  #define LED_ADSL0_ALTSEL0_SETUP       port_clear_altsel0
-#endif
-#if LED_ADSL0_ALTSEL1
-  #define LED_ADSL0_ALTSEL1_SETUP       port_set_altsel1
-#else
-  #define LED_ADSL0_ALTSEL1_SETUP       port_clear_altsel1
-#endif
-#if LED_ADSL0_OPENDRAIN
-  #define LED_ADSL0_OPENDRAIN_SETUP     port_set_open_drain
-#else
-  #define LED_ADSL0_OPENDRAIN_SETUP     port_clear_open_drain
-#endif
-
-#if LED_ADSL1_DIR
-  #define LED_ADSL1_DIR_SETUP           port_set_dir_out
-#else
-  #define LED_ADSL1_DIR_SETUP           port_clear_dir_out
-#endif
-#if LED_ADSL1_ALTSEL0
-  #define LED_ADSL1_ALTSEL0_SETUP       port_set_altsel0
-#else
-  #define LED_ADSL1_ALTSEL0_SETUP       port_clear_altsel0
-#endif
-#if LED_ADSL1_ALTSEL1
-  #define LED_ADSL1_ALTSEL1_SETUP       port_set_altsel1
-#else
-  #define LED_ADSL1_ALTSEL1_SETUP       port_clear_altsel1
-#endif
-#if LED_ADSL1_OPENDRAIN
-  #define LED_ADSL1_OPENDRAIN_SETUP     port_set_open_drain
-#else
-  #define LED_ADSL1_OPENDRAIN_SETUP     port_clear_open_drain
-#endif
-
-/*
- *  LED Device Minor Number
- */
-#if !defined(LED_MINOR)
-    #define LED_MINOR                   151 //  This number is written in Linux kernel document "devices.txt"
-#endif  //  !defined(LED_MINOR)
-
-/*
- *  Bits Operation
- */
-#define GET_BITS(x, msb, lsb)           (((x) & ((1 << ((msb) + 1)) - 1)) >> (lsb))
-#define SET_BITS(x, msb, lsb, value)    (((x) & ~(((1 << ((msb) + 1)) - 1) ^ ((1 << (lsb)) - 1))) | (((value) & ((1 << (1 + (msb) - (lsb))) - 1)) << (lsb)))
-
-/*
- *  LED Registers Mapping
- */
-#define DANUBE_LED                      (KSEG1 + 0x1E100BB0)
-#define DANUBE_LED_CON0                 ((volatile unsigned int*)(DANUBE_LED + 0x0000))
-#define DANUBE_LED_CON1                 ((volatile unsigned int*)(DANUBE_LED + 0x0004))
-#define DANUBE_LED_CPU0                 ((volatile unsigned int*)(DANUBE_LED + 0x0008))
-#define DANUBE_LED_CPU1                 ((volatile unsigned int*)(DANUBE_LED + 0x000C))
-#define DANUBE_LED_AR                   ((volatile unsigned int*)(DANUBE_LED + 0x0010))
-
-/*
- *  LED Control 0 Register
- */
-#define LED_CON0_SWU                    (*DANUBE_LED_CON0 & (1 << 31))
-#define LED_CON0_FALLING_EDGE           (*DANUBE_LED_CON0 & (1 << 26))
-#define LED_CON0_AD1                    (*DANUBE_LED_CON0 & (1 << 25))
-#define LED_CON0_AD0                    (*DANUBE_LED_CON0 & (1 << 24))
-#define LED_CON0_LBn(n)                 (*DANUBE_LED_CON0 & (1 << n))
-#define LED_CON0_DEFAULT_VALUE          (0x80000000 | (DATA_CLOCKING_EDGE << 26))
-
-/*
- *  LED Control 1 Register
- */
-#define LED_CON1_US                     (*DANUBE_LED_CON1 >> 30)
-#define LED_CON1_SCS                    (*DANUBE_LED_CON1 & (1 << 28))
-#define LED_CON1_FPID                   GET_BITS(*DANUBE_LED_CON1, 27, 23)
-#define LED_CON1_FPIS                   GET_BITS(*DANUBE_LED_CON1, 21, 20)
-#define LED_CON1_DO                     GET_BITS(*DANUBE_LED_CON1, 19, 18)
-#define LED_CON1_G2                     (*DANUBE_LED_CON1 & (1 << 2))
-#define LED_CON1_G1                     (*DANUBE_LED_CON1 & (1 << 1))
-#define LED_CON1_G0                     (*DANUBE_LED_CON1 & 0x01)
-#define LED_CON1_G                      (*DANUBE_LED_CON1 & 0x07)
-#define LED_CON1_DEFAULT_VALUE          0x00000000
-
-/*
- *  LED Data Output CPU 0 Register
- */
-#define LED_CPU0_Ln(n)                  (*DANUBE_LED_CPU0 & (1 << n))
-#define LED_LED_CPU0_DEFAULT_VALUE      0x00000000
-
-/*
- *  LED Data Output CPU 1 Register
- */
-#define LED_CPU1_Ln(n)                  (*DANUBE_LED_CPU1 & (1 << n))
-#define LED_LED_CPU1_DEFAULT_VALUE      0x00000000
-
-/*
- *  LED Data Output Access Rights Register
- */
-#define LED_AR_Ln(n)                    (*DANUBE_LED_AR & (1 << n))
-#define LED_AR_DEFAULT_VALUE            0x00000000
-
-/*
- *  If try module on Amazon chip, prepare some tricks to prevent invalid memory write.
- */
-#if defined(DEBUG_ON_AMAZON) && DEBUG_ON_AMAZON
-    char g_pFakeRegisters[0x50];
-
-    #undef  DEBUG_WRITE_REGISTER
-
-    #undef  DANUBE_LED
-    #define DANUBE_LED                  g_pFakeRegisters
-
-    #undef  port_reserve_pin
-    #undef  port_free_pin
-    #undef  port_set_altsel0
-    #undef  port_clear_altsel0
-    #undef  port_set_altsel1
-    #undef  port_clear_altsel1
-    #undef  port_set_dir_out
-
-    #define port_reserve_pin            amazon_port_reserve_pin
-    #define port_free_pin               amazon_port_free_pin
-    #define port_set_altsel0            amazon_port_set_altsel0
-    #define port_clear_altsel0          amazon_port_clear_altsel0
-    #define port_set_altsel1            amazon_port_set_altsel1
-    #define port_clear_altsel1          amazon_port_clear_altsel1
-    #define port_set_dir_out            amazon_port_set_dir_out
-#endif  //  defined(DEBUG_ON_AMAZON) && DEBUG_ON_AMAZON
-
-
-/*
- *  File Operations
- */
-static int led_ioctl(struct inode *, struct file *, unsigned int, unsigned long);
-static int led_open(struct inode *, struct file *);
-static int led_release(struct inode *, struct file *);
-
-/*
- *  Software Update LED
- */
-static inline int update_led(void);
-
-/*
- *  LED Configuration Functions
- */
-static inline unsigned int set_update_source(unsigned int, unsigned long, unsigned long);
-static inline unsigned int set_blink_in_batch(unsigned int, unsigned long, unsigned long);
-static inline unsigned int set_data_clock_edge(unsigned int, unsigned long);
-static inline unsigned int set_update_clock(unsigned int, unsigned long, unsigned long);
-static inline unsigned int set_store_mode(unsigned int, unsigned long);
-static inline unsigned int set_shift_clock(unsigned int, unsigned long);
-static inline unsigned int set_data_offset(unsigned int, unsigned long);
-static inline unsigned int set_number_of_enabled_led(unsigned int, unsigned long);
-static inline unsigned int set_data_in_batch(unsigned int, unsigned long, unsigned long);
-static inline unsigned int set_access_right(unsigned int, unsigned long, unsigned long);
-
-/*
- *  PMU Operation
- */
-static inline void enable_led(void);
-static inline void disable_led(void);
-
-/*
- *  GPIO Setup & Release
- */
-static inline int setup_gpio_port(unsigned long);
-static inline void release_gpio_port(unsigned long);
-
-/*
- *  GPT Setup & Release
- */
-static inline int setup_gpt(int, unsigned long);
-static inline void release_gpt(int);
-
-/*
- *  Turn On/Off LED
- */
-static inline int turn_on_led(unsigned long);
-static inline void turn_off_led(unsigned long);
-
-
-static struct semaphore led_sem;
-
-static struct file_operations led_fops = {
-    owner:      THIS_MODULE,
-    ioctl:      led_ioctl,
-    open:       led_open,
-    release:    led_release
-};
-
-static struct miscdevice led_miscdev = {
-    LED_MINOR,
-    "led",
-    &led_fops,
-    NULL,
-    NULL,
-    NULL
-};
-
-static unsigned long gpt_on = 0;
-static unsigned long gpt_freq = 0;
-
-static unsigned long adsl_on = 0;
-static unsigned long f_led_on = 0;
-
-static int module_id;
-
-
-static int
-led_ioctl (struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
-{
-    int ret = -EINVAL;
-    struct led_config_param param;
-
-    switch ( cmd )
-    {
-    case LED_CONFIG:
-        copy_from_user(&param, (char*)arg, sizeof(param));
-        ret = danube_led_config(&param);
-        break;
-    }
-
-    return ret;
-}
-
-static int
-led_open (struct inode *inode, struct file *file)
-{
-    return 0;
-}
+#define DANUBE_LED_CLK_EDGE                            DANUBE_LED_FALLING
+//#define DANUBE_LED_CLK_EDGE                  DANUBE_LED_RISING

 
 

-static int
-led_release (struct inode *inode, struct file *file)
-{
-    return 0;
-}
-
-static inline int
-update_led (void)
-{
-    int i, j;
-
-    /*
-     *  GPT2 or FPID is the clock to update LEDs automatically.
-     */
-    if ( LED_CON1_US != 0 )
-        return 0;
-
-    /*
-     *  Check the status to prevent conflict of two consecutive update
-     */
-    for ( i = 100000; i != 0; i -= j / 16 )
-    {
-        down(&led_sem);
-        if ( !LED_CON0_SWU )
-        {
-            *DANUBE_LED_CON0 |= 1 << 31;
-            up(&led_sem);
-            return 0;
-        }
-        else
-            up(&led_sem);
-        for ( j = 0; j < 1000 * 16; j++ );
-    }
-
-    return -EBUSY;
-}
-
-static inline unsigned int
-set_update_source (unsigned int reg, unsigned long led, unsigned long source)
-{
-    return (reg & ~((led & 0x03) << 24)) | ((source & 0x03) << 24);
-}
-
-static inline unsigned int
-set_blink_in_batch (unsigned int reg, unsigned long mask, unsigned long blink)
-{
-    return (reg & (~(mask & 0x00FFFFFF) & 0x87FFFFFF)) | (blink & 0x00FFFFFF);
-}
-
-static inline unsigned int
-set_data_clock_edge (unsigned int reg, unsigned long f_on_rising_edge)
-{
-    return f_on_rising_edge ? (reg & ~(1 << 26)) : (reg | (1 << 26));
-}
-
-static inline unsigned int
-set_update_clock (unsigned int reg, unsigned long clock, unsigned long fpid)
-{
-    switch ( clock )
-    {
-    case 0: reg &= ~0xC0000000; break;
-    case 1: reg = (reg & ~0xC0000000) | 0x40000000; break;
-    case 2: reg = (reg & ~0xCF800000) | 0x80000000 | ((fpid & 0x1F) << 23); break;
-    }
-    return reg;
-}
-
-static inline unsigned int
-set_store_mode (unsigned int reg, unsigned long mode)
-{
-    return mode ? (reg | (1 << 28)) : (reg & ~(1 << 28));
-}
-
-static inline
-unsigned int set_shift_clock (unsigned int reg, unsigned long fpis)
-{
-    return SET_BITS(reg, 21, 20, fpis);
-}
+#define DANUBE_LED_SPEED                               DANUBE_LED_8HZ

 
 

-static inline
-unsigned int set_data_offset (unsigned int reg, unsigned long offset)
-{
-    return SET_BITS(reg, 19, 18, offset);
-}
+#define DANUBE_LED_GPIO_PORT   0

 
 

-static inline
-unsigned int set_number_of_enabled_led (unsigned int reg, unsigned long number)
-{
-    unsigned int bit_mask;
-
-    bit_mask = number > 16 ? 0x07 : (number > 8 ? 0x03 : (number ? 0x01 : 0x00));
-    return (reg & ~0x07) | bit_mask;
-}
-
-static inline unsigned int
-set_data_in_batch (unsigned int reg, unsigned long mask, unsigned long data)
-{
-    return (reg & ~(mask & 0x00FFFFFF)) | (data & 0x00FFFFFF);
-}
-
-static inline unsigned int
-set_access_right (unsigned int reg, unsigned long mask, unsigned long ar)
-{
-    return (reg & ~(mask & 0x00FFFFFF)) | (~ar & mask);
-}
+static int danube_led_major;

 
 

-static inline void
-enable_led (void)
+void
+danube_led_set (unsigned int led)

 {
 {

-#if !defined(DEBUG_ON_AMAZON) || !DEBUG_ON_AMAZON
-    /*  Activate LED module in PMU. */
-    int i = 1000000;
-
-    *(unsigned long *)0xBF10201C &= ~(1 << 11);
-    while ( --i && (*(unsigned long *)0xBF102020 & (1 << 11)) );
-    if ( !i )
-        panic("Activating LED in PMU failed!");
-#endif
+       led &= 0xffffff;
+       writel(readl(DANUBE_LED_CPU0) | led, DANUBE_LED_CPU0);

 }
 }

+EXPORT_SYMBOL(danube_led_set);

 
 

-static inline void
-disable_led (void)
+void
+danube_led_clear (unsigned int led)

 {
 {

-#if !defined(DEBUG_ON_AMAZON) || !DEBUG_ON_AMAZON
-    /*  Inactivating LED module in PMU.    */
-    *(unsigned long *)0xBF10201C |= 1 << 11;
-#endif
+       led = ~(led & 0xffffff);
+       writel(readl(DANUBE_LED_CPU0) & led, DANUBE_LED_CPU0);

 }
 }

+EXPORT_SYMBOL(danube_led_clear);

 
 

-static inline int
-setup_gpio_port (unsigned long adsl)
+void
+danube_led_blink_set (unsigned int led)

 {
 {

-#if !defined(DEBUG_ON_AMAZON) || !DEBUG_ON_AMAZON
-    int ret = 0;
-
-  #if defined(DEBUG_WRITE_REGISTER) && DEBUG_WRITE_REGISTER
-    if ( adsl )
-    {
-        *(unsigned long *)0xBE100B18 |=  0x30;
-        *(unsigned long *)0xBE100B1C |=  0x20;
-        *(unsigned long *)0xBE100B1C &= ~0x10;
-        *(unsigned long *)0xBE100B20 |=  0x30;
-        *(unsigned long *)0xBE100B24 |=  0x30;
-    }
-    else
-    {
-        *(unsigned long *)0xBE100B18 |=  0x70;
-        *(unsigned long *)0xBE100B1C |=  0x70;
-        *(unsigned long *)0xBE100B20 &= ~0x70;
-        *(unsigned long *)0xBE100B24 |=  0x70;
-    }
-  #else
-
-    /*
-     *  Reserve all pins before config them.
-     */
-    if ( adsl )
-    {
-        ret |= port_reserve_pin(LED_ADSL0_PORT, LED_ADSL0_PIN, module_id);
-        ret |= port_reserve_pin(LED_ADSL1_PORT, LED_ADSL1_PIN, module_id);
-    }
-    else
-    {
-        ret |= port_reserve_pin(LED_ST_PORT, LED_ST_PIN, module_id);
-        ret |= port_reserve_pin(LED_D_PORT, LED_D_PIN, module_id);
-        ret |= port_reserve_pin(LED_SH_PORT, LED_SH_PIN, module_id);
-    }
-    if ( ret )
-    {
-        release_gpio_port(adsl);
-        return ret; //  Should be -EBUSY
-    }
-
-    if ( adsl )
-    {
-        LED_ADSL0_ALTSEL0_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN, module_id);
-        LED_ADSL0_ALTSEL1_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN, module_id);
-        LED_ADSL0_DIR_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN, module_id);
-        LED_ADSL0_OPENDRAIN_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN, module_id);
-
-        LED_ADSL1_ALTSEL0_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN, module_id);
-        LED_ADSL1_ALTSEL1_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN, module_id);
-        LED_ADSL1_DIR_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN, module_id);
-        LED_ADSL1_OPENDRAIN_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN, module_id);
-    }
-    else
-    {
-        /*
-         *  Set LED_ST
-         *    I don't check the return value, because I'm sure the value is valid
-         *    and the pins are reserved already.
-         */
-        LED_ST_ALTSEL0_SETUP(LED_ST_PORT, LED_ST_PIN, module_id);
-        LED_ST_ALTSEL1_SETUP(LED_ST_PORT, LED_ST_PIN, module_id);
-        LED_ST_DIR_SETUP(LED_ST_PORT, LED_ST_PIN, module_id);
-        LED_ST_OPENDRAIN_SETUP(LED_ST_PORT, LED_ST_PIN, module_id);
-
-        /*
-         *  Set LED_D
-         */
-        LED_D_ALTSEL0_SETUP(LED_D_PORT, LED_D_PIN, module_id);
-        LED_D_ALTSEL1_SETUP(LED_D_PORT, LED_D_PIN, module_id);
-        LED_D_DIR_SETUP(LED_D_PORT, LED_D_PIN, module_id);
-        LED_D_OPENDRAIN_SETUP(LED_D_PORT, LED_D_PIN, module_id);
-
-        /*
-         *  Set LED_SH
-         */
-        LED_SH_ALTSEL0_SETUP(LED_SH_PORT, LED_SH_PIN, module_id);
-        LED_SH_ALTSEL1_SETUP(LED_SH_PORT, LED_SH_PIN, module_id);
-        LED_SH_DIR_SETUP(LED_SH_PORT, LED_SH_PIN, module_id);
-        LED_SH_OPENDRAIN_SETUP(LED_SH_PORT, LED_SH_PIN, module_id);
-    }
-  #endif
-#endif
-
-    return 0;
+       led &= 0xffffff;
+       writel(readl(DANUBE_LED_CON0) | led, DANUBE_LED_CON0);

 }
 }

+EXPORT_SYMBOL(danube_led_blink_set);

 
 

-static inline void
-release_gpio_port (unsigned long adsl)
+void
+danube_led_blink_clear (unsigned int led)

 {
 {

-#if !defined(DEBUG_ON_AMAZON) || !DEBUG_ON_AMAZON
-  #if !defined(DEBUG_WRITE_REGISTER) || !DEBUG_WRITE_REGISTER
-    if ( adsl )
-    {
-        port_free_pin(LED_ADSL0_PORT, LED_ADSL0_PIN, module_id);
-        port_free_pin(LED_ADSL1_PORT, LED_ADSL1_PIN, module_id);
-    }
-    else
-    {
-        port_free_pin(LED_ST_PORT, LED_ST_PIN, module_id);
-        port_free_pin(LED_D_PORT, LED_D_PIN, module_id);
-        port_free_pin(LED_SH_PORT, LED_SH_PIN, module_id);
-    }
-  #endif
-#endif
+       led = ~(led & 0xffffff);
+       writel(readl(DANUBE_LED_CON0) & led, DANUBE_LED_CON0);

 }
 }

+EXPORT_SYMBOL(danube_led_blink_clear);

 
 

-static inline int
-setup_gpt (int timer, unsigned long freq)
+void
+danube_led_setup_gpio (void)

 {
 {

-    int ret;
-
-    timer = TIMER(timer, 1);
-
-    ret  = request_timer(timer,
-                           TIMER_FLAG_SYNC
-                         | TIMER_FLAG_16BIT
-                         | TIMER_FLAG_INT_SRC
-                         | TIMER_FLAG_CYCLIC | TIMER_FLAG_COUNTER | TIMER_FLAG_DOWN
-                         | TIMER_FLAG_ANY_EDGE
-                         | TIMER_FLAG_NO_HANDLE,
-                         8000000 / freq,
-                         0,
-                         0);
+       int i = 0;

 
 

-    if ( !ret )
-    {
-        ret = start_timer(timer, 0);
-        if ( ret )
-            free_timer(timer);
-    }
-
-    return ret;
+       /* we need to setup pins SH,D,ST (4,5,6) */
+       for (i = 4; i < 7; i++)
+       {
+               danube_port_set_altsel0(DANUBE_LED_GPIO_PORT, i);
+               danube_port_clear_altsel1(DANUBE_LED_GPIO_PORT, i);
+               danube_port_set_dir_out(DANUBE_LED_GPIO_PORT, i);
+               danube_port_set_open_drain(DANUBE_LED_GPIO_PORT, i);
+       }

 }
 
 }
 

-static inline void
-release_gpt (int timer)
-{
-    timer = TIMER(timer, 1);
-    stop_timer(timer);
-    free_timer(timer);
-}
-
-static inline int
-turn_on_led (unsigned long adsl)
+static int
+led_ioctl (struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)

 {
 {

-    int ret;
-
-    ret = setup_gpio_port(adsl);
-    if ( ret )
-        return ret;
+       int ret = -EINVAL;

 
 

-    enable_led();
+       switch ( cmd )
+       {
+       }

 
 

-    return 0;
-}
-
-static inline void
-turn_off_led (unsigned long adsl)
-{
-    release_gpio_port(adsl);
-    disable_led();
+       return ret;

 }
 
 }
 

-
-int
-danube_led_set_blink (unsigned int led, unsigned int blink)
+static int
+led_open (struct inode *inode, struct file *file)

 {
 {

-    unsigned int bit_mask;
-
-    if ( led > 23 )
-        return -EINVAL;
-
-    bit_mask = 1 << led;
-    down(&led_sem);
-    if ( blink )
-        *DANUBE_LED_CON0 |= bit_mask;
-    else
-        *DANUBE_LED_CON0 &= ~bit_mask;
-    up(&led_sem);
-
-    return (led == 0 && LED_CON0_AD0) || (led == 1 && LED_CON0_AD1) ? -EINVAL : 0;
+       return 0;

 }
 
 }
 

-int
-danube_led_set_data (unsigned int led, unsigned int data)
+static int
+led_release (struct inode *inode, struct file *file)

 {
 {

-    unsigned long f_update;
-    unsigned int bit_mask;
-
-    if ( led > 23 )
-        return -EINVAL;
-
-    bit_mask = 1 << led;
-    down(&led_sem);
-    if ( data )
-        *DANUBE_LED_CPU0 |= bit_mask;
-    else
-        *DANUBE_LED_CPU0 &= ~bit_mask;
-    f_update = !(*DANUBE_LED_AR & bit_mask);
-    up(&led_sem);
-
-    return f_update ? update_led() : 0;
+       return 0;

 }
 
 }
 

-int
-danube_led_config (struct led_config_param* param)
-{
-    int ret;
-    unsigned int reg_con0, reg_con1, reg_cpu0, reg_ar;
-    unsigned int clean_reg_con0, clean_reg_con1, clean_reg_cpu0, clean_reg_ar;
-    unsigned int f_setup_gpt2;
-    unsigned int f_software_update;
-    unsigned int new_led_on, new_adsl_on;
-
-    if ( !param )
-        return -EINVAL;
-
-    down(&led_sem);
-
-    reg_con0 = *DANUBE_LED_CON0;
-    reg_con1 = *DANUBE_LED_CON1;
-    reg_cpu0 = *DANUBE_LED_CPU0;
-    reg_ar   = *DANUBE_LED_AR;
-
-    clean_reg_con0 = 1;
-    clean_reg_con1 = 1;
-    clean_reg_cpu0 = 1;
-    clean_reg_ar   = 1;
-
-    f_setup_gpt2 = 0;
-
-    f_software_update = LED_CON0_SWU ? 0 : 1;
-
-    new_led_on = f_led_on;
-    new_adsl_on = adsl_on;
-
-    /*  ADSL or LED */
-    if ( (param->operation_mask & CONFIG_OPERATION_UPDATE_SOURCE) )
-    {
-        if ( param->led > 0x03 || param->source > 0x03 )
-            goto INVALID_PARAM;
-        clean_reg_con0 = 0;
-        reg_con0 = set_update_source(reg_con0, param->led, param->source);
-#if 0   //  ADSL0,1 is source for bit 0, 1 in shift register
-        new_adsl_on = param->source;
-#endif
-    }
-
-    /*  Blink   */
-    if ( (param->operation_mask & CONFIG_OPERATION_BLINK) )
-    {
-        if ( (param->blink_mask & 0xFF000000) || (param->blink & 0xFF000000) )
-            goto INVALID_PARAM;
-        clean_reg_con0 = 0;
-        reg_con0 = set_blink_in_batch(reg_con0, param->blink_mask, param->blink);
-    }
-
-    /*  Edge    */
-    if ( (param->operation_mask & CONFIG_DATA_CLOCK_EDGE) )
-    {
-        clean_reg_con0 = 0;
-        reg_con0 = set_data_clock_edge(reg_con0, param->f_data_clock_on_rising);
-    }
-
-    /*  Update Clock    */
-    if ( (param->operation_mask & CONFIG_OPERATION_UPDATE_CLOCK) )
-    {
-        if ( param->update_clock > 0x02 || (param->update_clock == 0x02 && param->fpid > 0x3) )
-            goto INVALID_PARAM;
-        clean_reg_con1 = 0;
-        f_software_update = param->update_clock == 0 ? 1 : 0;
-        if ( param->update_clock == 0x01 )
-            f_setup_gpt2 = 1;
-        reg_con1 = set_update_clock(reg_con1, param->update_clock, param->fpid);
-    }
-
-    /*  Store Mode  */
-    if ( (param->operation_mask & CONFIG_OPERATION_STORE_MODE) )
-    {
-        clean_reg_con1 = 0;
-        reg_con1 = set_store_mode(reg_con1, param->store_mode);
-    }
-
-    /*  Shift Clock */
-    if ( (param->operation_mask & CONFIG_OPERATION_SHIFT_CLOCK) )
-    {
-        if ( param->fpis > 0x03 )
-            goto INVALID_PARAM;
-        clean_reg_con1 = 0;
-        reg_con1 = set_shift_clock(reg_con1, param->fpis);
-    }
-
-    /*  Data Offset */
-    if ( (param->operation_mask & CONFIG_OPERATION_DATA_OFFSET) )
-    {
-        if ( param->data_offset > 0x03 )
-            goto INVALID_PARAM;
-        clean_reg_con1 = 0;
-        reg_con1 = set_data_offset(reg_con1, param->data_offset);
-    }
-
-    /*  Number of LED   */
-    if ( (param->operation_mask & CONFIG_OPERATION_NUMBER_OF_LED) )
-    {
-        if ( param->number_of_enabled_led > 0x24 )
-            goto INVALID_PARAM;
-
-        /*
-         *  If there is at lease one LED enabled, the GPIO pin must be setup.
-         */
-        new_led_on = param->number_of_enabled_led ? 1 : 0;
-
-        clean_reg_con1 = 0;
-        reg_con1 = set_number_of_enabled_led(reg_con1, param->number_of_enabled_led);
-    }
-
-    /*  LED Data    */
-    if ( (param->operation_mask & CONFIG_OPERATION_DATA) )
-    {
-        if ( (param->data_mask & 0xFF000000) || (param->data & 0xFF000000) )
-            goto INVALID_PARAM;
-        clean_reg_cpu0 = 0;
-        reg_cpu0 = set_data_in_batch(reg_cpu0, param->data_mask, param->data);
-        if ( f_software_update )
-        {
-            clean_reg_con0 = 0;
-            reg_con0 |= 0x80000000;
-        }
-    }
-
-    /*  Access Right    */
-    if ( (param->operation_mask & CONFIG_OPERATION_MIPS0_ACCESS) )
-    {
-        if ( (param->mips0_access_mask & 0xFF000000) || (param->mips0_access & 0xFF000000) )
-            goto INVALID_PARAM;
-        clean_reg_ar = 0;
-        reg_ar = set_access_right(reg_ar, param->mips0_access_mask, param->mips0_access);
-    }
-
-    /*  Setup GPT   */
-    if ( f_setup_gpt2 && !new_adsl_on )     //  If ADSL led is on, GPT is disabled.
-    {
-        ret = 0;
-
-        if ( gpt_on )
-        {
-            if ( gpt_freq != param->fpid )
-            {
-                release_gpt(2);
-                gpt_on = 0;
-                ret = setup_gpt(2, param->fpid);
-            }
-        }
-        else
-            ret = setup_gpt(2, param->fpid);
-
-        if ( ret )
-        {
-#if 1
-            printk("Setup GPT error!\n");
-#endif
-            goto SETUP_GPT_ERROR;
-        }
-        else
-        {
-#if 0
-            printk("Setup GPT successfully!\n");
-#endif
-            gpt_on = 1;
-        }
-    }
-    else
-        if ( gpt_on )
-        {
-            release_gpt(2);
-            gpt_on = 0;
-        }
-
-    /*  Turn on LED */
-    if ( new_adsl_on )
-        new_led_on = 1;
-    if ( !new_led_on || adsl_on != new_adsl_on )
-    {
-        turn_off_led(adsl_on);
-        f_led_on = 0;
-        adsl_on = 0;
-    }
-    if ( !f_led_on && new_led_on )
-    {
-        ret = turn_on_led(new_adsl_on);
-        if ( ret )
-        {
-            printk("Setup GPIO error!\n");
-            goto SETUP_GPIO_ERROR;
-        }
-        adsl_on = new_adsl_on;
-        f_led_on = 1;
-    }
-
-    /*  Write Register  */
-    if ( !f_led_on )
-        enable_led();
-    if ( !clean_reg_ar )
-        *DANUBE_LED_AR   = reg_ar;
-    if ( !clean_reg_cpu0 )
-        *DANUBE_LED_CPU0 = reg_cpu0;
-    if ( !clean_reg_con1 )
-        *DANUBE_LED_CON1 = reg_con1;
-    if ( !clean_reg_con0 )
-        *DANUBE_LED_CON0 = reg_con0;
-    if ( !f_led_on )
-        disable_led();
-
-#if defined(DEBUG_ON_AMAZON) && DEBUG_ON_AMAZON
-    *DANUBE_LED_CON0 &= 0x7FFFFFFF;
-#endif
-
-    up(&led_sem);
-    return 0;
+static struct file_operations danube_led_fops = {
+       .owner = THIS_MODULE,
+       .ioctl = led_ioctl,
+       .open = led_open,
+       .release = led_release
+};

 
 

-SETUP_GPIO_ERROR:
-    release_gpt(2);
-    gpt_on = 0;
-SETUP_GPT_ERROR:
-    up(&led_sem);
-    return ret;

 
 

-INVALID_PARAM:
-    up(&led_sem);
-    return -EINVAL;
-}
+/*
+Map for LED on reference board
+       WLAN_READ     LED11   OUT1    15
+       WARNING       LED12   OUT2    14
+       FXS1_LINK     LED13   OUT3    13
+       FXS2_LINK     LED14   OUT4    12
+       FXO_ACT       LED15   OUT5    11
+       USB_LINK      LED16   OUT6    10
+       ADSL2_LINK    LED19   OUT7    9
+       BT_LINK       LED17   OUT8    8
+       SD_LINK       LED20   OUT9    7
+       ADSL2_TRAFFIC LED31   OUT16   0
+Map for hardware relay on reference board
+       USB Power On          OUT11   5
+       RELAY                 OUT12   4
+*/

 
 
 int __init
 danube_led_init (void)
 {
 
 
 int __init
 danube_led_init (void)
 {

-    int ret;
-    struct led_config_param param = {0};
+       int ret = 0;

 
 

-    enable_led();
+       danube_led_setup_gpio();

 
 

-    /*
-     *  Set default value to registers to turn off all LED light.
-     */
-    *DANUBE_LED_AR   = LED_AR_DEFAULT_VALUE;
-    *DANUBE_LED_CPU0 = LED_LED_CPU0_DEFAULT_VALUE;
-    *DANUBE_LED_CPU1 = LED_LED_CPU1_DEFAULT_VALUE;
-    *DANUBE_LED_CON1 = LED_CON1_DEFAULT_VALUE;
-    *DANUBE_LED_CON0 = LED_CON0_DEFAULT_VALUE;
+       writel(0, DANUBE_LED_AR);
+       writel(0, DANUBE_LED_CPU0);
+       writel(0, DANUBE_LED_CPU1);
+       writel(LED_CON0_SWU, DANUBE_LED_CON0);
+       writel(0, DANUBE_LED_CON1);

 
 

-#if defined(DEBUG_ON_AMAZON) && DEBUG_ON_AMAZON
-    *DANUBE_LED_CON0 &= 0x7FFFFFFF;
-#endif
+       /* setup the clock edge that the shift register is triggered on */
+       writel(readl(DANUBE_LED_CON0) & ~DANUBE_LED_EDGE_MASK, DANUBE_LED_CON0);
+       writel(readl(DANUBE_LED_CON0) | DANUBE_LED_CLK_EDGE, DANUBE_LED_CON0);

 
 

-    disable_led();
+       /* per default leds 15-0 are set */
+       writel(DANUBE_LED_GROUP1 | DANUBE_LED_GROUP0, DANUBE_LED_CON1);

 
 

-    sema_init(&led_sem, 0);
+       /* leds are update periodically by the FPID */
+       writel(readl(DANUBE_LED_CON1) & ~DANUBE_LED_UPD_MASK, DANUBE_LED_CON1);
+       writel(readl(DANUBE_LED_CON1) | DANUBE_LED_UPD_SRC_FPI, DANUBE_LED_CON1);

 
 

-    ret = misc_register(&led_miscdev);
-    if ( ret == -EBUSY )
-    {
-        led_miscdev.minor = MISC_DYNAMIC_MINOR;
-        ret = misc_register(&led_miscdev);
-    }
-    if ( ret )
-    {
-        printk(KERN_ERR "led: can't misc_register\n");
-        return ret;
-    }
-    else
-        printk(KERN_INFO "led: misc_register on minor = %d\n", led_miscdev.minor);
+       /* set led update speed */
+       writel(readl(DANUBE_LED_CON1) & ~DANUBE_LED_MASK, DANUBE_LED_CON1);
+       writel(readl(DANUBE_LED_CON1) | DANUBE_LED_SPEED, DANUBE_LED_CON1);

 
 

-    module_id = THIS_MODULE ? (int)THIS_MODULE : ((MISC_MAJOR << 8) | led_miscdev.minor);
+       /* adsl 0 and 1 leds are updated by the arc */
+       writel(readl(DANUBE_LED_CON0) | DANUBE_LED_ADSL_SRC, DANUBE_LED_CON0);

 
 

-    up(&led_sem);
+       /* per default, the leds are turned on */
+       danube_pmu_enable(DANUBE_PMU_PWDCR_LED);

 
 

-#if BOARD_TYPE == REFERENCE_BOARD
-    /*  Add to enable hardware relay    */
-        /*  Map for LED on reference board
-              WLAN_READ     LED11   OUT1    15
-              WARNING       LED12   OUT2    14
-              FXS1_LINK     LED13   OUT3    13
-              FXS2_LINK     LED14   OUT4    12
-              FXO_ACT       LED15   OUT5    11
-              USB_LINK      LED16   OUT6    10
-              ADSL2_LINK    LED19   OUT7    9
-              BT_LINK       LED17   OUT8    8
-              SD_LINK       LED20   OUT9    7
-              ADSL2_TRAFFIC LED31   OUT16   0
-            Map for hardware relay on reference board
-              USB Power On          OUT11   5
-              RELAY                 OUT12   4
-        */
-    param.operation_mask = CONFIG_OPERATION_NUMBER_OF_LED;
-    param.number_of_enabled_led = 16;
-    danube_led_config(&param);
-    param.operation_mask = CONFIG_OPERATION_DATA;
-    param.data_mask = 1 << 4;
-    param.data = 1 << 4;
-    danube_led_config(&param);
-#endif
+       danube_led_major = register_chrdev(0, "danube_led", &danube_led_fops);

 
 

-    //  by default, update by FSC clock (FPID)
-    param.operation_mask = CONFIG_OPERATION_UPDATE_CLOCK;
-    param.update_clock   = 2;   //  FPID
-    param.fpid           = 3;   //  10Hz
-    danube_led_config(&param);
+       if (!danube_led_major)
+       {
+               printk("danube_led: Error! Could not register device. %d\n", danube_led_major);
+               ret = -EINVAL;

 
 

-    //  source of LED 0, 1 is ADSL
-    param.operation_mask = CONFIG_OPERATION_UPDATE_SOURCE;
-    param.led            = 3;   //  LED 0, 1
-    param.source         = 3;   //  ADSL
-    danube_led_config(&param);
+               goto out;
+       }

 
 

-    //  turn on USB
-    param.operation_mask = CONFIG_OPERATION_DATA;
-    param.data_mask = 1 << 5;
-    param.data = 1 << 5;
-    danube_led_config(&param);
+       printk(KERN_INFO "danube_led : device registered on major %d\n", danube_led_major);

 
 

-    return 0;
+out:
+       return ret;

 }
 
 void __exit
 danube_led_exit (void)
 {
 }
 
 void __exit
 danube_led_exit (void)
 {

-    int ret;
-
-    ret = misc_deregister(&led_miscdev);
-    if ( ret )
-        printk(KERN_ERR "led: can't misc_deregister, get error number %d\n", -ret);
-    else
-        printk(KERN_INFO "led: misc_deregister successfully\n");
+       unregister_chrdev(danube_led_major, "danube_led");

 }
 
 }
 

-EXPORT_SYMBOL(danube_led_set_blink);
-EXPORT_SYMBOL(danube_led_set_data);
-EXPORT_SYMBOL(danube_led_config);
-

 module_init(danube_led_init);
 module_exit(danube_led_exit);
 module_init(danube_led_init);
 module_exit(danube_led_exit);

-