You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
91 lines
2.0 KiB
91 lines
2.0 KiB
7 years ago
|
//
|
||
|
|
// Created by MightyPork on 2017/12/15.
|
||
|
|
//
|
||
|
|
|
||
|
|
#include "platform.h"
|
||
|
|
#include "framework/resources.h"
|
||
|
|
#include "status_led.h"
|
||
|
|
#include "pin_utils.h"
|
||
|
|
|
||
|
|
static uint32_t indicators[_INDICATOR_COUNT];
|
||
|
|
|
||
|
|
static GPIO_TypeDef *led_periph;
|
||
|
|
static uint32_t led_llpin;
|
||
|
|
|
||
|
|
/** Set up the LED */
|
||
|
|
void StatusLed_Init(void)
|
||
|
|
{
|
||
|
|
bool suc = true;
|
||
|
|
|
||
|
|
// Resolve and claim resource
|
||
|
|
Resource rsc = plat_pin2resource(STATUS_LED_PORT, STATUS_LED_PIN, &suc);
|
||
|
|
assert_param(suc);
|
||
|
|
|
||
|
|
suc &= rsc_claim(&UNIT_SYSTEM, rsc);
|
||
|
|
assert_param(suc);
|
||
|
|
|
||
|
|
// Resolve pin
|
||
|
|
led_periph = plat_port2periph(STATUS_LED_PORT, &suc);
|
||
|
|
led_llpin = plat_pin2ll(STATUS_LED_PIN, &suc);
|
||
|
|
assert_param(suc);
|
||
|
|
|
||
|
|
// Configure for output
|
||
|
|
LL_GPIO_SetPinMode(led_periph, led_llpin, LL_GPIO_MODE_OUTPUT);
|
||
|
|
LL_GPIO_SetPinOutputType(led_periph, led_llpin, LL_GPIO_OUTPUT_PUSHPULL);
|
||
|
|
LL_GPIO_SetPinSpeed(led_periph, led_llpin, LL_GPIO_SPEED_FREQ_LOW);
|
||
|
|
}
|
||
|
|
|
||
|
|
/** Set indicator ON */
|
||
|
|
void StatusLed_On(enum GEX_StatusIndicator indicator)
|
||
|
|
{
|
||
|
|
indicators[indicator] = osWaitForever;
|
||
|
|
|
||
|
|
if (indicator == STATUS_FAULT) {
|
||
|
|
// Persistent light
|
||
|
|
GPIOC->ODR |= 1<<13;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/** Set indicator OFF */
|
||
|
|
void StatusLed_Off(enum GEX_StatusIndicator indicator)
|
||
|
|
{
|
||
|
|
indicators[indicator] = 0;
|
||
|
|
// TODO some effect
|
||
|
|
}
|
||
|
|
|
||
|
|
/** Set or reset a indicator */
|
||
|
|
void StatusLed_Set(enum GEX_StatusIndicator indicator, bool set)
|
||
|
|
{
|
||
|
|
if (set) {
|
||
|
|
StatusLed_On(indicator);
|
||
|
|
} else {
|
||
|
|
StatusLed_Off(indicator);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/** Turn indicator ON for a given interval */
|
||
|
|
void StatusLed_Flash(enum GEX_StatusIndicator indicator, uint32_t ms)
|
||
|
|
{
|
||
|
|
indicators[indicator] = ms;
|
||
|
|
// TODO
|
||
|
|
}
|
||
|
|
|
||
|
|
/** Millisecond tick */
|
||
|
|
void StatusLed_Tick(void)
|
||
|
|
{
|
||
|
|
for (uint32_t i = 0; i < _INDICATOR_COUNT; i++) {
|
||
|
|
if (indicators[i] != osWaitForever && indicators[i] != 0) {
|
||
|
|
if (--indicators[i]) {
|
||
|
|
StatusLed_Off((enum GEX_StatusIndicator) i);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/** Heartbeat callback from the main thread */
|
||
|
|
void StatusLed_Heartbeat(void)
|
||
|
|
{
|
||
|
|
// TODO fixme
|
||
|
|
GPIOC->ODR ^= 1<<13;
|
||
|
|
}
|