NEW: sync the code of DJI Payload-SDK version 2.2.1 released on January 20 2021.
Signed-off-by: DJI-Martin <DJI-Martin@dji.com>
This commit is contained in:
179
sample/platform/rtos_freertos/stm32f4_eval/bootloader/common.c
Normal file
179
sample/platform/rtos_freertos/stm32f4_eval/bootloader/common.c
Normal file
@ -0,0 +1,179 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file IAP/IAP_Main/Src/common.c
|
||||
* @author MCD Application Team
|
||||
* @brief This file provides all the common functions.
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* <h2><center>© Copyright (c) 2017 STMicroelectronics International N.V.
|
||||
* All rights reserved.</center></h2>
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted, provided that the following conditions are met:
|
||||
*
|
||||
* 1. Redistribution 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 of STMicroelectronics nor the names of other
|
||||
* contributors to this software may be used to endorse or promote products
|
||||
* derived from this software without specific written permission.
|
||||
* 4. This software, including modifications and/or derivative works of this
|
||||
* software, must execute solely and exclusively on microcontroller or
|
||||
* microprocessor devices manufactured by or for STMicroelectronics.
|
||||
* 5. Redistribution and use of this software other than as permitted under
|
||||
* this license is void and will automatically terminate your rights under
|
||||
* this license.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY STMICROELECTRONICS AND CONTRIBUTORS "AS IS"
|
||||
* AND ANY EXPRESS, IMPLIED OR STATUTORY WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS FOR A
|
||||
* PARTICULAR PURPOSE AND NON-INFRINGEMENT OF THIRD PARTY INTELLECTUAL PROPERTY
|
||||
* RIGHTS ARE DISCLAIMED TO THE FULLEST EXTENT PERMITTED BY LAW. IN NO EVENT
|
||||
* SHALL STMICROELECTRONICS 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.
|
||||
*
|
||||
* @statement DJI has modified some symbols' name.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/** @addtogroup STM32F4xx_IAP_Main
|
||||
* @{
|
||||
*/
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "common.h"
|
||||
#include "main.h"
|
||||
#include "uart.h"
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
/* Private define ------------------------------------------------------------*/
|
||||
/* Private macro -------------------------------------------------------------*/
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
/* Private functions ---------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Convert an Integer to a string
|
||||
* @param p_str: The string output pointer
|
||||
* @param intnum: The integer to be converted
|
||||
* @retval None
|
||||
*/
|
||||
void Int2Str(uint8_t *p_str, uint32_t intnum)
|
||||
{
|
||||
uint32_t i, divider = 1000000000, pos = 0, status = 0;
|
||||
|
||||
for (i = 0; i < 10; i++) {
|
||||
p_str[pos++] = (intnum / divider) + 48;
|
||||
|
||||
intnum = intnum % divider;
|
||||
divider /= 10;
|
||||
if ((p_str[pos - 1] == '0') & (status == 0)) {
|
||||
pos = 0;
|
||||
} else {
|
||||
status++;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Convert a string to an integer
|
||||
* @param p_inputstr: The string to be converted
|
||||
* @param p_intnum: The integer value
|
||||
* @retval 1: Correct
|
||||
* 0: Error
|
||||
*/
|
||||
uint32_t Str2Int(uint8_t *p_inputstr, uint32_t *p_intnum)
|
||||
{
|
||||
uint32_t i = 0, res = 0;
|
||||
uint32_t val = 0;
|
||||
|
||||
if ((p_inputstr[0] == '0') && ((p_inputstr[1] == 'x') || (p_inputstr[1] == 'X'))) {
|
||||
i = 2;
|
||||
while ((i < 11) && (p_inputstr[i] != '\0')) {
|
||||
if (ISVALIDHEX(p_inputstr[i])) {
|
||||
val = (val << 4) + CONVERTHEX(p_inputstr[i]);
|
||||
} else {
|
||||
/* Return 0, Invalid input */
|
||||
res = 0;
|
||||
break;
|
||||
}
|
||||
i++;
|
||||
}
|
||||
|
||||
/* valid result */
|
||||
if (p_inputstr[i] == '\0') {
|
||||
*p_intnum = val;
|
||||
res = 1;
|
||||
}
|
||||
} else /* max 10-digit decimal input */
|
||||
{
|
||||
while ((i < 11) && (res != 1)) {
|
||||
if (p_inputstr[i] == '\0') {
|
||||
*p_intnum = val;
|
||||
/* return 1 */
|
||||
res = 1;
|
||||
} else if (((p_inputstr[i] == 'k') || (p_inputstr[i] == 'K')) && (i > 0)) {
|
||||
val = val << 10;
|
||||
*p_intnum = val;
|
||||
res = 1;
|
||||
} else if (((p_inputstr[i] == 'm') || (p_inputstr[i] == 'M')) && (i > 0)) {
|
||||
val = val << 20;
|
||||
*p_intnum = val;
|
||||
res = 1;
|
||||
} else if (ISVALIDDEC(p_inputstr[i]))
|
||||
{
|
||||
val = val * 10 + CONVERTDEC(p_inputstr[i]);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* return 0, Invalid input */
|
||||
res = 0;
|
||||
break;
|
||||
}
|
||||
i++;
|
||||
}
|
||||
}
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Print a string on the HyperTerminal
|
||||
* @param p_string: The string to be printed
|
||||
* @retval None
|
||||
*/
|
||||
void Serial_PutString(uint8_t *p_string)
|
||||
{
|
||||
uint16_t length = 0;
|
||||
|
||||
while (p_string[length] != '\0')
|
||||
{
|
||||
length++;
|
||||
}
|
||||
UART_Write(PSDK_CONSOLE_UART_NUM, p_string, length);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Transmit a byte to the HyperTerminal
|
||||
* @param param The byte to be sent
|
||||
* @retval HAL_StatusTypeDef HAL_OK if OK
|
||||
*/
|
||||
HAL_StatusTypeDef Serial_PutByte( uint8_t param )
|
||||
{
|
||||
UART_Write(PSDK_CONSOLE_UART_NUM, ¶m, 1);
|
||||
return HAL_OK;
|
||||
}
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|
Reference in New Issue
Block a user