/* * Copyright (c) 2006-2021, RT-Thread Development Team * * SPDX-License-Identifier: Apache-2.0 * * Change Logs: * Date Author Notes * 2011-12-05 Bernard the first version */ /* * COPYRIGHT (C) 2012, Shanghai Real Thread */ #include #ifdef RT_USING_MTD_NAND /** * RT-Thread Generic Device Interface */ static rt_err_t _mtd_init(rt_device_t dev) { return RT_EOK; } static rt_err_t _mtd_open(rt_device_t dev, rt_uint16_t oflag) { return RT_EOK; } static rt_err_t _mtd_close(rt_device_t dev) { return RT_EOK; } static rt_size_t _mtd_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size) { return size; } static rt_size_t _mtd_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size) { return size; } static rt_err_t _mtd_control(rt_device_t dev, int cmd, void *args) { return RT_EOK; } #ifdef RT_USING_DEVICE_OPS const static struct rt_device_ops mtd_nand_ops = { _mtd_init, _mtd_open, _mtd_close, _mtd_read, _mtd_write, _mtd_control }; #endif rt_err_t rt_mtd_nand_register_device(const char *name, struct rt_mtd_nand_device *device) { rt_device_t dev; dev = RT_DEVICE(device); RT_ASSERT(dev != RT_NULL); /* set device class and generic device interface */ dev->type = RT_Device_Class_MTD; #ifdef RT_USING_DEVICE_OPS dev->ops = &mtd_nand_ops; #else dev->init = _mtd_init; dev->open = _mtd_open; dev->read = _mtd_read; dev->write = _mtd_write; dev->close = _mtd_close; dev->control = _mtd_control; #endif dev->rx_indicate = RT_NULL; dev->tx_complete = RT_NULL; /* register to RT-Thread device system */ return rt_device_register(dev, name, RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE); } #if defined(RT_MTD_NAND_DEBUG) && defined(RT_USING_FINSH) #include #define __is_print(ch) ((unsigned int)((ch) - ' ') < 127u - ' ') static void mtd_dump_hex(const rt_uint8_t *ptr, rt_size_t buflen) { unsigned char *buf = (unsigned char *)ptr; int i, j; for (i = 0; i < buflen; i += 16) { rt_kprintf("%06x: ", i); for (j = 0; j < 16; j++) if (i + j < buflen) rt_kprintf("%02x ", buf[i + j]); else rt_kprintf(" "); rt_kprintf(" "); for (j = 0; j < 16; j++) if (i + j < buflen) rt_kprintf("%c", __is_print(buf[i + j]) ? buf[i + j] : '.'); rt_kprintf("\n"); } } int mtd_nandid(const char *name) { struct rt_mtd_nand_device *nand; nand = RT_MTD_NAND_DEVICE(rt_device_find(name)); if (nand == RT_NULL) { rt_kprintf("no nand device found!\n"); return -RT_ERROR; } return rt_mtd_nand_read_id(nand); } int mtd_nand_read(const char *name, int block, int page) { rt_err_t result; rt_uint8_t *page_ptr; rt_uint8_t *oob_ptr; struct rt_mtd_nand_device *nand; nand = RT_MTD_NAND_DEVICE(rt_device_find(name)); if (nand == RT_NULL) { rt_kprintf("no nand device found!\n"); return -RT_ERROR; } page_ptr = rt_malloc(nand->page_size + nand->oob_size); if (page_ptr == RT_NULL) { rt_kprintf("out of memory!\n"); return -RT_ENOMEM; } oob_ptr = page_ptr + nand->page_size; rt_memset(page_ptr, 0xff, nand->page_size + nand->oob_size); /* calculate the page number */ page = block * nand->pages_per_block + page; result = rt_mtd_nand_read(nand, page, page_ptr, nand->page_size, oob_ptr, nand->oob_size); rt_kprintf("read page, rc=%d\n", result); mtd_dump_hex(page_ptr, nand->page_size); mtd_dump_hex(oob_ptr, nand->oob_size); rt_free(page_ptr); return 0; } int mtd_nand_readoob(const char *name, int block, int page) { struct rt_mtd_nand_device *nand; rt_uint8_t *oob_ptr; nand = RT_MTD_NAND_DEVICE(rt_device_find(name)); if (nand == RT_NULL) { rt_kprintf("no nand device found!\n"); return -RT_ERROR; } oob_ptr = rt_malloc(nand->oob_size); if (oob_ptr == RT_NULL) { rt_kprintf("out of memory!\n"); return -RT_ENOMEM; } /* calculate the page number */ page = block * nand->pages_per_block + page; rt_mtd_nand_read(nand, page, RT_NULL, nand->page_size, oob_ptr, nand->oob_size); mtd_dump_hex(oob_ptr, nand->oob_size); rt_free(oob_ptr); return 0; } int mtd_nand_write(const char *name, int block, int page) { rt_err_t result; rt_uint8_t *page_ptr; rt_uint8_t *oob_ptr; rt_uint32_t index; struct rt_mtd_nand_device *nand; nand = RT_MTD_NAND_DEVICE(rt_device_find(name)); if (nand == RT_NULL) { rt_kprintf("no nand device found!\n"); return -RT_ERROR; } page_ptr = rt_malloc(nand->page_size + nand->oob_size); if (page_ptr == RT_NULL) { rt_kprintf("out of memory!\n"); return -RT_ENOMEM; } oob_ptr = page_ptr + nand->page_size; /* prepare page data */ for (index = 0; index < nand->page_size; index ++) { page_ptr[index] = index & 0xff; } /* prepare oob data */ for (index = 0; index < nand->oob_size; index ++) { oob_ptr[index] = index & 0xff; } /* calculate the page number */ page = block * nand->pages_per_block + page; result = rt_mtd_nand_write(nand, page, page_ptr, nand->page_size, oob_ptr, nand->oob_size); if (result != RT_MTD_EOK) { rt_kprintf("write page failed!, rc=%d\n", result); } rt_free(page_ptr); return 0; } int mtd_nand_erase(const char *name, int block) { struct rt_mtd_nand_device *nand; nand = RT_MTD_NAND_DEVICE(rt_device_find(name)); if (nand == RT_NULL) { rt_kprintf("no nand device found!\n"); return -RT_ERROR; } return rt_mtd_nand_erase_block(nand, block); } int mtd_nand_erase_all(const char *name) { rt_uint32_t index = 0; struct rt_mtd_nand_device *nand; nand = RT_MTD_NAND_DEVICE(rt_device_find(name)); if (nand == RT_NULL) { rt_kprintf("no nand device found!\n"); return -RT_ERROR; } for (index = 0; index < (nand->block_end - nand->block_start); index ++) { rt_mtd_nand_erase_block(nand, index); } return 0; } #ifdef RT_USING_FINSH static void mtd_nand(int argc, char **argv) { /* If the number of arguments less than 2 */ if (argc < 3) { help: rt_kprintf("\n"); rt_kprintf("mtd_nand [OPTION] [PARAM ...]\n"); rt_kprintf(" id Get nandid by given name\n"); rt_kprintf(" read Read data on page of block of device \n"); rt_kprintf(" readoob Read oob on page of block of device \n"); rt_kprintf(" write Run write test on page of block of device \n"); rt_kprintf(" erase Erase on block of device \n"); rt_kprintf(" eraseall Erase all block on device \n"); return ; } else if (!rt_strcmp(argv[1], "id")) { mtd_nandid(argv[2]); } else if (!rt_strcmp(argv[1], "read")) { if (argc < 5) { rt_kprintf("The input parameters are too few!\n"); goto help; } mtd_nand_read(argv[2], atoi(argv[3]), atoi(argv[4])); } else if (!rt_strcmp(argv[1], "readoob")) { if (argc < 5) { rt_kprintf("The input parameters are too few!\n"); goto help; } mtd_nand_readoob(argv[2], atoi(argv[3]), atoi(argv[4])); } else if (!rt_strcmp(argv[1], "write")) { if (argc < 5) { rt_kprintf("The input parameters are too few!\n"); goto help; } mtd_nand_write(argv[2], atoi(argv[3]), atoi(argv[4])); } else if (!rt_strcmp(argv[1], "erase")) { if (argc < 4) { rt_kprintf("The input parameters are too few!\n"); goto help; } mtd_nand_erase(argv[2], atoi(argv[3])); } else if (!rt_strcmp(argv[1], "eraseall")) { mtd_nand_erase_all(argv[2]); } else { rt_kprintf("Input parameters are not supported!\n"); goto help; } } MSH_CMD_EXPORT(mtd_nand, MTD nand device test function); #endif /* RT_USING_FINSH */ #ifndef RT_USING_FINSH_ONLY FINSH_FUNCTION_EXPORT_ALIAS(mtd_nandid, nand_id, read ID - nandid(name)); FINSH_FUNCTION_EXPORT_ALIAS(mtd_nand_read, nand_read, read page in nand - nand_read(name, block, page)); FINSH_FUNCTION_EXPORT_ALIAS(mtd_nand_readoob, nand_readoob, read spare data in nand - nand_readoob(name, block, page)); FINSH_FUNCTION_EXPORT_ALIAS(mtd_nand_write, nand_write, write dump data to nand - nand_write(name, block, page)); FINSH_FUNCTION_EXPORT_ALIAS(mtd_nand_erase, nand_erase, nand_erase(name, block)); FINSH_FUNCTION_EXPORT_ALIAS(mtd_nand_erase_all, nand_erase_all, erase all of nand device - nand_erase_all(name, block)); #endif /* RT_USING_FINSH_ONLY */ #endif /* defined(RT_MTD_NAND_DEBUG) && defined(RT_USING_FINSH) */ #endif /* RT_USING_MTD_NAND */