26d230419c
This allows to properly initialize the system led and add it to the sleep module so that it can be restored when resuming from suspended mode.
231 lines
8.1 KiB
C
231 lines
8.1 KiB
C
/*
|
|
* This file is part of the Micro Python project, http://micropython.org/
|
|
*
|
|
* The MIT License (MIT)
|
|
*
|
|
* Copyright (c) 2013, 2014 Damien P. George
|
|
* Copyright (c) 2015 Daniel Campora
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
|
|
#include <std.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
|
|
#include "py/mpconfig.h"
|
|
#include MICROPY_HAL_H
|
|
#include "py/obj.h"
|
|
#include "hw_ints.h"
|
|
#include "hw_types.h"
|
|
#include "hw_gpio.h"
|
|
#include "hw_memmap.h"
|
|
#include "hw_gprcm.h"
|
|
#include "hw_common_reg.h"
|
|
#include "pin.h"
|
|
#include "gpio.h"
|
|
#ifndef BOOTLOADER
|
|
#include "pybpin.h"
|
|
#include "pins.h"
|
|
#endif
|
|
#include "rom.h"
|
|
#include "rom_map.h"
|
|
#include "prcm.h"
|
|
#include "pybuart.h"
|
|
#include "utils.h"
|
|
#include "mperror.h"
|
|
|
|
|
|
/******************************************************************************
|
|
DEFINE CONSTANTS
|
|
******************************************************************************/
|
|
#define MPERROR_TOOGLE_MS (40)
|
|
#define MPERROR_SIGNAL_ERROR_MS (1000)
|
|
#define MPERROR_HEARTBEAT_ON_MS (80)
|
|
#define MPERROR_HEARTBEAT_OFF_MS (4920)
|
|
|
|
/******************************************************************************
|
|
DECLARE PRIVATE DATA
|
|
******************************************************************************/
|
|
struct mperror_heart_beat {
|
|
uint32_t off_time;
|
|
uint32_t on_time;
|
|
bool beating;
|
|
bool enabled;
|
|
} mperror_heart_beat = {.off_time = 0, .on_time = 0, .beating = false, .enabled = false};
|
|
|
|
/******************************************************************************
|
|
DEFINE PUBLIC FUNCTIONS
|
|
******************************************************************************/
|
|
void mperror_init0 (void) {
|
|
#ifdef BOOTLOADER
|
|
// enable the system led and the safe boot pin peripheral clocks
|
|
MAP_PRCMPeripheralClkEnable(MICROPY_SYS_LED_PRCM, PRCM_RUN_MODE_CLK | PRCM_SLP_MODE_CLK);
|
|
MAP_PRCMPeripheralClkEnable(MICROPY_SAFE_BOOT_PRCM, PRCM_RUN_MODE_CLK | PRCM_SLP_MODE_CLK);
|
|
// configure the safe boot pin
|
|
MAP_PinTypeGPIO(MICROPY_SAFE_BOOT_PIN_NUM, PIN_MODE_0, false);
|
|
MAP_PinConfigSet(MICROPY_SAFE_BOOT_PIN_NUM, PIN_STRENGTH_4MA, PIN_TYPE_STD_PD);
|
|
MAP_GPIODirModeSet(MICROPY_SAFE_BOOT_PORT, MICROPY_SAFE_BOOT_PORT_PIN, GPIO_DIR_MODE_IN);
|
|
// configure the bld
|
|
MAP_PinTypeGPIO(MICROPY_SYS_LED_PIN_NUM, PIN_MODE_0, false);
|
|
MAP_PinConfigSet(MICROPY_SYS_LED_PIN_NUM, PIN_STRENGTH_6MA, PIN_TYPE_STD);
|
|
MAP_GPIODirModeSet(MICROPY_SYS_LED_PORT, MICROPY_SYS_LED_PORT_PIN, GPIO_DIR_MODE_OUT);
|
|
#else
|
|
// configure the system led
|
|
pin_config ((pin_obj_t *)&MICROPY_SYS_LED_GPIO, PIN_MODE_0, GPIO_DIR_MODE_OUT, PIN_TYPE_STD, PIN_STRENGTH_6MA);
|
|
#endif
|
|
mperror_heartbeat_switch_off();
|
|
}
|
|
|
|
void mperror_bootloader_check_reset_cause (void) {
|
|
// if we are recovering from a WDT reset, trigger
|
|
// a hibernate cycle for a clean boot
|
|
if (MAP_PRCMSysResetCauseGet() == PRCM_WDT_RESET) {
|
|
HWREG(0x400F70B8) = 1;
|
|
UtilsDelay(800000/5);
|
|
HWREG(0x400F70B0) = 1;
|
|
UtilsDelay(800000/5);
|
|
|
|
HWREG(0x4402E16C) |= 0x2;
|
|
UtilsDelay(800);
|
|
HWREG(0x4402F024) &= 0xF7FFFFFF;
|
|
|
|
// since the reset cause will be changed, we must store the right reason
|
|
// so that the application knows it when booting for the next time
|
|
PRCMSignalWDTReset();
|
|
|
|
MAP_PRCMHibernateWakeupSourceEnable(PRCM_HIB_SLOW_CLK_CTR);
|
|
// set the sleep interval to 10ms
|
|
MAP_PRCMHibernateIntervalSet(330);
|
|
MAP_PRCMHibernateEnter();
|
|
}
|
|
}
|
|
|
|
void mperror_deinit_sfe_pin (void) {
|
|
// disable the pull-down
|
|
MAP_PinConfigSet(MICROPY_SAFE_BOOT_PIN_NUM, PIN_STRENGTH_4MA, PIN_TYPE_STD);
|
|
}
|
|
|
|
void mperror_signal_error (void) {
|
|
uint32_t count = 0;
|
|
while ((MPERROR_TOOGLE_MS * count++) < MPERROR_SIGNAL_ERROR_MS) {
|
|
// toogle the led
|
|
MAP_GPIOPinWrite(MICROPY_SYS_LED_PORT, MICROPY_SYS_LED_PORT_PIN, ~MAP_GPIOPinRead(MICROPY_SYS_LED_PORT, MICROPY_SYS_LED_PORT_PIN));
|
|
UtilsDelay(UTILS_DELAY_US_TO_COUNT(MPERROR_TOOGLE_MS * 1000));
|
|
}
|
|
}
|
|
|
|
void mperror_enable_heartbeat (void) {
|
|
mperror_heart_beat.enabled = true;
|
|
}
|
|
|
|
void mperror_heartbeat_switch_off (void) {
|
|
mperror_heart_beat.on_time = 0;
|
|
mperror_heart_beat.off_time = 0;
|
|
MAP_GPIOPinWrite(MICROPY_SYS_LED_PORT, MICROPY_SYS_LED_PORT_PIN, 0);
|
|
}
|
|
|
|
void mperror_disable_heartbeat (void) {
|
|
mperror_heart_beat.enabled = false;
|
|
mperror_heartbeat_switch_off();
|
|
}
|
|
|
|
void mperror_heartbeat_signal (void) {
|
|
if (mperror_heart_beat.enabled) {
|
|
if (!mperror_heart_beat.beating) {
|
|
if ((mperror_heart_beat.on_time = HAL_GetTick()) - mperror_heart_beat.off_time > MPERROR_HEARTBEAT_OFF_MS) {
|
|
MAP_GPIOPinWrite(MICROPY_SYS_LED_PORT, MICROPY_SYS_LED_PORT_PIN, MICROPY_SYS_LED_PORT_PIN);
|
|
mperror_heart_beat.beating = true;
|
|
}
|
|
}
|
|
else {
|
|
if ((mperror_heart_beat.off_time = HAL_GetTick()) - mperror_heart_beat.on_time > MPERROR_HEARTBEAT_ON_MS) {
|
|
MAP_GPIOPinWrite(MICROPY_SYS_LED_PORT, MICROPY_SYS_LED_PORT_PIN, 0);
|
|
mperror_heart_beat.beating = false;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void NORETURN __fatal_error(const char *msg) {
|
|
#ifdef DEBUG
|
|
if (msg != NULL) {
|
|
// wait for 20ms
|
|
UtilsDelay(UTILS_DELAY_US_TO_COUNT(20000));
|
|
mp_hal_stdout_tx_str("\r\nFATAL ERROR:");
|
|
mp_hal_stdout_tx_str(msg);
|
|
mp_hal_stdout_tx_str("\r\n");
|
|
}
|
|
#endif
|
|
// signal the crash with the system led
|
|
MAP_GPIOPinWrite(MICROPY_SYS_LED_PORT, MICROPY_SYS_LED_PORT_PIN, MICROPY_SYS_LED_PORT_PIN);
|
|
for ( ;; ) {__WFI();}
|
|
}
|
|
|
|
void __assert_func(const char *file, int line, const char *func, const char *expr) {
|
|
(void) func;
|
|
printf("Assertion failed: %s, file %s, line %d\n", expr, file, line);
|
|
__fatal_error(NULL);
|
|
}
|
|
|
|
void nlr_jump_fail(void *val) {
|
|
#ifdef DEBUG
|
|
char msg[64];
|
|
snprintf(msg, sizeof(msg), "uncaught exception %p\n", val);
|
|
__fatal_error(msg);
|
|
#else
|
|
__fatal_error(NULL);
|
|
#endif
|
|
}
|
|
|
|
#ifndef BOOTLOADER
|
|
/******************************************************************************/
|
|
// Micro Python bindings
|
|
|
|
/// \function enable()
|
|
/// Enables the heartbeat signal
|
|
STATIC mp_obj_t pyb_enable_heartbeat(mp_obj_t self) {
|
|
mperror_enable_heartbeat ();
|
|
return mp_const_none;
|
|
}
|
|
STATIC MP_DEFINE_CONST_FUN_OBJ_1(pyb_enable_heartbeat_obj, pyb_enable_heartbeat);
|
|
|
|
/// \function disable()
|
|
/// Disables the heartbeat signal
|
|
STATIC mp_obj_t pyb_disable_heartbeat(mp_obj_t self) {
|
|
mperror_disable_heartbeat ();
|
|
return mp_const_none;
|
|
}
|
|
STATIC MP_DEFINE_CONST_FUN_OBJ_1(pyb_disable_heartbeat_obj, pyb_disable_heartbeat);
|
|
|
|
STATIC const mp_map_elem_t pyb_heartbeat_locals_dict_table[] = {
|
|
{ MP_OBJ_NEW_QSTR(MP_QSTR_enable), (mp_obj_t)&pyb_enable_heartbeat_obj },
|
|
{ MP_OBJ_NEW_QSTR(MP_QSTR_disable), (mp_obj_t)&pyb_disable_heartbeat_obj },
|
|
};
|
|
STATIC MP_DEFINE_CONST_DICT(pyb_heartbeat_locals_dict, pyb_heartbeat_locals_dict_table);
|
|
|
|
static const mp_obj_type_t pyb_heartbeat_type = {
|
|
{ &mp_type_type },
|
|
.name = MP_QSTR_HeartBeat,
|
|
.locals_dict = (mp_obj_t)&pyb_heartbeat_locals_dict,
|
|
};
|
|
|
|
const mp_obj_base_t pyb_heartbeat_obj = {&pyb_heartbeat_type};
|
|
#endif
|