mirror of https://github.com/rusefi/rusefi.git
89 lines
1.9 KiB
C++
89 lines
1.9 KiB
C++
|
|
#include "pch.h"
|
|
#include "usbconsole.h"
|
|
#include "hardware.h"
|
|
|
|
extern "C" {
|
|
#include "boot.h"
|
|
#include "flash.h"
|
|
#include "shared_params.h"
|
|
}
|
|
|
|
class BlinkyThread : public chibios_rt::BaseStaticThread<256> {
|
|
protected:
|
|
void main(void) override {
|
|
Gpio yellow = getWarningLedPin();
|
|
Gpio blue = getCommsLedPin();
|
|
Gpio green = getRunningLedPin();
|
|
|
|
efiSetPadMode("yellow", yellow, PAL_MODE_OUTPUT_PUSHPULL);
|
|
efiSetPadMode("blue", blue, PAL_MODE_OUTPUT_PUSHPULL);
|
|
efiSetPadMode("green", green, PAL_MODE_OUTPUT_PUSHPULL);
|
|
|
|
auto yellowPort = getBrainPinPort(yellow);
|
|
auto yellowPin = getBrainPinIndex(yellow);
|
|
auto bluePort = getBrainPinPort(blue);
|
|
auto bluePin = getBrainPinIndex(blue);
|
|
auto greenPort = getBrainPinPort(green);
|
|
auto greenPin = getBrainPinIndex(green);
|
|
|
|
if (yellowPort) {
|
|
palSetPad(yellowPort, yellowPin);
|
|
}
|
|
if (bluePort) {
|
|
palSetPad(bluePort, bluePin);
|
|
}
|
|
if (greenPort) {
|
|
palSetPad(greenPort, greenPin);
|
|
}
|
|
|
|
while (true) {
|
|
if (yellowPort) {
|
|
palTogglePad(yellowPort, yellowPin);
|
|
}
|
|
if (bluePort) {
|
|
palTogglePad(bluePort, bluePin);
|
|
}
|
|
if (greenPort) {
|
|
palTogglePad(greenPort, greenPin);
|
|
}
|
|
// blink 3 times faster if Dual Bank is not enabled
|
|
chThdSleepMilliseconds(isFlashDualBank() ? 250 : 80);
|
|
}
|
|
}
|
|
};
|
|
|
|
static BlinkyThread blinky;
|
|
|
|
int main(void) {
|
|
halInit();
|
|
chSysInit();
|
|
|
|
baseMCUInit();
|
|
|
|
// start the blinky thread
|
|
blinky.start(NORMALPRIO + 10);
|
|
|
|
// Init openblt shared params
|
|
SharedParamsInit();
|
|
|
|
// Init openblt itself
|
|
BootInit();
|
|
|
|
while (true) {
|
|
BootTask();
|
|
}
|
|
}
|
|
|
|
// very basic version, supports on chip pins only (really only used for USB)
|
|
void efiSetPadMode(const char* msg, brain_pin_e brainPin, iomode_t mode) {
|
|
ioportid_t port = getHwPort(msg, brainPin);
|
|
ioportmask_t pin = getHwPin(msg, brainPin);
|
|
/* paranoid */
|
|
if (port == GPIO_NULL) {
|
|
return;
|
|
}
|
|
|
|
palSetPadMode(port, pin, mode);
|
|
}
|