GK SDK 源码库: XMIPCLinuxV100R005C00SPC030 (kernel/tools/open_source excluded)
This commit is contained in:
@@ -0,0 +1,176 @@
|
||||
/*
|
||||
* Copyright (c) 2019-2022, STMicroelectronics - All Rights Reserved
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#include <assert.h>
|
||||
#include <errno.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#include <common/debug.h>
|
||||
#include <drivers/delay_timer.h>
|
||||
#include <drivers/nand.h>
|
||||
#include <lib/utils.h>
|
||||
|
||||
#include <platform_def.h>
|
||||
|
||||
/*
|
||||
* Define a single nand_device used by specific NAND frameworks.
|
||||
*/
|
||||
static struct nand_device nand_dev;
|
||||
|
||||
#pragma weak plat_get_scratch_buffer
|
||||
void plat_get_scratch_buffer(void **buffer_addr, size_t *buf_size)
|
||||
{
|
||||
static uint8_t scratch_buff[PLATFORM_MTD_MAX_PAGE_SIZE];
|
||||
|
||||
assert(buffer_addr != NULL);
|
||||
assert(buf_size != NULL);
|
||||
|
||||
*buffer_addr = (void *)scratch_buff;
|
||||
*buf_size = sizeof(scratch_buff);
|
||||
}
|
||||
|
||||
int nand_read(unsigned int offset, uintptr_t buffer, size_t length,
|
||||
size_t *length_read)
|
||||
{
|
||||
unsigned int block = offset / nand_dev.block_size;
|
||||
unsigned int end_block = (offset + length - 1U) / nand_dev.block_size;
|
||||
unsigned int page_start =
|
||||
(offset % nand_dev.block_size) / nand_dev.page_size;
|
||||
unsigned int nb_pages = nand_dev.block_size / nand_dev.page_size;
|
||||
unsigned int start_offset = offset % nand_dev.page_size;
|
||||
unsigned int page;
|
||||
unsigned int bytes_read;
|
||||
int is_bad;
|
||||
int ret;
|
||||
uint8_t *scratch_buff;
|
||||
size_t scratch_buff_size;
|
||||
|
||||
plat_get_scratch_buffer((void **)&scratch_buff, &scratch_buff_size);
|
||||
|
||||
assert(scratch_buff != NULL);
|
||||
|
||||
VERBOSE("Block %u - %u, page_start %u, nb %u, length %zu, offset %u\n",
|
||||
block, end_block, page_start, nb_pages, length, offset);
|
||||
|
||||
*length_read = 0UL;
|
||||
|
||||
if (((start_offset != 0U) || (length % nand_dev.page_size) != 0U) &&
|
||||
(scratch_buff_size < nand_dev.page_size)) {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
while (block <= end_block) {
|
||||
is_bad = nand_dev.mtd_block_is_bad(block);
|
||||
if (is_bad < 0) {
|
||||
return is_bad;
|
||||
}
|
||||
|
||||
if (is_bad == 1) {
|
||||
/* Skip the block */
|
||||
uint32_t max_block =
|
||||
nand_dev.size / nand_dev.block_size;
|
||||
|
||||
block++;
|
||||
end_block++;
|
||||
if ((block < max_block) && (end_block < max_block)) {
|
||||
continue;
|
||||
}
|
||||
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
for (page = page_start; page < nb_pages; page++) {
|
||||
if ((start_offset != 0U) ||
|
||||
(length < nand_dev.page_size)) {
|
||||
ret = nand_dev.mtd_read_page(
|
||||
&nand_dev,
|
||||
(block * nb_pages) + page,
|
||||
(uintptr_t)scratch_buff);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
bytes_read = MIN((size_t)(nand_dev.page_size -
|
||||
start_offset),
|
||||
length);
|
||||
|
||||
memcpy((uint8_t *)buffer,
|
||||
scratch_buff + start_offset,
|
||||
bytes_read);
|
||||
|
||||
start_offset = 0U;
|
||||
} else {
|
||||
ret = nand_dev.mtd_read_page(&nand_dev,
|
||||
(block * nb_pages) + page,
|
||||
buffer);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
bytes_read = nand_dev.page_size;
|
||||
}
|
||||
|
||||
length -= bytes_read;
|
||||
buffer += bytes_read;
|
||||
*length_read += bytes_read;
|
||||
|
||||
if (length == 0U) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
page_start = 0U;
|
||||
block++;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int nand_seek_bb(uintptr_t base, unsigned int offset, size_t *extra_offset)
|
||||
{
|
||||
unsigned int block;
|
||||
unsigned int offset_block;
|
||||
unsigned int max_block;
|
||||
int is_bad;
|
||||
size_t count_bb = 0U;
|
||||
|
||||
block = base / nand_dev.block_size;
|
||||
|
||||
if (offset != 0U) {
|
||||
offset_block = (base + offset - 1U) / nand_dev.block_size;
|
||||
} else {
|
||||
offset_block = block;
|
||||
}
|
||||
|
||||
max_block = nand_dev.size / nand_dev.block_size;
|
||||
|
||||
while (block <= offset_block) {
|
||||
if (offset_block >= max_block) {
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
is_bad = nand_dev.mtd_block_is_bad(block);
|
||||
if (is_bad < 0) {
|
||||
return is_bad;
|
||||
}
|
||||
|
||||
if (is_bad == 1) {
|
||||
count_bb++;
|
||||
offset_block++;
|
||||
}
|
||||
|
||||
block++;
|
||||
}
|
||||
|
||||
*extra_offset = count_bb * nand_dev.block_size;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
struct nand_device *get_nand_device(void)
|
||||
{
|
||||
return &nand_dev;
|
||||
}
|
||||
@@ -0,0 +1,443 @@
|
||||
/*
|
||||
* Copyright (c) 2019-2022, STMicroelectronics - All Rights Reserved
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#include <assert.h>
|
||||
#include <errno.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#include <common/debug.h>
|
||||
#include <drivers/delay_timer.h>
|
||||
#include <drivers/raw_nand.h>
|
||||
#include <lib/utils.h>
|
||||
|
||||
#include <platform_def.h>
|
||||
|
||||
#define ONFI_SIGNATURE_ADDR 0x20U
|
||||
|
||||
/* CRC calculation */
|
||||
#define CRC_POLYNOM 0x8005U
|
||||
#define CRC_INIT_VALUE 0x4F4EU
|
||||
|
||||
/* Status register */
|
||||
#define NAND_STATUS_READY BIT(6)
|
||||
|
||||
static struct rawnand_device rawnand_dev;
|
||||
|
||||
#pragma weak plat_get_raw_nand_data
|
||||
int plat_get_raw_nand_data(struct rawnand_device *device)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int nand_send_cmd(uint8_t cmd, unsigned int tim)
|
||||
{
|
||||
struct nand_req req;
|
||||
|
||||
zeromem(&req, sizeof(struct nand_req));
|
||||
req.nand = rawnand_dev.nand_dev;
|
||||
req.type = NAND_REQ_CMD | cmd;
|
||||
req.inst_delay = tim;
|
||||
|
||||
return rawnand_dev.ops->exec(&req);
|
||||
}
|
||||
|
||||
static int nand_send_addr(uint8_t addr, unsigned int tim)
|
||||
{
|
||||
struct nand_req req;
|
||||
|
||||
zeromem(&req, sizeof(struct nand_req));
|
||||
req.nand = rawnand_dev.nand_dev;
|
||||
req.type = NAND_REQ_ADDR;
|
||||
req.addr = &addr;
|
||||
req.inst_delay = tim;
|
||||
|
||||
return rawnand_dev.ops->exec(&req);
|
||||
}
|
||||
|
||||
static int nand_send_wait(unsigned int delay, unsigned int tim)
|
||||
{
|
||||
struct nand_req req;
|
||||
|
||||
zeromem(&req, sizeof(struct nand_req));
|
||||
req.nand = rawnand_dev.nand_dev;
|
||||
req.type = NAND_REQ_WAIT;
|
||||
req.inst_delay = tim;
|
||||
req.delay_ms = delay;
|
||||
|
||||
return rawnand_dev.ops->exec(&req);
|
||||
}
|
||||
|
||||
|
||||
static int nand_read_data(uint8_t *data, unsigned int length, bool use_8bit)
|
||||
{
|
||||
struct nand_req req;
|
||||
|
||||
zeromem(&req, sizeof(struct nand_req));
|
||||
req.nand = rawnand_dev.nand_dev;
|
||||
req.type = NAND_REQ_DATAIN | (use_8bit ? NAND_REQ_BUS_WIDTH_8 : 0U);
|
||||
req.addr = data;
|
||||
req.length = length;
|
||||
|
||||
return rawnand_dev.ops->exec(&req);
|
||||
}
|
||||
|
||||
int nand_change_read_column_cmd(unsigned int offset, uintptr_t buffer,
|
||||
unsigned int len)
|
||||
{
|
||||
int ret;
|
||||
uint8_t addr[2];
|
||||
unsigned int i;
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_CHANGE_1ST, 0U);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (rawnand_dev.nand_dev->buswidth == NAND_BUS_WIDTH_16) {
|
||||
offset /= 2U;
|
||||
}
|
||||
|
||||
addr[0] = offset;
|
||||
addr[1] = offset >> 8;
|
||||
|
||||
for (i = 0; i < 2U; i++) {
|
||||
ret = nand_send_addr(addr[i], 0U);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_CHANGE_2ND, NAND_TCCS_MIN);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
return nand_read_data((uint8_t *)buffer, len, false);
|
||||
}
|
||||
|
||||
int nand_read_page_cmd(unsigned int page, unsigned int offset,
|
||||
uintptr_t buffer, unsigned int len)
|
||||
{
|
||||
uint8_t addr[5];
|
||||
uint8_t i = 0U;
|
||||
uint8_t j;
|
||||
int ret;
|
||||
|
||||
VERBOSE(">%s page %u offset %u buffer 0x%lx\n", __func__, page, offset,
|
||||
buffer);
|
||||
|
||||
if (rawnand_dev.nand_dev->buswidth == NAND_BUS_WIDTH_16) {
|
||||
offset /= 2U;
|
||||
}
|
||||
|
||||
addr[i++] = offset;
|
||||
addr[i++] = offset >> 8;
|
||||
|
||||
addr[i++] = page;
|
||||
addr[i++] = page >> 8;
|
||||
if (rawnand_dev.nand_dev->size > SZ_128M) {
|
||||
addr[i++] = page >> 16;
|
||||
}
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_READ_1ST, 0U);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
for (j = 0U; j < i; j++) {
|
||||
ret = nand_send_addr(addr[j], 0U);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_READ_2ND, NAND_TWB_MAX);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = nand_send_wait(PSEC_TO_MSEC(NAND_TR_MAX), NAND_TRR_MIN);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (buffer != 0U) {
|
||||
ret = nand_read_data((uint8_t *)buffer, len, false);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int nand_status(uint8_t *status)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_STATUS, NAND_TWHR_MIN);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (status != NULL) {
|
||||
ret = nand_read_data(status, 1U, true);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int nand_wait_ready(unsigned int delay_ms)
|
||||
{
|
||||
uint8_t status;
|
||||
int ret;
|
||||
uint64_t timeout;
|
||||
|
||||
/* Wait before reading status */
|
||||
udelay(1);
|
||||
|
||||
ret = nand_status(NULL);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
timeout = timeout_init_us(delay_ms * 1000U);
|
||||
while (!timeout_elapsed(timeout)) {
|
||||
ret = nand_read_data(&status, 1U, true);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if ((status & NAND_STATUS_READY) != 0U) {
|
||||
return nand_send_cmd(NAND_CMD_READ_1ST, 0U);
|
||||
}
|
||||
|
||||
udelay(10);
|
||||
}
|
||||
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
#if NAND_ONFI_DETECT
|
||||
static uint16_t nand_check_crc(uint16_t crc, uint8_t *data_in,
|
||||
unsigned int data_len)
|
||||
{
|
||||
uint32_t i;
|
||||
uint32_t j;
|
||||
uint32_t bit;
|
||||
|
||||
for (i = 0U; i < data_len; i++) {
|
||||
uint8_t cur_param = *data_in++;
|
||||
|
||||
for (j = BIT(7); j != 0U; j >>= 1) {
|
||||
bit = crc & BIT(15);
|
||||
crc <<= 1;
|
||||
|
||||
if ((cur_param & j) != 0U) {
|
||||
bit ^= BIT(15);
|
||||
}
|
||||
|
||||
if (bit != 0U) {
|
||||
crc ^= CRC_POLYNOM;
|
||||
}
|
||||
}
|
||||
|
||||
crc &= GENMASK(15, 0);
|
||||
}
|
||||
|
||||
return crc;
|
||||
}
|
||||
|
||||
static int nand_read_id(uint8_t addr, uint8_t *id, unsigned int size)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_READID, 0U);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = nand_send_addr(addr, NAND_TWHR_MIN);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
return nand_read_data(id, size, true);
|
||||
}
|
||||
|
||||
static int nand_reset(void)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_RESET, NAND_TWB_MAX);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
return nand_send_wait(PSEC_TO_MSEC(NAND_TRST_MAX), 0U);
|
||||
}
|
||||
|
||||
static int nand_read_param_page(void)
|
||||
{
|
||||
struct nand_param_page page;
|
||||
uint8_t addr = 0U;
|
||||
int ret;
|
||||
|
||||
ret = nand_send_cmd(NAND_CMD_READ_PARAM_PAGE, 0U);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = nand_send_addr(addr, NAND_TWB_MAX);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = nand_send_wait(PSEC_TO_MSEC(NAND_TR_MAX), NAND_TRR_MIN);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = nand_read_data((uint8_t *)&page, sizeof(page), true);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (strncmp((char *)&page.page_sig, "ONFI", 4) != 0) {
|
||||
WARN("Error ONFI detection\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (nand_check_crc(CRC_INIT_VALUE, (uint8_t *)&page, 254U) !=
|
||||
page.crc16) {
|
||||
WARN("Error reading param\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if ((page.features & ONFI_FEAT_BUS_WIDTH_16) != 0U) {
|
||||
rawnand_dev.nand_dev->buswidth = NAND_BUS_WIDTH_16;
|
||||
} else {
|
||||
rawnand_dev.nand_dev->buswidth = NAND_BUS_WIDTH_8;
|
||||
}
|
||||
|
||||
rawnand_dev.nand_dev->block_size = page.num_pages_per_blk *
|
||||
page.bytes_per_page;
|
||||
rawnand_dev.nand_dev->page_size = page.bytes_per_page;
|
||||
rawnand_dev.nand_dev->size = page.num_pages_per_blk *
|
||||
page.bytes_per_page *
|
||||
page.num_blk_in_lun * page.num_lun;
|
||||
|
||||
if (page.nb_ecc_bits != GENMASK_32(7, 0)) {
|
||||
rawnand_dev.nand_dev->ecc.max_bit_corr = page.nb_ecc_bits;
|
||||
rawnand_dev.nand_dev->ecc.size = SZ_512;
|
||||
}
|
||||
|
||||
VERBOSE("Page size %u, block_size %u, Size %llu, ecc %u, buswidth %u\n",
|
||||
rawnand_dev.nand_dev->page_size,
|
||||
rawnand_dev.nand_dev->block_size, rawnand_dev.nand_dev->size,
|
||||
rawnand_dev.nand_dev->ecc.max_bit_corr,
|
||||
rawnand_dev.nand_dev->buswidth);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int detect_onfi(void)
|
||||
{
|
||||
int ret;
|
||||
char id[4];
|
||||
|
||||
ret = nand_reset();
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = nand_read_id(ONFI_SIGNATURE_ADDR, (uint8_t *)id, sizeof(id));
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (strncmp(id, "ONFI", sizeof(id)) != 0) {
|
||||
WARN("NAND Non ONFI detected\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
return nand_read_param_page();
|
||||
}
|
||||
#endif
|
||||
|
||||
static int nand_mtd_block_is_bad(unsigned int block)
|
||||
{
|
||||
unsigned int nbpages_per_block = rawnand_dev.nand_dev->block_size /
|
||||
rawnand_dev.nand_dev->page_size;
|
||||
uint8_t bbm_marker[2];
|
||||
uint8_t page;
|
||||
int ret;
|
||||
|
||||
for (page = 0U; page < 2U; page++) {
|
||||
ret = nand_read_page_cmd(block * nbpages_per_block,
|
||||
rawnand_dev.nand_dev->page_size,
|
||||
(uintptr_t)bbm_marker,
|
||||
sizeof(bbm_marker));
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if ((bbm_marker[0] != GENMASK_32(7, 0)) ||
|
||||
(bbm_marker[1] != GENMASK_32(7, 0))) {
|
||||
WARN("Block %u is bad\n", block);
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int nand_mtd_read_page_raw(struct nand_device *nand, unsigned int page,
|
||||
uintptr_t buffer)
|
||||
{
|
||||
return nand_read_page_cmd(page, 0U, buffer,
|
||||
rawnand_dev.nand_dev->page_size);
|
||||
}
|
||||
|
||||
void nand_raw_ctrl_init(const struct nand_ctrl_ops *ops)
|
||||
{
|
||||
rawnand_dev.ops = ops;
|
||||
}
|
||||
|
||||
int nand_raw_init(unsigned long long *size, unsigned int *erase_size)
|
||||
{
|
||||
rawnand_dev.nand_dev = get_nand_device();
|
||||
if (rawnand_dev.nand_dev == NULL) {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
rawnand_dev.nand_dev->mtd_block_is_bad = nand_mtd_block_is_bad;
|
||||
rawnand_dev.nand_dev->mtd_read_page = nand_mtd_read_page_raw;
|
||||
rawnand_dev.nand_dev->ecc.mode = NAND_ECC_NONE;
|
||||
|
||||
if ((rawnand_dev.ops->setup == NULL) ||
|
||||
(rawnand_dev.ops->exec == NULL)) {
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
#if NAND_ONFI_DETECT
|
||||
if (detect_onfi() != 0) {
|
||||
WARN("Detect ONFI failed\n");
|
||||
}
|
||||
#endif
|
||||
|
||||
if (plat_get_raw_nand_data(&rawnand_dev) != 0) {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
assert((rawnand_dev.nand_dev->page_size != 0U) &&
|
||||
(rawnand_dev.nand_dev->block_size != 0U) &&
|
||||
(rawnand_dev.nand_dev->size != 0U));
|
||||
|
||||
*size = rawnand_dev.nand_dev->size;
|
||||
*erase_size = rawnand_dev.nand_dev->block_size;
|
||||
|
||||
rawnand_dev.ops->setup(rawnand_dev.nand_dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
@@ -0,0 +1,324 @@
|
||||
/*
|
||||
* Copyright (c) 2019-2022, STMicroelectronics - All Rights Reserved
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#include <assert.h>
|
||||
#include <errno.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#include <common/debug.h>
|
||||
#include <drivers/delay_timer.h>
|
||||
#include <drivers/spi_nand.h>
|
||||
#include <lib/utils.h>
|
||||
|
||||
#include <platform_def.h>
|
||||
|
||||
#define SPI_NAND_MAX_ID_LEN 4U
|
||||
#define DELAY_US_400MS 400000U
|
||||
#define MACRONIX_ID 0xC2U
|
||||
|
||||
static struct spinand_device spinand_dev;
|
||||
|
||||
#pragma weak plat_get_spi_nand_data
|
||||
int plat_get_spi_nand_data(struct spinand_device *device)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int spi_nand_reg(bool read_reg, uint8_t reg, uint8_t *val,
|
||||
enum spi_mem_data_dir dir)
|
||||
{
|
||||
struct spi_mem_op op;
|
||||
|
||||
zeromem(&op, sizeof(struct spi_mem_op));
|
||||
if (read_reg) {
|
||||
op.cmd.opcode = SPI_NAND_OP_GET_FEATURE;
|
||||
} else {
|
||||
op.cmd.opcode = SPI_NAND_OP_SET_FEATURE;
|
||||
}
|
||||
|
||||
op.cmd.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
op.addr.val = reg;
|
||||
op.addr.nbytes = 1U;
|
||||
op.addr.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
op.data.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
op.data.dir = dir;
|
||||
op.data.nbytes = 1U;
|
||||
op.data.buf = val;
|
||||
|
||||
return spi_mem_exec_op(&op);
|
||||
}
|
||||
|
||||
static int spi_nand_read_reg(uint8_t reg, uint8_t *val)
|
||||
{
|
||||
return spi_nand_reg(true, reg, val, SPI_MEM_DATA_IN);
|
||||
}
|
||||
|
||||
static int spi_nand_write_reg(uint8_t reg, uint8_t val)
|
||||
{
|
||||
return spi_nand_reg(false, reg, &val, SPI_MEM_DATA_OUT);
|
||||
}
|
||||
|
||||
static int spi_nand_update_cfg(uint8_t mask, uint8_t val)
|
||||
{
|
||||
int ret;
|
||||
uint8_t cfg = spinand_dev.cfg_cache;
|
||||
|
||||
cfg &= ~mask;
|
||||
cfg |= val;
|
||||
|
||||
if (cfg == spinand_dev.cfg_cache) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
ret = spi_nand_write_reg(SPI_NAND_REG_CFG, cfg);
|
||||
if (ret == 0) {
|
||||
spinand_dev.cfg_cache = cfg;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int spi_nand_ecc_enable(bool enable)
|
||||
{
|
||||
return spi_nand_update_cfg(SPI_NAND_CFG_ECC_EN,
|
||||
enable ? SPI_NAND_CFG_ECC_EN : 0U);
|
||||
}
|
||||
|
||||
static int spi_nand_quad_enable(uint8_t manufacturer_id)
|
||||
{
|
||||
bool enable = false;
|
||||
|
||||
if (manufacturer_id != MACRONIX_ID) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (spinand_dev.spi_read_cache_op.data.buswidth ==
|
||||
SPI_MEM_BUSWIDTH_4_LINE) {
|
||||
enable = true;
|
||||
}
|
||||
|
||||
return spi_nand_update_cfg(SPI_NAND_CFG_QE,
|
||||
enable ? SPI_NAND_CFG_QE : 0U);
|
||||
}
|
||||
|
||||
static int spi_nand_wait_ready(uint8_t *status)
|
||||
{
|
||||
int ret;
|
||||
uint64_t timeout = timeout_init_us(DELAY_US_400MS);
|
||||
|
||||
while (!timeout_elapsed(timeout)) {
|
||||
ret = spi_nand_read_reg(SPI_NAND_REG_STATUS, status);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
VERBOSE("%s Status %x\n", __func__, *status);
|
||||
if ((*status & SPI_NAND_STATUS_BUSY) == 0U) {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static int spi_nand_reset(void)
|
||||
{
|
||||
struct spi_mem_op op;
|
||||
uint8_t status;
|
||||
int ret;
|
||||
|
||||
zeromem(&op, sizeof(struct spi_mem_op));
|
||||
op.cmd.opcode = SPI_NAND_OP_RESET;
|
||||
op.cmd.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
|
||||
ret = spi_mem_exec_op(&op);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
return spi_nand_wait_ready(&status);
|
||||
}
|
||||
|
||||
static int spi_nand_read_id(uint8_t *id)
|
||||
{
|
||||
struct spi_mem_op op;
|
||||
|
||||
zeromem(&op, sizeof(struct spi_mem_op));
|
||||
op.cmd.opcode = SPI_NAND_OP_READ_ID;
|
||||
op.cmd.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
op.data.dir = SPI_MEM_DATA_IN;
|
||||
op.data.nbytes = SPI_NAND_MAX_ID_LEN;
|
||||
op.data.buf = id;
|
||||
op.data.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
|
||||
return spi_mem_exec_op(&op);
|
||||
}
|
||||
|
||||
static int spi_nand_load_page(unsigned int page)
|
||||
{
|
||||
struct spi_mem_op op;
|
||||
uint32_t block_nb = page / spinand_dev.nand_dev->block_size;
|
||||
uint32_t page_nb = page - (block_nb * spinand_dev.nand_dev->page_size);
|
||||
uint32_t nbpages_per_block = spinand_dev.nand_dev->block_size /
|
||||
spinand_dev.nand_dev->page_size;
|
||||
uint32_t block_sh = __builtin_ctz(nbpages_per_block) + 1U;
|
||||
|
||||
zeromem(&op, sizeof(struct spi_mem_op));
|
||||
op.cmd.opcode = SPI_NAND_OP_LOAD_PAGE;
|
||||
op.cmd.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
op.addr.val = (block_nb << block_sh) | page_nb;
|
||||
op.addr.nbytes = 3U;
|
||||
op.addr.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
|
||||
return spi_mem_exec_op(&op);
|
||||
}
|
||||
|
||||
static int spi_nand_read_from_cache(unsigned int page, unsigned int offset,
|
||||
uint8_t *buffer, unsigned int len)
|
||||
{
|
||||
uint32_t nbpages_per_block = spinand_dev.nand_dev->block_size /
|
||||
spinand_dev.nand_dev->page_size;
|
||||
uint32_t block_nb = page / nbpages_per_block;
|
||||
uint32_t page_sh = __builtin_ctz(spinand_dev.nand_dev->page_size) + 1U;
|
||||
|
||||
spinand_dev.spi_read_cache_op.addr.val = offset;
|
||||
|
||||
if ((spinand_dev.nand_dev->nb_planes > 1U) && ((block_nb % 2U) == 1U)) {
|
||||
spinand_dev.spi_read_cache_op.addr.val |= 1U << page_sh;
|
||||
}
|
||||
|
||||
spinand_dev.spi_read_cache_op.data.buf = buffer;
|
||||
spinand_dev.spi_read_cache_op.data.nbytes = len;
|
||||
|
||||
return spi_mem_exec_op(&spinand_dev.spi_read_cache_op);
|
||||
}
|
||||
|
||||
static int spi_nand_read_page(unsigned int page, unsigned int offset,
|
||||
uint8_t *buffer, unsigned int len,
|
||||
bool ecc_enabled)
|
||||
{
|
||||
uint8_t status;
|
||||
int ret;
|
||||
|
||||
ret = spi_nand_ecc_enable(ecc_enabled);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = spi_nand_load_page(page);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = spi_nand_wait_ready(&status);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = spi_nand_read_from_cache(page, offset, buffer, len);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (ecc_enabled && ((status & SPI_NAND_STATUS_ECC_UNCOR) != 0U)) {
|
||||
return -EBADMSG;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int spi_nand_mtd_block_is_bad(unsigned int block)
|
||||
{
|
||||
unsigned int nbpages_per_block = spinand_dev.nand_dev->block_size /
|
||||
spinand_dev.nand_dev->page_size;
|
||||
uint8_t bbm_marker[2];
|
||||
int ret;
|
||||
|
||||
ret = spi_nand_read_page(block * nbpages_per_block,
|
||||
spinand_dev.nand_dev->page_size,
|
||||
bbm_marker, sizeof(bbm_marker), false);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if ((bbm_marker[0] != GENMASK_32(7, 0)) ||
|
||||
(bbm_marker[1] != GENMASK_32(7, 0))) {
|
||||
WARN("Block %u is bad\n", block);
|
||||
return 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int spi_nand_mtd_read_page(struct nand_device *nand, unsigned int page,
|
||||
uintptr_t buffer)
|
||||
{
|
||||
return spi_nand_read_page(page, 0, (uint8_t *)buffer,
|
||||
spinand_dev.nand_dev->page_size, true);
|
||||
}
|
||||
|
||||
int spi_nand_init(unsigned long long *size, unsigned int *erase_size)
|
||||
{
|
||||
uint8_t id[SPI_NAND_MAX_ID_LEN];
|
||||
int ret;
|
||||
|
||||
spinand_dev.nand_dev = get_nand_device();
|
||||
if (spinand_dev.nand_dev == NULL) {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
spinand_dev.nand_dev->mtd_block_is_bad = spi_nand_mtd_block_is_bad;
|
||||
spinand_dev.nand_dev->mtd_read_page = spi_nand_mtd_read_page;
|
||||
spinand_dev.nand_dev->nb_planes = 1;
|
||||
|
||||
spinand_dev.spi_read_cache_op.cmd.opcode = SPI_NAND_OP_READ_FROM_CACHE;
|
||||
spinand_dev.spi_read_cache_op.cmd.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
spinand_dev.spi_read_cache_op.addr.nbytes = 2U;
|
||||
spinand_dev.spi_read_cache_op.addr.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
spinand_dev.spi_read_cache_op.dummy.nbytes = 1U;
|
||||
spinand_dev.spi_read_cache_op.dummy.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
spinand_dev.spi_read_cache_op.data.buswidth = SPI_MEM_BUSWIDTH_1_LINE;
|
||||
|
||||
if (plat_get_spi_nand_data(&spinand_dev) != 0) {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
assert((spinand_dev.nand_dev->page_size != 0U) &&
|
||||
(spinand_dev.nand_dev->block_size != 0U) &&
|
||||
(spinand_dev.nand_dev->size != 0U));
|
||||
|
||||
ret = spi_nand_reset();
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = spi_nand_read_id(id);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = spi_nand_read_reg(SPI_NAND_REG_CFG, &spinand_dev.cfg_cache);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = spi_nand_quad_enable(id[1]);
|
||||
if (ret != 0) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
VERBOSE("SPI_NAND Detected ID 0x%x\n", id[1]);
|
||||
|
||||
VERBOSE("Page size %u, Block size %u, size %llu\n",
|
||||
spinand_dev.nand_dev->page_size,
|
||||
spinand_dev.nand_dev->block_size,
|
||||
spinand_dev.nand_dev->size);
|
||||
|
||||
*size = spinand_dev.nand_dev->size;
|
||||
*erase_size = spinand_dev.nand_dev->block_size;
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user