mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-23 17:23:33 +08:00
Resync new repository with old repo r5166
git-svn-id: http://svn.code.sf.net/p/nuttx/code/trunk@5153 42af7a65-404d-4744-a932-0658087f49c3
This commit is contained in:
patacongo
@@ -0,0 +1,4 @@
|
||||
#
|
||||
# For a description of the syntax of this configuration file,
|
||||
# see misc/tools/kconfig-language.txt.
|
||||
#
|
||||
@@ -0,0 +1,52 @@
|
||||
############################################################################
|
||||
# drivers/bch/Make.defs
|
||||
#
|
||||
# Copyright (C) 2008, 2011 Gregory Nutt. All rights reserved.
|
||||
# Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
#
|
||||
# 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.
|
||||
#
|
||||
############################################################################
|
||||
|
||||
ifneq ($(CONFIG_NFILE_DESCRIPTORS),0)
|
||||
ifneq ($(CONFIG_DISABLE_MOUNTPOINT),y)
|
||||
|
||||
# Include BCH driver
|
||||
|
||||
CSRCS += bchlib_setup.c bchlib_teardown.c bchlib_read.c bchlib_write.c \
|
||||
bchlib_cache.c bchlib_sem.c bchdev_register.c bchdev_unregister.c \
|
||||
bchdev_driver.c
|
||||
|
||||
# Include BCH driver build support
|
||||
|
||||
DEPPATH += --dep-path bch
|
||||
VPATH += :bch
|
||||
CFLAGS += ${shell $(TOPDIR)/tools/incdir.sh $(INCDIROPT) "$(CC)" $(TOPDIR)/drivers/bch}
|
||||
|
||||
endif
|
||||
endif
|
||||
@@ -0,0 +1,102 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bch_internal.h
|
||||
*
|
||||
* Copyright (C) 2008-2009 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
#ifndef __FS_BCH_INTERNAL_H
|
||||
#define __FS_BCH_INTERNAL_H
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <nuttx/config.h>
|
||||
|
||||
#include <sys/types.h>
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
#include <semaphore.h>
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
#define bchlib_semgive(d) sem_post(&(d)->sem) /* To match bchlib_semtake */
|
||||
#define MAX_OPENCNT (255) /* Limit of uint8_t */
|
||||
|
||||
/****************************************************************************
|
||||
* Public Types
|
||||
****************************************************************************/
|
||||
|
||||
struct bchlib_s
|
||||
{
|
||||
struct inode *inode; /* I-node of the block driver */
|
||||
sem_t sem; /* For atomic accesses to this structure */
|
||||
size_t nsectors; /* Number of sectors supported by the device */
|
||||
size_t sector; /* The current sector in the buffer */
|
||||
uint16_t sectsize; /* The size of one sector on the device */
|
||||
uint8_t refs; /* Number of references */
|
||||
bool dirty; /* Data has been written to the buffer */
|
||||
bool readonly; /* true: Only read operations are supported */
|
||||
FAR uint8_t *buffer; /* One sector buffer */
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Global Variables
|
||||
****************************************************************************/
|
||||
|
||||
#undef EXTERN
|
||||
#if defined(__cplusplus)
|
||||
#define EXTERN extern "C"
|
||||
extern "C" {
|
||||
#else
|
||||
#define EXTERN extern
|
||||
#endif
|
||||
|
||||
EXTERN const struct file_operations bch_fops;
|
||||
|
||||
/****************************************************************************
|
||||
* Public Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
EXTERN void bchlib_semtake(FAR struct bchlib_s *bch);
|
||||
EXTERN int bchlib_flushsector(FAR struct bchlib_s *bch);
|
||||
EXTERN int bchlib_readsector(FAR struct bchlib_s *bch, size_t sector);
|
||||
|
||||
#undef EXTERN
|
||||
#if defined(__cplusplus)
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* __FS_BCH_INTERNAL_H */
|
||||
@@ -0,0 +1,255 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchdev_driver.c
|
||||
*
|
||||
* Copyright (C) 2008-2009 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Compilation Switches
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <nuttx/config.h>
|
||||
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <sys/ioctl.h>
|
||||
|
||||
#include <unistd.h>
|
||||
#include <string.h>
|
||||
#include <fcntl.h>
|
||||
#include <sched.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/fs/fs.h>
|
||||
#include <nuttx/fs/ioctl.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
static int bch_open(FAR struct file *filp);
|
||||
static int bch_close(FAR struct file *filp);
|
||||
static ssize_t bch_read(FAR struct file *, FAR char *, size_t);
|
||||
static ssize_t bch_write(FAR struct file *, FAR const char *, size_t);
|
||||
static int bch_ioctl(FAR struct file *filp, int cmd, unsigned long arg);
|
||||
|
||||
/****************************************************************************
|
||||
* Public Data
|
||||
****************************************************************************/
|
||||
|
||||
const struct file_operations bch_fops =
|
||||
{
|
||||
bch_open, /* open */
|
||||
bch_close, /* close */
|
||||
bch_read, /* read */
|
||||
bch_write, /* write */
|
||||
0, /* seek */
|
||||
bch_ioctl /* ioctl */
|
||||
#ifndef CONFIG_DISABLE_POLL
|
||||
, 0 /* poll */
|
||||
#endif
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bch_open
|
||||
*
|
||||
* Description: Open the block device
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
static int bch_open(FAR struct file *filp)
|
||||
{
|
||||
FAR struct inode *inode = filp->f_inode;
|
||||
FAR struct bchlib_s *bch;
|
||||
|
||||
DEBUGASSERT(inode && inode->i_private);
|
||||
bch = (FAR struct bchlib_s *)inode->i_private;
|
||||
|
||||
/* Increment the reference count */
|
||||
|
||||
bchlib_semtake(bch);
|
||||
if (bch->refs == MAX_OPENCNT)
|
||||
{
|
||||
return -EMFILE;
|
||||
}
|
||||
else
|
||||
{
|
||||
bch->refs++;
|
||||
}
|
||||
bchlib_semgive(bch);
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bch_close
|
||||
*
|
||||
* Description: close the block device
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
static int bch_close(FAR struct file *filp)
|
||||
{
|
||||
FAR struct inode *inode = filp->f_inode;
|
||||
FAR struct bchlib_s *bch;
|
||||
int ret = OK;
|
||||
|
||||
DEBUGASSERT(inode && inode->i_private);
|
||||
bch = (FAR struct bchlib_s *)inode->i_private;
|
||||
|
||||
/* Flush any dirty pages remaining in the cache */
|
||||
|
||||
bchlib_semtake(bch);
|
||||
(void)bchlib_flushsector(bch);
|
||||
|
||||
/* Decrement the reference count (I don't use bchlib_decref() because I
|
||||
* want the entire close operation to be atomic wrt other driver operations.
|
||||
*/
|
||||
|
||||
if (bch->refs == 0)
|
||||
{
|
||||
ret = -EIO;
|
||||
}
|
||||
else
|
||||
{
|
||||
bch->refs--;
|
||||
}
|
||||
bchlib_semgive(bch);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name:bch_read
|
||||
****************************************************************************/
|
||||
|
||||
static ssize_t bch_read(FAR struct file *filp, FAR char *buffer, size_t len)
|
||||
{
|
||||
FAR struct inode *inode = filp->f_inode;
|
||||
FAR struct bchlib_s *bch;
|
||||
int ret;
|
||||
|
||||
DEBUGASSERT(inode && inode->i_private);
|
||||
bch = (FAR struct bchlib_s *)inode->i_private;
|
||||
|
||||
bchlib_semtake(bch);
|
||||
ret = bchlib_read(bch, buffer, filp->f_pos, len);
|
||||
if (ret > 0)
|
||||
{
|
||||
filp->f_pos += len;
|
||||
}
|
||||
bchlib_semgive(bch);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name:bch_write
|
||||
****************************************************************************/
|
||||
|
||||
static ssize_t bch_write(FAR struct file *filp, FAR const char *buffer, size_t len)
|
||||
{
|
||||
FAR struct inode *inode = filp->f_inode;
|
||||
FAR struct bchlib_s *bch;
|
||||
int ret = -EACCES;
|
||||
|
||||
DEBUGASSERT(inode && inode->i_private);
|
||||
bch = (FAR struct bchlib_s *)inode->i_private;
|
||||
|
||||
if (!bch->readonly)
|
||||
{
|
||||
bchlib_semtake(bch);
|
||||
ret = bchlib_write(bch, buffer, filp->f_pos, len);
|
||||
if (ret > 0)
|
||||
{
|
||||
filp->f_pos += len;
|
||||
}
|
||||
bchlib_semgive(bch);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bch_ioctl
|
||||
*
|
||||
* Description: Return device geometry
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
static int bch_ioctl(FAR struct file *filp, int cmd, unsigned long arg)
|
||||
{
|
||||
FAR struct inode *inode = filp->f_inode;
|
||||
FAR struct bchlib_s *bch;
|
||||
int ret = -ENOTTY;
|
||||
|
||||
DEBUGASSERT(inode && inode->i_private);
|
||||
bch = (FAR struct bchlib_s *)inode->i_private;
|
||||
|
||||
if (cmd == DIOC_GETPRIV)
|
||||
{
|
||||
FAR struct bchlib_s **bchr = (FAR struct bchlib_s **)((uintptr_t)arg);
|
||||
|
||||
bchlib_semtake(bch);
|
||||
if (!bchr && bch->refs < 255)
|
||||
{
|
||||
ret = -EINVAL;
|
||||
}
|
||||
else
|
||||
{
|
||||
bch->refs++;
|
||||
*bchr = bch;
|
||||
}
|
||||
bchlib_semgive(bch);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
@@ -0,0 +1,104 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchdev_register.c
|
||||
*
|
||||
* Copyright (C) 2008-2009, 2012 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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 <stdbool.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchdev_register
|
||||
*
|
||||
* Description:
|
||||
* Setup so that it exports the block driver referenced by 'blkdev' as a
|
||||
* character device 'chardev'
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int bchdev_register(FAR const char *blkdev, FAR const char *chardev,
|
||||
bool readonly)
|
||||
{
|
||||
FAR void *handle;
|
||||
int ret;
|
||||
|
||||
/* Setup the BCH lib functions */
|
||||
|
||||
ret = bchlib_setup(blkdev, readonly, &handle);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("bchlib_setup failed: %d\n", -ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Then setup the character device */
|
||||
|
||||
ret = register_driver(chardev, &bch_fops, 0666, handle);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("register_driver failed: %d\n", -ret);
|
||||
bchlib_teardown(handle);
|
||||
handle = NULL;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,160 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchdev_unregister.c
|
||||
*
|
||||
* Copyright (C) 2008-2009, 2012 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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/stat.h>
|
||||
#include <sys/ioctl.h>
|
||||
|
||||
#include <unistd.h>
|
||||
#include <fcntl.h>
|
||||
#include <sched.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/fs/fs.h>
|
||||
#include <nuttx/fs/ioctl.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchdev_unregister
|
||||
*
|
||||
* Description:
|
||||
* Unregister character driver access to a block device that was created
|
||||
* by a previous call to bchdev_register().
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int bchdev_unregister(FAR const char *chardev)
|
||||
{
|
||||
FAR struct bchlib_s *bch;
|
||||
int fd;
|
||||
int ret;
|
||||
|
||||
/* Sanity check */
|
||||
|
||||
#ifdef CONFIG_DEBUG
|
||||
if (!chardev)
|
||||
{
|
||||
return -EINVAL;
|
||||
}
|
||||
#endif
|
||||
|
||||
/* Open the character driver associated with chardev */
|
||||
|
||||
fd = open(chardev, O_RDONLY);
|
||||
if (fd < 0)
|
||||
{
|
||||
dbg("Failed to open %s: %d\n", chardev, errno);
|
||||
return -errno;
|
||||
}
|
||||
|
||||
/* Get a reference to the internal data structure. On success, we
|
||||
* will hold a reference count on the state structure.
|
||||
*/
|
||||
|
||||
ret = ioctl(fd, DIOC_GETPRIV, (unsigned long)((uintptr_t)&bch));
|
||||
(void)close(fd);
|
||||
|
||||
if (ret < 0)
|
||||
{
|
||||
dbg("ioctl failed: %d\n", errno);
|
||||
return -errno;
|
||||
}
|
||||
|
||||
/* Lock out context switches. If there are no other references
|
||||
* and no context switches, then we can assume that we can safely
|
||||
* teardown the driver.
|
||||
*/
|
||||
|
||||
sched_lock();
|
||||
|
||||
/* Check if the internal structure is non-busy (we hold one reference). */
|
||||
|
||||
if (bch->refs > 1)
|
||||
{
|
||||
ret = -EBUSY;
|
||||
goto errout_with_lock;
|
||||
}
|
||||
|
||||
/* Unregister the driver (this cannot suspend or we lose our non-preemptive
|
||||
* state!). Once the driver is successfully unregistered, we can assume
|
||||
* we have exclusive access to the state instance.
|
||||
*/
|
||||
|
||||
ret = unregister_driver(chardev);
|
||||
if (ret < 0)
|
||||
{
|
||||
goto errout_with_lock;
|
||||
}
|
||||
|
||||
sched_unlock();
|
||||
|
||||
/* Release the internal structure */
|
||||
|
||||
bch->refs = 0;
|
||||
return bchlib_teardown(bch);
|
||||
|
||||
errout_with_lock:
|
||||
bch->refs--;
|
||||
sched_unlock();
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,133 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchlib_cache.c
|
||||
*
|
||||
* Copyright (C) 2008-2009 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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 <stdbool.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Private Types
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchlib_flushsector
|
||||
*
|
||||
* Description:
|
||||
* Flush the current contents of the sector buffer (if dirty)
|
||||
*
|
||||
* Assumptions:
|
||||
* Caller must assume mutual exclusion
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int bchlib_flushsector(FAR struct bchlib_s *bch)
|
||||
{
|
||||
FAR struct inode *inode;
|
||||
ssize_t ret = OK;
|
||||
|
||||
if (bch->dirty)
|
||||
{
|
||||
inode = bch->inode;
|
||||
ret = inode->u.i_bops->write(inode, bch->buffer, bch->sector, 1);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("Write failed: %d\n");
|
||||
}
|
||||
bch->dirty = false;
|
||||
}
|
||||
return (int)ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchlib_readsector
|
||||
*
|
||||
* Description:
|
||||
* Flush the current contents of the sector buffer (if dirty)
|
||||
*
|
||||
* Assumptions:
|
||||
* Caller must assume mutual exclusion
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int bchlib_readsector(FAR struct bchlib_s *bch, size_t sector)
|
||||
{
|
||||
FAR struct inode *inode;
|
||||
ssize_t ret = OK;
|
||||
|
||||
if (bch->sector != sector)
|
||||
{
|
||||
inode = bch->inode;
|
||||
|
||||
(void)bchlib_flushsector(bch);
|
||||
bch->sector = (size_t)-1;
|
||||
|
||||
ret = inode->u.i_bops->read(inode, bch->buffer, sector, 1);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("Read failed: %d\n");
|
||||
}
|
||||
bch->sector = sector;
|
||||
}
|
||||
return (int)ret;
|
||||
}
|
||||
|
||||
@@ -0,0 +1,203 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchlib_read.c
|
||||
*
|
||||
* Copyright (C) 2008-2009 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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 <string.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Private Types
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchlib_read
|
||||
*
|
||||
* Description:
|
||||
* Read from the block device set-up by bchlib_setup as if it were a character
|
||||
* device.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
ssize_t bchlib_read(FAR void *handle, FAR char *buffer, size_t offset, size_t len)
|
||||
{
|
||||
FAR struct bchlib_s *bch = (FAR struct bchlib_s *)handle;
|
||||
size_t nsectors;
|
||||
size_t sector;
|
||||
uint16_t sectoffset;
|
||||
size_t nbytes;
|
||||
size_t bytesread;
|
||||
int ret;
|
||||
|
||||
/* Get rid of this special case right away */
|
||||
|
||||
if (len < 1)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Convert the file position into a sector number an offset. */
|
||||
|
||||
sector = offset / bch->sectsize;
|
||||
sectoffset = offset - sector * bch->sectsize;
|
||||
|
||||
if (sector >= bch->nsectors)
|
||||
{
|
||||
/* Return end-of-file */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Read the initial partial sector */
|
||||
|
||||
bytesread = 0;
|
||||
if (sectoffset > 0)
|
||||
{
|
||||
/* Read the sector into the sector buffer */
|
||||
|
||||
bchlib_readsector(bch, sector);
|
||||
|
||||
/* Copy the tail end of the sector to the user buffer */
|
||||
|
||||
if (sectoffset + len > bch->sectsize)
|
||||
{
|
||||
nbytes = bch->sectsize - sectoffset;
|
||||
}
|
||||
else
|
||||
{
|
||||
nbytes = len;
|
||||
}
|
||||
|
||||
memcpy(buffer, &bch->buffer[sectoffset], nbytes);
|
||||
|
||||
/* Adjust pointers and counts */
|
||||
|
||||
sectoffset = 0;
|
||||
sector++;
|
||||
|
||||
if (sector >= bch->nsectors)
|
||||
{
|
||||
return nbytes;
|
||||
}
|
||||
|
||||
bytesread = nbytes;
|
||||
buffer += nbytes;
|
||||
len -= nbytes;
|
||||
}
|
||||
|
||||
/* Then read all of the full sectors following the partial sector directly
|
||||
* into the user buffer.
|
||||
*/
|
||||
|
||||
if (len >= bch->sectsize )
|
||||
{
|
||||
nsectors = len / bch->sectsize;
|
||||
if (sector + nsectors > bch->nsectors)
|
||||
{
|
||||
nsectors = bch->nsectors - sector;
|
||||
}
|
||||
|
||||
ret = bch->inode->u.i_bops->read(bch->inode, (FAR uint8_t *)buffer,
|
||||
sector, nsectors);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("Read failed: %d\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Adjust pointers and counts */
|
||||
|
||||
sectoffset = 0;
|
||||
sector += nsectors;
|
||||
|
||||
nbytes = nsectors * bch->sectsize;
|
||||
bytesread += nbytes;
|
||||
|
||||
if (sector >= bch->nsectors)
|
||||
{
|
||||
return bytesread;
|
||||
}
|
||||
|
||||
buffer += nbytes;
|
||||
len -= nbytes;
|
||||
}
|
||||
|
||||
/* Then read any partial final sector */
|
||||
|
||||
if (len > 0)
|
||||
{
|
||||
/* Read the sector into the sector buffer */
|
||||
|
||||
bchlib_readsector(bch, sector);
|
||||
|
||||
/* Copy the head end of the sector to the user buffer */
|
||||
|
||||
memcpy(buffer, bch->buffer, len);
|
||||
|
||||
/* Adjust counts */
|
||||
|
||||
bytesread += len;
|
||||
}
|
||||
|
||||
return bytesread;
|
||||
}
|
||||
@@ -0,0 +1,84 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchlib_sem.c
|
||||
*
|
||||
* Copyright (C) 2008-2009 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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 <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bch_semtake
|
||||
****************************************************************************/
|
||||
|
||||
void bchlib_semtake(FAR struct bchlib_s *bch)
|
||||
{
|
||||
/* Take the semaphore (perhaps waiting) */
|
||||
|
||||
while (sem_wait(&bch->sem) != 0)
|
||||
{
|
||||
/* The only case that an error should occur here is if
|
||||
* the wait was awakened by a signal.
|
||||
*/
|
||||
|
||||
ASSERT(errno == EINTR);
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,159 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchlib_setup.c
|
||||
*
|
||||
* Copyright (C) 2008-2009, 2011 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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 <sys/mount.h>
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
#include <stdlib.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/kmalloc.h>
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Private Types
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchlib_setup
|
||||
*
|
||||
* Description:
|
||||
* Setup so that the block driver referenced by 'blkdev' can be accessed
|
||||
* similar to a character device.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int bchlib_setup(const char *blkdev, bool readonly, FAR void **handle)
|
||||
{
|
||||
FAR struct bchlib_s *bch;
|
||||
struct geometry geo;
|
||||
int ret;
|
||||
|
||||
DEBUGASSERT(blkdev);
|
||||
|
||||
/* Allocate the BCH state structure */
|
||||
|
||||
bch = (FAR struct bchlib_s*)kzalloc(sizeof(struct bchlib_s));
|
||||
if (!bch)
|
||||
{
|
||||
fdbg("Failed to allocate BCH structure\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
/* Open the block driver */
|
||||
|
||||
ret = open_blockdriver(blkdev, readonly ? MS_RDONLY : 0, &bch->inode);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("Failed to open driver %s: %d\n", blkdev, -ret);
|
||||
goto errout_with_bch;
|
||||
}
|
||||
|
||||
DEBUGASSERT(bch->inode && bch->inode->u.i_bops && bch->inode->u.i_bops->geometry);
|
||||
|
||||
ret = bch->inode->u.i_bops->geometry(bch->inode, &geo);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("geometry failed: %d\n", -ret);
|
||||
goto errout_with_bch;
|
||||
}
|
||||
|
||||
if (!geo.geo_available)
|
||||
{
|
||||
fdbg("geometry failed: %d\n", -ret);
|
||||
ret = -ENODEV;
|
||||
goto errout_with_bch;
|
||||
}
|
||||
|
||||
if (!readonly && (!bch->inode->u.i_bops->write || !geo.geo_writeenabled))
|
||||
{
|
||||
fdbg("write access not supported\n");
|
||||
ret = -EACCES;
|
||||
goto errout_with_bch;
|
||||
}
|
||||
|
||||
/* Save the geometry info and complete initialization of the structure */
|
||||
|
||||
sem_init(&bch->sem, 0, 1);
|
||||
bch->nsectors = geo.geo_nsectors;
|
||||
bch->sectsize = geo.geo_sectorsize;
|
||||
bch->sector = (size_t)-1;
|
||||
bch->readonly = readonly;
|
||||
|
||||
/* Allocate the sector I/O buffer */
|
||||
|
||||
bch->buffer = (FAR uint8_t *)kmalloc(bch->sectsize);
|
||||
if (!bch->buffer)
|
||||
{
|
||||
fdbg("Failed to allocate sector buffer\n");
|
||||
ret = -ENOMEM;
|
||||
goto errout_with_bch;
|
||||
}
|
||||
|
||||
*handle = bch;
|
||||
return OK;
|
||||
|
||||
errout_with_bch:
|
||||
kfree(bch);
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,113 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchlib_teardown.c
|
||||
*
|
||||
* Copyright (C) 2008-2009, 2011 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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 <stdlib.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/kmalloc.h>
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Private Types
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchlib_teardown
|
||||
*
|
||||
* Description:
|
||||
* Setup so that the block driver referenced by 'blkdev' can be accessed
|
||||
* similar to a character device.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int bchlib_teardown(FAR void *handle)
|
||||
{
|
||||
FAR struct bchlib_s *bch = (FAR struct bchlib_s *)handle;
|
||||
|
||||
DEBUGASSERT(handle);
|
||||
|
||||
/* Check that there are not outstanding reference counts on the object */
|
||||
|
||||
if (bch->refs > 0)
|
||||
{
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
/* Flush any pending data to the block driver */
|
||||
|
||||
bchlib_flushsector(bch);
|
||||
|
||||
/* Close the block driver */
|
||||
|
||||
(void)close_blockdriver(bch->inode);
|
||||
|
||||
/* Free the BCH state structure */
|
||||
|
||||
if (bch->buffer)
|
||||
{
|
||||
kfree(bch->buffer);
|
||||
}
|
||||
|
||||
sem_destroy(&bch->sem);
|
||||
kfree(bch);
|
||||
return OK;
|
||||
}
|
||||
|
||||
@@ -0,0 +1,216 @@
|
||||
/****************************************************************************
|
||||
* drivers/bch/bchlib_write.c
|
||||
*
|
||||
* Copyright (C) 2008-2009, 2011 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
*
|
||||
* 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 <string.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/fs/fs.h>
|
||||
|
||||
#include "bch_internal.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Private Types
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: bchlib_write
|
||||
*
|
||||
* Description:
|
||||
* Write to the block device set-up by bchlib_setup as if it were a character
|
||||
* device.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
ssize_t bchlib_write(FAR void *handle, FAR const char *buffer, size_t offset, size_t len)
|
||||
{
|
||||
FAR struct bchlib_s *bch = (FAR struct bchlib_s *)handle;
|
||||
size_t nsectors;
|
||||
size_t sector;
|
||||
uint16_t sectoffset;
|
||||
size_t nbytes;
|
||||
size_t byteswritten;
|
||||
int ret;
|
||||
|
||||
/* Get rid of this special case right away */
|
||||
|
||||
if (len < 1)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Convert the file position into a sector number an offset. */
|
||||
|
||||
sector = offset / bch->sectsize;
|
||||
sectoffset = offset - sector * bch->sectsize;
|
||||
|
||||
if (sector >= bch->nsectors)
|
||||
{
|
||||
return -EFBIG;
|
||||
}
|
||||
|
||||
/* Write the initial partial sector */
|
||||
|
||||
byteswritten = 0;
|
||||
if (sectoffset > 0)
|
||||
{
|
||||
/* Read the full sector into the sector buffer */
|
||||
|
||||
bchlib_readsector(bch, sector);
|
||||
|
||||
/* Copy the tail end of the sector from the user buffer */
|
||||
|
||||
if (sectoffset + len > bch->sectsize)
|
||||
{
|
||||
nbytes = bch->sectsize - sectoffset;
|
||||
}
|
||||
else
|
||||
{
|
||||
nbytes = len;
|
||||
}
|
||||
|
||||
memcpy(&bch->buffer[sectoffset], buffer, nbytes);
|
||||
bch->dirty = true;
|
||||
|
||||
/* Adjust pointers and counts */
|
||||
|
||||
sectoffset = 0;
|
||||
sector++;
|
||||
|
||||
if (sector >= bch->nsectors)
|
||||
{
|
||||
return nbytes;
|
||||
}
|
||||
|
||||
byteswritten = nbytes;
|
||||
buffer += nbytes;
|
||||
len -= nbytes;
|
||||
}
|
||||
|
||||
/* Then write all of the full sectors following the partial sector
|
||||
* directly from the user buffer.
|
||||
*/
|
||||
|
||||
if (len >= bch->sectsize )
|
||||
{
|
||||
nsectors = len / bch->sectsize;
|
||||
if (sector + nsectors > bch->nsectors)
|
||||
{
|
||||
nsectors = bch->nsectors - sector;
|
||||
}
|
||||
|
||||
/* Write the contiguous sectors */
|
||||
|
||||
ret = bch->inode->u.i_bops->write(bch->inode, (FAR uint8_t *)buffer,
|
||||
sector, nsectors);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("Write failed: %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Adjust pointers and counts */
|
||||
|
||||
sectoffset = 0;
|
||||
sector += nsectors;
|
||||
|
||||
nbytes = nsectors * bch->sectsize;
|
||||
byteswritten += nbytes;
|
||||
|
||||
if (sector >= bch->nsectors)
|
||||
{
|
||||
return byteswritten;
|
||||
}
|
||||
|
||||
buffer += nbytes;
|
||||
len -= nbytes;
|
||||
}
|
||||
|
||||
/* Then write any partial final sector */
|
||||
|
||||
if (len > 0)
|
||||
{
|
||||
/* Read the sector into the sector buffer */
|
||||
|
||||
bchlib_readsector(bch, sector);
|
||||
|
||||
/* Copy the head end of the sector from the user buffer */
|
||||
|
||||
memcpy(bch->buffer, buffer, len);
|
||||
bch->dirty = true;
|
||||
|
||||
/* Adjust counts */
|
||||
|
||||
byteswritten += len;
|
||||
}
|
||||
|
||||
/* Finally, flush any cached writes to the device as well */
|
||||
|
||||
ret = bchlib_flushsector(bch);
|
||||
if (ret < 0)
|
||||
{
|
||||
fdbg("Flush failed: %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return byteswritten;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user