X-Git-Url: https://git.rohieb.name/openwrt.git/blobdiff_plain/5febfb77522efc6ccfd1db6a93faa486ee50d653..20abafaaf5fdb4dd7cb1e09a028b1c2c689557b7:/target/linux/danube/files/drivers/char/danube_led.c?ds=inline diff --git a/target/linux/danube/files/drivers/char/danube_led.c b/target/linux/danube/files/drivers/char/danube_led.c index 531c7ed0c..86a92d599 100644 --- a/target/linux/danube/files/drivers/char/danube_led.c +++ b/target/linux/danube/files/drivers/char/danube_led.c @@ -18,1361 +18,180 @@ * */ -#include #include #include #include #include #include -#include #include #include #include #include +#include +#include +#include -/* - * Chip Specific Head File - */ -#include - -#include -#include - - -/* - * #################################### - * Definition - * #################################### - */ - -#define DEBUG_ON_AMAZON 0 - -#define DATA_CLOCKING_EDGE FALLING_EDGE +#define DANUBE_LED_CLK_EDGE DANUBE_LED_FALLING +//#define DANUBE_LED_CLK_EDGE DANUBE_LED_RISING -#define BOARD_TYPE REFERENCE_BOARD +#define DANUBE_LED_SPEED DANUBE_LED_8HZ -#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 DANUBE_LED_GPIO_PORT 0 -#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 +static int danube_led_major; -#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 u32*)(DANUBE_LED + 0x0000)) -#define DANUBE_LED_CON1 ((volatile u32*)(DANUBE_LED + 0x0004)) -#define DANUBE_LED_CPU0 ((volatile u32*)(DANUBE_LED + 0x0008)) -#define DANUBE_LED_CPU1 ((volatile u32*)(DANUBE_LED + 0x000C)) -#define DANUBE_LED_AR ((volatile u32*)(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 - - -/* - * #################################### - * Preparation of Debug on Amazon Chip - * #################################### - */ - -/* - * 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 - - -/* - * #################################### - * Declaration - * #################################### - */ - -/* - * 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 u32 set_update_source(u32, unsigned long, unsigned long); -static inline u32 set_blink_in_batch(u32, unsigned long, unsigned long); -static inline u32 set_data_clock_edge(u32, unsigned long); -static inline u32 set_update_clock(u32, unsigned long, unsigned long); -static inline u32 set_store_mode(u32, unsigned long); -static inline u32 set_shift_clock(u32, unsigned long); -static inline u32 set_data_offset(u32, unsigned long); -static inline u32 set_number_of_enabled_led(u32, unsigned long); -static inline u32 set_data_in_batch(u32, unsigned long, unsigned long); -static inline u32 set_access_right(u32, 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); - - -/* - * #################################### - * Local Variable - * #################################### - */ - -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; - - -/* - * #################################### - * Global Variable - * #################################### - */ - - -/* - * #################################### - * Local Function - * #################################### - */ - -static int led_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) +void +danube_led_set (unsigned int led) { - int ret = -EINVAL; - struct led_config_param param; - - switch ( cmd ) - { - case LED_CONFIG: - copy_from_user(¶m, (char*)arg, sizeof(param)); - ret = danube_led_config(¶m); - break; - } - - return ret; + led &= 0xffffff; + writel(readl(DANUBE_LED_CPU0) | led, DANUBE_LED_CPU0); } +EXPORT_SYMBOL(danube_led_set); -static int led_open(struct inode *inode, struct file *file) +void +danube_led_clear (unsigned int led) { - return 0; + led = ~(led & 0xffffff); + writel(readl(DANUBE_LED_CPU0) & led, DANUBE_LED_CPU0); } +EXPORT_SYMBOL(danube_led_clear); -static int led_release(struct inode *inode, struct file *file) +void +danube_led_blink_set (unsigned int led) { - return 0; + led &= 0xffffff; + writel(readl(DANUBE_LED_CON0) | led, DANUBE_LED_CON0); } +EXPORT_SYMBOL(danube_led_blink_set); -/* - * Description: - * Update LEDs with data stored in register. - * Input: - * none - * Output: - * int --- 0: Success - * else: Error Code - */ -static inline int update_led(void) +void +danube_led_blink_clear (unsigned int led) { - 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; + led = ~(led & 0xffffff); + writel(readl(DANUBE_LED_CON0) & led, DANUBE_LED_CON0); } +EXPORT_SYMBOL(danube_led_blink_clear); -/* - * Description: - * Select update source for LED bit 0 and bit 1. - * Input: - * reg --- u32, the original register value going to be modified. - * led --- unsigned long, bit 0 stands for LED 0, and bit 1 stands for - * LED 1. If the bit is set, the source value is valid, else - * the source value is invalid. - * source --- unsigned long, bit 0 stands for LED 0, and bit 1 stands for - * LED 1. If the corresponding is cleared, LED is updated with - * value in data register, else LED is updated with ARC module. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_update_source(u32 reg, unsigned long led, unsigned long source) +void +danube_led_setup_gpio (void) { - return (reg & ~((led & 0x03) << 24)) | ((source & 0x03) << 24); -} + int i = 0; -/* - * Description: - * Define which of the LEDs should change their value based on the US pulse. - * Input: - * reg --- u32, the original register value going to be modified. - * mask --- unsigned long, if the corresponding bit is set, the blink value - * is valid, else the blink value is invalid. - * blink --- unsigned long, if the corresponding bit is set, the LED should - * change its value based on the US pulse. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_blink_in_batch(u32 reg, unsigned long mask, unsigned long blink) -{ - return (reg & (~(mask & 0x00FFFFFF) & 0x87FFFFFF)) | (blink & 0x00FFFFFF); + /* 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 u32 set_data_clock_edge(u32 reg, unsigned long f_on_rising_edge) +static int +led_ioctl (struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) { - return f_on_rising_edge ? (reg & ~(1 << 26)) : (reg | (1 << 26)); -} + int ret = -EINVAL; -/* - * Description: - * Select the clock source for US pulse. - * Input: - * reg --- u32, the original register value going to be modified. - * clock --- unsigned long, there 3 available values: - * 0x00 - use software update bit (SWU) as source. - * 0x01 - use GPT2 as clock source. - * 0x02 - use FPI as clock source. - * fpid --- unsigned long, if FPI is selected as clock source, this field - * specify the divider. Please refer to specification for detail - * description. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_update_clock(u32 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; -} + switch ( cmd ) + { + } -/* - * Description: - * Set the behavior of the LED_ST (shift register) signal. - * Input: - * reg --- u32, the original register value going to be modified. - * mode --- unsigned long, there 2 available values: - * zero - LED controller generate single pulse. - * non-zero - LED controller generate inverted shift clock. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_store_mode(u32 reg, unsigned long mode) -{ - return mode ? (reg | (1 << 28)) : (reg & ~(1 << 28)); + return ret; } -/* - * Description: - * Select the clock source for shift clock LED_SH. - * Input: - * reg --- u32, the original register value going to be modified. - * fpis --- unsigned long, if FPI is selected as clock source, this field - * specify the divider. Please refer to specification for detail - * description. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_shift_clock(u32 reg, unsigned long fpis) +static int +led_open (struct inode *inode, struct file *file) { - return SET_BITS(reg, 21, 20, fpis); + return 0; } -/* - * Description: - * Set the clock cycle offset before data is transmitted to LED_D pin. - * Input: - * reg --- u32, the original register value going to be modified. - * offset --- unsigned long, the number of clock cycles would be inserted - * before data is transmitted to LED_D pin. Zero means no cycle - * inserted. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_data_offset(u32 reg, unsigned long offset) -{ - return SET_BITS(reg, 19, 18, offset); -} - -/* - * Description: - * Enable or disable LEDs. - * Input: - * reg --- u32, the original register value going to be modified. - * number --- unsigned long, the number of LED to be enabled. This field - * could 0, 8, 16 or 24. Zero means disable all LEDs. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_number_of_enabled_led(u32 reg, unsigned long number) -{ - u32 bit_mask; - - bit_mask = number > 16 ? 0x07 : (number > 8 ? 0x03 : (number ? 0x01 : 0x00)); - return (reg & ~0x07) | bit_mask; -} - -/* - * Description: - * Turn on/off LEDs. - * Input: - * reg --- u32, the original register value going to be modified. - * mask --- unsigned long, if the corresponding bit is set, the data value - * is valid, else the data value is invalid. - * data --- unsigned long, if the corresponding bit is set, the LED should - * be on, else be off. - * Output: - * u32 --- The updated register value. - */ -static inline u32 set_data_in_batch(u32 reg, unsigned long mask, unsigned long data) -{ - return (reg & ~(mask & 0x00FFFFFF)) | (data & 0x00FFFFFF); -} - -static inline u32 set_access_right(u32 reg, unsigned long mask, unsigned long ar) -{ - return (reg & ~(mask & 0x00FFFFFF)) | (~ar & mask); -} - -/* - * Description: - * Enable LED control module. - * Input: - * none - * Output: - * none - */ -static inline void enable_led(void) -{ -#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 -} - -/* - * Description: - * Disable LED control module. - * Input: - * none - * Output: - * none - */ -static inline void disable_led(void) -{ -#if !defined(DEBUG_ON_AMAZON) || !DEBUG_ON_AMAZON - /* Inactivating LED module in PMU. */ - *(unsigned long *)0xBF10201C |= 1 << 11; -#endif -} - -/* - * Description: - * If LEDs are enabled, GPIO must be setup to enable LED pins. - * Input: - * none - * Output: - * int --- 0: Success - * else: Error Code - */ -static inline int setup_gpio_port(unsigned long adsl) -{ -#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; -} - -/* - * Description: - * If LEDs are all disabled, GPIO must be released so that other application - * could reuse it. - * Input: - * none - * Output: - * none - */ -static inline void release_gpio_port(unsigned long adsl) -{ -#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 -} - -/* - * Description: - * If shifter or update select GPT as clock source, this function would be - * invoked to setup corresponding GPT module. - * Attention please, this function is not working since the GPTU driver is - * not ready. - * Input: - * timer --- int, index of timer. - * freq --- unsigned long, frequency of timer (0.001Hz). This value will be - * rounded off to nearest possible value. - * Output: - * int --- 0: Success - * else: Error Code - */ -static inline int setup_gpt(int timer, unsigned long freq) -{ - int ret; - -#if 0 - timer = TIMER(timer, 0); -#else - timer = TIMER(timer, 1); // 2B -#endif - -#if 0 - ret = set_timer(timer, freq, 1, 0, TIMER_FLAG_NO_HANDLE, 0, 0); -#else - 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); - -#endif -// printk("setup_gpt: timer = %d, freq = %d, return = %d\n", timer, freq, ret); - if ( !ret ) - { - ret = start_timer(timer, 0); - if ( ret ) - free_timer(timer); - } - - return ret; -} - -/* - * Description: - * If shifter or update select other clock source, allocated GPT must be - * released so that other application can use it. - * Attention please, this function is not working since the GPTU driver is - * not ready. - * Input: - * none - * Output: - * none - */ -static inline void release_gpt(int timer) -{ -#if 0 - timer = TIMER(timer, 0); -#else - timer = TIMER(timer, 1); -#endif - stop_timer(timer); - free_timer(timer); -} - -static inline int turn_on_led(unsigned long adsl) -{ - int ret; - - ret = setup_gpio_port(adsl); - if ( ret ) - return ret; - - enable_led(); - - return 0; -} - -static inline void turn_off_led(unsigned long adsl) -{ - release_gpio_port(adsl); - disable_led(); -} - - -/* - * #################################### - * Global Function - * #################################### - */ - -/* - * Description: - * Define which of the LEDs should change its value based on the US pulse. - * Input: - * led --- unsigned int, index of the LED to be set. - * blink --- unsigned int, zero means normal mode, and non-zero means blink - * mode. - * Output: - * int --- 0: Success - * else: Error Code - */ -int danube_led_set_blink(unsigned int led, unsigned int blink) +static int +led_release (struct inode *inode, struct file *file) { - u32 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; } -/* - * Description: - * Turn on/off LED. - * Input: - * led --- unsigned int, index of the LED to be set. - * data --- unsigned int, zero means off, and non-zero means on. - * Output: - * int --- 0: Success - * else: Error Code - */ -int danube_led_set_data(unsigned int led, unsigned int data) -{ - unsigned long f_update; - u32 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); +static struct file_operations danube_led_fops = { + .owner = THIS_MODULE, + .ioctl = led_ioctl, + .open = led_open, + .release = led_release +}; - return f_update ? update_led() : 0; -} /* - * Description: - * Config LED controller. - * Input: - * param --- struct led_config_param*, the members are listed below: - * operation_mask - Select operations to be performed - * led - LED to change update source - * source - Corresponding update source - * blink_mask - LEDs to set blink mode - * blink - Set to blink mode or normal mode - * update_clock - Select the source of update clock - * fpid - If FPI is the source of update clock, set the divider - * store_mode - Set clock mode or single pulse mode for store signal - * fpis - If FPI is the source of shift clock, set the divider - * data_offset - Set cycles to be inserted before data is transmitted - * number_of_enabled_led - Total number of LED to be enabled - * data_mask - LEDs to set value - * data - Corresponding value - * mips0_access_mask - LEDs to set access right - * mips0_access; - 1: the corresponding data is output from MIPS0, 0: MIPS1 - * f_data_clock_on_rising - 1: data clock on rising edge, 0: data clock on falling edge - * Output: - * int --- 0: Success - * else: Error Code - */ -int danube_led_config(struct led_config_param* param) -{ - int ret; - u32 reg_con0, reg_con1, reg_cpu0, reg_ar; - u32 clean_reg_con0, clean_reg_con1, clean_reg_cpu0, clean_reg_ar; - u32 f_setup_gpt2; - u32 f_software_update; - u32 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); - } +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 +*/ - /* 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 ) - { -#if 1 - printk("Setup GPIO error!\n"); -#endif - goto SETUP_GPIO_ERROR; - } - adsl_on = new_adsl_on; - f_led_on = 1; - } - -#if 0 - if ( (reg_con0 & 0x80000000) ) - printk("software update\n"); -#endif - - /* 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 - -#if 0 - #if !defined(DEBUG_ON_AMAZON) || !DEBUG_ON_AMAZON - printk("*0xBF10201C = 0x%08lX\n", *(unsigned long *)0xBF10201C); - printk("*0xBE100B18 = 0x%08lX\n", *(unsigned long *)0xBE100B18); - printk("*0xBE100B1C = 0x%08lX\n", *(unsigned long *)0xBE100B1C); - printk("*0xBE100B20 = 0x%08lX\n", *(unsigned long *)0xBE100B20); - printk("*0xBE100B24 = 0x%08lX\n", *(unsigned long *)0xBE100B24); - #endif - printk("*DANUBE_LED_CON0 = 0x%08X\n", *DANUBE_LED_CON0); - printk("*DANUBE_LED_CON1 = 0x%08X\n", *DANUBE_LED_CON1); - printk("*DANUBE_LED_CPU0 = 0x%08X\n", *DANUBE_LED_CPU0); - printk("*DANUBE_LED_CPU1 = 0x%08X\n", *DANUBE_LED_CPU1); - printk("*DANUBE_LED_AR = 0x%08X\n", *DANUBE_LED_AR); -#endif - - up(&led_sem); - return 0; - -SETUP_GPIO_ERROR: - release_gpt(2); - gpt_on = 0; -SETUP_GPT_ERROR: - up(&led_sem); - return ret; - -INVALID_PARAM: - up(&led_sem); - return -EINVAL; -} - - -/* - * #################################### - * Init/Cleanup API - * #################################### - */ - -/* - * Description: - * register device - * Input: - * none - * Output: - * 0 --- successful - * else --- failure, usually it is negative value of error code - */ -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(¶m); - param.operation_mask = CONFIG_OPERATION_DATA; - param.data_mask = 1 << 4; - param.data = 1 << 4; - danube_led_config(¶m); -#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(¶m); + 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(¶m); + goto out; + } - // turn on USB - param.operation_mask = CONFIG_OPERATION_DATA; - param.data_mask = 1 << 5; - param.data = 1 << 5; - danube_led_config(¶m); + printk(KERN_INFO "danube_led : device registered on major %d\n", danube_led_major); - return 0; +out: + return ret; } -/* - * Description: - * deregister device - * Input: - * none - * Output: - * none - */ -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); -