-/***************************************************************************\r
- * Copyright (C) 2007 by Dominic Rath *\r
- * Dominic.Rath@gmx.de *\r
- * *\r
- * partially based on *\r
- * drivers/mtd/nand_ids.c *\r
- * *\r
- * Copyright (C) 2002 Thomas Gleixner (tglx@linutronix.de) *\r
- * *\r
- * This program is free software; you can redistribute it and/or modify *\r
- * it under the terms of the GNU General Public License as published by *\r
- * the Free Software Foundation; either version 2 of the License, or *\r
- * (at your option) any later version. *\r
- * *\r
- * This program is distributed in the hope that it will be useful, *\r
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *\r
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *\r
- * GNU General Public License for more details. *\r
- * *\r
- * You should have received a copy of the GNU General Public License *\r
- * along with this program; if not, write to the *\r
- * Free Software Foundation, Inc., *\r
- * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *\r
- ***************************************************************************/\r
-#ifdef HAVE_CONFIG_H\r
-#include "config.h"\r
-#endif\r
-\r
-#include "replacements.h"\r
-#include "log.h"\r
-\r
-#include <stdlib.h>\r
-#include <string.h>\r
-#include <inttypes.h>\r
-\r
-#include <errno.h>\r
-\r
-#include "nand.h"\r
-#include "flash.h"\r
-#include "time_support.h"\r
-#include "fileio.h"\r
-#include "image.h"\r
-\r
-int nand_register_commands(struct command_context_s *cmd_ctx);\r
-int handle_nand_list_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-int handle_nand_probe_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-int handle_nand_check_bad_blocks_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-int handle_nand_info_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-int handle_nand_copy_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-int handle_nand_write_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-int handle_nand_dump_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-int handle_nand_erase_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-\r
-int handle_nand_raw_access_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);\r
-\r
-int nand_read_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);\r
-int nand_read_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);\r
-int nand_read_plain(struct nand_device_s *device, u32 address, u8 *data, u32 data_size);\r
-\r
-int nand_write_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);\r
-int nand_write_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);\r
-\r
-/* NAND flash controller\r
- */\r
-extern nand_flash_controller_t lpc3180_nand_controller;\r
-extern nand_flash_controller_t s3c2410_nand_controller;\r
-extern nand_flash_controller_t s3c2412_nand_controller;\r
-extern nand_flash_controller_t s3c2440_nand_controller;\r
-extern nand_flash_controller_t s3c2443_nand_controller;\r
-\r
-/* extern nand_flash_controller_t boundary_scan_nand_controller; */\r
-\r
-nand_flash_controller_t *nand_flash_controllers[] =\r
-{\r
- &lpc3180_nand_controller,\r
- &s3c2410_nand_controller,\r
- &s3c2412_nand_controller,\r
- &s3c2440_nand_controller,\r
- &s3c2443_nand_controller,\r
-/* &boundary_scan_nand_controller, */\r
- NULL\r
-};\r
-\r
-/* configured NAND devices and NAND Flash command handler */\r
-nand_device_t *nand_devices = NULL;\r
-static command_t *nand_cmd;\r
-\r
-/* Chip ID list\r
- *\r
- * Name, ID code, pagesize, chipsize in MegaByte, eraseblock size,\r
- * options\r
- *\r
- * Pagesize; 0, 256, 512\r
- * 0 get this information from the extended chip ID\r
- * 256 256 Byte page size\r
- * 512 512 Byte page size\r
- */\r
-nand_info_t nand_flash_ids[] =\r
-{\r
- {"NAND 1MiB 5V 8-bit", 0x6e, 256, 1, 0x1000, 0},\r
- {"NAND 2MiB 5V 8-bit", 0x64, 256, 2, 0x1000, 0},\r
- {"NAND 4MiB 5V 8-bit", 0x6b, 512, 4, 0x2000, 0},\r
- {"NAND 1MiB 3,3V 8-bit", 0xe8, 256, 1, 0x1000, 0},\r
- {"NAND 1MiB 3,3V 8-bit", 0xec, 256, 1, 0x1000, 0},\r
- {"NAND 2MiB 3,3V 8-bit", 0xea, 256, 2, 0x1000, 0},\r
- {"NAND 4MiB 3,3V 8-bit", 0xd5, 512, 4, 0x2000, 0},\r
- {"NAND 4MiB 3,3V 8-bit", 0xe3, 512, 4, 0x2000, 0},\r
- {"NAND 4MiB 3,3V 8-bit", 0xe5, 512, 4, 0x2000, 0},\r
- {"NAND 8MiB 3,3V 8-bit", 0xd6, 512, 8, 0x2000, 0},\r
-\r
- {"NAND 8MiB 1,8V 8-bit", 0x39, 512, 8, 0x2000, 0},\r
- {"NAND 8MiB 3,3V 8-bit", 0xe6, 512, 8, 0x2000, 0},\r
- {"NAND 8MiB 1,8V 16-bit", 0x49, 512, 8, 0x2000, NAND_BUSWIDTH_16},\r
- {"NAND 8MiB 3,3V 16-bit", 0x59, 512, 8, 0x2000, NAND_BUSWIDTH_16},\r
-\r
- {"NAND 16MiB 1,8V 8-bit", 0x33, 512, 16, 0x4000, 0},\r
- {"NAND 16MiB 3,3V 8-bit", 0x73, 512, 16, 0x4000, 0},\r
- {"NAND 16MiB 1,8V 16-bit", 0x43, 512, 16, 0x4000, NAND_BUSWIDTH_16},\r
- {"NAND 16MiB 3,3V 16-bit", 0x53, 512, 16, 0x4000, NAND_BUSWIDTH_16},\r
-\r
- {"NAND 32MiB 1,8V 8-bit", 0x35, 512, 32, 0x4000, 0},\r
- {"NAND 32MiB 3,3V 8-bit", 0x75, 512, 32, 0x4000, 0},\r
- {"NAND 32MiB 1,8V 16-bit", 0x45, 512, 32, 0x4000, NAND_BUSWIDTH_16},\r
- {"NAND 32MiB 3,3V 16-bit", 0x55, 512, 32, 0x4000, NAND_BUSWIDTH_16},\r
-\r
- {"NAND 64MiB 1,8V 8-bit", 0x36, 512, 64, 0x4000, 0},\r
- {"NAND 64MiB 3,3V 8-bit", 0x76, 512, 64, 0x4000, 0},\r
- {"NAND 64MiB 1,8V 16-bit", 0x46, 512, 64, 0x4000, NAND_BUSWIDTH_16},\r
- {"NAND 64MiB 3,3V 16-bit", 0x56, 512, 64, 0x4000, NAND_BUSWIDTH_16},\r
-\r
- {"NAND 128MiB 1,8V 8-bit", 0x78, 512, 128, 0x4000, 0},\r
- {"NAND 128MiB 1,8V 8-bit", 0x39, 512, 128, 0x4000, 0},\r
- {"NAND 128MiB 3,3V 8-bit", 0x79, 512, 128, 0x4000, 0},\r
- {"NAND 128MiB 1,8V 16-bit", 0x72, 512, 128, 0x4000, NAND_BUSWIDTH_16},\r
- {"NAND 128MiB 1,8V 16-bit", 0x49, 512, 128, 0x4000, NAND_BUSWIDTH_16},\r
- {"NAND 128MiB 3,3V 16-bit", 0x74, 512, 128, 0x4000, NAND_BUSWIDTH_16},\r
- {"NAND 128MiB 3,3V 16-bit", 0x59, 512, 128, 0x4000, NAND_BUSWIDTH_16},\r
-\r
- {"NAND 256MiB 3,3V 8-bit", 0x71, 512, 256, 0x4000, 0},\r
-\r
- {"NAND 64MiB 1,8V 8-bit", 0xA2, 0, 64, 0, LP_OPTIONS},\r
- {"NAND 64MiB 3,3V 8-bit", 0xF2, 0, 64, 0, LP_OPTIONS},\r
- {"NAND 64MiB 1,8V 16-bit", 0xB2, 0, 64, 0, LP_OPTIONS16},\r
- {"NAND 64MiB 3,3V 16-bit", 0xC2, 0, 64, 0, LP_OPTIONS16},\r
-\r
- {"NAND 128MiB 1,8V 8-bit", 0xA1, 0, 128, 0, LP_OPTIONS},\r
- {"NAND 128MiB 3,3V 8-bit", 0xF1, 0, 128, 0, LP_OPTIONS},\r
- {"NAND 128MiB 1,8V 16-bit", 0xB1, 0, 128, 0, LP_OPTIONS16},\r
- {"NAND 128MiB 3,3V 16-bit", 0xC1, 0, 128, 0, LP_OPTIONS16},\r
-\r
- {"NAND 256MiB 1,8V 8-bit", 0xAA, 0, 256, 0, LP_OPTIONS},\r
- {"NAND 256MiB 3,3V 8-bit", 0xDA, 0, 256, 0, LP_OPTIONS},\r
- {"NAND 256MiB 1,8V 16-bit", 0xBA, 0, 256, 0, LP_OPTIONS16},\r
- {"NAND 256MiB 3,3V 16-bit", 0xCA, 0, 256, 0, LP_OPTIONS16},\r
-\r
- {"NAND 512MiB 1,8V 8-bit", 0xAC, 0, 512, 0, LP_OPTIONS},\r
- {"NAND 512MiB 3,3V 8-bit", 0xDC, 0, 512, 0, LP_OPTIONS},\r
- {"NAND 512MiB 1,8V 16-bit", 0xBC, 0, 512, 0, LP_OPTIONS16},\r
- {"NAND 512MiB 3,3V 16-bit", 0xCC, 0, 512, 0, LP_OPTIONS16},\r
-\r
- {"NAND 1GiB 1,8V 8-bit", 0xA3, 0, 1024, 0, LP_OPTIONS},\r
- {"NAND 1GiB 3,3V 8-bit", 0xD3, 0, 1024, 0, LP_OPTIONS},\r
- {"NAND 1GiB 1,8V 16-bit", 0xB3, 0, 1024, 0, LP_OPTIONS16},\r
- {"NAND 1GiB 3,3V 16-bit", 0xC3, 0, 1024, 0, LP_OPTIONS16},\r
-\r
- {"NAND 2GiB 1,8V 8-bit", 0xA5, 0, 2048, 0, LP_OPTIONS},\r
- {"NAND 2GiB 3,3V 8-bit", 0xD5, 0, 2048, 0, LP_OPTIONS},\r
- {"NAND 2GiB 1,8V 16-bit", 0xB5, 0, 2048, 0, LP_OPTIONS16},\r
- {"NAND 2GiB 3,3V 16-bit", 0xC5, 0, 2048, 0, LP_OPTIONS16},\r
-\r
- {NULL, 0,}\r
-};\r
-\r
-/* Manufacturer ID list\r
- */\r
-nand_manufacturer_t nand_manuf_ids[] =\r
-{\r
- {0x0, "unknown"},\r
- {NAND_MFR_TOSHIBA, "Toshiba"},\r
- {NAND_MFR_SAMSUNG, "Samsung"},\r
- {NAND_MFR_FUJITSU, "Fujitsu"},\r
- {NAND_MFR_NATIONAL, "National"},\r
- {NAND_MFR_RENESAS, "Renesas"},\r
- {NAND_MFR_STMICRO, "ST Micro"},\r
- {NAND_MFR_HYNIX, "Hynix"},\r
- {0x0, NULL},\r
-};\r
-\r
-/* nand device <nand_controller> [controller options]\r
- */\r
-int handle_nand_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- int i;\r
- int retval;\r
- \r
- if (argc < 1)\r
- {\r
- WARNING("incomplete flash device nand configuration");\r
- return ERROR_FLASH_BANK_INVALID;\r
- }\r
- \r
- for (i = 0; nand_flash_controllers[i]; i++)\r
- {\r
- nand_device_t *p, *c;\r
- \r
- if (strcmp(args[0], nand_flash_controllers[i]->name) == 0)\r
- {\r
- /* register flash specific commands */\r
- if (nand_flash_controllers[i]->register_commands(cmd_ctx) != ERROR_OK)\r
- {\r
- ERROR("couldn't register '%s' commands", args[0]);\r
- exit(-1);\r
- }\r
- \r
- c = malloc(sizeof(nand_device_t));\r
-\r
- c->controller = nand_flash_controllers[i];\r
- c->controller_priv = NULL;\r
- c->manufacturer = NULL;\r
- c->device = NULL;\r
- c->bus_width = 0;\r
- c->address_cycles = 0;\r
- c->page_size = 0;\r
- c->use_raw = 0;\r
- c->next = NULL;\r
-\r
- if ((retval = nand_flash_controllers[i]->nand_device_command(cmd_ctx, cmd, args, argc, c)) != ERROR_OK)\r
- {\r
- ERROR("'%s' driver rejected nand flash", c->controller->name);\r
- free(c);\r
- return ERROR_OK;\r
- }\r
- \r
- /* put NAND device in linked list */\r
- if (nand_devices)\r
- {\r
- /* find last flash device */\r
- for (p = nand_devices; p && p->next; p = p->next);\r
- if (p)\r
- p->next = c;\r
- }\r
- else\r
- {\r
- nand_devices = c;\r
- }\r
- \r
- return ERROR_OK;\r
- }\r
- }\r
-\r
- /* no valid NAND controller was found (i.e. the configuration option,\r
- * didn't match one of the compiled-in controllers)\r
- */\r
- ERROR("No valid NAND flash controller found (%s)", args[0]);\r
- ERROR("compiled-in NAND flash controllers:");\r
- for (i = 0; nand_flash_controllers[i]; i++)\r
- {\r
- ERROR("%i: %s", i, nand_flash_controllers[i]->name);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_register_commands(struct command_context_s *cmd_ctx)\r
-{\r
- nand_cmd = register_command(cmd_ctx, NULL, "nand", NULL, COMMAND_ANY, "NAND specific commands");\r
- \r
- register_command(cmd_ctx, nand_cmd, "device", handle_nand_device_command, COMMAND_CONFIG, NULL);\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_init(struct command_context_s *cmd_ctx)\r
-{\r
- if (nand_devices)\r
- {\r
- register_command(cmd_ctx, nand_cmd, "list", handle_nand_list_command, COMMAND_EXEC,\r
- "list configured NAND flash devices");\r
- register_command(cmd_ctx, nand_cmd, "info", handle_nand_info_command, COMMAND_EXEC,\r
- "print info about NAND flash device <num>");\r
- register_command(cmd_ctx, nand_cmd, "probe", handle_nand_probe_command, COMMAND_EXEC,\r
- "identify NAND flash device <num>");\r
- register_command(cmd_ctx, nand_cmd, "check_bad_blocks", handle_nand_check_bad_blocks_command, COMMAND_EXEC,\r
- "check NAND flash device <num> for bad blocks [<first> <last>]");\r
- register_command(cmd_ctx, nand_cmd, "erase", handle_nand_erase_command, COMMAND_EXEC,\r
- "erase blocks on NAND flash device <num> <first> <last>");\r
- register_command(cmd_ctx, nand_cmd, "copy", handle_nand_copy_command, COMMAND_EXEC,\r
- "copy from NAND flash device <num> <offset> <length> <ram-address>");\r
- register_command(cmd_ctx, nand_cmd, "dump", handle_nand_dump_command, COMMAND_EXEC,\r
- "dump from NAND flash device <num> <filename> <offset> <size> [options]");\r
- register_command(cmd_ctx, nand_cmd, "write", handle_nand_write_command, COMMAND_EXEC,\r
- "write to NAND flash device <num> <filename> <offset> [options]");\r
- register_command(cmd_ctx, nand_cmd, "raw_access", handle_nand_raw_access_command, COMMAND_EXEC,\r
- "raw access to NAND flash device <num> ['enable'|'disable']");\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-nand_device_t *get_nand_device_by_num(int num)\r
-{\r
- nand_device_t *p;\r
- int i = 0;\r
-\r
- for (p = nand_devices; p; p = p->next)\r
- {\r
- if (i++ == num)\r
- {\r
- return p;\r
- }\r
- }\r
- \r
- return NULL;\r
-}\r
-\r
-int nand_build_bbt(struct nand_device_s *device, int first, int last)\r
-{\r
- u32 page = 0x0;\r
- int i;\r
- u8 *oob;\r
- \r
- oob = malloc(6);\r
- \r
- if ((first < 0) || (first >= device->num_blocks))\r
- first = 0;\r
- \r
- if ((last >= device->num_blocks) || (last == -1))\r
- last = device->num_blocks - 1;\r
- \r
- for (i = first; i < last; i++)\r
- {\r
- nand_read_page(device, page, NULL, 0, oob, 6);\r
- \r
- if (((device->device->options & NAND_BUSWIDTH_16) && ((oob[0] & oob[1]) != 0xff))\r
- || (((device->page_size == 512) && (oob[5] != 0xff)) ||\r
- ((device->page_size == 2048) && (oob[0] != 0xff))))\r
- {\r
- WARNING("invalid block: %i", i);\r
- device->blocks[i].is_bad = 1;\r
- }\r
- else\r
- {\r
- device->blocks[i].is_bad = 0;\r
- }\r
- \r
- page += (device->erase_size / device->page_size);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_read_status(struct nand_device_s *device, u8 *status)\r
-{\r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
- \r
- /* Send read status command */\r
- device->controller->command(device, NAND_CMD_STATUS);\r
- \r
- usleep(1000);\r
- \r
- /* read status */\r
- if (device->device->options & NAND_BUSWIDTH_16)\r
- {\r
- u16 data;\r
- device->controller->read_data(device, &data);\r
- *status = data & 0xff;\r
- }\r
- else\r
- {\r
- device->controller->read_data(device, status);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_probe(struct nand_device_s *device)\r
-{\r
- u8 manufacturer_id, device_id;\r
- u8 id_buff[5];\r
- int retval;\r
- int i;\r
-\r
- /* clear device data */\r
- device->device = NULL;\r
- device->manufacturer = NULL;\r
- \r
- /* clear device parameters */\r
- device->bus_width = 0;\r
- device->address_cycles = 0;\r
- device->page_size = 0;\r
- device->erase_size = 0;\r
- \r
- /* initialize controller (device parameters are zero, use controller default) */\r
- if ((retval = device->controller->init(device) != ERROR_OK))\r
- {\r
- switch (retval)\r
- {\r
- case ERROR_NAND_OPERATION_FAILED:\r
- DEBUG("controller initialization failed");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- case ERROR_NAND_OPERATION_NOT_SUPPORTED:\r
- ERROR("BUG: controller reported that it doesn't support default parameters");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- default:\r
- ERROR("BUG: unknown controller initialization failure");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- }\r
- \r
- device->controller->command(device, NAND_CMD_RESET);\r
- device->controller->reset(device);\r
-\r
- device->controller->command(device, NAND_CMD_READID);\r
- device->controller->address(device, 0x0);\r
- \r
- if (device->bus_width == 8)\r
- {\r
- device->controller->read_data(device, &manufacturer_id);\r
- device->controller->read_data(device, &device_id);\r
- }\r
- else\r
- {\r
- u16 data_buf;\r
- device->controller->read_data(device, &data_buf);\r
- manufacturer_id = data_buf & 0xff;\r
- device->controller->read_data(device, &data_buf);\r
- device_id = data_buf & 0xff;\r
- }\r
- \r
- for (i = 0; nand_flash_ids[i].name; i++)\r
- {\r
- if (nand_flash_ids[i].id == device_id)\r
- {\r
- device->device = &nand_flash_ids[i];\r
- break;\r
- }\r
- }\r
- \r
- for (i = 0; nand_manuf_ids[i].name; i++)\r
- {\r
- if (nand_manuf_ids[i].id == manufacturer_id)\r
- {\r
- device->manufacturer = &nand_manuf_ids[i];\r
- break;\r
- }\r
- }\r
- \r
- if (!device->manufacturer)\r
- {\r
- device->manufacturer = &nand_manuf_ids[0];\r
- device->manufacturer->id = manufacturer_id;\r
- }\r
- \r
- if (!device->device)\r
- {\r
- ERROR("unknown NAND flash device found, manufacturer id: 0x%2.2x device id: 0x%2.2x",\r
- manufacturer_id, device_id);\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- \r
- DEBUG("found %s (%s)", device->device->name, device->manufacturer->name);\r
- \r
- /* initialize device parameters */\r
- \r
- /* bus width */ \r
- if (device->device->options & NAND_BUSWIDTH_16)\r
- device->bus_width = 16;\r
- else\r
- device->bus_width = 8;\r
-\r
- /* Do we need extended device probe information? */\r
- if (device->device->page_size == 0 ||\r
- device->device->erase_size == 0)\r
- {\r
- if (device->bus_width == 8)\r
- {\r
- device->controller->read_data(device, id_buff+3);\r
- device->controller->read_data(device, id_buff+4);\r
- device->controller->read_data(device, id_buff+5);\r
- }\r
- else\r
- {\r
- u16 data_buf;\r
-\r
- device->controller->read_data(device, &data_buf);\r
- id_buff[3] = data_buf;\r
-\r
- device->controller->read_data(device, &data_buf);\r
- id_buff[4] = data_buf;\r
-\r
- device->controller->read_data(device, &data_buf);\r
- id_buff[5] = data_buf >> 8;\r
- }\r
- }\r
- \r
- /* page size */\r
- if (device->device->page_size == 0)\r
- {\r
- device->page_size = 1 << (10 + (id_buff[4] & 3));\r
- }\r
- else if (device->device->page_size == 256)\r
- {\r
- ERROR("NAND flashes with 256 byte pagesize are not supported");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- else\r
- {\r
- device->page_size = device->device->page_size;\r
- }\r
- \r
- /* number of address cycles */\r
- if (device->page_size <= 512)\r
- {\r
- /* small page devices */\r
- if (device->device->chip_size <= 32)\r
- device->address_cycles = 3;\r
- else if (device->device->chip_size <= 8*1024)\r
- device->address_cycles = 4;\r
- else\r
- {\r
- ERROR("BUG: small page NAND device with more than 8 GiB encountered");\r
- device->address_cycles = 5;\r
- }\r
- }\r
- else\r
- {\r
- /* large page devices */\r
- if (device->device->chip_size <= 128)\r
- device->address_cycles = 4;\r
- else if (device->device->chip_size <= 32*1024)\r
- device->address_cycles = 5;\r
- else\r
- {\r
- ERROR("BUG: small page NAND device with more than 32 GiB encountered");\r
- device->address_cycles = 6;\r
- }\r
- }\r
- \r
- /* erase size */\r
- if (device->device->erase_size == 0)\r
- {\r
- switch ((id_buff[4] >> 4) & 3) {\r
- case 0:\r
- device->erase_size = 64 << 10;\r
- break;\r
- case 1:\r
- device->erase_size = 128 << 10;\r
- break;\r
- case 2:\r
- device->erase_size = 256 << 10;\r
- break;\r
- case 3:\r
- device->erase_size =512 << 10;\r
- break;\r
- }\r
- }\r
- else\r
- {\r
- device->erase_size = device->device->erase_size;\r
- }\r
- \r
- /* initialize controller, but leave parameters at the controllers default */\r
- if ((retval = device->controller->init(device) != ERROR_OK))\r
- {\r
- switch (retval)\r
- {\r
- case ERROR_NAND_OPERATION_FAILED:\r
- DEBUG("controller initialization failed");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- case ERROR_NAND_OPERATION_NOT_SUPPORTED:\r
- ERROR("controller doesn't support requested parameters (buswidth: %i, address cycles: %i, page size: %i)",\r
- device->bus_width, device->address_cycles, device->page_size);\r
- return ERROR_NAND_OPERATION_FAILED;\r
- default:\r
- ERROR("BUG: unknown controller initialization failure");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- }\r
- \r
- device->num_blocks = (device->device->chip_size * 1024) / (device->erase_size / 1024);\r
- device->blocks = malloc(sizeof(nand_block_t) * device->num_blocks);\r
- \r
- for (i = 0; i < device->num_blocks; i++)\r
- {\r
- device->blocks[i].size = device->erase_size;\r
- device->blocks[i].offset = i * device->erase_size;\r
- device->blocks[i].is_erased = -1;\r
- device->blocks[i].is_bad = -1;\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_erase(struct nand_device_s *device, int first_block, int last_block)\r
-{\r
- int i;\r
- u32 page;\r
- u8 status;\r
- int retval;\r
- \r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
- \r
- if ((first_block < 0) || (last_block > device->num_blocks))\r
- return ERROR_INVALID_ARGUMENTS;\r
- \r
- /* make sure we know if a block is bad before erasing it */\r
- for (i = first_block; i <= last_block; i++)\r
- {\r
- if (device->blocks[i].is_bad == -1)\r
- {\r
- nand_build_bbt(device, i, last_block);\r
- break;\r
- }\r
- }\r
- \r
- for (i = first_block; i <= last_block; i++)\r
- {\r
- /* Send erase setup command */\r
- device->controller->command(device, NAND_CMD_ERASE1);\r
- \r
- page = i * (device->erase_size / device->page_size);\r
- \r
- /* Send page address */\r
- if (device->page_size <= 512)\r
- {\r
- /* row */\r
- device->controller->address(device, page & 0xff);\r
- device->controller->address(device, (page >> 8) & 0xff);\r
- \r
- /* 3rd cycle only on devices with more than 32 MiB */\r
- if (device->address_cycles >= 4)\r
- device->controller->address(device, (page >> 16) & 0xff);\r
- \r
- /* 4th cycle only on devices with more than 8 GiB */\r
- if (device->address_cycles >= 5)\r
- device->controller->address(device, (page >> 24) & 0xff);\r
- }\r
- else\r
- {\r
- /* row */\r
- device->controller->address(device, page & 0xff);\r
- device->controller->address(device, (page >> 8) & 0xff);\r
- \r
- /* 3rd cycle only on devices with more than 128 MiB */\r
- if (device->address_cycles >= 5)\r
- device->controller->address(device, (page >> 16) & 0xff);\r
- }\r
- \r
- /* Send erase confirm command */\r
- device->controller->command(device, NAND_CMD_ERASE2);\r
- \r
- if (!device->controller->nand_ready(device, 1000))\r
- {\r
- ERROR("timeout waiting for NAND flash block erase to complete");\r
- return ERROR_NAND_OPERATION_TIMEOUT;\r
- }\r
- \r
- if ((retval = nand_read_status(device, &status)) != ERROR_OK)\r
- {\r
- ERROR("couldn't read status");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- \r
- if (status & 0x1)\r
- {\r
- ERROR("erase operation didn't pass, status: 0x%2.2x", status);\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_read_plain(struct nand_device_s *device, u32 address, u8 *data, u32 data_size)\r
-{\r
- u8 *page;\r
- \r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
- \r
- if (address % device->page_size)\r
- {\r
- ERROR("reads need to be page aligned");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- \r
- page = malloc(device->page_size);\r
- \r
- while (data_size > 0 )\r
- {\r
- u32 thisrun_size = (data_size > device->page_size) ? device->page_size : data_size;\r
- u32 page_address;\r
- \r
- \r
- page_address = address / device->page_size;\r
- \r
- nand_read_page(device, page_address, page, device->page_size, NULL, 0);\r
-\r
- memcpy(data, page, thisrun_size);\r
- \r
- address += thisrun_size;\r
- data += thisrun_size;\r
- data_size -= thisrun_size;\r
- }\r
- \r
- free(page);\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_write_plain(struct nand_device_s *device, u32 address, u8 *data, u32 data_size)\r
-{\r
- u8 *page;\r
- \r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
- \r
- if (address % device->page_size)\r
- {\r
- ERROR("writes need to be page aligned");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- \r
- page = malloc(device->page_size);\r
- \r
- while (data_size > 0 )\r
- {\r
- u32 thisrun_size = (data_size > device->page_size) ? device->page_size : data_size;\r
- u32 page_address;\r
- \r
- memset(page, 0xff, device->page_size);\r
- memcpy(page, data, thisrun_size);\r
- \r
- page_address = address / device->page_size;\r
- \r
- nand_write_page(device, page_address, page, device->page_size, NULL, 0);\r
- \r
- address += thisrun_size;\r
- data += thisrun_size;\r
- data_size -= thisrun_size;\r
- }\r
- \r
- free(page);\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int nand_write_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)\r
-{\r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
- \r
- if (device->use_raw || device->controller->write_page == NULL)\r
- return nand_write_page_raw(device, page, data, data_size, oob, oob_size);\r
- else\r
- return device->controller->write_page(device, page, data, data_size, oob, oob_size);\r
-}\r
-\r
-int nand_read_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)\r
-{\r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
- \r
- if (device->use_raw || device->controller->read_page == NULL)\r
- return nand_read_page_raw(device, page, data, data_size, oob, oob_size);\r
- else\r
- return device->controller->read_page(device, page, data, data_size, oob, oob_size);\r
-}\r
-\r
-int nand_read_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)\r
-{\r
- int i;\r
- \r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
-\r
- if (device->page_size <= 512)\r
- {\r
- /* small page device */\r
- if (data)\r
- device->controller->command(device, NAND_CMD_READ0);\r
- else\r
- device->controller->command(device, NAND_CMD_READOOB);\r
- \r
- /* column (always 0, we start at the beginning of a page/OOB area) */\r
- device->controller->address(device, 0x0);\r
- \r
- /* row */\r
- device->controller->address(device, page & 0xff);\r
- device->controller->address(device, (page >> 8) & 0xff);\r
- \r
- /* 4th cycle only on devices with more than 32 MiB */\r
- if (device->address_cycles >= 4)\r
- device->controller->address(device, (page >> 16) & 0xff);\r
-\r
- /* 5th cycle only on devices with more than 8 GiB */\r
- if (device->address_cycles >= 5)\r
- device->controller->address(device, (page >> 24) & 0xff);\r
- }\r
- else\r
- {\r
- /* large page device */\r
- device->controller->command(device, NAND_CMD_READ0);\r
- \r
- /* column (0 when we start at the beginning of a page,\r
- * or 2048 for the beginning of OOB area)\r
- */\r
- device->controller->address(device, 0x0);\r
- device->controller->address(device, 0x8);\r
- \r
- /* row */\r
- device->controller->address(device, page & 0xff);\r
- device->controller->address(device, (page >> 8) & 0xff);\r
-\r
- /* 5th cycle only on devices with more than 128 MiB */\r
- if (device->address_cycles >= 5)\r
- device->controller->address(device, (page >> 16) & 0xff);\r
-\r
- /* large page devices need a start command */\r
- device->controller->command(device, NAND_CMD_READSTART);\r
- }\r
- \r
- if (!device->controller->nand_ready(device, 100))\r
- return ERROR_NAND_OPERATION_TIMEOUT;\r
- \r
- if (data)\r
- {\r
- if (device->controller->read_block_data != NULL)\r
- (device->controller->read_block_data)(device, data, data_size);\r
- else\r
- {\r
- for (i = 0; i < data_size;)\r
- {\r
- if (device->device->options & NAND_BUSWIDTH_16)\r
- {\r
- device->controller->read_data(device, data);\r
- data += 2;\r
- i += 2;\r
- }\r
- else\r
- {\r
- device->controller->read_data(device, data);\r
- data += 1;\r
- i += 1;\r
- }\r
- }\r
- }\r
- }\r
- \r
- if (oob)\r
- {\r
- if (device->controller->read_block_data != NULL)\r
- (device->controller->read_block_data)(device, oob, oob_size);\r
- else\r
- {\r
- for (i = 0; i < oob_size;)\r
- {\r
- if (device->device->options & NAND_BUSWIDTH_16)\r
- {\r
- device->controller->read_data(device, oob);\r
- oob += 2;\r
- i += 2;\r
- }\r
- else\r
- {\r
- device->controller->read_data(device, oob);\r
- oob += 1;\r
- i += 1;\r
- }\r
- }\r
- }\r
- }\r
- \r
- return ERROR_OK; \r
-}\r
-\r
-int nand_write_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)\r
-{\r
- int i;\r
- int retval;\r
- u8 status;\r
- \r
- if (!device->device)\r
- return ERROR_NAND_DEVICE_NOT_PROBED;\r
-\r
- device->controller->command(device, NAND_CMD_SEQIN);\r
- \r
- if (device->page_size <= 512)\r
- {\r
- /* column (always 0, we start at the beginning of a page/OOB area) */\r
- device->controller->address(device, 0x0);\r
- \r
- /* row */\r
- device->controller->address(device, page & 0xff);\r
- device->controller->address(device, (page >> 8) & 0xff);\r
- \r
- /* 4th cycle only on devices with more than 32 MiB */\r
- if (device->address_cycles >= 4)\r
- device->controller->address(device, (page >> 16) & 0xff);\r
-\r
- /* 5th cycle only on devices with more than 8 GiB */\r
- if (device->address_cycles >= 5)\r
- device->controller->address(device, (page >> 24) & 0xff);\r
- }\r
- else\r
- {\r
- /* column (0 when we start at the beginning of a page,\r
- * or 2048 for the beginning of OOB area)\r
- */\r
- device->controller->address(device, 0x0);\r
- device->controller->address(device, 0x8);\r
- \r
- /* row */\r
- device->controller->address(device, page & 0xff);\r
- device->controller->address(device, (page >> 8) & 0xff);\r
-\r
- /* 5th cycle only on devices with more than 128 MiB */\r
- if (device->address_cycles >= 5)\r
- device->controller->address(device, (page >> 16) & 0xff);\r
- }\r
- \r
- if (data)\r
- {\r
- if (device->controller->write_block_data != NULL)\r
- (device->controller->write_block_data)(device, data, data_size);\r
- else\r
- {\r
- for (i = 0; i < data_size;)\r
- {\r
- if (device->device->options & NAND_BUSWIDTH_16)\r
- {\r
- u16 data_buf = le_to_h_u16(data);\r
- device->controller->write_data(device, data_buf);\r
- data += 2;\r
- i += 2;\r
- }\r
- else\r
- {\r
- device->controller->write_data(device, *data);\r
- data += 1;\r
- i += 1;\r
- }\r
- }\r
- }\r
- }\r
- \r
- if (oob)\r
- {\r
- if (device->controller->write_block_data != NULL)\r
- (device->controller->write_block_data)(device, oob, oob_size);\r
- else\r
- {\r
- for (i = 0; i < oob_size;)\r
- {\r
- if (device->device->options & NAND_BUSWIDTH_16)\r
- {\r
- u16 oob_buf = le_to_h_u16(data);\r
- device->controller->write_data(device, oob_buf);\r
- oob += 2;\r
- i += 2;\r
- }\r
- else\r
- {\r
- device->controller->write_data(device, *oob);\r
- oob += 1;\r
- i += 1;\r
- }\r
- }\r
- }\r
- }\r
- \r
- device->controller->command(device, NAND_CMD_PAGEPROG);\r
- \r
- if (!device->controller->nand_ready(device, 100))\r
- return ERROR_NAND_OPERATION_TIMEOUT;\r
- \r
- if ((retval = nand_read_status(device, &status)) != ERROR_OK)\r
- {\r
- ERROR("couldn't read status");\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- \r
- if (status & NAND_STATUS_FAIL)\r
- {\r
- ERROR("write operation didn't pass, status: 0x%2.2x", status);\r
- return ERROR_NAND_OPERATION_FAILED;\r
- }\r
- \r
- return ERROR_OK; \r
-}\r
-\r
-int handle_nand_list_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- int i = 0;\r
- \r
- if (!nand_devices)\r
- {\r
- command_print(cmd_ctx, "no NAND flash devices configured");\r
- return ERROR_OK;\r
- }\r
- \r
- for (p = nand_devices; p; p = p->next)\r
- {\r
- if (p->device)\r
- command_print(cmd_ctx, "#%i: %s (%s) pagesize: %i, buswidth: %i, erasesize: %i",\r
- i++, p->device->name, p->manufacturer->name, p->page_size, p->bus_width, p->erase_size);\r
- else\r
- command_print(cmd_ctx, "#%i: not probed");\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_info_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- int i = 0;\r
- int j = 0;\r
- int first = -1;\r
- int last = -1;\r
- \r
- if ((argc < 1) || (argc > 3))\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
-\r
- }\r
- \r
- if (argc == 2)\r
- {\r
- first = last = strtoul(args[1], NULL, 0);\r
- }\r
- else if (argc == 3)\r
- {\r
- first = strtoul(args[1], NULL, 0);\r
- last = strtoul(args[2], NULL, 0);\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
- if (p->device)\r
- {\r
- if (first >= p->num_blocks)\r
- first = p->num_blocks - 1;\r
- \r
- if (last >= p->num_blocks)\r
- last = p->num_blocks - 1;\r
- \r
- command_print(cmd_ctx, "#%i: %s (%s) pagesize: %i, buswidth: %i, erasesize: %i",\r
- i++, p->device->name, p->manufacturer->name, p->page_size, p->bus_width, p->erase_size);\r
- \r
- for (j = first; j <= last; j++)\r
- {\r
- char *erase_state, *bad_state;\r
- \r
- if (p->blocks[j].is_erased == 0)\r
- erase_state = "not erased";\r
- else if (p->blocks[j].is_erased == 1)\r
- erase_state = "erased";\r
- else\r
- erase_state = "erase state unknown";\r
- \r
- if (p->blocks[j].is_bad == 0)\r
- bad_state = "";\r
- else if (p->blocks[j].is_bad == 1)\r
- bad_state = " (marked bad)";\r
- else\r
- bad_state = " (block condition unknown)";\r
-\r
- command_print(cmd_ctx, "\t#%i: 0x%8.8x (0x%xkB) %s%s",\r
- j, p->blocks[j].offset, p->blocks[j].size / 1024,\r
- erase_state, bad_state);\r
- }\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "#%i: not probed");\r
- }\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_probe_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- int retval;\r
- \r
- if (argc != 1)\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
- if ((retval = nand_probe(p)) == ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "NAND flash device '%s' found", p->device->name);\r
- }\r
- else if (retval == ERROR_NAND_OPERATION_FAILED)\r
- {\r
- command_print(cmd_ctx, "probing failed for NAND flash device");\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "unknown error when probing NAND flash device");\r
- }\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_erase_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- int retval;\r
- \r
- if (argc != 3)\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
-\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
- int first = strtoul(args[1], NULL, 0);\r
- int last = strtoul(args[2], NULL, 0);\r
- \r
- if ((retval = nand_erase(p, first, last)) == ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "successfully erased blocks %i to %i on NAND flash device '%s'", first, last, p->device->name);\r
- }\r
- else if (retval == ERROR_NAND_OPERATION_FAILED)\r
- {\r
- command_print(cmd_ctx, "erase failed");\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "unknown error when erasing NAND flash device");\r
- }\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_check_bad_blocks_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- int retval;\r
- int first = -1;\r
- int last = -1;\r
- \r
- if ((argc < 1) || (argc > 3) || (argc == 2))\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
-\r
- }\r
- \r
- if (argc == 3)\r
- {\r
- first = strtoul(args[1], NULL, 0);\r
- last = strtoul(args[2], NULL, 0);\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
- if ((retval = nand_build_bbt(p, first, last)) == ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "checked NAND flash device for bad blocks, use \"nand info\" command to list blocks", p->device->name);\r
- }\r
- else if (retval == ERROR_NAND_OPERATION_FAILED)\r
- {\r
- command_print(cmd_ctx, "error when checking for bad blocks on NAND flash device");\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "unknown error when checking for bad blocks on NAND flash device");\r
- }\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_copy_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- \r
- if (argc != 4)\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
-\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
-\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_write_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- u32 offset;\r
- u32 binary_size;\r
- u32 buf_cnt;\r
- enum oob_formats oob_format = NAND_OOB_NONE;\r
- \r
- fileio_t fileio;\r
- \r
- duration_t duration;\r
- char *duration_text;\r
- \r
- nand_device_t *p;\r
- \r
- if (argc < 3)\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
-\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
- u8 *page = NULL;\r
- u32 page_size = 0;\r
- u8 *oob = NULL;\r
- u32 oob_size = 0;\r
- \r
- duration_start_measure(&duration);\r
- offset = strtoul(args[2], NULL, 0);\r
- \r
- if (argc > 3)\r
- {\r
- int i;\r
- for (i = 3; i < argc; i++)\r
- {\r
- if (!strcmp(args[i], "oob_raw"))\r
- oob_format |= NAND_OOB_RAW;\r
- else if (!strcmp(args[i], "oob_only"))\r
- oob_format |= NAND_OOB_RAW | NAND_OOB_ONLY;\r
- else\r
- {\r
- command_print(cmd_ctx, "unknown option: %s", args[i]);\r
- }\r
- }\r
- }\r
- \r
- if (fileio_open(&fileio, args[1], FILEIO_READ, FILEIO_BINARY) != ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "file open error: %s", fileio.error_str);\r
- return ERROR_OK;\r
- }\r
- \r
- buf_cnt = binary_size = fileio.size;\r
- \r
- if (!(oob_format & NAND_OOB_ONLY))\r
- {\r
- page_size = p->page_size;\r
- page = malloc(p->page_size);\r
- }\r
-\r
- if (oob_format & NAND_OOB_RAW)\r
- {\r
- if (p->page_size == 512)\r
- oob_size = 16;\r
- else if (p->page_size == 2048)\r
- oob_size = 64;\r
- oob = malloc(oob_size);\r
- }\r
- \r
- if (offset % p->page_size)\r
- {\r
- command_print(cmd_ctx, "only page size aligned offsets and sizes are supported");\r
- return ERROR_OK;\r
- }\r
- \r
- while (buf_cnt > 0)\r
- {\r
- u32 size_read;\r
- \r
- if (page)\r
- {\r
- fileio_read(&fileio, page_size, page, &size_read);\r
- buf_cnt -= size_read;\r
- if (size_read < page_size)\r
- {\r
- memset(page + size_read, 0xff, page_size - size_read);\r
- }\r
- }\r
- \r
- if (oob)\r
- {\r
- fileio_read(&fileio, oob_size, oob, &size_read);\r
- buf_cnt -= size_read;\r
- if (size_read < oob_size)\r
- {\r
- memset(oob + size_read, 0xff, oob_size - size_read);\r
- }\r
- }\r
- \r
- if (nand_write_page(p, offset / p->page_size, page, page_size, oob, oob_size) != ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "failed writing file %s to NAND flash %s at offset 0x%8.8x",\r
- args[1], args[0], offset);\r
- return ERROR_OK;\r
- }\r
- offset += page_size;\r
- }\r
-\r
- fileio_close(&fileio);\r
- \r
- duration_stop_measure(&duration, &duration_text);\r
- command_print(cmd_ctx, "wrote file %s to NAND flash %s at offset 0x%8.8x in %s",\r
- args[1], args[0], offset, duration_text);\r
- free(duration_text);\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_dump_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- \r
- if (argc < 4)\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
- if (p->device)\r
- {\r
- fileio_t fileio;\r
- duration_t duration;\r
- char *duration_text;\r
- int retval;\r
- \r
- u8 *page = NULL;\r
- u32 page_size = 0;\r
- u8 *oob = NULL;\r
- u32 oob_size = 0;\r
- u32 address = strtoul(args[2], NULL, 0);\r
- u32 size = strtoul(args[3], NULL, 0);\r
- u32 bytes_done = 0;\r
- enum oob_formats oob_format = NAND_OOB_NONE;\r
- \r
- if (argc > 4)\r
- {\r
- int i;\r
- for (i = 4; i < argc; i++)\r
- {\r
- if (!strcmp(args[i], "oob_raw"))\r
- oob_format |= NAND_OOB_RAW;\r
- else if (!strcmp(args[i], "oob_only"))\r
- oob_format |= NAND_OOB_RAW | NAND_OOB_ONLY;\r
- else\r
- command_print(cmd_ctx, "unknown option: '%s'", args[i]); \r
- }\r
- }\r
- \r
- if ((address % p->page_size) || (size % p->page_size))\r
- {\r
- command_print(cmd_ctx, "only page size aligned addresses and sizes are supported");\r
- return ERROR_OK;\r
- }\r
- \r
- if (!(oob_format & NAND_OOB_ONLY))\r
- {\r
- page_size = p->page_size;\r
- page = malloc(p->page_size);\r
- }\r
-\r
- if (oob_format & NAND_OOB_RAW)\r
- {\r
- if (p->page_size == 512)\r
- oob_size = 16;\r
- else if (p->page_size == 2048)\r
- oob_size = 64;\r
- oob = malloc(oob_size);\r
- }\r
- \r
- if (fileio_open(&fileio, args[1], FILEIO_WRITE, FILEIO_BINARY) != ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "dump_image error: %s", fileio.error_str);\r
- return ERROR_OK;\r
- }\r
- \r
- duration_start_measure(&duration);\r
- \r
- while (size > 0)\r
- {\r
- u32 size_written;\r
- if ((retval = nand_read_page(p, address / p->page_size, page, page_size, oob, oob_size)) != ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "reading NAND flash page failed");\r
- return ERROR_OK;\r
- }\r
- \r
- if (page)\r
- {\r
- fileio_write(&fileio, page_size, page, &size_written);\r
- bytes_done += page_size;\r
- }\r
- \r
- if (oob)\r
- {\r
- fileio_write(&fileio, oob_size, oob, &size_written);\r
- bytes_done += oob_size;\r
- }\r
- \r
- size -= p->page_size;\r
- address += p->page_size;\r
- }\r
- \r
- if (page)\r
- free(page);\r
- \r
- if (oob)\r
- free(oob);\r
- \r
- fileio_close(&fileio);\r
-\r
- duration_stop_measure(&duration, &duration_text);\r
- command_print(cmd_ctx, "dumped %"PRIi64" byte in %s", fileio.size, duration_text);\r
- free(duration_text);\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "#%i: not probed");\r
- }\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int handle_nand_raw_access_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- nand_device_t *p;\r
- \r
- if ((argc < 1) || (argc > 2))\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
- }\r
- \r
- p = get_nand_device_by_num(strtoul(args[0], NULL, 0));\r
- if (p)\r
- {\r
- if (p->device)\r
- {\r
- if (argc == 2)\r
- {\r
- if (strcmp("enable", args[1]) == 0)\r
- {\r
- p->use_raw = 1;\r
- }\r
- else if (strcmp("disable", args[1]) == 0)\r
- {\r
- p->use_raw = 0;\r
- }\r
- else\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
- }\r
- }\r
- \r
- command_print(cmd_ctx, "raw access is %s", (p->use_raw) ? "enabled" : "disabled");\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "#%i: not probed");\r
- }\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);\r
- }\r
- \r
- return ERROR_OK;\r
-}\r
-\r
+/***************************************************************************
+ * Copyright (C) 2007 by Dominic Rath *
+ * Dominic.Rath@gmx.de *
+ * *
+ * Partially based on drivers/mtd/nand_ids.c from Linux. *
+ * Copyright (C) 2002 Thomas Gleixner <tglx@linutronix.de> *
+ * *
+ * This program is free software; you can redistribute it and/or modify *
+ * it under the terms of the GNU General Public License as published by *
+ * the Free Software Foundation; either version 2 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 *
+ * GNU General Public License for more details. *
+ * *
+ * You should have received a copy of the GNU General Public License *
+ * along with this program; if not, write to the *
+ * Free Software Foundation, Inc., *
+ * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
+ ***************************************************************************/
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include "replacements.h"
+#include "log.h"
+
+#include <stdlib.h>
+#include <string.h>
+#include <inttypes.h>
+
+#include <errno.h>
+
+#include "nand.h"
+#include "flash.h"
+#include "time_support.h"
+#include "fileio.h"
+#include "image.h"
+
+int nand_register_commands(struct command_context_s *cmd_ctx);
+int handle_nand_list_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_nand_probe_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_nand_check_bad_blocks_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_nand_info_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_nand_copy_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_nand_write_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_nand_dump_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_nand_erase_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+
+int handle_nand_raw_access_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+
+int nand_read_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);
+int nand_read_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);
+int nand_read_plain(struct nand_device_s *device, u32 address, u8 *data, u32 data_size);
+
+int nand_write_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);
+int nand_write_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size);
+
+/* NAND flash controller
+ */
+extern nand_flash_controller_t lpc3180_nand_controller;
+extern nand_flash_controller_t s3c2410_nand_controller;
+extern nand_flash_controller_t s3c2412_nand_controller;
+extern nand_flash_controller_t s3c2440_nand_controller;
+extern nand_flash_controller_t s3c2443_nand_controller;
+
+/* extern nand_flash_controller_t boundary_scan_nand_controller; */
+
+nand_flash_controller_t *nand_flash_controllers[] =
+{
+ &lpc3180_nand_controller,
+ &s3c2410_nand_controller,
+ &s3c2412_nand_controller,
+ &s3c2440_nand_controller,
+ &s3c2443_nand_controller,
+/* &boundary_scan_nand_controller, */
+ NULL
+};
+
+/* configured NAND devices and NAND Flash command handler */
+nand_device_t *nand_devices = NULL;
+static command_t *nand_cmd;
+
+/* Chip ID list
+ *
+ * Name, ID code, pagesize, chipsize in MegaByte, eraseblock size,
+ * options
+ *
+ * Pagesize; 0, 256, 512
+ * 0 get this information from the extended chip ID
+ * 256 256 Byte page size
+ * 512 512 Byte page size
+ */
+nand_info_t nand_flash_ids[] =
+{
+ {"NAND 1MiB 5V 8-bit", 0x6e, 256, 1, 0x1000, 0},
+ {"NAND 2MiB 5V 8-bit", 0x64, 256, 2, 0x1000, 0},
+ {"NAND 4MiB 5V 8-bit", 0x6b, 512, 4, 0x2000, 0},
+ {"NAND 1MiB 3,3V 8-bit", 0xe8, 256, 1, 0x1000, 0},
+ {"NAND 1MiB 3,3V 8-bit", 0xec, 256, 1, 0x1000, 0},
+ {"NAND 2MiB 3,3V 8-bit", 0xea, 256, 2, 0x1000, 0},
+ {"NAND 4MiB 3,3V 8-bit", 0xd5, 512, 4, 0x2000, 0},
+ {"NAND 4MiB 3,3V 8-bit", 0xe3, 512, 4, 0x2000, 0},
+ {"NAND 4MiB 3,3V 8-bit", 0xe5, 512, 4, 0x2000, 0},
+ {"NAND 8MiB 3,3V 8-bit", 0xd6, 512, 8, 0x2000, 0},
+
+ {"NAND 8MiB 1,8V 8-bit", 0x39, 512, 8, 0x2000, 0},
+ {"NAND 8MiB 3,3V 8-bit", 0xe6, 512, 8, 0x2000, 0},
+ {"NAND 8MiB 1,8V 16-bit", 0x49, 512, 8, 0x2000, NAND_BUSWIDTH_16},
+ {"NAND 8MiB 3,3V 16-bit", 0x59, 512, 8, 0x2000, NAND_BUSWIDTH_16},
+
+ {"NAND 16MiB 1,8V 8-bit", 0x33, 512, 16, 0x4000, 0},
+ {"NAND 16MiB 3,3V 8-bit", 0x73, 512, 16, 0x4000, 0},
+ {"NAND 16MiB 1,8V 16-bit", 0x43, 512, 16, 0x4000, NAND_BUSWIDTH_16},
+ {"NAND 16MiB 3,3V 16-bit", 0x53, 512, 16, 0x4000, NAND_BUSWIDTH_16},
+
+ {"NAND 32MiB 1,8V 8-bit", 0x35, 512, 32, 0x4000, 0},
+ {"NAND 32MiB 3,3V 8-bit", 0x75, 512, 32, 0x4000, 0},
+ {"NAND 32MiB 1,8V 16-bit", 0x45, 512, 32, 0x4000, NAND_BUSWIDTH_16},
+ {"NAND 32MiB 3,3V 16-bit", 0x55, 512, 32, 0x4000, NAND_BUSWIDTH_16},
+
+ {"NAND 64MiB 1,8V 8-bit", 0x36, 512, 64, 0x4000, 0},
+ {"NAND 64MiB 3,3V 8-bit", 0x76, 512, 64, 0x4000, 0},
+ {"NAND 64MiB 1,8V 16-bit", 0x46, 512, 64, 0x4000, NAND_BUSWIDTH_16},
+ {"NAND 64MiB 3,3V 16-bit", 0x56, 512, 64, 0x4000, NAND_BUSWIDTH_16},
+
+ {"NAND 128MiB 1,8V 8-bit", 0x78, 512, 128, 0x4000, 0},
+ {"NAND 128MiB 1,8V 8-bit", 0x39, 512, 128, 0x4000, 0},
+ {"NAND 128MiB 3,3V 8-bit", 0x79, 512, 128, 0x4000, 0},
+ {"NAND 128MiB 1,8V 16-bit", 0x72, 512, 128, 0x4000, NAND_BUSWIDTH_16},
+ {"NAND 128MiB 1,8V 16-bit", 0x49, 512, 128, 0x4000, NAND_BUSWIDTH_16},
+ {"NAND 128MiB 3,3V 16-bit", 0x74, 512, 128, 0x4000, NAND_BUSWIDTH_16},
+ {"NAND 128MiB 3,3V 16-bit", 0x59, 512, 128, 0x4000, NAND_BUSWIDTH_16},
+
+ {"NAND 256MiB 3,3V 8-bit", 0x71, 512, 256, 0x4000, 0},
+
+ {"NAND 64MiB 1,8V 8-bit", 0xA2, 0, 64, 0, LP_OPTIONS},
+ {"NAND 64MiB 3,3V 8-bit", 0xF2, 0, 64, 0, LP_OPTIONS},
+ {"NAND 64MiB 1,8V 16-bit", 0xB2, 0, 64, 0, LP_OPTIONS16},
+ {"NAND 64MiB 3,3V 16-bit", 0xC2, 0, 64, 0, LP_OPTIONS16},
+
+ {"NAND 128MiB 1,8V 8-bit", 0xA1, 0, 128, 0, LP_OPTIONS},
+ {"NAND 128MiB 3,3V 8-bit", 0xF1, 0, 128, 0, LP_OPTIONS},
+ {"NAND 128MiB 1,8V 16-bit", 0xB1, 0, 128, 0, LP_OPTIONS16},
+ {"NAND 128MiB 3,3V 16-bit", 0xC1, 0, 128, 0, LP_OPTIONS16},
+
+ {"NAND 256MiB 1,8V 8-bit", 0xAA, 0, 256, 0, LP_OPTIONS},
+ {"NAND 256MiB 3,3V 8-bit", 0xDA, 0, 256, 0, LP_OPTIONS},
+ {"NAND 256MiB 1,8V 16-bit", 0xBA, 0, 256, 0, LP_OPTIONS16},
+ {"NAND 256MiB 3,3V 16-bit", 0xCA, 0, 256, 0, LP_OPTIONS16},
+
+ {"NAND 512MiB 1,8V 8-bit", 0xAC, 0, 512, 0, LP_OPTIONS},
+ {"NAND 512MiB 3,3V 8-bit", 0xDC, 0, 512, 0, LP_OPTIONS},
+ {"NAND 512MiB 1,8V 16-bit", 0xBC, 0, 512, 0, LP_OPTIONS16},
+ {"NAND 512MiB 3,3V 16-bit", 0xCC, 0, 512, 0, LP_OPTIONS16},
+
+ {"NAND 1GiB 1,8V 8-bit", 0xA3, 0, 1024, 0, LP_OPTIONS},
+ {"NAND 1GiB 3,3V 8-bit", 0xD3, 0, 1024, 0, LP_OPTIONS},
+ {"NAND 1GiB 1,8V 16-bit", 0xB3, 0, 1024, 0, LP_OPTIONS16},
+ {"NAND 1GiB 3,3V 16-bit", 0xC3, 0, 1024, 0, LP_OPTIONS16},
+
+ {"NAND 2GiB 1,8V 8-bit", 0xA5, 0, 2048, 0, LP_OPTIONS},
+ {"NAND 2GiB 3,3V 8-bit", 0xD5, 0, 2048, 0, LP_OPTIONS},
+ {"NAND 2GiB 1,8V 16-bit", 0xB5, 0, 2048, 0, LP_OPTIONS16},
+ {"NAND 2GiB 3,3V 16-bit", 0xC5, 0, 2048, 0, LP_OPTIONS16},
+
+ {NULL, 0,}
+};
+
+/* Manufacturer ID list
+ */
+nand_manufacturer_t nand_manuf_ids[] =
+{
+ {0x0, "unknown"},
+ {NAND_MFR_TOSHIBA, "Toshiba"},
+ {NAND_MFR_SAMSUNG, "Samsung"},
+ {NAND_MFR_FUJITSU, "Fujitsu"},
+ {NAND_MFR_NATIONAL, "National"},
+ {NAND_MFR_RENESAS, "Renesas"},
+ {NAND_MFR_STMICRO, "ST Micro"},
+ {NAND_MFR_HYNIX, "Hynix"},
+ {0x0, NULL},
+};
+
+/* nand device <nand_controller> [controller options]
+ */
+int handle_nand_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ int i;
+ int retval;
+
+ if (argc < 1)
+ {
+ LOG_WARNING("incomplete flash device nand configuration");
+ return ERROR_FLASH_BANK_INVALID;
+ }
+
+ for (i = 0; nand_flash_controllers[i]; i++)
+ {
+ nand_device_t *p, *c;
+
+ if (strcmp(args[0], nand_flash_controllers[i]->name) == 0)
+ {
+ /* register flash specific commands */
+ if ((retval = nand_flash_controllers[i]->register_commands(cmd_ctx)) != ERROR_OK)
+ {
+ LOG_ERROR("couldn't register '%s' commands", args[0]);
+ return retval;
+ }
+
+ c = malloc(sizeof(nand_device_t));
+
+ c->controller = nand_flash_controllers[i];
+ c->controller_priv = NULL;
+ c->manufacturer = NULL;
+ c->device = NULL;
+ c->bus_width = 0;
+ c->address_cycles = 0;
+ c->page_size = 0;
+ c->use_raw = 0;
+ c->next = NULL;
+
+ if ((retval = nand_flash_controllers[i]->nand_device_command(cmd_ctx, cmd, args, argc, c)) != ERROR_OK)
+ {
+ LOG_ERROR("'%s' driver rejected nand flash", c->controller->name);
+ free(c);
+ return ERROR_OK;
+ }
+
+ /* put NAND device in linked list */
+ if (nand_devices)
+ {
+ /* find last flash device */
+ for (p = nand_devices; p && p->next; p = p->next);
+ if (p)
+ p->next = c;
+ }
+ else
+ {
+ nand_devices = c;
+ }
+
+ return ERROR_OK;
+ }
+ }
+
+ /* no valid NAND controller was found (i.e. the configuration option,
+ * didn't match one of the compiled-in controllers)
+ */
+ LOG_ERROR("No valid NAND flash controller found (%s)", args[0]);
+ LOG_ERROR("compiled-in NAND flash controllers:");
+ for (i = 0; nand_flash_controllers[i]; i++)
+ {
+ LOG_ERROR("%i: %s", i, nand_flash_controllers[i]->name);
+ }
+
+ return ERROR_OK;
+}
+
+int nand_register_commands(struct command_context_s *cmd_ctx)
+{
+ nand_cmd = register_command(cmd_ctx, NULL, "nand", NULL, COMMAND_ANY, "NAND specific commands");
+
+ register_command(cmd_ctx, nand_cmd, "device", handle_nand_device_command, COMMAND_CONFIG, NULL);
+
+ return ERROR_OK;
+}
+
+int nand_init(struct command_context_s *cmd_ctx)
+{
+ if (nand_devices)
+ {
+ register_command(cmd_ctx, nand_cmd, "list", handle_nand_list_command, COMMAND_EXEC,
+ "list configured NAND flash devices");
+ register_command(cmd_ctx, nand_cmd, "info", handle_nand_info_command, COMMAND_EXEC,
+ "print info about NAND flash device <num>");
+ register_command(cmd_ctx, nand_cmd, "probe", handle_nand_probe_command, COMMAND_EXEC,
+ "identify NAND flash device <num>");
+ register_command(cmd_ctx, nand_cmd, "check_bad_blocks", handle_nand_check_bad_blocks_command, COMMAND_EXEC,
+ "check NAND flash device <num> for bad blocks [<first> <last>]");
+ register_command(cmd_ctx, nand_cmd, "erase", handle_nand_erase_command, COMMAND_EXEC,
+ "erase blocks on NAND flash device <num> <first> <last>");
+ register_command(cmd_ctx, nand_cmd, "copy", handle_nand_copy_command, COMMAND_EXEC,
+ "copy from NAND flash device <num> <offset> <length> <ram-address>");
+ register_command(cmd_ctx, nand_cmd, "dump", handle_nand_dump_command, COMMAND_EXEC,
+ "dump from NAND flash device <num> <filename> <offset> <size> [options]");
+ register_command(cmd_ctx, nand_cmd, "write", handle_nand_write_command, COMMAND_EXEC,
+ "write to NAND flash device <num> <filename> <offset> [options]");
+ register_command(cmd_ctx, nand_cmd, "raw_access", handle_nand_raw_access_command, COMMAND_EXEC,
+ "raw access to NAND flash device <num> ['enable'|'disable']");
+ }
+
+ return ERROR_OK;
+}
+
+nand_device_t *get_nand_device_by_num(int num)
+{
+ nand_device_t *p;
+ int i = 0;
+
+ for (p = nand_devices; p; p = p->next)
+ {
+ if (i++ == num)
+ {
+ return p;
+ }
+ }
+
+ return NULL;
+}
+
+int nand_build_bbt(struct nand_device_s *device, int first, int last)
+{
+ u32 page = 0x0;
+ int i;
+ u8 *oob;
+
+ oob = malloc(6);
+
+ if ((first < 0) || (first >= device->num_blocks))
+ first = 0;
+
+ if ((last >= device->num_blocks) || (last == -1))
+ last = device->num_blocks - 1;
+
+ for (i = first; i < last; i++)
+ {
+ nand_read_page(device, page, NULL, 0, oob, 6);
+
+ if (((device->device->options & NAND_BUSWIDTH_16) && ((oob[0] & oob[1]) != 0xff))
+ || (((device->page_size == 512) && (oob[5] != 0xff)) ||
+ ((device->page_size == 2048) && (oob[0] != 0xff))))
+ {
+ LOG_WARNING("invalid block: %i", i);
+ device->blocks[i].is_bad = 1;
+ }
+ else
+ {
+ device->blocks[i].is_bad = 0;
+ }
+
+ page += (device->erase_size / device->page_size);
+ }
+
+ return ERROR_OK;
+}
+
+int nand_read_status(struct nand_device_s *device, u8 *status)
+{
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ /* Send read status command */
+ device->controller->command(device, NAND_CMD_STATUS);
+
+ alive_sleep(1);
+
+ /* read status */
+ if (device->device->options & NAND_BUSWIDTH_16)
+ {
+ u16 data;
+ device->controller->read_data(device, &data);
+ *status = data & 0xff;
+ }
+ else
+ {
+ device->controller->read_data(device, status);
+ }
+
+ return ERROR_OK;
+}
+
+int nand_probe(struct nand_device_s *device)
+{
+ u8 manufacturer_id, device_id;
+ u8 id_buff[5];
+ int retval;
+ int i;
+
+ /* clear device data */
+ device->device = NULL;
+ device->manufacturer = NULL;
+
+ /* clear device parameters */
+ device->bus_width = 0;
+ device->address_cycles = 0;
+ device->page_size = 0;
+ device->erase_size = 0;
+
+ /* initialize controller (device parameters are zero, use controller default) */
+ if ((retval = device->controller->init(device) != ERROR_OK))
+ {
+ switch (retval)
+ {
+ case ERROR_NAND_OPERATION_FAILED:
+ LOG_DEBUG("controller initialization failed");
+ return ERROR_NAND_OPERATION_FAILED;
+ case ERROR_NAND_OPERATION_NOT_SUPPORTED:
+ LOG_ERROR("BUG: controller reported that it doesn't support default parameters");
+ return ERROR_NAND_OPERATION_FAILED;
+ default:
+ LOG_ERROR("BUG: unknown controller initialization failure");
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+ }
+
+ device->controller->command(device, NAND_CMD_RESET);
+ device->controller->reset(device);
+
+ device->controller->command(device, NAND_CMD_READID);
+ device->controller->address(device, 0x0);
+
+ if (device->bus_width == 8)
+ {
+ device->controller->read_data(device, &manufacturer_id);
+ device->controller->read_data(device, &device_id);
+ }
+ else
+ {
+ u16 data_buf;
+ device->controller->read_data(device, &data_buf);
+ manufacturer_id = data_buf & 0xff;
+ device->controller->read_data(device, &data_buf);
+ device_id = data_buf & 0xff;
+ }
+
+ for (i = 0; nand_flash_ids[i].name; i++)
+ {
+ if (nand_flash_ids[i].id == device_id)
+ {
+ device->device = &nand_flash_ids[i];
+ break;
+ }
+ }
+
+ for (i = 0; nand_manuf_ids[i].name; i++)
+ {
+ if (nand_manuf_ids[i].id == manufacturer_id)
+ {
+ device->manufacturer = &nand_manuf_ids[i];
+ break;
+ }
+ }
+
+ if (!device->manufacturer)
+ {
+ device->manufacturer = &nand_manuf_ids[0];
+ device->manufacturer->id = manufacturer_id;
+ }
+
+ if (!device->device)
+ {
+ LOG_ERROR("unknown NAND flash device found, manufacturer id: 0x%2.2x device id: 0x%2.2x",
+ manufacturer_id, device_id);
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+
+ LOG_DEBUG("found %s (%s)", device->device->name, device->manufacturer->name);
+
+ /* initialize device parameters */
+
+ /* bus width */
+ if (device->device->options & NAND_BUSWIDTH_16)
+ device->bus_width = 16;
+ else
+ device->bus_width = 8;
+
+ /* Do we need extended device probe information? */
+ if (device->device->page_size == 0 ||
+ device->device->erase_size == 0)
+ {
+ if (device->bus_width == 8)
+ {
+ device->controller->read_data(device, id_buff+3);
+ device->controller->read_data(device, id_buff+4);
+ device->controller->read_data(device, id_buff+5);
+ }
+ else
+ {
+ u16 data_buf;
+
+ device->controller->read_data(device, &data_buf);
+ id_buff[3] = data_buf;
+
+ device->controller->read_data(device, &data_buf);
+ id_buff[4] = data_buf;
+
+ device->controller->read_data(device, &data_buf);
+ id_buff[5] = data_buf >> 8;
+ }
+ }
+
+ /* page size */
+ if (device->device->page_size == 0)
+ {
+ device->page_size = 1 << (10 + (id_buff[4] & 3));
+ }
+ else if (device->device->page_size == 256)
+ {
+ LOG_ERROR("NAND flashes with 256 byte pagesize are not supported");
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+ else
+ {
+ device->page_size = device->device->page_size;
+ }
+
+ /* number of address cycles */
+ if (device->page_size <= 512)
+ {
+ /* small page devices */
+ if (device->device->chip_size <= 32)
+ device->address_cycles = 3;
+ else if (device->device->chip_size <= 8*1024)
+ device->address_cycles = 4;
+ else
+ {
+ LOG_ERROR("BUG: small page NAND device with more than 8 GiB encountered");
+ device->address_cycles = 5;
+ }
+ }
+ else
+ {
+ /* large page devices */
+ if (device->device->chip_size <= 128)
+ device->address_cycles = 4;
+ else if (device->device->chip_size <= 32*1024)
+ device->address_cycles = 5;
+ else
+ {
+ LOG_ERROR("BUG: small page NAND device with more than 32 GiB encountered");
+ device->address_cycles = 6;
+ }
+ }
+
+ /* erase size */
+ if (device->device->erase_size == 0)
+ {
+ switch ((id_buff[4] >> 4) & 3) {
+ case 0:
+ device->erase_size = 64 << 10;
+ break;
+ case 1:
+ device->erase_size = 128 << 10;
+ break;
+ case 2:
+ device->erase_size = 256 << 10;
+ break;
+ case 3:
+ device->erase_size =512 << 10;
+ break;
+ }
+ }
+ else
+ {
+ device->erase_size = device->device->erase_size;
+ }
+
+ /* initialize controller, but leave parameters at the controllers default */
+ if ((retval = device->controller->init(device) != ERROR_OK))
+ {
+ switch (retval)
+ {
+ case ERROR_NAND_OPERATION_FAILED:
+ LOG_DEBUG("controller initialization failed");
+ return ERROR_NAND_OPERATION_FAILED;
+ case ERROR_NAND_OPERATION_NOT_SUPPORTED:
+ LOG_ERROR("controller doesn't support requested parameters (buswidth: %i, address cycles: %i, page size: %i)",
+ device->bus_width, device->address_cycles, device->page_size);
+ return ERROR_NAND_OPERATION_FAILED;
+ default:
+ LOG_ERROR("BUG: unknown controller initialization failure");
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+ }
+
+ device->num_blocks = (device->device->chip_size * 1024) / (device->erase_size / 1024);
+ device->blocks = malloc(sizeof(nand_block_t) * device->num_blocks);
+
+ for (i = 0; i < device->num_blocks; i++)
+ {
+ device->blocks[i].size = device->erase_size;
+ device->blocks[i].offset = i * device->erase_size;
+ device->blocks[i].is_erased = -1;
+ device->blocks[i].is_bad = -1;
+ }
+
+ return ERROR_OK;
+}
+
+int nand_erase(struct nand_device_s *device, int first_block, int last_block)
+{
+ int i;
+ u32 page;
+ u8 status;
+ int retval;
+
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ if ((first_block < 0) || (last_block > device->num_blocks))
+ return ERROR_INVALID_ARGUMENTS;
+
+ /* make sure we know if a block is bad before erasing it */
+ for (i = first_block; i <= last_block; i++)
+ {
+ if (device->blocks[i].is_bad == -1)
+ {
+ nand_build_bbt(device, i, last_block);
+ break;
+ }
+ }
+
+ for (i = first_block; i <= last_block; i++)
+ {
+ /* Send erase setup command */
+ device->controller->command(device, NAND_CMD_ERASE1);
+
+ page = i * (device->erase_size / device->page_size);
+
+ /* Send page address */
+ if (device->page_size <= 512)
+ {
+ /* row */
+ device->controller->address(device, page & 0xff);
+ device->controller->address(device, (page >> 8) & 0xff);
+
+ /* 3rd cycle only on devices with more than 32 MiB */
+ if (device->address_cycles >= 4)
+ device->controller->address(device, (page >> 16) & 0xff);
+
+ /* 4th cycle only on devices with more than 8 GiB */
+ if (device->address_cycles >= 5)
+ device->controller->address(device, (page >> 24) & 0xff);
+ }
+ else
+ {
+ /* row */
+ device->controller->address(device, page & 0xff);
+ device->controller->address(device, (page >> 8) & 0xff);
+
+ /* 3rd cycle only on devices with more than 128 MiB */
+ if (device->address_cycles >= 5)
+ device->controller->address(device, (page >> 16) & 0xff);
+ }
+
+ /* Send erase confirm command */
+ device->controller->command(device, NAND_CMD_ERASE2);
+
+ if (!device->controller->nand_ready(device, 1000))
+ {
+ LOG_ERROR("timeout waiting for NAND flash block erase to complete");
+ return ERROR_NAND_OPERATION_TIMEOUT;
+ }
+
+ if ((retval = nand_read_status(device, &status)) != ERROR_OK)
+ {
+ LOG_ERROR("couldn't read status");
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+
+ if (status & 0x1)
+ {
+ LOG_ERROR("erase operation didn't pass, status: 0x%2.2x", status);
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+ }
+
+ return ERROR_OK;
+}
+
+int nand_read_plain(struct nand_device_s *device, u32 address, u8 *data, u32 data_size)
+{
+ u8 *page;
+
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ if (address % device->page_size)
+ {
+ LOG_ERROR("reads need to be page aligned");
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+
+ page = malloc(device->page_size);
+
+ while (data_size > 0 )
+ {
+ u32 thisrun_size = (data_size > device->page_size) ? device->page_size : data_size;
+ u32 page_address;
+
+
+ page_address = address / device->page_size;
+
+ nand_read_page(device, page_address, page, device->page_size, NULL, 0);
+
+ memcpy(data, page, thisrun_size);
+
+ address += thisrun_size;
+ data += thisrun_size;
+ data_size -= thisrun_size;
+ }
+
+ free(page);
+
+ return ERROR_OK;
+}
+
+int nand_write_plain(struct nand_device_s *device, u32 address, u8 *data, u32 data_size)
+{
+ u8 *page;
+
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ if (address % device->page_size)
+ {
+ LOG_ERROR("writes need to be page aligned");
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+
+ page = malloc(device->page_size);
+
+ while (data_size > 0 )
+ {
+ u32 thisrun_size = (data_size > device->page_size) ? device->page_size : data_size;
+ u32 page_address;
+
+ memset(page, 0xff, device->page_size);
+ memcpy(page, data, thisrun_size);
+
+ page_address = address / device->page_size;
+
+ nand_write_page(device, page_address, page, device->page_size, NULL, 0);
+
+ address += thisrun_size;
+ data += thisrun_size;
+ data_size -= thisrun_size;
+ }
+
+ free(page);
+
+ return ERROR_OK;
+}
+
+int nand_write_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)
+{
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ if (device->use_raw || device->controller->write_page == NULL)
+ return nand_write_page_raw(device, page, data, data_size, oob, oob_size);
+ else
+ return device->controller->write_page(device, page, data, data_size, oob, oob_size);
+}
+
+int nand_read_page(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)
+{
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ if (device->use_raw || device->controller->read_page == NULL)
+ return nand_read_page_raw(device, page, data, data_size, oob, oob_size);
+ else
+ return device->controller->read_page(device, page, data, data_size, oob, oob_size);
+}
+
+int nand_read_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)
+{
+ int i;
+
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ if (device->page_size <= 512)
+ {
+ /* small page device */
+ if (data)
+ device->controller->command(device, NAND_CMD_READ0);
+ else
+ device->controller->command(device, NAND_CMD_READOOB);
+
+ /* column (always 0, we start at the beginning of a page/OOB area) */
+ device->controller->address(device, 0x0);
+
+ /* row */
+ device->controller->address(device, page & 0xff);
+ device->controller->address(device, (page >> 8) & 0xff);
+
+ /* 4th cycle only on devices with more than 32 MiB */
+ if (device->address_cycles >= 4)
+ device->controller->address(device, (page >> 16) & 0xff);
+
+ /* 5th cycle only on devices with more than 8 GiB */
+ if (device->address_cycles >= 5)
+ device->controller->address(device, (page >> 24) & 0xff);
+ }
+ else
+ {
+ /* large page device */
+ device->controller->command(device, NAND_CMD_READ0);
+
+ /* column (0 when we start at the beginning of a page,
+ * or 2048 for the beginning of OOB area)
+ */
+ device->controller->address(device, 0x0);
+ if (data)
+ device->controller->address(device, 0x0);
+ else
+ device->controller->address(device, 0x8);
+
+ /* row */
+ device->controller->address(device, page & 0xff);
+ device->controller->address(device, (page >> 8) & 0xff);
+
+ /* 5th cycle only on devices with more than 128 MiB */
+ if (device->address_cycles >= 5)
+ device->controller->address(device, (page >> 16) & 0xff);
+
+ /* large page devices need a start command */
+ device->controller->command(device, NAND_CMD_READSTART);
+ }
+
+ if (!device->controller->nand_ready(device, 100))
+ return ERROR_NAND_OPERATION_TIMEOUT;
+
+ if (data)
+ {
+ if (device->controller->read_block_data != NULL)
+ (device->controller->read_block_data)(device, data, data_size);
+ else
+ {
+ for (i = 0; i < data_size;)
+ {
+ if (device->device->options & NAND_BUSWIDTH_16)
+ {
+ device->controller->read_data(device, data);
+ data += 2;
+ i += 2;
+ }
+ else
+ {
+ device->controller->read_data(device, data);
+ data += 1;
+ i += 1;
+ }
+ }
+ }
+ }
+
+ if (oob)
+ {
+ if (device->controller->read_block_data != NULL)
+ (device->controller->read_block_data)(device, oob, oob_size);
+ else
+ {
+ for (i = 0; i < oob_size;)
+ {
+ if (device->device->options & NAND_BUSWIDTH_16)
+ {
+ device->controller->read_data(device, oob);
+ oob += 2;
+ i += 2;
+ }
+ else
+ {
+ device->controller->read_data(device, oob);
+ oob += 1;
+ i += 1;
+ }
+ }
+ }
+ }
+
+ return ERROR_OK;
+}
+
+int nand_write_page_raw(struct nand_device_s *device, u32 page, u8 *data, u32 data_size, u8 *oob, u32 oob_size)
+{
+ int i;
+ int retval;
+ u8 status;
+
+ if (!device->device)
+ return ERROR_NAND_DEVICE_NOT_PROBED;
+
+ device->controller->command(device, NAND_CMD_SEQIN);
+
+ if (device->page_size <= 512)
+ {
+ /* column (always 0, we start at the beginning of a page/OOB area) */
+ device->controller->address(device, 0x0);
+
+ /* row */
+ device->controller->address(device, page & 0xff);
+ device->controller->address(device, (page >> 8) & 0xff);
+
+ /* 4th cycle only on devices with more than 32 MiB */
+ if (device->address_cycles >= 4)
+ device->controller->address(device, (page >> 16) & 0xff);
+
+ /* 5th cycle only on devices with more than 8 GiB */
+ if (device->address_cycles >= 5)
+ device->controller->address(device, (page >> 24) & 0xff);
+ }
+ else
+ {
+ /* column (0 when we start at the beginning of a page,
+ * or 2048 for the beginning of OOB area)
+ */
+ device->controller->address(device, 0x0);
+ device->controller->address(device, 0x8);
+
+ /* row */
+ device->controller->address(device, page & 0xff);
+ device->controller->address(device, (page >> 8) & 0xff);
+
+ /* 5th cycle only on devices with more than 128 MiB */
+ if (device->address_cycles >= 5)
+ device->controller->address(device, (page >> 16) & 0xff);
+ }
+
+ if (data)
+ {
+ if (device->controller->write_block_data != NULL)
+ (device->controller->write_block_data)(device, data, data_size);
+ else
+ {
+ for (i = 0; i < data_size;)
+ {
+ if (device->device->options & NAND_BUSWIDTH_16)
+ {
+ u16 data_buf = le_to_h_u16(data);
+ device->controller->write_data(device, data_buf);
+ data += 2;
+ i += 2;
+ }
+ else
+ {
+ device->controller->write_data(device, *data);
+ data += 1;
+ i += 1;
+ }
+ }
+ }
+ }
+
+ if (oob)
+ {
+ if (device->controller->write_block_data != NULL)
+ (device->controller->write_block_data)(device, oob, oob_size);
+ else
+ {
+ for (i = 0; i < oob_size;)
+ {
+ if (device->device->options & NAND_BUSWIDTH_16)
+ {
+ u16 oob_buf = le_to_h_u16(data);
+ device->controller->write_data(device, oob_buf);
+ oob += 2;
+ i += 2;
+ }
+ else
+ {
+ device->controller->write_data(device, *oob);
+ oob += 1;
+ i += 1;
+ }
+ }
+ }
+ }
+
+ device->controller->command(device, NAND_CMD_PAGEPROG);
+
+ if (!device->controller->nand_ready(device, 100))
+ return ERROR_NAND_OPERATION_TIMEOUT;
+
+ if ((retval = nand_read_status(device, &status)) != ERROR_OK)
+ {
+ LOG_ERROR("couldn't read status");
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+
+ if (status & NAND_STATUS_FAIL)
+ {
+ LOG_ERROR("write operation didn't pass, status: 0x%2.2x", status);
+ return ERROR_NAND_OPERATION_FAILED;
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_list_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+ int i = 0;
+
+ if (!nand_devices)
+ {
+ command_print(cmd_ctx, "no NAND flash devices configured");
+ return ERROR_OK;
+ }
+
+ for (p = nand_devices; p; p = p->next)
+ {
+ if (p->device)
+ command_print(cmd_ctx, "#%i: %s (%s) pagesize: %i, buswidth: %i, erasesize: %i",
+ i++, p->device->name, p->manufacturer->name, p->page_size, p->bus_width, p->erase_size);
+ else
+ command_print(cmd_ctx, "#%i: not probed");
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_info_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+ int i = 0;
+ int j = 0;
+ int first = -1;
+ int last = -1;
+
+ if ((argc < 1) || (argc > 3))
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+
+ }
+
+ if (argc == 2)
+ {
+ first = last = strtoul(args[1], NULL, 0);
+ }
+ else if (argc == 3)
+ {
+ first = strtoul(args[1], NULL, 0);
+ last = strtoul(args[2], NULL, 0);
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+ if (p->device)
+ {
+ if (first >= p->num_blocks)
+ first = p->num_blocks - 1;
+
+ if (last >= p->num_blocks)
+ last = p->num_blocks - 1;
+
+ command_print(cmd_ctx, "#%i: %s (%s) pagesize: %i, buswidth: %i, erasesize: %i",
+ i++, p->device->name, p->manufacturer->name, p->page_size, p->bus_width, p->erase_size);
+
+ for (j = first; j <= last; j++)
+ {
+ char *erase_state, *bad_state;
+
+ if (p->blocks[j].is_erased == 0)
+ erase_state = "not erased";
+ else if (p->blocks[j].is_erased == 1)
+ erase_state = "erased";
+ else
+ erase_state = "erase state unknown";
+
+ if (p->blocks[j].is_bad == 0)
+ bad_state = "";
+ else if (p->blocks[j].is_bad == 1)
+ bad_state = " (marked bad)";
+ else
+ bad_state = " (block condition unknown)";
+
+ command_print(cmd_ctx, "\t#%i: 0x%8.8x (0x%xkB) %s%s",
+ j, p->blocks[j].offset, p->blocks[j].size / 1024,
+ erase_state, bad_state);
+ }
+ }
+ else
+ {
+ command_print(cmd_ctx, "#%i: not probed");
+ }
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_probe_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+ int retval;
+
+ if (argc != 1)
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+ if ((retval = nand_probe(p)) == ERROR_OK)
+ {
+ command_print(cmd_ctx, "NAND flash device '%s' found", p->device->name);
+ }
+ else if (retval == ERROR_NAND_OPERATION_FAILED)
+ {
+ command_print(cmd_ctx, "probing failed for NAND flash device");
+ }
+ else
+ {
+ command_print(cmd_ctx, "unknown error when probing NAND flash device");
+ }
+ }
+ else
+ {
+ command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_erase_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+ int retval;
+
+ if (argc != 3)
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+ int first = strtoul(args[1], NULL, 0);
+ int last = strtoul(args[2], NULL, 0);
+
+ if ((retval = nand_erase(p, first, last)) == ERROR_OK)
+ {
+ command_print(cmd_ctx, "successfully erased blocks %i to %i on NAND flash device '%s'", first, last, p->device->name);
+ }
+ else if (retval == ERROR_NAND_OPERATION_FAILED)
+ {
+ command_print(cmd_ctx, "erase failed");
+ }
+ else
+ {
+ command_print(cmd_ctx, "unknown error when erasing NAND flash device");
+ }
+ }
+ else
+ {
+ command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_check_bad_blocks_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+ int retval;
+ int first = -1;
+ int last = -1;
+
+ if ((argc < 1) || (argc > 3) || (argc == 2))
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+
+ }
+
+ if (argc == 3)
+ {
+ first = strtoul(args[1], NULL, 0);
+ last = strtoul(args[2], NULL, 0);
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+ if ((retval = nand_build_bbt(p, first, last)) == ERROR_OK)
+ {
+ command_print(cmd_ctx, "checked NAND flash device for bad blocks, use \"nand info\" command to list blocks", p->device->name);
+ }
+ else if (retval == ERROR_NAND_OPERATION_FAILED)
+ {
+ command_print(cmd_ctx, "error when checking for bad blocks on NAND flash device");
+ }
+ else
+ {
+ command_print(cmd_ctx, "unknown error when checking for bad blocks on NAND flash device");
+ }
+ }
+ else
+ {
+ command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_copy_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+
+ if (argc != 4)
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+
+ }
+ else
+ {
+ command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_write_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ u32 offset;
+ u32 binary_size;
+ u32 buf_cnt;
+ enum oob_formats oob_format = NAND_OOB_NONE;
+
+ fileio_t fileio;
+
+ duration_t duration;
+ char *duration_text;
+
+ nand_device_t *p;
+
+ if (argc < 3)
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+ u8 *page = NULL;
+ u32 page_size = 0;
+ u8 *oob = NULL;
+ u32 oob_size = 0;
+
+ duration_start_measure(&duration);
+ offset = strtoul(args[2], NULL, 0);
+
+ if (argc > 3)
+ {
+ int i;
+ for (i = 3; i < argc; i++)
+ {
+ if (!strcmp(args[i], "oob_raw"))
+ oob_format |= NAND_OOB_RAW;
+ else if (!strcmp(args[i], "oob_only"))
+ oob_format |= NAND_OOB_RAW | NAND_OOB_ONLY;
+ else
+ {
+ command_print(cmd_ctx, "unknown option: %s", args[i]);
+ }
+ }
+ }
+
+ if (fileio_open(&fileio, args[1], FILEIO_READ, FILEIO_BINARY) != ERROR_OK)
+ {
+ return ERROR_OK;
+ }
+
+ buf_cnt = binary_size = fileio.size;
+
+ if (!(oob_format & NAND_OOB_ONLY))
+ {
+ page_size = p->page_size;
+ page = malloc(p->page_size);
+ }
+
+ if (oob_format & NAND_OOB_RAW)
+ {
+ if (p->page_size == 512)
+ oob_size = 16;
+ else if (p->page_size == 2048)
+ oob_size = 64;
+ oob = malloc(oob_size);
+ }
+
+ if (offset % p->page_size)
+ {
+ command_print(cmd_ctx, "only page size aligned offsets and sizes are supported");
+ fileio_close(&fileio);
+ free(oob);
+ free(page);
+ return ERROR_OK;
+ }
+
+ while (buf_cnt > 0)
+ {
+ u32 size_read;
+
+ if (NULL != page)
+ {
+ fileio_read(&fileio, page_size, page, &size_read);
+ buf_cnt -= size_read;
+ if (size_read < page_size)
+ {
+ memset(page + size_read, 0xff, page_size - size_read);
+ }
+ }
+
+ if (NULL != oob)
+ {
+ fileio_read(&fileio, oob_size, oob, &size_read);
+ buf_cnt -= size_read;
+ if (size_read < oob_size)
+ {
+ memset(oob + size_read, 0xff, oob_size - size_read);
+ }
+ }
+
+ if (nand_write_page(p, offset / p->page_size, page, page_size, oob, oob_size) != ERROR_OK)
+ {
+ command_print(cmd_ctx, "failed writing file %s to NAND flash %s at offset 0x%8.8x",
+ args[1], args[0], offset);
+
+ fileio_close(&fileio);
+ free(oob);
+ free(page);
+
+ return ERROR_OK;
+ }
+ offset += page_size;
+ }
+
+ fileio_close(&fileio);
+ free(oob);
+ free(page);
+ oob = NULL;
+ page = NULL;
+ duration_stop_measure(&duration, &duration_text);
+ command_print(cmd_ctx, "wrote file %s to NAND flash %s at offset 0x%8.8x in %s",
+ args[1], args[0], offset, duration_text);
+ free(duration_text);
+ duration_text = NULL;
+ }
+ else
+ {
+ command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_dump_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+
+ if (argc < 4)
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+ if (p->device)
+ {
+ fileio_t fileio;
+ duration_t duration;
+ char *duration_text;
+ int retval;
+
+ u8 *page = NULL;
+ u32 page_size = 0;
+ u8 *oob = NULL;
+ u32 oob_size = 0;
+ u32 address = strtoul(args[2], NULL, 0);
+ u32 size = strtoul(args[3], NULL, 0);
+ u32 bytes_done = 0;
+ enum oob_formats oob_format = NAND_OOB_NONE;
+
+ if (argc > 4)
+ {
+ int i;
+ for (i = 4; i < argc; i++)
+ {
+ if (!strcmp(args[i], "oob_raw"))
+ oob_format |= NAND_OOB_RAW;
+ else if (!strcmp(args[i], "oob_only"))
+ oob_format |= NAND_OOB_RAW | NAND_OOB_ONLY;
+ else
+ command_print(cmd_ctx, "unknown option: '%s'", args[i]);
+ }
+ }
+
+ if ((address % p->page_size) || (size % p->page_size))
+ {
+ command_print(cmd_ctx, "only page size aligned addresses and sizes are supported");
+ return ERROR_OK;
+ }
+
+ if (!(oob_format & NAND_OOB_ONLY))
+ {
+ page_size = p->page_size;
+ page = malloc(p->page_size);
+ }
+
+ if (oob_format & NAND_OOB_RAW)
+ {
+ if (p->page_size == 512)
+ oob_size = 16;
+ else if (p->page_size == 2048)
+ oob_size = 64;
+ oob = malloc(oob_size);
+ }
+
+ if (fileio_open(&fileio, args[1], FILEIO_WRITE, FILEIO_BINARY) != ERROR_OK)
+ {
+ return ERROR_OK;
+ }
+
+ duration_start_measure(&duration);
+
+ while (size > 0)
+ {
+ u32 size_written;
+ if ((retval = nand_read_page(p, address / p->page_size, page, page_size, oob, oob_size)) != ERROR_OK)
+ {
+ command_print(cmd_ctx, "reading NAND flash page failed");
+ free(page);
+ free(oob);
+ fileio_close(&fileio);
+ return ERROR_OK;
+ }
+
+ if (NULL != page)
+ {
+ fileio_write(&fileio, page_size, page, &size_written);
+ bytes_done += page_size;
+ }
+
+ if (NULL != oob)
+ {
+ fileio_write(&fileio, oob_size, oob, &size_written);
+ bytes_done += oob_size;
+ }
+
+ size -= p->page_size;
+ address += p->page_size;
+ }
+
+ free(page);
+ page = NULL;
+ free(oob);
+ oob = NULL;
+ fileio_close(&fileio);
+
+ duration_stop_measure(&duration, &duration_text);
+ command_print(cmd_ctx, "dumped %"PRIi64" byte in %s", fileio.size, duration_text);
+ free(duration_text);
+ duration_text = NULL;
+ }
+ else
+ {
+ command_print(cmd_ctx, "#%i: not probed");
+ }
+ }
+ else
+ {
+ command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);
+ }
+
+ return ERROR_OK;
+}
+
+int handle_nand_raw_access_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ nand_device_t *p;
+
+ if ((argc < 1) || (argc > 2))
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+ }
+
+ p = get_nand_device_by_num(strtoul(args[0], NULL, 0));
+ if (p)
+ {
+ if (p->device)
+ {
+ if (argc == 2)
+ {
+ if (strcmp("enable", args[1]) == 0)
+ {
+ p->use_raw = 1;
+ }
+ else if (strcmp("disable", args[1]) == 0)
+ {
+ p->use_raw = 0;
+ }
+ else
+ {
+ return ERROR_COMMAND_SYNTAX_ERROR;
+ }
+ }
+
+ command_print(cmd_ctx, "raw access is %s", (p->use_raw) ? "enabled" : "disabled");
+ }
+ else
+ {
+ command_print(cmd_ctx, "#%i: not probed");
+ }
+ }
+ else
+ {
+ command_print(cmd_ctx, "NAND flash device '#%s' is out of bounds", args[0]);
+ }
+
+ return ERROR_OK;
+}