forked from rrcarlosr/Jetpack
81 lines
2.0 KiB
C
81 lines
2.0 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2013 Corscience GmbH & Co.KG
|
||
|
|
* Andreas Bießmann <andreas.biessmann@corscience.de>
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: GPL-2.0+
|
||
|
|
*/
|
||
|
|
#include <common.h>
|
||
|
|
#include <status_led.h>
|
||
|
|
#include <twl4030.h>
|
||
|
|
#include <asm/arch/cpu.h>
|
||
|
|
#include <asm/io.h>
|
||
|
|
#include <asm/arch/sys_proto.h>
|
||
|
|
#include <asm/gpio.h>
|
||
|
|
|
||
|
|
#define TRICORDER_STATUS_LED_YELLOW 42
|
||
|
|
#define TRICORDER_STATUS_LED_GREEN 43
|
||
|
|
|
||
|
|
void __led_init(led_id_t mask, int state)
|
||
|
|
{
|
||
|
|
__led_set(mask, state);
|
||
|
|
}
|
||
|
|
|
||
|
|
void __led_toggle(led_id_t mask)
|
||
|
|
{
|
||
|
|
int toggle_gpio = 0;
|
||
|
|
#ifdef STATUS_LED_BIT
|
||
|
|
if (!toggle_gpio && STATUS_LED_BIT & mask)
|
||
|
|
toggle_gpio = TRICORDER_STATUS_LED_GREEN;
|
||
|
|
#endif
|
||
|
|
#ifdef STATUS_LED_BIT1
|
||
|
|
if (!toggle_gpio && STATUS_LED_BIT1 & mask)
|
||
|
|
toggle_gpio = TRICORDER_STATUS_LED_YELLOW;
|
||
|
|
#endif
|
||
|
|
#ifdef STATUS_LED_BIT2
|
||
|
|
if (!toggle_gpio && STATUS_LED_BIT2 & mask) {
|
||
|
|
uint8_t val;
|
||
|
|
twl4030_i2c_read_u8(TWL4030_CHIP_LED, TWL4030_LED_LEDEN,
|
||
|
|
&val);
|
||
|
|
val ^= (TWL4030_LED_LEDEN_LEDAON | TWL4030_LED_LEDEN_LEDAPWM);
|
||
|
|
twl4030_i2c_write_u8(TWL4030_CHIP_LED, TWL4030_LED_LEDEN,
|
||
|
|
val);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
if (toggle_gpio) {
|
||
|
|
int state;
|
||
|
|
gpio_request(toggle_gpio, "");
|
||
|
|
state = gpio_get_value(toggle_gpio);
|
||
|
|
gpio_set_value(toggle_gpio, !state);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void __led_set(led_id_t mask, int state)
|
||
|
|
{
|
||
|
|
#ifdef STATUS_LED_BIT
|
||
|
|
if (STATUS_LED_BIT & mask) {
|
||
|
|
gpio_request(TRICORDER_STATUS_LED_GREEN, "");
|
||
|
|
gpio_direction_output(TRICORDER_STATUS_LED_GREEN, 0);
|
||
|
|
gpio_set_value(TRICORDER_STATUS_LED_GREEN, state);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
#ifdef STATUS_LED_BIT1
|
||
|
|
if (STATUS_LED_BIT1 & mask) {
|
||
|
|
gpio_request(TRICORDER_STATUS_LED_YELLOW, "");
|
||
|
|
gpio_direction_output(TRICORDER_STATUS_LED_YELLOW, 0);
|
||
|
|
gpio_set_value(TRICORDER_STATUS_LED_YELLOW, state);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
#ifdef STATUS_LED_BIT2
|
||
|
|
if (STATUS_LED_BIT2 & mask) {
|
||
|
|
if (STATUS_LED_OFF == state)
|
||
|
|
twl4030_i2c_write_u8(TWL4030_CHIP_LED,
|
||
|
|
TWL4030_LED_LEDEN, 0);
|
||
|
|
else
|
||
|
|
twl4030_i2c_write_u8(TWL4030_CHIP_LED,
|
||
|
|
TWL4030_LED_LEDEN,
|
||
|
|
(TWL4030_LED_LEDEN_LEDAON |
|
||
|
|
TWL4030_LED_LEDEN_LEDAPWM));
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
}
|