#include <sys/param.h>
#include <lib/libsa/stand.h>
#include <rawfs.h>
extern int debug;
#define RAWFS_BSIZE 8192
struct file {
daddr_t fs_nextblk;
daddr_t fs_curblk;
int fs_len;
char *fs_ptr;
char fs_buf[RAWFS_BSIZE];
};
static int rawfs_get_block(struct open_file *);
int rawfs_open(const char *path, struct open_file *f)
{
struct file *fs;
fs = alloc(sizeof(struct file));
fs->fs_nextblk = 0;
fs->fs_curblk = -1;
fs->fs_len = 0;
fs->fs_ptr = fs->fs_buf;
f->f_fsdata = fs;
return 0;
}
int rawfs_close(struct open_file *f)
{
struct file *fs;
fs = (struct file *)f->f_fsdata;
f->f_fsdata = NULL;
if (fs != NULL)
dealloc(fs, sizeof(*fs));
return 0;
}
int rawfs_read(struct open_file *f, void *start, u_int size, u_int *resid)
{
struct file *fs = (struct file *)f->f_fsdata;
char *addr = start;
int error = 0;
size_t csize;
while (size != 0) {
if (fs->fs_len == 0)
if ((error = rawfs_get_block(f)) != 0)
break;
if (fs->fs_len <= 0)
break;
csize = size;
if (csize > fs->fs_len)
csize = fs->fs_len;
memcpy(addr, fs->fs_ptr, csize);
fs->fs_ptr += csize;
fs->fs_len -= csize;
addr += csize;
size -= csize;
}
if (resid)
*resid = size;
if (error) {
errno = error;
error = -1;
}
return error;
}
int rawfs_write(struct open_file *f, void *start, size_t size, size_t *resid)
{
errno = EROFS;
return -1;
}
off_t rawfs_seek(struct open_file *f, off_t offset, int where)
{
struct file *fs = (struct file *)f->f_fsdata;
daddr_t curblk, targblk;
off_t newoff;
int err, idx;
curblk = (fs->fs_curblk < 0) ? 0 : fs->fs_curblk;
switch (where) {
case SEEK_SET:
newoff = offset;
break;
case SEEK_CUR:
if (fs->fs_curblk < 0)
newoff = 0;
else {
newoff = fs->fs_curblk * RAWFS_BSIZE;
newoff += RAWFS_BSIZE - fs->fs_len;
}
newoff += offset;
break;
default:
errno = EINVAL;
return -1;
}
if (newoff < (curblk * RAWFS_BSIZE)) {
errno = EINVAL;
return -1;
}
targblk = newoff / RAWFS_BSIZE;
err = 0;
while (fs->fs_curblk != targblk && (err = rawfs_get_block(f)) == 0)
;
if (err) {
errno = err;
return -1;
}
idx = newoff % RAWFS_BSIZE;
fs->fs_len = RAWFS_BSIZE - idx;
fs->fs_ptr = &fs->fs_buf[idx];
return newoff;
}
int rawfs_stat(struct open_file *f, struct stat *sb)
{
errno = EFTYPE;
return -1;
}
static int
rawfs_get_block(struct open_file *f)
{
struct file *fs;
int error;
size_t len;
fs = (struct file *)f->f_fsdata;
fs->fs_ptr = fs->fs_buf;
twiddle();
error = f->f_dev->dv_strategy(f->f_devdata, F_READ,
fs->fs_nextblk * (RAWFS_BSIZE / DEV_BSIZE),
RAWFS_BSIZE, fs->fs_buf, &len);
if (error == 0) {
fs->fs_len = len;
fs->fs_curblk = fs->fs_nextblk;
fs->fs_nextblk += 1;
} else {
errno = error;
error = -1;
}
return error;
}