392 lines
11 KiB
C
392 lines
11 KiB
C
/***************************************************************************
|
|
* 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%08X", dcc_buffer[1]);
|
|
else
|
|
LOG_ERROR("loader response to OCL_ERASE_BLOCK 0x%08X", 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%08X", 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%08X", 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;
|
|
}
|