267 lines
7.8 KiB
C
267 lines
7.8 KiB
C
|
/*
|
|||
|
|
* Copyright : (C) 2022 Phytium Information Technology, Inc.
|
|||
|
|
* All Rights Reserved.
|
|||
|
|
*
|
|||
|
|
* This program is OPEN SOURCE software: you can redistribute it and/or modify it
|
|||
|
|
* under the terms of the Phytium Public License as published by the Phytium Technology Co.,Ltd,
|
|||
|
|
* either version 1.0 of the License, or (at your option) any later version.
|
|||
|
|
*
|
|||
|
|
* This program is distributed in the hope that it will be useful,but WITHOUT ANY WARRANTY;
|
|||
|
|
* without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
|||
|
|
* See the Phytium Public License for more details.
|
|||
|
|
*
|
|||
|
|
*
|
|||
|
|
* FilePath: fnand_ecc.c
|
|||
|
|
* Date: 2022-05-12 14:17:42
|
|||
|
|
* LastEditTime: 2022-05-12 15:56:27
|
|||
|
|
* Description: This files is for
|
|||
|
|
*
|
|||
|
|
* Modify History:
|
|||
|
|
* Ver Who Date Changes
|
|||
|
|
* ----- ------ -------- --------------------------------------
|
|||
|
|
*/
|
|||
|
|
|
|||
|
|
|
|||
|
|
#include "fnand_ecc.h"
|
|||
|
|
#include "fnand.h"
|
|||
|
|
#include "fnand_hw.h"
|
|||
|
|
#include "fdebug.h"
|
|||
|
|
#define FNAND_ECC_DEBUG_TAG "FNAND_ECC"
|
|||
|
|
#define FNAND_ECC_DEBUG_I(format, ...) FT_DEBUG_PRINT_I(FNAND_ECC_DEBUG_TAG, format, ##__VA_ARGS__)
|
|||
|
|
#define FNAND_ECC_DEBUG_W(format, ...) FT_DEBUG_PRINT_W(FNAND_ECC_DEBUG_TAG, format, ##__VA_ARGS__)
|
|||
|
|
#define FNAND_ECC_DEBUG_E(format, ...) FT_DEBUG_PRINT_E(FNAND_ECC_DEBUG_TAG, format, ##__VA_ARGS__)
|
|||
|
|
|
|||
|
|
|
|||
|
|
/**
|
|||
|
|
* @name: FNandGetEccTotalLength
|
|||
|
|
* @msg: 根据page size 与 ecc_strength（纠错个数）确定硬件ecc 产生
|
|||
|
|
* @param {u32} bytes_per_page
|
|||
|
|
* @param {u32} ecc_strength
|
|||
|
|
* @return {*}
|
|||
|
|
* @note:
|
|||
|
|
*/
|
|||
|
|
u32 FNandGetEccTotalLength(u32 bytes_per_page, u32 ecc_strength)
|
|||
|
|
{
|
|||
|
|
int ecc_total = 0;
|
|||
|
|
switch (bytes_per_page)
|
|||
|
|
{
|
|||
|
|
case 0x200:
|
|||
|
|
if (ecc_strength == 8)
|
|||
|
|
ecc_total = 0x0D;
|
|||
|
|
else if (ecc_strength == 4)
|
|||
|
|
ecc_total = 7;
|
|||
|
|
else if (ecc_strength == 2)
|
|||
|
|
ecc_total = 4;
|
|||
|
|
else
|
|||
|
|
ecc_total = 0;
|
|||
|
|
break;
|
|||
|
|
case 0x800:
|
|||
|
|
if (ecc_strength == 8)
|
|||
|
|
ecc_total = 0x34;
|
|||
|
|
else if (ecc_strength == 4)
|
|||
|
|
ecc_total = 0x1a;
|
|||
|
|
else if (ecc_strength == 2)
|
|||
|
|
ecc_total = 0xd;
|
|||
|
|
else
|
|||
|
|
ecc_total = 0;
|
|||
|
|
break;
|
|||
|
|
case 0x1000:
|
|||
|
|
if (ecc_strength == 8)
|
|||
|
|
ecc_total = 0x68;
|
|||
|
|
else if (ecc_strength == 4)
|
|||
|
|
ecc_total = 0x34;
|
|||
|
|
else if (ecc_strength == 2)
|
|||
|
|
ecc_total = 0x1a;
|
|||
|
|
else
|
|||
|
|
ecc_total = 0;
|
|||
|
|
break;
|
|||
|
|
case 0x2000:
|
|||
|
|
if (ecc_strength == 8)
|
|||
|
|
ecc_total = 0xD0;
|
|||
|
|
else if (ecc_strength == 4)
|
|||
|
|
ecc_total = 0x68;
|
|||
|
|
else if (ecc_strength == 2)
|
|||
|
|
ecc_total = 0x34;
|
|||
|
|
else
|
|||
|
|
ecc_total = 0;
|
|||
|
|
break;
|
|||
|
|
case 0x4000:
|
|||
|
|
if (ecc_strength == 8)
|
|||
|
|
ecc_total = 0x1A0;
|
|||
|
|
if (ecc_strength == 4)
|
|||
|
|
ecc_total = 0xD0;
|
|||
|
|
else if (ecc_strength == 2)
|
|||
|
|
ecc_total = 0x68;
|
|||
|
|
else
|
|||
|
|
ecc_total = 0;
|
|||
|
|
break;
|
|||
|
|
default:
|
|||
|
|
ecc_total = 0;
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
FNAND_ECC_DEBUG_I("[%s %d]writesize: 0x%x, ecc strength: %d, ecc_total: 0x%x\n", __func__, __LINE__, bytes_per_page, ecc_strength, ecc_total);
|
|||
|
|
return ecc_total;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
/**
|
|||
|
|
* @name: FNandCorrectEcc
|
|||
|
|
* @msg:
|
|||
|
|
* @note:
|
|||
|
|
* @return {*}
|
|||
|
|
* @param {uintptr_t} base_address
|
|||
|
|
* @param {u32} ecc_step_size 单次ecc 使用的步长大小
|
|||
|
|
* @param {u32} hw_ecc_steps 一页操作需要进行的ecc 次数
|
|||
|
|
* @param {u8*} buf page 页 对应的指针
|
|||
|
|
* @param {u32} length
|
|||
|
|
*/
|
|||
|
|
// s32 FNandCorrectEcc(uintptr_t base_address,u32 ecc_step_size,u32 hw_ecc_steps,u8* buf ,u32 length)
|
|||
|
|
// {
|
|||
|
|
// u32 i, j;
|
|||
|
|
// u32 value, tmp;
|
|||
|
|
// int stat = 0;
|
|||
|
|
// if(!buf)
|
|||
|
|
// {
|
|||
|
|
// FNAND_ECC_DEBUG_E("page buffer is null");
|
|||
|
|
// return -1;
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// /* i */
|
|||
|
|
// for (i = 0; i < hw_ecc_steps; i++)
|
|||
|
|
// {
|
|||
|
|
// for (j = 0; j < 2; j++) {
|
|||
|
|
// value = FNAND_READREG(base_address, 0xB8 + 4 * (2 * i + j));
|
|||
|
|
// FNAND_ECC_DEBUG_W("index:%x i is %d ,j is %d ",
|
|||
|
|
// 0xB8 + 4 * (2 * i + j),i,j);
|
|||
|
|
// if (value)
|
|||
|
|
// {
|
|||
|
|
// FNAND_ECC_DEBUG_W("offset:%x value:0x%08x\n",
|
|||
|
|
// 0xB8 + 4 * (2 * i + j), value);
|
|||
|
|
// //phytium_nfc_data_dump2(nfc, nfc->dma_buf + (ecc_step_size * i + tmp/8)/512, 512);
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// tmp = value & 0xFFFF;
|
|||
|
|
// if (tmp && (tmp <= 4096))
|
|||
|
|
// {
|
|||
|
|
// tmp -= 1;
|
|||
|
|
// FNAND_ECC_DEBUG_W( "ECC_CORRECT %x %02x\n",
|
|||
|
|
// ecc_step_size * i + tmp / 8,
|
|||
|
|
// buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
|
|||
|
|
// buf[ecc_step_size*i + tmp/8] ^= (0x01 << tmp%8);
|
|||
|
|
// stat++;
|
|||
|
|
|
|||
|
|
// FNAND_ECC_DEBUG_W( "ECC_CORRECT xor %x %02x\n",
|
|||
|
|
// 0x01 << tmp % 8,
|
|||
|
|
// buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// FNAND_ECC_DEBUG_E("ECC_CORRECT offset > 4096!\n");
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// tmp = (value >> 16) & 0xFFFF;
|
|||
|
|
// if (tmp && (tmp <= 4096) )
|
|||
|
|
// {
|
|||
|
|
// tmp -= 1;
|
|||
|
|
// FNAND_ECC_DEBUG_W( "ECC_CORRECT %x %02x\n",
|
|||
|
|
// ecc_step_size * i + tmp / 8,
|
|||
|
|
// buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
|
|||
|
|
// buf[ecc_step_size*i + tmp/8] ^= (0x01 << tmp%8);
|
|||
|
|
// stat++;
|
|||
|
|
|
|||
|
|
// FNAND_ECC_DEBUG_W( "ECC_CORRECT xor %x %02x\n",
|
|||
|
|
// ecc_step_size * i + tmp / 8,
|
|||
|
|
// buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// FNAND_ECC_DEBUG_E("ECC_CORRECT offset > 4096!\n");
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// return stat;
|
|||
|
|
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// 校验offset 0xb8 + i * 0x10
|
|||
|
|
// 校验强度为 2 j = 1
|
|||
|
|
// 校验强度为 4 j = 2
|
|||
|
|
// 校验强度为 8 j = 4
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
s32 FNandCorrectEcc(uintptr_t base_address, u32 ecc_step_size, u32 hw_ecc_steps, u8 *buf, u32 length)
|
|||
|
|
{
|
|||
|
|
u32 i, j;
|
|||
|
|
u32 value, tmp;
|
|||
|
|
int stat = 0;
|
|||
|
|
if (!buf)
|
|||
|
|
{
|
|||
|
|
FNAND_ECC_DEBUG_E("page buffer is null");
|
|||
|
|
return -1;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/* i */
|
|||
|
|
for (i = 0; i < hw_ecc_steps; i++)
|
|||
|
|
{
|
|||
|
|
for (j = 0; j < 4; j++)
|
|||
|
|
{
|
|||
|
|
// value = FNAND_READREG(base_address, 0xB8 + 4 * (2 * i + j));
|
|||
|
|
value = FNAND_READREG(base_address, 0xB8 + 0x10 * i + 4 * j);
|
|||
|
|
// FNAND_ECC_DEBUG_W("index:%x i is %d ,j is %d ",
|
|||
|
|
// 0xB8 + 0x10 * i + 4*j,i,j);
|
|||
|
|
if (value)
|
|||
|
|
{
|
|||
|
|
// FNAND_ECC_DEBUG_W("offset:%x value:0x%08x\n",
|
|||
|
|
// 0xB8 + 0x10 * i + 4*j, value);
|
|||
|
|
//phytium_nfc_data_dump2(nfc, nfc->dma_buf + (ecc_step_size * i + tmp/8)/512, 512);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
tmp = value & 0xFFFF;
|
|||
|
|
if (tmp && (tmp <= 4096))
|
|||
|
|
{
|
|||
|
|
tmp -= 1;
|
|||
|
|
FNAND_ECC_DEBUG_W("ECC_CORRECT %x %02x\n",
|
|||
|
|
ecc_step_size * i + tmp / 8,
|
|||
|
|
buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
|
|||
|
|
buf[ecc_step_size * i + tmp / 8] ^= (0x01 << tmp % 8);
|
|||
|
|
stat++;
|
|||
|
|
|
|||
|
|
FNAND_ECC_DEBUG_W("ECC_CORRECT xor %x %02x\n",
|
|||
|
|
0x01 << tmp % 8,
|
|||
|
|
buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
tmp = (value >> 16) & 0xFFFF;
|
|||
|
|
if (tmp && (tmp <= 4096))
|
|||
|
|
{
|
|||
|
|
tmp -= 1;
|
|||
|
|
FNAND_ECC_DEBUG_W("ECC_CORRECT %x %02x\n",
|
|||
|
|
ecc_step_size * i + tmp / 8,
|
|||
|
|
buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
|
|||
|
|
buf[ecc_step_size * i + tmp / 8] ^= (0x01 << tmp % 8);
|
|||
|
|
stat++;
|
|||
|
|
|
|||
|
|
FNAND_ECC_DEBUG_W("ECC_CORRECT xor %x %02x\n",
|
|||
|
|
ecc_step_size * i + tmp / 8,
|
|||
|
|
buf[ecc_step_size * i + tmp / 8]);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return stat;
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|