qemu/roms/u-boot/board/corscience/tricorder/led.c

   1 /*
   2  * Copyright (c) 2013 Corscience GmbH & Co.KG
   3  * Andreas Bießmann <andreas.biessmann@corscience.de>
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7 #include <common.h>
   8 #include <status_led.h>
   9 #include <twl4030.h>
  10 #include <asm/arch/cpu.h>
  11 #include <asm/io.h>
  12 #include <asm/arch/sys_proto.h>
  13 #include <asm/gpio.h>
  14
  15 #define TRICORDER_STATUS_LED_YELLOW 42
  16 #define TRICORDER_STATUS_LED_GREEN  43
  17
  18 void __led_init(led_id_t mask, int state)
  19 {
  20         __led_set(mask, state);
  21 }
  22
  23 void __led_toggle(led_id_t mask)
  24 {
  25         int toggle_gpio = 0;
  26 #ifdef STATUS_LED_BIT
  27         if (!toggle_gpio && STATUS_LED_BIT & mask)
  28                 toggle_gpio = TRICORDER_STATUS_LED_GREEN;
  29 #endif
  30 #ifdef STATUS_LED_BIT1
  31         if (!toggle_gpio && STATUS_LED_BIT1 & mask)
  32                 toggle_gpio = TRICORDER_STATUS_LED_YELLOW;
  33 #endif
  34 #ifdef STATUS_LED_BIT2
  35         if (!toggle_gpio && STATUS_LED_BIT2 & mask) {
  36                 uint8_t val;
  37                 twl4030_i2c_read_u8(TWL4030_CHIP_LED, TWL4030_LED_LEDEN,
  38                                     &val);
  39                 val ^= (TWL4030_LED_LEDEN_LEDAON | TWL4030_LED_LEDEN_LEDAPWM);
  40                 twl4030_i2c_write_u8(TWL4030_CHIP_LED, TWL4030_LED_LEDEN,
  41                                      val);
  42         }
  43 #endif
  44         if (toggle_gpio) {
  45                 int state;
  46                 gpio_request(toggle_gpio, "");
  47                 state = gpio_get_value(toggle_gpio);
  48                 gpio_set_value(toggle_gpio, !state);
  49         }
  50 }
  51
  52 void __led_set(led_id_t mask, int state)
  53 {
  54 #ifdef STATUS_LED_BIT
  55         if (STATUS_LED_BIT & mask) {
  56                 gpio_request(TRICORDER_STATUS_LED_GREEN, "");
  57                 gpio_direction_output(TRICORDER_STATUS_LED_GREEN, 0);
  58                 gpio_set_value(TRICORDER_STATUS_LED_GREEN, state);
  59         }
  60 #endif
  61 #ifdef STATUS_LED_BIT1
  62         if (STATUS_LED_BIT1 & mask) {
  63                 gpio_request(TRICORDER_STATUS_LED_YELLOW, "");
  64                 gpio_direction_output(TRICORDER_STATUS_LED_YELLOW, 0);
  65                 gpio_set_value(TRICORDER_STATUS_LED_YELLOW, state);
  66         }
  67 #endif
  68 #ifdef STATUS_LED_BIT2
  69         if (STATUS_LED_BIT2 & mask) {
  70                 if (STATUS_LED_OFF == state)
  71                         twl4030_i2c_write_u8(TWL4030_CHIP_LED,
  72                                              TWL4030_LED_LEDEN, 0);
  73                 else
  74                         twl4030_i2c_write_u8(TWL4030_CHIP_LED,
  75                                              TWL4030_LED_LEDEN,
  76                                              (TWL4030_LED_LEDEN_LEDAON |
  77                                               TWL4030_LED_LEDEN_LEDAPWM));
  78         }
  79 #endif
  80 }