#include "inflash.h"
#include "stm32l4xx_hal.h"
#include "pdebug.h"
#include "assertions.h"

/*
 * 无锡电声换能器参数
 * 10
 * 35
 * 65
 * 无锡电声换能器参数
 */
/* 默认参数 */
config_info g_stConfigInfo={
    .flag_head              = FLAG_SAVE_INFLASH_HEAD,
    .addr                   = 0x30,                         /* 默认地址              */
    .uart_baud              = 9600,                         /* 默认波特率            */
    .speed_average_time     = 600,                          /* 平均风速默认10分钟更新 */
    .temp_hum_update_time   = 600,                          /* 温湿度更新时间        */
    
//    .transducer_cfg_1R5     = 15,                           /* 大宇换能器参数        */
//    .transducer_cfg_4R5     = 45,                           /* 大宇换能器参数        */
//    .transducer_cfg_8R0     = 80,                           /* 大宇换能器参数        */
    .transducer_cfg_1R5     = 10,                           /* 无锡电声换能器参数        */
    .transducer_cfg_4R5     = 35,                           /* 无锡电声换能器参数        */
    .transducer_cfg_8R0     = 65,                           /* 无锡电声换能器参数        */
    .RSSI_range             = 20,                           /* RSSI大于0.2有效      */
    
    .linear_point_1_x       = 0,                            /* 线性插值点1 */
    .linear_point_1_y       = 0,                            /* 线性插值点1 */
    .linear_point_2_x       = 0,                            /* 线性插值点2 */
    .linear_point_2_y       = 0,                            /* 线性插值点2 */
    .linear_point_3_x       = 0,                            /* 线性插值点3 */
    .linear_point_3_y       = 0,                            /* 线性插值点3 */
    .linear_point_4_x       = 0,                            /* 线性插值点4 */
    .linear_point_4_y       = 0,                            /* 线性插值点4 */
    .linear_point_5_x       = 0,                            /* 线性插值点5 */
    .linear_point_5_y       = 0,                            /* 线性插值点5 */
    .linear_enable          = 0,                            /* 线性插值使能 */
    .flag_end             = FLAG_SAVE_INFLASH_END,
};

/**
  * @brief 擦除多页flash 
  * @param  
  * @retval 
  */
void InFlash_Erase_Pages(u_int16_t PageBeginNum, u_int16_t NbPages)
{  	
  
    FLASH_EraseInitTypeDef EraseInitStruct;
    u_int32_t PAGEError = 0;

    EraseInitStruct.Banks       = FLASH_BANK_2;
    EraseInitStruct.TypeErase   = FLASH_TYPEERASE_PAGES;
    EraseInitStruct.Page        = PageBeginNum;
    EraseInitStruct.NbPages     = NbPages;
    
   if (HAL_FLASHEx_Erase(&EraseInitStruct, &PAGEError) != HAL_OK)  
	 {
		  log_error("inflash erase error!");
	 }
}

/**
  * @brief  写数据
  * @param  
  * @retval 
  */
void InFlash_Write(u_int32_t addr, u_int64_t *pBuffer,u_int32_t  NumToWrite)
{
      int i = 0;
      while( i < NumToWrite){
        if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, addr, pBuffer[i]) != HAL_OK){
//		        log_error("inflash write error!");
            return;
        }else{
            addr += 8;
            i++;
        }
      }
}
 
 /**
  * @brief  存入配置信息
  * @param  
  * @retval 
  */
void save_config_info(config_info save_config_info)
{
      HAL_FLASH_Unlock();
      InFlash_Write(STM32_INFLASH_SAVE_ADDR_BEGIN, (u_int64_t*)&save_config_info, (sizeof(save_config_info)+7)/8);
      InFlash_Erase_Pages(STM32_INFLASH_SAVE_PAGE, 1);
      InFlash_Write(STM32_INFLASH_SAVE_ADDR_BEGIN, (u_int64_t*)&save_config_info, (sizeof(save_config_info)+7)/8);
      HAL_FLASH_Lock();
}

 /**
  * @brief  读取配置信息
  * @param  
  * @retval 
  */
BOOL read_config_info()
{    
     config_info temp_config_info={0x00};
     
     memcpy((u_int8_t*)&temp_config_info,(u_int8_t*) STM32_INFLASH_SAVE_ADDR_BEGIN, sizeof(config_info));
//     term_printf("%d", temp_config_info.addr);
     if((temp_config_info.flag_head == FLAG_SAVE_INFLASH_HEAD) && (temp_config_info.flag_end == FLAG_SAVE_INFLASH_END)){
        memcpy((u_int8_t*)&g_stConfigInfo, (u_int8_t*)&temp_config_info, sizeof(config_info));
//        term_printf("Addr:%d, speed_average_time:%dmin\r\n", g_stConfigInfo.addr, g_stConfigInfo.speed_average_time);
        return TRUE;
     }
     
//     term_printf("!get config info from inflash error,use default parameter.\r\n");
//      term_printf("Addr:%d, speed_average_time:%dmin\r\n", g_stConfigInfo.addr, g_stConfigInfo.speed_average_time);
     return FALSE;
}

 /**
  * @brief  删除配置信息
  * @param  
  * @retval 
  */
void delete_config_info()
{
      config_info delete_config_info = {0};
      HAL_FLASH_Unlock();
      InFlash_Write(STM32_INFLASH_SAVE_ADDR_BEGIN, (u_int64_t*)&delete_config_info, (sizeof(delete_config_info)+7)/8);
      InFlash_Erase_Pages(STM32_INFLASH_SAVE_PAGE, 1);
      InFlash_Write(STM32_INFLASH_SAVE_ADDR_BEGIN, (u_int64_t*)&delete_config_info, (sizeof(delete_config_info)+7)/8);
      HAL_FLASH_Lock();
}



#if 0
 /**
  * @brief  测试
  * @param  
  * @retval 
  */
u_int8_t buff[100]={0x00};
void TEST_config_info()
{
  g_stConfigInfo.x_angle_adjust = 2;
  g_stConfigInfo.y_angle_adjust =3;
  save_config_info(g_stConfigInfo);
  memcpy(buff,(u_int8_t*) STM32_INFLASH_SAVE_ADDR_BEGIN, sizeof(g_stConfigInfo));
     
}
#endif