rusefi
/
openocd
mirror of https://github.com/rusefi/openocd.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

- apply correct formatting to openocd.c 

- Thanks Charles Hardin

git-svn-id: svn://svn.berlios.de/openocd/trunk@770 b42882b7-edfa-0310-969c-e2dbd0fdcd60
This commit is contained in:
ntfreak 2008-07-08 08:55:53 +00:00
parent 9103bbbcb5
commit 31e2500259
1 changed files with 174 additions and 206 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

198
src/openocd.c
View File

@ -151,8 +151,7 @@ int handle_init_command(struct command_context_s *cmd_ctx, char *cmd, char **arg
LOG_DEBUG("jtag interface init complete"); LOG_DEBUG("jtag interface init complete");
/* Try to initialize & examine the JTAG chain at this point, but /* Try to initialize & examine the JTAG chain at this point, but
* continue startup regardless * continue startup regardless */
*/
if (jtag_init(cmd_ctx) == ERROR_OK) if (jtag_init(cmd_ctx) == ERROR_OK)
{ {
LOG_DEBUG("jtag init complete"); LOG_DEBUG("jtag init complete");
@ -185,7 +184,6 @@ int handle_init_command(struct command_context_s *cmd_ctx, char *cmd, char **arg
return ERROR_OK; return ERROR_OK;
} }
Jim_Interp *interp; Jim_Interp *interp;
command_context_t *active_cmd_ctx; command_context_t *active_cmd_ctx;
@ -195,17 +193,17 @@ static int new_int_array_element(Jim_Interp * interp, const char *varname, int i
Jim_Obj *nameObjPtr, *valObjPtr; Jim_Obj *nameObjPtr, *valObjPtr;
int result; int result;
namebuf = alloc_printf("%s(%d)", varname, idx ); namebuf = alloc_printf("%s(%d)", varname, idx);
nameObjPtr = Jim_NewStringObj(interp, namebuf, -1); nameObjPtr = Jim_NewStringObj(interp, namebuf, -1);
valObjPtr = Jim_NewIntObj(interp, val ); valObjPtr = Jim_NewIntObj(interp, val);
Jim_IncrRefCount(nameObjPtr); Jim_IncrRefCount(nameObjPtr);
Jim_IncrRefCount(valObjPtr); Jim_IncrRefCount(valObjPtr);
result = Jim_SetVariable(interp, nameObjPtr, valObjPtr); result = Jim_SetVariable(interp, nameObjPtr, valObjPtr);
Jim_DecrRefCount(interp, nameObjPtr); Jim_DecrRefCount(interp, nameObjPtr);
Jim_DecrRefCount(interp, valObjPtr); Jim_DecrRefCount(interp, valObjPtr);
free(namebuf); free(namebuf);
// printf( "%s = 0%08x\n", namebuf, val ); /* printf( "%s = 0%08x\n", namebuf, val ); */
return result; return result;
} }
@ -220,37 +218,37 @@ static int Jim_Command_mem2array(Jim_Interp *interp, int argc, Jim_Obj *const *a
u32 v; u32 v;
const char *varname; const char *varname;
u8 buffer[4096]; u8 buffer[4096];
int i,n,e,retval; int i, n, e, retval;
/* argv[1] = name of array to receive the data /* argv[1] = name of array to receive the data
* argv[2] = desired width * argv[2] = desired width
* argv[3] = memory address * argv[3] = memory address
* argv[4] = length in bytes to read * argv[4] = length in bytes to read
*/ */
if( argc != 5 ){ if (argc != 5) {
Jim_WrongNumArgs( interp, 1, argv, "varname width addr nelems" ); Jim_WrongNumArgs(interp, 1, argv, "varname width addr nelems");
return JIM_ERR; return JIM_ERR;
} }
varname = Jim_GetString( argv[1], &len ); varname = Jim_GetString(argv[1], &len);
/* given "foo" get space for worse case "foo(%d)" .. add 20 */ /* given "foo" get space for worse case "foo(%d)" .. add 20 */
e = Jim_GetLong( interp, argv[2], &l ); e = Jim_GetLong(interp, argv[2], &l);
width = l; width = l;
if( e != JIM_OK ){ if (e != JIM_OK) {
return e; return e;
} }
e = Jim_GetLong( interp, argv[3], &l ); e = Jim_GetLong(interp, argv[3], &l);
addr = l; addr = l;
if( e != JIM_OK ){ if (e != JIM_OK) {
return e; return e;
} }
e = Jim_GetLong( interp, argv[4], &l ); e = Jim_GetLong(interp, argv[4], &l);
len = l; len = l;
if( e != JIM_OK ){ if (e != JIM_OK) {
return e; return e;
} }
switch(width){ switch (width) {
case 8: case 8:
width = 1; width = 1;
break; break;
@ -261,53 +259,40 @@ static int Jim_Command_mem2array(Jim_Interp *interp, int argc, Jim_Obj *const *a
width = 4; width = 4;
break; break;
default: default:
Jim_SetResult(interp, Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
Jim_NewEmptyStringObj(interp)); Jim_AppendStrings( interp, Jim_GetResult(interp), "Invalid width param, must be 8/16/32", NULL );
Jim_AppendStrings( interp, Jim_GetResult(interp),
"Invalid width param, must be 8/16/32", NULL );
return JIM_ERR; return JIM_ERR;
} }
if( len == 0 ){ if (len == 0) {
Jim_SetResult(interp, Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
Jim_NewEmptyStringObj(interp)); Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: zero width read?", NULL);
Jim_AppendStrings( interp, Jim_GetResult(interp),
"mem2array: zero width read?", NULL );
return JIM_ERR; return JIM_ERR;
} }
if( (addr + (len * width)) < addr ){ if ((addr + (len * width)) < addr) {
Jim_SetResult(interp, Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
Jim_NewEmptyStringObj(interp)); Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: addr + len - wraps to zero?", NULL);
Jim_AppendStrings( interp, Jim_GetResult(interp),
"mem2array: addr + len - wraps to zero?", NULL );
return JIM_ERR; return JIM_ERR;
} }
/* absurd transfer size? */ /* absurd transfer size? */
if( len > 65536 ){ if (len > 65536) {
Jim_SetResult(interp, Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
Jim_NewEmptyStringObj(interp)); Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: absurd > 64K item request", NULL);
Jim_AppendStrings( interp, Jim_GetResult(interp),
"mem2array: absurd > 64K item request", NULL );
return JIM_ERR; return JIM_ERR;
} }
if( (width == 1) || if ((width == 1) ||
((width == 2) && ((addr & 1) == 0)) || ((width == 2) && ((addr & 1) == 0)) ||
((width == 4) && ((addr & 3) == 0)) ){ ((width == 4) && ((addr & 3) == 0))) {
/* all is well */ /* all is well */
} else { } else {
char buf[100]; char buf[100];
Jim_SetResult(interp, Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
Jim_NewEmptyStringObj(interp)); sprintf(buf, "mem2array address: 0x%08x is not aligned for %d byte reads", addr, width);
sprintf( buf, Jim_AppendStrings(interp, Jim_GetResult(interp), buf , NULL);
"mem2array address: 0x%08x is not aligned for %d byte reads",
addr, width );
Jim_AppendStrings( interp, Jim_GetResult(interp),
buf , NULL );
return JIM_ERR; return JIM_ERR;
} }
target = get_current_target( active_cmd_ctx ); target = get_current_target(active_cmd_ctx);
/* Transfer loop */ /* Transfer loop */
@ -315,52 +300,44 @@ static int Jim_Command_mem2array(Jim_Interp *interp, int argc, Jim_Obj *const *a
n = 0; n = 0;
/* assume ok */ /* assume ok */
e = JIM_OK; e = JIM_OK;
while( len ){ while (len) {
/* Slurp... in buffer size chunks */ /* Slurp... in buffer size chunks */
count = len; /* in objects.. */ count = len; /* in objects.. */
if( count > (sizeof(buffer)/width)){ if (count > (sizeof(buffer)/width)) {
count = (sizeof(buffer)/width); count = (sizeof(buffer)/width);
} }
retval = target->type->read_memory( target, retval = target->type->read_memory( target, addr, width, count, buffer );
addr,
width,
count,
buffer );
if( retval != ERROR_OK ){ if (retval != ERROR_OK) {
/* BOO !*/ /* BOO !*/
LOG_ERROR("mem2array: Read @ 0x%08x, w=%d, cnt=%d, failed", LOG_ERROR("mem2array: Read @ 0x%08x, w=%d, cnt=%d, failed", addr, width, count);
addr, width, count ); Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
Jim_SetResult(interp, Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: cannot read memory", NULL);
Jim_NewEmptyStringObj(interp));
Jim_AppendStrings( interp, Jim_GetResult(interp),
"mem2array: cannot read memory", NULL );
e = JIM_ERR; e = JIM_ERR;
len = 0; len = 0;
} else { } else {
v = 0; /* shut up gcc */ v = 0; /* shut up gcc */
for( i = 0 ; i < count ; i++, n++ ){ for (i = 0 ;i < count ;i++, n++) {
switch(width){ switch (width) {
case 4: case 4:
v = target_buffer_get_u32( target, &buffer[i*width] ); v = target_buffer_get_u32(target, &buffer[i*width]);
break; break;
case 2: case 2:
v = target_buffer_get_u16( target, &buffer[i*width] ); v = target_buffer_get_u16(target, &buffer[i*width]);
break; break;
case 1: case 1:
v = buffer[i] & 0x0ff; v = buffer[i] & 0x0ff;
break; break;
} }
new_int_array_element( interp, varname, n, v ); new_int_array_element(interp, varname, n, v);
} }
len -= count; len -= count;
} }
} }
Jim_SetResult(interp,
Jim_NewEmptyStringObj(interp)); Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
return JIM_OK; return JIM_OK;
} }
@ -373,11 +350,8 @@ static void tcl_output(void *privData, const char *file, int line, const char *f
} }
/* try to execute as Jim command, otherwise fall back to standard command. /* try to execute as Jim command, otherwise fall back to standard command.
* Note that even if the Jim command caused an error, then we succeeded
Note that even if the Jim command caused an error, then we succeeded * to execute it, hence this fn pretty much always returns ERROR_OK. */
to execute it, hence this fn pretty much always returns ERROR_OK.
*/
int jim_command(command_context_t *context, char *line) int jim_command(command_context_t *context, char *line)
{ {
int retval=ERROR_OK; int retval=ERROR_OK;
@ -389,41 +363,37 @@ int jim_command(command_context_t *context, char *line)
if (retcode == JIM_ERR) { if (retcode == JIM_ERR) {
int len, i; int len, i;
LOG_USER_N("Runtime error, file \"%s\", line %d:" JIM_NL, LOG_USER_N("Runtime error, file \"%s\", line %d:" JIM_NL, interp->errorFileName, interp->errorLine);
interp->errorFileName, interp->errorLine);
LOG_USER_N(" %s" JIM_NL, LOG_USER_N(" %s" JIM_NL,
Jim_GetString(interp->result, NULL)); Jim_GetString(interp->result, NULL));
Jim_ListLength(interp, interp->stackTrace, &len); Jim_ListLength(interp, interp->stackTrace, &len);
for (i = 0; i < len; i+= 3) { for (i = 0; i < len; i += 3) {
Jim_Obj *objPtr; Jim_Obj *objPtr;
const char *proc, *file, *line; const char *proc, *file, *line;
Jim_ListIndex(interp, interp->stackTrace, i, &objPtr, JIM_NONE); Jim_ListIndex(interp, interp->stackTrace, i, &objPtr, JIM_NONE);
proc = Jim_GetString(objPtr, NULL); proc = Jim_GetString(objPtr, NULL);
Jim_ListIndex(interp, interp->stackTrace, i+1, &objPtr, Jim_ListIndex(interp, interp->stackTrace, i+1, &objPtr, JIM_NONE);
JIM_NONE);
file = Jim_GetString(objPtr, NULL); file = Jim_GetString(objPtr, NULL);
Jim_ListIndex(interp, interp->stackTrace, i+2, &objPtr, Jim_ListIndex(interp, interp->stackTrace, i+2, &objPtr, JIM_NONE);
JIM_NONE);
line = Jim_GetString(objPtr, NULL); line = Jim_GetString(objPtr, NULL);
LOG_USER_N("In procedure '%s' called at file \"%s\", line %s" JIM_NL, LOG_USER_N("In procedure '%s' called at file \"%s\", line %s" JIM_NL, proc, file, line);
proc, file, line);
} }
} else if (retcode == JIM_EXIT) { } else if (retcode == JIM_EXIT) {
// ignore. /* ignore. */
//exit(Jim_GetExitCode(interp)); /* exit(Jim_GetExitCode(interp)); */
} else { } else {
if (reslen) { if (reslen) {
int i; int i;
char buff[256+1]; char buff[256+1];
for (i=0; i<reslen; i+=256) for (i = 0; i < reslen; i += 256)
{ {
int chunk; int chunk;
chunk=reslen-i; chunk = reslen - i;
if (chunk>256) if (chunk > 256)
chunk=256; chunk = 256;
strncpy(buff, result, chunk); strncpy(buff, result, chunk);
buff[chunk]=0; buff[chunk] = 0;
LOG_USER_N("%s", buff); LOG_USER_N("%s", buff);
} }
LOG_USER_N("%s", "\n"); LOG_USER_N("%s", "\n");
@ -432,7 +402,7 @@ int jim_command(command_context_t *context, char *line)
return retval; return retval;
} }
int startLoop=0; int startLoop = 0;
static int Jim_Command_openocd_ignore(Jim_Interp *interp, int argc, Jim_Obj *const *argv, int ignore) static int Jim_Command_openocd_ignore(Jim_Interp *interp, int argc, Jim_Obj *const *argv, int ignore)
{ {
@ -443,7 +413,7 @@ static int Jim_Command_openocd_ignore(Jim_Interp *interp, int argc, Jim_Obj *con
if (startLoop) if (startLoop)
{ {
// We don't know whether or not the telnet/gdb server is running... /* We don't know whether or not the telnet/gdb server is running... */
target_call_timer_callbacks_now(); target_call_timer_callbacks_now();
} }
@ -474,11 +444,11 @@ static int Jim_Command_openocd_throw(Jim_Interp *interp, int argc, Jim_Obj *cons
/* find full path to file */ /* find full path to file */
static int Jim_Command_find(Jim_Interp *interp, int argc, Jim_Obj *const *argv) static int Jim_Command_find(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
{ {
if (argc!=2) if (argc != 2)
return JIM_ERR; return JIM_ERR;
char *file = (char*)Jim_GetString(argv[1], NULL); char *file = (char*)Jim_GetString(argv[1], NULL);
char *full_path=find_file(file); char *full_path = find_file(file);
if (full_path==NULL) if (full_path == NULL)
return JIM_ERR; return JIM_ERR;
Jim_Obj *result = Jim_NewStringObj(interp, full_path, strlen(full_path)); Jim_Obj *result = Jim_NewStringObj(interp, full_path, strlen(full_path));
free(full_path); free(full_path);
@ -489,7 +459,7 @@ static int Jim_Command_find(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
static int Jim_Command_echo(Jim_Interp *interp, int argc, Jim_Obj *const *argv) static int Jim_Command_echo(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
{ {
if (argc!=2) if (argc != 2)
return JIM_ERR; return JIM_ERR;
char *str = (char*)Jim_GetString(argv[1], NULL); char *str = (char*)Jim_GetString(argv[1], NULL);
LOG_USER("%s", str); LOG_USER("%s", str);
@ -505,36 +475,36 @@ static size_t openocd_jim_fwrite(const void *_ptr, size_t size, size_t n, void *
ptr = _ptr; ptr = _ptr;
nbytes = size * n; nbytes = size * n;
if( nbytes == 0 ){ if (nbytes == 0) {
return 0; return 0;
} }
if( !active_cmd_ctx ){ if (!active_cmd_ctx) {
/* FIXME: Where should this go? */ /* TODO: Where should this go? */
return n; return n;
} }
/* do we have to chunk it? */ /* do we have to chunk it? */
if( ptr[ nbytes ] == 0 ){ if (ptr[nbytes] == 0) {
/* no it is a C style string */ /* no it is a C style string */
command_output_text( active_cmd_ctx, ptr ); command_output_text(active_cmd_ctx, ptr);
return strlen(ptr); return strlen(ptr);
} }
/* GRR we must chunk - not null terminated */ /* GRR we must chunk - not null terminated */
while( nbytes ){ while (nbytes) {
char chunk[128+1]; char chunk[128+1];
int x; int x;
x = nbytes; x = nbytes;
if( x > 128 ){ if (x > 128) {
x = 128; x = 128;
} }
/* copy it */ /* copy it */
memcpy( chunk, ptr, x ); memcpy(chunk, ptr, x);
/* terminate it */ /* terminate it */
chunk[n] = 0; chunk[n] = 0;
/* output it */ /* output it */
command_output_text( active_cmd_ctx, chunk ); command_output_text(active_cmd_ctx, chunk);
ptr += x; ptr += x;
nbytes -= x; nbytes -= x;
} }
@ -554,10 +524,10 @@ static int openocd_jim_vfprintf(void *cookie, const char *fmt, va_list ap)
int n; int n;
n = -1; n = -1;
if( active_cmd_ctx ){ if (active_cmd_ctx) {
cp = alloc_vprintf( fmt, ap ); cp = alloc_vprintf(fmt, ap);
if( cp ){ if (cp) {
command_output_text( active_cmd_ctx, cp ); command_output_text(active_cmd_ctx, cp);
n = strlen(cp); n = strlen(cp);
free(cp); free(cp);
} }
@ -603,7 +573,7 @@ void initJim2(void)
Jim_Eval(interp, "source [find tcl/commands.tcl]"); Jim_Eval(interp, "source [find tcl/commands.tcl]");
} }
command_context_t *setup_command_handler() command_context_t *setup_command_handler(void)
{ {
command_context_t *cmd_ctx; command_context_t *cmd_ctx;
@ -655,11 +625,9 @@ command_context_t *setup_command_handler()
return cmd_ctx; return cmd_ctx;
} }
/* /* normally this is the main() function entry, but if OpenOCD is linked
normally this is the main() function entry, but if OpenOCD is linked * into application, then this fn will not be invoked, but rather that
into application, then this fn will not be invoked, but rather that * application will have it's own implementation of main(). */
application will have it's own implementation of main().
*/
int openocd_main(int argc, char *argv[]) int openocd_main(int argc, char *argv[])
{ {
#ifdef JIM_EMBEDDED #ifdef JIM_EMBEDDED