pinebuds/services/nv_section/aud_section/aud_section.c

216 lines
6.8 KiB
C

/***************************************************************************
*
* Copyright 2015-2019 BES.
* All rights reserved. All unpublished rights reserved.
*
* No part of this work may be used or reproduced in any form or by any
* means, or stored in a database or retrieval system, without prior written
* permission of BES.
*
* Use of this work is governed by a license granted by BES.
* This work contains confidential and proprietary information of
* BES. which is protected by copyright, trade secret,
* trademark and other intellectual property rights.
*
****************************************************************************/
#include <stdio.h>
#include "hal_trace.h"
#include "aud_section.h"
#include "crc32.h"
#include "tgt_hardware.h"
#include "string.h"
#include "hal_norflash.h"
#include "cmsis.h"
#ifdef __ARMCC_VERSION
#include "link_sym_armclang.h"
#endif
extern uint32_t __aud_start[];
#ifndef ANC_COEF_LIST_NUM
#define ANC_COEF_LIST_NUM 0
#endif
#define MAGIC_NUMBER 0xBE57
#define USERDATA_VERSION 0x0001
static uint32_t section_device_length[AUDIO_SECTION_DEVICE_NUM] = {
AUDIO_SECTION_LENGTH_ANC,
AUDIO_SECTION_LENGTH_AUDIO,
AUDIO_SECTION_LENGTH_SPEECH,
};
static uint32_t audio_section_get_device_addr_offset(uint32_t device)
{
ASSERT(device < AUDIO_SECTION_DEVICE_NUM, "[%s] device(%d) >= AUDIO_SECTION_DEVICE_NUM", __func__, device);
uint32_t addr_offset = 0;
for (uint32_t i=0; i<device; i++)
{
addr_offset += section_device_length[i];
}
return addr_offset;
}
static audio_section_t *audio_section_get_device_ptr(uint32_t device)
{
uint8_t *section_ptr = (uint8_t *)__aud_start;
section_ptr += audio_section_get_device_addr_offset(device);
return (audio_section_t *)section_ptr;
}
int audio_section_store_cfg(uint32_t device, uint8_t *cfg, uint32_t len)
{
audio_section_t *section_ptr = (audio_section_t *)cfg;
uint32_t addr_start = 0;
uint32_t crc = 0;
section_ptr->head.magic = MAGIC_NUMBER;
section_ptr->head.version = USERDATA_VERSION;
section_ptr->device = device;
section_ptr->cfg_len = len;
// calculate crc
crc = crc32(0, (unsigned char *)section_ptr + AUDIO_SECTION_CFG_RESERVED_LEN, len - AUDIO_SECTION_CFG_RESERVED_LEN);
section_ptr->head.crc = crc;
addr_start = (uint32_t)__aud_start + audio_section_get_device_addr_offset(device);
#ifdef AUDIO_SECTION_DEBUG
TRACE(2,"[%s] len = %d", __func__, len);
TRACE(2,"[%s] addr_start = 0x%x", __func__, addr_start);
TRACE(2,"[%s] block length = 0x%x", __func__, section_device_length[device]);
#endif
// FIXME: CHECK return value
enum HAL_NORFLASH_RET_T flash_opt_res;
uint32_t flag = int_lock();
flash_opt_res = hal_norflash_erase(HAL_NORFLASH_ID_0, addr_start, section_device_length[device]);
int_unlock(flag);
if (flash_opt_res)
{
TRACE(2,"[%s] ERROR: erase flash res = %d", __func__, flash_opt_res);
return flash_opt_res;
}
flag = int_lock();
flash_opt_res = hal_norflash_write(HAL_NORFLASH_ID_0, addr_start, (uint8_t *)section_ptr, len);
int_unlock(flag);
if (flash_opt_res)
{
TRACE(2,"[%s] ERROR: write flash res = %d", __func__, flash_opt_res);
return flash_opt_res;
}
#ifdef AUDIO_SECTION_DEBUG
TRACE(1,"********************[%s]********************", __func__);
TRACE(1,"magic: 0x%x", section_ptr->head.magic);
TRACE(1,"version: 0x%x", section_ptr->head.version);
TRACE(1,"crc: 0x%x", section_ptr->head.crc);
TRACE(1,"device: %d", section_ptr->device);
TRACE(1,"cfg_len: %d", section_ptr->cfg_len);
TRACE(0,"********************END********************");
#endif
// audio_section_t *section_read_ptr = audio_section_get_device_ptr(device);
// check
return 0;
}
int audio_section_load_cfg(uint32_t device, uint8_t *cfg, uint32_t len)
{
audio_section_t *section_ptr = audio_section_get_device_ptr(device);
uint32_t crc = 0;
#ifdef AUDIO_SECTION_DEBUG
TRACE(1,"********************[%s]********************", __func__);
TRACE(1,"magic: 0x%x", section_ptr->head.magic);
TRACE(1,"version: 0x%x", section_ptr->head.version);
TRACE(1,"crc: 0x%x", section_ptr->head.crc);
TRACE(1,"device: %d", section_ptr->device);
TRACE(1,"cfg_len: %d", section_ptr->cfg_len);
TRACE(0,"********************END********************");
#endif
if(section_ptr->head.magic != MAGIC_NUMBER)
{
TRACE(3,"[%s] WARNING: Different magic number (%x != %x)", __func__, section_ptr->head.magic, MAGIC_NUMBER);
return -1;
}
// Calculate crc and check crc value
crc = crc32(0, (unsigned char *)section_ptr + AUDIO_SECTION_CFG_RESERVED_LEN, len - AUDIO_SECTION_CFG_RESERVED_LEN);
if(section_ptr->head.crc != crc)
{
TRACE(3,"[%s] WARNING: Different crc (%x != %x)", __func__, section_ptr->head.crc, crc);
return -2;
}
if(section_ptr->device != device)
{
TRACE(3,"[%s] WARNING: Different device (%d != %d)", __func__, section_ptr->device, device);
return -3;
}
if(section_ptr->cfg_len != len)
{
TRACE(3,"[%s] WARNING: Different length (%d != %d)", __func__, section_ptr->cfg_len, len);
return -4;
}
memcpy(cfg, section_ptr, len);
return 0;
}
int anccfg_loadfrom_audsec(const struct_anc_cfg *list[], const struct_anc_cfg *list_44p1k[], uint32_t count)
{
#ifdef PROGRAMMER
return 1;
#else // !PROGRAMMER
#ifdef CHIP_BEST1000
ASSERT(0, "[%s] Can not support anc load in this branch!!!", __func__);
#else
unsigned int re_calc_crc,i;
const pctool_aud_section *audsec_ptr;
audsec_ptr = (pctool_aud_section *)__aud_start;
TRACE(3,"0x%x,0x%x,0x%x",audsec_ptr->sec_head.magic,audsec_ptr->sec_head.version,audsec_ptr->sec_head.crc);
if (audsec_ptr->sec_head.magic != aud_section_magic) {
TRACE(0,"Invalid aud section - magic");
return 1;
}
re_calc_crc = crc32(0,(unsigned char *)&(audsec_ptr->sec_body),sizeof(audsec_body)-4);
if (re_calc_crc != audsec_ptr->sec_head.crc){
TRACE(0,"crc verify failure, invalid aud section.");
return 1;
}
TRACE(0,"Valid aud section.");
for(i=0;i<ANC_COEF_LIST_NUM;i++)
list[i] = (struct_anc_cfg *)&(audsec_ptr->sec_body.anc_config.anc_config_arr[i].anc_cfg[PCTOOL_SAMPLERATE_48X8K]);
#if (AUD_SECTION_STRUCT_VERSION == 3)
for(i=0;i<ANC_COEF_LIST_NUM;i++)
list_44p1k[i] = (struct_anc_cfg *)&(audsec_ptr->sec_body.anc_config.anc_config_arr[i].anc_cfg[PCTOOL_SAMPLERATE_48X8K]);
#else
for(i=0;i<ANC_COEF_LIST_NUM;i++)
list_44p1k[i] = (struct_anc_cfg *)&(audsec_ptr->sec_body.anc_config.anc_config_arr[i].anc_cfg[PCTOOL_SAMPLERATE_44_1X8K]);
#endif
#endif
return 0;
#endif // !PROGRAMMER
}