Statistics
| Branch: | Tag: | Revision:

amiro-blt / Target / Modules / DiWheelDrive_1-1 / Boot / main.c @ 9bfc7c44

History | View | Annotate | Download (36.264 KB)

1 69661903 Thomas Schöpping
/************************************************************************************//**
2
* \file         Demo\ARMCM3_STM32_Olimex_STM32P103_GCC\Boot\main.c
3
* \brief        Bootloader application source file.
4
* \ingroup      Boot_ARMCM3_STM32_Olimex_STM32P103_GCC
5
* \internal
6
*----------------------------------------------------------------------------------------
7
*                          C O P Y R I G H T
8
*----------------------------------------------------------------------------------------
9
*   Copyright (c) 2012  by Feaser    http://www.feaser.com    All rights reserved
10
*
11
*----------------------------------------------------------------------------------------
12
*                            L I C E N S E
13
*----------------------------------------------------------------------------------------
14
* This file is part of OpenBLT. OpenBLT is free software: you can redistribute it and/or
15
* modify it under the terms of the GNU General Public License as published by the Free
16
* Software Foundation, either version 3 of the License, or (at your option) any later
17
* version.
18
*
19
* OpenBLT is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY;
20
* without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
21
* PURPOSE. See the GNU General Public License for more details.
22
*
23
* You should have received a copy of the GNU General Public License along with OpenBLT.
24
* If not, see <http://www.gnu.org/licenses/>.
25
*
26 470d0567 Thomas Schöpping
* A special exception to the GPL is included to allow you to distribute a combined work
27
* that includes OpenBLT without being obliged to provide the source code for any
28 69661903 Thomas Schöpping
* proprietary components. The exception text is included at the bottom of the license
29
* file <license.html>.
30 470d0567 Thomas Schöpping
*
31 69661903 Thomas Schöpping
* \endinternal
32
****************************************************************************************/
33
34
/****************************************************************************************
35
* Include files
36
****************************************************************************************/
37
#include "boot.h"                                /* bootloader generic header          */
38
#include "timer.h"
39
#include "ARMCM3_STM32/types.h"
40 470d0567 Thomas Schöpping
#include "AMiRo/amiroblt.h"
41 2d379838 Thomas Schöpping
#include "helper.h"
42 09ad5212 Thomas Schöpping
#include "iodef.h"
43 69661903 Thomas Schöpping
44
/****************************************************************************************
45
* Defines
46
****************************************************************************************/
47
#define RESET_TIMEOUT_MS    100
48
49
/****************************************************************************************
50 fc7151bb Thomas Schöpping
* Function prototypes and static variables
51 69661903 Thomas Schöpping
****************************************************************************************/
52
static void Init(void);
53
54
static void initGpio();
55
static void initExti();
56
void configGpioForShutdown();
57
58
ErrorStatus handleColdReset();
59
ErrorStatus handleUartWakeup();
60
ErrorStatus handleAccelWakeup();
61
62
ErrorStatus shutdownDisambiguationProcedure(const uint8_t type);
63
void shutdownToTransportation(const blt_bool exec_disambiguation);
64
void shutdownToDeepsleep(const blt_bool exec_disambiguation);
65
void shutdownToHibernate(const blt_bool exec_disambiguation);
66
void shutdownAndRestart(const blt_bool exec_disambiguation);
67
68 470d0567 Thomas Schöpping
volatile blBackupRegister_t backup_reg;
69 69661903 Thomas Schöpping
70
/****************************************************************************************
71
* Callback configuration
72
****************************************************************************************/
73
void blCallbackShutdownTransportation(void);
74
void blCallbackShutdownDeepsleep(void);
75
void blCallbackShutdownHibernate(void);
76
void blCallbackShutdownRestart(void);
77
void blCallbackHandleShutdownRequest(void);
78
79 470d0567 Thomas Schöpping
const blCallbackTable_t cbtable __attribute__ ((section ("_callback_table"))) = {
80 69661903 Thomas Schöpping
  .magicNumber = BL_MAGIC_NUMBER,
81 fc7151bb Thomas Schöpping
  .vBootloader = {BL_VERSION_ID_AMiRoBLT_Beta, BL_VERSION_MAJOR, BL_VERSION_MINOR, 3},
82 f3866909 Thomas Schöpping
  .vSSSP = {BL_VERSION_ID_SSSP, BL_SSSP_VERSION_MAJOR, BL_SSSP_VERSION_MINOR, 0},
83 470d0567 Thomas Schöpping
  .vCompiler = {BL_VERSION_ID_GCC, __GNUC__, __GNUC_MINOR__, __GNUC_PATCHLEVEL__},  // currently only GCC is supported
84 69661903 Thomas Schöpping
  .cbShutdownHibernate = blCallbackShutdownHibernate,
85
  .cbShutdownDeepsleep = blCallbackShutdownDeepsleep,
86
  .cbShutdownTransportation = blCallbackShutdownTransportation,
87
  .cbShutdownRestart = blCallbackShutdownRestart,
88
  .cbHandleShutdownRequest = blCallbackHandleShutdownRequest,
89
  .cb5 = (void*)0,
90
  .cb6 = (void*)0,
91
  .cb7 = (void*)0,
92
  .cb8 = (void*)0,
93
  .cb9 = (void*)0,
94
  .cb10 = (void*)0,
95
  .cb11 = (void*)0
96
};
97
98
/************************************************************************************//**
99 470d0567 Thomas Schöpping
** \brief     This is the entry point for the bootloader application and is called
100 69661903 Thomas Schöpping
**            by the reset interrupt vector after the C-startup routines executed.
101
** \return    Program return code.
102
**
103
****************************************************************************************/
104
int main(void)
105
{
106
  /* initialize the microcontroller */
107
  Init();
108
109
  /* activate some required clocks */
110
  RCC_APB1PeriphClockCmd(RCC_APB1Periph_PWR, ENABLE);
111
  RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE);
112
113
  /* initialize GPIOs and EXTI lines */
114
  initGpio();
115
  setLed(BLT_TRUE);
116
  initExti();
117
118
  /* initialize the timer */
119
  TimerInit();
120
121
  /* detect the primary reason for this wakeup/restart */
122
  backup_reg.wakeup_pri_reason =
123
      ((RCC_GetFlagStatus(RCC_FLAG_LPWRRST) == SET) ? BL_WAKEUP_PRI_RSN_LPWRRST : 0) |
124
      ((RCC_GetFlagStatus(RCC_FLAG_WWDGRST) == SET) ? BL_WAKEUP_PRI_RSN_WWDGRST : 0) |
125
      ((RCC_GetFlagStatus(RCC_FLAG_IWDGRST) == SET) ? BL_WAKEUP_PRI_RSN_IWDGRST : 0) |
126
      ((RCC_GetFlagStatus(RCC_FLAG_SFTRST) == SET) ? BL_WAKEUP_PRI_RSN_SFTRST : 0)   |
127
      ((RCC_GetFlagStatus(RCC_FLAG_PORRST) == SET) ? BL_WAKEUP_PRI_RSN_PORRST : 0)   |
128
      ((RCC_GetFlagStatus(RCC_FLAG_PINRST) == SET) ? BL_WAKEUP_PRI_RSN_PINRST : 0)   |
129
      ((PWR_GetFlagStatus(PWR_FLAG_WU) == SET) ? BL_WAKEUP_PRI_RSN_WKUP : 0);
130
131
  /* when woken from standby mode, detect the secondary reason for thiswakeup/reset */
132
  if ( (backup_reg.wakeup_pri_reason & BL_WAKEUP_PRI_RSN_WKUP) && (PWR_GetFlagStatus(PWR_FLAG_SB) == SET) ) {
133
    if (GPIO_ReadInputDataBit(SYS_UART_UP_GPIO, SYS_UART_UP_PIN) == Bit_SET) {
134
      backup_reg.wakeup_sec_reason = BL_WAKEUP_SEC_RSN_UART;
135
    } else {
136
      backup_reg.wakeup_sec_reason = BL_WAKEUP_SEC_RSN_ACCEL;
137
    }
138
  } else {
139
    backup_reg.wakeup_sec_reason = BL_WAKEUP_SEC_RSN_UNKNOWN;
140
  }
141
142
  /* clear the flags */
143
  RCC_ClearFlag();
144
  PWR_ClearFlag(PWR_FLAG_WU);
145
146
  setLed(BLT_FALSE);
147
148
  /* wait 1ms for all signals to become stable */
149
  msleep(1);
150
151
  /* handle different wakeup/reset reasons */
152
  ErrorStatus status = ERROR;
153
  if (backup_reg.wakeup_pri_reason & BL_WAKEUP_PRI_RSN_WKUP) {
154
    /* the system was woken via WKUP pin */
155
    /* differenciate between two wakeup types */
156
    switch (backup_reg.wakeup_sec_reason) {
157
      case BL_WAKEUP_SEC_RSN_UART:
158
        status = handleUartWakeup();
159
        break;
160
      case BL_WAKEUP_SEC_RSN_ACCEL:
161
        status = handleAccelWakeup();
162
        break;
163
      default:
164
        status = ERROR;
165
        break;
166
    }
167
  } else if (backup_reg.wakeup_pri_reason & BL_WAKEUP_PRI_RSN_PINRST) {
168
    /* system was woken via NRST pin */
169
    status = handleColdReset();
170
  } else {
171
    /* system was woken/reset for an unexpected reason */
172
    blinkSOS(1);
173
    status = handleColdReset();
174
  }
175
176 f7d2c786 Thomas Schöpping
  /* if something went wrong, signal this failure */
177 69661903 Thomas Schöpping
  if (status != SUCCESS) {
178
    blinkSOSinf();
179
  }
180
181
  return 0;
182
} /*** end of main ***/
183
184
185
/************************************************************************************//**
186 470d0567 Thomas Schöpping
** \brief     Initializes the microcontroller.
187 69661903 Thomas Schöpping
** \return    none.
188
**
189
****************************************************************************************/
190
static void Init(void)
191
{
192
  volatile blt_int32u StartUpCounter = 0, HSEStatus = 0;
193
  blt_int32u pll_multiplier;
194
#if (BOOT_FILE_LOGGING_ENABLE > 0) && (BOOT_COM_UART_ENABLE == 0)
195
  GPIO_InitTypeDef  GPIO_InitStruct;
196 470d0567 Thomas Schöpping
  USART_InitTypeDef USART_InitStruct;
197
#endif
198 69661903 Thomas Schöpping
199
  /* reset the RCC clock configuration to the default reset state (for debug purpose) */
200
  /* set HSION bit */
201
  RCC->CR |= (blt_int32u)0x00000001;
202
  /* reset SW, HPRE, PPRE1, PPRE2, ADCPRE and MCO bits */
203
  RCC->CFGR &= (blt_int32u)0xF8FF0000;
204
  /* reset HSEON, CSSON and PLLON bits */
205
  RCC->CR &= (blt_int32u)0xFEF6FFFF;
206
  /* reset HSEBYP bit */
207
  RCC->CR &= (blt_int32u)0xFFFBFFFF;
208
  /* reset PLLSRC, PLLXTPRE, PLLMUL and USBPRE/OTGFSPRE bits */
209
  RCC->CFGR &= (blt_int32u)0xFF80FFFF;
210
  /* disable all interrupts and clear pending bits  */
211
  RCC->CIR = 0x009F0000;
212 470d0567 Thomas Schöpping
  /* enable HSE */
213 69661903 Thomas Schöpping
  RCC->CR |= ((blt_int32u)RCC_CR_HSEON);
214
  /* wait till HSE is ready and if Time out is reached exit */
215
  do
216
  {
217
    HSEStatus = RCC->CR & RCC_CR_HSERDY;
218 470d0567 Thomas Schöpping
    StartUpCounter++;
219
  }
220 69661903 Thomas Schöpping
  while((HSEStatus == 0) && (StartUpCounter != 1500));
221
  /* check if time out was reached */
222
  if ((RCC->CR & RCC_CR_HSERDY) == RESET)
223
  {
224
    /* cannot continue when HSE is not ready */
225
    ASSERT_RT(BLT_FALSE);
226
  }
227
  /* enable flash prefetch buffer */
228
  FLASH->ACR |= FLASH_ACR_PRFTBE;
229
  /* reset flash wait state configuration to default 0 wait states */
230
  FLASH->ACR &= (blt_int32u)((blt_int32u)~FLASH_ACR_LATENCY);
231
#if (BOOT_CPU_SYSTEM_SPEED_KHZ > 48000)
232
  /* configure 2 flash wait states */
233 470d0567 Thomas Schöpping
  FLASH->ACR |= (blt_int32u)FLASH_ACR_LATENCY_2;
234
#elif (BOOT_CPU_SYSTEM_SPEED_KHZ > 24000)
235 69661903 Thomas Schöpping
  /* configure 1 flash wait states */
236 470d0567 Thomas Schöpping
  FLASH->ACR |= (blt_int32u)FLASH_ACR_LATENCY_1;
237 69661903 Thomas Schöpping
#endif
238
  /* HCLK = SYSCLK */
239
  RCC->CFGR |= (blt_int32u)RCC_CFGR_HPRE_DIV1;
240
  /* PCLK2 = HCLK/2 */
241
  RCC->CFGR |= (blt_int32u)RCC_CFGR_PPRE2_DIV2;
242
  /* PCLK1 = HCLK/2 */
243
  RCC->CFGR |= (blt_int32u)RCC_CFGR_PPRE1_DIV2;
244
  /* reset PLL configuration */
245
  RCC->CFGR &= (blt_int32u)((blt_int32u)~(RCC_CFGR_PLLSRC | RCC_CFGR_PLLXTPRE | \
246
                                          RCC_CFGR_PLLMULL));
247
  /* assert that the pll_multiplier is between 2 and 16 */
248
  ASSERT_CT((BOOT_CPU_SYSTEM_SPEED_KHZ/BOOT_CPU_XTAL_SPEED_KHZ) >= 2);
249
  ASSERT_CT((BOOT_CPU_SYSTEM_SPEED_KHZ/BOOT_CPU_XTAL_SPEED_KHZ) <= 16);
250
  /* calculate multiplier value */
251
  pll_multiplier = BOOT_CPU_SYSTEM_SPEED_KHZ/BOOT_CPU_XTAL_SPEED_KHZ;
252
  /* convert to register value */
253
  pll_multiplier = (blt_int32u)((pll_multiplier - 2) << 18);
254
  /* set the PLL multiplier and clock source */
255
  RCC->CFGR |= (blt_int32u)(RCC_CFGR_PLLSRC_HSE | pll_multiplier);
256
  /* enable PLL */
257
  RCC->CR |= RCC_CR_PLLON;
258
  /* wait till PLL is ready */
259
  while((RCC->CR & RCC_CR_PLLRDY) == 0)
260
  {
261
  }
262
  /* select PLL as system clock source */
263
  RCC->CFGR &= (blt_int32u)((blt_int32u)~(RCC_CFGR_SW));
264 470d0567 Thomas Schöpping
  RCC->CFGR |= (blt_int32u)RCC_CFGR_SW_PLL;
265 69661903 Thomas Schöpping
  /* wait till PLL is used as system clock source */
266
  while ((RCC->CFGR & (blt_int32u)RCC_CFGR_SWS) != (blt_int32u)0x08)
267
  {
268
  }
269
270
  /* remap JTAG pins */
271
  RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO, ENABLE);
272
  AFIO->MAPR &= ~(blt_int32u)((blt_int32u)0x7 << 24);
273
  AFIO->MAPR |=  (blt_int32u)((blt_int32u)0x2 << 24);
274
  /* all input */
275
276
#if (BOOT_COM_CAN_ENABLE > 0 || BOOT_GATE_CAN_ENABLE > 0)
277
  /* enable clocks for CAN transmitter and receiver pins (GPIOB and AFIO) */
278
  RCC->APB2ENR |= (blt_int32u)(0x00000004 | 0x00000001);
279
  /* configure CAN Rx (GPIOA11) as alternate function input */
280
  /* first reset the configuration */
281
  GPIOA->CRH &= ~(blt_int32u)((blt_int32u)0xf << 12);
282
  /* CNF8[1:0] = %01 and MODE8[1:0] = %00 */
283
  GPIOA->CRH |= (blt_int32u)((blt_int32u)0x4 << 12);
284
  /* configure CAN Tx (GPIOA12) as alternate function push-pull */
285
  /* first reset the configuration */
286
  GPIOA->CRH &= ~(blt_int32u)((blt_int32u)0xf << 16);
287
  /* CNF9[1:0] = %11 and MODE9[1:0] = %11 */
288
  GPIOA->CRH |= (blt_int32u)((blt_int32u)0xb << 16);
289
290
  /* remap CAN1 pins to PortA */
291
  AFIO->MAPR &= ~(blt_int32u)((blt_int32u)0x3 << 13);
292
  AFIO->MAPR |=  (blt_int32u)((blt_int32u)0x0 << 13);
293
#endif
294
295
#if (BOOT_COM_UART_ENABLE > 0 || BOOT_GATE_UART_ENABLE > 0)
296
  /* enable clocks for USART1 peripheral, transmitter and receiver pins (GPIOA and AFIO) */
297
  RCC->APB2ENR |= (blt_int32u)(0x00004000 | 0x00000004 | 0x00000001);
298
  /* configure USART1 Tx (GPIOA9) as alternate function push-pull */
299
  /* first reset the configuration */
300
  GPIOA->CRH &= ~(blt_int32u)((blt_int32u)0xf << 4);
301
  /* CNF2[1:0] = %10 and MODE2[1:0] = %11 */
302
  GPIOA->CRH |= (blt_int32u)((blt_int32u)0xb << 4);
303
  /* configure USART1 Rx (GPIOA10) as alternate function input floating */
304
  /* first reset the configuration */
305
  GPIOA->CRH &= ~(blt_int32u)((blt_int32u)0xf << 8);
306
  /* CNF2[1:0] = %01 and MODE2[1:0] = %00 */
307
  GPIOA->CRH |= (blt_int32u)((blt_int32u)0x4 << 8);
308
#endif
309
} /*** end of Init ***/
310
311
/*
312
 * Initializes all GPIO used by the bootloader
313
 */
314
static void initGpio() {
315
  GPIO_InitTypeDef gpio_init;
316
317
  /*
318
   * OUTPUTS
319
   */
320
321
  /* initialize LED and push it up (inactive) */
322
  GPIO_SetBits(LED_GPIO, LED_PIN);
323
  gpio_init.GPIO_Pin    = LED_PIN;
324
  gpio_init.GPIO_Mode   = GPIO_Mode_Out_PP;
325
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
326
  GPIO_Init(LED_GPIO, &gpio_init);
327
328
  /* initialize SYS_PD_N and let it go (inactive) */
329
  GPIO_SetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
330
  gpio_init.GPIO_Pin    = SYS_PD_N_PIN;
331
  gpio_init.GPIO_Mode   = GPIO_Mode_Out_OD;
332
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
333
  GPIO_Init(SYS_PD_N_GPIO, &gpio_init);
334
335
  /* initialize SYS_SYNC_N and pull it down (active) */
336
  GPIO_ResetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
337
  gpio_init.GPIO_Pin    = SYS_SYNC_N_PIN;
338
  gpio_init.GPIO_Mode   = GPIO_Mode_Out_OD;
339
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
340
  GPIO_Init(SYS_SYNC_N_GPIO, &gpio_init);
341
342
  /* initialize SYS_WARMST_N and let it go (active) */
343
  GPIO_SetBits(SYS_WARMRST_N_GPIO, SYS_WARMRST_N_PIN);
344
  gpio_init.GPIO_Pin    = SYS_WARMRST_N_PIN;
345
  gpio_init.GPIO_Mode   = GPIO_Mode_Out_OD;
346
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
347
  GPIO_Init(SYS_WARMRST_N_GPIO, &gpio_init);
348
349
  /* initialize SYS_UART_UP and let it go (inactive) */
350
  GPIO_SetBits(SYS_UART_UP_GPIO, SYS_UART_UP_PIN);
351
  gpio_init.GPIO_Pin    = SYS_UART_UP_PIN;
352
  gpio_init.GPIO_Mode   = GPIO_Mode_Out_OD;
353
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
354
  GPIO_Init(SYS_UART_UP_GPIO, &gpio_init);
355
356
  /* initialize PATH_DCEN and pull it down (inactive) */
357
  GPIO_ResetBits(PATH_DCEN_GPIO, PATH_DCEN_PIN);
358
  gpio_init.GPIO_Pin    = PATH_DCEN_PIN;
359
  gpio_init.GPIO_Mode   = GPIO_Mode_Out_PP;
360
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
361
  GPIO_Init(PATH_DCEN_GPIO, &gpio_init);
362
363
  /*
364
   * INPUTS
365
   */
366
367
  /* initialize the input ACCEL_INT_N */
368
  gpio_init.GPIO_Pin    = ACCEL_INT_N_PIN;
369
  gpio_init.GPIO_Mode   = GPIO_Mode_IN_FLOATING;
370
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
371
  GPIO_Init(ACCEL_INT_N_GPIO, &gpio_init);
372
373
  return;
374
} /*** end of initGpio ***/
375
376
/*
377
 * Initialize all EXTI lines
378
 */
379
static void initExti() {
380
  /* configure EXTI lines */
381
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOC, GPIO_PinSource1); // SYS_SYNC_N
382
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOD, GPIO_PinSource2); // SYS_WARMRST_N
383
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOC, GPIO_PinSource3); // PATH_DCSTAT
384
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource5); // COMPASS_DRDY
385
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOC, GPIO_PinSource8); // SYS_PD_N
386
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOC, GPIO_PinSource9); // SYS_REG_EN
387
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource12); // IR_INT
388
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource13); // GYRO_DRDY
389
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource14); // SYS_UART_UP
390
  GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource15); // ACCEL_INT_N
391
392
  return;
393 f7d2c786 Thomas Schöpping
} /*** end of initExti ***/
394 69661903 Thomas Schöpping
395
/*
396
 * Signals, which type of low-power mode the system shall enter after the shutdown sequence.
397
 */
398
ErrorStatus shutdownDisambiguationProcedure(const uint8_t type) {
399
  GPIO_SetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
400
  ErrorStatus ret_val = ERROR;
401
402
  switch (type) {
403
    case BL_SHUTDOWN_PRI_RSN_UNKNOWN:
404
    case BL_SHUTDOWN_PRI_RSN_HIBERNATE:
405
    case BL_SHUTDOWN_PRI_RSN_DEEPSLEEP:
406
    case BL_SHUTDOWN_PRI_RSN_TRANSPORT:
407
    {
408
      // broadcast a number of pulses, depending on the argument
409
      uint8_t pulse_counter = 0;
410
      for (pulse_counter = 0; pulse_counter < type; ++pulse_counter) {
411
        msleep(1);
412
        GPIO_ResetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
413
        msleep(1);
414
        GPIO_SetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
415
      }
416
      // wait for timeout
417
      msleep(10);
418
      ret_val = SUCCESS;
419
      break;
420
    }
421
    case BL_SHUTDOWN_PRI_RSN_RESTART:
422
    {
423
      // since there is no ambiguity for restart requests, no pulses are generated
424
      msleep(10);
425
      ret_val = SUCCESS;
426
      break;
427
    }
428
    default:
429
      ret_val = ERROR;
430
      break;
431
  }
432
433
  return ret_val;
434
} /*** end of shutdownDisambiguationProcedure ***/
435
436
/*
437
 * Final shutdown of the system to enter transportation mode.
438
 */
439
void shutdownToTransportation(const blt_bool exec_disambiguation) {
440
  /* configure some criticpal GPIOs as input
441
   * This is required, because otherwise some hardware might be powered through these signals */
442
  configGpioForShutdown();
443
444
  /* turn off the motors */
445
  GPIO_ResetBits(POWER_EN_GPIO, POWER_EN_PIN);
446
447
  /* deactivate the WKUP pin */
448
  PWR_WakeUpPinCmd(DISABLE);
449
450
  /* deactivate any RTC related events */
451
  RTC_ITConfig(RTC_IT_ALR | RTC_IT_OW | RTC_IT_SEC, DISABLE);
452
  RTC_ClearFlag(~0);
453
454
  /* disable the IWDG */
455
  IWDG_ReloadCounter();
456
457
  /* wait for all boards to be ready for shutdown */
458
  GPIO_SetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
459
  if (GPIO_ReadInputDataBit(SYS_REG_EN_GPIO, SYS_REG_EN_PIN) == Bit_SET) {
460 fc7151bb Thomas Schöpping
    // this must be skipped if the pullup voltage (VIO3.3) is not active
461 69661903 Thomas Schöpping
    setLed(BLT_TRUE);
462
    waitForSignal(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN, Bit_SET);
463
    setLed(BLT_FALSE);
464
  }
465
466
  if (exec_disambiguation == BLT_TRUE) {
467
    /* execute disambiguation procedure and signal all modules to enter transportation mode */
468
    if (shutdownDisambiguationProcedure(BL_SHUTDOWN_PRI_RSN_TRANSPORT) != SUCCESS) {
469
      blinkSOS(1);
470
      msleep(10);
471
    }
472
  }
473
474
  /* morse 'OK' via the LED to signal that shutdown was successful */
475
  blinkOK(1);
476
477
  /* enter standby mode */
478
  PWR_EnterSTANDBYMode();
479
480
  return;
481
} /*** end of shutdownToTransportation ***/
482
483
/*
484 f7d2c786 Thomas Schöpping
 * Final shutdown of the system to enter deepsleep mode.
485 69661903 Thomas Schöpping
 */
486
void shutdownToDeepsleep(const blt_bool exec_disambiguation) {
487
  /* configure some criticpal GPIOs as input
488
   * This is required, because otherwise some hardware might be powered through these signals */
489
  configGpioForShutdown();
490
491
  /* turn off the motors */
492
  GPIO_ResetBits(POWER_EN_GPIO, POWER_EN_PIN);
493
494
  /* deactivate the WKUP pin */
495
  PWR_WakeUpPinCmd(ENABLE);
496
497
  /*
498
   * Configuration of RTC and IWDG belongs to the OS.
499
   */
500
501
  /* wait for all boards to be ready for shutdown */
502
  GPIO_SetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
503
  if (GPIO_ReadInputDataBit(SYS_REG_EN_GPIO, SYS_REG_EN_PIN) == Bit_SET) {
504 fc7151bb Thomas Schöpping
    // this must be skipped if the pullup voltage (VIO3.3) is not active
505 69661903 Thomas Schöpping
    setLed(BLT_TRUE);
506
    waitForSignal(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN, Bit_SET);
507
    setLed(BLT_FALSE);
508
  }
509
510
  if (exec_disambiguation == BLT_TRUE) {
511
    /* execute disambiguation procedure and signal all modules to enter deepsleep mode */
512
    if (shutdownDisambiguationProcedure(BL_SHUTDOWN_PRI_RSN_DEEPSLEEP) != SUCCESS) {
513
      blinkSOS(1);
514
      msleep(10);
515
    }
516
  }
517
518
  /* morse 'OK' via the LED to signal that shutdown was successful */
519
  blinkOK(1);
520
521
  /* enter standby mode */
522
  PWR_EnterSTANDBYMode();
523
524
  return;
525
} /*** end of shutdownToDeepsleep ***/
526
527
/*
528
 * Final shutdown of the system to enter hibernate mode.
529
 */
530
void shutdownToHibernate(const blt_bool exec_disambiguation) {
531
  /* configure some criticpal GPIOs as input
532
   * This is required, because otherwise some hardware might be powered through these signals */
533
  configGpioForShutdown();
534
535
  /* turn off the motors */
536
  GPIO_ResetBits(POWER_EN_GPIO, POWER_EN_PIN);
537
538
  /* deactivate the WKUP pin */
539
  PWR_WakeUpPinCmd(ENABLE);
540
541
  /*
542
   * Configuration of RTC and IWDG belongs to the OS.
543
   */
544
545
  /* wait for all boards to be ready for shutdown */
546
  GPIO_SetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
547
  if (GPIO_ReadInputDataBit(SYS_REG_EN_GPIO, SYS_REG_EN_PIN) == Bit_SET) {
548 fc7151bb Thomas Schöpping
    // this must be skipped if the pullup voltage (VIO3.3) is not active
549 69661903 Thomas Schöpping
    setLed(BLT_TRUE);
550
    waitForSignal(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN, Bit_SET);
551
    setLed(BLT_FALSE);
552
  }
553
554
  if (exec_disambiguation == BLT_TRUE) {
555
    /* execute disambiguation procedure and signal all modules to enter deepsleep mode */
556
    if (shutdownDisambiguationProcedure(BL_SHUTDOWN_PRI_RSN_HIBERNATE) != SUCCESS) {
557
      blinkSOS(1);
558
      msleep(10);
559
    }
560
  }
561
562
  /* morse 'OK' via the LED to signal that shutdown was successful */
563
  blinkOK(1);
564
565
  /* enter standby mode */
566
  PWR_EnterSTANDBYMode();
567
568
  return;
569 fc7151bb Thomas Schöpping
} /*** end of shutdownToHibernate ***/
570 69661903 Thomas Schöpping
571
/*
572
 * Final shutdown of the system and restart.
573
 */
574
void shutdownAndRestart(const blt_bool exec_disambiguation) {
575
  /* configure some criticpal GPIOs as input
576
   * This is required, because otherwise some hardware might be powered through these signals */
577
  configGpioForShutdown();
578
579
  /* turn off the motors */
580
  GPIO_ResetBits(POWER_EN_GPIO, POWER_EN_PIN);
581
582
  /* prepare for low-power mode */
583
  PWR_WakeUpPinCmd(DISABLE); // disable WKUP pin
584
  RTC_ITConfig(RTC_IT_ALR | RTC_IT_OW | RTC_IT_SEC, DISABLE); // unset RTC events
585
  RTC_ClearFlag(~0); // clear pending RTC events
586
  IWDG_ReloadCounter(); // disable IWDG
587
588
  /* wait for all boards to be ready for shutdown */
589
  GPIO_SetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
590
  if (GPIO_ReadInputDataBit(SYS_REG_EN_GPIO, SYS_REG_EN_PIN) == Bit_SET) {
591 fc7151bb Thomas Schöpping
    // this must be skipped if the pullup voltage (VIO3.3) is not active
592 69661903 Thomas Schöpping
    setLed(BLT_TRUE);
593
    waitForSignal(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN, Bit_SET);
594
    setLed(BLT_FALSE);
595
  }
596
597
  if (exec_disambiguation == BLT_TRUE) {
598
    /* execute disambiguation procedure and signal all modules to restart in default mode */
599
    if (shutdownDisambiguationProcedure(BL_SHUTDOWN_PRI_RSN_RESTART) != SUCCESS) {
600
      blinkSOS(1);
601
      msleep(10);
602
    }
603
  }
604
605
  /* morse 'OK' via the LED to signal that shutdown was successful */
606
  blinkOK(1);
607
608
  /* enter standby mode */
609
  PWR_EnterSTANDBYMode();
610
611
  /*
612
   * Even though this module will not restart the system by its own, the PowerManagement will reset the system.
613
   */
614
615
  return;
616 fc7151bb Thomas Schöpping
} /*** end of shutdownAndRestart ***/
617 69661903 Thomas Schöpping
618
/*
619
 * Configures some GPIO pins as inputs for safety reasons.
620
 * Under certain circumstances, these pins might power hardware that is supposed to be shut down.
621
 */
622
void configGpioForShutdown() {
623
  /* setup the configuration */
624
  GPIO_InitTypeDef gpio_init;
625
  gpio_init.GPIO_Mode   = GPIO_Mode_IN_FLOATING;
626
  gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
627
628
  /* configure SYS_UART_TX */
629
  gpio_init.GPIO_Pin = SYS_UART_TX_PIN;
630
  GPIO_Init(SYS_UART_TX_GPIO, &gpio_init);
631
632
  /* configure CAN_TX */
633
  gpio_init.GPIO_Pin = CAN_TX_PIN;
634
  GPIO_Init(CAN_TX_GPIO, &gpio_init);
635
636
  /* configure all MOTION (SPI) signals */
637
  gpio_init.GPIO_Pin = MOTION_SCLK_PIN;
638
  GPIO_Init(MOTION_SCLK_GPIO, &gpio_init);
639
  gpio_init.GPIO_Pin = MOTION_MISO_PIN;
640
  GPIO_Init(MOTION_MISO_GPIO, &gpio_init);
641
  gpio_init.GPIO_Pin = MOTION_MOSI_PIN;
642
  GPIO_Init(MOTION_MOSI_GPIO, &gpio_init);
643
  gpio_init.GPIO_Pin = ACCEL_SS_N_PIN;
644
  GPIO_Init(ACCEL_SS_N_GPIO, &gpio_init);
645
  gpio_init.GPIO_Pin = GYRO_SS_N_PIN;
646
  GPIO_Init(GYRO_SS_N_GPIO, &gpio_init);
647
648
  return;
649
} /*** end of configGpioForShutdown ***/
650
651
/*
652
 * System was reset via the NRST pin or the reason could not be detected.
653
 * In this case, there are three possibilities how to act:
654
 * 1) When the SYS_WARMRST_N signal becomes inactive, flashing mode is entered and the system will try to load the OS.
655
 * 2) When the SYS_UART_UP signal becomes active (low), the system will enter hibernate mode to enable charging via the pins.
656
 * 3) If none of both happens and a timeout occurs, the system enters deepsleep mode.
657
 */
658
ErrorStatus handleColdReset() {
659
  /* wait until either the SYS_WARMRST_N signal goes up, or SYS_UART_UP goes down */
660
  enum CRST_SIG {CRST_SIG_SYS_WARMRST_N,
661
                 CRST_SIG_SYS_UART_UP,
662
                 CRST_SIG_TIMEOUT
663
                } sig;
664
  uint32_t loopStartTime = 0;
665
  saTimerUpdate(&loopStartTime);
666
  uint32_t currentTime = loopStartTime;
667
  setLed(BLT_TRUE);
668
  while (1) {
669
    /* read the input signals */
670
    if (GPIO_ReadInputDataBit(SYS_REG_EN_GPIO, SYS_REG_EN_PIN) == Bit_SET &&
671
        GPIO_ReadInputDataBit(SYS_WARMRST_N_GPIO, SYS_WARMRST_N_PIN) == Bit_SET) {
672
      sig = CRST_SIG_SYS_WARMRST_N;
673
      break;
674
    }
675
    if (GPIO_ReadInputDataBit(SYS_UART_UP_GPIO, SYS_UART_UP_PIN) == Bit_RESET) {
676
      sig = CRST_SIG_SYS_UART_UP;
677
      break;
678
    }
679
680
    /* check for a timeout */
681
    saTimerUpdate(&currentTime);
682
    if (currentTime > loopStartTime + RESET_TIMEOUT_MS) {
683
      sig = CRST_SIG_TIMEOUT;
684
      break;
685
    }
686
  }
687
  setLed(BLT_FALSE);
688
689
  /* depending on the signal, react accordingly */
690
  switch (sig) {
691
    /* activation of the slave modules signales to boot the OS */
692
    case CRST_SIG_SYS_WARMRST_N:
693
    {
694
      /* enable CAN clock */
695
      RCC_APB1PeriphClockCmd(RCC_APB1Periph_CAN1, ENABLE);
696
697
      /* initialize the bootloader */
698
      BootInit();
699
700
      /* start the infinite program loop */
701
      uint32_t loopStartTime = 0;
702
      saTimerUpdate(&loopStartTime);
703
      uint32_t currentTime = loopStartTime;
704
      while (1)
705
      {
706 d54d2f07 Thomas Schöpping
//        /* make the LED "double-blink" */
707
//        saTimerUpdate(&currentTime);
708
//        if (currentTime < loopStartTime + 50) {
709
//          setLed(BLT_TRUE);
710
//        } else if (currentTime < loopStartTime + 50+100) {
711
//          setLed(BLT_FALSE);
712
//        } else if (currentTime < loopStartTime + 50+100+50) {
713
//          setLed(BLT_TRUE);
714
//        } else if ( currentTime < loopStartTime + 50+100+50+300) {
715
//          setLed(BLT_FALSE);
716
//        } else {
717
//          loopStartTime = currentTime;
718
//        }
719 69661903 Thomas Schöpping
720
        /* run the bootloader task */
721
        BootTask();
722
723
        /* check the SYS_PD_N signal */
724
        if (GPIO_ReadInputDataBit(SYS_PD_N_GPIO, SYS_PD_N_PIN) == Bit_RESET) {
725
          blCallbackHandleShutdownRequest();
726
          return SUCCESS;
727
        }
728
      }
729
730
      break;
731
    }
732
    /* activation of the UART_UP signal indicates that this module shall enter hibernate mode */
733
    case CRST_SIG_SYS_UART_UP:
734
    {
735
      /* indicate that the MCU is busy */
736
      GPIO_ResetBits(SYS_UART_UP_GPIO, SYS_UART_UP_PIN);
737
738
      /* enable the charging pins */
739
      GPIO_SetBits(PATH_DCEN_GPIO, PATH_DCEN_PIN);
740
741
      /* wait some time so the systen voltage (VSYS) is stable if it is supplied via the pins */
742
      msleep(10);
743
744
      /* indicate that the MCU is not busy anymore */
745
      GPIO_SetBits(SYS_UART_UP_GPIO, SYS_UART_UP_PIN);
746
747
      /* configure the accelerometer external interrupt as event */
748
      EXTI_InitTypeDef exti;
749
      exti.EXTI_Line = EXTI_Line15;
750
      exti.EXTI_Mode = EXTI_Mode_Event;
751
      exti.EXTI_Trigger = EXTI_Trigger_Falling;
752
      exti.EXTI_LineCmd = ENABLE;
753
      EXTI_Init(&exti);
754
755
      /* sleep until something happens */
756
      __WFE();
757
758
      /* clear all pending EXTI events */
759
      EXTI_DeInit();
760
      EXTI_ClearFlag(EXTI_Line15);
761
762
      /* handle accelerometer wakeup
763
       * note: In fact, the only events that will occur at this point are an interrupt event from the accelerometer, or a
764
       * system reset from the PowerManagement via the NRST pin. Thus, if the following code is reached, it must have
765
       * been the accelerometer.
766
       */
767
768
      /* as as after a normal wakeup from the accelerometer */
769
      return handleAccelWakeup();
770
771
      break;
772
    }
773
    /* if a timeout occurred, the system enters deepsleep mode */
774
    case CRST_SIG_TIMEOUT:
775
    {
776
      /* reconfigure the LED_GPIO as input so it will not light up (and thus save energy) */
777
      GPIO_InitTypeDef gpio_init;
778
      gpio_init.GPIO_Pin    = LED_PIN;
779
      gpio_init.GPIO_Mode   = GPIO_Mode_IN_FLOATING;
780
      gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
781
      GPIO_Init(LED_GPIO, &gpio_init);
782
783
      /* reconfigure SYS_PD_N as input so the callback will not indicate a shutdown */
784
      gpio_init.GPIO_Pin    = SYS_PD_N_PIN;
785
      gpio_init.GPIO_Mode   = GPIO_Mode_IN_FLOATING;
786
      gpio_init.GPIO_Speed  = GPIO_Speed_50MHz;
787
      GPIO_Init(SYS_PD_N_GPIO, &gpio_init);
788
789
      blCallbackShutdownDeepsleep();
790
      break;
791
    }
792
    default:
793
      break;
794
  }
795
796
  return ERROR;
797
} /*** end of handleColdReset ***/
798
799
/*
800
 * System was woken up via the WKUP pin and the SYS_UART_UP signal was found to be responsible.
801
 * In this case, the system starts as after a cold reset.
802
 */
803
ErrorStatus handleUartWakeup() {
804
  return handleColdReset();
805
} /*** end of handleUartWakeup ***/
806
807
/*
808
 * System was woken up via the WKUP pin and the ACCEL_INT_N signal was found to be responsible.
809
 * The SYS_UART_UP signal is used to wake the PowerManagement before a normal cold reset is performed.
810
 */
811
ErrorStatus handleAccelWakeup() {
812
  /* wakeup the PowerManegement (ensure that the pulse is detected) */
813
  GPIO_ResetBits(SYS_UART_UP_GPIO, SYS_UART_UP_PIN);
814
  msleep(1);
815
  GPIO_SetBits(SYS_UART_UP_GPIO, SYS_UART_UP_PIN);
816
817
  return handleColdReset();
818
} /*** end of handleAccelWakeu ***/
819
820
/*
821
 * Callback function that handles the system shutdown and enters transportation mode.
822
 * When called from a multithreaded environment, it must be ensured that no other thread will preempt this function.
823
 * In transportation low-power mode the system can only be woken up by pulling down the NRST signal.
824
 * Furthermore, the system can not be charged when in transportation mode.
825
 */
826 fc7151bb Thomas Schöpping
void blCallbackShutdownTransportation() {
827 69661903 Thomas Schöpping
  /* make sure that the required clocks are activated */
828
  RCC_APB1PeriphClockCmd(RCC_APB1Periph_PWR, ENABLE);
829
  RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE);
830
831
  /* set/keep the SYS_SYNC and SYS_PD signals active */
832
  GPIO_ResetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
833
  GPIO_ResetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
834
835 fc7151bb Thomas Schöpping
  /* initialized the standalone timer */
836 69661903 Thomas Schöpping
  saTimerInit();
837
838 fc7151bb Thomas Schöpping
  setLed(BLT_TRUE);
839
840 69661903 Thomas Schöpping
  shutdownToTransportation(BLT_TRUE);
841
842
  return;
843
} /*** end of blCallbackShutdownTransportation ***/
844
845
/*
846
 * Callback function that handles the system shutdown and enters deepsleep mode.
847
 * When called from a multithreaded environment, it must be ensured that no other thread will preempt this function.
848
 * In deepsleep low-power mode the system can only be woken up via the NRST or the WKUP signal, or the RTC or IWDG, if configured.
849
 */
850
void blCallbackShutdownDeepsleep(void) {
851
  /* make sure that the required clocks are activated */
852
  RCC_APB1PeriphClockCmd(RCC_APB1Periph_PWR, ENABLE);
853
  RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE);
854
855
  /* set/keep the SYS_SYNC and SYS_PD signals active */
856
  GPIO_ResetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
857
  GPIO_ResetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
858
859 fc7151bb Thomas Schöpping
  /* initialized the standalone timer */
860 69661903 Thomas Schöpping
  saTimerInit();
861
862 fc7151bb Thomas Schöpping
  setLed(BLT_TRUE);
863
864 69661903 Thomas Schöpping
  shutdownToDeepsleep(BLT_TRUE);
865
866
  return;
867
} /*** end of blCallbackShutdownDeepsleep ***/
868
869
/*
870
 * Callback function that handles the system shutdown and enters hibernate mode.
871
 * When called from a multithreaded environment, it must be ensured that no other thread will preempt this function.
872
 */
873
void blCallbackShutdownHibernate(void) {
874
  /* make sure that the required clocks are activated */
875
  RCC_APB1PeriphClockCmd(RCC_APB1Periph_PWR, ENABLE);
876
  RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE);
877
878
  /* set/keep the SYS_SYNC and SYS_PD signals active */
879
  GPIO_ResetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
880
  GPIO_ResetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
881
882 fc7151bb Thomas Schöpping
  /* initialized the standalone timer */
883 69661903 Thomas Schöpping
  saTimerInit();
884
885 fc7151bb Thomas Schöpping
  setLed(BLT_TRUE);
886
887 69661903 Thomas Schöpping
  shutdownToHibernate(BLT_TRUE);
888
889
  return;
890
} /*** end of blCallbackShutdownHibernate ***/
891
892
/*
893
 * Callback function that handles the system shutdown and initializes a restart.
894
 * When called from a multithreaded environment, it must be ensured that no other thread will preempt this function.
895
 */
896
void blCallbackShutdownRestart(void) {
897
  /* make sure that the required clocks are activated */
898
  RCC_APB1PeriphClockCmd(RCC_APB1Periph_PWR, ENABLE);
899
  RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE);
900
901 fc7151bb Thomas Schöpping
  /* set/keep the SYS_SYNC and SYS_PD signals active */
902 69661903 Thomas Schöpping
  GPIO_ResetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
903
  GPIO_ResetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
904
905 fc7151bb Thomas Schöpping
  /* initialized the standalone timer */
906 69661903 Thomas Schöpping
  saTimerInit();
907 fc7151bb Thomas Schöpping
908
  setLed(BLT_TRUE);
909
910
  /* deactivate SYS_PD_N and ensure that all modules had a chance to detect the falling edge */
911 69661903 Thomas Schöpping
  msleep(1);
912
  GPIO_SetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
913
  msleep(1);
914
915
  shutdownAndRestart(BLT_TRUE);
916
917
  return;
918
} /*** end of blCallbackRestart ***/
919
920
/*
921
 * Callback function that handles a system shutdown/restart request from another module.
922
 * Depending on the result of the disambiguation procedure, the module will enter the according low-power mode or restart.
923
 * When called from a multithreaded environment, it must be ensured that no other thread will preempt this function.
924
 */
925
void blCallbackHandleShutdownRequest(void) {
926
  /* make sure that the required clocks are activated */
927
  RCC_APB1PeriphClockCmd(RCC_APB1Periph_PWR, ENABLE);
928
  RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE);
929
930 fc7151bb Thomas Schöpping
  /* set/keep the SYS_SYNC and SYS_PD signals active */
931 69661903 Thomas Schöpping
  GPIO_ResetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
932
  GPIO_ResetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
933
934
  /* initialized the standalone timer */
935
  saTimerInit();
936
937
  setLed(BLT_TRUE);
938
939
  /* deactivate SYS_PD_N and ensure that all modules had a chance to detect the falling edge */
940
  msleep(1);
941
  GPIO_SetBits(SYS_PD_N_GPIO, SYS_PD_N_PIN);
942
  msleep(1);
943
944
  /* wait for all boards to be ready for shutdown */
945
  GPIO_SetBits(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN);
946
  if (GPIO_ReadOutputDataBit(SYS_REG_EN_GPIO, SYS_REG_EN_PIN) == Bit_SET) {
947 fc7151bb Thomas Schöpping
    // this must be skipped if the pullup voltage (VIO3.3) is not active
948 69661903 Thomas Schöpping
    setLed(BLT_TRUE);
949
    waitForSignal(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN, Bit_SET);
950
    setLed(BLT_FALSE);
951
  }
952
953
  /* check ths SYS_PD_N signal, whether the system shall shutdown or restart */
954
  blt_bool shutdown_nrestart = (GPIO_ReadInputDataBit(SYS_PD_N_GPIO, SYS_PD_N_PIN) == Bit_RESET) ? BLT_TRUE : BLT_FALSE;
955
956
  /* disambiguation procedure (passive) */
957
  uint32_t pulse_counter = 0;
958
  while (waitForSignalTimeout(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN, Bit_RESET, 10)) {
959
    waitForSignal(SYS_SYNC_N_GPIO, SYS_SYNC_N_PIN, Bit_SET);
960
    ++pulse_counter;
961
  }
962
963
  /* evaluate and hanlde disambiguation result */
964
  if (shutdown_nrestart == BLT_TRUE) {
965
    /* shutdown request */
966
967
    /* handle special cases */
968
    if (pulse_counter == BL_SHUTDOWN_PRI_RSN_UNKNOWN) {
969
      /* no pulse at all was received */
970
      pulse_counter = BL_SHUTDOWN_PRI_RSN_DEFAULT;
971
    } else if (pulse_counter != BL_SHUTDOWN_PRI_RSN_HIBERNATE &&
972
               pulse_counter != BL_SHUTDOWN_PRI_RSN_DEEPSLEEP &&
973
               pulse_counter != BL_SHUTDOWN_PRI_RSN_TRANSPORT) {
974
      /* invalid number of pulses received */
975
      blinkSOS(1);
976
      pulse_counter = BL_SHUTDOWN_PRI_RSN_DEFAULT;
977
    }
978
979
    switch (pulse_counter) {
980
      case BL_SHUTDOWN_PRI_RSN_HIBERNATE:
981
        shutdownToHibernate(BLT_FALSE);
982
        break;
983
      case BL_SHUTDOWN_PRI_RSN_DEEPSLEEP:
984
        shutdownToDeepsleep(BLT_FALSE);
985
        break;
986
      case BL_SHUTDOWN_PRI_RSN_TRANSPORT:
987
        shutdownToTransportation(BLT_FALSE);
988
        break;
989
    }
990
  } else {
991
    /* restart request */
992
993
    /* there is no ambiguity for restart, so it is ignored */
994
    shutdownAndRestart(BLT_FALSE);
995
  }
996
997
  /* if this code is reached, the system did neither shut down, nor restart.
998
   * This must never be the case!
999
   */
1000
  blinkSOSinf();
1001
  return;
1002
} /*** end of blCallbackHandleShutdownRequest ***/
1003
1004
/*********************************** end of main.c *************************************/