mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-21 01:12:11 +00:00
board_mcu_version: move to platforms/nuttx/src/px4
This commit is contained in:
@@ -33,5 +33,6 @@
|
||||
|
||||
px4_add_library(arch_version
|
||||
board_identity.c
|
||||
board_mcu_version.c
|
||||
)
|
||||
|
||||
|
||||
@@ -0,0 +1,64 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (C) 2017 PX4 Development Team. All rights reserved.
|
||||
* Author: @author David Sidrane <david_s5@nscdg.com>
|
||||
*
|
||||
* 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_mcu_version.c
|
||||
* Implementation of Kinetis based SoC version API
|
||||
*/
|
||||
|
||||
#include <px4_platform_common/px4_config.h>
|
||||
#include <px4_platform_common/defines.h>
|
||||
|
||||
#include "up_arch.h"
|
||||
#include "chip/kinetis_sim.h"
|
||||
|
||||
#define CHIP_TAG "Kinetis K??"
|
||||
#define CHIP_TAG_LEN sizeof(CHIP_TAG)-1
|
||||
|
||||
int board_mcu_version(char *rev, const char **revstr, const char **errata)
|
||||
{
|
||||
uint32_t sim_sdid = getreg32(KINETIS_SIM_SDID);
|
||||
static char chip[sizeof(CHIP_TAG)] = CHIP_TAG;
|
||||
|
||||
chip[CHIP_TAG_LEN - 2] = '0' + ((sim_sdid & SIM_SDID_FAMILYID_MASK) >> SIM_SDID_FAMILYID_SHIFT);
|
||||
chip[CHIP_TAG_LEN - 1] = '0' + ((sim_sdid & SIM_SDID_SUBFAMID_MASK) >> SIM_SDID_SUBFAMID_SHIFT);
|
||||
*revstr = chip;
|
||||
*rev = '0' + ((sim_sdid & SIM_SDID_REVID_MASK) >> SIM_SDID_REVID_SHIFT);
|
||||
|
||||
if (errata) {
|
||||
*errata = NULL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
@@ -33,5 +33,6 @@
|
||||
|
||||
px4_add_library(arch_version
|
||||
board_identity.c
|
||||
board_mcu_version.c
|
||||
)
|
||||
|
||||
|
||||
@@ -0,0 +1,158 @@
|
||||
/****************************************************************************
|
||||
*
|
||||
* Copyright (C) 2017 PX4 Development Team. All rights reserved.
|
||||
* Author: @author David Sidrane <david_s5@nscdg.com>
|
||||
*
|
||||
* 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_mcu_version.c
|
||||
* Implementation of STM32 based SoC version API
|
||||
*/
|
||||
|
||||
#include <px4_platform_common/px4_config.h>
|
||||
#include <px4_platform_common/defines.h>
|
||||
|
||||
/* magic numbers from reference manual */
|
||||
|
||||
enum MCU_REV {
|
||||
MCU_REV_STM32F4_REV_A = 0x1000,
|
||||
MCU_REV_STM32F4_REV_Z = 0x1001,
|
||||
MCU_REV_STM32F4_REV_Y = 0x1003,
|
||||
MCU_REV_STM32F4_REV_1 = 0x1007,
|
||||
MCU_REV_STM32F4_REV_3 = 0x2001
|
||||
};
|
||||
|
||||
/* Define any issues with the Silicon as lines separated by \n
|
||||
* omitting the last \n
|
||||
*/
|
||||
#define STM32_F4_ERRATA "This device can only utilize a maximum of 1MB flash safely!"
|
||||
|
||||
|
||||
//STM DocID018909 Rev 8 Sect 38.18 and DocID026670 Rev 5 40.6.1 (MCU device ID code)
|
||||
# define REVID_MASK 0xFFFF0000
|
||||
# define DEVID_MASK 0xFFF
|
||||
|
||||
# define STM32F74xxx_75xxx 0x449
|
||||
# define STM32F76xxx_77xxx 0x451
|
||||
# define STM32F40x_41x 0x413
|
||||
# define STM32F42x_43x 0x419
|
||||
# define STM32F103_LD 0x412
|
||||
# define STM32F103_MD 0x410
|
||||
# define STM32F103_HD 0x414
|
||||
# define STM32F103_XLD 0x430
|
||||
# define STM32F103_CON 0x418
|
||||
|
||||
|
||||
int board_mcu_version(char *rev, const char **revstr, const char **errata)
|
||||
{
|
||||
uint32_t abc = getreg32(STM32_DEBUGMCU_BASE);
|
||||
|
||||
int32_t chip_version = abc & DEVID_MASK;
|
||||
enum MCU_REV revid = (abc & REVID_MASK) >> 16;
|
||||
const char *chip_errata = NULL;
|
||||
|
||||
switch (chip_version) {
|
||||
|
||||
case STM32F74xxx_75xxx:
|
||||
*revstr = "STM32F74xxx";
|
||||
break;
|
||||
|
||||
case STM32F76xxx_77xxx:
|
||||
*revstr = "STM32F76xxx";
|
||||
break;
|
||||
|
||||
case STM32F42x_43x:
|
||||
*revstr = "STM32F42x";
|
||||
/* Set possible errata */
|
||||
chip_errata = STM32_F4_ERRATA;
|
||||
break;
|
||||
|
||||
case STM32F103_LD:
|
||||
*revstr = "STM32F1xx Low";
|
||||
break;
|
||||
|
||||
case STM32F103_MD:
|
||||
*revstr = "STM32F1xx Med";
|
||||
break;
|
||||
|
||||
case STM32F103_HD:
|
||||
*revstr = "STM32F1xx Hi";
|
||||
break;
|
||||
|
||||
case STM32F103_XLD:
|
||||
*revstr = "STM32F1xx XL";
|
||||
break;
|
||||
|
||||
case STM32F103_CON:
|
||||
*revstr = "STM32F1xx Con";
|
||||
break;
|
||||
|
||||
default:
|
||||
*revstr = "STM32F???";
|
||||
break;
|
||||
}
|
||||
|
||||
switch (revid) {
|
||||
|
||||
case MCU_REV_STM32F4_REV_A:
|
||||
*rev = 'A';
|
||||
break;
|
||||
|
||||
case MCU_REV_STM32F4_REV_Z:
|
||||
*rev = 'Z';
|
||||
break;
|
||||
|
||||
case MCU_REV_STM32F4_REV_Y:
|
||||
*rev = 'Y';
|
||||
break;
|
||||
|
||||
case MCU_REV_STM32F4_REV_1:
|
||||
*rev = '1';
|
||||
break;
|
||||
|
||||
case MCU_REV_STM32F4_REV_3:
|
||||
*rev = '3';
|
||||
chip_errata = NULL;
|
||||
break;
|
||||
|
||||
default:
|
||||
// todo add rev for 103 - if needed
|
||||
*rev = '?';
|
||||
revid = -1;
|
||||
break;
|
||||
}
|
||||
|
||||
if (errata) {
|
||||
*errata = chip_errata;
|
||||
}
|
||||
|
||||
return revid;
|
||||
}
|
||||
Reference in New Issue
Block a user