mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-23 14:47:44 +08:00
PX4 System changes Supporting STM32H7
stm32:ToneAlarmInterfacePWM TIM15-TIM17 have a BDTR Register common:board_crashdump Add H7 support stm32/board_mcu_version:Support H7 PX4 ADC:Use 32 interface and resoution abstraction Added PX4 stm32h7 ADC driver stm32h7:adc fix ADC ready check fmu: handle BOARD_HAS_PWM==5 cmake: improve error handling for NuttX olddefconfig failures WorkQueueManager:Quiet loadmon stack warning camera_trigger:GPIO support < 6 GPIO Adjust stack sizes (under hw stack check) PX4 System changes Supporting STM32H7 PX4IO Driver aerotenna_ocpoc:ADC add px4_arch_adc_dn_fullcount init.cmake:Track Upstream change needing Make.def at config time PX4 System changes Supporting STM32H7 NuttX CMakeLists.txt Track upstream changes Common board_crashdump add header and px4 config NuttX simplify callinb make libapps Use UINT32_MAX for error return drivers:uavcannode NuttX chip is now hardware drivers:uavcanesc NuttX chip is now hardware px4io:Avoid Race on AP to PX4 IO upgrade
This commit is contained in:
committed by
Lorenz Meier
parent
58799dc7d1
commit
e847698c9f
@@ -246,3 +246,8 @@ int ocpoc_adc_main(int argc, char *argv[])
|
||||
return PX4_OK;
|
||||
|
||||
}
|
||||
// This is a replacement for the hardcoded 4096
|
||||
uint32_t px4_arch_adc_dn_fullcount(void)
|
||||
{
|
||||
return 1 << 12; // 12 bit ADC
|
||||
}
|
||||
|
||||
@@ -373,6 +373,8 @@ typedef enum PX4_SOC_ARCH_ID_t {
|
||||
PX4_SOC_ARCH_ID_KINETISK66 = 0x0003,
|
||||
PX4_SOC_ARCH_ID_SAMV7 = 0x0004,
|
||||
|
||||
PX4_SOC_ARCH_ID_STM32H7 = 0x0006,
|
||||
|
||||
PX4_SOC_ARCH_ID_EAGLE = 0x1001,
|
||||
PX4_SOC_ARCH_ID_QURT = 0x1002,
|
||||
PX4_SOC_ARCH_ID_OCPOC = 0x1003,
|
||||
|
||||
@@ -317,7 +317,7 @@ add_custom_target(nuttx_builtin_list_target
|
||||
# libapps.a
|
||||
add_custom_command(OUTPUT ${APPS_DIR}/libapps.a ${APPS_DIR}/platform/.built
|
||||
COMMAND find ${APPS_DIR} -name \*.o -delete
|
||||
COMMAND make ${nuttx_build_options} --no-print-directory -C ../apps TOPDIR="${NUTTX_DIR}" libapps.a > nuttx_apps.log
|
||||
COMMAND make ${nuttx_build_options} --no-print-directory TOPDIR="${NUTTX_DIR}" ../apps/libapps.a > nuttx_apps.log
|
||||
DEPENDS
|
||||
nuttx_builtin_list_target ${nuttx_builtin_list}
|
||||
nuttx_context
|
||||
|
||||
@@ -92,6 +92,11 @@ execute_process(COMMAND ${cp_cmd} ${cp_opts} ${CP_SRC} ${CP_DST} WORKING_DIRECTO
|
||||
|
||||
set(NUTTX_DEFCONFIG ${NUTTX_CONFIG_DIR}/${NUTTX_CONFIG}/defconfig CACHE FILEPATH "path to defconfig" FORCE)
|
||||
|
||||
###############################################################################
|
||||
# Create a temporary Toplevel Make.defs for the oldconfig step
|
||||
###############################################################################
|
||||
configure_file(${NUTTX_SRC_DIR}/Make.defs.in ${NUTTX_DIR}/Make.defs)
|
||||
|
||||
# If the board provides a Kconfig Use it or create an empty one
|
||||
if(EXISTS ${NUTTX_CONFIG_DIR}/Kconfig)
|
||||
execute_process(COMMAND ${CMAKE_COMMAND} -E copy_if_different ${NUTTX_CONFIG_DIR}/Kconfig ${NUTTX_DIR}/boards/dummy/Kconfig)
|
||||
@@ -120,7 +125,17 @@ if (NOT config_expanded)
|
||||
WORKING_DIRECTORY ${NUTTX_DIR}
|
||||
OUTPUT_FILE nuttx_olddefconfig.log
|
||||
ERROR_FILE nuttx_olddefconfig.log
|
||||
RESULT_VARIABLE ret
|
||||
)
|
||||
if(NOT ret EQUAL "0")
|
||||
# Show the log here as it will be deleted due to the incomplete configure step
|
||||
file(READ ${NUTTX_DIR}/nuttx_olddefconfig.log DEFCONFIG_LOG)
|
||||
message( STATUS "${DEFCONFIG_LOG}")
|
||||
message( FATAL_ERROR "NuttX olddefconfig target failed. \
|
||||
Possible cause: the board (${NUTTX_CONFIG_DIR}/${NUTTX_CONFIG}) has the wrong directory structure (i.e. missing files).")
|
||||
endif()
|
||||
# remove Toplevel Make.defs
|
||||
file(REMOVE ${NUTTX_DIR}/Make.defs)
|
||||
endif()
|
||||
|
||||
###############################################################################
|
||||
|
||||
@@ -107,6 +107,9 @@ function(px4_os_determine_build_chip)
|
||||
elseif(CONFIG_ARCH_CHIP_STM32F7)
|
||||
set(CHIP_MANUFACTURER "stm")
|
||||
set(CHIP "stm32f7")
|
||||
elseif(CONFIG_ARCH_CHIP_STM32H7)
|
||||
set(CHIP_MANUFACTURER "stm")
|
||||
set(CHIP "stm32h7")
|
||||
elseif(CONFIG_ARCH_CHIP_MK66FN2M0VMD18)
|
||||
set(CHIP_MANUFACTURER "nxp")
|
||||
set(CHIP "k66")
|
||||
|
||||
@@ -1,3 +1,43 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (C) 2017-2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* 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 PX4 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
/**
|
||||
* @file board_crashdump.c
|
||||
*
|
||||
* Provides common board logic for crashdump callout
|
||||
* and hardfault log support
|
||||
*/
|
||||
|
||||
#ifdef CONFIG_BOARD_CRASHDUMP
|
||||
|
||||
#include <board_config.h>
|
||||
@@ -18,6 +58,10 @@
|
||||
# define HAS_BBSRAM CONFIG_STM32F7_BBSRAM
|
||||
# define BBSRAM_FILE_COUNT CONFIG_STM32F7_BBSRAM_FILES
|
||||
# define SAVE_CRASHDUMP CONFIG_STM32F7_SAVE_CRASHDUMP
|
||||
#elif defined(CONFIG_STM32H7_BBSRAM) && defined(CONFIG_STM32H7_SAVE_CRASHDUMP)
|
||||
# define HAS_BBSRAM CONFIG_STM32H7_BBSRAM
|
||||
# define BBSRAM_FILE_COUNT CONFIG_STM32H7_BBSRAM_FILES
|
||||
# define SAVE_CRASHDUMP CONFIG_STM32H7_SAVE_CRASHDUMP
|
||||
#elif defined(CONFIG_STM32_BBSRAM) && defined(CONFIG_STM32_SAVE_CRASHDUMP)
|
||||
# define HAS_BBSRAM CONFIG_STM32_BBSRAM
|
||||
# define BBSRAM_FILE_COUNT CONFIG_STM32_BBSRAM_FILES
|
||||
|
||||
@@ -32,6 +32,7 @@
|
||||
****************************************************************************/
|
||||
|
||||
#include <board_config.h>
|
||||
#include <stdint.h>
|
||||
#include <drivers/drv_adc.h>
|
||||
#include <drivers/drv_hrt.h>
|
||||
#include <px4_arch/adc.h>
|
||||
@@ -190,7 +191,7 @@ void px4_arch_adc_uninit(uint32_t base_address)
|
||||
// nothing to do
|
||||
}
|
||||
|
||||
uint16_t px4_arch_adc_sample(uint32_t base_address, unsigned channel)
|
||||
uint32_t px4_arch_adc_sample(uint32_t base_address, unsigned channel)
|
||||
{
|
||||
irqstate_t flags = px4_enter_critical_section();
|
||||
|
||||
@@ -211,12 +212,12 @@ uint16_t px4_arch_adc_sample(uint32_t base_address, unsigned channel)
|
||||
/* don't wait for more than 50us, since that means something broke - should reset here if we see this */
|
||||
if ((hrt_absolute_time() - now) > 50) {
|
||||
px4_leave_critical_section(flags);
|
||||
return 0xffff;
|
||||
return UINT32_MAX;
|
||||
}
|
||||
}
|
||||
|
||||
/* read the result and clear EOC */
|
||||
uint16_t result = rDR(base_address);
|
||||
uint32_t result = rDR(base_address);
|
||||
|
||||
px4_leave_critical_section(flags);
|
||||
|
||||
@@ -228,3 +229,7 @@ uint32_t px4_arch_adc_temp_sensor_mask()
|
||||
return 1 << 16;
|
||||
}
|
||||
|
||||
uint32_t px4_arch_adc_dn_fullcount(void)
|
||||
{
|
||||
return 1 << 12; // 12 bit ADC
|
||||
}
|
||||
|
||||
@@ -145,8 +145,32 @@
|
||||
# if defined(CONFIG_STM32_TIM14)
|
||||
# error Must not set CONFIG_STM32_TIM14 when TONE_ALARM_TIMER is 14
|
||||
# endif
|
||||
#elif TONE_ALARM_TIMER == 15
|
||||
# define TONE_ALARM_BASE STM32_TIM15_BASE
|
||||
# define TONE_ALARM_CLOCK STM32_APB2_TIM15_CLKIN
|
||||
# define TONE_ALARM_CLOCK_ENABLE RCC_APB2ENR_TIM15EN
|
||||
# define TONE_ALARM_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# if defined(CONFIG_STM32_TIM15)
|
||||
# error Must not set CONFIG_STM32_TIM15 when TONE_ALARM_TIMER is 15
|
||||
# endif
|
||||
#elif TONE_ALARM_TIMER == 16
|
||||
# define TONE_ALARM_BASE STM32_TIM16_BASE
|
||||
# define TONE_ALARM_CLOCK STM32_APB2_TIM16_CLKIN
|
||||
# define TONE_ALARM_CLOCK_ENABLE RCC_APB2ENR_TIM16EN
|
||||
# define TONE_ALARM_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# if defined(CONFIG_STM32_TIM16)
|
||||
# error Must not set CONFIG_STM32_TIM16 when TONE_ALARM_TIMER is 16
|
||||
# endif
|
||||
#elif TONE_ALARM_TIMER == 17
|
||||
# define TONE_ALARM_BASE STM32_TIM17_BASE
|
||||
# define TONE_ALARM_CLOCK STM32_APB2_TIM17_CLKIN
|
||||
# define TONE_ALARM_CLOCK_ENABLE RCC_APB2ENR_TIM17EN
|
||||
# define TONE_ALARM_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# if defined(CONFIG_STM32_TIM17)
|
||||
# error Must not set CONFIG_STM32_TIM16 when TONE_ALARM_TIMER is 17
|
||||
# endif
|
||||
#else
|
||||
# error Must set TONE_ALARM_TIMER to one of the timers between 1 and 14 (inclusive) to use this driver.
|
||||
# error Must set TONE_ALARM_TIMER to one of the timers between 1 and 17 (inclusive) to use this driver.
|
||||
#endif // TONE_ALARM_TIMER
|
||||
|
||||
#if TONE_ALARM_CHANNEL == 1
|
||||
@@ -199,6 +223,9 @@
|
||||
# define rSR REG(STM32_ATIM_SR_OFFSET)
|
||||
#else
|
||||
# define rARR REG(STM32_GTIM_ARR_OFFSET)
|
||||
#if TONE_ALARM_TIMER >= 15 && TONE_ALARM_TIMER <= 17 // Note: If using TIM15 - TIM17 it has a BDTR
|
||||
# define rBDTR REG(STM32_ATIM_BDTR_OFFSET)
|
||||
#endif
|
||||
# define rCCER REG(STM32_GTIM_CCER_OFFSET)
|
||||
# define rCCMR1 REG(STM32_GTIM_CCMR1_OFFSET)
|
||||
# define rCCMR2 REG(STM32_GTIM_CCMR2_OFFSET)
|
||||
|
||||
@@ -47,7 +47,9 @@ enum MCU_REV {
|
||||
MCU_REV_STM32F4_REV_Z = 0x1001,
|
||||
MCU_REV_STM32F4_REV_Y = 0x1003,
|
||||
MCU_REV_STM32F4_REV_1 = 0x1007,
|
||||
MCU_REV_STM32F4_REV_3 = 0x2001
|
||||
MCU_REV_STM32F4_REV_3 = 0x2001,
|
||||
MCU_REV_STM32F7_REV_X = MCU_REV_STM32F4_REV_3,
|
||||
MCU_REV_STM32F7_REV_V = 0x2003
|
||||
};
|
||||
|
||||
/* Define any issues with the Silicon as lines separated by \n
|
||||
@@ -60,6 +62,7 @@ enum MCU_REV {
|
||||
# define REVID_MASK 0xFFFF0000
|
||||
# define DEVID_MASK 0xFFF
|
||||
|
||||
# define STM32H74xx_75xx 0x450
|
||||
# define STM32F74xxx_75xxx 0x449
|
||||
# define STM32F76xxx_77xxx 0x451
|
||||
# define STM32F40x_41x 0x413
|
||||
@@ -81,6 +84,10 @@ int board_mcu_version(char *rev, const char **revstr, const char **errata)
|
||||
|
||||
switch (chip_version) {
|
||||
|
||||
case STM32H74xx_75xx:
|
||||
*revstr = "STM32H74xxx";
|
||||
break;
|
||||
|
||||
case STM32F74xxx_75xxx:
|
||||
*revstr = "STM32F74xxx";
|
||||
break;
|
||||
@@ -139,7 +146,12 @@ int board_mcu_version(char *rev, const char **revstr, const char **errata)
|
||||
break;
|
||||
|
||||
case MCU_REV_STM32F4_REV_3:
|
||||
*rev = '3';
|
||||
*rev = chip_version == STM32H74xx_75xx ? 'X' : '3' ;
|
||||
chip_errata = NULL;
|
||||
break;
|
||||
|
||||
case MCU_REV_STM32F7_REV_V:
|
||||
*rev = 'V';
|
||||
chip_errata = NULL;
|
||||
break;
|
||||
|
||||
|
||||
@@ -0,0 +1,46 @@
|
||||
############################################################################
|
||||
#
|
||||
# Copyright (c) 2019 PX4 Development Team. All rights reserved.
|
||||
#
|
||||
# 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 PX4 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.
|
||||
#
|
||||
############################################################################
|
||||
|
||||
|
||||
add_subdirectory(adc)
|
||||
add_subdirectory(../stm32_common/board_critmon board_critmon)
|
||||
add_subdirectory(../stm32_common/board_hw_info board_hw_info)
|
||||
add_subdirectory(../stm32_common/board_reset board_reset)
|
||||
add_subdirectory(../stm32_common/dshot dshot)
|
||||
add_subdirectory(../stm32_common/hrt hrt)
|
||||
add_subdirectory(../stm32_common/io_pins io_pins)
|
||||
add_subdirectory(../stm32_common/tone_alarm tone_alarm)
|
||||
add_subdirectory(../stm32_common/version version)
|
||||
|
||||
add_subdirectory(px4io_serial)
|
||||
|
||||
@@ -0,0 +1,36 @@
|
||||
############################################################################
|
||||
#
|
||||
# Copyright (c) 2015-2019 PX4 Development Team. All rights reserved.
|
||||
#
|
||||
# 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 PX4 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.
|
||||
#
|
||||
############################################################################
|
||||
|
||||
px4_add_library(arch_adc
|
||||
adc.cpp
|
||||
)
|
||||
@@ -0,0 +1,315 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (C) 2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* 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 PX4 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
#include <board_config.h>
|
||||
#include <stdint.h>
|
||||
#include <drivers/drv_adc.h>
|
||||
#include <drivers/drv_hrt.h>
|
||||
#include <px4_arch/adc.h>
|
||||
|
||||
#include <stm32_adc.h>
|
||||
#include <stm32_gpio.h>
|
||||
|
||||
|
||||
/*
|
||||
* Register accessors.
|
||||
* For now, no reason not to just use ADC1.
|
||||
*/
|
||||
#define REG(base, _reg) (*(volatile uint32_t *)((base) + (_reg)))
|
||||
|
||||
#define rCR(base) REG((base), STM32_ADC_CR_OFFSET)
|
||||
#define rISR(base) REG((base), STM32_ADC_ISR_OFFSET)
|
||||
#define rSMPR1(base) REG((base), STM32_ADC_SMPR1_OFFSET)
|
||||
#define rSMPR2(base) REG((base), STM32_ADC_SMPR2_OFFSET)
|
||||
#define rPCSEL(base) REG((base), STM32_ADC_PCSEL_OFFSET)
|
||||
#define rCFG(base) REG((base), STM32_ADC_CFGR_OFFSET)
|
||||
#define rCFG2(base) REG((base), STM32_ADC_CFGR2_OFFSET)
|
||||
#define rCCR(base) REG((base), STM32_ADC_CCR_OFFSET)
|
||||
#define rSQR1(base) REG((base), STM32_ADC_SQR1_OFFSET)
|
||||
#define rSQR2(base) REG((base), STM32_ADC_SQR2_OFFSET)
|
||||
#define rSQR3(base) REG((base), STM32_ADC_SQR3_OFFSET)
|
||||
#define rSQR4(base) REG((base), STM32_ADC_SQR4_OFFSET)
|
||||
#define rDR(base) REG((base), STM32_ADC_DR_OFFSET)
|
||||
|
||||
#define ADC_SMPR_DEFAULT ADC_SMPR_64p5 // 64.5 +7.5 * 24 Mhz is 3 uS
|
||||
#define ADC_SMPR1_DEFAULT ((ADC_SMPR_DEFAULT << ADC_SMPR1_SMP0_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP1_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP2_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP3_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP4_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP5_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP6_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP7_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP8_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR1_SMP9_SHIFT))
|
||||
#define ADC_SMPR2_DEFAULT ((ADC_SMPR_DEFAULT << ADC_SMPR2_SMP10_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP11_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP12_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP13_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP14_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP15_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP16_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP17_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP18_SHIFT) | \
|
||||
(ADC_SMPR_DEFAULT << ADC_SMPR2_SMP19_SHIFT))
|
||||
|
||||
|
||||
/* Assuming VDC 2.4 - 3.6 */
|
||||
|
||||
#define ADC_MAX_FADC 36000000
|
||||
|
||||
#if STM32_PLL2P_FREQUENCY <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_NOT_DIV
|
||||
#elif STM32_PLL2P_FREQUENCY/2 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV2
|
||||
#elif STM32_PLL2P_FREQUENCY/4 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV4
|
||||
#elif STM32_PLL2P_FREQUENCY/6 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV6
|
||||
#elif STM32_PLL2P_FREQUENCY/8 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV8
|
||||
#elif STM32_PLL2P_FREQUENCY/10 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV10
|
||||
#elif STM32_PLL2P_FREQUENCY/12 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV12
|
||||
#elif STM32_PLL2P_FREQUENCY/16 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV16
|
||||
#elif STM32_PLL2P_FREQUENCY/32 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV32
|
||||
#elif STM32_PLL2P_FREQUENCY/64 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV64
|
||||
#elif STM32_PLL2P_FREQUENCY/128 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV128
|
||||
#elif STM32_PLL2P_FREQUENCY/256 <= ADC_MAX_FADC
|
||||
# define ADC_CCR_PRESC_DIV ADC_CCR_PRESC_DIV256
|
||||
#else
|
||||
# error "ADC STM32_PLL2P_FREQUENCY too high - no divisor found "
|
||||
#endif
|
||||
|
||||
|
||||
int px4_arch_adc_init(uint32_t base_address)
|
||||
{
|
||||
/* Perform ADC init once per ADC */
|
||||
|
||||
static uint32_t once[SYSTEM_ADC_COUNT] {};
|
||||
|
||||
uint32_t *free = nullptr;
|
||||
|
||||
for (uint32_t i = 0; i < SYSTEM_ADC_COUNT; i++) {
|
||||
if (once[i] == base_address) {
|
||||
|
||||
/* This one was done already */
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
/* Use first free slot */
|
||||
|
||||
if (free == nullptr && once[i] == 0) {
|
||||
free = &once[i];
|
||||
}
|
||||
}
|
||||
|
||||
if (free == nullptr) {
|
||||
|
||||
/* ADC misconfigured SYSTEM_ADC_COUNT too small */;
|
||||
|
||||
PANIC();
|
||||
}
|
||||
|
||||
*free = base_address;
|
||||
|
||||
/* do calibration if supported */
|
||||
|
||||
rCR(base_address) = ADC_CR_ADVREGEN | ADC_CR_BOOST;
|
||||
|
||||
/* Wait for voltage regulator to power up */
|
||||
|
||||
up_udelay(20);
|
||||
|
||||
/* enable the temperature sensor, VREFINT channel and VBAT */
|
||||
|
||||
rCCR(base_address) = (ADC_CCR_VREFEN | ADC_CCR_VSENSEEN | ADC_CCR_VBATEN |
|
||||
ADC_CCR_CKMODE_ASYCH | ADC_CCR_PRESC_DIV);
|
||||
|
||||
/* Enable ADC calibration. ADCALDIF == 0 so this is only for
|
||||
* single-ended conversions, not for differential ones.
|
||||
* Do Liner Cal first
|
||||
*/
|
||||
|
||||
rCR(base_address) |= ADC_CR_ADCALLIN;
|
||||
rCR(base_address) |= ADC_CR_ADCAL;
|
||||
|
||||
/* Wait for calibration to complete */
|
||||
|
||||
hrt_abstime now = hrt_absolute_time();
|
||||
|
||||
while ((rCR(base_address) & ADC_CR_ADCAL)) {
|
||||
|
||||
/* don't wait for more than 7000us, since that means something broke
|
||||
* should reset here if we see this */
|
||||
if ((hrt_absolute_time() - now) > 7000) {
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
|
||||
rCR(base_address) &= ~ADC_CR_ADCALLIN;
|
||||
|
||||
rCR(base_address) |= ADC_CR_ADCAL;
|
||||
|
||||
/* Wait for calibration to complete */
|
||||
|
||||
now = hrt_absolute_time();
|
||||
|
||||
while ((rCR(base_address) & ADC_CR_ADCAL)) {
|
||||
|
||||
/* don't wait for more than 500us, since that means something broke
|
||||
* should reset here if we see this */
|
||||
if ((hrt_absolute_time() - now) > 500) {
|
||||
return -2;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/* Enable ADC
|
||||
* Note: ADEN bit cannot be set during ADCAL=1 and 4 ADC clock cycle
|
||||
* after the ADCAL bit is cleared by hardware. If we are using SYSCLK
|
||||
* as ADC clock source, this is the same as time taken to execute 4
|
||||
* ARM instructions.
|
||||
*/
|
||||
|
||||
rCR(base_address) |= ADC_CR_ADEN;
|
||||
|
||||
now = hrt_absolute_time();
|
||||
|
||||
/* Wait for hardware to be ready for conversions */
|
||||
|
||||
while ((rISR(base_address) & ADC_INT_ADRDY) == 0) {
|
||||
|
||||
/* don't wait for more than 500us, since that means something broke
|
||||
* should reset here if we see this */
|
||||
if ((hrt_absolute_time() - now) > 500) {
|
||||
return -3;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/* arbitrarily configure all channels for 810.5 cycle sample time */
|
||||
|
||||
rSMPR1(base_address) = ADC_SMPR1_DEFAULT;
|
||||
rSMPR2(base_address) = ADC_SMPR2_DEFAULT;
|
||||
|
||||
|
||||
/* Set CFGR configuration
|
||||
* Set the resolution of the conversion.
|
||||
* Disable external trigger for regular channels
|
||||
*/
|
||||
|
||||
rCFG(base_address) = (ADC_CFGR_RES_16BIT | ADC_CFGR_EXTEN_NONE);
|
||||
|
||||
/* Set CFGR2 configuration to align right no oversample */
|
||||
|
||||
rCFG2(base_address) = 0;
|
||||
|
||||
/* configure for a single-channel sequence */
|
||||
|
||||
rSQR1(base_address) = 0;
|
||||
rSQR2(base_address) = 0;
|
||||
rSQR3(base_address) = 0;
|
||||
rSQR4(base_address) = 0;
|
||||
|
||||
/* kick off a sample and wait for it to complete */
|
||||
now = hrt_absolute_time();
|
||||
rCR(base_address) |= ADC_CR_ADSTART;
|
||||
|
||||
while (!(rISR(base_address) & ADC_INT_EOC)) {
|
||||
|
||||
/* don't wait for more than 50us, since that means something broke - should reset here if we see this */
|
||||
if ((hrt_absolute_time() - now) > 50) {
|
||||
return -4;
|
||||
}
|
||||
}
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
void px4_arch_adc_uninit(uint32_t base_address)
|
||||
{
|
||||
// nothing to do
|
||||
}
|
||||
|
||||
uint32_t px4_arch_adc_sample(uint32_t base_address, unsigned channel)
|
||||
{
|
||||
irqstate_t flags = px4_enter_critical_section();
|
||||
|
||||
/* clear any previous EOC */
|
||||
|
||||
if (rISR(base_address) & ADC_INT_EOC) {
|
||||
rISR(base_address) &= ~ADC_INT_EOC;
|
||||
}
|
||||
|
||||
/* run a single conversion right now - should take about 810.5 cycles (34 microseconds) max */
|
||||
|
||||
rPCSEL(base_address) |= 1 << channel;
|
||||
rSQR1(base_address) = channel << ADC_SQR1_SQ_OFFSET;
|
||||
rCR(base_address) |= ADC_CR_ADSTART;
|
||||
|
||||
/* wait for the conversion to complete */
|
||||
const hrt_abstime now = hrt_absolute_time();
|
||||
|
||||
while (!(rISR(base_address) & ADC_INT_EOC)) {
|
||||
|
||||
/* don't wait for more than 50us, since that means something broke - should reset here if we see this */
|
||||
if ((hrt_absolute_time() - now) > 50) {
|
||||
px4_leave_critical_section(flags);
|
||||
return UINT32_MAX;
|
||||
}
|
||||
}
|
||||
|
||||
/* read the result and clear EOC */
|
||||
uint32_t result = rDR(base_address);
|
||||
|
||||
px4_leave_critical_section(flags);
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
uint32_t px4_arch_adc_temp_sensor_mask()
|
||||
{
|
||||
return 1 << 16;
|
||||
}
|
||||
|
||||
uint32_t px4_arch_adc_dn_fullcount(void)
|
||||
{
|
||||
return 1 << 16; // 16 bit ADC
|
||||
}
|
||||
@@ -0,0 +1,59 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (c) 2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* 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 PX4 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
#pragma once
|
||||
|
||||
#include <board_config.h>
|
||||
|
||||
#include <hardware/stm32_adc.h>
|
||||
|
||||
|
||||
/* Historically PX4 used one ADC1 With FMUvnX this has changes.
|
||||
* These defines maintain compatibility while allowing the
|
||||
* new boards to override the ADC used from HW VER/REV and
|
||||
* the system one.
|
||||
*
|
||||
* Depending on HW configuration (VER/REV POP options) hardware detection
|
||||
* may or may NOT initialize a given ADC. SYSTEM_ADC_COUNT is used to size the
|
||||
* singleton array to ensure this is only done once per ADC.
|
||||
*/
|
||||
|
||||
#if !defined(HW_REV_VER_ADC_BASE)
|
||||
# define HW_REV_VER_ADC_BASE STM32_ADC1_BASE
|
||||
#endif
|
||||
|
||||
#if !defined(SYSTEM_ADC_BASE)
|
||||
# define SYSTEM_ADC_BASE STM32_ADC1_BASE
|
||||
#endif
|
||||
|
||||
#include <px4_platform/adc.h>
|
||||
|
||||
@@ -0,0 +1,37 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (c) 2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* 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 PX4 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
#pragma once
|
||||
|
||||
|
||||
#include "../../../stm32_common/include/px4_arch/io_timer.h"
|
||||
|
||||
@@ -0,0 +1,56 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (c) 2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* 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 PX4 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
#pragma once
|
||||
|
||||
|
||||
#include "../../../stm32_common/include/px4_arch/micro_hal.h"
|
||||
|
||||
__BEGIN_DECLS
|
||||
|
||||
#define PX4_SOC_ARCH_ID PX4_SOC_ARCH_ID_STM32H7
|
||||
#include <chip.h>
|
||||
#include <hardware/stm32_flash.h>
|
||||
#include <up_internal.h> //include up_systemreset() which is included on stm32.h
|
||||
#include <stm32_bbsram.h>
|
||||
#define PX4_BBSRAM_SIZE STM32H7_BBSRAM_SIZE
|
||||
#define PX4_BBSRAM_GETDESC_IOCTL STM32H7_BBSRAM_GETDESC_IOCTL
|
||||
#define PX4_FLASH_BASE 0x08000000
|
||||
#define PX4_NUMBER_I2C_BUSES STM32H7_NI2C
|
||||
|
||||
int stm32h7_flash_lock(size_t addr);
|
||||
int stm32h7_flash_unlock(size_t addr);
|
||||
int stm32h7_flash_writeprotect(size_t block, bool enabled);
|
||||
#define stm32_flash_lock() stm32h7_flash_lock(PX4_FLASH_BASE)
|
||||
|
||||
__END_DECLS
|
||||
|
||||
@@ -0,0 +1,38 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (c) 2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* 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 PX4 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
#pragma once
|
||||
|
||||
#define PX4IO_SERIAL_BUF_ALIGN ARMV7M_DCACHE_LINESIZE
|
||||
#include "../../../stm32_common/include/px4_arch/px4io_serial.h"
|
||||
|
||||
@@ -0,0 +1,36 @@
|
||||
############################################################################
|
||||
#
|
||||
# Copyright (c) 2015-2019 PX4 Development Team. All rights reserved.
|
||||
#
|
||||
# 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 PX4 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.
|
||||
#
|
||||
############################################################################
|
||||
|
||||
px4_add_library(arch_px4io_serial
|
||||
px4io_serial.cpp
|
||||
)
|
||||
File diff suppressed because it is too large
Load Diff
+10
-9
@@ -37,7 +37,7 @@
|
||||
* Driver for an ADC.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include <drivers/drv_adc.h>
|
||||
#include <drivers/drv_hrt.h>
|
||||
#include <lib/cdev/CDev.hpp>
|
||||
@@ -82,9 +82,9 @@ private:
|
||||
* Sample a single channel and return the measured value.
|
||||
*
|
||||
* @param channel The channel to sample.
|
||||
* @return The sampled value, or 0xffff if sampling failed.
|
||||
* @return The sampled value, or UINT32_MAX if sampling failed.
|
||||
*/
|
||||
uint16_t sample(unsigned channel);
|
||||
uint32_t sample(unsigned channel);
|
||||
|
||||
void update_adc_report(hrt_abstime now);
|
||||
void update_system_power(hrt_abstime now);
|
||||
@@ -233,7 +233,8 @@ ADC::update_adc_report(hrt_abstime now)
|
||||
|
||||
for (unsigned i = 0; i < max_num; i++) {
|
||||
adc.channel_id[i] = _samples[i].am_channel;
|
||||
adc.channel_value[i] = _samples[i].am_data * 3.3f / 4096.0f;
|
||||
adc.channel_value[i] = _samples[i].am_data * 3.3f / px4_arch_adc_dn_fullcount();
|
||||
;
|
||||
}
|
||||
|
||||
_to_adc_report.publish(adc);
|
||||
@@ -258,7 +259,7 @@ ADC::update_system_power(hrt_abstime now)
|
||||
|
||||
if (_samples[i].am_channel == ADC_SCALED_V5_SENSE) {
|
||||
// it is 2:1 scaled
|
||||
system_power.voltage5v_v = _samples[i].am_data * (ADC_V5_V_FULL_SCALE / 4096.0f);
|
||||
system_power.voltage5v_v = _samples[i].am_data * (ADC_V5_V_FULL_SCALE / px4_arch_adc_dn_fullcount());
|
||||
cnt--;
|
||||
|
||||
} else
|
||||
@@ -267,7 +268,7 @@ ADC::update_system_power(hrt_abstime now)
|
||||
{
|
||||
if (_samples[i].am_channel == ADC_SCALED_V3V3_SENSORS_SENSE) {
|
||||
// it is 2:1 scaled
|
||||
system_power.voltage3v3_v = _samples[i].am_data * (ADC_3V3_SCALE * (3.3f / 4096.0f));
|
||||
system_power.voltage3v3_v = _samples[i].am_data * (ADC_3V3_SCALE * (3.3f / px4_arch_adc_dn_fullcount()));
|
||||
system_power.v3v3_valid = 1;
|
||||
cnt--;
|
||||
}
|
||||
@@ -323,13 +324,13 @@ ADC::update_system_power(hrt_abstime now)
|
||||
#endif // BOARD_ADC_USB_CONNECTED
|
||||
}
|
||||
|
||||
uint16_t
|
||||
uint32_t
|
||||
ADC::sample(unsigned channel)
|
||||
{
|
||||
perf_begin(_sample_perf);
|
||||
uint16_t result = px4_arch_adc_sample(_base_address, channel);
|
||||
uint32_t result = px4_arch_adc_sample(_base_address, channel);
|
||||
|
||||
if (result == 0xffff) {
|
||||
if (result == UINT32_MAX) {
|
||||
PX4_ERR("sample timeout");
|
||||
}
|
||||
|
||||
|
||||
@@ -3,7 +3,7 @@
|
||||
#include "gpio.h"
|
||||
#include <cstring>
|
||||
|
||||
constexpr uint32_t CameraInterfaceGPIO::_gpios[6];
|
||||
constexpr uint32_t CameraInterfaceGPIO::_gpios[ngpios];
|
||||
|
||||
CameraInterfaceGPIO::CameraInterfaceGPIO():
|
||||
CameraInterface(),
|
||||
@@ -25,7 +25,7 @@ void CameraInterfaceGPIO::setup()
|
||||
{
|
||||
for (unsigned i = 0, t = 0; i < arraySize(_pins); i++) {
|
||||
|
||||
// Pin range is from 1 to 6, indexes are 0 to 5
|
||||
// Pin range is from 1 to 5 or 6, indexes are 0 to 4 or 5
|
||||
|
||||
if (_pins[i] >= 0 && _pins[i] < (int)arraySize(_gpios)) {
|
||||
uint32_t gpio = _gpios[_pins[i]];
|
||||
@@ -50,9 +50,17 @@ void CameraInterfaceGPIO::trigger(bool trigger_on_true)
|
||||
|
||||
void CameraInterfaceGPIO::info()
|
||||
{
|
||||
PX4_INFO("GPIO trigger mode, pins enabled : [%d][%d][%d][%d][%d][%d], polarity : %s",
|
||||
_pins[5], _pins[4], _pins[3], _pins[2], _pins[1], _pins[0],
|
||||
_trigger_invert ? "ACTIVE_LOW" : "ACTIVE_HIGH");
|
||||
if (ngpios == 6) {
|
||||
PX4_INFO("GPIO trigger mode, pins enabled : [%d][%d][%d][%d][%d][%d], polarity : %s",
|
||||
_pins[5], _pins[4], _pins[3], _pins[2], _pins[1], _pins[0],
|
||||
_trigger_invert ? "ACTIVE_LOW" : "ACTIVE_HIGH");
|
||||
}
|
||||
|
||||
if (ngpios == 5) {
|
||||
PX4_INFO("GPIO trigger mode, pins enabled : [%d][%d][%d][%d][%d], polarity : %s",
|
||||
_pins[4], _pins[3], _pins[2], _pins[1], _pins[0],
|
||||
_trigger_invert ? "ACTIVE_LOW" : "ACTIVE_HIGH");
|
||||
}
|
||||
}
|
||||
|
||||
#endif /* ifdef __PX4_NUTTX */
|
||||
|
||||
@@ -21,6 +21,11 @@ public:
|
||||
void trigger(bool trigger_on_true);
|
||||
|
||||
void info();
|
||||
#if defined(GPIO_GPIO5_OUTPUT)
|
||||
static const int ngpios = 6;
|
||||
#else
|
||||
static const int ngpios = 5;
|
||||
#endif
|
||||
|
||||
private:
|
||||
|
||||
@@ -30,13 +35,15 @@ private:
|
||||
|
||||
bool _trigger_invert;
|
||||
|
||||
static constexpr uint32_t _gpios[6] = {
|
||||
static constexpr uint32_t _gpios[ngpios] = {
|
||||
GPIO_GPIO0_OUTPUT,
|
||||
GPIO_GPIO1_OUTPUT,
|
||||
GPIO_GPIO2_OUTPUT,
|
||||
GPIO_GPIO3_OUTPUT,
|
||||
GPIO_GPIO4_OUTPUT,
|
||||
#if defined(GPIO_GPIO5_OUTPUT)
|
||||
GPIO_GPIO5_OUTPUT
|
||||
#endif
|
||||
};
|
||||
|
||||
uint32_t _triggers[arraySize(_gpios)];
|
||||
|
||||
@@ -1,6 +1,6 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (C) 2012 PX4 Development Team. All rights reserved.
|
||||
* Copyright (C) 2012, 2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
@@ -78,14 +78,19 @@ void px4_arch_adc_uninit(uint32_t base_address);
|
||||
* Read a sample from the ADC
|
||||
* @param base_address architecture-specific address to specify the ADC
|
||||
* @param channel specify the channel
|
||||
* @return sample, 0xffff on error
|
||||
* @return sample, 0xffffffff on error
|
||||
*/
|
||||
uint16_t px4_arch_adc_sample(uint32_t base_address, unsigned channel);
|
||||
uint32_t px4_arch_adc_sample(uint32_t base_address, unsigned channel);
|
||||
|
||||
/**
|
||||
* Get the temperature sensor channel bitmask
|
||||
*/
|
||||
uint32_t px4_arch_adc_temp_sensor_mask(void);
|
||||
|
||||
/**
|
||||
* Get the adc digital number full count
|
||||
*/
|
||||
uint32_t px4_arch_adc_dn_fullcount(void);
|
||||
|
||||
__END_DECLS
|
||||
|
||||
|
||||
@@ -83,6 +83,8 @@ struct GPS_Sat_Info {
|
||||
struct satellite_info_s _data;
|
||||
};
|
||||
|
||||
static constexpr int TASK_STACK_SIZE = 1620;
|
||||
|
||||
|
||||
class GPS : public ModuleBase<GPS>
|
||||
{
|
||||
@@ -1069,7 +1071,7 @@ int GPS::task_spawn(int argc, char *argv[], Instance instance)
|
||||
}
|
||||
|
||||
int task_id = px4_task_spawn_cmd("gps", SCHED_DEFAULT,
|
||||
SCHED_PRIORITY_SLOW_DRIVER, 1700,
|
||||
SCHED_PRIORITY_SLOW_DRIVER, TASK_STACK_SIZE,
|
||||
entry_point, (char *const *)argv);
|
||||
|
||||
if (task_id < 0) {
|
||||
|
||||
@@ -33,6 +33,7 @@
|
||||
px4_add_module(
|
||||
MODULE drivers__blinkm
|
||||
MAIN blinkm
|
||||
STACK_MAIN 1240
|
||||
COMPILE_FLAGS
|
||||
SRCS
|
||||
blinkm.cpp
|
||||
|
||||
@@ -94,70 +94,14 @@
|
||||
#error PWMIN defines are needed in board_config.h for this board
|
||||
#endif
|
||||
|
||||
/* PWMIN configuration */
|
||||
#if PWMIN_TIMER == 1
|
||||
# define PWMIN_TIMER_BASE STM32_TIM1_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB2ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB2ENR_TIM1EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM1CC
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB2_TIM1_CLKIN
|
||||
#elif PWMIN_TIMER == 2
|
||||
# define PWMIN_TIMER_BASE STM32_TIM2_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB1ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB1ENR_TIM2EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM2
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB1_TIM2_CLKIN
|
||||
#elif PWMIN_TIMER == 3
|
||||
# define PWMIN_TIMER_BASE STM32_TIM3_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB1ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB1ENR_TIM3EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM3
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB1_TIM3_CLKIN
|
||||
#elif PWMIN_TIMER == 4
|
||||
# define PWMIN_TIMER_BASE STM32_TIM4_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB1ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB1ENR_TIM4EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM4
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB1_TIM4_CLKIN
|
||||
#elif PWMIN_TIMER == 5
|
||||
# define PWMIN_TIMER_BASE STM32_TIM5_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB1ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB1ENR_TIM5EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM5
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB1_TIM5_CLKIN
|
||||
#elif PWMIN_TIMER == 8
|
||||
# define PWMIN_TIMER_BASE STM32_TIM8_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB2ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB2ENR_TIM8EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM8CC
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB2_TIM8_CLKIN
|
||||
#elif PWMIN_TIMER == 9
|
||||
# define PWMIN_TIMER_BASE STM32_TIM9_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB2ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB2ENR_TIM9EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM1BRK
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB2_TIM9_CLKIN
|
||||
#elif PWMIN_TIMER == 10
|
||||
# define PWMIN_TIMER_BASE STM32_TIM10_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB2ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB2ENR_TIM10EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM1UP
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB2_TIM10_CLKIN
|
||||
#elif PWMIN_TIMER == 11
|
||||
# define PWMIN_TIMER_BASE STM32_TIM11_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB2ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB2ENR_TIM11EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM1TRGCOM
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB2_TIM11_CLKIN
|
||||
#elif PWMIN_TIMER == 12
|
||||
# define PWMIN_TIMER_BASE STM32_TIM12_BASE
|
||||
# define PWMIN_TIMER_POWER_REG STM32_RCC_APB1ENR
|
||||
# define PWMIN_TIMER_POWER_BIT RCC_APB1ENR_TIM12EN
|
||||
# define PWMIN_TIMER_VECTOR STM32_IRQ_TIM8BRK
|
||||
# define PWMIN_TIMER_CLOCK STM32_APB1_TIM12_CLKIN
|
||||
#else
|
||||
# error PWMIN_TIMER must be a value between 1 and 12
|
||||
#endif
|
||||
/* Get the timer defines */
|
||||
#define INPUT_TIMER PWMIN_TIMER
|
||||
#include "timer_registers.h"
|
||||
#define PWMIN_TIMER_BASE TIMER_BASE
|
||||
#define PWMIN_TIMER_CLOCK TIMER_CLOCK
|
||||
#define PWMIN_TIMER_POWER_REG TIMER_CLOCK_POWER_REG
|
||||
#define PWMIN_TIMER_POWER_BIT TIMER_CLOCK_POWER_BIT
|
||||
#define PWMIN_TIMER_VECTOR TIMER_IRQ_REG
|
||||
|
||||
/*
|
||||
* HRT clock must be at least 1MHz
|
||||
|
||||
@@ -0,0 +1,188 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (C) 2019 PX4 Development Team. All rights reserved.
|
||||
*
|
||||
* 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 PX4 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
/**
|
||||
* @file timer_registers.h
|
||||
*
|
||||
* Get architecture-specific timer register defines.
|
||||
* Usage:
|
||||
* #define INPUT_TIMER <timer>
|
||||
* #include "timer_registers.h"
|
||||
* # define <xy>_TIMER_BASE TIMER_BASE
|
||||
* # define <xy>_TIMER_CLOCK TIMER_CLOCK
|
||||
* # define <xy>_TIMER_POWER_REG TIMER_CLOCK_POWER_REG
|
||||
* # define <xy>_TIMER_POWER_BIT TIMER_CLOCK_POWER_BIT
|
||||
* # define <xy>_TIMER_VECTOR TIMER_IRQ_REG
|
||||
*
|
||||
*/
|
||||
|
||||
#include <px4_platform_common/px4_config.h>
|
||||
|
||||
#ifndef INPUT_TIMER
|
||||
# error "need to define INPUT_TIMER to use this header"
|
||||
#endif
|
||||
|
||||
#ifdef TIMER_BASE
|
||||
#undef TIMER_BASE
|
||||
#endif
|
||||
#ifdef TIMER_CLOCK_POWER_REG
|
||||
#undef TIMER_CLOCK_POWER_REG
|
||||
#endif
|
||||
#ifdef TIMER_CLOCK_POWER_BIT
|
||||
#undef TIMER_CLOCK_POWER_BIT
|
||||
#endif
|
||||
#ifdef TIMER_CLOCK
|
||||
#undef TIMER_CLOCK
|
||||
#endif
|
||||
#ifdef TIMER_IRQ_REG
|
||||
#undef TIMER_IRQ_REG
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
#if defined(CONFIG_ARCH_CHIP_STM32H7)
|
||||
|
||||
#if INPUT_TIMER == 1
|
||||
# define TIMER_BASE STM32_TIM1_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB2ENR_TIM1EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIMCC
|
||||
# define TIMER_CLOCK STM32_APB2_TIM1_CLKIN
|
||||
#elif INPUT_TIMER == 2
|
||||
# define TIMER_BASE STM32_TIM2_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1LENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1LENR_TIM2EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM2
|
||||
# define TIMER_CLOCK STM32_APB1_TIM2_CLKIN
|
||||
#elif INPUT_TIMER == 3
|
||||
# define TIMER_BASE STM32_TIM3_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1LENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1LENR_TIM3EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM3
|
||||
# define TIMER_CLOCK STM32_APB1_TIM3_CLKIN
|
||||
#elif INPUT_TIMER == 4
|
||||
# define TIMER_BASE STM32_TIM4_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1LENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1LENR_TIM4EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM4
|
||||
# define TIMER_CLOCK STM32_APB1_TIM4_CLKIN
|
||||
#elif INPUT_TIMER == 5
|
||||
# define TIMER_BASE STM32_TIM5_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1LENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1LENR_TIM5EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM5
|
||||
# define TIMER_CLOCK STM32_APB1_TIM5_CLKIN
|
||||
#elif INPUT_TIMER == 8
|
||||
# define TIMER_BASE STM32_TIM8_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB2ENR_TIM8EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM8CC
|
||||
# define TIMER_CLOCK STM32_APB2_TIM8_CLKIN
|
||||
#elif INPUT_TIMER == 12
|
||||
# define TIMER_BASE STM32_TIM12_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1LENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1LENR_TIM12EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM12
|
||||
# define TIMER_CLOCK STM32_APB1_TIM12_CLKIN
|
||||
#else
|
||||
# error INPUT_TIMER must be a value between 1 and 12
|
||||
#endif
|
||||
|
||||
|
||||
#else // F4, F7
|
||||
|
||||
#if INPUT_TIMER == 1
|
||||
# define TIMER_BASE STM32_TIM1_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB2ENR_TIM1EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM1CC
|
||||
# define TIMER_CLOCK STM32_APB2_TIM1_CLKIN
|
||||
#elif INPUT_TIMER == 2
|
||||
# define TIMER_BASE STM32_TIM2_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1ENR_TIM2EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM2
|
||||
# define TIMER_CLOCK STM32_APB1_TIM2_CLKIN
|
||||
#elif INPUT_TIMER == 3
|
||||
# define TIMER_BASE STM32_TIM3_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1ENR_TIM3EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM3
|
||||
# define TIMER_CLOCK STM32_APB1_TIM3_CLKIN
|
||||
#elif INPUT_TIMER == 4
|
||||
# define TIMER_BASE STM32_TIM4_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1ENR_TIM4EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM4
|
||||
# define TIMER_CLOCK STM32_APB1_TIM4_CLKIN
|
||||
#elif INPUT_TIMER == 5
|
||||
# define TIMER_BASE STM32_TIM5_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1ENR_TIM5EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM5
|
||||
# define TIMER_CLOCK STM32_APB1_TIM5_CLKIN
|
||||
#elif INPUT_TIMER == 8
|
||||
# define TIMER_BASE STM32_TIM8_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB2ENR_TIM8EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM8CC
|
||||
# define TIMER_CLOCK STM32_APB2_TIM8_CLKIN
|
||||
#elif INPUT_TIMER == 9
|
||||
# define TIMER_BASE STM32_TIM9_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB2ENR_TIM9EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM1BRK
|
||||
# define TIMER_CLOCK STM32_APB2_TIM9_CLKIN
|
||||
#elif INPUT_TIMER == 10
|
||||
# define TIMER_BASE STM32_TIM10_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB2ENR_TIM10EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM1UP
|
||||
# define TIMER_CLOCK STM32_APB2_TIM10_CLKIN
|
||||
#elif INPUT_TIMER == 11
|
||||
# define TIMER_BASE STM32_TIM11_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB2ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB2ENR_TIM11EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM1TRGCOM
|
||||
# define TIMER_CLOCK STM32_APB2_TIM11_CLKIN
|
||||
#elif INPUT_TIMER == 12
|
||||
# define TIMER_BASE STM32_TIM12_BASE
|
||||
# define TIMER_CLOCK_POWER_REG STM32_RCC_APB1ENR
|
||||
# define TIMER_CLOCK_POWER_BIT RCC_APB1ENR_TIM12EN
|
||||
# define TIMER_IRQ_REG STM32_IRQ_TIM8BRK
|
||||
# define TIMER_CLOCK STM32_APB1_TIM12_CLKIN
|
||||
#else
|
||||
# error INPUT_TIMER must be a value between 1 and 12
|
||||
#endif
|
||||
|
||||
#endif
|
||||
@@ -1146,9 +1146,12 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
|
||||
break;
|
||||
}
|
||||
|
||||
#endif
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 5
|
||||
|
||||
/* FALLTHROUGH */
|
||||
case PWM_SERVO_SET(4):
|
||||
if (_mode < MODE_5PWM1CAP) {
|
||||
if (_mode < MODE_5PWM) {
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
}
|
||||
@@ -1216,9 +1219,12 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
|
||||
break;
|
||||
}
|
||||
|
||||
#endif
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 5
|
||||
|
||||
/* FALLTHROUGH */
|
||||
case PWM_SERVO_GET(4):
|
||||
if (_mode < MODE_5PWM1CAP) {
|
||||
if (_mode < MODE_5PWM) {
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
}
|
||||
@@ -1249,8 +1255,10 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
|
||||
case PWM_SERVO_GET_RATEGROUP(1):
|
||||
case PWM_SERVO_GET_RATEGROUP(2):
|
||||
case PWM_SERVO_GET_RATEGROUP(3):
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 6
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 5
|
||||
case PWM_SERVO_GET_RATEGROUP(4):
|
||||
#endif
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 6
|
||||
case PWM_SERVO_GET_RATEGROUP(5):
|
||||
#endif
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 8
|
||||
@@ -1677,6 +1685,9 @@ PX4FMU::fmu_new_mode(PortMode new_mode)
|
||||
/* select 4-pin PWM mode */
|
||||
servo_mode = PX4FMU::MODE_4PWM;
|
||||
#endif
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM == 5
|
||||
servo_mode = PX4FMU::MODE_5PWM;
|
||||
#endif
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM == 6
|
||||
servo_mode = PX4FMU::MODE_6PWM;
|
||||
#endif
|
||||
@@ -2109,6 +2120,9 @@ int PX4FMU::custom_command(int argc, char *argv[])
|
||||
} else if (!strcmp(verb, "mode_pwm6")) {
|
||||
new_mode = PORT_PWM6;
|
||||
|
||||
#endif
|
||||
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 5
|
||||
|
||||
} else if (!strcmp(verb, "mode_pwm5")) {
|
||||
new_mode = PORT_PWM5;
|
||||
|
||||
|
||||
@@ -2822,6 +2822,7 @@ PX4IO::ioctl(file *filep, int cmd, unsigned long arg)
|
||||
}
|
||||
|
||||
/* reboot into bootloader - arg must be PX4IO_REBOOT_BL_MAGIC */
|
||||
usleep(1);
|
||||
io_reg_set(PX4IO_PAGE_SETUP, PX4IO_P_SETUP_REBOOT_BL, arg);
|
||||
// we don't expect a reply from this operation
|
||||
ret = OK;
|
||||
|
||||
@@ -36,7 +36,7 @@
|
||||
#include <stdint.h>
|
||||
|
||||
#include <arch/board/board.h>
|
||||
#include "chip/stm32_tim.h"
|
||||
#include "hardware/stm32_tim.h"
|
||||
|
||||
|
||||
#include "led.hpp"
|
||||
|
||||
@@ -36,7 +36,7 @@
|
||||
#include <stdint.h>
|
||||
|
||||
#include <arch/board/board.h>
|
||||
#include "chip/stm32_tim.h"
|
||||
#include "hardware/stm32_tim.h"
|
||||
|
||||
|
||||
#include "led.hpp"
|
||||
|
||||
@@ -72,6 +72,8 @@ __BEGIN_DECLS
|
||||
__EXPORT int dataman_main(int argc, char *argv[]);
|
||||
__END_DECLS
|
||||
|
||||
static constexpr int TASK_STACK_SIZE = 1220;
|
||||
|
||||
/* Private File based Operations */
|
||||
static ssize_t _file_write(dm_item_t item, unsigned index, dm_persitence_t persistence, const void *buf,
|
||||
size_t count);
|
||||
@@ -1446,7 +1448,8 @@ start()
|
||||
px4_sem_setprotocol(&g_init_sema, SEM_PRIO_NONE);
|
||||
|
||||
/* start the worker thread with low priority for disk IO */
|
||||
if ((task = px4_task_spawn_cmd("dataman", SCHED_DEFAULT, SCHED_PRIORITY_DEFAULT - 10, 1200, task_main, nullptr)) < 0) {
|
||||
if ((task = px4_task_spawn_cmd("dataman", SCHED_DEFAULT, SCHED_PRIORITY_DEFAULT - 10, TASK_STACK_SIZE, task_main,
|
||||
nullptr)) < 0) {
|
||||
px4_sem_destroy(&g_init_sema);
|
||||
PX4_ERR("task start failed");
|
||||
return -1;
|
||||
|
||||
@@ -58,7 +58,9 @@
|
||||
|
||||
__EXPORT int bl_update_main(int argc, char *argv[]);
|
||||
|
||||
#if defined (CONFIG_STM32_STM32F4XXX) || defined (CONFIG_ARCH_CHIP_STM32F7)
|
||||
#if defined (CONFIG_STM32_STM32F4XXX) || defined (CONFIG_ARCH_CHIP_STM32F7) || \
|
||||
defined (CONFIG_ARCH_CHIP_STM32H7)
|
||||
|
||||
static int setopt(void);
|
||||
|
||||
static void print_usage(const char *reason)
|
||||
@@ -81,7 +83,8 @@ static void print_usage(const char *reason)
|
||||
int
|
||||
bl_update_main(int argc, char *argv[])
|
||||
{
|
||||
#if !(defined (CONFIG_STM32_STM32F4XXX) || defined (CONFIG_ARCH_CHIP_STM32F7))
|
||||
#if !(defined (CONFIG_STM32_STM32F4XXX) || defined (CONFIG_ARCH_CHIP_STM32F7) \
|
||||
|| defined (CONFIG_ARCH_CHIP_STM32H7))
|
||||
PX4_ERR("Not supported on this HW");
|
||||
return 1;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user