+/***************************************************************************\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