-/***************************************************************************\r
- * Copyright (C) 2007-2008 by Øyvind Harboe *\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
-\r
-/* this file contains various functionality useful to standalone systems */\r
-\r
-#ifdef HAVE_CONFIG_H\r
-#include "config.h"\r
-#endif\r
-\r
-#include "log.h"\r
-#include "types.h"\r
-#include "configuration.h"\r
-#include "target.h"\r
-\r
-#include "command.h"\r
-\r
-#include <time_support.h>\r
-#include <sys/time.h>\r
-#include <sys/types.h>\r
-#include <strings.h>\r
-#include <stdio.h>\r
-#include <stdlib.h>\r
-#include <string.h>\r
-#include <unistd.h>\r
-#if !BUILD_ECOSBOARD\r
-#include <malloc.h>\r
-#endif\r
-#include <errno.h>\r
-\r
-\r
-#include <fcntl.h>\r
-#include <sys/stat.h>\r
-#include <dirent.h>\r
-#include <netinet/tcp.h>\r
-#include <sys/ioctl.h>\r
-#include <sys/socket.h>\r
-#include <netinet/in.h>\r
-#include <net/if.h>\r
-#include <arpa/inet.h>\r
-#include <sys/types.h>\r
-#include <sys/socket.h>\r
-#include <netdb.h>\r
-#include <netinet/in.h>\r
-#include <unistd.h>\r
-#include <arpa/inet.h>\r
-#include <stdio.h>\r
-#include <string.h>\r
-\r
-\r
-#include <unistd.h>\r
-#include <stdio.h>\r
-\r
-int handle_rm_command(struct command_context_s *cmd_ctx, char *cmd,\r
- char **args, int argc)\r
-{\r
- if (argc != 1)\r
- {\r
- command_print(cmd_ctx, "rm <filename>");\r
- return ERROR_INVALID_ARGUMENTS;\r
- }\r
-\r
- if (unlink(args[0]) != 0)\r
- {\r
- command_print(cmd_ctx, "failed: %d", errno);\r
- }\r
-\r
- return ERROR_OK;\r
-}\r
-\r
-\r
-/* loads a file and returns a pointer to it in memory. The file contains\r
- * a 0 byte(sentinel) after len bytes - the length of the file. */\r
-int loadFile(const char *fileName, void **data, int *len)\r
-{\r
- FILE * pFile;\r
- pFile = fopen(fileName,"rb");\r
- if (pFile==NULL)\r
- {\r
- LOG_ERROR("Can't open %s\n", fileName);\r
- return ERROR_FAIL;\r
- }\r
- if (fseek(pFile, 0, SEEK_END)!=0)\r
- {\r
- LOG_ERROR("Can't open %s\n", fileName);\r
- fclose(pFile);\r
- return ERROR_FAIL;\r
- }\r
- *len=ftell(pFile);\r
- if (*len==-1)\r
- {\r
- LOG_ERROR("Can't open %s\n", fileName);\r
- fclose(pFile);\r
- return ERROR_FAIL;\r
- }\r
-\r
- if (fseek(pFile, 0, SEEK_SET)!=0)\r
- {\r
- LOG_ERROR("Can't open %s\n", fileName);\r
- fclose(pFile);\r
- return ERROR_FAIL;\r
- }\r
- *data=malloc(*len+1);\r
- if (*data==NULL)\r
- {\r
- LOG_ERROR("Can't open %s\n", fileName);\r
- fclose(pFile);\r
- return ERROR_FAIL;\r
- }\r
-\r
- if (fread(*data, 1, *len, pFile)!=*len)\r
- {\r
- fclose(pFile);\r
- free(*data);\r
- LOG_ERROR("Can't open %s\n", fileName);\r
- return ERROR_FAIL;\r
- }\r
- fclose(pFile);\r
- *(((char *)(*data))+*len)=0; /* sentinel */\r
-\r
- return ERROR_OK;\r
-\r
-\r
-\r
-}\r
-\r
-\r
-\r
-int handle_cat_command(struct command_context_s *cmd_ctx, char *cmd,\r
- char **args, int argc)\r
-{\r
- if (argc != 1)\r
- {\r
- command_print(cmd_ctx, "cat <filename>");\r
- return ERROR_INVALID_ARGUMENTS;\r
- }\r
-\r
- // NOTE!!! we only have line printing capability so we print the entire file as a single line.\r
- void *data;\r
- int len;\r
-\r
- int retval = loadFile(args[0], &data, &len);\r
- if (retval == ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "%s", data);\r
- free(data);\r
- }\r
- else\r
- {\r
- command_print(cmd_ctx, "%s not found %d", args[0], retval);\r
- }\r
-\r
- return ERROR_OK;\r
-}\r
-int handle_trunc_command(struct command_context_s *cmd_ctx, char *cmd,\r
- char **args, int argc)\r
-{\r
- if (argc != 1)\r
- {\r
- command_print(cmd_ctx, "trunc <filename>");\r
- return ERROR_INVALID_ARGUMENTS;\r
- }\r
-\r
- FILE *config_file = NULL;\r
- config_file = fopen(args[0], "w");\r
- if (config_file != NULL)\r
- fclose(config_file);\r
-\r
- return ERROR_OK;\r
-}\r
-\r
-\r
-int handle_meminfo_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- static int prev = 0;\r
- struct mallinfo info;\r
-\r
- if (argc != 0)\r
- {\r
- command_print(cmd_ctx, "meminfo");\r
- return ERROR_INVALID_ARGUMENTS;\r
- }\r
-\r
- info = mallinfo();\r
-\r
- if (prev > 0)\r
- {\r
- command_print(cmd_ctx, "Diff: %d", prev - info.fordblks);\r
- }\r
- prev = info.fordblks;\r
-\r
- command_print(cmd_ctx, "Available ram: %d", info.fordblks );\r
-\r
- return ERROR_OK;\r
-}\r
-\r
-\r
-int handle_append_command(struct command_context_s *cmd_ctx, char *cmd,\r
- char **args, int argc)\r
-{\r
- if (argc < 1)\r
- {\r
- command_print(cmd_ctx,\r
- "append <filename> [<string1>, [<string2>, ...]]");\r
- return ERROR_INVALID_ARGUMENTS;\r
- }\r
-\r
- FILE *config_file = NULL;\r
- config_file = fopen(args[0], "a");\r
- if (config_file != NULL)\r
- {\r
- int i;\r
- fseek(config_file, 0, SEEK_END);\r
-\r
- for (i = 1; i < argc; i++)\r
- {\r
- fwrite(args[i], strlen(args[i]), 1, config_file);\r
- if (i != argc - 1)\r
- {\r
- fwrite(" ", 1, 1, config_file);\r
- }\r
- }\r
- fwrite("\n", 1, 1, config_file);\r
- fclose(config_file);\r
- }\r
-\r
- return ERROR_OK;\r
-}\r
-\r
-\r
-\r
-int handle_cp_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- if (argc != 2)\r
- {\r
- return ERROR_INVALID_ARGUMENTS;\r
- }\r
-\r
- // NOTE!!! we only have line printing capability so we print the entire file as a single line.\r
- void *data;\r
- int len;\r
-\r
- int retval = loadFile(args[0], &data, &len);\r
- if (retval != ERROR_OK)\r
- return retval;\r
-\r
- FILE *f = fopen(args[1], "wb");\r
- if (f == NULL)\r
- retval = ERROR_INVALID_ARGUMENTS;\r
-\r
- int pos = 0;\r
- for (;;)\r
- {\r
- int chunk = len - pos;\r
- static const int maxChunk = 512 * 1024; // ~1/sec\r
- if (chunk > maxChunk)\r
- {\r
- chunk = maxChunk;\r
- }\r
-\r
- if ((retval==ERROR_OK)&&(fwrite(((char *)data)+pos, 1, chunk, f)!=chunk))\r
- retval = ERROR_INVALID_ARGUMENTS;\r
-\r
- if (retval != ERROR_OK)\r
- {\r
- break;\r
- }\r
-\r
- command_print(cmd_ctx, "%d", len - pos);\r
-\r
- pos += chunk;\r
-\r
- if (pos == len)\r
- break;\r
- }\r
-\r
- if (retval == ERROR_OK)\r
- {\r
- command_print(cmd_ctx, "Copied %s to %s", args[0], args[1]);\r
- } else\r
- {\r
- command_print(cmd_ctx, "Failed: %d", retval);\r
- }\r
-\r
- if (data != NULL)\r
- free(data);\r
- if (f != NULL)\r
- fclose(f);\r
-\r
- if (retval != ERROR_OK)\r
- unlink(args[1]);\r
-\r
- return retval;\r
-}\r
-\r
-\r
-\r
-\r
-#define SHOW_RESULT(a, b) LOG_ERROR(#a " failed %d\n", (int)b)\r
-\r
-#define IOSIZE 512\r
-void copyfile(char *name2, char *name1)\r
-{\r
-\r
- int err;\r
- char buf[IOSIZE];\r
- int fd1, fd2;\r
- ssize_t done, wrote;\r
-\r
- fd1 = open(name1, O_WRONLY | O_CREAT);\r
- if (fd1 < 0)\r
- SHOW_RESULT( open, fd1 );\r
-\r
- fd2 = open(name2, O_RDONLY);\r
- if (fd2 < 0)\r
- SHOW_RESULT( open, fd2 );\r
-\r
- for (;;)\r
- {\r
- done = read(fd2, buf, IOSIZE );\r
- if (done < 0)\r
- {\r
- SHOW_RESULT( read, done );\r
- break;\r
- }\r
-\r
- if( done == 0 ) break;\r
-\r
- wrote = write(fd1, buf, done);\r
- if( wrote != done ) SHOW_RESULT( write, wrote );\r
-\r
- if( wrote != done ) break;\r
- }\r
-\r
- err = close(fd1);\r
- if( err < 0 ) SHOW_RESULT( close, err );\r
-\r
- err = close(fd2);\r
- if( err < 0 ) SHOW_RESULT( close, err );\r
-\r
-}\r
-\r
-/* utility fn to copy a directory */\r
-void copydir(char *name, char *destdir)\r
-{\r
- int err;\r
- DIR *dirp;\r
-\r
- dirp = opendir(destdir);\r
- if (dirp==NULL)\r
- {\r
- mkdir(destdir, 0777);\r
- } else\r
- {\r
- err = closedir(dirp);\r
- }\r
-\r
- dirp = opendir(name);\r
- if( dirp == NULL ) SHOW_RESULT( opendir, -1 );\r
-\r
- for (;;)\r
- {\r
- struct dirent *entry = readdir(dirp);\r
-\r
- if (entry == NULL)\r
- break;\r
-\r
- if (strcmp(entry->d_name, ".") == 0)\r
- continue;\r
- if (strcmp(entry->d_name, "..") == 0)\r
- continue;\r
-\r
- int isDir = 0;\r
- struct stat buf;\r
- char fullPath[PATH_MAX];\r
- strncpy(fullPath, name, PATH_MAX);\r
- strcat(fullPath, "/");\r
- strncat(fullPath, entry->d_name, PATH_MAX - strlen(fullPath));\r
-\r
- if (stat(fullPath, &buf) == -1)\r
- {\r
- LOG_ERROR("unable to read status from %s", fullPath);\r
- break;\r
- }\r
- isDir = S_ISDIR(buf.st_mode) != 0;\r
-\r
- if (isDir)\r
- continue;\r
-\r
- // diag_printf("<INFO>: entry %14s",entry->d_name);\r
- char fullname[PATH_MAX];\r
- char fullname2[PATH_MAX];\r
-\r
- strcpy(fullname, name);\r
- strcat(fullname, "/");\r
- strcat(fullname, entry->d_name);\r
-\r
- strcpy(fullname2, destdir);\r
- strcat(fullname2, "/");\r
- strcat(fullname2, entry->d_name);\r
- // diag_printf("from %s to %s\n", fullname, fullname2);\r
- copyfile(fullname, fullname2);\r
-\r
- // diag_printf("\n");\r
- }\r
-\r
- err = closedir(dirp);\r
- if( err < 0 ) SHOW_RESULT( stat, err );\r
-}\r
-\r
-\r
-\r
-\r
-static int\r
-zylinjtag_Jim_Command_rm(Jim_Interp *interp,\r
- int argc,\r
- Jim_Obj * const *argv)\r
-{\r
- int del;\r
- if (argc != 2)\r
- {\r
- Jim_WrongNumArgs(interp, 1, argv, "rm ?dirorfile?");\r
- return JIM_ERR;\r
- }\r
-\r
- del = 0;\r
- if (unlink(Jim_GetString(argv[1], NULL)) == 0)\r
- del = 1;\r
- if (rmdir(Jim_GetString(argv[1], NULL)) == 0)\r
- del = 1;\r
-\r
- return del ? JIM_OK : JIM_ERR;\r
-}\r
-\r
-\r
-static int\r
-zylinjtag_Jim_Command_ls(Jim_Interp *interp,\r
- int argc,\r
- Jim_Obj * const *argv)\r
-{\r
- if (argc != 2)\r
- {\r
- Jim_WrongNumArgs(interp, 1, argv, "ls ?dir?");\r
- return JIM_ERR;\r
- }\r
-\r
- char *name = (char*) Jim_GetString(argv[1], NULL);\r
-\r
- DIR *dirp = NULL;\r
- dirp = opendir(name);\r
- if (dirp == NULL)\r
- {\r
- return JIM_ERR;\r
- }\r
- Jim_Obj *objPtr = Jim_NewListObj(interp, NULL, 0);\r
-\r
- for (;;)\r
- {\r
- struct dirent *entry = NULL;\r
- entry = readdir(dirp);\r
- if (entry == NULL)\r
- break;\r
-\r
- if ((strcmp(".", entry->d_name)==0)||(strcmp("..", entry->d_name)==0))\r
- continue;\r
-\r
- Jim_ListAppendElement(interp, objPtr, Jim_NewStringObj(interp, entry->d_name, strlen(entry->d_name)));\r
- }\r
- closedir(dirp);\r
-\r
- Jim_SetResult(interp, objPtr);\r
-\r
- return JIM_OK;\r
-}\r
-\r
-int handle_peek_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- if (argc != 1)\r
- {\r
- return ERROR_COMMAND_SYNTAX_ERROR;\r
- }\r
- volatile int *address=(volatile int *)strtoul(args[0], NULL, 0);\r
- int value=*address;\r
- command_print(cmd_ctx, "0x%x : 0x%x", address, value);\r
- return ERROR_OK;\r
-}\r
-\r
-int handle_poke_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)\r
-{\r
- if (argc != 2)\r
- {\r
- return ERROR_INVALID_ARGUMENTS;\r
- }\r
- volatile int *address=(volatile int *)strtoul(args[0], NULL, 0);\r
- int value=strtoul(args[1], NULL, 0);\r
- *address=value;\r
- return ERROR_OK;\r
-}\r
-\r
-static int\r
-zylinjtag_Jim_Command_peek(Jim_Interp *interp,\r
- int argc,\r
- Jim_Obj * const *argv)\r
-{\r
- if (argc != 2)\r
- {\r
- Jim_WrongNumArgs(interp, 1, argv, "peek ?address?");\r
- return JIM_ERR;\r
- }\r
-\r
- long address;\r
- if (Jim_GetLong(interp, argv[1], &address) != JIM_OK)\r
- return JIM_ERR;\r
-\r
- int value = *((volatile int *) address);\r
-\r
- Jim_SetResult(interp, Jim_NewIntObj(interp, value));\r
-\r
- return JIM_OK;\r
-}\r
-\r
-static int\r
-zylinjtag_Jim_Command_poke(Jim_Interp *interp,\r
- int argc,\r
- Jim_Obj * const *argv)\r
-{\r
- if (argc != 3)\r
- {\r
- Jim_WrongNumArgs(interp, 1, argv, "poke ?address? ?value?");\r
- return JIM_ERR;\r
- }\r
-\r
- long address;\r
- if (Jim_GetLong(interp, argv[1], &address) != JIM_OK)\r
- return JIM_ERR;\r
- long value;\r
- if (Jim_GetLong(interp, argv[2], &value) != JIM_OK)\r
- return JIM_ERR;\r
-\r
- *((volatile int *) address) = value;\r
-\r
- return JIM_OK;\r
-}\r
-\r
-int ioutil_init(struct command_context_s *cmd_ctx)\r
-{\r
- register_command(cmd_ctx, NULL, "rm", handle_rm_command, COMMAND_ANY,\r
- "remove file");\r
-\r
- register_command(cmd_ctx, NULL, "cat", handle_cat_command, COMMAND_ANY,\r
- "display file content");\r
-\r
- register_command(cmd_ctx, NULL, "trunc", handle_trunc_command, COMMAND_ANY,\r
- "truncate a file to 0 size");\r
-\r
- register_command(cmd_ctx, NULL, "cp", handle_cp_command,\r
- COMMAND_ANY, "copy a file <from> <to>");\r
-\r
- register_command(cmd_ctx, NULL, "append_file", handle_append_command,\r
- COMMAND_ANY, "append a variable number of strings to a file");\r
-\r
- register_command(cmd_ctx, NULL, "meminfo", handle_meminfo_command,\r
- COMMAND_ANY, "display available ram memory");\r
-\r
- Jim_CreateCommand(interp, "rm", zylinjtag_Jim_Command_rm, NULL, NULL);\r
-\r
- Jim_CreateCommand(interp, "peek", zylinjtag_Jim_Command_peek, NULL, NULL);\r
- Jim_CreateCommand(interp, "poke", zylinjtag_Jim_Command_poke, NULL, NULL);\r
- Jim_CreateCommand(interp, "ls", zylinjtag_Jim_Command_ls, NULL, NULL);\r
-\r
-\r
- return ERROR_OK;\r
-}\r
-\r
-\r
+/***************************************************************************
+ * Copyright (C) 2007-2008 by Øyvind Harboe *
+ * *
+ * 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. *
+ ***************************************************************************/
+
+/* this file contains various functionality useful to standalone systems */
+
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include "log.h"
+#include "time_support.h"
+
+#ifdef HAVE_ARPA_INET_H
+#include <arpa/inet.h>
+#endif
+#ifdef HAVE_DIRENT_H
+#include <dirent.h>
+#endif
+#ifdef HAVE_NETDB_H
+#include <netdb.h>
+#endif
+#ifdef HAVE_NET_IF_H
+#include <net/if.h>
+#endif
+#ifdef HAVE_SYS_IOCTL_H
+#include <sys/ioctl.h>
+#endif
+#ifdef HAVE_SYS_STAT_H
+#include <sys/stat.h>
+#endif
+#ifdef HAVE_IFADDRS_H
+#include <ifaddrs.h>
+#endif
+#ifdef HAVE_MALLOC_H
+#if !BUILD_ECOSBOARD
+#include <malloc.h>
+#endif
+#endif
+
+
+/* loads a file and returns a pointer to it in memory. The file contains
+ * a 0 byte(sentinel) after len bytes - the length of the file. */
+int loadFile(const char *fileName, void **data, size_t *len)
+{
+ // ensure returned length is always sane
+ *len = 0;
+
+ FILE * pFile;
+ pFile = fopen(fileName,"rb");
+ if (pFile == NULL)
+ {
+ LOG_ERROR("Can't open %s\n", fileName);
+ return ERROR_FAIL;
+ }
+ if (fseek(pFile, 0, SEEK_END) != 0)
+ {
+ LOG_ERROR("Can't open %s\n", fileName);
+ fclose(pFile);
+ return ERROR_FAIL;
+ }
+ long fsize = ftell(pFile);
+ if (fsize == -1)
+ {
+ LOG_ERROR("Can't open %s\n", fileName);
+ fclose(pFile);
+ return ERROR_FAIL;
+ }
+ *len = fsize;
+
+ if (fseek(pFile, 0, SEEK_SET) != 0)
+ {
+ LOG_ERROR("Can't open %s\n", fileName);
+ fclose(pFile);
+ return ERROR_FAIL;
+ }
+ *data = malloc(*len + 1);
+ if (*data == NULL)
+ {
+ LOG_ERROR("Can't open %s\n", fileName);
+ fclose(pFile);
+ return ERROR_FAIL;
+ }
+
+ if (fread(*data, 1, *len, pFile)!=*len)
+ {
+ fclose(pFile);
+ free(*data);
+ LOG_ERROR("Can't open %s\n", fileName);
+ return ERROR_FAIL;
+ }
+ fclose(pFile);
+
+ // 0-byte after buffer (not included in *len) serves as a sentinel
+ char *buf = (char *)*data;
+ buf[*len] = 0;
+
+ return ERROR_OK;
+}
+
+COMMAND_HANDLER(handle_cat_command)
+{
+ if (CMD_ARGC != 1)
+ {
+ command_print(CMD_CTX, "cat <filename>");
+ return ERROR_INVALID_ARGUMENTS;
+ }
+
+ // NOTE!!! we only have line printing capability so we print the entire file as a single line.
+ void *data;
+ size_t len;
+
+ int retval = loadFile(CMD_ARGV[0], &data, &len);
+ if (retval == ERROR_OK)
+ {
+ command_print(CMD_CTX, "%s", (char *)data);
+ free(data);
+ }
+ else
+ {
+ command_print(CMD_CTX, "%s not found %d", CMD_ARGV[0], retval);
+ }
+
+ return ERROR_OK;
+}
+
+COMMAND_HANDLER(handle_trunc_command)
+{
+ if (CMD_ARGC != 1)
+ {
+ command_print(CMD_CTX, "trunc <filename>");
+ return ERROR_INVALID_ARGUMENTS;
+ }
+
+ FILE *config_file = NULL;
+ config_file = fopen(CMD_ARGV[0], "w");
+ if (config_file != NULL)
+ fclose(config_file);
+
+ return ERROR_OK;
+}
+
+COMMAND_HANDLER(handle_meminfo_command)
+{
+ static int prev = 0;
+ struct mallinfo info;
+
+ if (CMD_ARGC != 0)
+ {
+ command_print(CMD_CTX, "meminfo");
+ return ERROR_INVALID_ARGUMENTS;
+ }
+
+ info = mallinfo();
+
+ if (prev > 0)
+ {
+ command_print(CMD_CTX, "Diff: %d", prev - info.fordblks);
+ }
+ prev = info.fordblks;
+
+ command_print(CMD_CTX, "Available ram: %d", info.fordblks);
+
+ return ERROR_OK;
+}
+
+
+COMMAND_HANDLER(handle_append_command)
+{
+ if (CMD_ARGC < 1)
+ {
+ command_print(CMD_CTX,
+ "append <filename> [<string1>, [<string2>, ...]]");
+ return ERROR_INVALID_ARGUMENTS;
+ }
+
+ int retval = ERROR_FAIL;
+ FILE *config_file = NULL;
+ config_file = fopen(CMD_ARGV[0], "a");
+ if (config_file != NULL)
+ {
+ fseek(config_file, 0, SEEK_END);
+
+ unsigned i;
+ for (i = 1; i < CMD_ARGC; i++)
+ {
+ if (fwrite(CMD_ARGV[i], 1, strlen(CMD_ARGV[i]), config_file) != strlen(CMD_ARGV[i]))
+ break;
+ if (i != CMD_ARGC - 1)
+ {
+ if (fwrite(" ", 1, 1, config_file) != 1)
+ break;
+ }
+ }
+ if ((i == CMD_ARGC) && (fwrite("\n", 1, 1, config_file) == 1))
+ {
+ retval = ERROR_OK;
+ }
+ fclose(config_file);
+ }
+
+ return retval;
+}
+
+
+
+COMMAND_HANDLER(handle_cp_command)
+{
+ if (CMD_ARGC != 2)
+ {
+ return ERROR_INVALID_ARGUMENTS;
+ }
+
+ // NOTE!!! we only have line printing capability so we print the entire file as a single line.
+ void *data;
+ size_t len;
+
+ int retval = loadFile(CMD_ARGV[0], &data, &len);
+ if (retval != ERROR_OK)
+ return retval;
+
+ FILE *f = fopen(CMD_ARGV[1], "wb");
+ if (f == NULL)
+ retval = ERROR_INVALID_ARGUMENTS;
+
+ size_t pos = 0;
+ for (;;)
+ {
+ size_t chunk = len - pos;
+ static const size_t maxChunk = 512 * 1024; // ~1/sec
+ if (chunk > maxChunk)
+ {
+ chunk = maxChunk;
+ }
+
+ if ((retval == ERROR_OK) && (fwrite(((char *)data) + pos, 1, chunk, f) != chunk))
+ retval = ERROR_INVALID_ARGUMENTS;
+
+ if (retval != ERROR_OK)
+ {
+ break;
+ }
+
+ command_print(CMD_CTX, "%zu", len - pos);
+
+ pos += chunk;
+
+ if (pos == len)
+ break;
+ }
+
+ if (retval == ERROR_OK)
+ {
+ command_print(CMD_CTX, "Copied %s to %s", CMD_ARGV[0], CMD_ARGV[1]);
+ } else
+ {
+ command_print(CMD_CTX, "Failed: %d", retval);
+ }
+
+ if (data != NULL)
+ free(data);
+ if (f != NULL)
+ fclose(f);
+
+ if (retval != ERROR_OK)
+ unlink(CMD_ARGV[1]);
+
+ return retval;
+}
+
+
+
+
+#define SHOW_RESULT(a, b) LOG_ERROR(#a " failed %d\n", (int)b)
+
+#define IOSIZE 512
+void copyfile(char *name2, char *name1)
+{
+
+ int err;
+ char buf[IOSIZE];
+ int fd1, fd2;
+ ssize_t done, wrote;
+
+ fd1 = open(name1, O_WRONLY | O_CREAT, 0664);
+ if (fd1 < 0)
+ SHOW_RESULT(open, fd1);
+
+ fd2 = open(name2, O_RDONLY);
+ if (fd2 < 0)
+ SHOW_RESULT(open, fd2);
+
+ for (;;)
+ {
+ done = read(fd2, buf, IOSIZE);
+ if (done < 0)
+ {
+ SHOW_RESULT(read, done);
+ break;
+ }
+
+ if (done == 0) break;
+
+ wrote = write(fd1, buf, done);
+ if (wrote != done) SHOW_RESULT(write, wrote);
+
+ if (wrote != done) break;
+ }
+
+ err = close(fd1);
+ if (err < 0) SHOW_RESULT(close, err);
+
+ err = close(fd2);
+ if (err < 0) SHOW_RESULT(close, err);
+
+}
+
+/* utility fn to copy a directory */
+void copydir(char *name, char *destdir)
+{
+ int err;
+ DIR *dirp;
+
+ dirp = opendir(destdir);
+ if (dirp == NULL)
+ {
+ mkdir(destdir, 0777);
+ } else
+ {
+ err = closedir(dirp);
+ }
+
+ dirp = opendir(name);
+ if (dirp == NULL) SHOW_RESULT(opendir, -1);
+
+ for (;;)
+ {
+ struct dirent *entry = readdir(dirp);
+
+ if (entry == NULL)
+ break;
+
+ if (strcmp(entry->d_name, ".") == 0)
+ continue;
+ if (strcmp(entry->d_name, "..") == 0)
+ continue;
+
+ int isDir = 0;
+ struct stat buf;
+ char fullPath[PATH_MAX];
+ strncpy(fullPath, name, PATH_MAX);
+ strcat(fullPath, "/");
+ strncat(fullPath, entry->d_name, PATH_MAX - strlen(fullPath));
+
+ if (stat(fullPath, &buf) == -1)
+ {
+ LOG_ERROR("unable to read status from %s", fullPath);
+ break;
+ }
+ isDir = S_ISDIR(buf.st_mode) != 0;
+
+ if (isDir)
+ continue;
+
+ // diag_printf("<INFO>: entry %14s",entry->d_name);
+ char fullname[PATH_MAX];
+ char fullname2[PATH_MAX];
+
+ strcpy(fullname, name);
+ strcat(fullname, "/");
+ strcat(fullname, entry->d_name);
+
+ strcpy(fullname2, destdir);
+ strcat(fullname2, "/");
+ strcat(fullname2, entry->d_name);
+ // diag_printf("from %s to %s\n", fullname, fullname2);
+ copyfile(fullname, fullname2);
+
+ // diag_printf("\n");
+ }
+
+ err = closedir(dirp);
+ if (err < 0) SHOW_RESULT(stat, err);
+}
+
+
+
+
+static int
+zylinjtag_Jim_Command_rm(Jim_Interp *interp,
+ int argc,
+ Jim_Obj * const *argv)
+{
+ int del;
+ if (argc != 2)
+ {
+ Jim_WrongNumArgs(interp, 1, argv, "rm ?dirorfile?");
+ return JIM_ERR;
+ }
+
+ del = 0;
+ if (unlink(Jim_GetString(argv[1], NULL)) == 0)
+ del = 1;
+ if (rmdir(Jim_GetString(argv[1], NULL)) == 0)
+ del = 1;
+
+ return del ? JIM_OK : JIM_ERR;
+}
+
+
+static int
+zylinjtag_Jim_Command_ls(Jim_Interp *interp,
+ int argc,
+ Jim_Obj * const *argv)
+{
+ if (argc != 2)
+ {
+ Jim_WrongNumArgs(interp, 1, argv, "ls ?dir?");
+ return JIM_ERR;
+ }
+
+ char *name = (char*) Jim_GetString(argv[1], NULL);
+
+ DIR *dirp = NULL;
+ dirp = opendir(name);
+ if (dirp == NULL)
+ {
+ return JIM_ERR;
+ }
+ Jim_Obj *objPtr = Jim_NewListObj(interp, NULL, 0);
+
+ for (;;)
+ {
+ struct dirent *entry = NULL;
+ entry = readdir(dirp);
+ if (entry == NULL)
+ break;
+
+ if ((strcmp(".", entry->d_name) == 0)||(strcmp("..", entry->d_name) == 0))
+ continue;
+
+ Jim_ListAppendElement(interp, objPtr, Jim_NewStringObj(interp, entry->d_name, strlen(entry->d_name)));
+ }
+ closedir(dirp);
+
+ Jim_SetResult(interp, objPtr);
+
+ return JIM_OK;
+}
+
+static int
+zylinjtag_Jim_Command_peek(Jim_Interp *interp,
+ int argc,
+ Jim_Obj * const *argv)
+{
+ if (argc != 2)
+ {
+ Jim_WrongNumArgs(interp, 1, argv, "peek ?address?");
+ return JIM_ERR;
+ }
+
+ long address;
+ if (Jim_GetLong(interp, argv[1], &address) != JIM_OK)
+ return JIM_ERR;
+
+ int value = *((volatile int *) address);
+
+ Jim_SetResult(interp, Jim_NewIntObj(interp, value));
+
+ return JIM_OK;
+}
+
+static int
+zylinjtag_Jim_Command_poke(Jim_Interp *interp,
+ int argc,
+ Jim_Obj * const *argv)
+{
+ if (argc != 3)
+ {
+ Jim_WrongNumArgs(interp, 1, argv, "poke ?address? ?value?");
+ return JIM_ERR;
+ }
+
+ long address;
+ if (Jim_GetLong(interp, argv[1], &address) != JIM_OK)
+ return JIM_ERR;
+ long value;
+ if (Jim_GetLong(interp, argv[2], &value) != JIM_OK)
+ return JIM_ERR;
+
+ *((volatile int *) address) = value;
+
+ return JIM_OK;
+}
+
+
+/* not so pretty code to fish out ip number*/
+static int zylinjtag_Jim_Command_ip(Jim_Interp *interp, int argc,
+ Jim_Obj * const *argv)
+{
+#if !defined(__CYGWIN__)
+ Jim_Obj *tclOutput = Jim_NewStringObj(interp, "", 0);
+
+ struct ifaddrs *ifa = NULL, *ifp = NULL;
+
+ if (getifaddrs(&ifp) < 0)
+ {
+ return JIM_ERR;
+ }
+
+ for (ifa = ifp; ifa; ifa = ifa->ifa_next)
+ {
+ char ip[200];
+ socklen_t salen;
+
+ if (ifa->ifa_addr->sa_family == AF_INET)
+ salen = sizeof(struct sockaddr_in);
+ else if (ifa->ifa_addr->sa_family == AF_INET6)
+ salen = sizeof(struct sockaddr_in6);
+ else
+ continue;
+
+ if (getnameinfo(ifa->ifa_addr, salen, ip, sizeof(ip), NULL, 0,
+ NI_NUMERICHOST) < 0)
+ {
+ continue;
+ }
+
+ Jim_AppendString(interp, tclOutput, ip, strlen(ip));
+ break;
+
+ }
+
+ freeifaddrs(ifp);
+#else
+ Jim_Obj *tclOutput = Jim_NewStringObj(interp, "fixme!!!", 0);
+ LOG_ERROR("NOT IMPLEMENTED!!!");
+#endif
+ Jim_SetResult(interp, tclOutput);
+
+ return JIM_OK;
+}
+
+/* not so pretty code to fish out eth0 mac address */
+static int zylinjtag_Jim_Command_mac(Jim_Interp *interp, int argc,
+ Jim_Obj * const *argv)
+{
+
+
+ struct ifreq *ifr, *ifend;
+ struct ifreq ifreq;
+ struct ifconf ifc;
+ struct ifreq ifs[5];
+ int SockFD;
+
+ SockFD = socket(AF_INET, SOCK_DGRAM, 0);
+ if (SockFD < 0)
+ {
+ return JIM_ERR;
+ }
+
+ ifc.ifc_len = sizeof(ifs);
+ ifc.ifc_req = ifs;
+ if (ioctl(SockFD, SIOCGIFCONF, &ifc) < 0)
+ {
+ close(SockFD);
+ return JIM_ERR;
+ }
+
+ ifend = ifs + (ifc.ifc_len / sizeof(struct ifreq));
+ for (ifr = ifc.ifc_req; ifr < ifend; ifr++)
+ {
+ //if (ifr->ifr_addr.sa_family == AF_INET)
+ {
+ if (strcmp("eth0", ifr->ifr_name) != 0)
+ continue;
+ strncpy(ifreq.ifr_name, ifr->ifr_name, sizeof(ifreq.ifr_name));
+ if (ioctl(SockFD, SIOCGIFHWADDR, &ifreq) < 0)
+ {
+ close(SockFD);
+ return JIM_ERR;
+ }
+
+ close(SockFD);
+
+
+ Jim_Obj *tclOutput = Jim_NewStringObj(interp, "", 0);
+
+ char buffer[256];
+ sprintf(buffer, "%02x-%02x-%02x-%02x-%02x-%02x",
+ ifreq.ifr_hwaddr.sa_data[0]&0xff,
+ ifreq.ifr_hwaddr.sa_data[1]&0xff,
+ ifreq.ifr_hwaddr.sa_data[2]&0xff,
+ ifreq.ifr_hwaddr.sa_data[3]&0xff,
+ ifreq.ifr_hwaddr.sa_data[4]&0xff,
+ ifreq.ifr_hwaddr.sa_data[5]&0xff);
+
+ Jim_AppendString(interp, tclOutput, buffer, strlen(buffer));
+
+ Jim_SetResult(interp, tclOutput);
+
+ return JIM_OK;
+ }
+ }
+ close(SockFD);
+
+ return JIM_ERR;
+
+}
+
+static const struct command_registration ioutil_command_handlers[] = {
+ {
+ .name = "cat",
+ .handler = &handle_cat_command,
+ .mode = COMMAND_ANY,
+ .help = "display file content",
+ .usage= "<file_name>",
+ },
+ {
+ .name = "trunc",
+ .handler = &handle_trunc_command,
+ .mode = COMMAND_ANY,
+ .help = "truncate a file 0 size",
+ .usage= "<file_name>",
+ },
+ {
+ .name = "cp",
+ .handler = &handle_cp_command,
+ .mode = COMMAND_ANY,
+ .help = "copy a file",
+ .usage = "<src> <dst>",
+ },
+ {
+ .name = "append_file",
+ .handler = &handle_append_command,
+ .mode = COMMAND_ANY,
+ .help = "append a variable number of strings to a file",
+ .usage= "<file_name> [<string> ...]",
+ },
+ {
+ .name = "meminfo",
+ .handler = &handle_meminfo_command,
+ .mode = COMMAND_ANY,
+ .help = "display available ram memory",
+ },
+ // jim handlers
+ {
+ .name = "rm",
+ .mode = COMMAND_ANY,
+ .jim_handler = &zylinjtag_Jim_Command_rm,
+ .help = "remove a file",
+ .usage = "<file>",
+ },
+ {
+ .name = "peek",
+ .mode = COMMAND_ANY,
+ .jim_handler = &zylinjtag_Jim_Command_peek,
+ .help = "peek at a memory address",
+ .usage = "<addr>",
+ },
+ {
+ .name = "poke",
+ .mode = COMMAND_ANY,
+ .jim_handler = &zylinjtag_Jim_Command_poke,
+ .help = "poke at a memory address",
+ .usage = "<addr> <value>",
+ },
+ {
+ .name = "ls",
+ .mode = COMMAND_ANY,
+ .jim_handler = &zylinjtag_Jim_Command_ls,
+ .help = "show a listing of files",
+ .usage = "<dir>",
+ },
+ {
+ .name = "mac",
+ .mode = COMMAND_ANY,
+ .jim_handler = &zylinjtag_Jim_Command_mac,
+ .help = "show MAC address",
+ },
+ {
+ .name = "ip",
+ .jim_handler = &zylinjtag_Jim_Command_ip,
+ .mode = COMMAND_ANY,
+ .help = "show IP address",
+ },
+ COMMAND_REGISTRATION_DONE
+};
+
+int ioutil_init(struct command_context *cmd_ctx)
+{
+ return register_commands(cmd_ctx, NULL, ioutil_command_handlers);
+}
Code Review / openocd.git / blobdiff