fat.c revision 1.17 1 1.17 christos /* $NetBSD: fat.c,v 1.17 2006/03/20 01:42:47 christos Exp $ */
2 1.1 ws
3 1.1 ws /*
4 1.8 ws * Copyright (C) 1995, 1996, 1997 Wolfgang Solfrank
5 1.1 ws * Copyright (c) 1995 Martin Husemann
6 1.1 ws *
7 1.1 ws * Redistribution and use in source and binary forms, with or without
8 1.1 ws * modification, are permitted provided that the following conditions
9 1.1 ws * are met:
10 1.1 ws * 1. Redistributions of source code must retain the above copyright
11 1.1 ws * notice, this list of conditions and the following disclaimer.
12 1.1 ws * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 ws * notice, this list of conditions and the following disclaimer in the
14 1.1 ws * documentation and/or other materials provided with the distribution.
15 1.1 ws * 3. All advertising materials mentioning features or use of this software
16 1.1 ws * must display the following acknowledgement:
17 1.1 ws * This product includes software developed by Martin Husemann
18 1.1 ws * and Wolfgang Solfrank.
19 1.1 ws * 4. Neither the name of the University nor the names of its contributors
20 1.1 ws * may be used to endorse or promote products derived from this software
21 1.1 ws * without specific prior written permission.
22 1.1 ws *
23 1.1 ws * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
24 1.1 ws * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25 1.1 ws * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 1.1 ws * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
27 1.1 ws * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
28 1.1 ws * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 1.1 ws * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 1.1 ws * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 1.1 ws * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
32 1.1 ws * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 ws */
34 1.1 ws
35 1.1 ws
36 1.7 lukem #include <sys/cdefs.h>
37 1.1 ws #ifndef lint
38 1.17 christos __RCSID("$NetBSD: fat.c,v 1.17 2006/03/20 01:42:47 christos Exp $");
39 1.1 ws #endif /* not lint */
40 1.1 ws
41 1.1 ws #include <stdlib.h>
42 1.1 ws #include <string.h>
43 1.1 ws #include <ctype.h>
44 1.1 ws #include <stdio.h>
45 1.1 ws #include <unistd.h>
46 1.1 ws
47 1.1 ws #include "ext.h"
48 1.4 christos #include "fsutil.h"
49 1.3 christos
50 1.16 xtraeme static int checkclnum(struct bootblock *, int, cl_t, cl_t *);
51 1.16 xtraeme static int clustdiffer(cl_t, cl_t *, cl_t *, int);
52 1.16 xtraeme static int tryclear(struct bootblock *, struct fatEntry *, cl_t, cl_t *);
53 1.16 xtraeme static int _readfat(int, struct bootblock *, int, u_char **);
54 1.1 ws
55 1.1 ws /*
56 1.1 ws * Check a cluster number for valid value
57 1.1 ws */
58 1.1 ws static int
59 1.16 xtraeme checkclnum(struct bootblock *boot, int fat, cl_t cl, cl_t *next)
60 1.1 ws {
61 1.8 ws if (*next >= (CLUST_RSRVD&boot->ClustMask))
62 1.8 ws *next |= ~boot->ClustMask;
63 1.1 ws if (*next == CLUST_FREE) {
64 1.1 ws boot->NumFree++;
65 1.1 ws return FSOK;
66 1.1 ws }
67 1.5 ws if (*next == CLUST_BAD) {
68 1.5 ws boot->NumBad++;
69 1.5 ws return FSOK;
70 1.5 ws }
71 1.1 ws if (*next < CLUST_FIRST
72 1.1 ws || (*next >= boot->NumClusters && *next < CLUST_EOFS)) {
73 1.8 ws pwarn("Cluster %u in FAT %d continues with %s cluster number %u\n",
74 1.1 ws cl, fat,
75 1.1 ws *next < CLUST_RSRVD ? "out of range" : "reserved",
76 1.8 ws *next&boot->ClustMask);
77 1.1 ws if (ask(0, "Truncate")) {
78 1.1 ws *next = CLUST_EOF;
79 1.1 ws return FSFATMOD;
80 1.1 ws }
81 1.1 ws return FSERROR;
82 1.1 ws }
83 1.1 ws return FSOK;
84 1.1 ws }
85 1.1 ws
86 1.1 ws /*
87 1.10 jdolecek * Read a FAT from disk. Returns 1 if successful, 0 otherwise.
88 1.1 ws */
89 1.11 jdolecek static int
90 1.16 xtraeme _readfat(int fs, struct bootblock *boot, int no, u_char **buffer)
91 1.1 ws {
92 1.1 ws off_t off;
93 1.1 ws
94 1.10 jdolecek *buffer = malloc(boot->FATsecs * boot->BytesPerSec);
95 1.10 jdolecek if (*buffer == NULL) {
96 1.1 ws perror("No space for FAT");
97 1.10 jdolecek return 0;
98 1.1 ws }
99 1.8 ws
100 1.1 ws off = boot->ResSectors + no * boot->FATsecs;
101 1.1 ws off *= boot->BytesPerSec;
102 1.1 ws
103 1.1 ws if (lseek(fs, off, SEEK_SET) != off) {
104 1.1 ws perror("Unable to read FAT");
105 1.10 jdolecek goto err;
106 1.1 ws }
107 1.8 ws
108 1.10 jdolecek if (read(fs, *buffer, boot->FATsecs * boot->BytesPerSec)
109 1.1 ws != boot->FATsecs * boot->BytesPerSec) {
110 1.8 ws perror("Unable to read FAT");
111 1.10 jdolecek goto err;
112 1.10 jdolecek }
113 1.10 jdolecek
114 1.10 jdolecek return 1;
115 1.10 jdolecek
116 1.10 jdolecek err:
117 1.10 jdolecek free(*buffer);
118 1.10 jdolecek return 0;
119 1.10 jdolecek }
120 1.10 jdolecek
121 1.10 jdolecek /*
122 1.10 jdolecek * Read a FAT and decode it into internal format
123 1.10 jdolecek */
124 1.10 jdolecek int
125 1.16 xtraeme readfat(int fs, struct bootblock *boot, int no, struct fatEntry **fp)
126 1.10 jdolecek {
127 1.10 jdolecek struct fatEntry *fat;
128 1.10 jdolecek u_char *buffer, *p;
129 1.10 jdolecek cl_t cl;
130 1.10 jdolecek int ret = FSOK;
131 1.10 jdolecek
132 1.10 jdolecek boot->NumFree = boot->NumBad = 0;
133 1.10 jdolecek
134 1.10 jdolecek if (!_readfat(fs, boot, no, &buffer))
135 1.10 jdolecek return FSFATAL;
136 1.10 jdolecek
137 1.10 jdolecek fat = calloc(boot->NumClusters, sizeof(struct fatEntry));
138 1.10 jdolecek if (fat == NULL) {
139 1.10 jdolecek perror("No space for FAT");
140 1.1 ws free(buffer);
141 1.1 ws return FSFATAL;
142 1.1 ws }
143 1.1 ws
144 1.6 ws if (buffer[0] != boot->Media
145 1.6 ws || buffer[1] != 0xff || buffer[2] != 0xff
146 1.8 ws || (boot->ClustMask == CLUST16_MASK && buffer[3] != 0xff)
147 1.8 ws || (boot->ClustMask == CLUST32_MASK
148 1.8 ws && ((buffer[3]&0x0f) != 0x0f
149 1.8 ws || buffer[4] != 0xff || buffer[5] != 0xff
150 1.8 ws || buffer[6] != 0xff || (buffer[7]&0x0f) != 0x0f))) {
151 1.10 jdolecek
152 1.10 jdolecek /* Windows 95 OSR2 (and possibly any later) changes
153 1.10 jdolecek * the FAT signature to 0xXXffff7f for FAT16 and to
154 1.10 jdolecek * 0xXXffff0fffffff07 for FAT32 upon boot, to know that the
155 1.10 jdolecek * filesystem is dirty if it doesn't reboot cleanly.
156 1.10 jdolecek * Check this special condition before errorring out.
157 1.10 jdolecek */
158 1.10 jdolecek if (buffer[0] == boot->Media && buffer[1] == 0xff
159 1.10 jdolecek && buffer[2] == 0xff
160 1.10 jdolecek && ((boot->ClustMask == CLUST16_MASK && buffer[3] == 0x7f)
161 1.10 jdolecek || (boot->ClustMask == CLUST32_MASK
162 1.10 jdolecek && buffer[3] == 0x0f && buffer[4] == 0xff
163 1.10 jdolecek && buffer[5] == 0xff && buffer[6] == 0xff
164 1.10 jdolecek && buffer[7] == 0x07)))
165 1.10 jdolecek ret |= FSDIRTY;
166 1.10 jdolecek else {
167 1.10 jdolecek /* just some odd byte sequence in FAT */
168 1.10 jdolecek
169 1.10 jdolecek switch (boot->ClustMask) {
170 1.10 jdolecek case CLUST32_MASK:
171 1.12 is pwarn("%s (%02x%02x%02x%02x%02x%02x%02x%02x)\n",
172 1.12 is "FAT starts with odd byte sequence",
173 1.12 is buffer[0], buffer[1], buffer[2], buffer[3],
174 1.12 is buffer[4], buffer[5], buffer[6], buffer[7]);
175 1.10 jdolecek break;
176 1.10 jdolecek case CLUST16_MASK:
177 1.13 lukem pwarn("%s (%02x%02x%02x%02x)\n",
178 1.13 lukem "FAT starts with odd byte sequence",
179 1.13 lukem buffer[0], buffer[1], buffer[2], buffer[3]);
180 1.10 jdolecek break;
181 1.10 jdolecek default:
182 1.13 lukem pwarn("%s (%02x%02x%02x)\n",
183 1.13 lukem "FAT starts with odd byte sequence",
184 1.13 lukem buffer[0], buffer[1], buffer[2]);
185 1.10 jdolecek break;
186 1.10 jdolecek }
187 1.8 ws
188 1.10 jdolecek
189 1.10 jdolecek if (ask(1, "Correct"))
190 1.10 jdolecek ret |= FSFIXFAT;
191 1.8 ws }
192 1.1 ws }
193 1.8 ws switch (boot->ClustMask) {
194 1.8 ws case CLUST32_MASK:
195 1.8 ws p = buffer + 8;
196 1.8 ws break;
197 1.8 ws case CLUST16_MASK:
198 1.8 ws p = buffer + 4;
199 1.8 ws break;
200 1.8 ws default:
201 1.8 ws p = buffer + 3;
202 1.8 ws break;
203 1.8 ws }
204 1.1 ws for (cl = CLUST_FIRST; cl < boot->NumClusters;) {
205 1.8 ws switch (boot->ClustMask) {
206 1.8 ws case CLUST32_MASK:
207 1.8 ws fat[cl].next = p[0] + (p[1] << 8)
208 1.8 ws + (p[2] << 16) + (p[3] << 24);
209 1.8 ws fat[cl].next &= boot->ClustMask;
210 1.8 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
211 1.8 ws cl++;
212 1.8 ws p += 4;
213 1.8 ws break;
214 1.8 ws case CLUST16_MASK:
215 1.1 ws fat[cl].next = p[0] + (p[1] << 8);
216 1.1 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
217 1.1 ws cl++;
218 1.1 ws p += 2;
219 1.8 ws break;
220 1.8 ws default:
221 1.1 ws fat[cl].next = (p[0] + (p[1] << 8)) & 0x0fff;
222 1.1 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
223 1.1 ws cl++;
224 1.1 ws if (cl >= boot->NumClusters)
225 1.1 ws break;
226 1.1 ws fat[cl].next = ((p[1] >> 4) + (p[2] << 4)) & 0x0fff;
227 1.1 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
228 1.1 ws cl++;
229 1.1 ws p += 3;
230 1.8 ws break;
231 1.1 ws }
232 1.1 ws }
233 1.8 ws
234 1.1 ws free(buffer);
235 1.17 christos if (ret & FSFATAL) {
236 1.17 christos free(fat);
237 1.17 christos *fp = NULL;
238 1.17 christos } else
239 1.17 christos *fp = fat;
240 1.1 ws return ret;
241 1.1 ws }
242 1.1 ws
243 1.1 ws /*
244 1.1 ws * Get type of reserved cluster
245 1.1 ws */
246 1.14 wiz const char *
247 1.16 xtraeme rsrvdcltype(cl_t cl)
248 1.1 ws {
249 1.9 ws if (cl == CLUST_FREE)
250 1.9 ws return "free";
251 1.1 ws if (cl < CLUST_BAD)
252 1.1 ws return "reserved";
253 1.1 ws if (cl > CLUST_BAD)
254 1.1 ws return "as EOF";
255 1.1 ws return "bad";
256 1.1 ws }
257 1.1 ws
258 1.1 ws static int
259 1.16 xtraeme clustdiffer(cl_t cl, cl_t *cp1, cl_t *cp2, int fatnum)
260 1.1 ws {
261 1.9 ws if (*cp1 == CLUST_FREE || *cp1 >= CLUST_RSRVD) {
262 1.9 ws if (*cp2 == CLUST_FREE || *cp2 >= CLUST_RSRVD) {
263 1.9 ws if ((*cp1 != CLUST_FREE && *cp1 < CLUST_BAD
264 1.9 ws && *cp2 != CLUST_FREE && *cp2 < CLUST_BAD)
265 1.1 ws || (*cp1 > CLUST_BAD && *cp2 > CLUST_BAD)) {
266 1.8 ws pwarn("Cluster %u is marked %s with different indicators, ",
267 1.1 ws cl, rsrvdcltype(*cp1));
268 1.1 ws if (ask(1, "fix")) {
269 1.1 ws *cp2 = *cp1;
270 1.1 ws return FSFATMOD;
271 1.1 ws }
272 1.1 ws return FSFATAL;
273 1.1 ws }
274 1.8 ws pwarn("Cluster %u is marked %s in FAT 0, %s in FAT %d\n",
275 1.1 ws cl, rsrvdcltype(*cp1), rsrvdcltype(*cp2), fatnum);
276 1.8 ws if (ask(0, "use FAT 0's entry")) {
277 1.1 ws *cp2 = *cp1;
278 1.1 ws return FSFATMOD;
279 1.1 ws }
280 1.8 ws if (ask(0, "use FAT %d's entry", fatnum)) {
281 1.1 ws *cp1 = *cp2;
282 1.1 ws return FSFATMOD;
283 1.1 ws }
284 1.1 ws return FSFATAL;
285 1.1 ws }
286 1.8 ws pwarn("Cluster %u is marked %s in FAT 0, but continues with cluster %u in FAT %d\n",
287 1.1 ws cl, rsrvdcltype(*cp1), *cp2, fatnum);
288 1.1 ws if (ask(0, "Use continuation from FAT %d", fatnum)) {
289 1.1 ws *cp1 = *cp2;
290 1.1 ws return FSFATMOD;
291 1.1 ws }
292 1.8 ws if (ask(0, "Use mark from FAT 0")) {
293 1.1 ws *cp2 = *cp1;
294 1.1 ws return FSFATMOD;
295 1.1 ws }
296 1.1 ws return FSFATAL;
297 1.1 ws }
298 1.9 ws if (*cp2 == CLUST_FREE || *cp2 >= CLUST_RSRVD) {
299 1.8 ws pwarn("Cluster %u continues with cluster %u in FAT 0, but is marked %s in FAT %d\n",
300 1.1 ws cl, *cp1, rsrvdcltype(*cp2), fatnum);
301 1.8 ws if (ask(0, "Use continuation from FAT 0")) {
302 1.1 ws *cp2 = *cp1;
303 1.1 ws return FSFATMOD;
304 1.1 ws }
305 1.1 ws if (ask(0, "Use mark from FAT %d", fatnum)) {
306 1.1 ws *cp1 = *cp2;
307 1.1 ws return FSFATMOD;
308 1.1 ws }
309 1.1 ws return FSERROR;
310 1.1 ws }
311 1.8 ws pwarn("Cluster %u continues with cluster %u in FAT 0, but with cluster %u in FAT %d\n",
312 1.1 ws cl, *cp1, *cp2, fatnum);
313 1.8 ws if (ask(0, "Use continuation from FAT 0")) {
314 1.1 ws *cp2 = *cp1;
315 1.1 ws return FSFATMOD;
316 1.1 ws }
317 1.1 ws if (ask(0, "Use continuation from FAT %d", fatnum)) {
318 1.1 ws *cp1 = *cp2;
319 1.1 ws return FSFATMOD;
320 1.1 ws }
321 1.1 ws return FSERROR;
322 1.1 ws }
323 1.1 ws
324 1.1 ws /*
325 1.1 ws * Compare two FAT copies in memory. Resolve any conflicts and merge them
326 1.1 ws * into the first one.
327 1.1 ws */
328 1.1 ws int
329 1.16 xtraeme comparefat(struct bootblock *boot, struct fatEntry *first,
330 1.16 xtraeme struct fatEntry *second, int fatnum)
331 1.1 ws {
332 1.1 ws cl_t cl;
333 1.1 ws int ret = FSOK;
334 1.1 ws
335 1.1 ws for (cl = CLUST_FIRST; cl < boot->NumClusters; cl++)
336 1.1 ws if (first[cl].next != second[cl].next)
337 1.1 ws ret |= clustdiffer(cl, &first[cl].next, &second[cl].next, fatnum);
338 1.1 ws return ret;
339 1.1 ws }
340 1.1 ws
341 1.1 ws void
342 1.16 xtraeme clearchain(struct bootblock *boot, struct fatEntry *fat, cl_t head)
343 1.1 ws {
344 1.1 ws cl_t p, q;
345 1.1 ws
346 1.1 ws for (p = head; p >= CLUST_FIRST && p < boot->NumClusters; p = q) {
347 1.1 ws if (fat[p].head != head)
348 1.1 ws break;
349 1.1 ws q = fat[p].next;
350 1.1 ws fat[p].next = fat[p].head = CLUST_FREE;
351 1.1 ws fat[p].length = 0;
352 1.1 ws }
353 1.1 ws }
354 1.1 ws
355 1.9 ws int
356 1.16 xtraeme tryclear(struct bootblock *boot, struct fatEntry *fat, cl_t head, cl_t *truncp)
357 1.9 ws {
358 1.9 ws if (ask(0, "Clear chain starting at %u", head)) {
359 1.9 ws clearchain(boot, fat, head);
360 1.9 ws return FSFATMOD;
361 1.9 ws } else if (ask(0, "Truncate")) {
362 1.15 matt *truncp = CLUST_EOF;
363 1.9 ws return FSFATMOD;
364 1.9 ws } else
365 1.9 ws return FSERROR;
366 1.9 ws }
367 1.9 ws
368 1.1 ws /*
369 1.1 ws * Check a complete FAT in-memory for crosslinks
370 1.1 ws */
371 1.1 ws int
372 1.16 xtraeme checkfat(struct bootblock *boot, struct fatEntry *fat)
373 1.1 ws {
374 1.9 ws cl_t head, p, h, n;
375 1.1 ws u_int len;
376 1.1 ws int ret = 0;
377 1.1 ws int conf;
378 1.8 ws
379 1.1 ws /*
380 1.1 ws * pass 1: figure out the cluster chains.
381 1.1 ws */
382 1.1 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++) {
383 1.8 ws /* find next untravelled chain */
384 1.6 ws if (fat[head].head != 0 /* cluster already belongs to some chain */
385 1.5 ws || fat[head].next == CLUST_FREE
386 1.5 ws || fat[head].next == CLUST_BAD)
387 1.1 ws continue; /* skip it. */
388 1.1 ws
389 1.1 ws /* follow the chain and mark all clusters on the way */
390 1.1 ws for (len = 0, p = head;
391 1.1 ws p >= CLUST_FIRST && p < boot->NumClusters;
392 1.1 ws p = fat[p].next) {
393 1.1 ws fat[p].head = head;
394 1.1 ws len++;
395 1.1 ws }
396 1.1 ws
397 1.1 ws /* the head record gets the length */
398 1.8 ws fat[head].length = fat[head].next == CLUST_FREE ? 0 : len;
399 1.1 ws }
400 1.8 ws
401 1.1 ws /*
402 1.1 ws * pass 2: check for crosslinked chains (we couldn't do this in pass 1 because
403 1.1 ws * we didn't know the real start of the chain then - would have treated partial
404 1.1 ws * chains as interlinked with their main chain)
405 1.1 ws */
406 1.1 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++) {
407 1.8 ws /* find next untravelled chain */
408 1.1 ws if (fat[head].head != head)
409 1.1 ws continue;
410 1.1 ws
411 1.1 ws /* follow the chain to its end (hopefully) */
412 1.1 ws for (p = head;
413 1.9 ws (n = fat[p].next) >= CLUST_FIRST && n < boot->NumClusters;
414 1.9 ws p = n)
415 1.9 ws if (fat[n].head != head)
416 1.1 ws break;
417 1.9 ws if (n >= CLUST_EOFS)
418 1.1 ws continue;
419 1.8 ws
420 1.9 ws if (n == CLUST_FREE || n >= CLUST_RSRVD) {
421 1.8 ws pwarn("Cluster chain starting at %u ends with cluster marked %s\n",
422 1.9 ws head, rsrvdcltype(n));
423 1.9 ws ret |= tryclear(boot, fat, head, &fat[p].next);
424 1.1 ws continue;
425 1.1 ws }
426 1.9 ws if (n < CLUST_FIRST || n >= boot->NumClusters) {
427 1.8 ws pwarn("Cluster chain starting at %u ends with cluster out of range (%u)\n",
428 1.9 ws head, n);
429 1.9 ws ret |= tryclear(boot, fat, head, &fat[p].next);
430 1.9 ws continue;
431 1.1 ws }
432 1.8 ws pwarn("Cluster chains starting at %u and %u are linked at cluster %u\n",
433 1.9 ws head, fat[n].head, n);
434 1.9 ws conf = tryclear(boot, fat, head, &fat[p].next);
435 1.9 ws if (ask(0, "Clear chain starting at %u", h = fat[n].head)) {
436 1.1 ws if (conf == FSERROR) {
437 1.1 ws /*
438 1.1 ws * Transfer the common chain to the one not cleared above.
439 1.1 ws */
440 1.9 ws for (p = n;
441 1.9 ws p >= CLUST_FIRST && p < boot->NumClusters;
442 1.1 ws p = fat[p].next) {
443 1.1 ws if (h != fat[p].head) {
444 1.1 ws /*
445 1.1 ws * Have to reexamine this chain.
446 1.1 ws */
447 1.1 ws head--;
448 1.1 ws break;
449 1.1 ws }
450 1.1 ws fat[p].head = head;
451 1.1 ws }
452 1.1 ws }
453 1.1 ws clearchain(boot, fat, h);
454 1.1 ws conf |= FSFATMOD;
455 1.1 ws }
456 1.1 ws ret |= conf;
457 1.1 ws }
458 1.1 ws
459 1.1 ws return ret;
460 1.1 ws }
461 1.1 ws
462 1.1 ws /*
463 1.1 ws * Write out FATs encoding them from the internal format
464 1.1 ws */
465 1.1 ws int
466 1.16 xtraeme writefat(int fs, struct bootblock *boot, struct fatEntry *fat, int correct_fat)
467 1.1 ws {
468 1.1 ws u_char *buffer, *p;
469 1.1 ws cl_t cl;
470 1.1 ws int i;
471 1.1 ws u_int32_t fatsz;
472 1.1 ws off_t off;
473 1.1 ws int ret = FSOK;
474 1.8 ws
475 1.1 ws buffer = malloc(fatsz = boot->FATsecs * boot->BytesPerSec);
476 1.1 ws if (buffer == NULL) {
477 1.1 ws perror("No space for FAT");
478 1.1 ws return FSFATAL;
479 1.1 ws }
480 1.1 ws memset(buffer, 0, fatsz);
481 1.1 ws boot->NumFree = 0;
482 1.6 ws p = buffer;
483 1.10 jdolecek if (correct_fat) {
484 1.10 jdolecek *p++ = (u_char)boot->Media;
485 1.8 ws *p++ = 0xff;
486 1.8 ws *p++ = 0xff;
487 1.10 jdolecek switch (boot->ClustMask) {
488 1.10 jdolecek case CLUST16_MASK:
489 1.10 jdolecek *p++ = 0xff;
490 1.10 jdolecek break;
491 1.10 jdolecek case CLUST32_MASK:
492 1.10 jdolecek *p++ = 0x0f;
493 1.10 jdolecek *p++ = 0xff;
494 1.10 jdolecek *p++ = 0xff;
495 1.10 jdolecek *p++ = 0xff;
496 1.10 jdolecek *p++ = 0x0f;
497 1.10 jdolecek break;
498 1.10 jdolecek }
499 1.10 jdolecek } else {
500 1.10 jdolecek /* use same FAT signature as the old FAT has */
501 1.10 jdolecek int count;
502 1.10 jdolecek u_char *old_fat;
503 1.10 jdolecek
504 1.10 jdolecek switch (boot->ClustMask) {
505 1.10 jdolecek case CLUST32_MASK:
506 1.10 jdolecek count = 8;
507 1.10 jdolecek break;
508 1.10 jdolecek case CLUST16_MASK:
509 1.10 jdolecek count = 4;
510 1.10 jdolecek break;
511 1.10 jdolecek default:
512 1.10 jdolecek count = 3;
513 1.10 jdolecek break;
514 1.10 jdolecek }
515 1.10 jdolecek
516 1.10 jdolecek if (!_readfat(fs, boot, boot->ValidFat >= 0 ? boot->ValidFat :0,
517 1.10 jdolecek &old_fat)) {
518 1.10 jdolecek free(buffer);
519 1.10 jdolecek return FSFATAL;
520 1.10 jdolecek }
521 1.10 jdolecek
522 1.10 jdolecek memcpy(p, old_fat, count);
523 1.10 jdolecek free(old_fat);
524 1.10 jdolecek p += count;
525 1.8 ws }
526 1.10 jdolecek
527 1.6 ws for (cl = CLUST_FIRST; cl < boot->NumClusters; cl++) {
528 1.8 ws switch (boot->ClustMask) {
529 1.8 ws case CLUST32_MASK:
530 1.8 ws if (fat[cl].next == CLUST_FREE)
531 1.8 ws boot->NumFree++;
532 1.8 ws *p++ = (u_char)fat[cl].next;
533 1.8 ws *p++ = (u_char)(fat[cl].next >> 8);
534 1.8 ws *p++ = (u_char)(fat[cl].next >> 16);
535 1.8 ws *p &= 0xf0;
536 1.8 ws *p++ |= (fat[cl].next >> 24)&0x0f;
537 1.8 ws break;
538 1.8 ws case CLUST16_MASK:
539 1.1 ws if (fat[cl].next == CLUST_FREE)
540 1.1 ws boot->NumFree++;
541 1.8 ws *p++ = (u_char)fat[cl].next;
542 1.8 ws *p++ = (u_char)(fat[cl].next >> 8);
543 1.8 ws break;
544 1.8 ws default:
545 1.1 ws if (fat[cl].next == CLUST_FREE)
546 1.1 ws boot->NumFree++;
547 1.1 ws if (cl + 1 < boot->NumClusters
548 1.1 ws && fat[cl + 1].next == CLUST_FREE)
549 1.1 ws boot->NumFree++;
550 1.8 ws *p++ = (u_char)fat[cl].next;
551 1.8 ws *p++ = (u_char)((fat[cl].next >> 8) & 0xf)
552 1.8 ws |(u_char)(fat[cl+1].next << 4);
553 1.8 ws *p++ = (u_char)(fat[++cl].next >> 4);
554 1.8 ws break;
555 1.1 ws }
556 1.1 ws }
557 1.1 ws for (i = 0; i < boot->FATs; i++) {
558 1.1 ws off = boot->ResSectors + i * boot->FATsecs;
559 1.1 ws off *= boot->BytesPerSec;
560 1.1 ws if (lseek(fs, off, SEEK_SET) != off
561 1.1 ws || write(fs, buffer, fatsz) != fatsz) {
562 1.1 ws perror("Unable to write FAT");
563 1.1 ws ret = FSFATAL; /* Return immediately? XXX */
564 1.1 ws }
565 1.1 ws }
566 1.1 ws free(buffer);
567 1.1 ws return ret;
568 1.1 ws }
569 1.1 ws
570 1.1 ws /*
571 1.1 ws * Check a complete in-memory FAT for lost cluster chains
572 1.1 ws */
573 1.1 ws int
574 1.16 xtraeme checklost(int dosfs, struct bootblock *boot, struct fatEntry *fat)
575 1.1 ws {
576 1.1 ws cl_t head;
577 1.1 ws int mod = FSOK;
578 1.8 ws int ret;
579 1.1 ws
580 1.1 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++) {
581 1.8 ws /* find next untravelled chain */
582 1.1 ws if (fat[head].head != head
583 1.1 ws || fat[head].next == CLUST_FREE
584 1.1 ws || (fat[head].next >= CLUST_RSRVD
585 1.2 ws && fat[head].next < CLUST_EOFS)
586 1.2 ws || (fat[head].flags & FAT_USED))
587 1.1 ws continue;
588 1.1 ws
589 1.8 ws pwarn("Lost cluster chain at cluster %u\n%d Cluster(s) lost\n",
590 1.2 ws head, fat[head].length);
591 1.8 ws mod |= ret = reconnect(dosfs, boot, fat, head);
592 1.2 ws if (mod & FSFATAL)
593 1.2 ws break;
594 1.8 ws if (ret == FSERROR && ask(0, "Clear")) {
595 1.8 ws clearchain(boot, fat, head);
596 1.8 ws mod |= FSFATMOD;
597 1.8 ws }
598 1.1 ws }
599 1.1 ws finishlf();
600 1.8 ws
601 1.8 ws if (boot->FSInfo) {
602 1.8 ws ret = 0;
603 1.8 ws if (boot->FSFree != boot->NumFree) {
604 1.8 ws pwarn("Free space in FSInfo block (%d) not correct (%d)\n",
605 1.8 ws boot->FSFree, boot->NumFree);
606 1.8 ws if (ask(1, "fix")) {
607 1.8 ws boot->FSFree = boot->NumFree;
608 1.8 ws ret = 1;
609 1.8 ws }
610 1.8 ws }
611 1.8 ws if (boot->NumFree && fat[boot->FSNext].next != CLUST_FREE) {
612 1.8 ws pwarn("Next free cluster in FSInfo block (%u) not free\n",
613 1.8 ws boot->FSNext);
614 1.8 ws if (ask(1, "fix"))
615 1.8 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++)
616 1.8 ws if (fat[head].next == CLUST_FREE) {
617 1.8 ws boot->FSNext = head;
618 1.8 ws ret = 1;
619 1.8 ws break;
620 1.8 ws }
621 1.8 ws }
622 1.8 ws if (ret)
623 1.8 ws mod |= writefsinfo(dosfs, boot);
624 1.8 ws }
625 1.8 ws
626 1.1 ws return mod;
627 1.1 ws }
628