xref: /netbsd-src/sys/arch/ews4800mips/stand/common/datafs.c (revision ce099b40997c43048fb78bd578195f81d2456523)
1*ce099b40Smartin /*	$NetBSD: datafs.c,v 1.2 2008/04/28 20:23:18 martin Exp $	*/
204faabf0Stsutsui 
304faabf0Stsutsui /*-
404faabf0Stsutsui  * Copyright (c) 2004 The NetBSD Foundation, Inc.
504faabf0Stsutsui  * All rights reserved.
604faabf0Stsutsui  *
704faabf0Stsutsui  * This code is derived from software contributed to The NetBSD Foundation
804faabf0Stsutsui  * by UCHIYAMA Yasushi.
904faabf0Stsutsui  *
1004faabf0Stsutsui  * Redistribution and use in source and binary forms, with or without
1104faabf0Stsutsui  * modification, are permitted provided that the following conditions
1204faabf0Stsutsui  * are met:
1304faabf0Stsutsui  * 1. Redistributions of source code must retain the above copyright
1404faabf0Stsutsui  *    notice, this list of conditions and the following disclaimer.
1504faabf0Stsutsui  * 2. Redistributions in binary form must reproduce the above copyright
1604faabf0Stsutsui  *    notice, this list of conditions and the following disclaimer in the
1704faabf0Stsutsui  *    documentation and/or other materials provided with the distribution.
1804faabf0Stsutsui  *
1904faabf0Stsutsui  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
2004faabf0Stsutsui  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
2104faabf0Stsutsui  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
2204faabf0Stsutsui  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
2304faabf0Stsutsui  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
2404faabf0Stsutsui  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
2504faabf0Stsutsui  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
2604faabf0Stsutsui  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
2704faabf0Stsutsui  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
2804faabf0Stsutsui  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
2904faabf0Stsutsui  * POSSIBILITY OF SUCH DAMAGE.
3004faabf0Stsutsui  */
3104faabf0Stsutsui 
3204faabf0Stsutsui #include <lib/libsa/stand.h>
3304faabf0Stsutsui #include <lib/libkern/libkern.h>
3404faabf0Stsutsui 
3504faabf0Stsutsui #include "local.h"
3604faabf0Stsutsui 
3704faabf0Stsutsui FS_DEF(data);
3804faabf0Stsutsui 
3904faabf0Stsutsui struct fs_ops datafs_ops = {
4004faabf0Stsutsui 	data_open, data_close, data_read, data_write, data_seek, data_stat
4104faabf0Stsutsui };
4204faabf0Stsutsui 
4304faabf0Stsutsui struct datafs {
4404faabf0Stsutsui 	uint8_t *ptr;
4504faabf0Stsutsui 	uint8_t *end;
4604faabf0Stsutsui 	uint8_t *start;
4704faabf0Stsutsui 	size_t size;
4804faabf0Stsutsui } __data;
4904faabf0Stsutsui 
5004faabf0Stsutsui void
data_attach(void * addr,size_t size)5104faabf0Stsutsui data_attach(void *addr, size_t size)
5204faabf0Stsutsui {
5304faabf0Stsutsui 
5404faabf0Stsutsui 	__data.start = addr;
5504faabf0Stsutsui 	__data.size = size;
5604faabf0Stsutsui }
5704faabf0Stsutsui 
5804faabf0Stsutsui int
data_open(const char * name,struct open_file * f)5904faabf0Stsutsui data_open(const char *name, struct open_file *f)
6004faabf0Stsutsui {
6104faabf0Stsutsui 
6204faabf0Stsutsui 	if (__data.size == 0) {
6304faabf0Stsutsui 		printf("no data\n");
6404faabf0Stsutsui 		return -1;
6504faabf0Stsutsui 	}
6604faabf0Stsutsui 
6704faabf0Stsutsui 	__data.ptr = __data.start;
6804faabf0Stsutsui 	__data.end = __data.ptr + __data.size;
6904faabf0Stsutsui 
7004faabf0Stsutsui 	return 0;
7104faabf0Stsutsui }
7204faabf0Stsutsui 
7304faabf0Stsutsui int
data_close(struct open_file * f)7404faabf0Stsutsui data_close(struct open_file *f)
7504faabf0Stsutsui {
7604faabf0Stsutsui 
7704faabf0Stsutsui 	return 0;
7804faabf0Stsutsui }
7904faabf0Stsutsui 
8004faabf0Stsutsui int
data_read(struct open_file * f,void * buf,size_t size,size_t * resid)8104faabf0Stsutsui data_read(struct open_file *f, void *buf, size_t size, size_t *resid)
8204faabf0Stsutsui {
8304faabf0Stsutsui 	uint8_t *b = buf;
8404faabf0Stsutsui 	size_t sz;
8504faabf0Stsutsui 
8604faabf0Stsutsui 	twiddle();
8704faabf0Stsutsui 	if (__data.ptr + size < __data.end) {
8804faabf0Stsutsui 		sz = size;
8904faabf0Stsutsui 		memcpy(b, __data.ptr, sz);
9004faabf0Stsutsui 		__data.ptr += sz;
9104faabf0Stsutsui 	} else {
9204faabf0Stsutsui 		sz = (size_t)(__data.end - __data.ptr);
9304faabf0Stsutsui 		while (__data.ptr < __data.end)
9404faabf0Stsutsui 			*b++ = *__data.ptr++;
9504faabf0Stsutsui 	}
9604faabf0Stsutsui 
9704faabf0Stsutsui 	if (resid)
9804faabf0Stsutsui 		*resid = size - sz;
9904faabf0Stsutsui 
10004faabf0Stsutsui 	return 0;
10104faabf0Stsutsui }
10204faabf0Stsutsui 
10304faabf0Stsutsui int
data_write(struct open_file * f,void * start,size_t size,size_t * resid)10404faabf0Stsutsui data_write(struct open_file *f, void *start, size_t size, size_t *resid)
10504faabf0Stsutsui {
10604faabf0Stsutsui 
10704faabf0Stsutsui 	return 0;
10804faabf0Stsutsui }
10904faabf0Stsutsui 
11004faabf0Stsutsui off_t
data_seek(struct open_file * f,off_t offset,int where)11104faabf0Stsutsui data_seek(struct open_file *f, off_t offset, int where)
11204faabf0Stsutsui {
11304faabf0Stsutsui 	uint8_t *p = 0;
11404faabf0Stsutsui 
11504faabf0Stsutsui 	switch (where) {
11604faabf0Stsutsui 	case SEEK_SET:
11704faabf0Stsutsui 		p = __data.start + offset;
11804faabf0Stsutsui 		break;
11904faabf0Stsutsui 	case SEEK_CUR:
12004faabf0Stsutsui 		p = __data.ptr + offset;
12104faabf0Stsutsui 		break;
12204faabf0Stsutsui 	case SEEK_END:
12304faabf0Stsutsui 		p = __data.end + offset;
12404faabf0Stsutsui 		break;
12504faabf0Stsutsui 	default:
12604faabf0Stsutsui 		return EINVAL;
12704faabf0Stsutsui 	}
12804faabf0Stsutsui 
12904faabf0Stsutsui 	if (p < __data.start || p >= __data.end) {
13004faabf0Stsutsui 		return EINVAL;
13104faabf0Stsutsui 	}
13204faabf0Stsutsui 
13304faabf0Stsutsui 	__data.ptr = p;
13404faabf0Stsutsui 
13504faabf0Stsutsui 	return (off_t)(p - __data.start);
13604faabf0Stsutsui }
13704faabf0Stsutsui 
13804faabf0Stsutsui int
data_stat(struct open_file * f,struct stat * stat)13904faabf0Stsutsui data_stat(struct open_file *f, struct stat *stat)
14004faabf0Stsutsui {
14104faabf0Stsutsui 
14204faabf0Stsutsui 	stat->st_size = __data.size;
14304faabf0Stsutsui 
14404faabf0Stsutsui 	return 0;
14504faabf0Stsutsui }
146