Initial commit
This commit is contained in:
145
src/platform/f7-disco-gcc/board/ledcontroller.cpp
Normal file
145
src/platform/f7-disco-gcc/board/ledcontroller.cpp
Normal file
@ -0,0 +1,145 @@
|
||||
#include "mcu/mcu.h"
|
||||
#include "config/ledcontroller-config.h"
|
||||
#if (LEDCONTROLLER_TRACE_ENABLE != 0)
|
||||
#include "trace/trace.h"
|
||||
#endif // LEDCONTROLLER_TRACE_ENABLE
|
||||
#include "ledcontroller.h"
|
||||
|
||||
LedController * LedController::_pInstance = nullptr;
|
||||
|
||||
LedController::LedController()
|
||||
{
|
||||
assert(!_pInstance); // Only one instance of this class allowed!
|
||||
_pInstance = this;
|
||||
|
||||
// Initialize the method array with the right methods.
|
||||
_ledOperation[0] = &LedController::setLed0;
|
||||
_ledOperation[1] = &LedController::setLed1;
|
||||
_ledOperation[2] = &LedController::setLed2;
|
||||
_ledOperation[3] = &LedController::setLed3;
|
||||
|
||||
/*
|
||||
* F7-DISCO LED GPIOs (Extension Board):
|
||||
* LED0: PA15
|
||||
* LED1: PH6
|
||||
* LED2: PA8
|
||||
* LED3: PB4
|
||||
*/
|
||||
}
|
||||
|
||||
LedController::~LedController()
|
||||
{
|
||||
}
|
||||
|
||||
void LedController::setLed(uint8_t index, bool bOn)
|
||||
{
|
||||
setLeds(0x01 << index, bOn);
|
||||
}
|
||||
|
||||
void LedController::setLeds(uint8_t ledMask, bool bOn)
|
||||
{
|
||||
uint8_t mask = 0x01;
|
||||
|
||||
for (uint8_t i = 0; i < ledCount(); i++, mask <<= 1)
|
||||
{
|
||||
if ((ledMask & mask) == mask && _ledOperation[i])
|
||||
{
|
||||
(this->*_ledOperation[i])(bOn);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void LedController::setLed0(bool bOn /* = true */)
|
||||
{
|
||||
if (bOn)
|
||||
{
|
||||
HAL_GPIO_WritePin(LED0_GPIO_Port, LED0_Pin, GPIO_PIN_SET);
|
||||
}
|
||||
else
|
||||
{
|
||||
HAL_GPIO_WritePin(LED0_GPIO_Port, LED0_Pin, GPIO_PIN_RESET);
|
||||
}
|
||||
|
||||
#if (LEDCONTROLLER_TRACE_ENABLE != 0)
|
||||
if (bOn)
|
||||
{
|
||||
// Not using "%s" here (bug in gcc c-library!)
|
||||
Trace::out(" LED0: on");
|
||||
}
|
||||
else
|
||||
{
|
||||
Trace::out(" LED0: off");
|
||||
}
|
||||
#endif // LEDCONTROLLER_TRACE_ENABLE
|
||||
}
|
||||
|
||||
void LedController::setLed1(bool bOn /* = true */)
|
||||
{
|
||||
if (bOn)
|
||||
{
|
||||
HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_SET);
|
||||
|
||||
}
|
||||
else
|
||||
{
|
||||
HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_RESET);
|
||||
}
|
||||
|
||||
#if (LEDCONTROLLER_TRACE_ENABLE != 0)
|
||||
if (bOn)
|
||||
{
|
||||
Trace::out(" LED1: on");
|
||||
}
|
||||
else
|
||||
{
|
||||
Trace::out(" LED1: off");
|
||||
}
|
||||
#endif // LEDCONTROLLER_TRACE_ENABLE
|
||||
}
|
||||
|
||||
void LedController::setLed2(bool bOn /* = true */)
|
||||
{
|
||||
if (bOn)
|
||||
{
|
||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_SET);
|
||||
|
||||
}
|
||||
else
|
||||
{
|
||||
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
||||
}
|
||||
|
||||
#if (LEDCONTROLLER_TRACE_ENABLE != 0)
|
||||
if (bOn)
|
||||
{
|
||||
Trace::out(" LED2: on");
|
||||
}
|
||||
else
|
||||
{
|
||||
Trace::out(" LED2: off");
|
||||
}
|
||||
#endif // LEDCONTROLLER_TRACE_ENABLE
|
||||
}
|
||||
|
||||
void LedController::setLed3(bool bOn /* = true */)
|
||||
{
|
||||
if (bOn)
|
||||
{
|
||||
HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_SET);
|
||||
}
|
||||
else
|
||||
{
|
||||
HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET);
|
||||
}
|
||||
|
||||
#if (LEDCONTROLLER_TRACE_ENABLE != 0)
|
||||
if (bOn)
|
||||
{
|
||||
Trace::out(" LED3: on");
|
||||
}
|
||||
else
|
||||
{
|
||||
Trace::out(" LED3: off");
|
||||
}
|
||||
#endif // LEDCONTROLLER_TRACE_ENABLE
|
||||
}
|
Reference in New Issue
Block a user