2009-11-05 19:15:06 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* drivers/rwbuffer.c
|
|
|
|
*
|
2014-07-11 19:20:11 +02:00
|
|
|
* Copyright (C) 2009, 2011, 2013-2014 Gregory Nutt. All rights reserved.
|
2012-07-15 16:56:25 +02:00
|
|
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
2009-11-05 19:15:06 +01:00
|
|
|
*
|
|
|
|
* 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>
|
|
|
|
|
2009-12-15 15:25:14 +01:00
|
|
|
#include <sys/types.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <stdbool.h>
|
2009-11-05 19:15:06 +01:00
|
|
|
#include <stdlib.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <time.h>
|
2009-11-05 22:44:33 +01:00
|
|
|
#include <assert.h>
|
2009-11-05 19:15:06 +01:00
|
|
|
#include <semaphore.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <debug.h>
|
|
|
|
|
2011-04-06 18:40:47 +02:00
|
|
|
#include <nuttx/kmalloc.h>
|
2009-11-05 22:44:33 +01:00
|
|
|
#include <nuttx/wqueue.h>
|
2016-07-20 21:54:38 +02:00
|
|
|
#include <nuttx/drivers/rwbuffer.h>
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#if defined(CONFIG_DRVR_WRITEBUFFER) || defined(CONFIG_DRVR_READAHEAD)
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
/****************************************************************************
|
2015-04-08 15:15:32 +02:00
|
|
|
* Pre-processor Definitions
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/* Configuration ************************************************************/
|
|
|
|
|
2009-11-05 23:58:36 +01:00
|
|
|
#ifndef CONFIG_SCHED_WORKQUEUE
|
|
|
|
# error "Worker thread support is required (CONFIG_SCHED_WORKQUEUE)"
|
|
|
|
#endif
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifndef CONFIG_DRVR_WRDELAY
|
|
|
|
# define CONFIG_DRVR_WRDELAY 350
|
2009-11-05 19:15:06 +01:00
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Types
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
2016-02-22 01:08:58 +01:00
|
|
|
* Private Data
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
2015-10-03 00:30:35 +02:00
|
|
|
* Public Data
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_semtake
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static void rwb_semtake(sem_t *sem)
|
|
|
|
{
|
|
|
|
/* Take the semaphore (perhaps waiting) */
|
|
|
|
|
|
|
|
while (sem_wait(sem) != 0)
|
|
|
|
{
|
2015-08-26 15:18:50 +02:00
|
|
|
/* The only case that an error should occur here is if
|
2009-11-05 19:15:06 +01:00
|
|
|
* the wait was awakened by a signal.
|
|
|
|
*/
|
|
|
|
|
2014-08-29 00:59:06 +02:00
|
|
|
ASSERT(get_errno() == EINTR);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_semgive
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#define rwb_semgive(s) sem_post(s)
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_overlap
|
|
|
|
****************************************************************************/
|
|
|
|
|
2009-12-15 15:25:14 +01:00
|
|
|
static inline bool rwb_overlap(off_t blockstart1, size_t nblocks1,
|
|
|
|
off_t blockstart2, size_t nblocks2)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2015-08-26 15:18:50 +02:00
|
|
|
off_t blockend1 = blockstart1 + nblocks1 - 1;
|
|
|
|
off_t blockend2 = blockstart2 + nblocks2 - 1;
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
/* If the buffer 1 is wholly outside of buffer 2, return false */
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
if ((blockend1 < blockstart2) || /* Wholly "below" */
|
|
|
|
(blockstart1 > blockend2)) /* Wholly "above" */
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2009-12-15 15:25:14 +01:00
|
|
|
return false;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2009-12-15 15:25:14 +01:00
|
|
|
return true;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_resetwrbuffer
|
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
2009-11-05 19:15:06 +01:00
|
|
|
static inline void rwb_resetwrbuffer(struct rwbuffer_s *rwb)
|
|
|
|
{
|
|
|
|
/* We assume that the caller holds the wrsem */
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
rwb->wrnblocks = 0;
|
2009-11-05 19:15:06 +01:00
|
|
|
rwb->wrblockstart = (off_t)-1;
|
|
|
|
rwb->wrexpectedblock = (off_t)-1;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_wrflush
|
2014-09-25 21:35:10 +02:00
|
|
|
*
|
|
|
|
* Assumptions:
|
|
|
|
* The caller holds the wrsem semaphore.
|
|
|
|
*
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
2009-11-05 19:15:06 +01:00
|
|
|
static void rwb_wrflush(struct rwbuffer_s *rwb)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("Timeout!\n");
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
if (rwb->wrnblocks > 0)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("Flushing: blockstart=0x%08lx nblocks=%d from buffer=%p\n",
|
2009-11-06 14:43:21 +01:00
|
|
|
(long)rwb->wrblockstart, rwb->wrnblocks, rwb->wrbuffer);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2009-11-25 14:50:26 +01:00
|
|
|
/* Flush cache. On success, the flush method will return the number
|
|
|
|
* of blocks written. Anything other than the number requested is
|
|
|
|
* an error.
|
|
|
|
*/
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
ret = rwb->wrflush(rwb->dev, rwb->wrbuffer, rwb->wrblockstart, rwb->wrnblocks);
|
2009-11-25 14:50:26 +01:00
|
|
|
if (ret != rwb->wrnblocks)
|
2009-11-05 21:16:15 +01:00
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("ERROR: Error flushing write buffer: %d\n", ret);
|
2009-11-05 21:16:15 +01:00
|
|
|
}
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2009-11-05 19:15:06 +01:00
|
|
|
rwb_resetwrbuffer(rwb);
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_wrtimeout
|
|
|
|
****************************************************************************/
|
|
|
|
|
2009-11-05 22:44:33 +01:00
|
|
|
static void rwb_wrtimeout(FAR void *arg)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
|
|
|
/* The following assumes that the size of a pointer is 4-bytes or less */
|
|
|
|
|
2009-11-05 22:44:33 +01:00
|
|
|
FAR struct rwbuffer_s *rwb = (struct rwbuffer_s *)arg;
|
|
|
|
DEBUGASSERT(rwb != NULL);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-04-06 17:02:02 +02:00
|
|
|
/* If a timeout elapses with with write buffer activity, this watchdog
|
2009-11-05 22:44:33 +01:00
|
|
|
* handler function will be evoked on the thread of execution of the
|
|
|
|
* worker thread.
|
2009-11-05 19:15:06 +01:00
|
|
|
*/
|
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
rwb_semtake(&rwb->wrsem);
|
2009-11-05 22:44:33 +01:00
|
|
|
rwb_wrflush(rwb);
|
2014-09-25 21:35:10 +02:00
|
|
|
rwb_semgive(&rwb->wrsem);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
2009-11-05 22:44:33 +01:00
|
|
|
* Name: rwb_wrstarttimeout
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2009-11-05 22:44:33 +01:00
|
|
|
static void rwb_wrstarttimeout(FAR struct rwbuffer_s *rwb)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
/* CONFIG_DRVR_WRDELAY provides the delay period in milliseconds. CLK_TCK
|
2009-11-05 19:15:06 +01:00
|
|
|
* provides the clock tick of the system (frequency in Hz).
|
|
|
|
*/
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
int ticks = (CONFIG_DRVR_WRDELAY + CLK_TCK/2) / CLK_TCK;
|
2012-09-04 02:54:09 +02:00
|
|
|
(void)work_queue(LPWORK, &rwb->work, rwb_wrtimeout, (FAR void *)rwb, ticks);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
2009-11-05 22:44:33 +01:00
|
|
|
* Name: rwb_wrcanceltimeout
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2009-11-05 22:44:33 +01:00
|
|
|
static inline void rwb_wrcanceltimeout(struct rwbuffer_s *rwb)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2012-09-04 02:54:09 +02:00
|
|
|
(void)work_cancel(LPWORK, &rwb->work);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_writebuffer
|
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
2009-11-05 19:15:06 +01:00
|
|
|
static ssize_t rwb_writebuffer(FAR struct rwbuffer_s *rwb,
|
2009-12-15 15:25:14 +01:00
|
|
|
off_t startblock, uint32_t nblocks,
|
|
|
|
FAR const uint8_t *wrbuffer)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
/* Write writebuffer Logic */
|
|
|
|
|
2009-11-05 22:44:33 +01:00
|
|
|
rwb_wrcanceltimeout(rwb);
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
/* First: Should we flush out our cache? We would do that if (1) we already
|
|
|
|
* buffering blocks and the next block writing is not in the same sequence,
|
|
|
|
* or (2) the number of blocks would exceed our allocated buffer capacity
|
|
|
|
*/
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
if (((startblock != rwb->wrexpectedblock) && (rwb->wrnblocks)) ||
|
|
|
|
((rwb->wrnblocks + nblocks) > rwb->wrmaxblocks))
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("writebuffer miss, expected: %08x, given: %08x\n",
|
2009-11-06 14:43:21 +01:00
|
|
|
rwb->wrexpectedblock, startblock);
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
/* Flush the write buffer */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2015-08-26 15:18:50 +02:00
|
|
|
ret = rwb->wrflush(rwb->dev, rwb->wrbuffer, rwb->wrblockstart, rwb->wrnblocks);
|
2009-11-05 19:15:06 +01:00
|
|
|
if (ret < 0)
|
2009-11-05 21:16:15 +01:00
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("ERROR: Error writing multiple from cache: %d\n", -ret);
|
2009-11-05 19:15:06 +01:00
|
|
|
return ret;
|
2009-11-05 21:16:15 +01:00
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
rwb_resetwrbuffer(rwb);
|
|
|
|
}
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
/* writebuffer is empty? Then initialize it */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
if (rwb->wrnblocks == 0)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("Fresh cache starting at block: 0x%08x\n", startblock);
|
2009-11-05 19:15:06 +01:00
|
|
|
rwb->wrblockstart = startblock;
|
|
|
|
}
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2009-11-05 19:15:06 +01:00
|
|
|
/* Add data to cache */
|
|
|
|
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("writebuffer: copying %d bytes from %p to %p\n",
|
2013-07-09 15:59:28 +02:00
|
|
|
nblocks * rwb->blocksize, wrbuffer,
|
2009-11-06 14:43:21 +01:00
|
|
|
&rwb->wrbuffer[rwb->wrnblocks * rwb->blocksize]);
|
|
|
|
memcpy(&rwb->wrbuffer[rwb->wrnblocks * rwb->blocksize],
|
|
|
|
wrbuffer, nblocks * rwb->blocksize);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
rwb->wrnblocks += nblocks;
|
|
|
|
rwb->wrexpectedblock = rwb->wrblockstart + rwb->wrnblocks;
|
2009-11-05 22:44:33 +01:00
|
|
|
rwb_wrstarttimeout(rwb);
|
2009-11-06 14:43:21 +01:00
|
|
|
return nblocks;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
2009-11-25 14:50:26 +01:00
|
|
|
* Name: rwb_resetrhbuffer
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2009-11-05 19:15:06 +01:00
|
|
|
static inline void rwb_resetrhbuffer(struct rwbuffer_s *rwb)
|
|
|
|
{
|
|
|
|
/* We assume that the caller holds the readAheadBufferSemphore */
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
rwb->rhnblocks = 0;
|
2009-11-05 19:15:06 +01:00
|
|
|
rwb->rhblockstart = (off_t)-1;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
2009-11-25 14:50:26 +01:00
|
|
|
* Name: rwb_bufferread
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2009-11-05 19:15:06 +01:00
|
|
|
static inline void
|
|
|
|
rwb_bufferread(struct rwbuffer_s *rwb, off_t startblock,
|
2009-12-15 15:25:14 +01:00
|
|
|
size_t nblocks, uint8_t **rdbuffer)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
|
|
|
/* We assume that (1) the caller holds the readAheadBufferSemphore, and (2)
|
|
|
|
* that the caller already knows that all of the blocks are in the
|
|
|
|
* read-ahead buffer.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* Convert the units from blocks to bytes */
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
off_t blockoffset = startblock - rwb->rhblockstart;
|
|
|
|
off_t byteoffset = rwb->blocksize * blockoffset;
|
|
|
|
size_t nbytes = rwb->blocksize * nblocks;
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
/* Get the byte address in the read-ahead buffer */
|
|
|
|
|
2009-12-15 15:25:14 +01:00
|
|
|
uint8_t *rhbuffer = rwb->rhbuffer + byteoffset;
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
/* Copy the data from the read-ahead buffer into the IO buffer */
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
memcpy(*rdbuffer, rhbuffer, nbytes);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
/* Update the caller's copy for the next address */
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
*rdbuffer += nbytes;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
2009-11-25 14:50:26 +01:00
|
|
|
* Name: rwb_rhreload
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2009-11-05 19:15:06 +01:00
|
|
|
static int rwb_rhreload(struct rwbuffer_s *rwb, off_t startblock)
|
|
|
|
{
|
2014-09-25 21:35:10 +02:00
|
|
|
off_t endblock;
|
2009-11-05 19:15:06 +01:00
|
|
|
size_t nblocks;
|
2009-11-06 14:43:21 +01:00
|
|
|
int ret;
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
/* Check for attempts to read beyond the end of the media */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
if (startblock >= rwb->nblocks)
|
|
|
|
{
|
|
|
|
return -ESPIPE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get the block number +1 of the last block that will fit in the
|
|
|
|
* read-ahead buffer
|
|
|
|
*/
|
|
|
|
|
|
|
|
endblock = startblock + rwb->rhmaxblocks;
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
/* Make sure that we don't read past the end of the device */
|
|
|
|
|
|
|
|
if (endblock > rwb->nblocks)
|
|
|
|
{
|
|
|
|
endblock = rwb->nblocks;
|
|
|
|
}
|
2012-07-15 16:56:25 +02:00
|
|
|
|
2009-11-05 19:15:06 +01:00
|
|
|
nblocks = endblock - startblock;
|
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
/* Reset the read buffer */
|
|
|
|
|
|
|
|
rwb_resetrhbuffer(rwb);
|
|
|
|
|
2009-11-05 19:15:06 +01:00
|
|
|
/* Now perform the read */
|
|
|
|
|
|
|
|
ret = rwb->rhreload(rwb->dev, rwb->rhbuffer, startblock, nblocks);
|
2009-11-25 14:50:26 +01:00
|
|
|
if (ret == nblocks)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
|
|
|
/* Update information about what is in the read-ahead buffer */
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
rwb->rhnblocks = nblocks;
|
2009-11-05 19:15:06 +01:00
|
|
|
rwb->rhblockstart = startblock;
|
2009-11-25 14:50:26 +01:00
|
|
|
|
|
|
|
/* The return value is not the number of blocks we asked to be loaded. */
|
|
|
|
|
|
|
|
return nblocks;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
2009-11-25 14:50:26 +01:00
|
|
|
|
|
|
|
return -EIO;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_invalidate_writebuffer
|
|
|
|
*
|
|
|
|
* Description:
|
|
|
|
* Invalidate a region of the write buffer
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-12 00:19:17 +02:00
|
|
|
#if defined(CONFIG_DRVR_WRITEBUFFER) && defined(CONFIG_DRVR_INVALIDATE)
|
2014-07-11 19:20:11 +02:00
|
|
|
int rwb_invalidate_writebuffer(FAR struct rwbuffer_s *rwb,
|
|
|
|
off_t startblock, size_t blockcount)
|
|
|
|
{
|
2017-05-31 17:28:20 +02:00
|
|
|
int ret = OK;
|
|
|
|
|
|
|
|
/* Is there a write buffer? Is data saved in the write buffer? */
|
2014-07-11 19:20:11 +02:00
|
|
|
|
2014-09-25 19:02:30 +02:00
|
|
|
if (rwb->wrmaxblocks > 0 && rwb->wrnblocks > 0)
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
|
|
|
off_t wrbend;
|
|
|
|
off_t invend;
|
|
|
|
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("startblock=%d blockcount=%p\n", startblock, blockcount);
|
2014-07-11 19:20:11 +02:00
|
|
|
|
|
|
|
rwb_semtake(&rwb->wrsem);
|
|
|
|
|
|
|
|
/* Now there are five cases:
|
|
|
|
*
|
|
|
|
* 1. We invalidate nothing
|
|
|
|
*/
|
|
|
|
|
|
|
|
wrbend = rwb->wrblockstart + rwb->wrnblocks;
|
|
|
|
invend = startblock + blockcount;
|
|
|
|
|
|
|
|
if (rwb->wrblockstart > invend || wrbend < startblock)
|
|
|
|
{
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* 2. We invalidate the entire write buffer. */
|
|
|
|
|
|
|
|
else if (rwb->wrblockstart >= startblock && wrbend <= invend)
|
|
|
|
{
|
|
|
|
rwb->wrnblocks = 0;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* We are going to invalidate a subset of the write buffer. Three
|
|
|
|
* more cases to consider:
|
|
|
|
*
|
|
|
|
* 2. We invalidate a portion in the middle of the write buffer
|
|
|
|
*/
|
|
|
|
|
|
|
|
else if (rwb->wrblockstart < startblock && wrbend > invend)
|
|
|
|
{
|
|
|
|
uint8_t *src;
|
|
|
|
off_t block;
|
|
|
|
off_t offset;
|
|
|
|
size_t nblocks;
|
|
|
|
|
|
|
|
/* Write the blocks at the end of the media to hardware */
|
|
|
|
|
|
|
|
nblocks = wrbend - invend;
|
|
|
|
block = invend;
|
|
|
|
offset = block - rwb->wrblockstart;
|
|
|
|
src = rwb->wrbuffer + offset * rwb->blocksize;
|
|
|
|
|
2014-09-25 19:02:30 +02:00
|
|
|
ret = rwb->wrflush(rwb->dev, src, block, nblocks);
|
2014-07-11 19:20:11 +02:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("ERROR: wrflush failed: %d\n", ret);
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Keep the blocks at the beginning of the buffer up the
|
|
|
|
* start of the invalidated region.
|
|
|
|
*/
|
|
|
|
else
|
|
|
|
{
|
|
|
|
rwb->wrnblocks = startblock - rwb->wrblockstart;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* 3. We invalidate a portion at the end of the write buffer */
|
|
|
|
|
|
|
|
else if (wrbend > startblock && wrbend <= invend)
|
|
|
|
{
|
|
|
|
rwb->wrnblocks = wrbend - startblock;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* 4. We invalidate a portion at the beginning of the write buffer */
|
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
else /* if (rwb->wrblockstart >= startblock && wrbend > invend) */
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
|
|
|
uint8_t *src;
|
|
|
|
size_t ninval;
|
|
|
|
size_t nkeep;
|
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
DEBUGASSERT(rwb->wrblockstart >= startblock && wrbend > invend);
|
2014-07-11 19:20:11 +02:00
|
|
|
|
|
|
|
/* Copy the data from the uninvalidated region to the beginning
|
|
|
|
* of the write buffer.
|
|
|
|
*
|
|
|
|
* First calculate the source and destination of the transfer.
|
|
|
|
*/
|
|
|
|
|
|
|
|
ninval = invend - rwb->wrblockstart;
|
|
|
|
src = rwb->wrbuffer + ninval * rwb->blocksize;
|
|
|
|
|
|
|
|
/* Calculate the number of blocks we are keeping. We keep
|
|
|
|
* the ones that we don't invalidate.
|
|
|
|
*/
|
|
|
|
|
|
|
|
nkeep = rwb->wrnblocks - ninval;
|
|
|
|
|
|
|
|
/* Then move the data that we are keeping to the beginning
|
|
|
|
* the write buffer.
|
|
|
|
*/
|
|
|
|
|
|
|
|
memcpy(rwb->wrbuffer, src, nkeep * rwb->blocksize);
|
|
|
|
|
|
|
|
/* Update the block info. The first block is now the one just
|
|
|
|
* after the invalidation region and the number buffered blocks
|
|
|
|
* is the number that we kept.
|
|
|
|
*/
|
|
|
|
|
|
|
|
rwb->wrblockstart = invend;
|
|
|
|
rwb->wrnblocks = nkeep;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
rwb_semgive(&rwb->wrsem);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_invalidate_readahead
|
|
|
|
*
|
|
|
|
* Description:
|
|
|
|
* Invalidate a region of the read-ahead buffer
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-12 00:19:17 +02:00
|
|
|
#if defined(CONFIG_DRVR_READAHEAD) && defined(CONFIG_DRVR_INVALIDATE)
|
2014-07-11 19:20:11 +02:00
|
|
|
int rwb_invalidate_readahead(FAR struct rwbuffer_s *rwb,
|
|
|
|
off_t startblock, size_t blockcount)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
2014-09-25 19:02:30 +02:00
|
|
|
if (rwb->rhmaxblocks > 0 && rwb->rhnblocks > 0)
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
|
|
|
off_t rhbend;
|
|
|
|
off_t invend;
|
|
|
|
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("startblock=%d blockcount=%p\n", startblock, blockcount);
|
2014-07-11 19:20:11 +02:00
|
|
|
|
|
|
|
rwb_semtake(&rwb->rhsem);
|
|
|
|
|
|
|
|
/* Now there are five cases:
|
|
|
|
*
|
|
|
|
* 1. We invalidate nothing
|
|
|
|
*/
|
|
|
|
|
|
|
|
rhbend = rwb->rhblockstart + rwb->rhnblocks;
|
|
|
|
invend = startblock + blockcount;
|
|
|
|
|
2015-10-10 18:41:00 +02:00
|
|
|
if (rhbend <= startblock || rwb->rhblockstart >= invend)
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* 2. We invalidate the entire read-ahead buffer. */
|
|
|
|
|
|
|
|
else if (rwb->rhblockstart >= startblock && rhbend <= invend)
|
|
|
|
{
|
|
|
|
rwb->rhnblocks = 0;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* We are going to invalidate a subset of the read-ahead buffer.
|
|
|
|
* Three more cases to consider:
|
|
|
|
*
|
2014-09-25 21:35:10 +02:00
|
|
|
* 2. We invalidate a portion in the middle of the read-ahead buffer
|
2014-07-11 19:20:11 +02:00
|
|
|
*/
|
|
|
|
|
|
|
|
else if (rwb->rhblockstart < startblock && rhbend > invend)
|
|
|
|
{
|
|
|
|
/* Keep the blocks at the beginning of the buffer up the
|
|
|
|
* start of the invalidated region.
|
|
|
|
*/
|
|
|
|
|
|
|
|
rwb->rhnblocks = startblock - rwb->rhblockstart;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* 3. We invalidate a portion at the end of the read-ahead buffer */
|
|
|
|
|
|
|
|
else if (rhbend > startblock && rhbend <= invend)
|
|
|
|
{
|
|
|
|
rwb->rhnblocks = rhbend - startblock;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* 4. We invalidate a portion at the beginning of the write buffer */
|
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
else /* if (rwb->rhblockstart >= startblock && rhbend > invend) */
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
|
|
|
/* Let's just force the whole read-ahead buffer to be reloaded.
|
|
|
|
* That might cost s small amount of performance, but well worth
|
|
|
|
* the lower complexity.
|
|
|
|
*/
|
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
DEBUGASSERT(rwb->rhblockstart >= startblock && rhbend > invend);
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb->rhnblocks = 0;
|
|
|
|
ret = OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
rwb_semgive(&rwb->rhsem);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2009-11-05 19:15:06 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* Public Functions
|
|
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_initialize
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
int rwb_initialize(FAR struct rwbuffer_s *rwb)
|
|
|
|
{
|
2009-12-15 15:25:14 +01:00
|
|
|
uint32_t allocsize;
|
2009-11-06 14:43:21 +01:00
|
|
|
|
2009-11-05 19:15:06 +01:00
|
|
|
/* Sanity checking */
|
|
|
|
|
|
|
|
DEBUGASSERT(rwb != NULL);
|
|
|
|
DEBUGASSERT(rwb->blocksize > 0);
|
|
|
|
DEBUGASSERT(rwb->nblocks > 0);
|
|
|
|
DEBUGASSERT(rwb->dev != NULL);
|
|
|
|
|
|
|
|
/* Setup so that rwb_uninitialize can handle a failure */
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
2015-10-10 18:41:00 +02:00
|
|
|
DEBUGASSERT(rwb->wrflush != NULL);
|
2009-11-05 19:15:06 +01:00
|
|
|
rwb->wrbuffer = NULL;
|
|
|
|
#endif
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2009-11-05 19:15:06 +01:00
|
|
|
DEBUGASSERT(rwb->rhreload != NULL);
|
|
|
|
rwb->rhbuffer = NULL;
|
|
|
|
#endif
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
|
|
|
if (rwb->wrmaxblocks > 0)
|
|
|
|
{
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("Initialize the write buffer\n");
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Initialize the write buffer access semaphore */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
sem_init(&rwb->wrsem, 0, 1);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Initialize write buffer parameters */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb_resetwrbuffer(rwb);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Allocate the write buffer */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb->wrbuffer = NULL;
|
|
|
|
if (rwb->wrmaxblocks > 0)
|
2009-11-06 14:43:21 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
allocsize = rwb->wrmaxblocks * rwb->blocksize;
|
2014-09-01 01:26:36 +02:00
|
|
|
rwb->wrbuffer = kmm_malloc(allocsize);
|
2014-07-11 19:20:11 +02:00
|
|
|
if (!rwb->wrbuffer)
|
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("Write buffer kmm_malloc(%d) failed\n", allocsize);
|
2014-07-11 19:20:11 +02:00
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2009-11-06 14:43:21 +01:00
|
|
|
}
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("Write buffer size: %d bytes\n", allocsize);
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
|
|
|
#endif /* CONFIG_DRVR_WRITEBUFFER */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2014-09-25 19:02:30 +02:00
|
|
|
if (rwb->rhmaxblocks > 0)
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("Initialize the read-ahead buffer\n");
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Initialize the read-ahead buffer access semaphore */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
sem_init(&rwb->rhsem, 0, 1);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Initialize read-ahead buffer parameters */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb_resetrhbuffer(rwb);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Allocate the read-ahead buffer */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb->rhbuffer = NULL;
|
|
|
|
if (rwb->rhmaxblocks > 0)
|
2009-11-06 14:43:21 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
allocsize = rwb->rhmaxblocks * rwb->blocksize;
|
2014-09-01 01:26:36 +02:00
|
|
|
rwb->rhbuffer = kmm_malloc(allocsize);
|
2014-07-11 19:20:11 +02:00
|
|
|
if (!rwb->rhbuffer)
|
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("Read-ahead buffer kmm_malloc(%d) failed\n", allocsize);
|
2014-07-11 19:20:11 +02:00
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2009-11-06 14:43:21 +01:00
|
|
|
}
|
2014-07-11 19:20:11 +02:00
|
|
|
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("Read-ahead buffer size: %d bytes\n", allocsize);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
2014-07-11 19:20:11 +02:00
|
|
|
#endif /* CONFIG_DRVR_READAHEAD */
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
return OK;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_uninitialize
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
void rwb_uninitialize(FAR struct rwbuffer_s *rwb)
|
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
|
|
|
if (rwb->wrmaxblocks > 0)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb_wrcanceltimeout(rwb);
|
|
|
|
sem_destroy(&rwb->wrsem);
|
|
|
|
if (rwb->wrbuffer)
|
|
|
|
{
|
2014-09-01 01:04:02 +02:00
|
|
|
kmm_free(rwb->wrbuffer);
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2014-09-25 19:02:30 +02:00
|
|
|
if (rwb->rhmaxblocks > 0)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
sem_destroy(&rwb->rhsem);
|
|
|
|
if (rwb->rhbuffer)
|
|
|
|
{
|
2014-09-01 01:04:02 +02:00
|
|
|
kmm_free(rwb->rhbuffer);
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
2009-11-25 14:50:26 +01:00
|
|
|
* Name: rwb_read
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2015-12-05 17:36:00 +01:00
|
|
|
ssize_t rwb_read(FAR struct rwbuffer_s *rwb, off_t startblock,
|
|
|
|
size_t nblocks, FAR uint8_t *rdbuffer)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2015-12-05 17:36:00 +01:00
|
|
|
size_t remaining;
|
2014-09-25 19:02:30 +02:00
|
|
|
int ret = OK;
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("startblock=%ld nblocks=%ld rdbuffer=%p\n",
|
2009-11-06 14:43:21 +01:00
|
|
|
(long)startblock, (long)nblocks, rdbuffer);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
2009-11-05 19:15:06 +01:00
|
|
|
/* If the new read data overlaps any part of the write buffer, then
|
|
|
|
* flush the write data onto the physical media before reading. We
|
|
|
|
* could attempt some more exotic handling -- but this simple logic
|
|
|
|
* is well-suited for simple streaming applications.
|
|
|
|
*/
|
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
if (rwb->wrmaxblocks > 0)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2009-11-06 14:43:21 +01:00
|
|
|
/* If the write buffer overlaps the block(s) requested, then flush the
|
|
|
|
* write buffer.
|
|
|
|
*/
|
|
|
|
|
|
|
|
rwb_semtake(&rwb->wrsem);
|
|
|
|
if (rwb_overlap(rwb->wrblockstart, rwb->wrnblocks, startblock, nblocks))
|
|
|
|
{
|
|
|
|
rwb_wrflush(rwb);
|
|
|
|
}
|
2014-07-11 19:20:11 +02:00
|
|
|
|
2009-11-06 14:43:21 +01:00
|
|
|
rwb_semgive(&rwb->wrsem);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2014-09-25 19:02:30 +02:00
|
|
|
if (rwb->rhmaxblocks > 0)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Loop until we have read all of the requested blocks */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb_semtake(&rwb->rhsem);
|
2015-10-10 18:41:00 +02:00
|
|
|
for (remaining = nblocks; remaining > 0; )
|
2009-11-05 21:16:15 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Is there anything in the read-ahead buffer? */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
if (rwb->rhnblocks > 0)
|
|
|
|
{
|
|
|
|
off_t bufferend;
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
/* How many blocks are available in this buffer? */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
bufferend = rwb->rhblockstart + rwb->rhnblocks;
|
2014-09-25 21:35:10 +02:00
|
|
|
if (startblock >= rwb->rhblockstart && startblock < bufferend)
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
2014-09-25 21:35:10 +02:00
|
|
|
size_t rdblocks = bufferend - startblock;
|
|
|
|
if (rdblocks > remaining)
|
|
|
|
{
|
|
|
|
rdblocks = remaining;
|
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
/* Then read the data from the read-ahead buffer */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
rwb_bufferread(rwb, startblock, rdblocks, &rdbuffer);
|
|
|
|
startblock += rdblocks;
|
|
|
|
remaining -= rdblocks;
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* If we did not get all of the data from the buffer, then we have
|
|
|
|
* to refill the buffer and try again.
|
|
|
|
*/
|
|
|
|
|
|
|
|
if (remaining > 0)
|
2009-11-05 21:16:15 +01:00
|
|
|
{
|
2014-09-25 19:02:30 +02:00
|
|
|
ret = rwb_rhreload(rwb, startblock);
|
2014-07-11 19:20:11 +02:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("ERROR: Failed to fill the read-ahead buffer: %d\n", ret);
|
2015-12-05 17:36:00 +01:00
|
|
|
return (ssize_t)ret;
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
2009-11-05 21:16:15 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* On success, return the number of blocks that we were requested to
|
|
|
|
* read. This is for compatibility with the normal return of a block
|
|
|
|
* driver read method
|
|
|
|
*/
|
2009-11-25 14:50:26 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb_semgive(&rwb->rhsem);
|
|
|
|
ret = nblocks;
|
|
|
|
}
|
|
|
|
else
|
2009-11-05 19:15:06 +01:00
|
|
|
#else
|
2014-07-12 15:44:56 +02:00
|
|
|
{
|
|
|
|
/* No read-ahead buffering, (re)load the data directly into
|
|
|
|
* the user buffer.
|
|
|
|
*/
|
|
|
|
|
2015-08-26 15:18:50 +02:00
|
|
|
ret = rwb->rhreload(rwb->dev, rdbuffer, startblock, nblocks);
|
2014-07-12 15:44:56 +02:00
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
#endif
|
2014-07-11 19:20:11 +02:00
|
|
|
|
2015-12-05 17:36:00 +01:00
|
|
|
return (ssize_t)ret;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_write
|
|
|
|
****************************************************************************/
|
|
|
|
|
2015-12-05 17:36:00 +01:00
|
|
|
ssize_t rwb_write(FAR struct rwbuffer_s *rwb, off_t startblock,
|
|
|
|
size_t nblocks, FAR const uint8_t *wrbuffer)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-09-25 19:02:30 +02:00
|
|
|
int ret = OK;
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2014-09-25 19:02:30 +02:00
|
|
|
if (rwb->rhmaxblocks > 0)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
/* If the new write data overlaps any part of the read buffer, then
|
|
|
|
* flush the data from the read buffer. We could attempt some more
|
|
|
|
* exotic handling -- but this simple logic is well-suited for simple
|
|
|
|
* streaming applications.
|
|
|
|
*/
|
|
|
|
|
|
|
|
rwb_semtake(&rwb->rhsem);
|
|
|
|
if (rwb_overlap(rwb->rhblockstart, rwb->rhnblocks, startblock, nblocks))
|
|
|
|
{
|
|
|
|
rwb_resetrhbuffer(rwb);
|
|
|
|
}
|
|
|
|
|
|
|
|
rwb_semgive(&rwb->rhsem);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
|
|
|
if (rwb->wrmaxblocks > 0)
|
|
|
|
{
|
2016-06-11 19:59:51 +02:00
|
|
|
finfo("startblock=%d wrbuffer=%p\n", startblock, wrbuffer);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Use the block cache unless the buffer size is bigger than block cache */
|
2014-04-13 22:32:20 +02:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
if (nblocks > rwb->wrmaxblocks)
|
|
|
|
{
|
|
|
|
/* First flush the cache */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
rwb_semtake(&rwb->wrsem);
|
|
|
|
rwb_wrflush(rwb);
|
|
|
|
rwb_semgive(&rwb->wrsem);
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/* Then transfer the data directly to the media */
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 19:02:30 +02:00
|
|
|
ret = rwb->wrflush(rwb->dev, wrbuffer, startblock, nblocks);
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/* Buffer the data in the write buffer */
|
|
|
|
|
|
|
|
ret = rwb_writebuffer(rwb, startblock, nblocks, wrbuffer);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* On success, return the number of blocks that we were requested to
|
|
|
|
* write. This is for compatibility with the normal return of a block
|
|
|
|
* driver write method
|
|
|
|
*/
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
|
|
|
else
|
2017-05-31 17:28:20 +02:00
|
|
|
#endif /* CONFIG_DRVR_WRITEBUFFER */
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
/* No write buffer.. just pass the write operation through via the
|
|
|
|
* flush callback.
|
|
|
|
*/
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 19:02:30 +02:00
|
|
|
ret = rwb->wrflush(rwb->dev, wrbuffer, startblock, nblocks);
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
2009-11-25 14:50:26 +01:00
|
|
|
|
2015-12-05 17:36:00 +01:00
|
|
|
return (ssize_t)ret;
|
2014-07-11 19:20:11 +02:00
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-09-25 21:35:10 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_readbytes
|
|
|
|
*
|
|
|
|
* Description:
|
|
|
|
* Character-oriented read
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#ifdef CONFIG_DRVR_READBYTES
|
|
|
|
ssize_t rwb_readbytes(FAR struct rwbuffer_s *dev, off_t offset,
|
|
|
|
size_t nbytes, FAR uint8_t *buffer)
|
|
|
|
{
|
|
|
|
/* Loop while there are bytes still be be read */
|
|
|
|
/* Make sure that the sector containing the next bytes to transfer is in
|
|
|
|
* memory.
|
|
|
|
*/
|
|
|
|
/* How many bytes can be transfer from the in-memory data? */
|
|
|
|
/* Transfer the bytes */
|
|
|
|
/* Adjust counts and offsets for the next time through the loop */
|
|
|
|
|
|
|
|
#warning Not Implemented
|
|
|
|
return -ENOSYS;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* Name: rwb_mediaremoved
|
|
|
|
*
|
|
|
|
* Description:
|
|
|
|
* The following function is called when media is removed
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-12 00:19:17 +02:00
|
|
|
#ifdef CONFIG_DRVR_REMOVABLE
|
2014-07-11 19:20:11 +02:00
|
|
|
int rwb_mediaremoved(FAR struct rwbuffer_s *rwb)
|
|
|
|
{
|
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
|
|
|
if (rwb->wrmaxblocks > 0)
|
|
|
|
{
|
|
|
|
rwb_semtake(&rwb->wrsem);
|
|
|
|
rwb_resetwrbuffer(rwb);
|
|
|
|
rwb_semgive(&rwb->wrsem);
|
|
|
|
}
|
|
|
|
#endif
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
2014-11-05 22:26:48 +01:00
|
|
|
if (rwb->rhmaxblocks > 0)
|
2014-07-11 19:20:11 +02:00
|
|
|
{
|
|
|
|
rwb_semtake(&rwb->rhsem);
|
|
|
|
rwb_resetrhbuffer(rwb);
|
|
|
|
rwb_semgive(&rwb->rhsem);
|
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
#endif
|
2014-07-11 19:20:11 +02:00
|
|
|
|
|
|
|
return OK;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
2014-07-12 00:19:17 +02:00
|
|
|
#endif
|
2009-11-05 19:15:06 +01:00
|
|
|
|
|
|
|
/****************************************************************************
|
2014-07-11 19:20:11 +02:00
|
|
|
* Name: rwb_invalidate
|
2012-07-15 16:56:25 +02:00
|
|
|
*
|
|
|
|
* Description:
|
2014-07-11 19:20:11 +02:00
|
|
|
* Invalidate a region of the caches
|
2012-07-15 16:56:25 +02:00
|
|
|
*
|
2009-11-05 19:15:06 +01:00
|
|
|
****************************************************************************/
|
|
|
|
|
2014-07-12 00:19:17 +02:00
|
|
|
#ifdef CONFIG_DRVR_INVALIDATE
|
2014-07-11 19:20:11 +02:00
|
|
|
int rwb_invalidate(FAR struct rwbuffer_s *rwb,
|
|
|
|
off_t startblock, size_t blockcount)
|
2009-11-05 19:15:06 +01:00
|
|
|
{
|
2014-07-11 19:20:11 +02:00
|
|
|
int ret;
|
|
|
|
|
|
|
|
#ifdef CONFIG_DRVR_WRITEBUFFER
|
|
|
|
ret = rwb_invalidate_writebuffer(rwb, startblock, blockcount);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("ERROR: rwb_invalidate_writebuffer failed: %d\n", ret);
|
2014-07-11 19:20:11 +02:00
|
|
|
return ret;
|
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
#endif
|
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#ifdef CONFIG_DRVR_READAHEAD
|
|
|
|
ret = rwb_invalidate_readahead(rwb, startblock, blockcount);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
2016-06-11 23:50:49 +02:00
|
|
|
ferr("ERROR: rwb_invalidate_readahead failed: %d\n", ret);
|
2014-07-11 19:20:11 +02:00
|
|
|
return ret;
|
|
|
|
}
|
2009-11-05 19:15:06 +01:00
|
|
|
#endif
|
2014-07-11 19:20:11 +02:00
|
|
|
|
|
|
|
return OK;
|
2009-11-05 19:15:06 +01:00
|
|
|
}
|
2014-07-12 00:19:17 +02:00
|
|
|
#endif
|
2009-11-05 19:15:06 +01:00
|
|
|
|
2014-07-11 19:20:11 +02:00
|
|
|
#endif /* CONFIG_DRVR_WRITEBUFFER || CONFIG_DRVR_READAHEAD */
|
2009-11-05 19:15:06 +01:00
|
|
|
|