xref: /netbsd-src/sys/arch/ews4800mips/stand/common/bootfs.c (revision 276d4f85dc8ab239bf90d57377b1804c2abef035)
1*276d4f85Schristos /*	$NetBSD: bootfs.c,v 1.5 2019/01/09 03:28:31 christos 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 
35*276d4f85Schristos #include <sys/param.h>
3604faabf0Stsutsui #include <machine/bfs.h>
3704faabf0Stsutsui #include <machine/sector.h>
3804faabf0Stsutsui 
3904faabf0Stsutsui #include "local.h"
4004faabf0Stsutsui 
4104faabf0Stsutsui /* System V bfs */
4204faabf0Stsutsui 
4304faabf0Stsutsui FS_DEF(bfs);
4404faabf0Stsutsui 
4504faabf0Stsutsui struct fs_ops bfs_ops = {
4604faabf0Stsutsui 	bfs_open, bfs_close, bfs_read, bfs_write, bfs_seek, bfs_stat
4704faabf0Stsutsui };
4804faabf0Stsutsui 
4904faabf0Stsutsui struct bfs_file {
5004faabf0Stsutsui 	struct bfs *bfs;
5104faabf0Stsutsui 	int start, end;
5204faabf0Stsutsui 	size_t size;
5304faabf0Stsutsui 	int cur;
5404faabf0Stsutsui 	uint8_t buf[DEV_BSIZE];
5504faabf0Stsutsui };
5604faabf0Stsutsui 
5704faabf0Stsutsui int
bfs_open(const char * name,struct open_file * f)5804faabf0Stsutsui bfs_open(const char *name, struct open_file *f)
5904faabf0Stsutsui {
6004faabf0Stsutsui 	struct bfs_file *file;
6104faabf0Stsutsui 
6204faabf0Stsutsui 	if ((file = alloc(sizeof *file)) == 0)
6304faabf0Stsutsui 		return -1;
6404faabf0Stsutsui 	memset(file, 0, sizeof *file);
6504faabf0Stsutsui 
6604faabf0Stsutsui 	if (bfs_init(&file->bfs) != 0) {
67606bb2caSchristos 		dealloc(file, sizeof *file);
6804faabf0Stsutsui 		return -2;
6904faabf0Stsutsui 	}
7004faabf0Stsutsui 
7104faabf0Stsutsui 	if (!bfs_file_lookup(file->bfs, name, &file->start, &file->end,
7204faabf0Stsutsui 	    &file->size)) {
7304faabf0Stsutsui 		bfs_fini(file->bfs);
74606bb2caSchristos 		dealloc(file, sizeof *file);
7504faabf0Stsutsui 		return -3;
7604faabf0Stsutsui 	}
7704faabf0Stsutsui 
789b2b412cSperry 	printf("%s: %s %d %d %d\n", __func__, name, file->start,
7904faabf0Stsutsui 	    file->end, file->size);
8004faabf0Stsutsui 
8104faabf0Stsutsui 	f->f_fsdata = file;
8204faabf0Stsutsui 
8304faabf0Stsutsui 	return 0;
8404faabf0Stsutsui }
8504faabf0Stsutsui 
8604faabf0Stsutsui int
bfs_close(struct open_file * f)8704faabf0Stsutsui bfs_close(struct open_file *f)
8804faabf0Stsutsui {
8904faabf0Stsutsui 	struct bfs_file *file = f->f_fsdata;
9004faabf0Stsutsui 
9104faabf0Stsutsui 	bfs_fini(file->bfs);
9204faabf0Stsutsui 
9304faabf0Stsutsui 	return 0;
9404faabf0Stsutsui }
9504faabf0Stsutsui 
9604faabf0Stsutsui int
bfs_read(struct open_file * f,void * buf,size_t size,size_t * resid)9704faabf0Stsutsui bfs_read(struct open_file *f, void *buf, size_t size, size_t *resid)
9804faabf0Stsutsui {
9904faabf0Stsutsui 	struct bfs_file *file = f->f_fsdata;
10004faabf0Stsutsui 	int n, start, end;
10104faabf0Stsutsui 	uint8_t *p = buf;
10204faabf0Stsutsui 	size_t bufsz = size;
10304faabf0Stsutsui 	int cur = file->cur;
10404faabf0Stsutsui 
10504faabf0Stsutsui 	if (cur + size > file->size)
10604faabf0Stsutsui 		size = file->size - cur;
10704faabf0Stsutsui 
10804faabf0Stsutsui 	start = file->start + (cur >> DEV_BSHIFT);
10904faabf0Stsutsui 	end = file->start + ((cur + size) >> DEV_BSHIFT);
11004faabf0Stsutsui 
11104faabf0Stsutsui 	/* first sector */
11204faabf0Stsutsui 	if (!sector_read(0, file->buf, start))
11304faabf0Stsutsui 		return -2;
11404faabf0Stsutsui 	n = TRUNC_SECTOR(cur) + DEV_BSIZE - cur;
11504faabf0Stsutsui 	if (n >= size) {
11604faabf0Stsutsui 		memcpy(p, file->buf + DEV_BSIZE - n, size);
11704faabf0Stsutsui 		goto done;
11804faabf0Stsutsui 	}
11904faabf0Stsutsui 	memcpy(p, file->buf + DEV_BSIZE - n, n);
12004faabf0Stsutsui 	p += n;
12104faabf0Stsutsui 
12204faabf0Stsutsui 	if ((end - start - 1) > 0) {
12304faabf0Stsutsui 		if (!sector_read_n(0, p, start + 1, end - start - 1))
12404faabf0Stsutsui 			return -2;
12504faabf0Stsutsui 		p += (end - start - 1) * DEV_BSIZE;
12604faabf0Stsutsui 	}
12704faabf0Stsutsui 
12804faabf0Stsutsui 	/* last sector */
12904faabf0Stsutsui 	if (!sector_read(0, file->buf, end))
13004faabf0Stsutsui 		return -2;
13104faabf0Stsutsui 	n = cur + size - TRUNC_SECTOR(cur + size);
13204faabf0Stsutsui 	memcpy(p, file->buf, n);
13304faabf0Stsutsui 
13404faabf0Stsutsui  done:
13504faabf0Stsutsui 	file->cur += size;
13604faabf0Stsutsui 
13704faabf0Stsutsui 	if (resid)
13804faabf0Stsutsui 		*resid = bufsz - size;
13904faabf0Stsutsui 
14004faabf0Stsutsui 	return 0;
14104faabf0Stsutsui }
14204faabf0Stsutsui 
14304faabf0Stsutsui int
bfs_write(struct open_file * f,void * start,size_t size,size_t * resid)14404faabf0Stsutsui bfs_write(struct open_file *f, void *start, size_t size, size_t *resid)
14504faabf0Stsutsui {
14604faabf0Stsutsui 
14704faabf0Stsutsui 	return -1;
14804faabf0Stsutsui }
14904faabf0Stsutsui 
15004faabf0Stsutsui off_t
bfs_seek(struct open_file * f,off_t offset,int where)15104faabf0Stsutsui bfs_seek(struct open_file *f, off_t offset, int where)
15204faabf0Stsutsui {
15304faabf0Stsutsui 	struct bfs_file *file = f->f_fsdata;
15404faabf0Stsutsui 	int cur;
15504faabf0Stsutsui 
15604faabf0Stsutsui 	switch (where) {
15704faabf0Stsutsui 	case SEEK_SET:
15804faabf0Stsutsui 		cur = offset;
15904faabf0Stsutsui 		break;
16004faabf0Stsutsui 	case SEEK_CUR:
16104faabf0Stsutsui 		cur = file->cur + offset;
16204faabf0Stsutsui 		break;
16304faabf0Stsutsui 	case SEEK_END:
16404faabf0Stsutsui 		cur = file->size + offset;
16504faabf0Stsutsui 		break;
16604faabf0Stsutsui 	default:
16704faabf0Stsutsui 		return EINVAL;
16804faabf0Stsutsui 	}
16904faabf0Stsutsui 
17004faabf0Stsutsui 	if (cur  < 0 || cur >= file->size) {
17104faabf0Stsutsui 		return EINVAL;
17204faabf0Stsutsui 	}
17304faabf0Stsutsui 
17404faabf0Stsutsui 	file->cur = cur;
17504faabf0Stsutsui 
17604faabf0Stsutsui 	return (off_t)cur;
17704faabf0Stsutsui }
17804faabf0Stsutsui 
17904faabf0Stsutsui int
bfs_stat(struct open_file * f,struct stat * stat)18004faabf0Stsutsui bfs_stat(struct open_file *f, struct stat *stat)
18104faabf0Stsutsui {
18204faabf0Stsutsui 	struct bfs_file *file = f->f_fsdata;
18304faabf0Stsutsui 
18404faabf0Stsutsui 	stat->st_size = file->size;
18504faabf0Stsutsui 
18604faabf0Stsutsui 	return 0;
18704faabf0Stsutsui }
188