luban-lite-t3e-pro/bsp/artinchip/sys/g73x/boot_res_nand.c

/*
 * Copyright (C) 2023 ArtInChip Technology Co.,Ltd
 * Author: Dehuang Wu <dehuang.wu@artinchip.com>
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <aic_common.h>
#include <aic_image.h>
#include <boot_param.h>
#include <private_param.h>
#include <aic_log.h>
#include <aic_osal.h>

#define IMAGE_BACKUP_BLOCK_CNT 4
#define PAGE_CNT_PER_BLOCK     64
#define PAGE_TABLE_MAX_ENTRY   101
#define PAGE_DEFAULT_SIZE      2048
#define FSBL_CANDIDATE_BLK_CNT 18

#define SLICE_DEFAULT_SIZE        2048
#define PAGE_TABLE_USE_SIZE       2048
#define PAGE_MAX_SIZE             4096
#define SPL_CANDIDATE_BLOCK_NUM   18
#define SPL_INVALID_BLOCK_IDX     0xFFFFFFFF
#define SPL_INVALID_PAGE_ADDR     0xFFFFFFFF

#define SPINAND_IMAGE_BACKUP_0 0
#define SPINAND_IMAGE_BACKUP_1 1
#define SPINAND_IMAGE_BACKUP_2 2
#define SPINAND_IMAGE_BACKUP_3 3
#define SPINAND_IMAGE_BACKUP_4 4

#define ROUNDUP(a, b) ((((a)-1) / (b) + 1) * (b))

struct nand_page_table_head {
    char magic[4]; /* "AICP": AIC Page table */
    u32 entry_cnt;
    u16 page_size;
    u8 pages_per_block;
    u8 blocks; /* Block number in SPI NAND */
    u8 planes; /* Plane number in SPI NAND: Max 2 in market avaialbe devices */
    u8 pad[7]; /* Padding it to fit size 20 bytes */
};

struct nand_page_table_entry {
    u32 pageaddr[IMAGE_BACKUP_BLOCK_CNT]; /* Page address in good block */
    u32 checksum;                         /* Page data checksum value */
};

struct nand_page_table {
    struct nand_page_table_head head;
    struct nand_page_table_entry entry[PAGE_TABLE_MAX_ENTRY];
};

static u32 spl_candidate_block_table[SPL_CANDIDATE_BLOCK_NUM] = {
    0,   1,   2,   3,   202, 32,  312, 296, 142,
    136, 392, 526, 452, 708, 810, 552, 906, 674,
};

static u32 calc_page_checksum(u8 *start, u32 size)
{
    u8 *p;
    u32 i, val, sum, rest, cnt;

    p = start;
    i = 0;
    sum = 0;
    cnt = size >> 2;

    for (i = 0; i < cnt; i++) {
        p = &start[i * 4];
        val = (p[3] << 24) | (p[2] << 16) | (p[1] << 8) | p[0];
        sum += val;
    }

    /* Calculate not 32 bit aligned part */
    rest = size - (cnt << 2);
    p = &start[cnt * 4];
    val = 0;
    for (i = 0; i < rest; i++)
        val += (p[i] << (i * 8));
    sum += val;

    return sum;
}

static s32 get_nand_page_table(nand_read fn, void *dev, unsigned long pagesize,
                               struct nand_page_table *pt)
{
    u32 i, blkidx, pa, sumval;
    s32 ret = -1;
    u32 *table = spl_candidate_block_table;
    u8 *page_data = NULL;
    ulong offset;

    page_data = malloc(PAGE_DEFAULT_SIZE);
    if (page_data == NULL)
        return -1;
    /* Search in alternative blocks */
    for (i = 0; i < FSBL_CANDIDATE_BLK_CNT; i++) {
        blkidx = table[i];
        pa = (blkidx << 6) + 0; /* First page in block */
        offset = pa * pagesize;
        ret = fn(dev, offset, page_data, PAGE_DEFAULT_SIZE);
        if (ret != 0) {
            pr_err("Read from block = %d, pa = 0x%x failed.\n", blkidx, pa);
            return (ret);
        }
        sumval = calc_page_checksum(page_data, PAGE_DEFAULT_SIZE);
        if (sumval != 0xFFFFFFFF) {
            ret = -1;
            pr_err("Checksum of block = %d, pa = 0x%x failed.\n", blkidx, pa);
            continue;
        }

        memcpy(pt, page_data, sizeof(struct nand_page_table));
        if (strncmp(pt->head.magic, "AICP", 4) != 0) {
            ret = -1;
            pr_err("AIC Head of block = %d, pa = 0x%x failed.\n", blkidx, pa);
            continue;
        } else {
            ret = 0;
            goto out;
        }
    }

out:
    if (page_data)
        free(page_data);
    return (ret);
}

void *aic_get_boot_resource_from_nand(void *dev, unsigned long pagesize,
                                      nand_read fn)
{
    u32 pa, i, offset, cksum, sumval, rdofs, rdlen;
    struct nand_page_table *pt;
    struct aic_image_header head;
    u8 *res = NULL, *p;
    s32 ret;

    pt = malloc(sizeof(*pt));
    if (pt == NULL)
        return NULL;

    ret = get_nand_page_table(fn, dev, pagesize, pt);
    if (ret != 0) {
        return NULL;
    }

    u8 *page = malloc(pagesize);
    if (page == NULL) {
        return NULL;
    }

    pa = pt->entry[1].pageaddr[0];
    cksum = pt->entry[1].checksum;

    offset = pa * pagesize;
    fn(dev, offset, page, pagesize);
    sumval = calc_page_checksum(page, pagesize);
    sumval += cksum;
    if (sumval != 0xFFFFFFFF) {
        pr_err("Page 1, pa 0x%x checksum 0x%x is wrong.\n", pa, sumval);
        goto out;
    }

    memcpy(&head, page, sizeof(head));

    if (head.magic != AIC_IMAGE_MAGIC) {
        pr_err("aic image head verify failure.");
        goto out;
    }
    if (head.private_data_offset) {
        rdofs = head.private_data_offset & (~(pagesize - 1));
        rdlen = ROUNDUP(head.private_data_len, pagesize);
        if (head.private_data_offset & (pagesize - 1))
            rdlen += pagesize;

        res = (void *)malloc(rdlen);
        if (res == NULL) {
            pr_err("Failed to malloc resource buffer.\n");
            free(res);
            res = NULL;
            goto out;
        }

        p = res;
        while (rdlen) {
            i = 1 + rdofs / pagesize;
            if (i < PAGE_TABLE_MAX_ENTRY) {
                pa = pt->entry[i].pageaddr[0];
            } else {
                pa = pt->entry[i % PAGE_TABLE_MAX_ENTRY].pageaddr[1];
            }
            offset = pa * pagesize;
            ret = fn(dev, offset, p, pagesize);
            if (ret) {
                pr_err("Failed to read aic image head.");
                free(res);
                res = NULL;
                goto out;
            }

            rdlen -= pagesize;
            rdofs += pagesize;
            p += pagesize;
        }

        rdofs = head.private_data_offset & (pagesize - 1);
        if (rdofs) {
            memcpy(res, res + rdofs, head.private_data_len);
        }
    }
out:
    if (pt)
        free(pt);
    if (page)
        free(page);

    return res;
}