516 lines
13 KiB
C
516 lines
13 KiB
C
/*
|
|
* Copyright (c) 2006-2025 RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
*/
|
|
|
|
#include <dfs_seq_file.h>
|
|
#include <dfs_dentry.h>
|
|
|
|
#define DBG_TAG "DFS.seq"
|
|
#define DBG_LVL DBG_WARNING
|
|
#include <rtdbg.h>
|
|
|
|
#ifndef PAGE_SIZE
|
|
#define PAGE_SIZE 4096
|
|
#endif
|
|
|
|
/**
|
|
* @brief Handle buffer overflow condition in sequence file
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
*
|
|
* @details Sets the count to size to indicate buffer is full
|
|
*/
|
|
static void dfs_seq_overflow(struct dfs_seq_file *seq)
|
|
{
|
|
seq->count = seq->size;
|
|
}
|
|
|
|
/**
|
|
* @brief Allocate memory for sequence file operations
|
|
*
|
|
* @param[in] size Size of memory to allocate in bytes
|
|
*
|
|
* @return void* Pointer to allocated memory, or NULL if allocation fails
|
|
*/
|
|
static void *dfs_seq_alloc(unsigned long size)
|
|
{
|
|
return rt_calloc(1, size);
|
|
}
|
|
|
|
/**
|
|
* @brief Initialize and open a sequence file
|
|
*
|
|
* @param[in] file Pointer to the file structure to be initialized
|
|
* @param[in] ops Pointer to sequence operations structure containing callback functions
|
|
*
|
|
* @return int 0 on success, negative error code on failure:
|
|
* -EINVAL if ops is NULL
|
|
* -ENOMEM if memory allocation fails
|
|
*/
|
|
int dfs_seq_open(struct dfs_file *file, const struct dfs_seq_ops *ops)
|
|
{
|
|
struct dfs_seq_file *seq;
|
|
|
|
if (!ops)
|
|
{
|
|
LOG_E("dfs_seq_open: ops = null, pathname: %s\n", file->dentry->pathname);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (file->data)
|
|
{
|
|
LOG_W("dfs_seq_open: file->data != null\n");
|
|
}
|
|
|
|
seq = rt_calloc(1, sizeof(struct dfs_seq_file));
|
|
if (!seq)
|
|
return -ENOMEM;
|
|
|
|
file->data = seq;
|
|
|
|
rt_mutex_init(&seq->lock, "dfs_seq", RT_IPC_FLAG_PRIO);
|
|
|
|
seq->ops = ops;
|
|
seq->file = file;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Traverse sequence file data with specified offset
|
|
*
|
|
* This function traverses the sequence file data starting from the specified offset.
|
|
* It handles buffer overflow conditions by dynamically resizing the buffer when needed.
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
* @param[in] offset Position to start traversing from
|
|
*
|
|
* @return int 0 on success, negative error code on failure:
|
|
* -ENOMEM if memory allocation fails
|
|
* -EAGAIN if buffer needs to be resized
|
|
*
|
|
* @note Data output loop: start() -> show() -> next() -> show() -> ... -> next() -> stop()
|
|
*/
|
|
static int dfs_seq_traverse(struct dfs_seq_file *seq, off_t offset)
|
|
{
|
|
off_t pos = 0;
|
|
int error = 0;
|
|
void *p;
|
|
|
|
seq->index = 0;
|
|
seq->count = seq->from = 0;
|
|
if (!offset)
|
|
return 0;
|
|
|
|
if (!seq->buf)
|
|
{
|
|
seq->buf = dfs_seq_alloc(seq->size = PAGE_SIZE);
|
|
if (!seq->buf)
|
|
return -ENOMEM;
|
|
}
|
|
p = seq->ops->start(seq, &seq->index);
|
|
while (p)
|
|
{
|
|
error = seq->ops->show(seq, p);
|
|
if (error < 0)
|
|
break;
|
|
if (error)
|
|
{
|
|
error = 0;
|
|
seq->count = 0;
|
|
}
|
|
if (dfs_seq_is_full(seq))
|
|
goto Eoverflow;
|
|
|
|
p = seq->ops->next(seq, p, &seq->index);
|
|
if (pos + seq->count > offset)
|
|
{
|
|
seq->from = offset - pos;
|
|
seq->count -= seq->from;
|
|
break;
|
|
}
|
|
pos += seq->count;
|
|
seq->count = 0;
|
|
if (pos == offset)
|
|
break;
|
|
}
|
|
seq->ops->stop(seq, p);
|
|
return error;
|
|
|
|
Eoverflow:
|
|
seq->ops->stop(seq, p);
|
|
rt_free(seq->buf);
|
|
seq->count = 0;
|
|
seq->buf = dfs_seq_alloc(seq->size <<= 1);
|
|
return !seq->buf ? -ENOMEM : -EAGAIN;
|
|
}
|
|
|
|
/**
|
|
* @brief Read data from sequence file
|
|
*
|
|
* @param[in] file Pointer to the file structure
|
|
* @param[out] buf Buffer to store the read data
|
|
* @param[in] size Size of the buffer in bytes
|
|
* @param[in,out] pos Current file position (updated after read)
|
|
*
|
|
* @return ssize_t Number of bytes read on success, negative error code on failure:
|
|
* -EFAULT if buffer error occurs
|
|
* -ENOMEM if memory allocation fails
|
|
* 0 if size is 0
|
|
*
|
|
* @details This function implements the core sequence file reading logic with following steps:
|
|
* 1. Reset iterator if reading from start
|
|
* 2. Synchronize position if needed
|
|
* 3. Allocate buffer if not exists
|
|
* 4. Copy remaining data from previous read
|
|
* 5. Start iteration and fill buffer with new data
|
|
* 6. Handle buffer overflow by doubling size
|
|
* 7. Copy data to user buffer and update positions
|
|
*/
|
|
ssize_t dfs_seq_read(struct dfs_file *file, void *buf, size_t size, off_t *pos)
|
|
{
|
|
struct dfs_seq_file *seq = file->data;
|
|
size_t copied = 0;
|
|
size_t n;
|
|
void *p;
|
|
int err = 0;
|
|
|
|
if (!size)
|
|
return 0;
|
|
|
|
rt_mutex_take(&seq->lock, RT_WAITING_FOREVER);
|
|
|
|
/*
|
|
* if request is to read from zero offset, reset iterator to first
|
|
* record as it might have been already advanced by previous requests
|
|
*/
|
|
if (*pos == 0)
|
|
{
|
|
seq->index = 0;
|
|
seq->count = 0;
|
|
}
|
|
|
|
/* Don't assume ki_pos is where we left it */
|
|
if (*pos != seq->read_pos)
|
|
{
|
|
while ((err = dfs_seq_traverse(seq, *pos)) == -EAGAIN)
|
|
;
|
|
if (err)
|
|
{
|
|
/* With prejudice... */
|
|
seq->read_pos = 0;
|
|
seq->index = 0;
|
|
seq->count = 0;
|
|
goto Done;
|
|
}
|
|
else
|
|
{
|
|
seq->read_pos = *pos;
|
|
}
|
|
}
|
|
|
|
/* grab buffer if we didn't have one */
|
|
if (!seq->buf)
|
|
{
|
|
seq->buf = dfs_seq_alloc(seq->size = PAGE_SIZE);
|
|
if (!seq->buf)
|
|
goto Enomem;
|
|
}
|
|
/* something left in the buffer - copy it out first */
|
|
if (seq->count)
|
|
{
|
|
n = seq->count > size ? size : seq->count;
|
|
rt_memcpy((char *)buf + copied, seq->buf + seq->from, n);
|
|
size -= n;
|
|
seq->count -= n;
|
|
seq->from += n;
|
|
copied += n;
|
|
if (seq->count) /* hadn't managed to copy everything */
|
|
goto Done;
|
|
}
|
|
/* get a non-empty record in the buffer */
|
|
seq->from = 0;
|
|
p = seq->ops->start(seq, &seq->index);
|
|
while (p)
|
|
{
|
|
err = seq->ops->show(seq, p);
|
|
if (err < 0) /* hard error */
|
|
break;
|
|
if (err) /* ->show() says "skip it" */
|
|
seq->count = 0;
|
|
if (!seq->count)
|
|
{ /* empty record */
|
|
p = seq->ops->next(seq, p, &seq->index);
|
|
continue;
|
|
}
|
|
if (!dfs_seq_is_full(seq)) /* got it */
|
|
goto Fill;
|
|
/* need a bigger buffer */
|
|
seq->ops->stop(seq, p);
|
|
rt_free(seq->buf);
|
|
seq->count = 0;
|
|
seq->buf = dfs_seq_alloc(seq->size <<= 1);
|
|
if (!seq->buf)
|
|
goto Enomem;
|
|
p = seq->ops->start(seq, &seq->index);
|
|
}
|
|
/* EOF or an error */
|
|
seq->ops->stop(seq, p);
|
|
seq->count = 0;
|
|
goto Done;
|
|
Fill:
|
|
/* one non-empty record is in the buffer; if they want more, */
|
|
/* try to fit more in, but in any case we need to advance */
|
|
/* the iterator once for every record shown. */
|
|
while (1)
|
|
{
|
|
size_t offs = seq->count;
|
|
off_t pos = seq->index;
|
|
|
|
p = seq->ops->next(seq, p, &seq->index);
|
|
if (pos == seq->index)
|
|
{
|
|
LOG_W(".next function %p did not update position index\n", seq->ops->next);
|
|
seq->index++;
|
|
}
|
|
if (!p) /* no next record for us */
|
|
break;
|
|
if (seq->count >= size)
|
|
break;
|
|
err = seq->ops->show(seq, p);
|
|
if (err > 0)
|
|
{ /* ->show() says "skip it" */
|
|
seq->count = offs;
|
|
}
|
|
else if (err || dfs_seq_is_full(seq))
|
|
{
|
|
seq->count = offs;
|
|
break;
|
|
}
|
|
}
|
|
seq->ops->stop(seq, p);
|
|
n = seq->count > size ? size : seq->count;
|
|
rt_memcpy((char *)buf + copied, seq->buf, n);
|
|
size -= n;
|
|
copied += n;
|
|
seq->count -= n;
|
|
seq->from = n;
|
|
Done:
|
|
if (!copied)
|
|
{
|
|
copied = seq->count ? -EFAULT : err;
|
|
}
|
|
else
|
|
{
|
|
*pos += copied;
|
|
seq->read_pos += copied;
|
|
}
|
|
rt_mutex_release(&seq->lock);
|
|
return copied;
|
|
Enomem:
|
|
err = -ENOMEM;
|
|
goto Done;
|
|
}
|
|
|
|
/**
|
|
* @brief Reposition the file offset for sequence file
|
|
*
|
|
* @param[in] file Pointer to the file structure
|
|
* @param[in] offset Offset value according to whence
|
|
* @param[in] whence Reference position for offset:
|
|
* - SEEK_SET: from file beginning
|
|
* - SEEK_CUR: from current position
|
|
* @return off_t New file offset on success, negative error code on failure:
|
|
* -EINVAL for invalid parameters
|
|
*/
|
|
off_t dfs_seq_lseek(struct dfs_file *file, off_t offset, int whence)
|
|
{
|
|
struct dfs_seq_file *seq = file->data;
|
|
off_t retval = -EINVAL;
|
|
|
|
rt_mutex_take(&seq->lock, RT_WAITING_FOREVER);
|
|
|
|
switch (whence)
|
|
{
|
|
case SEEK_CUR:
|
|
offset += file->fpos;
|
|
case SEEK_SET:
|
|
if (offset < 0)
|
|
break;
|
|
retval = offset;
|
|
if (offset != seq->read_pos)
|
|
{
|
|
while ((retval = dfs_seq_traverse(seq, offset)) == -EAGAIN);
|
|
if (retval)
|
|
{
|
|
/* with extreme prejudice... */
|
|
retval = 0;
|
|
seq->read_pos = 0;
|
|
seq->index = 0;
|
|
seq->count = 0;
|
|
}
|
|
else
|
|
{
|
|
seq->read_pos = offset;
|
|
retval = offset;
|
|
}
|
|
}
|
|
}
|
|
|
|
rt_mutex_release(&seq->lock);
|
|
|
|
return retval;
|
|
}
|
|
|
|
/**
|
|
* @brief Release resources associated with a sequence file
|
|
*
|
|
* @param[in] file Pointer to the file structure to be released
|
|
*
|
|
* @return int Always returns 0 indicating success
|
|
*/
|
|
int dfs_seq_release(struct dfs_file *file)
|
|
{
|
|
struct dfs_seq_file *seq = file->data;
|
|
|
|
if (seq)
|
|
{
|
|
rt_mutex_detach(&seq->lock);
|
|
if (seq->buf)
|
|
{
|
|
rt_free(seq->buf);
|
|
}
|
|
rt_free(seq);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Format and write data to sequence file buffer using variable arguments
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
* @param[in] f Format string (printf-style)
|
|
* @param[in] args Variable arguments list
|
|
*
|
|
* @details This function:
|
|
* - Formats data using vsnprintf
|
|
* - Triggers overflow if buffer is full
|
|
*/
|
|
void dfs_seq_vprintf(struct dfs_seq_file *seq, const char *f, va_list args)
|
|
{
|
|
int len;
|
|
|
|
if (seq->count < seq->size)
|
|
{
|
|
len = vsnprintf(seq->buf + seq->count, seq->size - seq->count, f, args);
|
|
if (seq->count + len < seq->size)
|
|
{
|
|
seq->count += len;
|
|
return;
|
|
}
|
|
}
|
|
dfs_seq_overflow(seq);
|
|
}
|
|
|
|
/**
|
|
* @brief Format and print data to sequence file buffer (printf-style)
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
* @param[in] f Format string (printf-style)
|
|
* @param[in] ... Variable arguments matching format string
|
|
*/
|
|
void dfs_seq_printf(struct dfs_seq_file *seq, const char *f, ...)
|
|
{
|
|
va_list args;
|
|
|
|
va_start(args, f);
|
|
dfs_seq_vprintf(seq, f, args);
|
|
va_end(args);
|
|
}
|
|
|
|
/**
|
|
* @brief Write a single character to sequence file buffer
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
* @param[in] c Character to be written
|
|
*/
|
|
void dfs_seq_putc(struct dfs_seq_file *seq, char c)
|
|
{
|
|
if (seq->count < seq->size)
|
|
{
|
|
seq->buf[seq->count++] = c;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Write a string to sequence file buffer
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
* @param[in] s Null-terminated string to be written
|
|
*/
|
|
void dfs_seq_puts(struct dfs_seq_file *seq, const char *s)
|
|
{
|
|
int len = strlen(s);
|
|
|
|
if (seq->count + len >= seq->size)
|
|
{
|
|
dfs_seq_overflow(seq);
|
|
return;
|
|
}
|
|
rt_memcpy(seq->buf + seq->count, s, len);
|
|
seq->count += len;
|
|
}
|
|
|
|
/**
|
|
* @brief Write arbitrary binary data to sequence file buffer
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
* @param[in] data Pointer to data to be written
|
|
* @param[in] len Length of data in bytes
|
|
*
|
|
* @return int 0 on success, -1 if buffer overflow occurs
|
|
*/
|
|
int dfs_seq_write(struct dfs_seq_file *seq, const void *data, size_t len)
|
|
{
|
|
if (seq->count + len < seq->size)
|
|
{
|
|
rt_memcpy(seq->buf + seq->count, data, len);
|
|
seq->count += len;
|
|
return 0;
|
|
}
|
|
dfs_seq_overflow(seq);
|
|
return -1;
|
|
}
|
|
|
|
/**
|
|
* @brief Pad the sequence file buffer with spaces and optionally append a character
|
|
*
|
|
* @param[in,out] seq Pointer to sequence file structure
|
|
* @param[in] c Optional character to append after padding (if not '\0')
|
|
*/
|
|
void dfs_seq_pad(struct dfs_seq_file *seq, char c)
|
|
{
|
|
int size = seq->pad_until - seq->count;
|
|
|
|
if (size > 0)
|
|
{
|
|
if (size + seq->count > seq->size)
|
|
{
|
|
dfs_seq_overflow(seq);
|
|
return;
|
|
}
|
|
rt_memset(seq->buf + seq->count, ' ', size);
|
|
seq->count += size;
|
|
}
|
|
|
|
if (c)
|
|
{
|
|
dfs_seq_putc(seq, c);
|
|
}
|
|
} |