73 lines
1.7 KiB
C
73 lines
1.7 KiB
C
|
/* *
|
||
|
|
* Copyright (c) CompanyNameMagicTag 2018-2019. All rights reserved.
|
||
|
|
* Description: Upgrade - Transmit file handling - extra information.
|
||
|
|
* Author: CompanyName
|
||
|
|
* Create: 2018-10-31
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "trans_extra_info.h"
|
||
|
|
#include "soc_trans_save.h"
|
||
|
|
|
||
|
|
#include <soc_stdlib.h>
|
||
|
|
|
||
|
|
#pragma pack(1)
|
||
|
|
typedef struct {
|
||
|
|
td_u8 id;
|
||
|
|
td_u8 size;
|
||
|
|
} upg_std_extra_item;
|
||
|
|
#pragma pack()
|
||
|
|
|
||
|
|
#ifdef __cplusplus
|
||
|
|
extern "C" {
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/* Parse the extended information. */
|
||
|
|
td_u32 uapi_std_get_extra_info_item(td_u8 *data, td_u32 data_size, td_u8 id, td_u8 **extra_item, td_u16 *size)
|
||
|
|
{
|
||
|
|
if (extra_item == TD_NULL || *extra_item == TD_NULL) {
|
||
|
|
return EXT_ERR_FAILURE;
|
||
|
|
}
|
||
|
|
|
||
|
|
td_u32 offset;
|
||
|
|
upg_std_extra_item item_head = { 0 };
|
||
|
|
td_u8 item_id;
|
||
|
|
td_u16 item_size;
|
||
|
|
|
||
|
|
for (offset = 0; offset < data_size;) {
|
||
|
|
if (memcpy_s(&item_head, sizeof(item_head), &data[offset], sizeof(upg_std_extra_item)) != EOK) {
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (item_head.id == TRANS_FILE_CTRL_ID_END) {
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (item_head.id == TRANS_FILE_CTRL_ID_ALIGN) {
|
||
|
|
offset += 1;
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
|
||
|
|
item_id = item_head.id;
|
||
|
|
item_size = item_head.size;
|
||
|
|
|
||
|
|
if (item_id >= 0xC0 && item_id <= 0xEE) {
|
||
|
|
item_size = item_head.size * 2; /* id between 0xC0 and 0xEE, size bitwidth = 2. */
|
||
|
|
}
|
||
|
|
|
||
|
|
if (item_id == id) {
|
||
|
|
*size = item_size;
|
||
|
|
*extra_item = (data + offset + sizeof(upg_std_extra_item));
|
||
|
|
return EXT_ERR_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
offset += (td_u32)sizeof(upg_std_extra_item);
|
||
|
|
offset += item_size;
|
||
|
|
}
|
||
|
|
|
||
|
|
return EXT_ERR_FAILURE;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef __cplusplus
|
||
|
|
}
|
||
|
|
#endif
|