dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity
px4-firmware/nuttx/fs/nfs/nfs_util.c

843 lines
22 KiB
C
Executable File
Raw Blame History

/****************************************************************************
* fs/nfs/nfs_util.h
*
* Copyright (C) 2012 Gregory Nutt. All rights reserved.
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
*
* 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 <nuttx/config.h>
#include <sys/types.h>
#include <stdint.h>
#include <stdbool.h>
#include <stdlib.h>
#include <string.h>
#include <assert.h>
#include <errno.h>
#include <assert.h>
#include <debug.h>
#include <nuttx/fs/ioctl.h>
#include <nuttx/fs/dirent.h>
#include "nfsmount.h"
/****************************************************************************
* Private Types
****************************************************************************/
/****************************************************************************
* Private Function Prototypes
****************************************************************************/
/****************************************************************************
* Private Variables
****************************************************************************/
/****************************************************************************
* Public Variables
****************************************************************************/
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Name: nfs_checkentry
*
* Desciption:
* Check if the entry at offset is a directory or file path segment
*
****************************************************************************/
static inline int nfs_checkentry(struct nfs_mountpt_s *rm, uint32_t offset,
const char *entryname, int entrylen,
struct nfs_dirinfo_s *dirinfo)
{
char name[NAME_MAX+1];
uint32_t linkoffset;
uint32_t next;
uint32_t info;
uint32_t size;
int ret;
/* Parse the directory entry at this offset (which may be re-directed
* to some other entry if HARLINKED).
*/
ret = nfs_parsedirentry(rm, offset, &linkoffset, &next, &info, &size);
if (ret < 0)
{
return ret;
}
/* Now we are pointing to the real entry of interest. Is it a
* directory? Or a file?
*/
if (IS_DIRECTORY(next) || IS_FILE(next))
{
/* Get the name of the directory entry. */
ret = nfs_parsefilename(rm, offset, name);
if (ret < 0)
{
return ret;
}
/* Then check if this the name segment we are looking for. The
* string comparison is awkward because there is no terminator
* on entryname (there is a terminator on name, however)
*/
if (memcmp(entryname, name, entrylen) == 0 &&
strlen(name) == entrylen)
{
/* Found it -- save the component info and return success */
if (IS_DIRECTORY(next))
{
dirinfo->rd_dir.fr_firstoffset = info;
dirinfo->rd_dir.fr_curroffset = info;
dirinfo->rd_size = 0;
}
else
{
dirinfo->rd_dir.fr_curroffset = offset;
dirinfo->rd_size = size;
}
dirinfo->rd_next = next;
return OK;
}
}
/* The entry is not a directory or it does not have the matching name */
return -ENOENT;
}
/****************************************************************************
* Name: nfs_devcacheread
*
* Desciption:
* Read the specified sector for specified offset into the sector cache.
* Return the index into the sector corresponding to the offset
*
****************************************************************************/
int16_t nfs_devcacheread(struct nfs_mountpt_s *rm, uint32_t offset)
{
uint32_t sector;
int ret;
/* rm->rm_cachesector holds the current sector that is buffer in or referenced
* by rm->tm_buffer. If the requested sector is the same as this sector,
* then we do nothing.
*/
sector = SEC_NSECTORS(rm, offset);
if (rm->rm_cachesector != sector)
{
/* Check the access mode */
if (rm->rm_xipbase)
{
/* In XIP mode, rf_buffer is just an offset pointer into the device
* address space.
*/
rm->rm_buffer = rm->rm_xipbase + SEC_ALIGN(rm, offset);
}
else
{
/* In non-XIP mode, we will have to read the new sector.*/
ret = nfs_hwread(rm, rm->rm_buffer, sector, 1);
if (ret < 0)
{
return (int16_t)ret;
}
}
/* Update the cached sector number */
rm->rm_cachesector = sector;
}
/* Return the offset */
return offset & SEC_NDXMASK(rm);
}
/****************************************************************************
* Name: nfs_searchdir
*
* Desciption:
* This is part of the nfs_finddirentry log. Search the directory
* beginning at dirinfo->fr_firstoffset for entryname.
*
****************************************************************************/
static inline int nfs_searchdir(struct nfs_mountpt_s *rm,
const char *entryname, int entrylen,
struct nfs_dirinfo_s *dirinfo)
{
uint32_t offset;
uint32_t next;
int16_t ndx;
int ret;
/* Then loop through the current directory until the directory
* with the matching name is found. Or until all of the entries
* the directory have been examined.
*/
offset = dirinfo->rd_dir.fr_firstoffset;
do
{
/* Read the sector into memory (do this before calling
* nfs_checkentry() so we won't have to read the sector
* twice in the event that the offset refers to a hardlink).
*/
ndx = nfs_devcacheread(rm, offset);
if (ndx < 0)
{
return ndx;
}
/* Because everything is chunked and aligned to 16-bit boundaries,
* we know that most the basic node info fits into the sector.
*/
next = nfs_devread32(rm, ndx + ROMFS_FHDR_NEXT) & RFNEXT_OFFSETMASK;
/* Check if the name this entry is a directory with the matching
* name
*/
ret = nfs_checkentry(rm, offset, entryname, entrylen, dirinfo);
if (ret == OK)
{
/* Its a match! Return success */
return OK;
}
/* No match... select the offset to the next entry */
offset = next;
}
while (next != 0);
/* There is nothing in this directoy with that name */
return -ENOENT;
}
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: nfs_semtake
****************************************************************************/
void nfs_semtake(struct nfsmount *nmp)
{
/* Take the semaphore (perhaps waiting) */
while (sem_wait(&nmp->nm_sem) != 0)
{
/* The only case that an error should occur here is if
* the wait was awakened by a signal.
*/
ASSERT(*get_errno_ptr() == EINTR);
}
}
/****************************************************************************
* Name: nfs_semgive
****************************************************************************/
void nfs_semgive(struct nfsmount *nmp)
{
sem_post(&nmp->nm_sem);
}
/****************************************************************************
* Name: nfs_hwread
*
* Desciption: Read the specified sector into the sector buffer
*
****************************************************************************/
int nfs_hwread(struct nfs_mountpt_s *rm, uint8_t *buffer, uint32_t sector,
unsigned int nsectors)
{
int ret = -ENODEV;
/* Check the access mode */
if (rm->rm_xipbase)
{
/* In XIP mode, we just copy the requested data */
memcpy(buffer,
rm->rm_xipbase + sector*rm->rm_hwsectorsize,
nsectors*rm->rm_hwsectorsize);
ret = OK;
}
else
{
/* In non-XIP mode, we have to read the data from the device */
struct inode *inode = rm->rm_blkdriver;
ssize_t nsectorsread;
DEBUGASSERT(inode);
if (inode->u.i_bops && inode->u.i_bops->read)
{
nsectorsread =
inode->u.i_bops->read(inode, buffer, sector, nsectors);
if (nsectorsread == (ssize_t)nsectors)
{
ret = OK;
}
else if (nsectorsread < 0)
{
ret = nsectorsread;
}
}
}
return ret;
}
/****************************************************************************
* Name: nfs_filecacheread
*
* Desciption:
* Read the specified sector into the sector cache
*
****************************************************************************/
int nfs_filecacheread(struct nfs_mountpt_s *rm, struct nfs_file_s *rf, uint32_t sector)
{
int ret;
fvdbg("sector: %d cached: %d sectorsize: %d XIP base: %p buffer: %p\n",
sector, rf->rf_cachesector, rm->rm_hwsectorsize,
rm->rm_xipbase, rf->rf_buffer);
/* rf->rf_cachesector holds the current sector that is buffer in or referenced
* by rf->rf_buffer. If the requested sector is the same as this sector,
* then we do nothing.
*/
if (rf->rf_cachesector != sector)
{
/* Check the access mode */
if (rm->rm_xipbase)
{
/* In XIP mode, rf_buffer is just an offset pointer into the device
* address space.
*/
rf->rf_buffer = rm->rm_xipbase + sector * rm->rm_hwsectorsize;
fvdbg("XIP buffer: %p\n", rf->rf_buffer);
}
else
{
/* In non-XIP mode, we will have to read the new sector.*/
fvdbg("Calling nfs_hwread\n");
ret = nfs_hwread(rm, rf->rf_buffer, sector, 1);
if (ret < 0)
{
fdbg("nfs_hwread failed: %d\n", ret);
return ret;
}
}
/* Update the cached sector number */
rf->rf_cachesector = sector;
}
return OK;
}
/****************************************************************************
* Name: nfs_hwconfigure
*
* Desciption:
* This function is called as part of the ROMFS mount operation It
* configures the ROMFS filestem for use on this block driver. This includes
* the accounting for the geometry of the device, setting up any XIP modes
* of operation, and/or allocating any cache buffers.
*
****************************************************************************/
int nfs_hwconfigure(struct nfs_mountpt_s *rm)
{
struct inode *inode = rm->rm_blkdriver;
struct geometry geo;
int ret;
/* Get the underlying device geometry */
#ifdef CONFIG_DEBUG
if (!inode || !inode->u.i_bops || !inode->u.i_bops->geometry)
{
return -ENODEV;
}
#endif
ret = inode->u.i_bops->geometry(inode, &geo);
if (ret != OK)
{
return ret;
}
if (!geo.geo_available)
{
return -EBUSY;
}
/* Save that information in the mount structure */
rm->rm_hwsectorsize = geo.geo_sectorsize;
rm->rm_hwnsectors = geo.geo_nsectors;
/* Determine if block driver supports the XIP mode of operation */
rm->rm_cachesector = (uint32_t)-1;
if (inode->u.i_bops->ioctl)
{
ret = inode->u.i_bops->ioctl(inode, BIOC_XIPBASE,
(unsigned long)&rm->rm_xipbase);
if (ret == OK && rm->rm_xipbase)
{
/* Yes.. Then we will directly access the media (vs.
* copying into an allocated sector buffer.
*/
rm->rm_buffer = rm->rm_xipbase;
rm->rm_cachesector = 0;
return OK;
}
}
/* Allocate the device cache buffer for normal sector accesses */
rm->rm_buffer = (uint8_t*)malloc(rm->rm_hwsectorsize);
if (!rm->rm_buffer)
{
return -ENOMEM;
}
return OK;
}
/****************************************************************************
* Name: nfs_ffileconfigure
*
* Desciption:
* This function is called as part of the ROMFS file open operation It
* sets up the file structure to handle buffer appropriately, depending
* upon XIP mode or not.
*
****************************************************************************/
int nfs_fileconfigure(struct nfs_mountpt_s *rm, struct nfs_file_s *rf)
{
/* Check if XIP access mode is supported. If so, then we do not need
* to allocate anything.
*/
if (rm->rm_xipbase)
{
/* We'll put a valid address in rf_buffer just in case. */
rf->rf_cachesector = 0;
rf->rf_buffer = rm->rm_xipbase;
}
else
{
/* Nothing in the cache buffer */
rf->rf_cachesector = (uint32_t)-1;
/* Create a file buffer to support partial sector accesses */
rf->rf_buffer = (uint8_t*)malloc(rm->rm_hwsectorsize);
if (!rf->rf_buffer)
{
return -ENOMEM;
}
}
return OK;
}
/****************************************************************************
* Name: nfs_checkmount
*
* Desciption: Check if the mountpoint is still valid.
*
* The caller should hold the mountpoint semaphore
*
****************************************************************************/
int nfs_checkmount(struct nfsmount *nmp)
{
struct nfsnode *file;
struct inode *inode;
struct geometry geo;
int ret;
/* If the fs_mounted flag is false, then we have already handled the loss
* of the mount.
*/
DEBUGASSERT(nmp && nmp->nm_blkdriver);
if (nmp->mm_mounted)
{
/* We still think the mount is healthy. Check an see if this is
* still the case
*/
inode = nmp->nm_blkdriver;
if (inode->u.i_bops && inode->u.i_bops->geometry)
{
ret = inode->u.i_bops->geometry(inode, &geo);
if (ret == OK && geo.geo_available && !geo.geo_mediachanged)
{
return OK;
}
}
/* If we get here, the mount is NOT healthy */
nmp->nm_mounted = false;
/* Make sure that this is flagged in every opened file */
for (file = nmp->nm_head; file; file = file->n_next)
{
file->n_open = false;
}
}
return -ENODEV;
}
/****************************************************************************
* Name: nfs_finddirentry
*
* Desciption:
* Given a path to something that may or may not be in the file system,
* return the directory entry of the item.
*
****************************************************************************/
int nfs_finddirentry(struct nfs_mountpt_s *rm, struct nfs_dirinfo_s *dirinfo,
const char *path)
{
const char *entryname;
const char *terminator;
int entrylen;
int ret;
/* Start with the first element after the root directory */
dirinfo->rd_dir.fr_firstoffset = rm->rm_rootoffset;
dirinfo->rd_dir.fr_curroffset = rm->rm_rootoffset;
dirinfo->rd_next = RFNEXT_DIRECTORY;
dirinfo->rd_size = 0;
/* The root directory is a special case */
if (!path || path[0] == '\0')
{
return OK;
}
/* Then loop for each directory/file component in the full path */
entryname = path;
terminator = NULL;
for (;;)
{
/* Find the start of the next path component */
while (*entryname == '/') entryname++;
/* Find the end of the next path component */
terminator = strchr(entryname, '/');
if (!terminator)
{
entrylen = strlen(entryname);
}
else
{
entrylen = terminator - entryname;
}
/* Long path segment names will be truncated to NAME_MAX */
if (entrylen > NAME_MAX)
{
entrylen = NAME_MAX;
}
/* Then find the entry in the current directory with the
* matching name.
*/
ret = nfs_searchdir(rm, entryname, entrylen, dirinfo);
if (ret < 0)
{
return ret;
}
/* Was that the last path component? */
if (!terminator)
{
/* Yes.. return success */
return OK;
}
/* No... If that was not the last path component, then it had
* better have been a directory
*/
if (!IS_DIRECTORY(dirinfo->rd_next))
{
return -ENOTDIR;
}
/* Setup to search the next directory for the next component
* of the path
*/
entryname = terminator;
}
return ERROR; /* Won't get here */
}
/****************************************************************************
* Name: nfs_parsedirentry
*
* Desciption:
* Return the directory entry at this offset. If rf is NULL, then the
* mount device resources are used. Otherwise, file resources are used.
*
****************************************************************************/
int nfs_parsedirentry(struct nfs_mountpt_s *rm, uint32_t offset, uint32_t *poffset,
uint32_t *pnext, uint32_t *pinfo, uint32_t *psize)
{
uint32_t save;
uint32_t next;
int16_t ndx;
int ret;
/* Read the sector into memory */
ndx = nfs_devcacheread(rm, offset);
if (ndx < 0)
{
return ndx;
}
/* Yes.. Save the first 'next' value. That has the offset needed to
* traverse the parent directory. But we may need to change the type
* after we follow the hard links.
*/
save = nfs_devread32(rm, ndx + ROMFS_FHDR_NEXT);
/* Traverse hardlinks as necesssary to get to the real file header */
ret = nfs_followhardlinks(rm, offset, poffset);
if (ret < 0)
{
return ret;
}
/* Because everything is chunked and aligned to 16-bit boundaries,
* we know that most the basic node info fits into the sector. The
* associated name may not, however.
*/
next = nfs_devread32(rm, ndx + ROMFS_FHDR_NEXT);
*pnext = (save & RFNEXT_OFFSETMASK) | (next & RFNEXT_ALLMODEMASK);
*pinfo = nfs_devread32(rm, ndx + ROMFS_FHDR_INFO);
*psize = nfs_devread32(rm, ndx + ROMFS_FHDR_SIZE);
return OK;
}
/****************************************************************************
* Name: nfs_parsefilename
*
* Desciption:
* Return the filename from directory entry at this offset
*
****************************************************************************/
int nfs_parsefilename(struct nfs_mountpt_s *rm, uint32_t offset, char *pname)
{
int16_t ndx;
uint16_t namelen;
uint16_t chunklen;
bool done;
/* Loop until the whole name is obtained or until NAME_MAX characters
* of the name have been parsed.
*/
offset += ROMFS_FHDR_NAME;
for (namelen = 0, done = false; namelen < NAME_MAX && !done;)
{
/* Read the sector into memory */
ndx = nfs_devcacheread(rm, offset);
if (ndx < 0)
{
return ndx;
}
/* Is the name terminated in this 16-byte block */
if (rm->rm_buffer[ndx + 15] == '\0')
{
/* Yes.. then this chunk is less than 16 */
chunklen = strlen((char*)&rm->rm_buffer[ndx]);
done = true;
}
else
{
/* No.. then this chunk is 16 bytes in length */
chunklen = 16;
}
/* Check if we would exceed the NAME_MAX */
if (namelen + chunklen > NAME_MAX)
{
chunklen = NAME_MAX - namelen;
done = true;
}
/* Copy the chunk */
memcpy(&pname[namelen], &rm->rm_buffer[ndx], chunklen);
namelen += chunklen;
}
/* Terminate the name (NAME_MAX+1 chars total) and return success */
pname[namelen] = '\0';
return OK;
}
/****************************************************************************
* Name: nfs_datastart
*
* Desciption:
* Given the offset to a file header, return the offset to the start of
* the file data
*
****************************************************************************/
int nfs_datastart(struct nfs_mountpt_s *rm, uint32_t offset, uint32_t *start)
{
int16_t ndx;
int ret;
/* Traverse hardlinks as necesssary to get to the real file header */
ret = nfs_followhardlinks(rm, offset, &offset);
if (ret < 0)
{
return ret;
}
/* Loop until the header size is obtained. */
offset += ROMFS_FHDR_NAME;
for (;;)
{
/* Read the sector into memory */
ndx = nfs_devcacheread(rm, offset);
if (ndx < 0)
{
return ndx;
}
/* Get the offset to the next chunk */
offset += 16;
if (offset >= rm->rm_volsize)
{
return -EIO;
}
/* Is the name terminated in this 16-byte block */
if (rm->rm_buffer[ndx + 15] == '\0')
{
/* Yes.. then the data starts at the next chunk */
*start = offset;
return OK;
}
}
return -EINVAL; /* Won't get here */
}
View Git Blame Copy Permalink