/**************************************************************************** * libs/libc/modlib/modlib_read.c * * Copyright (C) 2015, 2017 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 #include #include /**************************************************************************** * Pre-processor Definitions ****************************************************************************/ #undef ELF_DUMP_READDATA /* Define to dump all file data read */ /**************************************************************************** * Private Functions ****************************************************************************/ /**************************************************************************** * Name: modlib_dumpreaddata ****************************************************************************/ #if defined(ELF_DUMP_READDATA) static inline void modlib_dumpreaddata(FAR char *buffer, int buflen) { FAR uint32_t *buf32 = (FAR uint32_t *)buffer; int i; int j; for (i = 0; i < buflen; i += 32) { syslog(LOG_DEBUG, "%04x:", i); for (j = 0; j < 32; j += sizeof(uint32_t)) { syslog(LOG_DEBUG, " %08x", *buf32++); } syslog(LOG_DEBUG, "\n"); } } #else # define modlib_dumpreaddata(b,n) #endif /**************************************************************************** * Public Functions ****************************************************************************/ /**************************************************************************** * Name: modlib_read * * Description: * Read 'readsize' bytes from the object file at 'offset'. The data is * read into 'buffer.' * * Returned Value: * 0 (OK) is returned on success and a negated errno is returned on * failure. * ****************************************************************************/ int modlib_read(FAR struct mod_loadinfo_s *loadinfo, FAR uint8_t *buffer, size_t readsize, off_t offset) { ssize_t nbytes; /* Number of bytes read */ off_t rpos; /* Position returned by lseek */ binfo("Read %ld bytes from offset %ld\n", (long)readsize, (long)offset); /* Loop until all of the requested data has been read. */ while (readsize > 0) { /* Seek to the next read position */ rpos = lseek(loadinfo->filfd, offset, SEEK_SET); if (rpos != offset) { int errval = get_errno(); berr("ERROR: Failed to seek to position %lu: %d\n", (unsigned long)offset, errval); return -errval; } /* Read the file data at offset into the user buffer */ nbytes = _NX_READ(loadinfo->filfd, buffer, readsize); if (nbytes < 0) { int errval = _NX_GETERRNO(nbytes); /* EINTR just means that we received a signal */ if (errval != EINTR) { berr("ERROR: Read from offset %lu failed: %d\n", (unsigned long)offset, errval); return -errval; } } else if (nbytes == 0) { berr("ERROR: Unexpected end of file\n"); return -ENODATA; } else { readsize -= nbytes; buffer += nbytes; offset += nbytes; } } modlib_dumpreaddata(buffer, readsize); return OK; }