use ARRAY_SIZE macro
[fw/openocd] / src / flash / s3c2440_nand.c
index f08e76104cb1c65e6bfbf254de3ad492071c168b..556f6f1e89b960af560360689cf0d1f62932ad47 100644 (file)
-/* src/flash/s3c2440_nand.c\r
- *\r
- * S3C2440 OpenOCD NAND Flash controller support.\r
- *\r
- * Copyright 2007,2008 Ben Dooks <ben@fluff.org>\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
- * Many thanks to Simtec Electronics for sponsoring this work.\r
- */\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
-\r
-#include "nand.h"\r
-#include "s3c24xx_nand.h"\r
-#include "target.h"\r
-\r
-int s3c2440_nand_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc, struct nand_device_s *device);\r
-int s3c2440_init(struct nand_device_s *device);\r
-int s3c2440_nand_ready(struct nand_device_s *device, int timeout);\r
-\r
-nand_flash_controller_t s3c2440_nand_controller =\r
-{\r
-       .name                   = "s3c2440",\r
-       .nand_device_command    = s3c2440_nand_device_command,\r
-       .register_commands      = s3c24xx_register_commands,\r
-       .init                   = s3c2440_init,\r
-       .reset                  = s3c24xx_reset,\r
-       .command                = s3c24xx_command,\r
-       .address                = s3c24xx_address,\r
-       .write_data             = s3c24xx_write_data,\r
-       .read_data              = s3c24xx_read_data,\r
-       .write_page             = s3c24xx_write_page,\r
-       .read_page              = s3c24xx_read_page,\r
-       .write_block_data       = s3c2440_write_block_data,\r
-       .read_block_data        = s3c2440_read_block_data,\r
-       .controller_ready       = s3c24xx_controller_ready,\r
-       .nand_ready             = s3c2440_nand_ready,\r
-};\r
-\r
-int s3c2440_nand_device_command(struct command_context_s *cmd_ctx, char *cmd,\r
-                               char **args, int argc,\r
-                               struct nand_device_s *device)\r
-{\r
-       s3c24xx_nand_controller_t *info;\r
-       \r
-       info = s3c24xx_nand_device_command(cmd_ctx, cmd, args, argc, device);\r
-       if (info == NULL) {\r
-               return ERROR_NAND_DEVICE_INVALID;\r
-       }\r
-\r
-       /* fill in the address fields for the core device */\r
-       info->cmd = S3C2440_NFCMD;\r
-       info->addr = S3C2440_NFADDR;\r
-       info->data = S3C2440_NFDATA;\r
-       info->nfstat = S3C2440_NFSTAT;\r
-               \r
-       return ERROR_OK;\r
-}\r
-\r
-int s3c2440_init(struct nand_device_s *device)\r
-{\r
-       s3c24xx_nand_controller_t *s3c24xx_info = device->controller_priv;\r
-       target_t *target = s3c24xx_info->target;\r
-\r
-       target_write_u32(target, S3C2410_NFCONF,\r
-                        S3C2440_NFCONF_TACLS(3) |\r
-                        S3C2440_NFCONF_TWRPH0(7) |\r
-                        S3C2440_NFCONF_TWRPH1(7));\r
-\r
-       target_write_u32(target, S3C2440_NFCONT,\r
-                        S3C2440_NFCONT_INITECC | S3C2440_NFCONT_ENABLE);\r
-\r
-       return ERROR_OK;\r
-}\r
-\r
-int s3c2440_nand_ready(struct nand_device_s *device, int timeout)\r
-{\r
-       s3c24xx_nand_controller_t *s3c24xx_info = device->controller_priv;\r
-       target_t *target = s3c24xx_info->target;\r
-       u8 status;\r
-\r
-       if (target->state != TARGET_HALTED) {\r
-               ERROR("target must be halted to use S3C24XX NAND flash controller");\r
-               return ERROR_NAND_OPERATION_FAILED;\r
-       }\r
-       \r
-       do {            \r
-               target_read_u8(target, s3c24xx_info->nfstat, &status);\r
-               \r
-               if (status & S3C2440_NFSTAT_READY)\r
-                       return 1;\r
-\r
-               usleep(1000);\r
-       } while (timeout-- > 0);\r
-\r
-\r
-       return 0;\r
-}\r
-\r
-/* use the fact we can read/write 4 bytes in one go via a single 32bit op */\r
-\r
-int s3c2440_read_block_data(struct nand_device_s *device, u8 *data, int data_size)\r
-{\r
-       s3c24xx_nand_controller_t *s3c24xx_info = device->controller_priv;\r
-       target_t *target = s3c24xx_info->target;\r
-       u32 nfdata = s3c24xx_info->data;\r
-       u32 tmp;\r
-\r
-       INFO("%s: reading data: %p, %p, %d\n", __func__, device, data, data_size);\r
-\r
-       if (target->state != TARGET_HALTED) {\r
-               ERROR("target must be halted to use S3C24XX NAND flash controller");\r
-               return ERROR_NAND_OPERATION_FAILED;\r
-       }\r
-\r
-       while (data_size >= 4) {          \r
-               target_read_u32(target, nfdata, &tmp);\r
-\r
-               data[0] = tmp;\r
-               data[1] = tmp >> 8;\r
-               data[2] = tmp >> 16;\r
-               data[3] = tmp >> 24;\r
-\r
-               data_size -= 4;\r
-               data += 4;\r
-       }\r
-\r
-       while (data_size > 0) {\r
-               target_read_u8(target, nfdata, data);\r
-\r
-               data_size -= 1;\r
-               data += 1;\r
-       }\r
-\r
-       return ERROR_OK;\r
-}\r
-\r
-int s3c2440_write_block_data(struct nand_device_s *device, u8 *data, int data_size)\r
-{\r
-       s3c24xx_nand_controller_t *s3c24xx_info = device->controller_priv;\r
-       target_t *target = s3c24xx_info->target;\r
-       u32 nfdata = s3c24xx_info->data;\r
-       u32 tmp;\r
-\r
-       if (target->state != TARGET_HALTED) {\r
-               ERROR("target must be halted to use S3C24XX NAND flash controller");\r
-               return ERROR_NAND_OPERATION_FAILED;\r
-       }\r
-\r
-       while (data_size >= 4) {          \r
-               tmp = le_to_h_u32(data);\r
-               target_write_u32(target, nfdata, tmp);\r
-\r
-               data_size -= 4;\r
-               data += 4;\r
-       }\r
-\r
-       while (data_size > 0) {\r
-               target_write_u8(target, nfdata, *data);\r
-\r
-               data_size -= 1;\r
-               data += 1;\r
-       }\r
-\r
-       return ERROR_OK;\r
-}\r
+/***************************************************************************
+ *   Copyright (C) 2007, 2008 by Ben Dooks                                 *
+ *   ben@fluff.org                                                         *
+ *                                                                         *
+ *   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.             *
+ ***************************************************************************/
+
+/*
+ * S3C2440 OpenOCD NAND Flash controller support.
+ *
+ * Many thanks to Simtec Electronics for sponsoring this work.
+ */
+
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include "s3c24xx_nand.h"
+
+
+NAND_DEVICE_COMMAND_HANDLER(s3c2440_nand_device_command)
+{
+       struct s3c24xx_nand_controller *info;
+       CALL_S3C24XX_DEVICE_COMMAND(nand, &info);
+
+       /* fill in the address fields for the core device */
+       info->cmd = S3C2440_NFCMD;
+       info->addr = S3C2440_NFADDR;
+       info->data = S3C2440_NFDATA;
+       info->nfstat = S3C2440_NFSTAT;
+
+       return ERROR_OK;
+}
+
+static int s3c2440_init(struct nand_device *nand)
+{
+       struct s3c24xx_nand_controller *s3c24xx_info = nand->controller_priv;
+       struct target *target = s3c24xx_info->target;
+
+       target_write_u32(target, S3C2410_NFCONF,
+                        S3C2440_NFCONF_TACLS(3) |
+                        S3C2440_NFCONF_TWRPH0(7) |
+                        S3C2440_NFCONF_TWRPH1(7));
+
+       target_write_u32(target, S3C2440_NFCONT,
+                        S3C2440_NFCONT_INITECC | S3C2440_NFCONT_ENABLE);
+
+       return ERROR_OK;
+}
+
+int s3c2440_nand_ready(struct nand_device *nand, int timeout)
+{
+       struct s3c24xx_nand_controller *s3c24xx_info = nand->controller_priv;
+       struct target *target = s3c24xx_info->target;
+       uint8_t status;
+
+       if (target->state != TARGET_HALTED) {
+               LOG_ERROR("target must be halted to use S3C24XX NAND flash controller");
+               return ERROR_NAND_OPERATION_FAILED;
+       }
+
+       do {
+               target_read_u8(target, s3c24xx_info->nfstat, &status);
+
+               if (status & S3C2440_NFSTAT_READY)
+                       return 1;
+
+               alive_sleep(1);
+       } while (timeout-- > 0);
+
+
+       return 0;
+}
+
+/* use the fact we can read/write 4 bytes in one go via a single 32bit op */
+
+int s3c2440_read_block_data(struct nand_device *nand, uint8_t *data, int data_size)
+{
+       struct s3c24xx_nand_controller *s3c24xx_info = nand->controller_priv;
+       struct target *target = s3c24xx_info->target;
+       uint32_t nfdata = s3c24xx_info->data;
+       uint32_t tmp;
+
+       LOG_INFO("%s: reading data: %p, %p, %d\n", __func__, nand, data, data_size);
+
+       if (target->state != TARGET_HALTED) {
+               LOG_ERROR("target must be halted to use S3C24XX NAND flash controller");
+               return ERROR_NAND_OPERATION_FAILED;
+       }
+
+       while (data_size >= 4) {
+               target_read_u32(target, nfdata, &tmp);
+
+               data[0] = tmp;
+               data[1] = tmp >> 8;
+               data[2] = tmp >> 16;
+               data[3] = tmp >> 24;
+
+               data_size -= 4;
+               data += 4;
+       }
+
+       while (data_size > 0) {
+               target_read_u8(target, nfdata, data);
+
+               data_size -= 1;
+               data += 1;
+       }
+
+       return ERROR_OK;
+}
+
+int s3c2440_write_block_data(struct nand_device *nand, uint8_t *data, int data_size)
+{
+       struct s3c24xx_nand_controller *s3c24xx_info = nand->controller_priv;
+       struct target *target = s3c24xx_info->target;
+       uint32_t nfdata = s3c24xx_info->data;
+       uint32_t tmp;
+
+       if (target->state != TARGET_HALTED) {
+               LOG_ERROR("target must be halted to use S3C24XX NAND flash controller");
+               return ERROR_NAND_OPERATION_FAILED;
+       }
+
+       while (data_size >= 4) {
+               tmp = le_to_h_u32(data);
+               target_write_u32(target, nfdata, tmp);
+
+               data_size -= 4;
+               data += 4;
+       }
+
+       while (data_size > 0) {
+               target_write_u8(target, nfdata, *data);
+
+               data_size -= 1;
+               data += 1;
+       }
+
+       return ERROR_OK;
+}
+
+struct nand_flash_controller s3c2440_nand_controller = {
+               .name = "s3c2440",
+               .nand_device_command = &s3c2440_nand_device_command,
+               .init = &s3c2440_init,
+               .reset = &s3c24xx_reset,
+               .command = &s3c24xx_command,
+               .address = &s3c24xx_address,
+               .write_data = &s3c24xx_write_data,
+               .read_data = &s3c24xx_read_data,
+               .write_page = s3c24xx_write_page,
+               .read_page = s3c24xx_read_page,
+               .write_block_data = &s3c2440_write_block_data,
+               .read_block_data = &s3c2440_read_block_data,
+               .controller_ready = &s3c24xx_controller_ready,
+               .nand_ready = &s3c2440_nand_ready,
+       };