"marcel" <M.W.Wijlaars@tue.nl>,

I have the ADuC702x flashdriver working again (see attachment). It adds the option to erase and write the ADuC702x flash

git-svn-id: svn://svn.berlios.de/openocd/trunk@992 b42882b7-edfa-0310-969c-e2dbd0fdcd60

3 files changed, 257 insertions, 38 deletions

diff --git a/src/flash/Makefile.am b/src/flash/Makefile.am
index 418a15c9..77e870f1 100644
--- a/src/flash/Makefile.am
+++ b/src/flash/Makefile.am
@@ -2,7 +2,7 @@ INCLUDES = -I$(top_srcdir)/src/helper -I$(top_srcdir)/src/jtag -I$(top_srcdir)/s
 AM_CPPFLAGS = -DPKGLIBDIR=\"$(pkglibdir)\" @CPPFLAGS@
 METASOURCES = AUTO
 noinst_LIBRARIES = libflash.a
-libflash_a_SOURCES = flash.c lpc2000.c cfi.c non_cfi.c at91sam7.c str7x.c str9x.c nand.c lpc3180_nand_controller.c \
+libflash_a_SOURCES = flash.c lpc2000.c cfi.c non_cfi.c at91sam7.c str7x.c str9x.c x7026.c nand.c lpc3180_nand_controller.c \
 					 stellaris.c str9xpec.c stm32x.c tms470.c ecos.c  \
 		     s3c24xx_nand.c s3c2410_nand.c s3c2412_nand.c s3c2440_nand.c s3c2443_nand.c lpc288x.c ocl.c
 noinst_HEADERS = flash.h lpc2000.h cfi.h non_cfi.h at91sam7.h str7x.h str9x.h nand.h lpc3180_nand_controller.h \
diff --git a/src/flash/flash.c b/src/flash/flash.c
index 5f9d78bc..a1b64ade 100644
--- a/src/flash/flash.c
+++ b/src/flash/flash.c
@@ -69,6 +69,7 @@ extern flash_driver_t cfi_flash;
 extern flash_driver_t at91sam7_flash;
 extern flash_driver_t str7x_flash;
 extern flash_driver_t str9x_flash;
+extern flash_driver_t x7026_flash;
 extern flash_driver_t stellaris_flash;
 extern flash_driver_t str9xpec_flash;
 extern flash_driver_t stm32x_flash;
@@ -84,6 +85,7 @@ flash_driver_t *flash_drivers[] =
 	&at91sam7_flash,
 	&str7x_flash,
 	&str9x_flash,
+	&x7026_flash,
 	&stellaris_flash,
 	&str9xpec_flash,
 	&stm32x_flash,
@@ -148,7 +150,7 @@ int flash_register_commands(struct command_context_s *cmd_ctx)
 static int jim_flash_banks(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
 {
 	flash_bank_t *p;
-	
+
 	if (argc != 1) {
 		Jim_WrongNumArgs(interp, 1, argv, "no arguments to flash_banks command");
 		return JIM_ERR;
@@ -163,7 +165,7 @@ static int jim_flash_banks(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
 	for (p = flash_banks; p; p = p->next)
 	{
 		Jim_Obj *elem=Jim_NewListObj(interp, NULL, 0);
-		
+
 		Jim_ListAppendElement(interp, elem, Jim_NewStringObj(interp, "name", -1));
 		Jim_ListAppendElement(interp, elem, Jim_NewStringObj(interp, p->driver->name, -1));
 		Jim_ListAppendElement(interp, elem, Jim_NewStringObj(interp, "base", -1));
@@ -174,7 +176,7 @@ static int jim_flash_banks(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
 		Jim_ListAppendElement(interp, elem, Jim_NewIntObj(interp, p->bus_width));
 		Jim_ListAppendElement(interp, elem, Jim_NewStringObj(interp, "chip_width", -1));
 		Jim_ListAppendElement(interp, elem, Jim_NewIntObj(interp, p->chip_width));
-		
+
 		Jim_ListAppendElement(interp, list, elem);
 	}
 
@@ -188,7 +190,7 @@ int flash_init_drivers(struct command_context_s *cmd_ctx)
 	if (flash_banks)
 	{
 		register_jim(cmd_ctx, "ocd_flash_banks", jim_flash_banks, "return information about the flash banks");
-		
+
 		register_command(cmd_ctx, flash_cmd, "info", handle_flash_info_command, COMMAND_EXEC,
 						 "print info about flash bank <num>");
 		register_command(cmd_ctx, flash_cmd, "probe", handle_flash_probe_command, COMMAND_EXEC,
@@ -452,7 +454,7 @@ int handle_flash_erase_check_command(struct command_context_s *cmd_ctx, char *cm
 			command_print(cmd_ctx, "unknown error when checking erase state of flash bank #%s at 0x%8.8x",
 				args[0], p->base);
 		}
-		
+
 		for (j = 0; j < p->num_sectors; j++)
 		{
 			char *erase_state;
@@ -468,7 +470,7 @@ int handle_flash_erase_check_command(struct command_context_s *cmd_ctx, char *cm
 						j, p->sectors[j].offset, p->sectors[j].size, p->sectors[j].size>>10,
 						erase_state);
 		}
-		
+
 	}
 
 	return ERROR_OK;
@@ -642,10 +644,10 @@ int handle_flash_write_image_command(struct command_context_s *cmd_ctx, char *cm
 	{
 		return ERROR_COMMAND_SYNTAX_ERROR;
 	}
-	
+
 	/* flash auto-erase is disabled by default*/
 	int auto_erase = 0;
-	
+
 	if (strcmp(args[0], "erase")==0)
 	{
 		auto_erase = 1;
@@ -653,13 +655,13 @@ int handle_flash_write_image_command(struct command_context_s *cmd_ctx, char *cm
 		argc--;
 		command_print(cmd_ctx, "auto erase enabled");
 	}
-	
+
 
 	if (argc < 1)
 	{
 		return ERROR_COMMAND_SYNTAX_ERROR;
 	}
-	
+
 	if (!target)
 	{
 		LOG_ERROR("no target selected");
@@ -722,16 +724,16 @@ int handle_flash_fill_command(struct command_context_s *cmd_ctx, char *cmd, char
 	target_t *target = get_current_target(cmd_ctx);
 	u32 i;
 	int wordsize;
-	
+
 	if (argc != 3)
 	{
 		return ERROR_COMMAND_SYNTAX_ERROR;
 	}
-	
+
 	address	= strtoul(args[0], NULL, 0);
 	pattern	= strtoul(args[1], NULL, 0);
 	count 	= strtoul(args[2], NULL, 0);
-	
+
 	if(count == 0)
 		return ERROR_OK;
 
@@ -750,7 +752,7 @@ int handle_flash_fill_command(struct command_context_s *cmd_ctx, char *cmd, char
 	default:
 		return ERROR_COMMAND_SYNTAX_ERROR;
 	}
-	
+
 	chunk_count = MIN(count, (1024 / wordsize));
 	switch(wordsize)
 	{
@@ -773,7 +775,7 @@ int handle_flash_fill_command(struct command_context_s *cmd_ctx, char *cmd, char
 		LOG_ERROR("BUG: can't happen");
 		exit(-1);
 	}
-	
+
 	duration_start_measure(&duration);
 
 	flash_set_dirty();
@@ -781,7 +783,7 @@ int handle_flash_fill_command(struct command_context_s *cmd_ctx, char *cmd, char
 	if (err == ERROR_OK)
 	{
 		for (wrote=0; wrote<(count*wordsize); wrote+=sizeof(chunk))
-		{ 
+		{
 			int cur_size = MIN( (count*wordsize - wrote) , 1024 );
 			if (err == ERROR_OK)
 			{
@@ -799,7 +801,7 @@ int handle_flash_fill_command(struct command_context_s *cmd_ctx, char *cmd, char
 				break;
 		}
 	}
-	
+
 	duration_stop_measure(&duration, &duration_text);
 
 	if(err == ERROR_OK)
@@ -973,7 +975,7 @@ int flash_write(target_t *target, image_t *image, u32 *written, int erase)
 	u32 section_offset;
 	flash_bank_t *c;
 	int *padding;
-	
+
 	section = 0;
 	section_offset = 0;
 
@@ -987,10 +989,10 @@ int flash_write(target_t *target, image_t *image, u32 *written, int erase)
 
 		flash_set_dirty();
 	}
-	
+
 	/* allocate padding array */
 	padding = malloc(image->num_sections * sizeof(padding));
-	
+
 	/* loop until we reach end of the image */
 	while (section < image->num_sections)
 	{
@@ -1001,7 +1003,7 @@ int flash_write(target_t *target, image_t *image, u32 *written, int erase)
 		u32 run_address = image->sections[section].base_address + section_offset;
 		u32 run_size = image->sections[section].size - section_offset;
 		int pad_bytes = 0;
-		
+
 		if (image->sections[section].size ==  0)
 		{
 			LOG_WARNING("empty section %d", section);
@@ -1039,7 +1041,7 @@ int flash_write(target_t *target, image_t *image, u32 *written, int erase)
 			run_size += image->sections[++section_last].size;
 			run_size += pad_bytes;
 			padding[section_last] = 0;
-			
+
 			LOG_INFO("Padding image section %d with %d bytes", section_last-1, pad_bytes );
 		}
 
@@ -1067,11 +1069,11 @@ int flash_write(target_t *target, image_t *image, u32 *written, int erase)
 				free(padding);
 				return retval;
 			}
-			
+
 			/* see if we need to pad the section */
 			while (padding[section]--)
 				 (buffer+buffer_size)[size_read++] = 0xff;
-			
+
 			buffer_size += size_read;
 			section_offset += size_read;
 
@@ -1107,9 +1109,9 @@ int flash_write(target_t *target, image_t *image, u32 *written, int erase)
 		if (written != NULL)
 			*written += run_size; /* add run size to total written counter */
 	}
-	
+
 	free(padding);
-	
+
 	return retval;
 }
 
@@ -1120,18 +1122,18 @@ int default_flash_mem_blank_check(struct flash_bank_s *bank)
 	int buffer_size = sizeof(buffer);
 	int i;
 	int nBytes;
-	
+
 	if (bank->target->state != TARGET_HALTED)
 	{
 		LOG_ERROR("Target not halted");
 		return ERROR_TARGET_NOT_HALTED;
 	}
-	
+
 	for (i = 0; i < bank->num_sectors; i++)
 	{
 		int j;
 		bank->sectors[i].is_erased = 1;
-		
+
 		for (j = 0; j < bank->sectors[i].size; j += buffer_size)
 		{
 			int chunk;
@@ -1141,11 +1143,11 @@ int default_flash_mem_blank_check(struct flash_bank_s *bank)
 			{
 				chunk = (j - bank->sectors[i].size);
 			}
-			
+
 			retval = target->type->read_memory(target, bank->base + bank->sectors[i].offset + j, 4, chunk/4, buffer);
 			if (retval != ERROR_OK)
 				return retval;
-		
+
 			for (nBytes = 0; nBytes < chunk; nBytes++)
 			{
 				if (buffer[nBytes] != 0xFF)
@@ -1156,7 +1158,7 @@ int default_flash_mem_blank_check(struct flash_bank_s *bank)
 			}
 		}
 	}
-	
+
 	return ERROR_OK;
 }
 
@@ -1167,18 +1169,18 @@ int default_flash_blank_check(struct flash_bank_s *bank)
 	int retval;
 	int fast_check = 0;
 	int blank;
-	
+
 	if (bank->target->state != TARGET_HALTED)
 	{
 		LOG_ERROR("Target not halted");
 		return ERROR_TARGET_NOT_HALTED;
 	}
-		
+
 	for (i = 0; i < bank->num_sectors; i++)
 	{
 		u32 address = bank->base + bank->sectors[i].offset;
 		u32 size = bank->sectors[i].size;
-		
+
 		if ((retval = target_blank_check_memory(target, address, size, &blank)) != ERROR_OK)
 		{
 			fast_check = 0;
@@ -1190,12 +1192,12 @@ int default_flash_blank_check(struct flash_bank_s *bank)
 			bank->sectors[i].is_erased = 0;
 		fast_check = 1;
 	}
-		
+
 	if (!fast_check)
 	{
 		LOG_USER("Running slow fallback erase check - add working memory");
 		return default_flash_mem_blank_check(bank);
 	}
-	
+
 	return ERROR_OK;
 }
diff --git a/src/flash/x7026.c b/src/flash/x7026.c
new file mode 100644
index 00000000..e700a8bd
--- /dev/null
+++ b/src/flash/x7026.c
@@ -0,0 +1,217 @@
+/***************************************************************************

+ *   Copyright (C) 2008 by Kevin McGuire                                   *

+ *   Copyright (C) 2008 by Marcel Wijlaars                                 *

+ *

+ *   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 "flash.h"

+#include "target.h"

+#include "log.h"

+#include "armv4_5.h"

+#include "algorithm.h"

+#include "binarybuffer.h"

+

+#include <stdlib.h>

+#include <string.h>

+#include <unistd.h>

+

+int x7026_flash_bank_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc, struct flash_bank_s *bank);

+int x7026_register_commands(struct command_context_s *cmd_ctx);

+int x7026_erase(struct flash_bank_s *bank, int first, int last);

+int x7026_protect(struct flash_bank_s *bank, int set, int first, int last);

+int x7026_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count);

+int x7026_probe(struct flash_bank_s *bank);

+int x7026_info(struct flash_bank_s *bank, char *buf, int buf_size);

+int x7026_protect_check(struct flash_bank_s *bank);

+int x7026_erase_check(struct flash_bank_s *bank);

+

+#define ADUC7026_FLASH				0xfffff800

+#define ADUC7026_FLASH_FEESTA			(0*4)

+#define ADUC7026_FLASH_FEEMOD			(1*4)

+#define ADUC7026_FLASH_FEECON			(2*4)

+#define ADUC7026_FLASH_FEEDAT			(3*4)

+#define ADUC7026_FLASH_FEEADR			(4*4)

+#define ADUC7026_FLASH_FEESIGN		(5*4)

+#define ADUC7026_FLASH_FEEPRO			(6*4)

+#define ADUC7026_FLASH_FEEHIDE		(7*4)

+

+typedef struct{

+	uint32_t	feesta;

+	uint32_t	feemod;

+	uint32_t	feecon;

+	uint32_t	feedat;

+	uint32_t	feeadr;

+	uint32_t	feesign;

+	uint32_t	feepro;

+	uint32_t	feehide;

+} ADUC7026_FLASH_MMIO;

+

+typedef struct

+{

+	unsigned char tmp;

+} X7026_BANK;

+

+flash_driver_t x7026_flash =

+{

+	.name = "x7026",

+	.register_commands = x7026_register_commands,

+	.flash_bank_command = x7026_flash_bank_command,

+	.erase = x7026_erase,

+	.protect = x7026_protect,

+	.write = x7026_write,

+	.probe = x7026_probe,

+	.auto_probe = x7026_probe,

+	.erase_check = x7026_erase_check,

+	.protect_check = x7026_protect_check,

+	.info = x7026_info

+};

+

+int x7026_register_commands(struct command_context_s *cmd_ctx)

+{

+	printf("x7026_register_commands not implemented yet.\n");

+	return ERROR_OK;

+}

+

+/* flash bank str7x <base> <size> 0 0 <target#>  */

+int x7026_flash_bank_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc, struct flash_bank_s *bank)

+{

+	X7026_BANK	*nbank;

+

+	if (argc < 6)

+	{

+		LOG_WARNING("incomplete flash_bank x7026 configuration");

+		return ERROR_FLASH_BANK_INVALID;

+	}

+

+	nbank = malloc(sizeof(X7026_BANK));

+	/* just warn that we are used to normally using 0x80000 */

+	if(bank->base != 0x80000)

+	{

+		LOG_WARNING("Default base address is 0x80000 on the ADuC7026!");

+	}

+	nbank->tmp = 1;

+	bank->driver_priv = nbank;

+	return ERROR_OK;

+}

+

+int x7026_protect_check(struct flash_bank_s *bank)

+{

+	printf("x7026_protect_check not implemented yet.\n");

+	return ERROR_OK;

+}

+

+int x7026_erase(struct flash_bank_s *bank, int first, int last)

+{

+	unsigned int 	x;

+	int 			count;

+	u32 			v;

+	target_t *target = bank->target;

+

+	/* mass erase */

+	if((first | last) == 0)

+	{

+		printf("performing mass erase.\n");

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEDAT, 0x3cff);

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEADR, 0xffc3);

+		target_read_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEMOD, &v);

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEMOD, v | 0x8);

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEECON, 0x06);

+		for(v = 0x4; v & 0x4;

+			target_read_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEESTA, &v));

+

+		if(!(v & 0x1))

+		{

+			printf("mass erase failed.\n");

+			return -1;

+		}

+		printf("mass erase successful.\n");

+		return ERROR_OK;

+	}

+

+	count = last - first;

+	for(x = 0; x < (unsigned int)count; ++x)

+	{

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEADR, bank->base + first * 512 + x * 512);

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEECON, 0x05);

+		for(v = 0x4; v & 0x4; target_read_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEESTA, &v));

+		if(!(v & 0x1))

+		{

+			printf("erase failed for page address %x\n", bank->base + first * 512 + x * 512);

+			return -1;

+		}

+		printf("erased page address %x\n", bank->base + first * 512 + x * 512);

+	}

+	return ERROR_OK;

+}

+

+int x7026_protect(struct flash_bank_s *bank, int set, int first, int last)

+{

+	printf("x7026_protect not implemented yet.\n");

+	return -1;

+}

+

+int x7026_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)

+{

+	unsigned int 	x;

+	u32			v;

+	target_t 		*target = bank->target;

+	for(x = 0; x < count; x += 2)

+	{

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEADR, offset + x);

+		/* if we able to encounter a single byte instead of a word */

+		if((x + 1) == count)

+		{

+			target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEDAT, buffer[x]);

+		}else{

+			target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEEDAT, buffer[x] | (buffer[x+1] << 8));

+		}

+		target_write_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEECON, 0x02);

+		for(v = 0x4; v & 0x4; target_read_u32(target, ADUC7026_FLASH + ADUC7026_FLASH_FEESTA, &v));

+		if(!(v & 0x1))

+		{

+			printf("single write failed for address %x.\n", offset + x);

+			return -1;

+		}

+		printf("single write for address %x.\n", offset + x);

+	}

+	return ERROR_OK;

+}

+

+int x7026_probe(struct flash_bank_s *bank)

+{

+	printf("x7026_probe not implemented yet.\n");

+	return ERROR_OK;

+}

+

+int x7026_info(struct flash_bank_s *bank, char *buf, int buf_size)

+{

+	snprintf(buf, buf_size, "x7026 flash driver info" );

+	return -1;

+}

+

+int x7026_erase_check(struct flash_bank_s *bank)

+{

+	printf("x7026_erase_check not implemented yet.\n");

+	return -1;

+}