696 lines
22 KiB
C
696 lines
22 KiB
C
/********************************** (C) COPYRIGHT *******************************
|
|
* File Name : Peripheral.C
|
|
* Author : WCH
|
|
* Version : V1.0
|
|
* Date : 2018/12/10
|
|
* Description : 外设从机应用程序，初始化广播连接参数，然后广播，直至连接主机后，通过自定义服务传输数据
|
|
*********************************************************************************
|
|
* Copyright (c) 2021 Nanjing Qinheng Microelectronics Co., Ltd.
|
|
* Attention: This software (modified or not) and binary are used for
|
|
* microcontroller manufactured by Nanjing Qinheng Microelectronics.
|
|
*******************************************************************************/
|
|
|
|
/*********************************************************************
|
|
* INCLUDES
|
|
*/
|
|
#include "CONFIG.h"
|
|
#include "GATTprofile.h"
|
|
#include "Peripheral.h"
|
|
#include "OTA.h"
|
|
#include "OTAprofile.h"
|
|
|
|
/*********************************************************************
|
|
* MACROS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* CONSTANTS
|
|
*/
|
|
|
|
// How often to perform periodic event
|
|
#define SBP_PERIODIC_EVT_PERIOD 1000
|
|
|
|
// What is the advertising interval when device is discoverable (units of 625us, 32=20ms)
|
|
#define DEFAULT_ADVERTISING_INTERVAL 32
|
|
|
|
// Limited discoverable mode advertises for 30.72s, and then stops
|
|
// General discoverable mode advertises indefinitely
|
|
|
|
#define DEFAULT_DISCOVERABLE_MODE GAP_ADTYPE_FLAGS_GENERAL
|
|
|
|
// Minimum connection interval (units of 1.25ms, 6=7.5ms) if automatic parameter update request is enabled
|
|
#define DEFAULT_DESIRED_MIN_CONN_INTERVAL 6
|
|
|
|
// Maximum connection interval (units of 1.25ms, 12=15ms) if automatic parameter update request is enabled
|
|
#define DEFAULT_DESIRED_MAX_CONN_INTERVAL 12
|
|
|
|
// Slave latency to use if automatic parameter update request is enabled
|
|
#define DEFAULT_DESIRED_SLAVE_LATENCY 0
|
|
|
|
// Supervision timeout value (units of 10ms, 1000=10s) if automatic parameter update request is enabled
|
|
#define DEFAULT_DESIRED_CONN_TIMEOUT 1000
|
|
|
|
// Whether to enable automatic parameter update request when a connection is formed
|
|
#define DEFAULT_ENABLE_UPDATE_REQUEST TRUE
|
|
|
|
// Connection Pause Peripheral time value (in seconds)
|
|
#define DEFAULT_CONN_PAUSE_PERIPHERAL 6
|
|
|
|
// Company Identifier: WCH
|
|
#define WCH_COMPANY_ID 0x07D7
|
|
|
|
#define INVALID_CONNHANDLE 0xFFFF
|
|
|
|
// Length of bd addr as a string
|
|
#define B_ADDR_STR_LEN 15
|
|
|
|
/*********************************************************************
|
|
* TYPEDEFS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* GLOBAL VARIABLES
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* EXTERNAL VARIABLES
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* EXTERNAL FUNCTIONS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* LOCAL VARIABLES
|
|
*/
|
|
static uint8_t Peripheral_TaskID = INVALID_TASK_ID; // Task ID for internal task/event processing
|
|
|
|
// GAP - SCAN RSP data (max size = 31 bytes)
|
|
static uint8_t scanRspData[31] = {
|
|
// complete name
|
|
0x12, // length of this data
|
|
GAP_ADTYPE_LOCAL_NAME_COMPLETE,
|
|
'O', 'T', 'A', 'O', 'T', 'A', '_', 'O', 'T', 'A', 'O', 'T', 'A', '_', 'O', 'T', 'A',
|
|
// connection interval range
|
|
0x05, // length of this data
|
|
GAP_ADTYPE_SLAVE_CONN_INTERVAL_RANGE,
|
|
LO_UINT16(DEFAULT_DESIRED_MIN_CONN_INTERVAL), // 100ms
|
|
HI_UINT16(DEFAULT_DESIRED_MIN_CONN_INTERVAL),
|
|
LO_UINT16(DEFAULT_DESIRED_MAX_CONN_INTERVAL), // 1s
|
|
HI_UINT16(DEFAULT_DESIRED_MAX_CONN_INTERVAL),
|
|
|
|
// Tx power level
|
|
0x02, // length of this data
|
|
GAP_ADTYPE_POWER_LEVEL,
|
|
0 // 0dBm
|
|
};
|
|
|
|
// GAP - Advertisement data (max size = 31 bytes, though this is
|
|
// best kept short to conserve power while advertisting)
|
|
static uint8_t advertData[] = {
|
|
// Flags; this sets the device to use limited discoverable
|
|
// mode (advertises for 30 seconds at a time) instead of general
|
|
// discoverable mode (advertises indefinitely)
|
|
0x02, // length of this data
|
|
GAP_ADTYPE_FLAGS,
|
|
DEFAULT_DISCOVERABLE_MODE | GAP_ADTYPE_FLAGS_BREDR_NOT_SUPPORTED,
|
|
|
|
// service UUID, to notify central devices what services are included
|
|
// in this peripheral
|
|
0x03, // length of this data
|
|
GAP_ADTYPE_16BIT_MORE, // some of the UUID's, but not all
|
|
LO_UINT16(SIMPLEPROFILE_SERV_UUID),
|
|
HI_UINT16(SIMPLEPROFILE_SERV_UUID)
|
|
|
|
};
|
|
|
|
// GAP GATT Attributes
|
|
static uint8_t attDeviceName[GAP_DEVICE_NAME_LEN] = "OTAOTA_OTAOTA_OTA";
|
|
|
|
// OTA IAP VARIABLES
|
|
/* OTA通讯的帧 */
|
|
OTA_IAP_CMD_t iap_rec_data;
|
|
|
|
/* OTA解析结果 */
|
|
uint32_t OpParaDataLen = 0;
|
|
uint32_t OpAdd = 0;
|
|
|
|
/* flash的数据临时存储 */
|
|
__attribute__((aligned(8))) uint8_t block_buf[16];
|
|
|
|
/* Image跳转函数地址定义 */
|
|
typedef int (*pImageTaskFn)(void);
|
|
pImageTaskFn user_image_tasks;
|
|
|
|
/* Flash 擦除过程 */
|
|
uint32_t EraseAdd = 0; //擦除地址
|
|
uint32_t EraseBlockNum = 0; //需要擦除的块数
|
|
uint32_t EraseBlockCnt = 0; //擦除的块计数
|
|
|
|
/* FLASH 校验过程 */
|
|
uint8_t VerifyStatus = 0;
|
|
|
|
/*********************************************************************
|
|
* LOCAL FUNCTIONS
|
|
*/
|
|
static void Peripheral_ProcessTMOSMsg(tmos_event_hdr_t *pMsg);
|
|
static void peripheralStateNotificationCB(gapRole_States_t newState, gapRoleEvent_t *pEvent);
|
|
static void performPeriodicTask(void);
|
|
|
|
void OTA_IAPReadDataComplete(unsigned char index);
|
|
void OTA_IAPWriteData(unsigned char index, unsigned char *p_data, unsigned char w_len);
|
|
void Rec_OTA_IAP_DataDeal(void);
|
|
void OTA_IAP_SendCMDDealSta(uint8_t deal_status);
|
|
|
|
/*********************************************************************
|
|
* PROFILE CALLBACKS
|
|
*/
|
|
|
|
// GAP Role Callbacks
|
|
static gapRolesCBs_t Peripheral_PeripheralCBs = {
|
|
peripheralStateNotificationCB, // Profile State Change Callbacks
|
|
NULL, // When a valid RSSI is read from controller (not used by application)
|
|
NULL};
|
|
|
|
// GAP Bond Manager Callbacks
|
|
static gapBondCBs_t Peripheral_BondMgrCBs = {
|
|
NULL, // Passcode callback (not used by application)
|
|
NULL // Pairing / Bonding state Callback (not used by application)
|
|
};
|
|
|
|
// Simple GATT Profile Callbacks
|
|
static OTAProfileCBs_t Peripheral_OTA_IAPProfileCBs = {
|
|
OTA_IAPReadDataComplete, // Charactersitic value change callback
|
|
OTA_IAPWriteData};
|
|
|
|
// Callback when the connection parameteres are updated.
|
|
void PeripheralParamUpdate(uint16_t connInterval, uint16_t connSlaveLatency, uint16_t connTimeout);
|
|
|
|
gapRolesParamUpdateCB_t PeripheralParamUpdate_t = NULL;
|
|
|
|
/*********************************************************************
|
|
* PUBLIC FUNCTIONS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* @fn Peripheral_Init
|
|
*
|
|
* @brief Initialization function for the Peripheral App Task.
|
|
* This is called during initialization and should contain
|
|
* any application specific initialization (ie. hardware
|
|
* initialization/setup, table initialization, power up
|
|
* notificaiton ... ).
|
|
*
|
|
* @param task_id - the ID assigned by TMOS. This ID should be
|
|
* used to send messages and set timers.
|
|
*
|
|
* @return none
|
|
*/
|
|
void Peripheral_Init()
|
|
{
|
|
Peripheral_TaskID = TMOS_ProcessEventRegister(Peripheral_ProcessEvent);
|
|
|
|
// Setup the GAP Peripheral Role Profile
|
|
{
|
|
// For other hardware platforms, device starts advertising upon initialization
|
|
uint8_t initial_advertising_enable = TRUE;
|
|
|
|
// Set the GAP Role Parameters
|
|
GAPRole_SetParameter(GAPROLE_ADVERT_ENABLED, sizeof(uint8_t), &initial_advertising_enable);
|
|
GAPRole_SetParameter(GAPROLE_SCAN_RSP_DATA, sizeof(scanRspData), scanRspData);
|
|
GAPRole_SetParameter(GAPROLE_ADVERT_DATA, sizeof(advertData), advertData);
|
|
}
|
|
|
|
// Set the GAP Characteristics
|
|
GGS_SetParameter(GGS_DEVICE_NAME_ATT, GAP_DEVICE_NAME_LEN, attDeviceName);
|
|
|
|
// Set advertising interval
|
|
{
|
|
uint16_t advInt = DEFAULT_ADVERTISING_INTERVAL;
|
|
|
|
GAP_SetParamValue(TGAP_DISC_ADV_INT_MIN, advInt);
|
|
GAP_SetParamValue(TGAP_DISC_ADV_INT_MAX, advInt);
|
|
}
|
|
|
|
// Initialize GATT attributes
|
|
GGS_AddService(GATT_ALL_SERVICES); // GAP
|
|
GATTServApp_AddService(GATT_ALL_SERVICES); // GATT attributes
|
|
OTAProfile_AddService(GATT_ALL_SERVICES);
|
|
|
|
// Register callback with OTAGATTprofile
|
|
OTAProfile_RegisterAppCBs(&Peripheral_OTA_IAPProfileCBs);
|
|
|
|
// Setup a delayed profile startup
|
|
tmos_set_event(Peripheral_TaskID, SBP_START_DEVICE_EVT);
|
|
}
|
|
|
|
void PeripheralParamUpdate(uint16_t connInterval, uint16_t connSlaveLatency, uint16_t connTimeout)
|
|
{
|
|
PRINT("update %d %d %d \n", connInterval, connSlaveLatency, connTimeout);
|
|
|
|
// GAPRole_SendUpdateParam( DEFAULT_DESIRED_MIN_CONN_INTERVAL, DEFAULT_DESIRED_MAX_CONN_INTERVAL,
|
|
// DEFAULT_DESIRED_SLAVE_LATENCY, DEFAULT_DESIRED_CONN_TIMEOUT, GAPROLE_NO_ACTION );
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn Peripheral_ProcessEvent
|
|
*
|
|
* @brief Peripheral Application Task event processor. This function
|
|
* is called to process all events for the task. Events
|
|
* include timers, messages and any other user defined events.
|
|
*
|
|
* @param task_id - The TMOS assigned task ID.
|
|
* @param events - events to process. This is a bit map and can
|
|
* contain more than one event.
|
|
*
|
|
* @return events not processed
|
|
*/
|
|
uint16_t Peripheral_ProcessEvent(uint8_t task_id, uint16_t events)
|
|
{
|
|
// VOID task_id; // TMOS required parameter that isn't used in this function
|
|
|
|
if(events & SYS_EVENT_MSG)
|
|
{
|
|
uint8_t *pMsg;
|
|
|
|
if((pMsg = tmos_msg_receive(Peripheral_TaskID)) != NULL)
|
|
{
|
|
Peripheral_ProcessTMOSMsg((tmos_event_hdr_t *)pMsg);
|
|
// Release the TMOS message
|
|
tmos_msg_deallocate(pMsg);
|
|
}
|
|
// return unprocessed events
|
|
return (events ^ SYS_EVENT_MSG);
|
|
}
|
|
|
|
if(events & SBP_START_DEVICE_EVT)
|
|
{
|
|
// Start the Device
|
|
GAPRole_PeripheralStartDevice(Peripheral_TaskID, &Peripheral_BondMgrCBs, &Peripheral_PeripheralCBs);
|
|
// Set timer for first periodic event
|
|
tmos_start_task(Peripheral_TaskID, SBP_PERIODIC_EVT, SBP_PERIODIC_EVT_PERIOD);
|
|
return (events ^ SBP_START_DEVICE_EVT);
|
|
}
|
|
|
|
if(events & SBP_PERIODIC_EVT)
|
|
{
|
|
// Restart timer
|
|
if(SBP_PERIODIC_EVT_PERIOD)
|
|
{
|
|
tmos_start_task(Peripheral_TaskID, SBP_PERIODIC_EVT, SBP_PERIODIC_EVT_PERIOD);
|
|
}
|
|
// Perform periodic application task
|
|
performPeriodicTask();
|
|
return (events ^ SBP_PERIODIC_EVT);
|
|
}
|
|
|
|
//OTA_FLASH_ERASE_EVT
|
|
if(events & OTA_FLASH_ERASE_EVT)
|
|
{
|
|
uint8_t status;
|
|
|
|
PRINT("ERASE:%08x num:%d\r\n", (int)(EraseAdd + EraseBlockCnt * FLASH_BLOCK_SIZE), (int)EraseBlockCnt);
|
|
status = FLASH_ROM_ERASE(EraseAdd + EraseBlockCnt * FLASH_BLOCK_SIZE, FLASH_BLOCK_SIZE);
|
|
|
|
/* 擦除失败 */
|
|
if(status != SUCCESS)
|
|
{
|
|
OTA_IAP_SendCMDDealSta(status);
|
|
return (events ^ OTA_FLASH_ERASE_EVT);
|
|
}
|
|
|
|
EraseBlockCnt++;
|
|
|
|
/* 擦除结束 */
|
|
if(EraseBlockCnt >= EraseBlockNum)
|
|
{
|
|
PRINT("ERASE Complete\r\n");
|
|
OTA_IAP_SendCMDDealSta(status);
|
|
return (events ^ OTA_FLASH_ERASE_EVT);
|
|
}
|
|
|
|
return (events);
|
|
}
|
|
|
|
// Discard unknown events
|
|
return 0;
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn Peripheral_ProcessTMOSMsg
|
|
*
|
|
* @brief Process an incoming task message.
|
|
*
|
|
* @param pMsg - message to process
|
|
*
|
|
* @return none
|
|
*/
|
|
static void Peripheral_ProcessTMOSMsg(tmos_event_hdr_t *pMsg)
|
|
{
|
|
switch(pMsg->event)
|
|
{
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn peripheralStateNotificationCB
|
|
*
|
|
* @brief Notification from the profile of a state change.
|
|
*
|
|
* @param newState - new state
|
|
*
|
|
* @return none
|
|
*/
|
|
static void peripheralStateNotificationCB(gapRole_States_t newState, gapRoleEvent_t *pEvent)
|
|
{
|
|
switch(newState & GAPROLE_STATE_ADV_MASK)
|
|
{
|
|
case GAPROLE_STARTED:
|
|
PRINT("Initialized..\n");
|
|
break;
|
|
|
|
case GAPROLE_ADVERTISING:
|
|
PRINT("Advertising..\n");
|
|
break;
|
|
|
|
case GAPROLE_CONNECTED:
|
|
{
|
|
gapEstLinkReqEvent_t *event = (gapEstLinkReqEvent_t *)pEvent;
|
|
uint16_t conn_interval = 0;
|
|
|
|
conn_interval = event->connInterval;
|
|
PRINT("Connected.. \n");
|
|
|
|
if(conn_interval > DEFAULT_DESIRED_MAX_CONN_INTERVAL)
|
|
{
|
|
PRINT("Send Update\r\n");
|
|
GAPRole_PeripheralConnParamUpdateReq(event->connectionHandle,
|
|
DEFAULT_DESIRED_MIN_CONN_INTERVAL,
|
|
DEFAULT_DESIRED_MAX_CONN_INTERVAL,
|
|
DEFAULT_DESIRED_SLAVE_LATENCY,
|
|
DEFAULT_DESIRED_CONN_TIMEOUT,
|
|
Peripheral_TaskID);
|
|
}
|
|
break;
|
|
}
|
|
case GAPROLE_CONNECTED_ADV:
|
|
PRINT("Connected Advertising..\n");
|
|
break;
|
|
case GAPROLE_WAITING:
|
|
{
|
|
uint8_t initial_advertising_enable = TRUE;
|
|
|
|
// Set the GAP Role Parameters
|
|
GAPRole_SetParameter(GAPROLE_ADVERT_ENABLED, sizeof(uint8_t), &initial_advertising_enable);
|
|
PRINT("Disconnected..\n");
|
|
}
|
|
break;
|
|
|
|
case GAPROLE_ERROR:
|
|
PRINT("Error..\n");
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn performPeriodicTask
|
|
*
|
|
* @brief Perform a periodic application task. This function gets
|
|
* called every five seconds as a result of the SBP_PERIODIC_EVT
|
|
* TMOS event. In this example, the value of the third
|
|
* characteristic in the SimpleGATTProfile service is retrieved
|
|
* from the profile, and then copied into the value of the
|
|
* the fourth characteristic.
|
|
*
|
|
* @param none
|
|
*
|
|
* @return none
|
|
*/
|
|
static void performPeriodicTask(void)
|
|
{
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn OTA_IAP_SendData
|
|
*
|
|
* @brief OTA IAP发送数据，使用时限制20字节以内
|
|
*
|
|
* @param p_send_data - 发送数据的指针
|
|
* @param send_len - 发送数据的长度
|
|
*
|
|
* @return none
|
|
*/
|
|
void OTA_IAP_SendData(uint8_t *p_send_data, uint8_t send_len)
|
|
{
|
|
OTAProfile_SendData(OTAPROFILE_CHAR, p_send_data, send_len);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn OTA_IAP_SendCMDDealSta
|
|
*
|
|
* @brief OTA IAP执行的状态返回
|
|
*
|
|
* @param deal_status - 返回的状态
|
|
*
|
|
* @return none
|
|
*/
|
|
void OTA_IAP_SendCMDDealSta(uint8_t deal_status)
|
|
{
|
|
uint8_t send_buf[2];
|
|
|
|
send_buf[0] = deal_status;
|
|
send_buf[1] = 0;
|
|
OTA_IAP_SendData(send_buf, 2);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn OTA_IAP_CMDErrDeal
|
|
*
|
|
* @brief OTA IAP异常命令码处理
|
|
*
|
|
* @return none
|
|
*/
|
|
void OTA_IAP_CMDErrDeal(void)
|
|
{
|
|
OTA_IAP_SendCMDDealSta(0xfe);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn SwitchImageFlag
|
|
*
|
|
* @brief 切换dataflash里的ImageFlag
|
|
*
|
|
* @param new_flag - 切换的ImageFlag
|
|
*
|
|
* @return none
|
|
*/
|
|
void SwitchImageFlag(uint8_t new_flag)
|
|
{
|
|
uint16_t i;
|
|
uint32_t ver_flag;
|
|
|
|
/* 读取第一块 */
|
|
EEPROM_READ(OTA_DATAFLASH_ADD, (uint32_t *)&block_buf[0], 4);
|
|
|
|
/* 擦除第一块 */
|
|
EEPROM_ERASE(OTA_DATAFLASH_ADD, EEPROM_PAGE_SIZE);
|
|
|
|
/* 更新Image信息 */
|
|
block_buf[0] = new_flag;
|
|
|
|
/* 编程DataFlash */
|
|
EEPROM_WRITE(OTA_DATAFLASH_ADD, (uint32_t *)&block_buf[0], 4);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn DisableAllIRQ
|
|
*
|
|
* @brief 关闭所有的中断
|
|
*
|
|
* @return none
|
|
*/
|
|
void DisableAllIRQ(void)
|
|
{
|
|
SYS_DisableAllIrq(NULL);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn Rec_OTA_IAP_DataDeal
|
|
*
|
|
* @brief 接收到OTA数据包处理
|
|
*
|
|
* @return none
|
|
*/
|
|
void Rec_OTA_IAP_DataDeal(void)
|
|
{
|
|
switch(iap_rec_data.other.buf[0])
|
|
{
|
|
/* 编程 */
|
|
case CMD_IAP_PROM:
|
|
{
|
|
uint32_t i;
|
|
uint8_t status;
|
|
|
|
OpParaDataLen = iap_rec_data.program.len;
|
|
OpAdd = (uint32_t)(iap_rec_data.program.addr[0]);
|
|
OpAdd |= ((uint32_t)(iap_rec_data.program.addr[1]) << 8);
|
|
OpAdd = OpAdd * 16;
|
|
|
|
PRINT("IAP_PROM: %08x len:%d \r\n", (int)OpAdd, (int)OpParaDataLen);
|
|
|
|
/* 当前是ImageA，直接编程 */
|
|
status = FLASH_ROM_WRITE(OpAdd, iap_rec_data.program.buf, (uint16_t)OpParaDataLen);
|
|
OTA_IAP_SendCMDDealSta(status);
|
|
break;
|
|
}
|
|
/* 擦除 -- 蓝牙擦除由主机控制 */
|
|
case CMD_IAP_ERASE:
|
|
{
|
|
OpAdd = (uint32_t)(iap_rec_data.erase.addr[0]);
|
|
OpAdd |= ((uint32_t)(iap_rec_data.erase.addr[1]) << 8);
|
|
OpAdd = OpAdd * 16;
|
|
|
|
EraseBlockNum = (uint32_t)(iap_rec_data.erase.block_num[0]);
|
|
EraseBlockNum |= ((uint32_t)(iap_rec_data.erase.block_num[1]) << 8);
|
|
EraseAdd = OpAdd;
|
|
EraseBlockCnt = 0;
|
|
|
|
/* 检验就放在擦除里清0 */
|
|
VerifyStatus = 0;
|
|
|
|
PRINT("IAP_ERASE start:%08x num:%d\r\n", (int)OpAdd, (int)EraseBlockNum);
|
|
|
|
if(EraseAdd < IMAGE_A_START_ADD || (EraseAdd + (EraseBlockNum - 1) * FLASH_BLOCK_SIZE) > IMAGE_B_START_ADD)
|
|
{
|
|
OTA_IAP_SendCMDDealSta(0xFF);
|
|
}
|
|
else
|
|
{
|
|
/* 修改DataFlash，切换至ImageB */
|
|
SwitchImageFlag(IMAGE_B_FLAG);
|
|
|
|
/* 启动擦除 */
|
|
tmos_set_event(Peripheral_TaskID, OTA_FLASH_ERASE_EVT);
|
|
}
|
|
break;
|
|
}
|
|
/* 校验 */
|
|
case CMD_IAP_VERIFY:
|
|
{
|
|
uint32_t i;
|
|
uint8_t status = 0;
|
|
|
|
OpParaDataLen = iap_rec_data.verify.len;
|
|
|
|
OpAdd = (uint32_t)(iap_rec_data.verify.addr[0]);
|
|
OpAdd |= ((uint32_t)(iap_rec_data.verify.addr[1]) << 8);
|
|
OpAdd = OpAdd * 16;
|
|
|
|
PRINT("IAP_VERIFY: %08x len:%d \r\n", (int)OpAdd, (int)OpParaDataLen);
|
|
|
|
status = FLASH_ROM_VERIFY(OpAdd, iap_rec_data.verify.buf, OpParaDataLen);
|
|
VerifyStatus |= status;
|
|
OTA_IAP_SendCMDDealSta(VerifyStatus);
|
|
break;
|
|
}
|
|
/* 编程结束 */
|
|
case CMD_IAP_END:
|
|
{
|
|
PRINT("IAP_END \r\n");
|
|
|
|
/* 关闭当前所有使用中断，或者方便一点直接全部关闭 */
|
|
DisableAllIRQ();
|
|
|
|
/* 修改DataFlash，切换至ImageA */
|
|
SwitchImageFlag(IMAGE_A_FLAG);
|
|
|
|
/* 等待打印完成 ，跳转ImageB*/
|
|
mDelaymS(10);
|
|
jumpApp();
|
|
|
|
/* 不会执行到这 */
|
|
SYS_ResetExecute();
|
|
|
|
break;
|
|
}
|
|
case CMD_IAP_INFO:
|
|
{
|
|
uint8_t send_buf[20];
|
|
|
|
PRINT("IAP_INFO \r\n");
|
|
|
|
/* IMAGE FLAG */
|
|
send_buf[0] = IMAGE_B_FLAG;
|
|
|
|
/* IMAGE_B_START_ADD */
|
|
send_buf[1] = (uint8_t)(IMAGE_B_START_ADD & 0xff);
|
|
send_buf[2] = (uint8_t)((IMAGE_B_START_ADD >> 8) & 0xff);
|
|
send_buf[3] = (uint8_t)((IMAGE_B_START_ADD >> 16) & 0xff);
|
|
send_buf[4] = (uint8_t)((IMAGE_B_START_ADD >> 24) & 0xff);
|
|
|
|
/* BLOCK SIZE */
|
|
send_buf[5] = (uint8_t)(FLASH_BLOCK_SIZE & 0xff);
|
|
send_buf[6] = (uint8_t)((FLASH_BLOCK_SIZE >> 8) & 0xff);
|
|
|
|
send_buf[7] = CHIP_ID&0xFF;
|
|
send_buf[8] = (CHIP_ID>>8)&0xFF;
|
|
/* 有需要再增加 */
|
|
|
|
/* 发送信息 */
|
|
OTA_IAP_SendData(send_buf, 20);
|
|
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
OTA_IAP_CMDErrDeal();
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn OTA_IAPReadDataComplete
|
|
*
|
|
* @brief OTA 数据读取完成处理
|
|
*
|
|
* @param index - OTA 通道序号
|
|
*
|
|
* @return none
|
|
*/
|
|
void OTA_IAPReadDataComplete(unsigned char index)
|
|
{
|
|
PRINT("OTA Send Comp \r\n");
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn OTA_IAPWriteData
|
|
*
|
|
* @brief OTA 通道数据接收完成处理
|
|
*
|
|
* @param index - OTA 通道序号
|
|
* @param p_data - 写入的数据
|
|
* @param w_len - 写入的长度
|
|
*
|
|
* @return none
|
|
*/
|
|
void OTA_IAPWriteData(unsigned char index, unsigned char *p_data, unsigned char w_len)
|
|
{
|
|
unsigned char rec_len;
|
|
unsigned char *rec_data;
|
|
|
|
rec_len = w_len;
|
|
rec_data = p_data;
|
|
tmos_memcpy((unsigned char *)&iap_rec_data, rec_data, rec_len);
|
|
Rec_OTA_IAP_DataDeal();
|
|
}
|
|
|
|
/*********************************************************************
|
|
*********************************************************************/
|