xref: /freebsd/stand/libsa/dosfs.c (revision 3e15b01d)
1ca987d46SWarner Losh /*
2ca987d46SWarner Losh  * Copyright (c) 1996, 1998 Robert Nordier
3ca987d46SWarner Losh  * All rights reserved.
4ca987d46SWarner Losh  *
5ca987d46SWarner Losh  * Redistribution and use in source and binary forms, with or without
6ca987d46SWarner Losh  * modification, are permitted provided that the following conditions
7ca987d46SWarner Losh  * are met:
8ca987d46SWarner Losh  * 1. Redistributions of source code must retain the above copyright
9ca987d46SWarner Losh  *    notice, this list of conditions and the following disclaimer.
10ca987d46SWarner Losh  * 2. Redistributions in binary form must reproduce the above copyright
11ca987d46SWarner Losh  *    notice, this list of conditions and the following disclaimer in
12ca987d46SWarner Losh  *    the documentation and/or other materials provided with the
13ca987d46SWarner Losh  *    distribution.
14ca987d46SWarner Losh  *
15ca987d46SWarner Losh  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR(S) ``AS IS'' AND ANY EXPRESS
16ca987d46SWarner Losh  * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17ca987d46SWarner Losh  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18ca987d46SWarner Losh  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR(S) BE LIABLE FOR ANY
19ca987d46SWarner Losh  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20ca987d46SWarner Losh  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
21ca987d46SWarner Losh  * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
22ca987d46SWarner Losh  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
23ca987d46SWarner Losh  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
24ca987d46SWarner Losh  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
25ca987d46SWarner Losh  * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26ca987d46SWarner Losh  */
27ca987d46SWarner Losh 
28ca987d46SWarner Losh /*
29ca987d46SWarner Losh  * Readonly filesystem for Microsoft FAT12/FAT16/FAT32 filesystems,
30ca987d46SWarner Losh  * also supports VFAT.
31ca987d46SWarner Losh  */
32ca987d46SWarner Losh 
33ca987d46SWarner Losh #include <sys/types.h>
34ca987d46SWarner Losh #include <string.h>
35ca987d46SWarner Losh #include <stddef.h>
36ca987d46SWarner Losh 
37ca987d46SWarner Losh #include "stand.h"
38ca987d46SWarner Losh 
39ca987d46SWarner Losh #include "dosfs.h"
40ca987d46SWarner Losh 
41b4cb3fe0SToomas Soome typedef struct dos_mnt {
42b4cb3fe0SToomas Soome 	char			*dos_dev;
43b4cb3fe0SToomas Soome 	DOS_FS			*dos_fs;
44b4cb3fe0SToomas Soome 	int			dos_fd;
45b4cb3fe0SToomas Soome 	STAILQ_ENTRY(dos_mnt)	dos_link;
46b4cb3fe0SToomas Soome } dos_mnt_t;
47b4cb3fe0SToomas Soome 
48b4cb3fe0SToomas Soome typedef STAILQ_HEAD(dos_mnt_list, dos_mnt) dos_mnt_list_t;
49b4cb3fe0SToomas Soome static dos_mnt_list_t mnt_list = STAILQ_HEAD_INITIALIZER(mnt_list);
50ca987d46SWarner Losh 
51ca987d46SWarner Losh static int	dos_open(const char *path, struct open_file *fd);
52ca987d46SWarner Losh static int	dos_close(struct open_file *fd);
53ca987d46SWarner Losh static int	dos_read(struct open_file *fd, void *buf, size_t size, size_t *resid);
54ca987d46SWarner Losh static off_t	dos_seek(struct open_file *fd, off_t offset, int whence);
55ca987d46SWarner Losh static int	dos_stat(struct open_file *fd, struct stat *sb);
56ca987d46SWarner Losh static int	dos_readdir(struct open_file *fd, struct dirent *d);
57b4cb3fe0SToomas Soome static int	dos_mount(const char *dev, const char *path, void **data);
58b4cb3fe0SToomas Soome static int	dos_unmount(const char *dev, void *data);
59ca987d46SWarner Losh 
60ca987d46SWarner Losh struct fs_ops dosfs_fsops = {
61b4cb3fe0SToomas Soome 	.fs_name = "dosfs",
62b4cb3fe0SToomas Soome 	.fo_open = dos_open,
63b4cb3fe0SToomas Soome 	.fo_close = dos_close,
64b4cb3fe0SToomas Soome 	.fo_read = dos_read,
65b4cb3fe0SToomas Soome 	.fo_write = null_write,
66b4cb3fe0SToomas Soome 	.fo_seek = dos_seek,
67b4cb3fe0SToomas Soome 	.fo_stat = dos_stat,
68b4cb3fe0SToomas Soome 	.fo_readdir = dos_readdir,
69b4cb3fe0SToomas Soome 	.fo_mount = dos_mount,
70b4cb3fe0SToomas Soome 	.fo_unmount = dos_unmount
71ca987d46SWarner Losh };
72ca987d46SWarner Losh 
73ca987d46SWarner Losh #define SECSIZ  512             /* sector size */
74ca987d46SWarner Losh #define SSHIFT    9             /* SECSIZ shift */
75ca987d46SWarner Losh #define DEPSEC   16             /* directory entries per sector */
76ca987d46SWarner Losh #define DSHIFT    4             /* DEPSEC shift */
77ca987d46SWarner Losh #define LOCLUS    2             /* lowest cluster number */
78ca987d46SWarner Losh #define FATBLKSZ  0x20000       /* size of block in the FAT cache buffer */
79ca987d46SWarner Losh 
80ca987d46SWarner Losh /* DOS "BIOS Parameter Block" */
81ca987d46SWarner Losh typedef struct {
82ca987d46SWarner Losh 	u_char secsiz[2];           /* sector size */
83ca987d46SWarner Losh 	u_char spc;                 /* sectors per cluster */
84ca987d46SWarner Losh 	u_char ressec[2];           /* reserved sectors */
85ca987d46SWarner Losh 	u_char fats;                /* FATs */
86ca987d46SWarner Losh 	u_char dirents[2];          /* root directory entries */
87ca987d46SWarner Losh 	u_char secs[2];             /* total sectors */
88ca987d46SWarner Losh 	u_char media;               /* media descriptor */
89ca987d46SWarner Losh 	u_char spf[2];              /* sectors per FAT */
90ca987d46SWarner Losh 	u_char spt[2];              /* sectors per track */
91ca987d46SWarner Losh 	u_char heads[2];            /* drive heads */
92ca987d46SWarner Losh 	u_char hidsec[4];           /* hidden sectors */
93ca987d46SWarner Losh 	u_char lsecs[4];            /* huge sectors */
94ca987d46SWarner Losh 	u_char lspf[4];             /* huge sectors per FAT */
95ca987d46SWarner Losh 	u_char xflg[2];             /* flags */
96ca987d46SWarner Losh 	u_char vers[2];             /* filesystem version */
97ca987d46SWarner Losh 	u_char rdcl[4];             /* root directory start cluster */
98ca987d46SWarner Losh 	u_char infs[2];             /* filesystem info sector */
99ca987d46SWarner Losh 	u_char bkbs[2];             /* backup boot sector */
100ca987d46SWarner Losh } DOS_BPB;
101ca987d46SWarner Losh 
102ca987d46SWarner Losh /* Initial portion of DOS boot sector */
103ca987d46SWarner Losh typedef struct {
104ca987d46SWarner Losh 	u_char jmp[3];              /* usually 80x86 'jmp' opcode */
105ca987d46SWarner Losh 	u_char oem[8];              /* OEM name and version */
106ca987d46SWarner Losh 	DOS_BPB bpb;                /* BPB */
107ca987d46SWarner Losh } DOS_BS;
108ca987d46SWarner Losh 
109ca987d46SWarner Losh /* Supply missing "." and ".." root directory entries */
110ca987d46SWarner Losh static const char *const dotstr[2] = {".", ".."};
111ca987d46SWarner Losh static DOS_DE dot[2] = {
112ca987d46SWarner Losh 	{".       ", "   ", FA_DIR, {0, 0, {0, 0}, {0, 0}, {0, 0}, {0, 0}},
113ca987d46SWarner Losh 	    {0, 0}, {0x21, 0}, {0, 0}, {0, 0, 0, 0}},
114ca987d46SWarner Losh 	{"..      ", "   ", FA_DIR, {0, 0, {0, 0}, {0, 0}, {0, 0}, {0, 0}},
115ca987d46SWarner Losh 	    {0, 0}, {0x21, 0}, {0, 0}, {0, 0, 0, 0}}
116ca987d46SWarner Losh };
117ca987d46SWarner Losh 
118ca987d46SWarner Losh /* The usual conversion macros to avoid multiplication and division */
119ca987d46SWarner Losh #define bytsec(n)      ((n) >> SSHIFT)
120ca987d46SWarner Losh #define secbyt(s)      ((s) << SSHIFT)
121ca987d46SWarner Losh #define entsec(e)      ((e) >> DSHIFT)
122ca987d46SWarner Losh #define bytblk(fs, n)  ((n) >> (fs)->bshift)
123ca987d46SWarner Losh #define blkbyt(fs, b)  ((b) << (fs)->bshift)
124ca987d46SWarner Losh #define secblk(fs, s)  ((s) >> ((fs)->bshift - SSHIFT))
125ca987d46SWarner Losh #define blksec(fs, b)  ((b) << ((fs)->bshift - SSHIFT))
126ca987d46SWarner Losh 
127ca987d46SWarner Losh /* Convert cluster number to offset within filesystem */
128ca987d46SWarner Losh #define blkoff(fs, b) (secbyt((fs)->lsndta) + blkbyt(fs, (b) - LOCLUS))
129ca987d46SWarner Losh 
130ca987d46SWarner Losh /* Convert cluster number to logical sector number */
131ca987d46SWarner Losh #define blklsn(fs, b)  ((fs)->lsndta + blksec(fs, (b) - LOCLUS))
132ca987d46SWarner Losh 
133ca987d46SWarner Losh /* Convert cluster number to offset within FAT */
134ca987d46SWarner Losh #define fatoff(sz, c)  ((sz) == 12 ? (c) + ((c) >> 1) :  \
135ca987d46SWarner Losh                         (sz) == 16 ? (c) << 1 :          \
136ca987d46SWarner Losh 			(c) << 2)
137ca987d46SWarner Losh 
138ca987d46SWarner Losh /* Does cluster number reference a valid data cluster? */
139ca987d46SWarner Losh #define okclus(fs, c)  ((c) >= LOCLUS && (c) <= (fs)->xclus)
140ca987d46SWarner Losh 
141ca987d46SWarner Losh /* Get start cluster from directory entry */
142ca987d46SWarner Losh #define stclus(sz, de)  ((sz) != 32 ? cv2((de)->clus) :          \
143ca987d46SWarner Losh                          ((u_int)cv2((de)->dex.h_clus) << 16) |  \
144ca987d46SWarner Losh 			 cv2((de)->clus))
145ca987d46SWarner Losh 
146ca987d46SWarner Losh static int parsebs(DOS_FS *, DOS_BS *);
147ca987d46SWarner Losh static int namede(DOS_FS *, const char *, DOS_DE **);
148ca987d46SWarner Losh static int lookup(DOS_FS *, u_int, const char *, DOS_DE **);
149ca987d46SWarner Losh static void cp_xdnm(u_char *, DOS_XDE *);
150ca987d46SWarner Losh static void cp_sfn(u_char *, DOS_DE *);
151ca987d46SWarner Losh static off_t fsize(DOS_FS *, DOS_DE *);
152ca987d46SWarner Losh static int fatcnt(DOS_FS *, u_int);
153ca987d46SWarner Losh static int fatget(DOS_FS *, u_int *);
154ca987d46SWarner Losh static int fatend(u_int, u_int);
155ca987d46SWarner Losh static int ioread(DOS_FS *, u_int, void *, size_t);
156ca987d46SWarner Losh static int ioget(struct open_file *, daddr_t, void *, size_t);
157ca987d46SWarner Losh 
158ca987d46SWarner Losh static int
dos_read_fatblk(DOS_FS * fs,struct open_file * fd,u_int blknum)159ca987d46SWarner Losh dos_read_fatblk(DOS_FS *fs, struct open_file *fd, u_int blknum)
160ca987d46SWarner Losh {
161ca987d46SWarner Losh 	int err;
162ca987d46SWarner Losh 	size_t io_size;
163ca987d46SWarner Losh 	daddr_t offset_in_fat, max_offset_in_fat;
164ca987d46SWarner Losh 
165ca987d46SWarner Losh 	offset_in_fat = ((daddr_t)blknum) * FATBLKSZ;
166ca987d46SWarner Losh 	max_offset_in_fat = secbyt(fs->spf);
167ca987d46SWarner Losh 	io_size = FATBLKSZ;
168ca987d46SWarner Losh 	if (offset_in_fat > max_offset_in_fat)
169ca987d46SWarner Losh 		offset_in_fat = max_offset_in_fat;
170ca987d46SWarner Losh 	if (offset_in_fat + io_size > max_offset_in_fat)
171ca987d46SWarner Losh 		io_size = ((size_t)(max_offset_in_fat - offset_in_fat));
172ca987d46SWarner Losh 
173ca987d46SWarner Losh 	if (io_size != 0) {
174ca987d46SWarner Losh 		err = ioget(fd, fs->lsnfat + bytsec(offset_in_fat),
175ca987d46SWarner Losh 		    fs->fatbuf, io_size);
176ca987d46SWarner Losh 		if (err != 0) {
177ca987d46SWarner Losh 			fs->fatbuf_blknum = ((u_int)(-1));
178ca987d46SWarner Losh 			return (err);
179ca987d46SWarner Losh 		}
180ca987d46SWarner Losh 	}
181ca987d46SWarner Losh 	if (io_size < FATBLKSZ)
182ca987d46SWarner Losh 		memset(fs->fatbuf + io_size, 0, FATBLKSZ - io_size);
183ca987d46SWarner Losh 
184ca987d46SWarner Losh 	fs->fatbuf_blknum = blknum;
185ca987d46SWarner Losh 	return (0);
186ca987d46SWarner Losh }
187ca987d46SWarner Losh 
188ca987d46SWarner Losh /*
189ca987d46SWarner Losh  * Mount DOS filesystem
190ca987d46SWarner Losh  */
191ca987d46SWarner Losh static int
dos_mount_impl(DOS_FS * fs,struct open_file * fd)192b4cb3fe0SToomas Soome dos_mount_impl(DOS_FS *fs, struct open_file *fd)
193ca987d46SWarner Losh {
194ca987d46SWarner Losh 	int err;
195ca987d46SWarner Losh 	u_char *buf;
196ca987d46SWarner Losh 
197ca987d46SWarner Losh 	fs->fd = fd;
198ca987d46SWarner Losh 
199ca987d46SWarner Losh 	if ((buf = malloc(secbyt(1))) == NULL)
200ca987d46SWarner Losh 		return (errno);
201ca987d46SWarner Losh 	if ((err = ioget(fs->fd, 0, buf, secbyt(1))) ||
202ca987d46SWarner Losh 	    (err = parsebs(fs, (DOS_BS *)buf))) {
203ca987d46SWarner Losh 		free(buf);
204ca987d46SWarner Losh 		return (err);
205ca987d46SWarner Losh 	}
206ca987d46SWarner Losh 	free(buf);
207ca987d46SWarner Losh 
208ca987d46SWarner Losh 	if ((fs->fatbuf = malloc(FATBLKSZ)) == NULL)
209ca987d46SWarner Losh 		return (errno);
210ca987d46SWarner Losh 	err = dos_read_fatblk(fs, fd, 0);
211ca987d46SWarner Losh 	if (err != 0) {
212ca987d46SWarner Losh 		free(fs->fatbuf);
213ca987d46SWarner Losh 		return (err);
214ca987d46SWarner Losh 	}
215ca987d46SWarner Losh 
216ca987d46SWarner Losh 	fs->root = dot[0];
217ca987d46SWarner Losh 	fs->root.name[0] = ' ';
218ca987d46SWarner Losh 	if (fs->fatsz == 32) {
219ca987d46SWarner Losh 		fs->root.clus[0] = fs->rdcl & 0xff;
220ca987d46SWarner Losh 		fs->root.clus[1] = (fs->rdcl >> 8) & 0xff;
221ca987d46SWarner Losh 		fs->root.dex.h_clus[0] = (fs->rdcl >> 16) & 0xff;
222ca987d46SWarner Losh 		fs->root.dex.h_clus[1] = (fs->rdcl >> 24) & 0xff;
223ca987d46SWarner Losh 	}
224ca987d46SWarner Losh 	return (0);
225ca987d46SWarner Losh }
226ca987d46SWarner Losh 
227b4cb3fe0SToomas Soome static int
dos_mount(const char * dev,const char * path,void ** data)228b4cb3fe0SToomas Soome dos_mount(const char *dev, const char *path, void **data)
229b4cb3fe0SToomas Soome {
230b4cb3fe0SToomas Soome 	char *fs;
231b4cb3fe0SToomas Soome 	dos_mnt_t *mnt;
232b4cb3fe0SToomas Soome 	struct open_file *f;
233b4cb3fe0SToomas Soome 	DOS_FILE *df;
234b4cb3fe0SToomas Soome 
235b4cb3fe0SToomas Soome 	errno = 0;
236b4cb3fe0SToomas Soome 	mnt = calloc(1, sizeof(*mnt));
237b4cb3fe0SToomas Soome 	if (mnt == NULL)
238b4cb3fe0SToomas Soome 		return (errno);
239b4cb3fe0SToomas Soome 	mnt->dos_fd = -1;
240b4cb3fe0SToomas Soome 	mnt->dos_dev = strdup(dev);
241b4cb3fe0SToomas Soome 	if (mnt->dos_dev == NULL)
242b4cb3fe0SToomas Soome 		goto done;
243b4cb3fe0SToomas Soome 
244b4cb3fe0SToomas Soome 	if (asprintf(&fs, "%s%s", dev, path) < 0)
245b4cb3fe0SToomas Soome 		goto done;
246b4cb3fe0SToomas Soome 
247b4cb3fe0SToomas Soome 	mnt->dos_fd = open(fs, O_RDONLY);
248b4cb3fe0SToomas Soome 	free(fs);
249b4cb3fe0SToomas Soome 	if (mnt->dos_fd == -1)
250b4cb3fe0SToomas Soome 		goto done;
251b4cb3fe0SToomas Soome 
252b4cb3fe0SToomas Soome 	f = fd2open_file(mnt->dos_fd);
253b4cb3fe0SToomas Soome 	if (strcmp(f->f_ops->fs_name, "dosfs") == 0) {
254b4cb3fe0SToomas Soome 		df = f->f_fsdata;
255b4cb3fe0SToomas Soome 		mnt->dos_fs = df->fs;
256b4cb3fe0SToomas Soome 		STAILQ_INSERT_TAIL(&mnt_list, mnt, dos_link);
257b4cb3fe0SToomas Soome 	} else {
258b4cb3fe0SToomas Soome                 errno = ENXIO;
259b4cb3fe0SToomas Soome 	}
260b4cb3fe0SToomas Soome 
261b4cb3fe0SToomas Soome done:
262b4cb3fe0SToomas Soome 	if (errno != 0) {
263b4cb3fe0SToomas Soome 		free(mnt->dos_dev);
264b4cb3fe0SToomas Soome 		if (mnt->dos_fd >= 0)
265b4cb3fe0SToomas Soome 			close(mnt->dos_fd);
266b4cb3fe0SToomas Soome 		free(mnt);
267b4cb3fe0SToomas Soome 	} else {
268b4cb3fe0SToomas Soome 		*data = mnt;
269b4cb3fe0SToomas Soome 	}
270b4cb3fe0SToomas Soome 
271b4cb3fe0SToomas Soome 	return (errno);
272b4cb3fe0SToomas Soome }
273b4cb3fe0SToomas Soome 
274b4cb3fe0SToomas Soome static int
dos_unmount(const char * dev __unused,void * data)275b4cb3fe0SToomas Soome dos_unmount(const char *dev __unused, void *data)
276b4cb3fe0SToomas Soome {
277b4cb3fe0SToomas Soome 	dos_mnt_t *mnt = data;
278b4cb3fe0SToomas Soome 
279b4cb3fe0SToomas Soome 	STAILQ_REMOVE(&mnt_list, mnt, dos_mnt, dos_link);
280b4cb3fe0SToomas Soome 	free(mnt->dos_dev);
281b4cb3fe0SToomas Soome 	close(mnt->dos_fd);
282b4cb3fe0SToomas Soome 	free(mnt);
283b4cb3fe0SToomas Soome 	return (0);
284b4cb3fe0SToomas Soome }
285b4cb3fe0SToomas Soome 
286ca987d46SWarner Losh /*
287ca987d46SWarner Losh  * Unmount mounted filesystem
288ca987d46SWarner Losh  */
289ca987d46SWarner Losh static int
dos_unmount_impl(DOS_FS * fs)290b4cb3fe0SToomas Soome dos_unmount_impl(DOS_FS *fs)
291ca987d46SWarner Losh {
292ca987d46SWarner Losh 	if (fs->links)
293ca987d46SWarner Losh 		return (EBUSY);
294ca987d46SWarner Losh 	free(fs->fatbuf);
295ca987d46SWarner Losh 	free(fs);
296ca987d46SWarner Losh 	return (0);
297ca987d46SWarner Losh }
298ca987d46SWarner Losh 
299ca987d46SWarner Losh /*
300ca987d46SWarner Losh  * Open DOS file
301ca987d46SWarner Losh  */
302ca987d46SWarner Losh static int
dos_open(const char * path,struct open_file * fd)303ca987d46SWarner Losh dos_open(const char *path, struct open_file *fd)
304ca987d46SWarner Losh {
305ca987d46SWarner Losh 	DOS_DE *de;
306ca987d46SWarner Losh 	DOS_FILE *f;
307ca987d46SWarner Losh 	DOS_FS *fs;
308b4cb3fe0SToomas Soome 	dos_mnt_t *mnt;
309b4cb3fe0SToomas Soome 	const char *dev;
310ca987d46SWarner Losh 	u_int size, clus;
311ca987d46SWarner Losh 	int err;
312ca987d46SWarner Losh 
313ec9f3e77SWarner Losh 	dev = devformat((struct devdesc *)fd->f_devdata);
314b4cb3fe0SToomas Soome 	STAILQ_FOREACH(mnt, &mnt_list, dos_link) {
315b4cb3fe0SToomas Soome 		if (strcmp(dev, mnt->dos_dev) == 0)
316b4cb3fe0SToomas Soome 			break;
317b4cb3fe0SToomas Soome 	}
318b4cb3fe0SToomas Soome 
319b4cb3fe0SToomas Soome 	if (mnt == NULL) {
320ca987d46SWarner Losh 		/* Allocate mount structure, associate with open */
3210eb736c0SMichael Gmelin 		if ((fs = calloc(1, sizeof(DOS_FS))) == NULL)
322ca987d46SWarner Losh 			return (errno);
323b4cb3fe0SToomas Soome 		if ((err = dos_mount_impl(fs, fd))) {
324ca987d46SWarner Losh 			free(fs);
325ca987d46SWarner Losh 			return (err);
326ca987d46SWarner Losh 		}
327b4cb3fe0SToomas Soome 	} else {
328b4cb3fe0SToomas Soome 		fs = mnt->dos_fs;
329b4cb3fe0SToomas Soome 	}
330ca987d46SWarner Losh 
331ca987d46SWarner Losh 	if ((err = namede(fs, path, &de))) {
332b4cb3fe0SToomas Soome 		if (mnt == NULL)
333b4cb3fe0SToomas Soome 			dos_unmount_impl(fs);
334ca987d46SWarner Losh 		return (err);
335ca987d46SWarner Losh 	}
336ca987d46SWarner Losh 
337ca987d46SWarner Losh 	clus = stclus(fs->fatsz, de);
338ca987d46SWarner Losh 	size = cv4(de->size);
339ca987d46SWarner Losh 
340ca987d46SWarner Losh 	if ((!(de->attr & FA_DIR) && (!clus != !size)) ||
341ca987d46SWarner Losh 	    ((de->attr & FA_DIR) && size) ||
342ca987d46SWarner Losh 	    (clus && !okclus(fs, clus))) {
343b4cb3fe0SToomas Soome 		if (mnt == NULL)
344b4cb3fe0SToomas Soome 			dos_unmount_impl(fs);
345ca987d46SWarner Losh 		return (EINVAL);
346ca987d46SWarner Losh 	}
347b4cb3fe0SToomas Soome 	if ((f = calloc(1, sizeof(DOS_FILE))) == NULL) {
348ca987d46SWarner Losh 		err = errno;
349b4cb3fe0SToomas Soome 		if (mnt == NULL)
350b4cb3fe0SToomas Soome 			dos_unmount_impl(fs);
351ca987d46SWarner Losh 		return (err);
352ca987d46SWarner Losh 	}
353ca987d46SWarner Losh 	f->fs = fs;
354ca987d46SWarner Losh 	fs->links++;
355ca987d46SWarner Losh 	f->de = *de;
356b4cb3fe0SToomas Soome 	fd->f_fsdata = f;
357ca987d46SWarner Losh 	return (0);
358ca987d46SWarner Losh }
359ca987d46SWarner Losh 
360ca987d46SWarner Losh /*
361ca987d46SWarner Losh  * Read from file
362ca987d46SWarner Losh  */
363ca987d46SWarner Losh static int
dos_read(struct open_file * fd,void * buf,size_t nbyte,size_t * resid)364ca987d46SWarner Losh dos_read(struct open_file *fd, void *buf, size_t nbyte, size_t *resid)
365ca987d46SWarner Losh {
366ca987d46SWarner Losh 	off_t size;
367ca987d46SWarner Losh 	u_int nb, off, clus, c, cnt, n;
368ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
369ca987d46SWarner Losh 	int err = 0;
370ca987d46SWarner Losh 
371ca987d46SWarner Losh 	/*
372ca987d46SWarner Losh 	 * as ioget() can be called *a lot*, use twiddle here.
373ca987d46SWarner Losh 	 * also 4 seems to be good value not to slow loading down too much:
3743ec0714dSToomas Soome 	 * with 270MB file (~540k ioget() calls, twiddle can easily waste
3753ec0714dSToomas Soome 	 * 4-5 sec.
376ca987d46SWarner Losh 	 */
377ca987d46SWarner Losh 	twiddle(4);
378ca987d46SWarner Losh 	nb = (u_int)nbyte;
379ca987d46SWarner Losh 	if ((size = fsize(f->fs, &f->de)) == -1)
380ca987d46SWarner Losh 		return (EINVAL);
381ca987d46SWarner Losh 	if (nb > (n = size - f->offset))
382ca987d46SWarner Losh 		nb = n;
383ca987d46SWarner Losh 	off = f->offset;
384ca987d46SWarner Losh 	if ((clus = stclus(f->fs->fatsz, &f->de)))
385ca987d46SWarner Losh 		off &= f->fs->bsize - 1;
386ca987d46SWarner Losh 	c = f->c;
387ca987d46SWarner Losh 	cnt = nb;
388ca987d46SWarner Losh 	while (cnt) {
389ca987d46SWarner Losh 		n = 0;
390ca987d46SWarner Losh 		if (!c) {
391ca987d46SWarner Losh 			if ((c = clus))
392ca987d46SWarner Losh 				n = bytblk(f->fs, f->offset);
393ca987d46SWarner Losh 		} else if (!off)
394ca987d46SWarner Losh 			n++;
395ca987d46SWarner Losh 		while (n--) {
396ca987d46SWarner Losh 			if ((err = fatget(f->fs, &c)))
397ca987d46SWarner Losh 				goto out;
398ca987d46SWarner Losh 			if (!okclus(f->fs, c)) {
399ca987d46SWarner Losh 				err = EINVAL;
400ca987d46SWarner Losh 				goto out;
401ca987d46SWarner Losh 			}
402ca987d46SWarner Losh 		}
403ca987d46SWarner Losh 		if (!clus || (n = f->fs->bsize - off) > cnt)
404ca987d46SWarner Losh 			n = cnt;
405ca987d46SWarner Losh 		if ((err = ioread(f->fs, (c ? blkoff(f->fs, c) :
406ca987d46SWarner Losh 		    secbyt(f->fs->lsndir)) + off, buf, n)))
407ca987d46SWarner Losh 			goto out;
408ca987d46SWarner Losh 		f->offset += n;
409ca987d46SWarner Losh 		f->c = c;
410ca987d46SWarner Losh 		off = 0;
411ca987d46SWarner Losh 		buf = (char *)buf + n;
412ca987d46SWarner Losh 		cnt -= n;
413ca987d46SWarner Losh 	}
414ca987d46SWarner Losh out:
415ca987d46SWarner Losh 	if (resid)
416ca987d46SWarner Losh 		*resid = nbyte - nb + cnt;
417ca987d46SWarner Losh 	return (err);
418ca987d46SWarner Losh }
419ca987d46SWarner Losh 
420ca987d46SWarner Losh /*
421ca987d46SWarner Losh  * Reposition within file
422ca987d46SWarner Losh  */
423ca987d46SWarner Losh static off_t
dos_seek(struct open_file * fd,off_t offset,int whence)424ca987d46SWarner Losh dos_seek(struct open_file *fd, off_t offset, int whence)
425ca987d46SWarner Losh {
426ca987d46SWarner Losh 	off_t off;
427ca987d46SWarner Losh 	u_int size;
428ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
429ca987d46SWarner Losh 
430ca987d46SWarner Losh 	size = cv4(f->de.size);
431ca987d46SWarner Losh 	switch (whence) {
432ca987d46SWarner Losh 	case SEEK_SET:
433ca987d46SWarner Losh 		off = 0;
434ca987d46SWarner Losh 		break;
435ca987d46SWarner Losh 	case SEEK_CUR:
436ca987d46SWarner Losh 		off = f->offset;
437ca987d46SWarner Losh 		break;
438ca987d46SWarner Losh 	case SEEK_END:
439ca987d46SWarner Losh 		off = size;
440ca987d46SWarner Losh 		break;
441ca987d46SWarner Losh 	default:
442ca987d46SWarner Losh 		errno = EINVAL;
443ca987d46SWarner Losh 		return (-1);
444ca987d46SWarner Losh 	}
445ca987d46SWarner Losh 	off += offset;
446ca987d46SWarner Losh 	if (off < 0 || off > size) {
447ca987d46SWarner Losh 		errno = EINVAL;
448ca987d46SWarner Losh 		return (-1);
449ca987d46SWarner Losh 	}
450ca987d46SWarner Losh 	f->offset = (u_int)off;
451ca987d46SWarner Losh 	f->c = 0;
452ca987d46SWarner Losh 	return (off);
453ca987d46SWarner Losh }
454ca987d46SWarner Losh 
455ca987d46SWarner Losh /*
456ca987d46SWarner Losh  * Close open file
457ca987d46SWarner Losh  */
458ca987d46SWarner Losh static int
dos_close(struct open_file * fd)459ca987d46SWarner Losh dos_close(struct open_file *fd)
460ca987d46SWarner Losh {
461ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
462ca987d46SWarner Losh 	DOS_FS *fs = f->fs;
463ca987d46SWarner Losh 
464ca987d46SWarner Losh 	f->fs->links--;
465ca987d46SWarner Losh 	free(f);
466b4cb3fe0SToomas Soome 	dos_unmount_impl(fs);
467ca987d46SWarner Losh 	return (0);
468ca987d46SWarner Losh }
469ca987d46SWarner Losh 
470ca987d46SWarner Losh /*
471ca987d46SWarner Losh  * Return some stat information on a file.
472ca987d46SWarner Losh  */
473ca987d46SWarner Losh static int
dos_stat(struct open_file * fd,struct stat * sb)474ca987d46SWarner Losh dos_stat(struct open_file *fd, struct stat *sb)
475ca987d46SWarner Losh {
476ca987d46SWarner Losh 	DOS_FILE *f = (DOS_FILE *)fd->f_fsdata;
477ca987d46SWarner Losh 
478ca987d46SWarner Losh 	/* only important stuff */
479ca987d46SWarner Losh 	sb->st_mode = f->de.attr & FA_DIR ? S_IFDIR | 0555 : S_IFREG | 0444;
480ca987d46SWarner Losh 	sb->st_nlink = 1;
481ca987d46SWarner Losh 	sb->st_uid = 0;
482ca987d46SWarner Losh 	sb->st_gid = 0;
483ca987d46SWarner Losh 	if ((sb->st_size = fsize(f->fs, &f->de)) == -1)
484ca987d46SWarner Losh 		return (EINVAL);
485ca987d46SWarner Losh 	return (0);
486ca987d46SWarner Losh }
487ca987d46SWarner Losh 
488ca987d46SWarner Losh static int
dos_checksum(unsigned char * name,unsigned char * ext)489513f7db5SToomas Soome dos_checksum(unsigned char *name, unsigned char *ext)
490ca987d46SWarner Losh {
491ca987d46SWarner Losh 	int x, i;
492ca987d46SWarner Losh 	char buf[11];
493ca987d46SWarner Losh 
494ca987d46SWarner Losh 	bcopy(name, buf, 8);
495ca987d46SWarner Losh 	bcopy(ext, buf+8, 3);
496ca987d46SWarner Losh 	x = 0;
497ca987d46SWarner Losh 	for (i = 0; i < 11; i++) {
498ca987d46SWarner Losh 		x = ((x & 1) << 7) | (x >> 1);
499ca987d46SWarner Losh 		x += buf[i];
500ca987d46SWarner Losh 		x &= 0xff;
501ca987d46SWarner Losh 	}
502ca987d46SWarner Losh 	return (x);
503ca987d46SWarner Losh }
504ca987d46SWarner Losh 
505ca987d46SWarner Losh static int
dos_readdir(struct open_file * fd,struct dirent * d)506ca987d46SWarner Losh dos_readdir(struct open_file *fd, struct dirent *d)
507ca987d46SWarner Losh {
508ca987d46SWarner Losh 	/* DOS_FILE *f = (DOS_FILE *)fd->f_fsdata; */
509ca987d46SWarner Losh 	u_char fn[261];
510ca987d46SWarner Losh 	DOS_DIR dd;
511ca987d46SWarner Losh 	size_t res;
512ca987d46SWarner Losh 	u_int chk, x, xdn;
513ca987d46SWarner Losh 	int err;
514ca987d46SWarner Losh 
515ca987d46SWarner Losh 	x = chk = 0;
5163ec0714dSToomas Soome 	for (;;) {
517ca987d46SWarner Losh 		xdn = x;
518ca987d46SWarner Losh 		x = 0;
519ca987d46SWarner Losh 		err = dos_read(fd, &dd, sizeof(dd), &res);
520ca987d46SWarner Losh 		if (err)
521ca987d46SWarner Losh 			return (err);
522ca987d46SWarner Losh 		if (res == sizeof(dd))
523ca987d46SWarner Losh 			return (ENOENT);
524ca987d46SWarner Losh 		if (dd.de.name[0] == 0)
525ca987d46SWarner Losh 			return (ENOENT);
526ca987d46SWarner Losh 
527ca987d46SWarner Losh 		/* Skip deleted entries */
528ca987d46SWarner Losh 		if (dd.de.name[0] == 0xe5)
529ca987d46SWarner Losh 			continue;
530ca987d46SWarner Losh 
531ca987d46SWarner Losh 		/* Check if directory entry is volume label */
532ca987d46SWarner Losh 		if (dd.de.attr & FA_LABEL) {
533ca987d46SWarner Losh 			/*
534ca987d46SWarner Losh 			 * If volume label set, check if the current entry is
535ca987d46SWarner Losh 			 * extended entry (FA_XDE) for long file names.
536ca987d46SWarner Losh 			 */
537ca987d46SWarner Losh 			if ((dd.de.attr & FA_MASK) == FA_XDE) {
538ca987d46SWarner Losh 				/*
539ca987d46SWarner Losh 				 * Read through all following extended entries
540ca987d46SWarner Losh 				 * to get the long file name. 0x40 marks the
541ca987d46SWarner Losh 				 * last entry containing part of long file name.
542ca987d46SWarner Losh 				 */
543ca987d46SWarner Losh 				if (dd.xde.seq & 0x40)
544ca987d46SWarner Losh 					chk = dd.xde.chk;
5453ec0714dSToomas Soome 				else if (dd.xde.seq != xdn - 1 ||
5463ec0714dSToomas Soome 				    dd.xde.chk != chk)
547ca987d46SWarner Losh 					continue;
548ca987d46SWarner Losh 				x = dd.xde.seq & ~0x40;
549ca987d46SWarner Losh 				if (x < 1 || x > 20) {
550ca987d46SWarner Losh 					x = 0;
551ca987d46SWarner Losh 					continue;
552ca987d46SWarner Losh 				}
553ca987d46SWarner Losh 				cp_xdnm(fn, &dd.xde);
554ca987d46SWarner Losh 			} else {
555ca987d46SWarner Losh 				/* skip only volume label entries */
556ca987d46SWarner Losh 				continue;
557ca987d46SWarner Losh 			}
558ca987d46SWarner Losh 		} else {
559ca987d46SWarner Losh 			if (xdn == 1) {
560ca987d46SWarner Losh 				x = dos_checksum(dd.de.name, dd.de.ext);
561ca987d46SWarner Losh 				if (x == chk)
562ca987d46SWarner Losh 					break;
563ca987d46SWarner Losh 			} else {
564ca987d46SWarner Losh 				cp_sfn(fn, &dd.de);
565ca987d46SWarner Losh 				break;
566ca987d46SWarner Losh 			}
567ca987d46SWarner Losh 			x = 0;
568ca987d46SWarner Losh 		}
569ca987d46SWarner Losh 	}
570ca987d46SWarner Losh 
571ca987d46SWarner Losh 	d->d_fileno = (dd.de.clus[1] << 8) + dd.de.clus[0];
572ca987d46SWarner Losh 	d->d_reclen = sizeof(*d);
573ca987d46SWarner Losh 	d->d_type = (dd.de.attr & FA_DIR) ? DT_DIR : DT_REG;
574ca987d46SWarner Losh 	memcpy(d->d_name, fn, sizeof(d->d_name));
575ca987d46SWarner Losh 	return (0);
576ca987d46SWarner Losh }
577ca987d46SWarner Losh 
578ca987d46SWarner Losh /*
579ca987d46SWarner Losh  * Parse DOS boot sector
580ca987d46SWarner Losh  */
581ca987d46SWarner Losh static int
parsebs(DOS_FS * fs,DOS_BS * bs)582ca987d46SWarner Losh parsebs(DOS_FS *fs, DOS_BS *bs)
583ca987d46SWarner Losh {
584ca987d46SWarner Losh 	u_int sc;
585ca987d46SWarner Losh 
586ca987d46SWarner Losh 	if ((bs->jmp[0] != 0x69 &&
587ca987d46SWarner Losh 	    bs->jmp[0] != 0xe9 &&
588ca987d46SWarner Losh 	    (bs->jmp[0] != 0xeb || bs->jmp[2] != 0x90)) ||
589ca987d46SWarner Losh 	    bs->bpb.media < 0xf0)
590ca987d46SWarner Losh 		return (EINVAL);
591ca987d46SWarner Losh 	if (cv2(bs->bpb.secsiz) != SECSIZ)
592ca987d46SWarner Losh 		return (EINVAL);
593ca987d46SWarner Losh 	if (!(fs->spc = bs->bpb.spc) || fs->spc & (fs->spc - 1))
594ca987d46SWarner Losh 		return (EINVAL);
595ca987d46SWarner Losh 	fs->bsize = secbyt(fs->spc);
596ca987d46SWarner Losh 	fs->bshift = ffs(fs->bsize) - 1;
597ca987d46SWarner Losh 	if ((fs->spf = cv2(bs->bpb.spf))) {
598ca987d46SWarner Losh 		if (bs->bpb.fats != 2)
599ca987d46SWarner Losh 			return (EINVAL);
600ca987d46SWarner Losh 		if (!(fs->dirents = cv2(bs->bpb.dirents)))
601ca987d46SWarner Losh 			return (EINVAL);
602ca987d46SWarner Losh 	} else {
603ca987d46SWarner Losh 		if (!(fs->spf = cv4(bs->bpb.lspf)))
604ca987d46SWarner Losh 			return (EINVAL);
605ca987d46SWarner Losh 		if (!bs->bpb.fats || bs->bpb.fats > 16)
606ca987d46SWarner Losh 			return (EINVAL);
607ca987d46SWarner Losh 		if ((fs->rdcl = cv4(bs->bpb.rdcl)) < LOCLUS)
608ca987d46SWarner Losh 			return (EINVAL);
609ca987d46SWarner Losh 	}
610ca987d46SWarner Losh 	if (!(fs->lsnfat = cv2(bs->bpb.ressec)))
611ca987d46SWarner Losh 		return (EINVAL);
612ca987d46SWarner Losh 	fs->lsndir = fs->lsnfat + fs->spf * bs->bpb.fats;
613ca987d46SWarner Losh 	fs->lsndta = fs->lsndir + entsec(fs->dirents);
614ca987d46SWarner Losh 	if (!(sc = cv2(bs->bpb.secs)) && !(sc = cv4(bs->bpb.lsecs)))
615ca987d46SWarner Losh 		return (EINVAL);
616ca987d46SWarner Losh 	if (fs->lsndta > sc)
617ca987d46SWarner Losh 		return (EINVAL);
618ca987d46SWarner Losh 	if ((fs->xclus = secblk(fs, sc - fs->lsndta) + 1) < LOCLUS)
619ca987d46SWarner Losh 		return (EINVAL);
620ca987d46SWarner Losh 	fs->fatsz = fs->dirents ? fs->xclus < 0xff6 ? 12 : 16 : 32;
621ca987d46SWarner Losh 	sc = (secbyt(fs->spf) << 1) / (fs->fatsz >> 2) - 1;
622ca987d46SWarner Losh 	if (fs->xclus > sc)
623ca987d46SWarner Losh 		fs->xclus = sc;
624ca987d46SWarner Losh 	return (0);
625ca987d46SWarner Losh }
626ca987d46SWarner Losh 
627ca987d46SWarner Losh /*
628ca987d46SWarner Losh  * Return directory entry from path
629ca987d46SWarner Losh  */
630ca987d46SWarner Losh static int
namede(DOS_FS * fs,const char * path,DOS_DE ** dep)631ca987d46SWarner Losh namede(DOS_FS *fs, const char *path, DOS_DE **dep)
632ca987d46SWarner Losh {
633ca987d46SWarner Losh 	char name[256];
634ca987d46SWarner Losh 	DOS_DE *de;
635ca987d46SWarner Losh 	char *s;
636ca987d46SWarner Losh 	size_t n;
637ca987d46SWarner Losh 	int err;
638ca987d46SWarner Losh 
639ca987d46SWarner Losh 	err = 0;
640ca987d46SWarner Losh 	de = &fs->root;
641ca987d46SWarner Losh 	while (*path) {
642ca987d46SWarner Losh 		while (*path == '/')
643ca987d46SWarner Losh 			path++;
644ca987d46SWarner Losh 		if (*path == '\0')
645ca987d46SWarner Losh 			break;
646ca987d46SWarner Losh 		if (!(s = strchr(path, '/')))
647ca987d46SWarner Losh 			s = strchr(path, 0);
648ca987d46SWarner Losh 		if ((n = s - path) > 255)
649ca987d46SWarner Losh 			return (ENAMETOOLONG);
650ca987d46SWarner Losh 		memcpy(name, path, n);
651ca987d46SWarner Losh 		name[n] = 0;
652ca987d46SWarner Losh 		path = s;
653ca987d46SWarner Losh 		if (!(de->attr & FA_DIR))
654ca987d46SWarner Losh 			return (ENOTDIR);
655ca987d46SWarner Losh 		if ((err = lookup(fs, stclus(fs->fatsz, de), name, &de)))
656ca987d46SWarner Losh 			return (err);
657ca987d46SWarner Losh 	}
658ca987d46SWarner Losh 	*dep = de;
659ca987d46SWarner Losh 	return (0);
660ca987d46SWarner Losh }
661ca987d46SWarner Losh 
662ca987d46SWarner Losh /*
663ca987d46SWarner Losh  * Lookup path segment
664ca987d46SWarner Losh  */
665ca987d46SWarner Losh static int
lookup(DOS_FS * fs,u_int clus,const char * name,DOS_DE ** dep)666ca987d46SWarner Losh lookup(DOS_FS *fs, u_int clus, const char *name, DOS_DE **dep)
667ca987d46SWarner Losh {
668ca987d46SWarner Losh 	static DOS_DIR dir[DEPSEC];
669ca987d46SWarner Losh 	u_char lfn[261];
670ca987d46SWarner Losh 	u_char sfn[13];
671ca987d46SWarner Losh 	u_int nsec, lsec, xdn, chk, sec, ent, x;
672ca987d46SWarner Losh 	int err, ok;
673ca987d46SWarner Losh 
674ca987d46SWarner Losh 	if (!clus)
675ca987d46SWarner Losh 		for (ent = 0; ent < 2; ent++)
676ca987d46SWarner Losh 			if (!strcasecmp(name, dotstr[ent])) {
677ca987d46SWarner Losh 				*dep = dot + ent;
678ca987d46SWarner Losh 				return (0);
679ca987d46SWarner Losh 		}
680ca987d46SWarner Losh 	if (!clus && fs->fatsz == 32)
681ca987d46SWarner Losh 		clus = fs->rdcl;
682ca987d46SWarner Losh 	nsec = !clus ? entsec(fs->dirents) : fs->spc;
683ca987d46SWarner Losh 	lsec = 0;
684ca987d46SWarner Losh 	xdn = chk = 0;
685ca987d46SWarner Losh 	for (;;) {
686ca987d46SWarner Losh 		if (!clus && !lsec)
687ca987d46SWarner Losh 			lsec = fs->lsndir;
688ca987d46SWarner Losh 		else if (okclus(fs, clus))
689ca987d46SWarner Losh 			lsec = blklsn(fs, clus);
690ca987d46SWarner Losh 		else
691ca987d46SWarner Losh 			return (EINVAL);
692ca987d46SWarner Losh 		for (sec = 0; sec < nsec; sec++) {
693ca987d46SWarner Losh 			if ((err = ioget(fs->fd, lsec + sec, dir, secbyt(1))))
694ca987d46SWarner Losh 				return (err);
695ca987d46SWarner Losh 			for (ent = 0; ent < DEPSEC; ent++) {
696ca987d46SWarner Losh 				if (!*dir[ent].de.name)
697ca987d46SWarner Losh 					return (ENOENT);
698ca987d46SWarner Losh 				if (*dir[ent].de.name != 0xe5) {
6993ec0714dSToomas Soome 					if ((dir[ent].de.attr & FA_MASK) ==
7003ec0714dSToomas Soome 					    FA_XDE) {
701ca987d46SWarner Losh 						x = dir[ent].xde.seq;
702ca987d46SWarner Losh 						if (x & 0x40 || (x + 1 == xdn &&
703ca987d46SWarner Losh 						    dir[ent].xde.chk == chk)) {
704ca987d46SWarner Losh 							if (x & 0x40) {
705ca987d46SWarner Losh 								chk = dir[ent].xde.chk;
706ca987d46SWarner Losh 								x &= ~0x40;
707ca987d46SWarner Losh 							}
708ca987d46SWarner Losh 							if (x >= 1 && x <= 20) {
709ca987d46SWarner Losh 								cp_xdnm(lfn, &dir[ent].xde);
710ca987d46SWarner Losh 								xdn = x;
711ca987d46SWarner Losh 								continue;
712ca987d46SWarner Losh 							}
713ca987d46SWarner Losh 						}
7143ec0714dSToomas Soome 					} else if (!(dir[ent].de.attr &
7153ec0714dSToomas Soome 					    FA_LABEL)) {
716ca987d46SWarner Losh 						if ((ok = xdn == 1)) {
7173ec0714dSToomas Soome 							x = dos_checksum(
7183ec0714dSToomas Soome 							    dir[ent].de.name,
7193ec0714dSToomas Soome 							    dir[ent].de.ext);
720ca987d46SWarner Losh 							ok = chk == x &&
7213ec0714dSToomas Soome 							!strcasecmp(name,
7223ec0714dSToomas Soome 							    (const char *)lfn);
723ca987d46SWarner Losh 						}
724ca987d46SWarner Losh 						if (!ok) {
7253ec0714dSToomas Soome 							cp_sfn(sfn,
7263ec0714dSToomas Soome 							    &dir[ent].de);
7273ec0714dSToomas Soome 							ok = !strcasecmp(name,
7283ec0714dSToomas Soome 							    (const char *)sfn);
729ca987d46SWarner Losh 						}
730ca987d46SWarner Losh 						if (ok) {
731ca987d46SWarner Losh 							*dep = &dir[ent].de;
732ca987d46SWarner Losh 							return (0);
733ca987d46SWarner Losh 						}
734ca987d46SWarner Losh 					}
735ca987d46SWarner Losh 				}
736ca987d46SWarner Losh 				xdn = 0;
737ca987d46SWarner Losh 			}
738ca987d46SWarner Losh 		}
739ca987d46SWarner Losh 		if (!clus)
740ca987d46SWarner Losh 			break;
741ca987d46SWarner Losh 		if ((err = fatget(fs, &clus)))
742ca987d46SWarner Losh 			return (err);
743ca987d46SWarner Losh 		if (fatend(fs->fatsz, clus))
744ca987d46SWarner Losh 			break;
745ca987d46SWarner Losh 	}
746ca987d46SWarner Losh 	return (ENOENT);
747ca987d46SWarner Losh }
748ca987d46SWarner Losh 
749ca987d46SWarner Losh /*
750ca987d46SWarner Losh  * Copy name from extended directory entry
751ca987d46SWarner Losh  */
752ca987d46SWarner Losh static void
cp_xdnm(u_char * lfn,DOS_XDE * xde)753ca987d46SWarner Losh cp_xdnm(u_char *lfn, DOS_XDE *xde)
754ca987d46SWarner Losh {
755ca987d46SWarner Losh 	static struct {
756ca987d46SWarner Losh 		u_int off;
757ca987d46SWarner Losh 		u_int dim;
758ca987d46SWarner Losh 	} ix[3] = {
759ca987d46SWarner Losh 		{offsetof(DOS_XDE, name1), sizeof(xde->name1) / 2},
760ca987d46SWarner Losh 		{offsetof(DOS_XDE, name2), sizeof(xde->name2) / 2},
761ca987d46SWarner Losh 		{offsetof(DOS_XDE, name3), sizeof(xde->name3) / 2}
762ca987d46SWarner Losh 	};
763ca987d46SWarner Losh 	u_char *p;
764ca987d46SWarner Losh 	u_int n, x, c;
765ca987d46SWarner Losh 
766ca987d46SWarner Losh 	lfn += 13 * ((xde->seq & ~0x40) - 1);
767ca987d46SWarner Losh 	for (n = 0; n < 3; n++)
768ca987d46SWarner Losh 		for (p = (u_char *)xde + ix[n].off, x = ix[n].dim; x;
769ca987d46SWarner Losh 		    p += 2, x--) {
770ca987d46SWarner Losh 			if ((c = cv2(p)) && (c < 32 || c > 127))
771ca987d46SWarner Losh 				c = '?';
772ca987d46SWarner Losh 			if (!(*lfn++ = c))
773ca987d46SWarner Losh 				return;
774ca987d46SWarner Losh 		}
775ca987d46SWarner Losh 	if (xde->seq & 0x40)
776ca987d46SWarner Losh 		*lfn = 0;
777ca987d46SWarner Losh }
778ca987d46SWarner Losh 
779ca987d46SWarner Losh /*
780ca987d46SWarner Losh  * Copy short filename
781ca987d46SWarner Losh  */
782ca987d46SWarner Losh static void
cp_sfn(u_char * sfn,DOS_DE * de)783ca987d46SWarner Losh cp_sfn(u_char *sfn, DOS_DE *de)
784ca987d46SWarner Losh {
785ca987d46SWarner Losh 	u_char *p;
786ca987d46SWarner Losh 	int j, i;
787ca987d46SWarner Losh 
788ca987d46SWarner Losh 	p = sfn;
789ca987d46SWarner Losh 	if (*de->name != ' ') {
7903ec0714dSToomas Soome 		for (j = 7; de->name[j] == ' '; j--)
7913ec0714dSToomas Soome 			;
792ca987d46SWarner Losh 		for (i = 0; i <= j; i++)
793ca987d46SWarner Losh 			*p++ = de->name[i];
794ca987d46SWarner Losh 		if (*de->ext != ' ') {
795ca987d46SWarner Losh 			*p++ = '.';
7963ec0714dSToomas Soome 			for (j = 2; de->ext[j] == ' '; j--)
7973ec0714dSToomas Soome 				;
798ca987d46SWarner Losh 			for (i = 0; i <= j; i++)
799ca987d46SWarner Losh 				*p++ = de->ext[i];
800ca987d46SWarner Losh 		}
801ca987d46SWarner Losh 	}
802ca987d46SWarner Losh 	*p = 0;
803ca987d46SWarner Losh 	if (*sfn == 5)
804ca987d46SWarner Losh 		*sfn = 0xe5;
805ca987d46SWarner Losh }
806ca987d46SWarner Losh 
807ca987d46SWarner Losh /*
808ca987d46SWarner Losh  * Return size of file in bytes
809ca987d46SWarner Losh  */
810ca987d46SWarner Losh static off_t
fsize(DOS_FS * fs,DOS_DE * de)811ca987d46SWarner Losh fsize(DOS_FS *fs, DOS_DE *de)
812ca987d46SWarner Losh {
813ca987d46SWarner Losh 	u_long size;
814ca987d46SWarner Losh 	u_int c;
815ca987d46SWarner Losh 	int n;
816ca987d46SWarner Losh 
817ca987d46SWarner Losh 	if (!(size = cv4(de->size)) && de->attr & FA_DIR) {
8183ec0714dSToomas Soome 		if (!(c = cv2(de->clus))) {
819ca987d46SWarner Losh 			size = fs->dirents * sizeof(DOS_DE);
8203ec0714dSToomas Soome 		} else {
821ca987d46SWarner Losh 			if ((n = fatcnt(fs, c)) == -1)
822ca987d46SWarner Losh 				return (n);
823ca987d46SWarner Losh 			size = blkbyt(fs, n);
824ca987d46SWarner Losh 		}
825ca987d46SWarner Losh 	}
826ca987d46SWarner Losh 	return (size);
827ca987d46SWarner Losh }
828ca987d46SWarner Losh 
829ca987d46SWarner Losh /*
830ca987d46SWarner Losh  * Count number of clusters in chain
831ca987d46SWarner Losh  */
832ca987d46SWarner Losh static int
fatcnt(DOS_FS * fs,u_int c)833ca987d46SWarner Losh fatcnt(DOS_FS *fs, u_int c)
834ca987d46SWarner Losh {
835ca987d46SWarner Losh 	int n;
836ca987d46SWarner Losh 
837ca987d46SWarner Losh 	for (n = 0; okclus(fs, c); n++)
838ca987d46SWarner Losh 		if (fatget(fs, &c))
839ca987d46SWarner Losh 			return (-1);
840ca987d46SWarner Losh 	return (fatend(fs->fatsz, c) ? n : -1);
841ca987d46SWarner Losh }
842ca987d46SWarner Losh 
843ca987d46SWarner Losh /*
844ca987d46SWarner Losh  * Get next cluster in cluster chain. Use in core fat cache unless
845ca987d46SWarner Losh  * the number of current 128K block in FAT has changed.
846ca987d46SWarner Losh  */
847ca987d46SWarner Losh static int
fatget(DOS_FS * fs,u_int * c)848ca987d46SWarner Losh fatget(DOS_FS *fs, u_int *c)
849ca987d46SWarner Losh {
850ca987d46SWarner Losh 	u_int val_in, val_out, offset, blknum, nbyte;
851ca987d46SWarner Losh 	const u_char *p_entry;
852ca987d46SWarner Losh 	int err;
853ca987d46SWarner Losh 
854ca987d46SWarner Losh 	/* check input value to prevent overflow in fatoff() */
855ca987d46SWarner Losh 	val_in = *c;
856ca987d46SWarner Losh 	if (val_in & 0xf0000000)
857ca987d46SWarner Losh 		return (EINVAL);
858ca987d46SWarner Losh 
859ca987d46SWarner Losh 	/* ensure that current 128K FAT block is cached */
860ca987d46SWarner Losh 	offset = fatoff(fs->fatsz, val_in);
861ca987d46SWarner Losh 	nbyte = fs->fatsz != 32 ? 2 : 4;
862ca987d46SWarner Losh 	if (offset + nbyte > secbyt(fs->spf))
863ca987d46SWarner Losh 		return (EINVAL);
864ca987d46SWarner Losh 	blknum = offset / FATBLKSZ;
865ca987d46SWarner Losh 	offset %= FATBLKSZ;
866ca987d46SWarner Losh 	if (offset + nbyte > FATBLKSZ)
867ca987d46SWarner Losh 		return (EINVAL);
868ca987d46SWarner Losh 	if (blknum != fs->fatbuf_blknum) {
869ca987d46SWarner Losh 		err = dos_read_fatblk(fs, fs->fd, blknum);
870ca987d46SWarner Losh 		if (err != 0)
871ca987d46SWarner Losh 			return (err);
872ca987d46SWarner Losh 	}
873ca987d46SWarner Losh 	p_entry = fs->fatbuf + offset;
874ca987d46SWarner Losh 
875ca987d46SWarner Losh 	/* extract cluster number from FAT entry */
876ca987d46SWarner Losh 	switch (fs->fatsz) {
877ca987d46SWarner Losh 	case 32:
878ca987d46SWarner Losh 		val_out = cv4(p_entry);
879ca987d46SWarner Losh 		val_out &= 0x0fffffff;
880ca987d46SWarner Losh 		break;
881ca987d46SWarner Losh 	case 16:
882ca987d46SWarner Losh 		val_out = cv2(p_entry);
883ca987d46SWarner Losh 		break;
884ca987d46SWarner Losh 	case 12:
885ca987d46SWarner Losh 		val_out = cv2(p_entry);
886ca987d46SWarner Losh 		if (val_in & 1)
887ca987d46SWarner Losh 			val_out >>= 4;
888ca987d46SWarner Losh 		else
889ca987d46SWarner Losh 			val_out &= 0xfff;
890ca987d46SWarner Losh 		break;
891ca987d46SWarner Losh 	default:
892ca987d46SWarner Losh 		return (EINVAL);
893ca987d46SWarner Losh 	}
894ca987d46SWarner Losh 	*c = val_out;
895ca987d46SWarner Losh 	return (0);
896ca987d46SWarner Losh }
897ca987d46SWarner Losh 
898ca987d46SWarner Losh /*
899ca987d46SWarner Losh  * Is cluster an end-of-chain marker?
900ca987d46SWarner Losh  */
901ca987d46SWarner Losh static int
fatend(u_int sz,u_int c)902ca987d46SWarner Losh fatend(u_int sz, u_int c)
903ca987d46SWarner Losh {
904ca987d46SWarner Losh 	return (c > (sz == 12 ? 0xff7U : sz == 16 ? 0xfff7U : 0xffffff7));
905ca987d46SWarner Losh }
906ca987d46SWarner Losh 
907ca987d46SWarner Losh /*
908ca987d46SWarner Losh  * Offset-based I/O primitive
909ca987d46SWarner Losh  */
910ca987d46SWarner Losh static int
ioread(DOS_FS * fs,u_int offset,void * buf,size_t nbyte)911ca987d46SWarner Losh ioread(DOS_FS *fs, u_int offset, void *buf, size_t nbyte)
912ca987d46SWarner Losh {
913ca987d46SWarner Losh 	char *s;
914ca987d46SWarner Losh 	u_int off, n;
915ca987d46SWarner Losh 	int err;
916ca987d46SWarner Losh 	u_char local_buf[SECSIZ];
917ca987d46SWarner Losh 
918ca987d46SWarner Losh 	s = buf;
919ca987d46SWarner Losh 	if ((off = offset & (SECSIZ - 1))) {
920ca987d46SWarner Losh 		offset -= off;
921ca987d46SWarner Losh 		if ((n = SECSIZ - off) > nbyte)
922ca987d46SWarner Losh 			n = nbyte;
9233ec0714dSToomas Soome 		err = ioget(fs->fd, bytsec(offset), local_buf,
9243ec0714dSToomas Soome 		    sizeof(local_buf));
9253ec0714dSToomas Soome 		if (err != 0)
926ca987d46SWarner Losh 			return (err);
927ca987d46SWarner Losh 		memcpy(s, local_buf + off, n);
928ca987d46SWarner Losh 		offset += SECSIZ;
929ca987d46SWarner Losh 		s += n;
930ca987d46SWarner Losh 		nbyte -= n;
931ca987d46SWarner Losh 	}
932ca987d46SWarner Losh 	n = nbyte & (SECSIZ - 1);
933ca987d46SWarner Losh 	if (nbyte -= n) {
934ca987d46SWarner Losh 		if ((err = ioget(fs->fd, bytsec(offset), s, nbyte)))
935ca987d46SWarner Losh 			return (err);
936ca987d46SWarner Losh 		offset += nbyte;
937ca987d46SWarner Losh 		s += nbyte;
938ca987d46SWarner Losh 	}
9393ec0714dSToomas Soome 	if (n != 0) {
9403ec0714dSToomas Soome 		err = ioget(fs->fd, bytsec(offset), local_buf,
9413ec0714dSToomas Soome 		    sizeof(local_buf));
9423ec0714dSToomas Soome 		if (err != 0)
943ca987d46SWarner Losh 			return (err);
944ca987d46SWarner Losh 		memcpy(s, local_buf, n);
945ca987d46SWarner Losh 	}
946ca987d46SWarner Losh 	return (0);
947ca987d46SWarner Losh }
948ca987d46SWarner Losh 
949ca987d46SWarner Losh /*
950ca987d46SWarner Losh  * Sector-based I/O primitive
951ca987d46SWarner Losh  */
952ca987d46SWarner Losh static int
ioget(struct open_file * fd,daddr_t lsec,void * buf,size_t size)953ca987d46SWarner Losh ioget(struct open_file *fd, daddr_t lsec, void *buf, size_t size)
954ca987d46SWarner Losh {
955ca987d46SWarner Losh 	size_t rsize;
956ca987d46SWarner Losh 	int rv;
957ca987d46SWarner Losh 
958ca987d46SWarner Losh 	/* Make sure we get full read or error. */
959ca987d46SWarner Losh 	rsize = 0;
960ca987d46SWarner Losh 	rv = (fd->f_dev->dv_strategy)(fd->f_devdata, F_READ, lsec,
961ca987d46SWarner Losh 	    size, buf, &rsize);
962ca987d46SWarner Losh 	if ((rv == 0) && (size != rsize))
963ca987d46SWarner Losh 		rv = EIO;
964ca987d46SWarner Losh 	return (rv);
965ca987d46SWarner Losh }
966