/**
  ******************************************************************************
  * @file    partition.c
  * @version V1.0
  * @date
  * @brief   This file is the standard driver c file
  ******************************************************************************
  * @attention
  *
  * <h2><center>&copy; COPYRIGHT(c) 2019 Bouffalo Lab</center></h2>
  *
  * Redistribution and use in source and binary forms, with or without modification,
  * are permitted provided that the following conditions are met:
  *   1. Redistributions 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 Bouffalo Lab nor the names of its contributors
  *      may be used to endorse or promote products derived from this software
  *      without specific prior written permission.
  *
  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER 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.
  *
  ******************************************************************************
  */

#include "partition.h"
#include "softcrc.h"
#include "bflb_platform.h"

/** @addtogroup  BFLB_Common_Driver
 *  @{
 */

/** @addtogroup  PARTITION
 *  @{
 */

/** @defgroup  PARTITION_Private_Macros
 *  @{
 */

/*@} end of group PARTITION_Private_Macros */

/** @defgroup  PARTITION_Private_Types
 *  @{
 */

/*@} end of group PARTITION_Private_Types */

/** @defgroup  PARTITION_Private_Variables
 *  @{
 */
p_pt_table_flash_erase gp_pt_table_flash_erase = NULL;
p_pt_table_flash_write gp_pt_table_flash_write = NULL;
p_pt_table_flash_read gp_pt_table_flash_read = NULL;
pt_table_iap_param_type p_iap_param;

/*@} end of group PARTITION_Private_Variables */

/** @defgroup  PARTITION_Global_Variables
 *  @{
 */
extern int main(void);

/*@} end of group PARTITION_Global_Variables */

/** @defgroup  PARTITION_Private_Fun_Declaration
 *  @{
 */

/*@} end of group PARTITION_Private_Fun_Declaration */

/** @defgroup  PARTITION_Private_Functions
 *  @{
 */

/****************************************************************************/ /**
 * @brief  Judge partition table valid
 *
 * @param  ptStuff: Partition table stuff pointer
 *
 * @return 0 for invalid and 1 for valid
 *
*******************************************************************************/
static uint8_t pt_table_valid(pt_table_stuff_config *pt_stuff)
{
    pt_table_config *pt_table = &pt_stuff->pt_table;
    pt_table_entry_config *pt_entries = pt_stuff->pt_entries;
    uint32_t *p_crc32;
    uint32_t entriesLen = sizeof(pt_table_entry_config) * pt_table->entryCnt;

    if (pt_table->magicCode == BFLB_PT_MAGIC_CODE) {
        if (pt_table->entryCnt > PT_ENTRY_MAX) {
            MSG("PT Entry Count Error\r\n");
            return 0;
        }

        if (pt_table->crc32 !=
            BFLB_Soft_CRC32((uint8_t *)pt_table, sizeof(pt_table_config) - 4)) {
            MSG("PT CRC Error\r\n");
            return 0;
        }

        p_crc32 = (uint32_t *)((uintptr_t)pt_entries + entriesLen);

        if (*p_crc32 != BFLB_Soft_CRC32((uint8_t *)pt_entries, entriesLen)) {
            MSG("PT Entry CRC Error\r\n");
            return 0;
        }

        return 1;
    }

    return 0;
}

/*@} end of group PARTITION_Private_Functions */

/** @defgroup  PARTITION_Public_Functions
 *  @{
 */

/****************************************************************************/ /**
 * @brief  Register partition flash read write erase fucntion
 *
 * @param  erase: Flash erase function
 * @param  write: Flash write function
 * @param  read: Flash read function
 *
 * @return None
 *
*******************************************************************************/
void pt_table_set_flash_operation(p_pt_table_flash_erase erase, p_pt_table_flash_write write, p_pt_table_flash_read read)
{
    gp_pt_table_flash_erase = erase;
    gp_pt_table_flash_write = write;
    gp_pt_table_flash_read = read;
}

/****************************************************************************/ /**
 * @brief  Get active partition table whole stuff
 *
 * @param  ptStuff[2]: Partition table stuff pointer
 *
 * @return Active partition table ID
 *
*******************************************************************************/
pt_table_id_type pt_table_get_active_partition_need_lock(pt_table_stuff_config ptStuff[2])
{
    uint32_t pt_valid[2] = { 0, 0 };
    pt_table_id_type activePtID;

    if (ptStuff == NULL) {
        return PT_TABLE_ID_INVALID;
    }

    activePtID = PT_TABLE_ID_INVALID;

    gp_pt_table_flash_read(BFLB_PT_TABLE0_ADDRESS, (uint8_t *)&ptStuff[0], sizeof(pt_table_stuff_config));
    pt_valid[0] = pt_table_valid(&ptStuff[0]);

    gp_pt_table_flash_read(BFLB_PT_TABLE1_ADDRESS, (uint8_t *)&ptStuff[1], sizeof(pt_table_stuff_config));
    pt_valid[1] = pt_table_valid(&ptStuff[1]);

    if (pt_valid[0] == 1 && pt_valid[1] == 1) {
        if (ptStuff[0].pt_table.age >= ptStuff[1].pt_table.age) {
            activePtID = PT_TABLE_ID_0;
        } else {
            activePtID = PT_TABLE_ID_1;
        }
    } else if (pt_valid[0] == 1) {
        activePtID = PT_TABLE_ID_0;
    } else if (pt_valid[1] == 1) {
        activePtID = PT_TABLE_ID_1;
    }

    return activePtID;
}

/****************************************************************************/ /**
 * @brief  Get partition entry according to entry ID
 *
 * @param  ptStuff: Partition table stuff pointer
 * @param  type: Type of partition entry
 * @param  ptEntry: Partition entry pointer to store read data
 *
 * @return PT_ERROR_SUCCESS or PT_ERROR_ENTRY_NOT_FOUND or PT_ERROR_PARAMETER
 *
*******************************************************************************/
pt_table_error_type pt_table_get_active_entries_by_id(pt_table_stuff_config *pt_stuff,
                                                      pt_table_entry_type type,
                                                      pt_table_entry_config *pt_entry)
{
    uint32_t i = 0;

    if (pt_stuff == NULL || pt_entry == NULL) {
        return PT_ERROR_PARAMETER;
    }

    for (i = 0; i < pt_stuff->pt_table.entryCnt; i++) {
        if (pt_stuff->pt_entries[i].type == type) {
            ARCH_MemCpy_Fast(pt_entry, &pt_stuff->pt_entries[i], sizeof(pt_table_entry_config));
            return PT_ERROR_SUCCESS;
        }
    }

    return PT_ERROR_ENTRY_NOT_FOUND;
}

/****************************************************************************/ /**
 * @brief  Get partition entry according to entry name
 *
 * @param  ptStuff: Partition table stuff pointer
 * @param  name: Name of partition entry
 * @param  ptEntry: Partition entry pointer to store read data
 *
 * @return PT_ERROR_SUCCESS or PT_ERROR_ENTRY_NOT_FOUND or PT_ERROR_PARAMETER
 *
*******************************************************************************/
pt_table_error_type pt_table_get_active_entries_by_name(pt_table_stuff_config *pt_stuff,
                                                        uint8_t *name,
                                                        pt_table_entry_config *pt_entry)
{
    uint32_t i = 0;
    uint32_t len = strlen((char *)name);

    if (pt_stuff == NULL || pt_entry == NULL) {
        return PT_ERROR_PARAMETER;
    }

    for (i = 0; i < pt_stuff->pt_table.entryCnt; i++) {
        if (strlen((char *)pt_stuff->pt_entries[i].name) == len &&
            memcmp((char *)pt_stuff->pt_entries[i].name, (char *)name, len) == 0) {
            ARCH_MemCpy_Fast(pt_entry, &pt_stuff->pt_entries[i], sizeof(pt_table_entry_config));
            return PT_ERROR_SUCCESS;
        }
    }

    return PT_ERROR_ENTRY_NOT_FOUND;
}

/****************************************************************************/ /**
 * @brief  Update partition entry
 *
 * @param  targetTableID: Target partition table to update
 * @param  ptStuff: Partition table stuff pointer
 * @param  ptEntry: Partition entry pointer to update
 *
 * @return Partition update result
 *
*******************************************************************************/
pt_table_error_type pt_table_update_entry(pt_table_id_type target_table_id,
                                          pt_table_stuff_config *pt_stuff,
                                          pt_table_entry_config *pt_entry)
{
    uint32_t i = 0;
    BL_Err_Type ret;
    uint32_t write_addr;
    uint32_t entries_len;
    pt_table_config *pt_table;
    pt_table_entry_config *pt_entries;
    uint32_t *crc32;

    if (pt_entry == NULL || pt_stuff == NULL) {
        return PT_ERROR_PARAMETER;
    }

    pt_table = &pt_stuff->pt_table;
    pt_entries = pt_stuff->pt_entries;

    if (target_table_id == PT_TABLE_ID_INVALID) {
        return PT_ERROR_TABLE_NOT_VALID;
    }

    if (target_table_id == PT_TABLE_ID_0) {
        write_addr = BFLB_PT_TABLE0_ADDRESS;
    } else {
        write_addr = BFLB_PT_TABLE1_ADDRESS;
    }

    for (i = 0; i < pt_table->entryCnt; i++) {
        if (pt_entries[i].type == pt_entry->type) {
            ARCH_MemCpy_Fast(&pt_entries[i], pt_entry, sizeof(pt_table_entry_config));
            break;
        }
    }

    if (i == pt_table->entryCnt) {
        /* Not found this entry ,add new one */
        if (pt_table->entryCnt < PT_ENTRY_MAX) {
            ARCH_MemCpy_Fast(&pt_entries[pt_table->entryCnt], pt_entry, sizeof(pt_table_entry_config));
            pt_table->entryCnt++;
        } else {
            return PT_ERROR_ENTRY_UPDATE_FAIL;
        }
    }

    /* Prepare write back to flash */
    /* Update age */
    pt_table->age++;
    pt_table->crc32 = BFLB_Soft_CRC32((uint8_t *)pt_table, sizeof(pt_table_config) - 4);

    /* Update entries CRC */
    entries_len = pt_table->entryCnt * sizeof(pt_table_entry_config);
    crc32 = (uint32_t *)((uintptr_t)pt_entries + entries_len);
    *crc32 = BFLB_Soft_CRC32((uint8_t *)&pt_entries[0], entries_len);

    /* Write back to flash */
    /* Erase flash first */
    ret = gp_pt_table_flash_erase(write_addr, write_addr + sizeof(pt_table_config) + entries_len + 4 - 1);

    if (ret != SUCCESS) {
        MSG_ERR("Flash Erase error\r\n");
        return PT_ERROR_FALSH_WRITE;
    }

    /* Write flash */
    ret = gp_pt_table_flash_write(write_addr, (uint8_t *)pt_stuff, sizeof(pt_table_stuff_config));

    if (ret != SUCCESS) {
        MSG_ERR("Flash Write error\r\n");
        return PT_ERROR_FALSH_WRITE;
    }

    return PT_ERROR_SUCCESS;
}

/****************************************************************************/ /**
 * @brief  Create partition entry
 *
 * @param  ptID: Partition table ID
 *
 * @return Partition create result
 *
*******************************************************************************/
pt_table_error_type pt_table_create(pt_table_id_type pt_id)
{
    uint32_t write_addr;
    BL_Err_Type ret;
    pt_table_config pt_table;

    if (pt_id == PT_TABLE_ID_INVALID) {
        return PT_ERROR_TABLE_NOT_VALID;
    }

    if (pt_id == PT_TABLE_ID_0) {
        write_addr = BFLB_PT_TABLE0_ADDRESS;
    } else {
        write_addr = BFLB_PT_TABLE1_ADDRESS;
    }

    /* Prepare write back to flash */
    pt_table.magicCode = BFLB_PT_MAGIC_CODE;
    pt_table.version = 0;
    pt_table.entryCnt = 0;
    pt_table.age = 0;
    pt_table.crc32 = BFLB_Soft_CRC32((uint8_t *)&pt_table, sizeof(pt_table_config) - 4);
    /* Write back to flash */
    ret = gp_pt_table_flash_erase(write_addr, write_addr + sizeof(pt_table_config) - 1);

    if (ret != SUCCESS) {
        MSG_ERR("Flash Erase error\r\n");
        return PT_ERROR_FALSH_ERASE;
    }

    ret = gp_pt_table_flash_write(write_addr, (uint8_t *)&pt_table, sizeof(pt_table_config));

    if (ret != SUCCESS) {
        MSG_ERR("Flash Write error\r\n");
        return PT_ERROR_FALSH_WRITE;
    }

    return PT_ERROR_SUCCESS;
}

pt_table_error_type pt_table_dump(void)
{
    uint32_t pt_valid[2] = { 0, 0 };
    pt_table_stuff_config pt_stuff[2];

    gp_pt_table_flash_read(BFLB_PT_TABLE0_ADDRESS, (uint8_t *)&pt_stuff[0], sizeof(pt_table_stuff_config));
    pt_valid[0] = pt_table_valid(&pt_stuff[0]);

    gp_pt_table_flash_read(BFLB_PT_TABLE1_ADDRESS, (uint8_t *)&pt_stuff[1], sizeof(pt_table_stuff_config));
    pt_valid[1] = pt_table_valid(&pt_stuff[1]);

    if (pt_valid[0]) {
        MSG("PT TABLE0 valid\r\n");
    } else {
        MSG("PT TABLE0 invalid\r\n");
    }

    if (pt_valid[1]) {
        MSG("PT TABLE1 valid\r\n");
    } else {
        MSG("PT TABLE1 invalid\r\n");
    }

    for (int i = 0; i < 2; i++) {
        if (pt_valid[i] == 1) {
            MSG("ptStuff[%d].pt_table.magicCode 0x%08x\r\n", i, pt_stuff[i].pt_table.magicCode);
            MSG("ptStuff[%d].pt_table.version 0x%08x\r\n", i, pt_stuff[i].pt_table.version);
            MSG("ptStuff[%d].pt_table.entryCnt 0x%08x\r\n", i, pt_stuff[i].pt_table.entryCnt);
            MSG("ptStuff[%d].pt_table.age 0x%08x\r\n", i, pt_stuff[i].pt_table.age);
            MSG("ptStuff[%d].pt_table.crc32 0x%08x\r\n", i, pt_stuff[i].pt_table.crc32);

            for (int j = 0; j < pt_stuff[i].pt_table.entryCnt; j++) {
                MSG("ptStuff[%d].pt_entries[%d].type 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].type);
                MSG("ptStuff[%d].pt_entries[%d].device 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].device);
                MSG("ptStuff[%d].pt_entries[%d].active_index 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].active_index);
                MSG("ptStuff[%d].pt_entries[%d].Address[0] 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].start_address[0]);
                MSG("ptStuff[%d].pt_entries[%d].Address[1] 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].start_address[1]);
                MSG("ptStuff[%d].pt_entries[%d].maxLen[0] 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].max_len[0]);
                MSG("ptStuff[%d].pt_entries[%d].maxLen[1] 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].max_len[1]);
                MSG("ptStuff[%d].pt_entries[%d].len 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].len);
                MSG("ptStuff[%d].pt_entries[%d].age 0x%08x\r\n", i, j, pt_stuff[i].pt_entries[j].age);
            }
        }
    }

    return PT_ERROR_SUCCESS;
}

pt_table_error_type pt_table_get_iap_para(pt_table_iap_param_type *para)
{
    uint32_t pt_valid[2] = { 0, 0 };
    pt_table_stuff_config pt_stuff[2];
    uint8_t active_index;

    gp_pt_table_flash_read(BFLB_PT_TABLE0_ADDRESS, (uint8_t *)&pt_stuff[0], sizeof(pt_table_stuff_config));
    pt_valid[0] = pt_table_valid(&pt_stuff[0]);

    gp_pt_table_flash_read(BFLB_PT_TABLE1_ADDRESS, (uint8_t *)&pt_stuff[1], sizeof(pt_table_stuff_config));
    pt_valid[1] = pt_table_valid(&pt_stuff[1]);

    if ((pt_valid[0] == 1) && (pt_valid[1] == 1)) {
        if (pt_stuff[0].pt_table.age >= pt_stuff[1].pt_table.age) {
            active_index = pt_stuff[0].pt_entries[0].active_index;
            para->iap_write_addr = para->iap_start_addr = pt_stuff[0].pt_entries[0].start_address[!(active_index & 0x01)];
            para->inactive_index = !(active_index & 0x01);
            para->inactive_table_index = 1;

        } else {
            active_index = pt_stuff[1].pt_entries[0].active_index;
            para->iap_write_addr = para->iap_start_addr = pt_stuff[1].pt_entries[0].start_address[!(active_index & 0x01)];
            para->inactive_index = !(active_index & 0x01);
            para->inactive_table_index = 0;
        }

    } else if (pt_valid[1] == 1) {
        active_index = pt_stuff[1].pt_entries[0].active_index;
        para->iap_write_addr = para->iap_start_addr = pt_stuff[1].pt_entries[0].start_address[!(active_index & 0x01)];
        para->inactive_index = !(active_index & 0x01);
        para->inactive_table_index = 0;
    } else if (pt_valid[0] == 1) {
        active_index = pt_stuff[0].pt_entries[0].active_index;
        para->iap_write_addr = para->iap_start_addr = pt_stuff[0].pt_entries[0].start_address[!(active_index & 0x01)];
        para->inactive_index = !(active_index & 0x01);
        para->inactive_table_index = 1;
    } else {
        return PT_ERROR_TABLE_NOT_VALID;
    }

    MSG("inactive_table_index %d, inactive index %d , IAP start addr %08x \r\n", para->inactive_table_index, para->inactive_index, para->iap_start_addr);
    return PT_ERROR_SUCCESS;
}

pt_table_error_type pt_table_set_iap_para(pt_table_iap_param_type *para)
{
    pt_table_stuff_config pt_stuff, pt_stuff_write;
    int32_t ret;
    uint32_t *p_crc32;
    uint32_t entries_len;

    if (para->inactive_table_index == 1) {
        gp_pt_table_flash_read(BFLB_PT_TABLE0_ADDRESS, (uint8_t *)&pt_stuff, sizeof(pt_table_stuff_config));
    } else if (para->inactive_table_index == 0) {
        gp_pt_table_flash_read(BFLB_PT_TABLE1_ADDRESS, (uint8_t *)&pt_stuff, sizeof(pt_table_stuff_config));
    }

    ARCH_MemCpy_Fast((void *)&pt_stuff_write, (void *)&pt_stuff, sizeof(pt_table_stuff_config));
    pt_stuff_write.pt_table.age += 1;
    pt_stuff_write.pt_entries[0].active_index = !(pt_stuff_write.pt_entries[0].active_index & 0x01);
    pt_stuff_write.pt_table.crc32 = BFLB_Soft_CRC32((uint8_t *)&pt_stuff_write, sizeof(pt_table_config) - 4);
    entries_len = sizeof(pt_table_entry_config) * pt_stuff_write.pt_table.entryCnt;
    //pt_stuff_write.crc32 = BFLB_Soft_CRC32((uint8_t*)pt_stuff_write.pt_entries,entries_len);
    p_crc32 = (uint32_t *)((uintptr_t)pt_stuff_write.pt_entries + entries_len);
    *p_crc32 = BFLB_Soft_CRC32((uint8_t *)pt_stuff_write.pt_entries, entries_len);

    if (para->inactive_table_index == 1) {
        ret = gp_pt_table_flash_erase(BFLB_PT_TABLE1_ADDRESS, BFLB_PT_TABLE1_ADDRESS + sizeof(pt_table_stuff_config) - 1);

        if (ret != SUCCESS) {
            MSG_ERR("Flash Erase error\r\n");
            return PT_ERROR_FALSH_ERASE;
        }

        ret = gp_pt_table_flash_write(BFLB_PT_TABLE1_ADDRESS, (uint8_t *)&pt_stuff_write, sizeof(pt_table_stuff_config));

        if (ret != SUCCESS) {
            MSG_ERR("Flash Write error\r\n");
            return PT_ERROR_FALSH_WRITE;
        }
    } else if (para->inactive_table_index == 0) {
        ret = gp_pt_table_flash_erase(BFLB_PT_TABLE0_ADDRESS, BFLB_PT_TABLE0_ADDRESS + sizeof(pt_table_stuff_config) - 1);

        if (ret != SUCCESS) {
            MSG_ERR("Flash Erase error\r\n");
            return PT_ERROR_FALSH_ERASE;
        }

        ret = gp_pt_table_flash_write(BFLB_PT_TABLE0_ADDRESS, (uint8_t *)&pt_stuff_write, sizeof(pt_table_stuff_config));

        if (ret != SUCCESS) {
            MSG_ERR("Flash Write error\r\n");
            return PT_ERROR_FALSH_WRITE;
        }
    }

    MSG("Update pt_table suss\r\n");
    return PT_ERROR_SUCCESS;
}

/*@} end of group PARTITION_Public_Functions */

/*@} end of group PARTITION */

/*@} end of group BFLB_Common_Driver */