From 809bc0321fd97187df0ea2838caf857c56d3952a Mon Sep 17 00:00:00 2001 From: John Crispin Date: Thu, 13 Dec 2007 23:05:45 +0000 Subject: [PATCH] more danube led clean up SVN-Revision: 9746 --- .../danube/files/drivers/char/danube_led.c | 235 ++++++++---------- .../files/include/asm-mips/danube/danube.h | 4 +- 2 files changed, 104 insertions(+), 135 deletions(-) diff --git a/target/linux/danube/files/drivers/char/danube_led.c b/target/linux/danube/files/drivers/char/danube_led.c index ba53abfbf9..9cefe8e94b 100644 --- a/target/linux/danube/files/drivers/char/danube_led.c +++ b/target/linux/danube/files/drivers/char/danube_led.c @@ -29,8 +29,7 @@ #include #include #include -#include -#include +#include #include #define LED_CONFIG 0x01 @@ -79,17 +78,6 @@ extern int danube_led_config(struct led_config_param *); #define RISING_EDGE 0 #define FALLING_EDGE 1 -#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 - #define LED_SH_PORT 0 #define LED_SH_PIN 4 #define LED_SH_DIR 1 @@ -134,138 +122,112 @@ extern int danube_led_config(struct led_config_param *); #endif #if LED_SH_DIR - #define LED_SH_DIR_SETUP port_set_dir_out + #define LED_SH_DIR_SETUP danube_port_set_dir_out #else - #define LED_SH_DIR_SETUP port_clear_dir_out + #define LED_SH_DIR_SETUP danube_port_clear_dir_out #endif #if LED_SH_ALTSEL0 - #define LED_SH_ALTSEL0_SETUP port_set_altsel0 + #define LED_SH_ALTSEL0_SETUP danube_port_set_altsel0 #else - #define LED_SH_ALTSEL0_SETUP port_clear_altsel0 + #define LED_SH_ALTSEL0_SETUP danube_port_clear_altsel0 #endif #if LED_SH_ALTSEL1 - #define LED_SH_ALTSEL1_SETUP port_set_altsel1 + #define LED_SH_ALTSEL1_SETUP danube_port_set_altsel1 #else - #define LED_SH_ALTSEL1_SETUP port_clear_altsel1 + #define LED_SH_ALTSEL1_SETUP danube_port_clear_altsel1 #endif #if LED_SH_OPENDRAIN - #define LED_SH_OPENDRAIN_SETUP port_set_open_drain + #define LED_SH_OPENDRAIN_SETUP danube_port_set_open_drain #else - #define LED_SH_OPENDRAIN_SETUP port_clear_open_drain + #define LED_SH_OPENDRAIN_SETUP danube_port_clear_open_drain #endif #if LED_D_DIR - #define LED_D_DIR_SETUP port_set_dir_out + #define LED_D_DIR_SETUP danube_port_set_dir_out #else - #define LED_D_DIR_SETUP port_clear_dir_out + #define LED_D_DIR_SETUP danube_port_clear_dir_out #endif #if LED_D_ALTSEL0 - #define LED_D_ALTSEL0_SETUP port_set_altsel0 + #define LED_D_ALTSEL0_SETUP danube_port_set_altsel0 #else - #define LED_D_ALTSEL0_SETUP port_clear_altsel0 + #define LED_D_ALTSEL0_SETUP danube_port_clear_altsel0 #endif #if LED_D_ALTSEL1 - #define LED_D_ALTSEL1_SETUP port_set_altsel1 + #define LED_D_ALTSEL1_SETUP danube_port_set_altsel1 #else - #define LED_D_ALTSEL1_SETUP port_clear_altsel1 + #define LED_D_ALTSEL1_SETUP danube_port_clear_altsel1 #endif #if LED_D_OPENDRAIN - #define LED_D_OPENDRAIN_SETUP port_set_open_drain + #define LED_D_OPENDRAIN_SETUP danube_port_set_open_drain #else - #define LED_D_OPENDRAIN_SETUP port_clear_open_drain + #define LED_D_OPENDRAIN_SETUP danube_port_clear_open_drain #endif #if LED_ST_DIR - #define LED_ST_DIR_SETUP port_set_dir_out + #define LED_ST_DIR_SETUP danube_port_set_dir_out #else - #define LED_ST_DIR_SETUP port_clear_dir_out + #define LED_ST_DIR_SETUP danube_port_clear_dir_out #endif #if LED_ST_ALTSEL0 - #define LED_ST_ALTSEL0_SETUP port_set_altsel0 + #define LED_ST_ALTSEL0_SETUP danube_port_set_altsel0 #else - #define LED_ST_ALTSEL0_SETUP port_clear_altsel0 + #define LED_ST_ALTSEL0_SETUP danube_port_clear_altsel0 #endif #if LED_ST_ALTSEL1 - #define LED_ST_ALTSEL1_SETUP port_set_altsel1 + #define LED_ST_ALTSEL1_SETUP danube_port_set_altsel1 #else - #define LED_ST_ALTSEL1_SETUP port_clear_altsel1 + #define LED_ST_ALTSEL1_SETUP danube_port_clear_altsel1 #endif #if LED_ST_OPENDRAIN - #define LED_ST_OPENDRAIN_SETUP port_set_open_drain + #define LED_ST_OPENDRAIN_SETUP danube_port_set_open_drain #else - #define LED_ST_OPENDRAIN_SETUP port_clear_open_drain + #define LED_ST_OPENDRAIN_SETUP danube_port_clear_open_drain #endif #if LED_ADSL0_DIR - #define LED_ADSL0_DIR_SETUP port_set_dir_out + #define LED_ADSL0_DIR_SETUP danube_port_set_dir_out #else - #define LED_ADSL0_DIR_SETUP port_clear_dir_out + #define LED_ADSL0_DIR_SETUP danube_port_clear_dir_out #endif #if LED_ADSL0_ALTSEL0 - #define LED_ADSL0_ALTSEL0_SETUP port_set_altsel0 + #define LED_ADSL0_ALTSEL0_SETUP danube_port_set_altsel0 #else - #define LED_ADSL0_ALTSEL0_SETUP port_clear_altsel0 + #define LED_ADSL0_ALTSEL0_SETUP danube_port_clear_altsel0 #endif #if LED_ADSL0_ALTSEL1 - #define LED_ADSL0_ALTSEL1_SETUP port_set_altsel1 + #define LED_ADSL0_ALTSEL1_SETUP danube_port_set_altsel1 #else - #define LED_ADSL0_ALTSEL1_SETUP port_clear_altsel1 + #define LED_ADSL0_ALTSEL1_SETUP danube_port_clear_altsel1 #endif #if LED_ADSL0_OPENDRAIN - #define LED_ADSL0_OPENDRAIN_SETUP port_set_open_drain + #define LED_ADSL0_OPENDRAIN_SETUP danube_port_set_open_drain #else - #define LED_ADSL0_OPENDRAIN_SETUP port_clear_open_drain + #define LED_ADSL0_OPENDRAIN_SETUP danube_port_clear_open_drain #endif #if LED_ADSL1_DIR - #define LED_ADSL1_DIR_SETUP port_set_dir_out + #define LED_ADSL1_DIR_SETUP danube_port_set_dir_out #else - #define LED_ADSL1_DIR_SETUP port_clear_dir_out + #define LED_ADSL1_DIR_SETUP danube_port_clear_dir_out #endif #if LED_ADSL1_ALTSEL0 - #define LED_ADSL1_ALTSEL0_SETUP port_set_altsel0 + #define LED_ADSL1_ALTSEL0_SETUP danube_port_set_altsel0 #else - #define LED_ADSL1_ALTSEL0_SETUP port_clear_altsel0 + #define LED_ADSL1_ALTSEL0_SETUP danube_port_clear_altsel0 #endif #if LED_ADSL1_ALTSEL1 - #define LED_ADSL1_ALTSEL1_SETUP port_set_altsel1 + #define LED_ADSL1_ALTSEL1_SETUP danube_port_set_altsel1 #else - #define LED_ADSL1_ALTSEL1_SETUP port_clear_altsel1 + #define LED_ADSL1_ALTSEL1_SETUP danube_port_clear_altsel1 #endif #if LED_ADSL1_OPENDRAIN - #define LED_ADSL1_OPENDRAIN_SETUP port_set_open_drain + #define LED_ADSL1_OPENDRAIN_SETUP danube_port_set_open_drain #else - #define LED_ADSL1_OPENDRAIN_SETUP port_clear_open_drain + #define LED_ADSL1_OPENDRAIN_SETUP danube_port_clear_open_drain #endif #define SET_BITS(x, msb, lsb, value) (((x) & ~(((1 << ((msb) + 1)) - 1) ^ ((1 << (lsb)) - 1))) | (((value) & ((1 << (1 + (msb) - (lsb))) - 1)) << (lsb))) -static inline int update_led(void); - -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); - -static inline void enable_led(void); -static inline void disable_led(void); - -static inline int setup_gpio_port(unsigned long); -static inline void release_gpio_port(unsigned long); - -static inline int setup_gpt(int, unsigned long); -static inline void release_gpt(int); - -static inline int turn_on_led(unsigned long); -static inline void turn_off_led(unsigned long); - - static struct semaphore led_sem; static unsigned long gpt_on = 0; @@ -274,9 +236,6 @@ static unsigned long gpt_freq = 0; static unsigned long adsl_on = 0; static unsigned long f_led_on = 0; -static int module_id; - - static inline int update_led (void) { @@ -331,11 +290,20 @@ 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; + case 0: + reg &= ~0xC0000000; + break; + + case 1: + reg = (reg & ~0xC0000000) | 0x40000000; + break; + + case 2: + reg = (reg & ~0xCF800000) | 0x80000000 | ((fpid & 0x1F) << 23); + break; } - return reg; + + return reg; } static inline unsigned int @@ -383,16 +351,33 @@ enable_led (void) /* Activate LED module in PMU. */ int i = 1000000; - *(unsigned long *)0xBF10201C &= ~(1 << 11); - while ( --i && (*(unsigned long *)0xBF102020 & (1 << 11)) ); - if ( !i ) + writel(readl(DANUBE_PMU_PWDCR) & ~DANUBE_PMU_PWDCR_LED, DANUBE_PMU_PWDCR); + while (--i && (readl(DANUBE_PMU_PWDSR) & DANUBE_PMU_PWDCR_LED)) {} + + if (!i) panic("Activating LED in PMU failed!"); } static inline void disable_led (void) { - *(unsigned long *)0xBF10201C |= 1 << 11; + writel(readl(DANUBE_PMU_PWDCR) | DANUBE_PMU_PWDCR_LED, DANUBE_PMU_PWDCR); +} + +static inline void +release_gpio_port (unsigned long adsl) +{ + if ( adsl ) + { + danube_port_free_pin(LED_ADSL0_PORT, LED_ADSL0_PIN); + danube_port_free_pin(LED_ADSL1_PORT, LED_ADSL1_PIN); + } + else + { + danube_port_free_pin(LED_ST_PORT, LED_ST_PIN); + danube_port_free_pin(LED_D_PORT, LED_D_PIN); + danube_port_free_pin(LED_SH_PORT, LED_SH_PIN); + } } static inline int @@ -405,14 +390,14 @@ setup_gpio_port (unsigned long adsl) */ 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); + ret |= danube_port_reserve_pin(LED_ADSL0_PORT, LED_ADSL0_PIN); + ret |= danube_port_reserve_pin(LED_ADSL1_PORT, LED_ADSL1_PIN); } 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); + ret |= danube_port_reserve_pin(LED_ST_PORT, LED_ST_PIN); + ret |= danube_port_reserve_pin(LED_D_PORT, LED_D_PIN); + ret |= danube_port_reserve_pin(LED_SH_PORT, LED_SH_PIN); } if ( ret ) { @@ -422,15 +407,15 @@ setup_gpio_port (unsigned long adsl) 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); + LED_ADSL0_ALTSEL0_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN); + LED_ADSL0_ALTSEL1_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN); + LED_ADSL0_DIR_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN); + LED_ADSL0_OPENDRAIN_SETUP(LED_ADSL0_PORT, LED_ADSL0_PIN); + + LED_ADSL1_ALTSEL0_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN); + LED_ADSL1_ALTSEL1_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN); + LED_ADSL1_DIR_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN); + LED_ADSL1_OPENDRAIN_SETUP(LED_ADSL1_PORT, LED_ADSL1_PIN); } else { @@ -439,47 +424,31 @@ setup_gpio_port (unsigned long adsl) * 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); + LED_ST_ALTSEL0_SETUP(LED_ST_PORT, LED_ST_PIN); + LED_ST_ALTSEL1_SETUP(LED_ST_PORT, LED_ST_PIN); + LED_ST_DIR_SETUP(LED_ST_PORT, LED_ST_PIN); + LED_ST_OPENDRAIN_SETUP(LED_ST_PORT, LED_ST_PIN); /* * 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); + LED_D_ALTSEL0_SETUP(LED_D_PORT, LED_D_PIN); + LED_D_ALTSEL1_SETUP(LED_D_PORT, LED_D_PIN); + LED_D_DIR_SETUP(LED_D_PORT, LED_D_PIN); + LED_D_OPENDRAIN_SETUP(LED_D_PORT, LED_D_PIN); /* * 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); + LED_SH_ALTSEL0_SETUP(LED_SH_PORT, LED_SH_PIN); + LED_SH_ALTSEL1_SETUP(LED_SH_PORT, LED_SH_PIN); + LED_SH_DIR_SETUP(LED_SH_PORT, LED_SH_PIN); + LED_SH_OPENDRAIN_SETUP(LED_SH_PORT, LED_SH_PIN); } return 0; } -static inline void -release_gpio_port (unsigned long adsl) -{ - 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); - } -} - static inline int setup_gpt (int timer, unsigned long freq) { @@ -880,8 +849,6 @@ danube_led_init (void) printk(KERN_INFO "led: misc_register on minor = %d\n", led_miscdev.minor); } - module_id = THIS_MODULE ? (int)THIS_MODULE : ((MISC_MAJOR << 8) | led_miscdev.minor); - up(&led_sem); /* Add to enable hardware relay */ diff --git a/target/linux/danube/files/include/asm-mips/danube/danube.h b/target/linux/danube/files/include/asm-mips/danube/danube.h index 512ec49309..deb0618ea0 100644 --- a/target/linux/danube/files/include/asm-mips/danube/danube.h +++ b/target/linux/danube/files/include/asm-mips/danube/danube.h @@ -160,9 +160,11 @@ #define DANUBE_PMU_BASE_ADDR (KSEG1 + 0x1F102000) -/* power down control */ #define DANUBE_PMU_PWDCR ((u32*)(DANUBE_PMU_BASE_ADDR + 0x001C)) +#define DANUBE_PMU_PWDSR ((u32*)(DANUBE_PMU_BASE_ADDR + 0x0020)) + #define DANUBE_PMU_PWDCR_DMA 0x20 +#define DANUBE_PMU_PWDCR_LED 0x800 #define DANUBE_PMU_PWDCR_GPT 0x1000 #define DANUBE_PMU_PWDCR_PPE 0x2000 #define DANUBE_PMU_PWDCR_FPI 0x4000 -- 2.30.2