mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 02:55:07 +08:00
Changes to tap_v1 for upstream Nuttx and hardfault logging
This commit is contained in:
committed by
Lorenz Meier
parent
402251819d
commit
b7cc04e0d2
@@ -1,5 +1,7 @@
|
|||||||
include(nuttx/px4_impl_nuttx)
|
include(nuttx/px4_impl_nuttx)
|
||||||
|
|
||||||
|
px4_nuttx_configure(HWCLASS m4 CONFIG nsh ROMFS y ROMFSROOT tap_common)
|
||||||
|
|
||||||
set(CMAKE_TOOLCHAIN_FILE ${PX4_SOURCE_DIR}/cmake/toolchains/Toolchain-arm-none-eabi.cmake)
|
set(CMAKE_TOOLCHAIN_FILE ${PX4_SOURCE_DIR}/cmake/toolchains/Toolchain-arm-none-eabi.cmake)
|
||||||
|
|
||||||
set(target_definitions MEMORY_CONSTRAINED_SYSTEM)
|
set(target_definitions MEMORY_CONSTRAINED_SYSTEM)
|
||||||
@@ -35,6 +37,7 @@ set(config_module_list
|
|||||||
systemcmds/param
|
systemcmds/param
|
||||||
systemcmds/perf
|
systemcmds/perf
|
||||||
systemcmds/pwm
|
systemcmds/pwm
|
||||||
|
systemcmds/hardfault_log
|
||||||
systemcmds/motor_test
|
systemcmds/motor_test
|
||||||
systemcmds/reboot
|
systemcmds/reboot
|
||||||
systemcmds/top
|
systemcmds/top
|
||||||
|
|||||||
@@ -154,8 +154,20 @@
|
|||||||
* Note: TIM1,8 are on APB2, others on APB1
|
* Note: TIM1,8 are on APB2, others on APB1
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#define STM32_TIM18_FREQUENCY (2*STM32_PCLK2_FREQUENCY)
|
#define BOARD_TIM1_FREQUENCY STM32_APB2_TIM1_CLKIN
|
||||||
#define STM32_TIM27_FREQUENCY (2*STM32_PCLK1_FREQUENCY)
|
#define BOARD_TIM2_FREQUENCY STM32_APB1_TIM2_CLKIN
|
||||||
|
#define BOARD_TIM3_FREQUENCY STM32_APB1_TIM3_CLKIN
|
||||||
|
#define BOARD_TIM4_FREQUENCY STM32_APB1_TIM4_CLKIN
|
||||||
|
#define BOARD_TIM5_FREQUENCY STM32_APB1_TIM5_CLKIN
|
||||||
|
#define BOARD_TIM6_FREQUENCY STM32_APB1_TIM6_CLKIN
|
||||||
|
#define BOARD_TIM7_FREQUENCY STM32_APB1_TIM7_CLKIN
|
||||||
|
#define BOARD_TIM8_FREQUENCY STM32_APB2_TIM8_CLKIN
|
||||||
|
#define BOARD_TIM9_FREQUENCY STM32_APB2_TIM9_CLKIN
|
||||||
|
#define BOARD_TIM10_FREQUENCY STM32_APB2_TIM10_CLKIN
|
||||||
|
#define BOARD_TIM11_FREQUENCY STM32_APB2_TIM11_CLKIN
|
||||||
|
#define BOARD_TIM12_FREQUENCY STM32_APB1_TIM12_CLKIN
|
||||||
|
#define BOARD_TIM13_FREQUENCY STM32_APB1_TIM13_CLKIN
|
||||||
|
#define BOARD_TIM14_FREQUENCY STM32_APB1_TIM14_CLKIN
|
||||||
|
|
||||||
/* LED definitions ******************************************************************/
|
/* LED definitions ******************************************************************/
|
||||||
/* If CONFIG_ARCH_LEDS is not defined, then the user can control the LEDs in any
|
/* If CONFIG_ARCH_LEDS is not defined, then the user can control the LEDs in any
|
||||||
|
|||||||
@@ -35,14 +35,14 @@
|
|||||||
|
|
||||||
include ${TOPDIR}/.config
|
include ${TOPDIR}/.config
|
||||||
include ${TOPDIR}/tools/Config.mk
|
include ${TOPDIR}/tools/Config.mk
|
||||||
|
|
||||||
include $(TOPDIR)/PX4_Warnings.mk
|
include $(TOPDIR)/PX4_Warnings.mk
|
||||||
|
include $(TOPDIR)/PX4_Config.mk
|
||||||
|
|
||||||
#
|
#
|
||||||
# We only support building with the ARM bare-metal toolchain from
|
# We only support building with the ARM bare-metal toolchain from
|
||||||
# https://launchpad.net/gcc-arm-embedded on Windows, Linux or Mac OS.
|
# https://launchpad.net/gcc-arm-embedded on Windows, Linux or Mac OS.
|
||||||
#
|
#
|
||||||
CONFIG_ARMV7M_TOOLCHAIN := GNU_EABI
|
CONFIG_ARMV7M_TOOLCHAIN := GNU_EABI${HOST_OS_FIRST_LETTER}
|
||||||
|
|
||||||
include ${TOPDIR}/arch/arm/src/armv7-m/Toolchain.defs
|
include ${TOPDIR}/arch/arm/src/armv7-m/Toolchain.defs
|
||||||
|
|
||||||
@@ -62,17 +62,19 @@ ARCHCPUFLAGS = -mcpu=cortex-m4 \
|
|||||||
-mfpu=fpv4-sp-d16 \
|
-mfpu=fpv4-sp-d16 \
|
||||||
-mfloat-abi=hard
|
-mfloat-abi=hard
|
||||||
|
|
||||||
|
# Enable precise stack overflow tracking
|
||||||
|
|
||||||
# enable precise stack overflow tracking
|
|
||||||
ifeq ($(CONFIG_ARMV7M_STACKCHECK),y)
|
ifeq ($(CONFIG_ARMV7M_STACKCHECK),y)
|
||||||
INSTRUMENTATIONDEFINES = -finstrument-functions -ffixed-r10
|
INSTRUMENTATIONDEFINES = -finstrument-functions -ffixed-r10
|
||||||
endif
|
endif
|
||||||
|
|
||||||
# pull in *just* libm from the toolchain ... this is grody
|
# Pull in *just* libm from the toolchain ... this is grody
|
||||||
|
|
||||||
LIBM = "${shell $(CC) $(ARCHCPUFLAGS) -print-file-name=libm.a}"
|
LIBM = "${shell $(CC) $(ARCHCPUFLAGS) -print-file-name=libm.a}"
|
||||||
EXTRA_LIBS += $(LIBM)
|
EXTRA_LIBS += $(LIBM)
|
||||||
|
|
||||||
# use our linker script
|
# Use our linker script
|
||||||
|
|
||||||
LDSCRIPT = ld.script
|
LDSCRIPT = ld.script
|
||||||
|
|
||||||
ifeq ($(WINTOOL),y)
|
ifeq ($(WINTOOL),y)
|
||||||
@@ -94,18 +96,20 @@ else
|
|||||||
ARCHSCRIPT = -T$(TOPDIR)/configs/$(CONFIG_ARCH_BOARD)/scripts/$(LDSCRIPT)
|
ARCHSCRIPT = -T$(TOPDIR)/configs/$(CONFIG_ARCH_BOARD)/scripts/$(LDSCRIPT)
|
||||||
else
|
else
|
||||||
# Linux/Cygwin-native toolchain
|
# Linux/Cygwin-native toolchain
|
||||||
MKDEP = $(TOPDIR)/tools/mkdeps.sh
|
MKDEP = $(TOPDIR)/tools/mkdeps$(HOSTEXEEXT)
|
||||||
ARCHINCLUDES = -I. -isystem $(TOPDIR)/include
|
ARCHINCLUDES = -I. -isystem $(TOPDIR)/include
|
||||||
ARCHXXINCLUDES = -I. -isystem $(TOPDIR)/include -isystem $(TOPDIR)/include/cxx
|
ARCHXXINCLUDES = -I. -isystem $(TOPDIR)/include -isystem $(TOPDIR)/include/cxx
|
||||||
ARCHSCRIPT = -T$(TOPDIR)/configs/$(CONFIG_ARCH_BOARD)/scripts/$(LDSCRIPT)
|
ARCHSCRIPT = -T$(TOPDIR)/configs/$(CONFIG_ARCH_BOARD)/scripts/$(LDSCRIPT)
|
||||||
endif
|
endif
|
||||||
endif
|
endif
|
||||||
|
|
||||||
# tool versions
|
# Tool versions
|
||||||
|
|
||||||
ARCHCCVERSION = ${shell $(CC) -v 2>&1 | sed -n '/^gcc version/p' | sed -e 's/^gcc version \([0-9\.]\)/\1/g' -e 's/[-\ ].*//g' -e '1q'}
|
ARCHCCVERSION = ${shell $(CC) -v 2>&1 | sed -n '/^gcc version/p' | sed -e 's/^gcc version \([0-9\.]\)/\1/g' -e 's/[-\ ].*//g' -e '1q'}
|
||||||
ARCHCCMAJOR = ${shell echo $(ARCHCCVERSION) | cut -d'.' -f1}
|
ARCHCCMAJOR = ${shell echo $(ARCHCCVERSION) | cut -d'.' -f1}
|
||||||
|
|
||||||
# optimisation flags
|
# Optimization flags
|
||||||
|
|
||||||
ARCHOPTIMIZATION = $(MAXOPTIMIZATION) \
|
ARCHOPTIMIZATION = $(MAXOPTIMIZATION) \
|
||||||
-fno-strict-aliasing \
|
-fno-strict-aliasing \
|
||||||
-fno-strength-reduce \
|
-fno-strength-reduce \
|
||||||
@@ -127,7 +131,8 @@ ARCHWARNINGSXX = $(ARCHWARNINGS) $(PX4_ARCHWARNINGSXX)
|
|||||||
ARCHDEFINES =
|
ARCHDEFINES =
|
||||||
ARCHPICFLAGS = -fpic -msingle-pic-base -mpic-register=r10
|
ARCHPICFLAGS = -fpic -msingle-pic-base -mpic-register=r10
|
||||||
|
|
||||||
# this seems to be the only way to add linker flags
|
# This seems to be the only way to add linker flags
|
||||||
|
|
||||||
EXTRA_LIBS += --warn-common \
|
EXTRA_LIBS += --warn-common \
|
||||||
--gc-sections
|
--gc-sections
|
||||||
|
|
||||||
@@ -146,8 +151,8 @@ OBJEXT = .o
|
|||||||
LIBEXT = .a
|
LIBEXT = .a
|
||||||
EXEEXT =
|
EXEEXT =
|
||||||
|
|
||||||
|
# Produce partially-linked $1 from files in $2
|
||||||
|
|
||||||
# produce partially-linked $1 from files in $2
|
|
||||||
define PRELINK
|
define PRELINK
|
||||||
@echo "PRELINK: $1"
|
@echo "PRELINK: $1"
|
||||||
$(Q) $(LD) -Ur -o $1 $2 && $(OBJCOPY) --localize-hidden $1
|
$(Q) $(LD) -Ur -o $1 $2 && $(OBJCOPY) --localize-hidden $1
|
||||||
|
|||||||
@@ -1,52 +0,0 @@
|
|||||||
############################################################################
|
|
||||||
# configs/px4fmu/nsh/appconfig
|
|
||||||
#
|
|
||||||
# Copyright (C) 2011 Gregory Nutt. All rights reserved.
|
|
||||||
# Author: Gregory Nutt <gnutt@nuttx.org>
|
|
||||||
#
|
|
||||||
# Redistribution and use in source and binary forms, with or without
|
|
||||||
# modification, are permitted provided that the following conditions
|
|
||||||
# are met:
|
|
||||||
#
|
|
||||||
# 1. Redistributions of source code must retain the above copyright
|
|
||||||
# notice, this list of conditions and the following disclaimer.
|
|
||||||
# 2. Redistributions in binary form must reproduce the above copyright
|
|
||||||
# notice, this list of conditions and the following disclaimer in
|
|
||||||
# the documentation and/or other materials provided with the
|
|
||||||
# distribution.
|
|
||||||
# 3. Neither the name NuttX nor the names of its contributors may be
|
|
||||||
# used to endorse or promote products derived from this software
|
|
||||||
# without specific prior written permission.
|
|
||||||
#
|
|
||||||
# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
||||||
# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
||||||
# LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
|
||||||
# FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
|
||||||
# COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
|
||||||
# BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
|
||||||
# OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
|
||||||
# AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
||||||
# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
|
||||||
# ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
||||||
# POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
#
|
|
||||||
############################################################################
|
|
||||||
|
|
||||||
# Path to example in apps/examples containing the user_start entry point
|
|
||||||
|
|
||||||
CONFIGURED_APPS += examples/nsh
|
|
||||||
|
|
||||||
# The NSH application library
|
|
||||||
CONFIGURED_APPS += nshlib
|
|
||||||
CONFIGURED_APPS += system/readline
|
|
||||||
|
|
||||||
ifeq ($(CONFIG_CAN),y)
|
|
||||||
CONFIGURED_APPS += examples/can
|
|
||||||
endif
|
|
||||||
|
|
||||||
#ifeq ($(CONFIG_USBDEV),y)
|
|
||||||
#ifeq ($(CONFIG_CDCACM),y)
|
|
||||||
CONFIGURED_APPS += examples/cdcacm
|
|
||||||
#endif
|
|
||||||
#endif
|
|
||||||
+677
-204
File diff suppressed because it is too large
Load Diff
@@ -80,5 +80,9 @@ distclean: clean
|
|||||||
$(call DELFILE, Make.dep)
|
$(call DELFILE, Make.dep)
|
||||||
$(call DELFILE, .depend)
|
$(call DELFILE, .depend)
|
||||||
|
|
||||||
|
ifneq ($(BOARD_CONTEXT),y)
|
||||||
|
context:
|
||||||
|
endif
|
||||||
|
|
||||||
-include Make.dep
|
-include Make.dep
|
||||||
|
|
||||||
|
|||||||
@@ -36,6 +36,7 @@ px4_add_module(
|
|||||||
COMPILE_FLAGS
|
COMPILE_FLAGS
|
||||||
SRCS
|
SRCS
|
||||||
../common/board_name.c
|
../common/board_name.c
|
||||||
|
../common/board_dma_alloc.c
|
||||||
tap_init.c
|
tap_init.c
|
||||||
tap_pwr.c
|
tap_pwr.c
|
||||||
tap_i2c.cpp
|
tap_i2c.cpp
|
||||||
|
|||||||
@@ -48,16 +48,11 @@
|
|||||||
#include <nuttx/compiler.h>
|
#include <nuttx/compiler.h>
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
|
|
||||||
#include <stm32.h>
|
|
||||||
#include <arch/board/board.h>
|
|
||||||
|
|
||||||
/****************************************************************************************************
|
/****************************************************************************************************
|
||||||
* Definitions
|
* Definitions
|
||||||
****************************************************************************************************/
|
****************************************************************************************************/
|
||||||
/* Configuration ************************************************************************************/
|
/* Configuration ************************************************************************************/
|
||||||
|
|
||||||
#define UDID_START 0x1FFF7A10
|
|
||||||
|
|
||||||
/* PX4FMU GPIOs ***********************************************************************************/
|
/* PX4FMU GPIOs ***********************************************************************************/
|
||||||
/* LEDs
|
/* LEDs
|
||||||
*
|
*
|
||||||
@@ -242,6 +237,9 @@
|
|||||||
{GPIO_GPIO4_INPUT, GPIO_GPIO4_OUTPUT, 0}, \
|
{GPIO_GPIO4_INPUT, GPIO_GPIO4_OUTPUT, 0}, \
|
||||||
{GPIO_GPIO5_INPUT, GPIO_GPIO5_OUTPUT, 0}, }
|
{GPIO_GPIO5_INPUT, GPIO_GPIO5_OUTPUT, 0}, }
|
||||||
|
|
||||||
|
/* This board provides a DMA pool and APIs */
|
||||||
|
|
||||||
|
#define BOARD_DMA_ALLOC_POOL_SIZE 5120
|
||||||
|
|
||||||
#define MS_PWR_BUTTON_DOWN 200
|
#define MS_PWR_BUTTON_DOWN 200
|
||||||
#define KEY_AD_GPIO (GPIO_INPUT|GPIO_PULLDOWN|GPIO_EXTI|GPIO_PORTC|GPIO_PIN1)
|
#define KEY_AD_GPIO (GPIO_INPUT|GPIO_PULLDOWN|GPIO_EXTI|GPIO_PORTC|GPIO_PIN1)
|
||||||
@@ -275,7 +273,6 @@ __BEGIN_DECLS
|
|||||||
/****************************************************************************************************
|
/****************************************************************************************************
|
||||||
* Public Functions
|
* Public Functions
|
||||||
****************************************************************************************************/
|
****************************************************************************************************/
|
||||||
|
|
||||||
/****************************************************************************************************
|
/****************************************************************************************************
|
||||||
* Name: stm32_spiinitialize
|
* Name: stm32_spiinitialize
|
||||||
*
|
*
|
||||||
@@ -286,9 +283,35 @@ __BEGIN_DECLS
|
|||||||
|
|
||||||
extern void stm32_spiinitialize(void);
|
extern void stm32_spiinitialize(void);
|
||||||
|
|
||||||
|
/************************************************************************************
|
||||||
|
* Name: stm32_spi_bus_initialize
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Called to configure SPI Buses.
|
||||||
|
*
|
||||||
|
************************************************************************************/
|
||||||
|
|
||||||
|
extern int stm32_spi_bus_initialize(void);
|
||||||
|
|
||||||
|
/****************************************************************************************************
|
||||||
|
* Name: board_spi_reset board_peripheral_reset
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Called to reset SPI and the perferal bus
|
||||||
|
*
|
||||||
|
****************************************************************************************************/
|
||||||
|
|
||||||
#define board_spi_reset(ms)
|
#define board_spi_reset(ms)
|
||||||
#define board_peripheral_reset(ms)
|
#define board_peripheral_reset(ms)
|
||||||
|
|
||||||
|
/****************************************************************************************************
|
||||||
|
* Name: stm32_usbinitialize
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Called to configure USB IO.
|
||||||
|
*
|
||||||
|
****************************************************************************************************/
|
||||||
|
|
||||||
extern void stm32_usbinitialize(void);
|
extern void stm32_usbinitialize(void);
|
||||||
|
|
||||||
/************************************************************************************
|
/************************************************************************************
|
||||||
@@ -302,23 +325,14 @@ extern void stm32_usbinitialize(void);
|
|||||||
extern int board_sdio_initialize(void);
|
extern int board_sdio_initialize(void);
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: nsh_archinitialize
|
* Name: board_i2c_initialize
|
||||||
*
|
*
|
||||||
* Description:
|
* Description:
|
||||||
* Perform architecture specific initialization for NSH.
|
* Called to set I2C bus frequencies.
|
||||||
*
|
|
||||||
* CONFIG_NSH_ARCHINIT=y :
|
|
||||||
* Called from the NSH library
|
|
||||||
*
|
|
||||||
* CONFIG_BOARD_INITIALIZE=y, CONFIG_NSH_LIBRARY=y, &&
|
|
||||||
* CONFIG_NSH_ARCHINIT=n :
|
|
||||||
* Called from board_initialize().
|
|
||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
#ifdef CONFIG_NSH_LIBRARY
|
int board_i2c_initialize(void);
|
||||||
int nsh_archinitialize(void);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/************************************************************************************
|
/************************************************************************************
|
||||||
* Name: board_pwr_init()
|
* Name: board_pwr_init()
|
||||||
@@ -352,15 +366,7 @@ bool board_pwr_button_down(void);
|
|||||||
|
|
||||||
void board_pwr(bool on_not_off);
|
void board_pwr(bool on_not_off);
|
||||||
|
|
||||||
/****************************************************************************
|
#include "../common/board_common.h"
|
||||||
* Name: board_i2c_initialize
|
|
||||||
*
|
|
||||||
* Description:
|
|
||||||
* Called to set I2C bus frequncies.
|
|
||||||
*
|
|
||||||
****************************************************************************/
|
|
||||||
|
|
||||||
int board_i2c_initialize(void);
|
|
||||||
|
|
||||||
#endif /* __ASSEMBLY__ */
|
#endif /* __ASSEMBLY__ */
|
||||||
|
|
||||||
|
|||||||
@@ -36,10 +36,10 @@
|
|||||||
* @file tap-v1_init.c
|
* @file tap-v1_init.c
|
||||||
*
|
*
|
||||||
* tap-v1-specific early startup code. This file implements the
|
* tap-v1-specific early startup code. This file implements the
|
||||||
* nsh_archinitialize() function that is called early by nsh during startup.
|
* board_app_initialize() function that is called early by nsh during startup.
|
||||||
*
|
*
|
||||||
* Code here is run before the rcS script is invoked; it should start required
|
* Code here is run before the rcS script is invoked; it should start required
|
||||||
* subsystems and perform board-specific initialisation.
|
* subsystems and perform board-specific initialization.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
@@ -50,16 +50,14 @@
|
|||||||
|
|
||||||
#include <stdbool.h>
|
#include <stdbool.h>
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
|
#include <string.h>
|
||||||
#include <debug.h>
|
#include <debug.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
|
|
||||||
#include <nuttx/arch.h>
|
#include <nuttx/arch.h>
|
||||||
#include <nuttx/i2c.h>
|
#include <nuttx/board.h>
|
||||||
#include <nuttx/analog/adc.h>
|
#include <nuttx/analog/adc.h>
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#include "stm32.h"
|
|
||||||
#include "board_config.h"
|
#include "board_config.h"
|
||||||
#include "stm32_uart.h"
|
#include "stm32_uart.h"
|
||||||
|
|
||||||
@@ -68,12 +66,17 @@
|
|||||||
#include <drivers/drv_hrt.h>
|
#include <drivers/drv_hrt.h>
|
||||||
#include <drivers/drv_led.h>
|
#include <drivers/drv_led.h>
|
||||||
|
|
||||||
|
#include <systemlib/px4_macros.h>
|
||||||
#include <systemlib/cpuload.h>
|
#include <systemlib/cpuload.h>
|
||||||
|
#include <systemlib/err.h>
|
||||||
|
#include <systemlib/hardfault_log.h>
|
||||||
|
#include <systemlib/systemlib.h>
|
||||||
|
|
||||||
# if defined(FLASH_BASED_PARAMS)
|
# if defined(FLASH_BASED_PARAMS)
|
||||||
# include <systemlib/flashparams/flashfs.h>
|
# include <systemlib/flashparams/flashfs.h>
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Pre-Processor Definitions
|
* Pre-Processor Definitions
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
@@ -84,13 +87,13 @@
|
|||||||
|
|
||||||
#ifdef CONFIG_CPP_HAVE_VARARGS
|
#ifdef CONFIG_CPP_HAVE_VARARGS
|
||||||
# ifdef CONFIG_DEBUG
|
# ifdef CONFIG_DEBUG
|
||||||
# define message(...) lowsyslog(__VA_ARGS__)
|
# define message(...) syslog(__VA_ARGS__)
|
||||||
# else
|
# else
|
||||||
# define message(...) printf(__VA_ARGS__)
|
# define message(...) printf(__VA_ARGS__)
|
||||||
# endif
|
# endif
|
||||||
#else
|
#else
|
||||||
# ifdef CONFIG_DEBUG
|
# ifdef CONFIG_DEBUG
|
||||||
# define message lowsyslog
|
# define message syslog
|
||||||
# else
|
# else
|
||||||
# define message printf
|
# define message printf
|
||||||
# endif
|
# endif
|
||||||
@@ -162,26 +165,46 @@ __EXPORT void stm32_boardinitialize(void)
|
|||||||
|
|
||||||
stm32_spiinitialize();
|
stm32_spiinitialize();
|
||||||
|
|
||||||
/* configure LEDs (empty call to NuttX' ledinit) */
|
/* configure LEDs */
|
||||||
|
|
||||||
up_ledinit();
|
board_autoled_initialize();
|
||||||
}
|
}
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: nsh_archinitialize
|
* Name: board_app_initialize
|
||||||
*
|
*
|
||||||
* Description:
|
* Description:
|
||||||
* Perform architecture specific initialization
|
* Perform architecture specific initialization
|
||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
__EXPORT int nsh_archinitialize(void)
|
__EXPORT int board_app_initialize(uintptr_t arg)
|
||||||
{
|
{
|
||||||
int result;
|
int result;
|
||||||
|
|
||||||
|
#if defined(CONFIG_HAVE_CXX) && defined(CONFIG_HAVE_CXXINITIALIZE)
|
||||||
|
|
||||||
|
/* run C++ ctors before we go any further */
|
||||||
|
|
||||||
|
up_cxxinitialize();
|
||||||
|
|
||||||
|
# if defined(CONFIG_EXAMPLES_NSH_CXXINITIALIZE)
|
||||||
|
# error CONFIG_EXAMPLES_NSH_CXXINITIALIZE Must not be defined! Use CONFIG_HAVE_CXX and CONFIG_HAVE_CXXINITIALIZE.
|
||||||
|
# endif
|
||||||
|
|
||||||
|
#else
|
||||||
|
# error platform is dependent on c++ both CONFIG_HAVE_CXX and CONFIG_HAVE_CXXINITIALIZE must be defined.
|
||||||
|
#endif
|
||||||
|
|
||||||
/* configure the high-resolution time/callout interface */
|
/* configure the high-resolution time/callout interface */
|
||||||
hrt_init();
|
hrt_init();
|
||||||
|
|
||||||
|
/* configure the DMA allocator */
|
||||||
|
|
||||||
|
if (board_dma_alloc_init() < 0) {
|
||||||
|
message("DMA alloc FAILED");
|
||||||
|
}
|
||||||
|
|
||||||
/* configure CPU load estimation */
|
/* configure CPU load estimation */
|
||||||
#ifdef CONFIG_SCHED_INSTRUMENTATION
|
#ifdef CONFIG_SCHED_INSTRUMENTATION
|
||||||
cpuload_initialize_once();
|
cpuload_initialize_once();
|
||||||
@@ -206,6 +229,138 @@ __EXPORT int nsh_archinitialize(void)
|
|||||||
|
|
||||||
board_pwr_init(1);
|
board_pwr_init(1);
|
||||||
|
|
||||||
|
#if defined(CONFIG_STM32_BBSRAM)
|
||||||
|
|
||||||
|
/* NB. the use of the console requires the hrt running
|
||||||
|
* to poll the DMA
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* Using Battery Backed Up SRAM */
|
||||||
|
|
||||||
|
int filesizes[CONFIG_STM32_BBSRAM_FILES + 1] = BSRAM_FILE_SIZES;
|
||||||
|
|
||||||
|
stm32_bbsraminitialize(BBSRAM_PATH, filesizes);
|
||||||
|
|
||||||
|
#if defined(CONFIG_STM32_SAVE_CRASHDUMP)
|
||||||
|
|
||||||
|
/* Panic Logging in Battery Backed Up Files */
|
||||||
|
|
||||||
|
/*
|
||||||
|
* In an ideal world, if a fault happens in flight the
|
||||||
|
* system save it to BBSRAM will then reboot. Upon
|
||||||
|
* rebooting, the system will log the fault to disk, recover
|
||||||
|
* the flight state and continue to fly. But if there is
|
||||||
|
* a fault on the bench or in the air that prohibit the recovery
|
||||||
|
* or committing the log to disk, the things are too broken to
|
||||||
|
* fly. So the question is:
|
||||||
|
*
|
||||||
|
* Did we have a hard fault and not make it far enough
|
||||||
|
* through the boot sequence to commit the fault data to
|
||||||
|
* the SD card?
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* Do we have an uncommitted hard fault in BBSRAM?
|
||||||
|
* - this will be reset after a successful commit to SD
|
||||||
|
*/
|
||||||
|
int hadCrash = hardfault_check_status("boot");
|
||||||
|
|
||||||
|
if (hadCrash == OK) {
|
||||||
|
|
||||||
|
message("[boot] There is a hard fault logged. Hold down the SPACE BAR," \
|
||||||
|
" while booting to halt the system!\n");
|
||||||
|
|
||||||
|
/* Yes. So add one to the boot count - this will be reset after a successful
|
||||||
|
* commit to SD
|
||||||
|
*/
|
||||||
|
|
||||||
|
int reboots = hardfault_increment_reboot("boot", false);
|
||||||
|
|
||||||
|
/* Also end the misery for a user that holds for a key down on the console */
|
||||||
|
|
||||||
|
int bytesWaiting;
|
||||||
|
ioctl(fileno(stdin), FIONREAD, (unsigned long)((uintptr_t) &bytesWaiting));
|
||||||
|
|
||||||
|
if (reboots > 2 || bytesWaiting != 0) {
|
||||||
|
|
||||||
|
/* Since we can not commit the fault dump to disk. Display it
|
||||||
|
* to the console.
|
||||||
|
*/
|
||||||
|
|
||||||
|
hardfault_write("boot", fileno(stdout), HARDFAULT_DISPLAY_FORMAT, false);
|
||||||
|
|
||||||
|
message("[boot] There were %d reboots with Hard fault that were not committed to disk - System halted %s\n",
|
||||||
|
reboots,
|
||||||
|
(bytesWaiting == 0 ? "" : " Due to Key Press\n"));
|
||||||
|
|
||||||
|
|
||||||
|
/* For those of you with a debugger set a break point on up_assert and
|
||||||
|
* then set dbgContinue = 1 and go.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* Clear any key press that got us here */
|
||||||
|
|
||||||
|
static volatile bool dbgContinue = false;
|
||||||
|
int c = '>';
|
||||||
|
|
||||||
|
while (!dbgContinue) {
|
||||||
|
|
||||||
|
switch (c) {
|
||||||
|
|
||||||
|
case EOF:
|
||||||
|
|
||||||
|
|
||||||
|
case '\n':
|
||||||
|
case '\r':
|
||||||
|
case ' ':
|
||||||
|
continue;
|
||||||
|
|
||||||
|
default:
|
||||||
|
|
||||||
|
putchar(c);
|
||||||
|
putchar('\n');
|
||||||
|
|
||||||
|
switch (c) {
|
||||||
|
|
||||||
|
case 'D':
|
||||||
|
case 'd':
|
||||||
|
hardfault_write("boot", fileno(stdout), HARDFAULT_DISPLAY_FORMAT, false);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 'C':
|
||||||
|
case 'c':
|
||||||
|
hardfault_rearm("boot");
|
||||||
|
hardfault_increment_reboot("boot", true);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 'B':
|
||||||
|
case 'b':
|
||||||
|
dbgContinue = true;
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
} // Inner Switch
|
||||||
|
|
||||||
|
message("\nEnter B - Continue booting\n" \
|
||||||
|
"Enter C - Clear the fault log\n" \
|
||||||
|
"Enter D - Dump fault log\n\n?>");
|
||||||
|
fflush(stdout);
|
||||||
|
|
||||||
|
if (!dbgContinue) {
|
||||||
|
c = getchar();
|
||||||
|
}
|
||||||
|
|
||||||
|
break;
|
||||||
|
|
||||||
|
} // outer switch
|
||||||
|
} // for
|
||||||
|
|
||||||
|
} // inner if
|
||||||
|
} // outer if
|
||||||
|
|
||||||
|
#endif // CONFIG_STM32_SAVE_CRASHDUMP
|
||||||
|
#endif // CONFIG_STM32_BBSRAM
|
||||||
|
|
||||||
/* initial LED state */
|
/* initial LED state */
|
||||||
drv_led_start();
|
drv_led_start();
|
||||||
led_off(LED_AMBER);
|
led_off(LED_AMBER);
|
||||||
@@ -214,7 +369,7 @@ __EXPORT int nsh_archinitialize(void)
|
|||||||
result = board_i2c_initialize();
|
result = board_i2c_initialize();
|
||||||
|
|
||||||
if (result != OK) {
|
if (result != OK) {
|
||||||
up_ledon(LED_AMBER);
|
led_on(LED_AMBER);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -231,7 +386,7 @@ __EXPORT int nsh_archinitialize(void)
|
|||||||
|
|
||||||
if (result != OK) {
|
if (result != OK) {
|
||||||
message("[boot] FAILED to init params in FLASH %d\n", result);
|
message("[boot] FAILED to init params in FLASH %d\n", result);
|
||||||
up_ledon(LED_AMBER);
|
led_on(LED_AMBER);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -242,9 +397,163 @@ __EXPORT int nsh_archinitialize(void)
|
|||||||
result = board_sdio_initialize();
|
result = board_sdio_initialize();
|
||||||
|
|
||||||
if (result != OK) {
|
if (result != OK) {
|
||||||
up_ledon(LED_AMBER);
|
led_on(LED_AMBER);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
|
||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void copy_reverse(stack_word_t *dest, stack_word_t *src, int size)
|
||||||
|
{
|
||||||
|
while (size--) {
|
||||||
|
*dest++ = *src--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
__EXPORT void board_crashdump(uintptr_t currentsp, FAR void *tcb, FAR const uint8_t *filename, int lineno)
|
||||||
|
{
|
||||||
|
/* We need a chunk of ram to save the complete context in.
|
||||||
|
* Since we are going to reboot we will use &_sdata
|
||||||
|
* which is the lowest memory and the amount we will save
|
||||||
|
* _should be_ below any resources we need herein.
|
||||||
|
* Unfortunately this is hard to test. See dead below
|
||||||
|
*/
|
||||||
|
|
||||||
|
fullcontext_s *pdump = (fullcontext_s *)&_sdata;
|
||||||
|
|
||||||
|
(void)enter_critical_section();
|
||||||
|
|
||||||
|
struct tcb_s *rtcb = (struct tcb_s *)tcb;
|
||||||
|
|
||||||
|
/* Zero out everything */
|
||||||
|
|
||||||
|
memset(pdump, 0, sizeof(fullcontext_s));
|
||||||
|
|
||||||
|
/* Save Info */
|
||||||
|
|
||||||
|
pdump->info.lineno = lineno;
|
||||||
|
|
||||||
|
if (filename) {
|
||||||
|
|
||||||
|
int offset = 0;
|
||||||
|
unsigned int len = strlen((char *)filename) + 1;
|
||||||
|
|
||||||
|
if (len > sizeof(pdump->info.filename)) {
|
||||||
|
offset = len - sizeof(pdump->info.filename) ;
|
||||||
|
}
|
||||||
|
|
||||||
|
strncpy(pdump->info.filename, (char *)&filename[offset], sizeof(pdump->info.filename));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Save the value of the pointer for current_regs as debugging info.
|
||||||
|
* It should be NULL in case of an ASSERT and will aid in cross
|
||||||
|
* checking the validity of system memory at the time of the
|
||||||
|
* fault.
|
||||||
|
*/
|
||||||
|
|
||||||
|
pdump->info.current_regs = (uintptr_t) CURRENT_REGS;
|
||||||
|
|
||||||
|
/* Save Context */
|
||||||
|
|
||||||
|
|
||||||
|
#if CONFIG_TASK_NAME_SIZE > 0
|
||||||
|
strncpy(pdump->info.name, rtcb->name, CONFIG_TASK_NAME_SIZE);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
pdump->info.pid = rtcb->pid;
|
||||||
|
|
||||||
|
|
||||||
|
/* If current_regs is not NULL then we are in an interrupt context
|
||||||
|
* and the user context is in current_regs else we are running in
|
||||||
|
* the users context
|
||||||
|
*/
|
||||||
|
|
||||||
|
if (CURRENT_REGS) {
|
||||||
|
pdump->info.stacks.interrupt.sp = currentsp;
|
||||||
|
|
||||||
|
pdump->info.flags |= (eRegsPresent | eUserStackPresent | eIntStackPresent);
|
||||||
|
memcpy(pdump->info.regs, (void *)CURRENT_REGS, sizeof(pdump->info.regs));
|
||||||
|
pdump->info.stacks.user.sp = pdump->info.regs[REG_R13];
|
||||||
|
|
||||||
|
} else {
|
||||||
|
|
||||||
|
/* users context */
|
||||||
|
pdump->info.flags |= eUserStackPresent;
|
||||||
|
|
||||||
|
pdump->info.stacks.user.sp = currentsp;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (pdump->info.pid == 0) {
|
||||||
|
|
||||||
|
pdump->info.stacks.user.top = g_idle_topstack - 4;
|
||||||
|
pdump->info.stacks.user.size = CONFIG_IDLETHREAD_STACKSIZE;
|
||||||
|
|
||||||
|
} else {
|
||||||
|
pdump->info.stacks.user.top = (uint32_t) rtcb->adj_stack_ptr;
|
||||||
|
pdump->info.stacks.user.size = (uint32_t) rtcb->adj_stack_size;;
|
||||||
|
}
|
||||||
|
|
||||||
|
#if CONFIG_ARCH_INTERRUPTSTACK > 3
|
||||||
|
|
||||||
|
/* Get the limits on the interrupt stack memory */
|
||||||
|
|
||||||
|
pdump->info.stacks.interrupt.top = (uint32_t)&g_intstackbase;
|
||||||
|
pdump->info.stacks.interrupt.size = (CONFIG_ARCH_INTERRUPTSTACK & ~3);
|
||||||
|
|
||||||
|
/* If In interrupt Context save the interrupt stack data centered
|
||||||
|
* about the interrupt stack pointer
|
||||||
|
*/
|
||||||
|
|
||||||
|
if ((pdump->info.flags & eIntStackPresent) != 0) {
|
||||||
|
stack_word_t *ps = (stack_word_t *) pdump->info.stacks.interrupt.sp;
|
||||||
|
copy_reverse(pdump->istack, &ps[arraySize(pdump->istack) / 2], arraySize(pdump->istack));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Is it Invalid? */
|
||||||
|
|
||||||
|
if (!(pdump->info.stacks.interrupt.sp <= pdump->info.stacks.interrupt.top &&
|
||||||
|
pdump->info.stacks.interrupt.sp > pdump->info.stacks.interrupt.top - pdump->info.stacks.interrupt.size)) {
|
||||||
|
pdump->info.flags |= eInvalidIntStackPrt;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* If In interrupt context or User save the user stack data centered
|
||||||
|
* about the user stack pointer
|
||||||
|
*/
|
||||||
|
if ((pdump->info.flags & eUserStackPresent) != 0) {
|
||||||
|
stack_word_t *ps = (stack_word_t *) pdump->info.stacks.user.sp;
|
||||||
|
copy_reverse(pdump->ustack, &ps[arraySize(pdump->ustack) / 2], arraySize(pdump->ustack));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Is it Invalid? */
|
||||||
|
|
||||||
|
if (!(pdump->info.stacks.user.sp <= pdump->info.stacks.user.top &&
|
||||||
|
pdump->info.stacks.user.sp > pdump->info.stacks.user.top - pdump->info.stacks.user.size)) {
|
||||||
|
pdump->info.flags |= eInvalidUserStackPtr;
|
||||||
|
}
|
||||||
|
|
||||||
|
int rv = stm32_bbsram_savepanic(HARDFAULT_FILENO, (uint8_t *)pdump, sizeof(fullcontext_s));
|
||||||
|
|
||||||
|
/* Test if memory got wiped because of using _sdata */
|
||||||
|
|
||||||
|
if (rv == -ENXIO) {
|
||||||
|
char *dead = "Memory wiped - dump not saved!";
|
||||||
|
|
||||||
|
while (*dead) {
|
||||||
|
up_lowputc(*dead++);
|
||||||
|
}
|
||||||
|
|
||||||
|
} else if (rv == -ENOSPC) {
|
||||||
|
|
||||||
|
/* hard fault again */
|
||||||
|
|
||||||
|
up_lowputc('!');
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
#if defined(CONFIG_BOARD_RESET_ON_CRASH)
|
||||||
|
px4_systemreset(false);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|||||||
@@ -93,10 +93,11 @@ static int board_button_irq(int irq, FAR void *context)
|
|||||||
|
|
||||||
led_on(BOARD_LED_BLUE);
|
led_on(BOARD_LED_BLUE);
|
||||||
|
|
||||||
stm32_pwr_enablebkp();
|
|
||||||
up_mdelay(200);
|
up_mdelay(200);
|
||||||
|
stm32_pwr_enablebkp(true);
|
||||||
/* XXX wow, this is evil - write a magic number into backup register zero */
|
/* XXX wow, this is evil - write a magic number into backup register zero */
|
||||||
*(uint32_t *)0x40002850 = 0xdeaddead;
|
*(uint32_t *)0x40002850 = 0xdeaddead;
|
||||||
|
stm32_pwr_enablebkp(false);
|
||||||
up_mdelay(50);
|
up_mdelay(50);
|
||||||
up_systemreset();
|
up_systemreset();
|
||||||
|
|
||||||
|
|||||||
@@ -50,7 +50,7 @@
|
|||||||
#include <debug.h>
|
#include <debug.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
|
|
||||||
#include <nuttx/spi.h>
|
#include <nuttx/spi/spi.h>
|
||||||
#include <nuttx/mmcsd.h>
|
#include <nuttx/mmcsd.h>
|
||||||
#include <arch/board/board.h>
|
#include <arch/board/board.h>
|
||||||
|
|
||||||
@@ -102,7 +102,7 @@ __EXPORT int board_sdio_initialize(void)
|
|||||||
{
|
{
|
||||||
/* Get the SPI port for the microSD slot */
|
/* Get the SPI port for the microSD slot */
|
||||||
|
|
||||||
spi = up_spiinitialize(CONFIG_NSH_MMCSDSPIPORTNO);
|
spi = stm32_spibus_initialize(CONFIG_NSH_MMCSDSPIPORTNO);
|
||||||
|
|
||||||
if (!spi) {
|
if (!spi) {
|
||||||
message("[boot] FAILED to initialize SPI port %d\n", CONFIG_NSH_MMCSDSPIPORTNO);
|
message("[boot] FAILED to initialize SPI port %d\n", CONFIG_NSH_MMCSDSPIPORTNO);
|
||||||
|
|||||||
@@ -48,12 +48,9 @@
|
|||||||
#include <stdbool.h>
|
#include <stdbool.h>
|
||||||
#include <debug.h>
|
#include <debug.h>
|
||||||
|
|
||||||
#include <nuttx/spi.h>
|
#include <nuttx/spi/spi.h>
|
||||||
#include <arch/board/board.h>
|
#include <arch/board/board.h>
|
||||||
|
|
||||||
#include "up_arch.h"
|
|
||||||
#include "chip.h"
|
|
||||||
#include "stm32.h"
|
|
||||||
#include "board_config.h"
|
#include "board_config.h"
|
||||||
|
|
||||||
/************************************************************************************
|
/************************************************************************************
|
||||||
|
|||||||
Reference in New Issue
Block a user