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