#include "includes.h"
#include "boot.h"
#include "asm/sfc_norflash_api.h"
#include "cfg_private.h"
/* #include "sdfile.h" */

#define CFG_PRIVATE_FILE_NUM   5
SDFILE_FILE_HEAD head = {0};
static u8 cfg_private_create_flag = 0;
static u32 cfg_private_create_sclust = 0;


static FILE *cfg_private_create(const char *path, const char *mode)
{
    int i = 0;
    char *str = NULL;
    char *part_path = NULL;
    char *buf_temp = NULL;
    int file_head_len = 0;
    int align_size = 4096;
    if (boot_info.vm.align == 1) {
        align_size = 256;
    }

    str = strrchr(path, '/');
    /* r_printf(">>>[test]:file name str = %s\n", str + 1); */
    part_path = (char *)zalloc(strlen(path));
    memcpy(part_path, path, strlen(path) - strlen(str));
    /* r_printf(">>>[test]:part_path = %s\n", part_path); */
    FILE *file = fopen(part_path, "r");
    if (!file) {
        r_printf(">>>[test]:no apply part!!!!!!!\n");
        goto __exit;
    }
    struct vfs_attr attrs = {0};
    fget_attrs(file, &attrs);
    attrs.sclust = sdfile_cpu_addr2flash_addr(attrs.sclust);
    if (attrs.sclust % align_size) {
        fclose(file);
        file = NULL;
        r_printf(">>>[test]:part start addr is not alignment, sclust = %d, align_size = %d\n", attrs.sclust, align_size);
        goto __exit;
    }
    cfg_private_create_sclust = attrs.sclust;
    buf_temp = (char *)malloc(align_size);
    norflash_read(NULL, (void *)buf_temp, align_size, attrs.sclust);
    for (; i < CFG_PRIVATE_FILE_NUM; i++) {
        int addr = attrs.sclust + i * sizeof(SDFILE_FILE_HEAD);
        norflash_read(NULL, (void *)&head, sizeof(SDFILE_FILE_HEAD), addr);
        if (CRC16((u8 *)&head + 2, sizeof(SDFILE_FILE_HEAD) - 2) == head.head_crc) {
            file_head_len += head.len;
            continue;
        }
        memset(&head, 0, sizeof(SDFILE_FILE_HEAD));
        head.len = attrs.fsize - CFG_PRIVATE_FILE_NUM * sizeof(SDFILE_FILE_HEAD) - file_head_len;
        /* y_printf(">>>[test]:file len = %d\n", head.len); */
        head.addr = attrs.sclust + CFG_PRIVATE_FILE_NUM * sizeof(SDFILE_FILE_HEAD) + file_head_len;
        head.addr = sdfile_flash_addr2cpu_addr(head.addr);
        /* y_printf(">>>[test]:file addr = %d\n", head.addr); */
        memcpy(head.name, (char *)(str + 1), strlen(str + 1));
        head.attr = 0x02;
        head.head_crc = CRC16((u8 *)&head + 2, sizeof(SDFILE_FILE_HEAD) - 2);
        break;
    }
    if (i >= CFG_PRIVATE_FILE_NUM) {
        fclose(file);
        file = NULL;
        r_printf(">>>[test]:file head is over\n");
        goto __exit;
    }
    cfg_private_erase(attrs.sclust, align_size);
    memcpy(buf_temp + i * sizeof(SDFILE_FILE_HEAD), &head, sizeof(SDFILE_FILE_HEAD));
    norflash_write(NULL, (void *)buf_temp, align_size, attrs.sclust);
    /* put_buf(buf_temp, align_size); */
    fclose(file);
    file = NULL;
    file = fopen(path, mode);

__exit:
    if (part_path) {
        free(part_path);
    }
    if (buf_temp) {
        free(buf_temp);
    }
    return file;
}

FILE *cfg_private_open(const char *path, const char *mode)
{
    int res;
    FILE *file = fopen(path, mode);
    if (!file) {
        if (mode[0] == 'w' && mode[1] == '+') {
            file = cfg_private_create(path, mode);
            if (file) {
                cfg_private_create_flag = 1;
            }
        }
    }
    return file;
}

int cfg_private_read(FILE *file, void *buf, u32 len)
{
    return fread(file, buf, len);
}

void cfg_private_erase(u32 addr, u32 len)
{
    /* r_printf(">>>[test]:addr = 0x%x, len = %d\n", addr, len); */
    u32 erase_total_size = len;
    u32 erase_addr = addr;
    u32 erase_size = 4096;
    u32 erase_cmd = IOCTL_ERASE_SECTOR;
    //flash不同支持的最小擦除单位不同(page/sector)
    //boot_info.vm.align == 1: 最小擦除单位page;
    //boot_info.vm.align != 1: 最小擦除单位sector;
    if (boot_info.vm.align == 1) {
        erase_size = 256;
        erase_cmd = IOCTL_ERASE_PAGE;
    }
    while (erase_total_size) {
        //擦除区域操作
        norflash_ioctl(NULL, erase_cmd, erase_addr);
        erase_addr += erase_size;
        erase_total_size -= erase_size;
    }
}

int cfg_private_check(char *buf, int len)
{
    for (int i = 0; i < len; i++) {
        if (buf[i] != 0xff) {
            return 0;
        }
    }
    return 1;
}

int cfg_private_write(FILE *file, void *buf, u32 len)
{
    int align_size = 4096;
    if (boot_info.vm.align == 1) {
        align_size = 256;
    }
    struct vfs_attr attrs = {0};
    fget_attrs(file, &attrs);
    /* r_printf(">>>[test]:attrs.sclust = 0x%x\n", attrs.sclust); */
    attrs.sclust = sdfile_cpu_addr2flash_addr(attrs.sclust);
    u32 fptr = fpos(file);
    /* r_printf(">>>[test]:addr = %d, fsize = %d, fptr = %d, w_len = %d\n", attrs.sclust, attrs.fsize, fptr, len); */
    if (len + fptr > attrs.fsize) {
        r_printf(">>>[test]:error, write over!!!!!!!!\n");
        return -1;
    }
    char *buf_temp = (char *)malloc(align_size);
    int res = len;

    for (int wlen = 0; len > 0;) {
        u32 align_addr = (attrs.sclust + fptr) / align_size * align_size;
        u32 w_pos = attrs.sclust + fptr - align_addr;
        wlen = align_size - w_pos;
        /* y_printf(">>>[test]:wpos = %d, wlen = %d\n", w_pos, wlen); */
        if (wlen > len) {
            wlen = len;
        }
        norflash_read(NULL, (void *)buf_temp, align_size, align_addr);
        if (0 == cfg_private_check(buf_temp, align_size)) {
            cfg_private_erase(align_addr, align_size);
        }
        memcpy(buf_temp + w_pos, buf, wlen);
        /* put_buf(buf_temp, align_size); */
        norflash_write(NULL, (void *)buf_temp, align_size, align_addr);
        fptr += wlen;
        len -= wlen;
    }
__exit:
    free(buf_temp);
    fseek(file, fptr, SEEK_SET);
    return res;
}

int cfg_private_delete_file(FILE *file)
{
    int align_size = 4096;
    if (boot_info.vm.align == 1) {
        align_size = 256;
    }
    struct vfs_attr attrs = {0};
    fget_attrs(file, &attrs);
    attrs.sclust = sdfile_cpu_addr2flash_addr(attrs.sclust);
    int len = attrs.fsize;
    char *buf_temp = (char *)malloc(align_size);
    u32 fptr = 0;

    for (int wlen = 0; len > 0;) {
        u32 align_addr = (attrs.sclust + fptr) / align_size * align_size;
        u32 w_pos = attrs.sclust + fptr - align_addr;
        wlen = align_size - w_pos;
        if (wlen > len) {
            wlen = len;
        }
        norflash_read(NULL, (void *)buf_temp, align_size, align_addr);
        if (0 == cfg_private_check(buf_temp, align_size)) {
            cfg_private_erase(align_addr, align_size);
        }
        memset(buf_temp + w_pos, 0xff, wlen);
        norflash_write(NULL, (void *)buf_temp, align_size, align_addr);
        fptr += wlen;
        len -= wlen;
    }
    free(buf_temp);
    fclose(file);
    return 0;
}

int cfg_private_close(FILE *file)
{
    if (cfg_private_create_flag) {
        int i = 0;
        int align_size = 4096;
        if (boot_info.vm.align == 1) {
            align_size = 256;
        }
        char name[SDFILE_NAME_LEN];
        fget_name(file, name, SDFILE_NAME_LEN);
        char *buf_temp = (char *)malloc(align_size);
        norflash_read(NULL, (void *)buf_temp, align_size, cfg_private_create_sclust);
        for (; i < CFG_PRIVATE_FILE_NUM; i++) {
            int addr = cfg_private_create_sclust + i * sizeof(SDFILE_FILE_HEAD);
            norflash_read(NULL, (void *)&head, sizeof(SDFILE_FILE_HEAD), addr);
            if (CRC16((u8 *)&head + 2, sizeof(SDFILE_FILE_HEAD) - 2) != head.head_crc) {
                continue;
            }
            if (0 == memcmp(head.name, name, SDFILE_NAME_LEN)) {
                head.len = fpos(file);
                y_printf(">>>[test]:real file len = %d\n", head.len);
                head.head_crc = CRC16((u8 *)&head + 2, sizeof(SDFILE_FILE_HEAD) - 2);
                break;
            }
        }
        cfg_private_create_flag = 0;
        if (i < CFG_PRIVATE_FILE_NUM) {
            cfg_private_erase(cfg_private_create_sclust, align_size);
            memcpy(buf_temp + i * sizeof(SDFILE_FILE_HEAD), &head, sizeof(SDFILE_FILE_HEAD));
            norflash_write(NULL, (void *)buf_temp, align_size, cfg_private_create_sclust);
        }
        if (buf_temp) {
            free(buf_temp);
        }
    }
    return fclose(file);
}

int cfg_private_seek(FILE *file, int offset, int fromwhere)
{
    return fseek(file, offset, fromwhere);
}

void cfg_private_test_demo(void)
{
#if 0
#define N 256
    char test_buf[N] = {0};
    char r_buf[512] = {0};
    for (int i = 0; i < N; i++) {
        test_buf[i] = i & 0xff;
    }

    char path[64] = "mnt/sdfile/app/FATFSI/eq_cfg_hw.bin";
    char path2[64] = "mnt/sdfile/app/FATFSI/cfg_tool.bin";
    y_printf("\n >>>[test]:func = %s,line= %d\n", __FUNCTION__, __LINE__);
    FILE *fp = cfg_private_open(path, "w+");
    if (!fp) {
        r_printf(">>>[test]:open fail!!!!!\n");
        while (1);
    }
    /* cfg_private_delete_file(fp); */
    /* fp = cfg_private_open(path, "w+"); */
    /* cfg_private_read(fp, r_buf, 512); */
    /* put_buf(r_buf, 512); */
    /* cfg_private_seek(fp, 0, SEEK_SET); */

    cfg_private_write(fp, test_buf, N);

    cfg_private_close(fp);
    fp = cfg_private_open(path, "r");
    cfg_private_read(fp, r_buf, 512);
    put_buf(r_buf, 512);
    fclose(fp);
    y_printf("\n >>>[test]:func = %s,line= %d\n", __FUNCTION__, __LINE__);

    fp = cfg_private_open(path2, "w+");
    if (!fp) {
        r_printf(">>>[test]:open fail!!!!!\n");
        while (1);
    }
    for (int i = 0; i < N; i++) {
        test_buf[i] = (N - 1 - i) & 0xff;
    }
    cfg_private_write(fp, test_buf, N);
    cfg_private_close(fp);
    fp = cfg_private_open(path2, "r");
    cfg_private_read(fp, r_buf, 512);
    put_buf(r_buf, 512);
    fclose(fp);

#if 0
    FILE *file = cfg_private_open("mnt/sdfile/app/FATFSI", "w+");
    if (!file) {
        r_printf(">>>[test]:open fail!!!!!\n");
        while (1);
    }
    struct vfs_attr attrs = {0};
    fget_attrs(file, &attrs);
    y_printf(">>>[test]:in part addr = %d, fsize = %d\n", attrs.sclust, attrs.fsize);
    char *part = zalloc(attrs.fsize);
    cfg_private_delete_file(file);
    file = cfg_private_open("mnt/sdfile/app/FATFSI", "w+");
    cfg_private_read(file, part, attrs.fsize);
    put_buf(part, attrs.fsize);
    free(part);
#endif
    while (1);
#endif
}