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