/**************************************************************************** * apps/nshlib/dbg_dbgcmds.c * * Copyright (C) 2008-2009, 2011-2012 Gregory Nutt. All rights reserved. * Author: Gregory Nutt * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in * the documentation and/or other materials provided with the * distribution. * 3. Neither the name NuttX nor the names of its contributors may be * used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. * ****************************************************************************/ /**************************************************************************** * Included Files ****************************************************************************/ #include #include #include #include #include #include #include #if CONFIG_NFILE_DESCRIPTORS > 0 # include #endif #include "nsh.h" #include "nsh_console.h" /**************************************************************************** * Definitions ****************************************************************************/ /**************************************************************************** * Private Types ****************************************************************************/ struct dbgmem_s { bool dm_write; /* true: perfrom write operation */ void *dm_addr; /* Address to access */ uint32_t dm_value; /* Value to write */ unsigned int dm_count; /* The number of bytes to access */ }; /**************************************************************************** * Private Function Prototypes ****************************************************************************/ /**************************************************************************** * Private Data ****************************************************************************/ /**************************************************************************** * Public Data ****************************************************************************/ /**************************************************************************** * Private Functions ****************************************************************************/ /**************************************************************************** * Name: mem_parse ****************************************************************************/ int mem_parse(FAR struct nsh_vtbl_s *vtbl, int argc, char **argv, struct dbgmem_s *mem) { char *pcvalue = strchr(argv[1], '='); unsigned long lvalue = 0; /* Check if we are writing a value */ if (pcvalue) { *pcvalue = '\0'; pcvalue++; lvalue = (unsigned long)strtol(pcvalue, NULL, 16); if (lvalue > 0xffffffffL) { return -EINVAL; } mem->dm_write = true; mem->dm_value = (uint32_t)lvalue; } else { mem->dm_write = false; mem->dm_value = 0; } /* Get the address to be accessed */ mem->dm_addr = (void*)((uintptr_t)strtol(argv[1], NULL, 16)); /* Get the number of bytes to access */ if (argc > 2) { mem->dm_count = (unsigned int)strtol(argv[2], NULL, 16); } else { mem->dm_count = 1; } return OK; } /**************************************************************************** * Public Functions ****************************************************************************/ /**************************************************************************** * Name: cmd_mb ****************************************************************************/ #ifndef CONFIG_NSH_DISABLE_MB int cmd_mb(FAR struct nsh_vtbl_s *vtbl, int argc, char **argv) { struct dbgmem_s mem; volatile uint8_t *ptr; int ret; int i; ret = mem_parse(vtbl, argc, argv, &mem); if (ret == 0) { /* Loop for the number of requested bytes */ for (i = 0, ptr = (volatile uint8_t*)mem.dm_addr; i < mem.dm_count; i++, ptr++) { /* Print the value at the address */ nsh_output(vtbl, " %p = 0x%02x", ptr, *ptr); /* Are we supposed to write a value to this address? */ if (mem.dm_write) { /* Yes, was the supplied value within range? */ if (mem.dm_value > 0x000000ff) { nsh_output(vtbl, g_fmtargrange, argv[0]); return ERROR; } /* Write the value and re-read the address so that we print its * current value (if the address is a process address, then the * value read might not necessarily be the value written). */ *ptr = (uint8_t)mem.dm_value; nsh_output(vtbl, " -> 0x%02x", *ptr); } /* Make sure we end it with a newline */ nsh_output(vtbl, "\n", *ptr); } } return ret; } #endif /**************************************************************************** * Name: cmd_mh ****************************************************************************/ #ifndef CONFIG_NSH_DISABLE_MH int cmd_mh(FAR struct nsh_vtbl_s *vtbl, int argc, char **argv) { struct dbgmem_s mem; volatile uint16_t *ptr; int ret; int i; ret = mem_parse(vtbl, argc, argv, &mem); if (ret == 0) { /* Loop for the number of requested bytes */ for (i = 0, ptr = (volatile uint16_t*)mem.dm_addr; i < mem.dm_count; i += 2, ptr++) { /* Print the value at the address */ nsh_output(vtbl, " %p = 0x%04x", ptr, *ptr); /* Are we supposed to write a value to this address? */ if (mem.dm_write) { /* Yes, was the supplied value within range? */ if (mem.dm_value > 0x0000ffff) { nsh_output(vtbl, g_fmtargrange, argv[0]); return ERROR; } /* Write the value and re-read the address so that we print its * current value (if the address is a process address, then the * value read might not necessarily be the value written). */ *ptr = (uint16_t)mem.dm_value; nsh_output(vtbl, " -> 0x%04x", *ptr); } /* Make sure we end it with a newline */ nsh_output(vtbl, "\n", *ptr); } } return ret; } #endif /**************************************************************************** * Name: cmd_mw ****************************************************************************/ #ifndef CONFIG_NSH_DISABLE_MW int cmd_mw(FAR struct nsh_vtbl_s *vtbl, int argc, char **argv) { struct dbgmem_s mem; volatile uint32_t *ptr; int ret; int i; ret = mem_parse(vtbl, argc, argv, &mem); if (ret == 0) { /* Loop for the number of requested bytes */ for (i = 0, ptr = (volatile uint32_t*)mem.dm_addr; i < mem.dm_count; i += 4, ptr++) { /* Print the value at the address */ nsh_output(vtbl, " %p = 0x%08x", ptr, *ptr); /* Are we supposed to write a value to this address? */ if (mem.dm_write) { /* Write the value and re-read the address so that we print its * current value (if the address is a process address, then the * value read might not necessarily be the value written). */ *ptr = mem.dm_value; nsh_output(vtbl, " -> 0x%08x", *ptr); } /* Make sure we end it with a newline */ nsh_output(vtbl, "\n", *ptr); } } return ret; } #endif /**************************************************************************** * Name: nsh_dumpbuffer ****************************************************************************/ void nsh_dumpbuffer(FAR struct nsh_vtbl_s *vtbl, const char *msg, const uint8_t *buffer, ssize_t nbytes) { char line[128]; int ch; int i; int j; nsh_output(vtbl, "%s:\n", msg); for (i = 0; i < nbytes; i += 16) { sprintf(line, "%04x: ", i); for ( j = 0; j < 16; j++) { if (i + j < nbytes) { sprintf(&line[strlen(line)], "%02x ", buffer[i+j] ); } else { strcpy(&line[strlen(line)], " "); } } for ( j = 0; j < 16; j++) { if (i + j < nbytes) { ch = buffer[i+j]; sprintf(&line[strlen(line)], "%c", ch >= 0x20 && ch <= 0x7e ? ch : '.'); } } nsh_output(vtbl, "%s\n", line); } } /**************************************************************************** * Name: cmd_xd, hex dump of memory ****************************************************************************/ #ifndef CONFIG_NSH_DISABLE_XD int cmd_xd(FAR struct nsh_vtbl_s *vtbl, int argc, char **argv) { FAR char *addr; FAR char *endptr; int nbytes; addr = (char*)((uintptr_t)strtol(argv[1], &endptr, 16)); if (argv[0][0] == '\0' || *endptr != '\0') { return ERROR; } nbytes = (int)strtol(argv[2], &endptr, 0); if (argv[0][0] == '\0' || *endptr != '\0' || nbytes < 0) { return ERROR; } nsh_dumpbuffer(vtbl, "Hex dump", (uint8_t*)addr, nbytes); return OK; } #endif /**************************************************************************** * Name: cmd_hexdump, hex dump of files ****************************************************************************/ #if CONFIG_NFILE_DESCRIPTORS > 0 #ifndef CONFIG_NSH_DISABLE_HEXDUMP int cmd_hexdump(FAR struct nsh_vtbl_s *vtbl, int argc, char **argv) { uint8_t buffer[IOBUFFERSIZE]; char msg[32]; int position; int fd; int ret = OK; /* Open the file for reading */ fd = open(argv[1], O_RDONLY); if (fd < 0) { nsh_output(vtbl, g_fmtcmdfailed, "hexdump", "open", NSH_ERRNO); return ERROR; } position = 0; for (;;) { int nbytesread = read(fd, buffer, IOBUFFERSIZE); /* Check for read errors */ if (nbytesread < 0) { int errval = errno; nsh_output(vtbl, g_fmtcmdfailed, "hexdump", "read", NSH_ERRNO_OF(errval)); ret = ERROR; break; } else if (nbytesread > 0) { snprintf(msg, sizeof(msg), "%s at %08x", argv[1], position); nsh_dumpbuffer(vtbl, msg, buffer, nbytesread); position += nbytesread; } else { break; // EOF } } (void)close(fd); return ret; } #endif #endif