- added svn props for newly added files

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

1 files changed, 402 insertions, 402 deletions

diff --git a/src/flash/ocl.c b/src/flash/ocl.c
index befa4e10..4f3b506c 100644
--- a/src/flash/ocl.c
+++ b/src/flash/ocl.c
@@ -1,402 +1,402 @@
-/***************************************************************************

- *   Copyright (C) 2007 by Pavel Chromy                                    *

- *   chromy@asix.cz                                                        *

- *                                                                         *

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

-

-#include "flash.h"

-#include "target.h"

-#include "log.h"

-#include "binarybuffer.h"

-#include "types.h"

-#include "embeddedice.h"

-#include "arm7_9_common.h"

-

-#include <stdlib.h>

-#include <string.h>

-#include <unistd.h>

-

-int ocl_register_commands(struct command_context_s *cmd_ctx);

-int ocl_flash_bank_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc, struct flash_bank_s *bank);

-int ocl_erase(struct flash_bank_s *bank, int first, int last);

-int ocl_protect(struct flash_bank_s *bank, int set, int first, int last);

-int ocl_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count);

-int ocl_probe(struct flash_bank_s *bank);

-int ocl_erase_check(struct flash_bank_s *bank);

-int ocl_protect_check(struct flash_bank_s *bank);

-int ocl_info(struct flash_bank_s *bank, char *buf, int buf_size);

-int ocl_auto_probe(struct flash_bank_s *bank);

-

-flash_driver_t ocl_flash =

-{

-	.name = "ocl",

-	.register_commands = ocl_register_commands,

-	.flash_bank_command = ocl_flash_bank_command,

-	.erase = ocl_erase,

-	.protect = ocl_protect,

-	.write = ocl_write,

-	.probe = ocl_probe,

-	.erase_check = ocl_erase_check,

-	.protect_check = ocl_protect_check,

-	.info = ocl_info,

-	.auto_probe = ocl_auto_probe

-};

-

-

-typedef struct ocl_priv_s

-{

-	arm_jtag_t *jtag_info;

-	int buflen;

-	int bufalign;

-} ocl_priv_t;

-

-

-int ocl_register_commands(struct command_context_s *cmd_ctx)

-{

-	return ERROR_OK;

-}

-

-

-int ocl_erase_check(struct flash_bank_s *bank)

-{

-	return ERROR_OK;

-}

-

-

-int ocl_protect_check(struct flash_bank_s *bank)

-{

-	return ERROR_OK;

-}

-

-

-/* flash_bank ocl 0 0 0 0 <target#> */

-int ocl_flash_bank_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc, struct flash_bank_s *bank)

-{

-	int retval;

-	armv4_5_common_t *armv4_5;

-	arm7_9_common_t *arm7_9;

-	ocl_priv_t *ocl;

-

-	if (argc < 6)

-	{

-		LOG_WARNING("incomplete flash_bank ocl configuration");

-		return ERROR_FLASH_BANK_INVALID;

-	}

-

-	if ((retval = arm7_9_get_arch_pointers(bank->target, &armv4_5, &arm7_9)) != ERROR_OK)

-		return retval;

-

-	ocl = bank->driver_priv = malloc(sizeof(ocl_priv_t));

-	ocl->jtag_info = &arm7_9->jtag_info;

-	ocl->buflen = 0;

-	ocl->bufalign = 1;

-

-	return ERROR_OK;

-}

-

-

-int ocl_erase(struct flash_bank_s *bank, int first, int last)

-{

-	ocl_priv_t *ocl = bank->driver_priv;

-	int retval;

-	u32 dcc_buffer[3];

-

-	/* check preconditions */

-	if (bank->num_sectors == 0)

-		return ERROR_FLASH_BANK_NOT_PROBED;

-		

-	if (bank->target->state != TARGET_RUNNING)

-	{

-		LOG_ERROR("target has to be running to communicate with the loader");

-		return ERROR_TARGET_NOT_RUNNING;

-	}

-		

-	if ((first == 0) && (last == bank->num_sectors - 1))

-	{

-		dcc_buffer[0] = OCL_ERASE_ALL;

-		if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-			return retval;

-	}

-	else

-	{

-		dcc_buffer[0] = OCL_ERASE_BLOCK;

-		dcc_buffer[1] = first;

-		dcc_buffer[2] = last;

-		if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, 3) != ERROR_OK))

-			return retval;

-	}

-

-	/* wait for response, fixed timeout of 1 s */

-	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 1000) != ERROR_OK))

-	{

-		if (retval == ERROR_TARGET_TIMEOUT)

-			LOG_ERROR("loader not responding");

-		return retval;

-	}

-

-	/* receive response */

-	if ((retval = embeddedice_receive(ocl->jtag_info, dcc_buffer+1, 1) != ERROR_OK))

-		return retval;

-

-	if (dcc_buffer[1] != OCL_CMD_DONE)

-	{

-		if (dcc_buffer[0] == OCL_ERASE_ALL)

-			LOG_ERROR("loader response to OCL_ERASE_ALL 0x%08lX", dcc_buffer[1]);

-		else

-			LOG_ERROR("loader response to OCL_ERASE_BLOCK 0x%08lX", dcc_buffer[1]);

-		return ERROR_FLASH_OPERATION_FAILED;

-	}

-

-	return ERROR_OK;

-}

-

-

-int ocl_protect(struct flash_bank_s *bank, int set, int first, int last)

-{

-	return ERROR_OK;

-}

-

-

-int ocl_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)

-{

-	ocl_priv_t *ocl = bank->driver_priv;

-	int retval;

-	u32 *dcc_buffer;

-	u32 *dcc_bufptr;

-	int byteofs;

-	int runlen;

-	u32 chksum;

-	

-	int i;

-

-	/* check preconditions */

-	if (ocl->buflen == 0 || ocl->bufalign==0)

-		return ERROR_FLASH_BANK_NOT_PROBED;

-

-	if (bank->target->state != TARGET_RUNNING)

-	{

-		LOG_ERROR("target has to be running to communicate with the loader");

-		return ERROR_TARGET_NOT_RUNNING;

-	}

-

-	/* allocate buffer for max. ocl buffer + overhead */

-	dcc_buffer = malloc(sizeof(u32)*(ocl->buflen/4+3));

-

-	while (count)

-	{

-		if (count + (offset % ocl->bufalign) > ocl->buflen)

-			runlen = ocl->buflen - (offset % ocl->bufalign);

-		else

-			runlen = count;

-

-		dcc_buffer[0] = OCL_FLASH_BLOCK | runlen;

-		dcc_buffer[1] = offset;

-		dcc_bufptr = &dcc_buffer[2];

-

-		*dcc_bufptr = 0xffffffff;

-		byteofs = (offset % ocl->bufalign) % 4;

-		chksum = OCL_CHKS_INIT;

-

-		/* copy data to DCC buffer in proper byte order and properly aligned */

-		for (i=0; i<runlen; i++)

-		{

-			switch (byteofs++)

-			{

-				case 0:

-					*dcc_bufptr &= *(buffer++) | 0xffffff00;

-					break;

-				case 1:

-					*dcc_bufptr &= ((*(buffer++))<<8) | 0xffff00ff;

-					break;

-				case 2:

-					*dcc_bufptr &= ((*(buffer++))<<16) | 0xff00ffff;

-					break;

-				case 3:

-					*dcc_bufptr &= ((*(buffer++))<<24) | 0x00ffffff;

-					chksum ^= *(dcc_bufptr++);

-					*dcc_bufptr = 0xffffffff;

-					byteofs = 0;

-					break;

-			}

-		}

-

-		/* add the remaining word to checksum */

-		if (byteofs)

-			chksum ^= *(dcc_bufptr++);

-

-		*(dcc_bufptr++) = chksum;

-		

-		/* send the data */

-		if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, dcc_bufptr-dcc_buffer)) != ERROR_OK)

-		{

-			free(dcc_buffer);

-		  return retval;

-		}

-

-		/* wait for response, fixed timeout of 1 s */

-		if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 1000) != ERROR_OK))

-		{

-			if (retval == ERROR_TARGET_TIMEOUT)

-				LOG_ERROR("loader not responding");

-			free(dcc_buffer);

-			return retval;

-		}

-

-		/* receive response */

-		if ((retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-		{

-			free(dcc_buffer);

-			return retval;

-		}

-

-		if (dcc_buffer[0] != OCL_CMD_DONE)

-		{

-			LOG_ERROR("loader response to OCL_FLASH_BLOCK 0x%08lX", dcc_buffer[0]);

-			free(dcc_buffer);

-			return ERROR_FLASH_OPERATION_FAILED;

-		}

-

-		count -= runlen;

-		offset += runlen;

-	}

-

-	free(dcc_buffer);

-	return ERROR_OK;

-}

-

-

-int ocl_probe(struct flash_bank_s *bank)

-{

-	ocl_priv_t *ocl = bank->driver_priv;

-	int retval;

-	u32 dcc_buffer[1];

-	int sectsize;

-	int i;

-

-	/* purge pending data in DCC */

-	embeddedice_receive(ocl->jtag_info, dcc_buffer, 1);

-

-	dcc_buffer[0] = OCL_PROBE;

-	if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-		return retval;

-

-	/* wait for response, fixed timeout of 1 s */

-	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 1000) != ERROR_OK))

-	{

-		if (retval == ERROR_TARGET_TIMEOUT)

-			LOG_ERROR("loader not responding");

-		return retval;

-	}

-

-	/* receive response */

-	if ((retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-		return retval;

-		

-	if (dcc_buffer[0] != OCL_CMD_DONE)

-	{

-		LOG_ERROR("loader response to OCL_PROBE 0x%08lX", dcc_buffer[0]);

-		return ERROR_FLASH_OPERATION_FAILED;

-	}

-

-	/* receive and fill in parameters, detection of loader is important, receive it one by one */

-	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)

-		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-		return retval;

-	bank->base = dcc_buffer[0];

-

-	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)

-		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-		return retval;

-	bank->size = dcc_buffer[0];

-

-	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)

-		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-		return retval;

-	bank->num_sectors = dcc_buffer[0];

-

-	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)

-		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))

-		return retval;

-	ocl->buflen = dcc_buffer[0] & 0xffff;

-	ocl->bufalign = dcc_buffer[0] >> 16;

-

-	bank->sectors = realloc(bank->sectors, sizeof(flash_sector_t)*bank->num_sectors);

-	if (bank->num_sectors == 0)

-	{

-		LOG_ERROR("number of sectors shall be non zero value");

-		return ERROR_FLASH_BANK_INVALID;

-	}

-	if (bank->size % bank->num_sectors) {

-		LOG_ERROR("bank size not divisible by number of sectors");

-		return ERROR_FLASH_BANK_INVALID;

-	}

-	sectsize = bank->size / bank->num_sectors;

-	for (i=0; i<bank->num_sectors; i++)

-	{

-		bank->sectors[i].offset = i * sectsize;

-		bank->sectors[i].size = sectsize;

-		bank->sectors[i].is_erased = -1;

-		bank->sectors[i].is_protected = -1;

-	}

-

-	if (ocl->bufalign == 0)

-		ocl->bufalign = 1;

-

-	if (ocl->buflen == 0)

-	{

-		LOG_ERROR("buflen shall be non zero value");

-		return ERROR_FLASH_BANK_INVALID;

-	}

-

-	if ((ocl->bufalign > ocl->buflen) || (ocl->buflen % ocl->bufalign))

-	{

-		LOG_ERROR("buflen is not multiple of bufalign");

-		return ERROR_FLASH_BANK_INVALID;

-	}

-

-	if (ocl->buflen % 4)

-	{

-		LOG_ERROR("buflen shall be divisible by 4");

-		return ERROR_FLASH_BANK_INVALID;

-	}

-

-	return ERROR_OK;

-}

-

-

-int ocl_info(struct flash_bank_s *bank, char *buf, int buf_size)

-{

-	return ERROR_OK;

-}

-

-

-int ocl_auto_probe(struct flash_bank_s *bank)

-{

-	ocl_priv_t *ocl = bank->driver_priv;

-

-	if (ocl->buflen == 0 || ocl->bufalign==0)

-		return ERROR_FLASH_BANK_NOT_PROBED;

-

-	return ERROR_OK;

-}

+/***************************************************************************
+ *   Copyright (C) 2007 by Pavel Chromy                                    *
+ *   chromy@asix.cz                                                        *
+ *                                                                         *
+ *   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 "ocl.h"
+
+#include "flash.h"
+#include "target.h"
+#include "log.h"
+#include "binarybuffer.h"
+#include "types.h"
+#include "embeddedice.h"
+#include "arm7_9_common.h"
+
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+
+int ocl_register_commands(struct command_context_s *cmd_ctx);
+int ocl_flash_bank_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc, struct flash_bank_s *bank);
+int ocl_erase(struct flash_bank_s *bank, int first, int last);
+int ocl_protect(struct flash_bank_s *bank, int set, int first, int last);
+int ocl_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count);
+int ocl_probe(struct flash_bank_s *bank);
+int ocl_erase_check(struct flash_bank_s *bank);
+int ocl_protect_check(struct flash_bank_s *bank);
+int ocl_info(struct flash_bank_s *bank, char *buf, int buf_size);
+int ocl_auto_probe(struct flash_bank_s *bank);
+
+flash_driver_t ocl_flash =
+{
+	.name = "ocl",
+	.register_commands = ocl_register_commands,
+	.flash_bank_command = ocl_flash_bank_command,
+	.erase = ocl_erase,
+	.protect = ocl_protect,
+	.write = ocl_write,
+	.probe = ocl_probe,
+	.erase_check = ocl_erase_check,
+	.protect_check = ocl_protect_check,
+	.info = ocl_info,
+	.auto_probe = ocl_auto_probe
+};
+
+
+typedef struct ocl_priv_s
+{
+	arm_jtag_t *jtag_info;
+	int buflen;
+	int bufalign;
+} ocl_priv_t;
+
+
+int ocl_register_commands(struct command_context_s *cmd_ctx)
+{
+	return ERROR_OK;
+}
+
+
+int ocl_erase_check(struct flash_bank_s *bank)
+{
+	return ERROR_OK;
+}
+
+
+int ocl_protect_check(struct flash_bank_s *bank)
+{
+	return ERROR_OK;
+}
+
+
+/* flash_bank ocl 0 0 0 0 <target#> */
+int ocl_flash_bank_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc, struct flash_bank_s *bank)
+{
+	int retval;
+	armv4_5_common_t *armv4_5;
+	arm7_9_common_t *arm7_9;
+	ocl_priv_t *ocl;
+
+	if (argc < 6)
+	{
+		LOG_WARNING("incomplete flash_bank ocl configuration");
+		return ERROR_FLASH_BANK_INVALID;
+	}
+
+	if ((retval = arm7_9_get_arch_pointers(bank->target, &armv4_5, &arm7_9)) != ERROR_OK)
+		return retval;
+
+	ocl = bank->driver_priv = malloc(sizeof(ocl_priv_t));
+	ocl->jtag_info = &arm7_9->jtag_info;
+	ocl->buflen = 0;
+	ocl->bufalign = 1;
+
+	return ERROR_OK;
+}
+
+
+int ocl_erase(struct flash_bank_s *bank, int first, int last)
+{
+	ocl_priv_t *ocl = bank->driver_priv;
+	int retval;
+	u32 dcc_buffer[3];
+
+	/* check preconditions */
+	if (bank->num_sectors == 0)
+		return ERROR_FLASH_BANK_NOT_PROBED;
+		
+	if (bank->target->state != TARGET_RUNNING)
+	{
+		LOG_ERROR("target has to be running to communicate with the loader");
+		return ERROR_TARGET_NOT_RUNNING;
+	}
+		
+	if ((first == 0) && (last == bank->num_sectors - 1))
+	{
+		dcc_buffer[0] = OCL_ERASE_ALL;
+		if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+			return retval;
+	}
+	else
+	{
+		dcc_buffer[0] = OCL_ERASE_BLOCK;
+		dcc_buffer[1] = first;
+		dcc_buffer[2] = last;
+		if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, 3) != ERROR_OK))
+			return retval;
+	}
+
+	/* wait for response, fixed timeout of 1 s */
+	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 1000) != ERROR_OK))
+	{
+		if (retval == ERROR_TARGET_TIMEOUT)
+			LOG_ERROR("loader not responding");
+		return retval;
+	}
+
+	/* receive response */
+	if ((retval = embeddedice_receive(ocl->jtag_info, dcc_buffer+1, 1) != ERROR_OK))
+		return retval;
+
+	if (dcc_buffer[1] != OCL_CMD_DONE)
+	{
+		if (dcc_buffer[0] == OCL_ERASE_ALL)
+			LOG_ERROR("loader response to OCL_ERASE_ALL 0x%08lX", dcc_buffer[1]);
+		else
+			LOG_ERROR("loader response to OCL_ERASE_BLOCK 0x%08lX", dcc_buffer[1]);
+		return ERROR_FLASH_OPERATION_FAILED;
+	}
+
+	return ERROR_OK;
+}
+
+
+int ocl_protect(struct flash_bank_s *bank, int set, int first, int last)
+{
+	return ERROR_OK;
+}
+
+
+int ocl_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
+{
+	ocl_priv_t *ocl = bank->driver_priv;
+	int retval;
+	u32 *dcc_buffer;
+	u32 *dcc_bufptr;
+	int byteofs;
+	int runlen;
+	u32 chksum;
+	
+	int i;
+
+	/* check preconditions */
+	if (ocl->buflen == 0 || ocl->bufalign==0)
+		return ERROR_FLASH_BANK_NOT_PROBED;
+
+	if (bank->target->state != TARGET_RUNNING)
+	{
+		LOG_ERROR("target has to be running to communicate with the loader");
+		return ERROR_TARGET_NOT_RUNNING;
+	}
+
+	/* allocate buffer for max. ocl buffer + overhead */
+	dcc_buffer = malloc(sizeof(u32)*(ocl->buflen/4+3));
+
+	while (count)
+	{
+		if (count + (offset % ocl->bufalign) > ocl->buflen)
+			runlen = ocl->buflen - (offset % ocl->bufalign);
+		else
+			runlen = count;
+
+		dcc_buffer[0] = OCL_FLASH_BLOCK | runlen;
+		dcc_buffer[1] = offset;
+		dcc_bufptr = &dcc_buffer[2];
+
+		*dcc_bufptr = 0xffffffff;
+		byteofs = (offset % ocl->bufalign) % 4;
+		chksum = OCL_CHKS_INIT;
+
+		/* copy data to DCC buffer in proper byte order and properly aligned */
+		for (i=0; i<runlen; i++)
+		{
+			switch (byteofs++)
+			{
+				case 0:
+					*dcc_bufptr &= *(buffer++) | 0xffffff00;
+					break;
+				case 1:
+					*dcc_bufptr &= ((*(buffer++))<<8) | 0xffff00ff;
+					break;
+				case 2:
+					*dcc_bufptr &= ((*(buffer++))<<16) | 0xff00ffff;
+					break;
+				case 3:
+					*dcc_bufptr &= ((*(buffer++))<<24) | 0x00ffffff;
+					chksum ^= *(dcc_bufptr++);
+					*dcc_bufptr = 0xffffffff;
+					byteofs = 0;
+					break;
+			}
+		}
+
+		/* add the remaining word to checksum */
+		if (byteofs)
+			chksum ^= *(dcc_bufptr++);
+
+		*(dcc_bufptr++) = chksum;
+		
+		/* send the data */
+		if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, dcc_bufptr-dcc_buffer)) != ERROR_OK)
+		{
+			free(dcc_buffer);
+		  return retval;
+		}
+
+		/* wait for response, fixed timeout of 1 s */
+		if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 1000) != ERROR_OK))
+		{
+			if (retval == ERROR_TARGET_TIMEOUT)
+				LOG_ERROR("loader not responding");
+			free(dcc_buffer);
+			return retval;
+		}
+
+		/* receive response */
+		if ((retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+		{
+			free(dcc_buffer);
+			return retval;
+		}
+
+		if (dcc_buffer[0] != OCL_CMD_DONE)
+		{
+			LOG_ERROR("loader response to OCL_FLASH_BLOCK 0x%08lX", dcc_buffer[0]);
+			free(dcc_buffer);
+			return ERROR_FLASH_OPERATION_FAILED;
+		}
+
+		count -= runlen;
+		offset += runlen;
+	}
+
+	free(dcc_buffer);
+	return ERROR_OK;
+}
+
+
+int ocl_probe(struct flash_bank_s *bank)
+{
+	ocl_priv_t *ocl = bank->driver_priv;
+	int retval;
+	u32 dcc_buffer[1];
+	int sectsize;
+	int i;
+
+	/* purge pending data in DCC */
+	embeddedice_receive(ocl->jtag_info, dcc_buffer, 1);
+
+	dcc_buffer[0] = OCL_PROBE;
+	if ((retval = embeddedice_send(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+		return retval;
+
+	/* wait for response, fixed timeout of 1 s */
+	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 1000) != ERROR_OK))
+	{
+		if (retval == ERROR_TARGET_TIMEOUT)
+			LOG_ERROR("loader not responding");
+		return retval;
+	}
+
+	/* receive response */
+	if ((retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+		return retval;
+		
+	if (dcc_buffer[0] != OCL_CMD_DONE)
+	{
+		LOG_ERROR("loader response to OCL_PROBE 0x%08lX", dcc_buffer[0]);
+		return ERROR_FLASH_OPERATION_FAILED;
+	}
+
+	/* receive and fill in parameters, detection of loader is important, receive it one by one */
+	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)
+		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+		return retval;
+	bank->base = dcc_buffer[0];
+
+	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)
+		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+		return retval;
+	bank->size = dcc_buffer[0];
+
+	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)
+		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+		return retval;
+	bank->num_sectors = dcc_buffer[0];
+
+	if ((retval = embeddedice_handshake(ocl->jtag_info, EICE_COMM_CTRL_WBIT, 0) != ERROR_OK)
+		|| (retval = embeddedice_receive(ocl->jtag_info, dcc_buffer, 1) != ERROR_OK))
+		return retval;
+	ocl->buflen = dcc_buffer[0] & 0xffff;
+	ocl->bufalign = dcc_buffer[0] >> 16;
+
+	bank->sectors = realloc(bank->sectors, sizeof(flash_sector_t)*bank->num_sectors);
+	if (bank->num_sectors == 0)
+	{
+		LOG_ERROR("number of sectors shall be non zero value");
+		return ERROR_FLASH_BANK_INVALID;
+	}
+	if (bank->size % bank->num_sectors) {
+		LOG_ERROR("bank size not divisible by number of sectors");
+		return ERROR_FLASH_BANK_INVALID;
+	}
+	sectsize = bank->size / bank->num_sectors;
+	for (i=0; i<bank->num_sectors; i++)
+	{
+		bank->sectors[i].offset = i * sectsize;
+		bank->sectors[i].size = sectsize;
+		bank->sectors[i].is_erased = -1;
+		bank->sectors[i].is_protected = -1;
+	}
+
+	if (ocl->bufalign == 0)
+		ocl->bufalign = 1;
+
+	if (ocl->buflen == 0)
+	{
+		LOG_ERROR("buflen shall be non zero value");
+		return ERROR_FLASH_BANK_INVALID;
+	}
+
+	if ((ocl->bufalign > ocl->buflen) || (ocl->buflen % ocl->bufalign))
+	{
+		LOG_ERROR("buflen is not multiple of bufalign");
+		return ERROR_FLASH_BANK_INVALID;
+	}
+
+	if (ocl->buflen % 4)
+	{
+		LOG_ERROR("buflen shall be divisible by 4");
+		return ERROR_FLASH_BANK_INVALID;
+	}
+
+	return ERROR_OK;
+}
+
+
+int ocl_info(struct flash_bank_s *bank, char *buf, int buf_size)
+{
+	return ERROR_OK;
+}
+
+
+int ocl_auto_probe(struct flash_bank_s *bank)
+{
+	ocl_priv_t *ocl = bank->driver_priv;
+
+	if (ocl->buflen == 0 || ocl->bufalign==0)
+		return ERROR_FLASH_BANK_NOT_PROBED;
+
+	return ERROR_OK;
+}