/* Hardware initialization */
static void hwInit(void)
{
extFunc = eeprom_read_byte((uint8_t*)EEPROM_EXT_FUNC);
#if 0
loadTempParams();
if (extFunc == USE_DS18B20) {
ds18x20SearchDevices();
tempInit(); /* Init temperature control */
}
#endif
I2CInit(); /* I2C bus */
displayInit(); /* Load params and text labels before fb scan started */
rcInit(); /* IR Remote control */
inputInit(); /* Buttons/encoder polling */
adcInit(); /* Analog-to-digital converter */
sei(); /* Gloabl interrupt enable */
//tunerInit(extFunc); /* Tuner */
DDR(STMU_STBY) |= STMU_STBY_LINE; /* Standby port */
DDR(STMU_MUTE) |= STMU_MUTE_LINE; /* Mute port */
sndInit(extFunc); /* Load labels/icons/etc */
setStbyTimer(0);
return;
}
void systemInit(void)
{
RCC_ClocksTypeDef rccClocks;
///////////////////////////////////
// Init cycle counter
cycleCounterInit();
// SysTick
SysTick_Config(SystemCoreClock / 1000);
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB |
RCC_APB2Periph_GPIOC | RCC_APB2Periph_AFIO |
RCC_APB2Periph_TIM1 | RCC_APB2Periph_TIM8 |
RCC_APB2Periph_ADC1, ENABLE);
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3 | RCC_APB1Periph_TIM4 |
RCC_APB1Periph_TIM5 | RCC_APB1Periph_TIM6 |
RCC_APB1Periph_I2C2, ENABLE);
RCC_AHBPeriphClockCmd(RCC_AHBPeriph_DMA1, ENABLE);
#ifdef _DTIMING
timingSetup();
#endif
///////////////////////////////////////////////////////////////////////////
checkFirstTime(false);
readEEPROM();
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); // 2 bits for pre-emption priority, 2 bits for subpriority
pwmMotorDriverInit();
cliInit();
gpioInit();
adcInit();
LED2_ON;
delay(10000); // 10 seconds of 20 second delay for sensor stabilization
if (GetVCPConnectMode() != eVCPConnectReset)
{
cliPrintF("\r\nUSB startup delay...\r\n");
delay(3000);
if (GetVCPConnectMode() == eVCPConnectData)
{
cliPrintF("\r\nBGC32 firmware starting up, USB connected...\r\n");
}
}
else
{
cliPrintF("\r\nDelaying for usb/serial driver to settle\r\n");
delay(3000);
cliPrintF("\r\nBGC32 firmware starting up, serial active...\r\n");
}
#ifdef __VERSION__
cliPrintF("\ngcc version " __VERSION__ "\n");
#endif
cliPrintF("BGC32 Firmware V%s, Build Date " __DATE__ " "__TIME__" \n", __BGC32_VERSION);
if ((RCC->CR & RCC_CR_HSERDY) != RESET)
{
cliPrintF("\nRunning on external HSE clock....\n");
}
else
{
cliPrintF("\nERROR: Running on internal HSI clock....\n");
}
RCC_GetClocksFreq(&rccClocks);
cliPrintF("\nADCCLK-> %2d MHz\n", rccClocks.ADCCLK_Frequency / 1000000);
cliPrintF( "HCLK-> %2d MHz\n", rccClocks.HCLK_Frequency / 1000000);
cliPrintF( "PCLK1-> %2d MHz\n", rccClocks.PCLK1_Frequency / 1000000);
cliPrintF( "PCLK2-> %2d MHz\n", rccClocks.PCLK2_Frequency / 1000000);
cliPrintF( "SYSCLK-> %2d MHz\n\n", rccClocks.SYSCLK_Frequency / 1000000);
delay(10000); // Remaining 10 seconds of 20 second delay for sensor stabilization - probably not long enough..
LED1_ON;
i2cInit(I2C2);
rcInit();
timingFunctionsInit();
BKPInit();
initFirstOrderFilter();
initPID();
initSinArray();
orientIMU();
initMPU6050();
// initMag();
}
int main(void)
{
int8_t encCnt = 0;
uint8_t cmd = CMD_END;
static uint8_t dispPrev = MODE_STANDBY;
rcInit();
sndInit();
matrixInit();
sei();
_delay_ms(100);
powerOff();
while(1) {
encCnt = getEncoder();
cmd = getCmdBuf();
/* If no command from buttons, try remote control */
if (cmd == CMD_END)
cmd = getRcBuf();
/* Don't handle commands in standby mode except some */
if (dispMode == MODE_STANDBY) {
encCnt = 0;
if (cmd != CMD_RC_STBY && cmd != CMD_BTN_1 && cmd != CMD_BTN_1_2_LONG)
cmd = CMD_END;
}
/* Don't handle buttons in learn mode except some */
if (dispMode == MODE_LEARN) {
if (encCnt || cmd != CMD_END)
displayTime = TIMEOUT_LEARN;
if (cmd != CMD_BTN_1_LONG && cmd != CMD_BTN_3)
cmd = CMD_END;
}
/* Handle command */
switch (cmd) {
case CMD_RC_STBY:
case CMD_BTN_1:
if (dispMode == MODE_STANDBY)
powerOn();
else
powerOff();
break;
case CMD_RC_MUTE:
case CMD_BTN_2:
if (dispMode == MODE_TIME_EDIT) {
rtcNextEditParam();
displayTime = TIMEOUT_TIME_EDIT;
} else {
if (aproc.mute) {
sndSetMute(0);
dispMode = MODE_SND_VOLUME;
} else {
sndSetMute(1);
dispMode = MODE_MUTE;
}
displayTime = TIMEOUT_AUDIO;
}
break;
case CMD_RC_MENU:
case CMD_BTN_3:
if (dispMode == MODE_LEARN) {
nextRcCmd();
} else {
sndNextParam(&dispMode);
displayTime = TIMEOUT_AUDIO;
}
break;
case CMD_RC_RED:
case CMD_RC_GREEN:
case CMD_RC_YELLOW:
case CMD_RC_BLUE:
sndSetInput(cmd - CMD_RC_RED);
dispMode = MODE_SND_GAIN0 + (cmd - CMD_RC_RED);
displayTime = TIMEOUT_AUDIO;
break;
case CMD_BTN_1_LONG:
switch (dispMode) {
case MODE_STANDBY:
case MODE_LEARN:
powerOff();
break;
default:
dispMode = MODE_BRIGHTNESS;
displayTime = TIMEOUT_BR;
break;
}
break;
case CMD_BTN_2_LONG:
switch (dispMode) {
case MODE_TIME_EDIT:
dispMode = MODE_TIME;
rtc.etm = RTC_NOEDIT;
break;
default:
dispMode = MODE_TIME_EDIT;
rtc.etm = RTC_HOUR;
displayTime = TIMEOUT_TIME_EDIT;
break;
}
break;
case CMD_RC_NEXT:
case CMD_BTN_3_LONG:
if (dispMode >= MODE_SND_GAIN0 && dispMode < MODE_SND_END)
aproc.input++;
sndSetInput(aproc.input);
dispMode = MODE_SND_GAIN0 + aproc.input;
displayTime = TIMEOUT_AUDIO;
break;
case CMD_BTN_1_2_LONG:
if (dispMode == MODE_STANDBY)
dispMode = MODE_LEARN;
switchTestMode(CMD_RC_STBY);
displayTime = TIMEOUT_LEARN;
break;
}
/* Emulate RC VOL_UP/VOL_DOWN as encoder actions */
if (cmd == CMD_RC_VOL_UP)
encCnt++;
if (cmd == CMD_RC_VOL_DOWN)
encCnt--;
/* Handle encoder */
if (encCnt) {
switch (dispMode) {
case MODE_STANDBY:
case MODE_LEARN:
break;
case MODE_TIME_EDIT:
displayTime = TIMEOUT_TIME_EDIT;
rtcChangeTime(encCnt);
break;
case MODE_BRIGHTNESS:
changeBrWork(encCnt);
displayTime = TIMEOUT_BR;
break;
case MODE_MUTE:
case MODE_LOUDNESS:
case MODE_TIME:
dispMode = MODE_SND_VOLUME;
default:
sndSetMute(0);
sndChangeParam(dispMode, encCnt);
displayTime = TIMEOUT_AUDIO;
break;
}
}
/* Exid to default mode if timer expired */
if (displayTime == 0) {
if (dispMode == MODE_LEARN || dispMode == MODE_STANDBY) {
dispMode = MODE_STANDBY;
} else {
rtc.etm = RTC_NOEDIT;
if (aproc.mute)
dispMode = MODE_MUTE;
else
dispMode = MODE_TIME;
}
}
/* Show things */
switch (dispMode) {
case MODE_STANDBY:
showStby();
break;
case MODE_MUTE:
showMute();
break;
case MODE_LOUDNESS:
showLoudness();
break;
case MODE_LEARN:
showLearn();
break;
case MODE_TIME:
case MODE_TIME_EDIT:
showTime();
break;
case MODE_BRIGHTNESS:
showBrWork();
break;
default:
showSndParam(dispMode, ICON_NATIVE);
break;
}
if (dispMode == dispPrev)
updateScreen(EFFECT_NONE, dispMode);
else
updateScreen(EFFECT_SPLASH, dispMode);
dispPrev = dispMode;
}
return 0;
}
