fat.c revision 1.18 1 1.18 christos /* $NetBSD: fat.c,v 1.18 2006/06/05 16:51:18 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.18 christos __RCSID("$NetBSD: fat.c,v 1.18 2006/06/05 16:51:18 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.18 christos size_t len;
94 1.1 ws
95 1.18 christos *buffer = malloc(len = boot->FATsecs * boot->BytesPerSec);
96 1.10 jdolecek if (*buffer == NULL) {
97 1.18 christos perr("No space for FAT sectors (%zu)", len);
98 1.10 jdolecek return 0;
99 1.1 ws }
100 1.8 ws
101 1.1 ws off = boot->ResSectors + no * boot->FATsecs;
102 1.1 ws off *= boot->BytesPerSec;
103 1.1 ws
104 1.1 ws if (lseek(fs, off, SEEK_SET) != off) {
105 1.18 christos perr("Unable to read FAT");
106 1.10 jdolecek goto err;
107 1.1 ws }
108 1.8 ws
109 1.10 jdolecek if (read(fs, *buffer, boot->FATsecs * boot->BytesPerSec)
110 1.1 ws != boot->FATsecs * boot->BytesPerSec) {
111 1.18 christos perr("Unable to read FAT");
112 1.10 jdolecek goto err;
113 1.10 jdolecek }
114 1.10 jdolecek
115 1.10 jdolecek return 1;
116 1.10 jdolecek
117 1.10 jdolecek err:
118 1.10 jdolecek free(*buffer);
119 1.10 jdolecek return 0;
120 1.10 jdolecek }
121 1.10 jdolecek
122 1.10 jdolecek /*
123 1.10 jdolecek * Read a FAT and decode it into internal format
124 1.10 jdolecek */
125 1.10 jdolecek int
126 1.16 xtraeme readfat(int fs, struct bootblock *boot, int no, struct fatEntry **fp)
127 1.10 jdolecek {
128 1.10 jdolecek struct fatEntry *fat;
129 1.10 jdolecek u_char *buffer, *p;
130 1.10 jdolecek cl_t cl;
131 1.10 jdolecek int ret = FSOK;
132 1.18 christos size_t len;
133 1.10 jdolecek
134 1.10 jdolecek boot->NumFree = boot->NumBad = 0;
135 1.10 jdolecek
136 1.10 jdolecek if (!_readfat(fs, boot, no, &buffer))
137 1.10 jdolecek return FSFATAL;
138 1.10 jdolecek
139 1.18 christos fat = malloc(len = boot->NumClusters * sizeof(struct fatEntry));
140 1.10 jdolecek if (fat == NULL) {
141 1.18 christos perr("No space for FAT clusters (%zu)", len);
142 1.1 ws free(buffer);
143 1.1 ws return FSFATAL;
144 1.1 ws }
145 1.18 christos (void)memset(fat, 0, len);
146 1.1 ws
147 1.6 ws if (buffer[0] != boot->Media
148 1.6 ws || buffer[1] != 0xff || buffer[2] != 0xff
149 1.8 ws || (boot->ClustMask == CLUST16_MASK && buffer[3] != 0xff)
150 1.8 ws || (boot->ClustMask == CLUST32_MASK
151 1.8 ws && ((buffer[3]&0x0f) != 0x0f
152 1.8 ws || buffer[4] != 0xff || buffer[5] != 0xff
153 1.8 ws || buffer[6] != 0xff || (buffer[7]&0x0f) != 0x0f))) {
154 1.10 jdolecek
155 1.10 jdolecek /* Windows 95 OSR2 (and possibly any later) changes
156 1.10 jdolecek * the FAT signature to 0xXXffff7f for FAT16 and to
157 1.10 jdolecek * 0xXXffff0fffffff07 for FAT32 upon boot, to know that the
158 1.10 jdolecek * filesystem is dirty if it doesn't reboot cleanly.
159 1.10 jdolecek * Check this special condition before errorring out.
160 1.10 jdolecek */
161 1.10 jdolecek if (buffer[0] == boot->Media && buffer[1] == 0xff
162 1.10 jdolecek && buffer[2] == 0xff
163 1.10 jdolecek && ((boot->ClustMask == CLUST16_MASK && buffer[3] == 0x7f)
164 1.10 jdolecek || (boot->ClustMask == CLUST32_MASK
165 1.10 jdolecek && buffer[3] == 0x0f && buffer[4] == 0xff
166 1.10 jdolecek && buffer[5] == 0xff && buffer[6] == 0xff
167 1.10 jdolecek && buffer[7] == 0x07)))
168 1.10 jdolecek ret |= FSDIRTY;
169 1.10 jdolecek else {
170 1.10 jdolecek /* just some odd byte sequence in FAT */
171 1.10 jdolecek
172 1.10 jdolecek switch (boot->ClustMask) {
173 1.10 jdolecek case CLUST32_MASK:
174 1.12 is pwarn("%s (%02x%02x%02x%02x%02x%02x%02x%02x)\n",
175 1.12 is "FAT starts with odd byte sequence",
176 1.12 is buffer[0], buffer[1], buffer[2], buffer[3],
177 1.12 is buffer[4], buffer[5], buffer[6], buffer[7]);
178 1.10 jdolecek break;
179 1.10 jdolecek case CLUST16_MASK:
180 1.13 lukem pwarn("%s (%02x%02x%02x%02x)\n",
181 1.13 lukem "FAT starts with odd byte sequence",
182 1.13 lukem buffer[0], buffer[1], buffer[2], buffer[3]);
183 1.10 jdolecek break;
184 1.10 jdolecek default:
185 1.13 lukem pwarn("%s (%02x%02x%02x)\n",
186 1.13 lukem "FAT starts with odd byte sequence",
187 1.13 lukem buffer[0], buffer[1], buffer[2]);
188 1.10 jdolecek break;
189 1.10 jdolecek }
190 1.8 ws
191 1.10 jdolecek
192 1.10 jdolecek if (ask(1, "Correct"))
193 1.10 jdolecek ret |= FSFIXFAT;
194 1.8 ws }
195 1.1 ws }
196 1.8 ws switch (boot->ClustMask) {
197 1.8 ws case CLUST32_MASK:
198 1.8 ws p = buffer + 8;
199 1.8 ws break;
200 1.8 ws case CLUST16_MASK:
201 1.8 ws p = buffer + 4;
202 1.8 ws break;
203 1.8 ws default:
204 1.8 ws p = buffer + 3;
205 1.8 ws break;
206 1.8 ws }
207 1.1 ws for (cl = CLUST_FIRST; cl < boot->NumClusters;) {
208 1.8 ws switch (boot->ClustMask) {
209 1.8 ws case CLUST32_MASK:
210 1.8 ws fat[cl].next = p[0] + (p[1] << 8)
211 1.8 ws + (p[2] << 16) + (p[3] << 24);
212 1.8 ws fat[cl].next &= boot->ClustMask;
213 1.8 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
214 1.8 ws cl++;
215 1.8 ws p += 4;
216 1.8 ws break;
217 1.8 ws case CLUST16_MASK:
218 1.1 ws fat[cl].next = p[0] + (p[1] << 8);
219 1.1 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
220 1.1 ws cl++;
221 1.1 ws p += 2;
222 1.8 ws break;
223 1.8 ws default:
224 1.1 ws fat[cl].next = (p[0] + (p[1] << 8)) & 0x0fff;
225 1.1 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
226 1.1 ws cl++;
227 1.1 ws if (cl >= boot->NumClusters)
228 1.1 ws break;
229 1.1 ws fat[cl].next = ((p[1] >> 4) + (p[2] << 4)) & 0x0fff;
230 1.1 ws ret |= checkclnum(boot, no, cl, &fat[cl].next);
231 1.1 ws cl++;
232 1.1 ws p += 3;
233 1.8 ws break;
234 1.1 ws }
235 1.1 ws }
236 1.8 ws
237 1.1 ws free(buffer);
238 1.17 christos if (ret & FSFATAL) {
239 1.17 christos free(fat);
240 1.17 christos *fp = NULL;
241 1.17 christos } else
242 1.17 christos *fp = fat;
243 1.1 ws return ret;
244 1.1 ws }
245 1.1 ws
246 1.1 ws /*
247 1.1 ws * Get type of reserved cluster
248 1.1 ws */
249 1.14 wiz const char *
250 1.16 xtraeme rsrvdcltype(cl_t cl)
251 1.1 ws {
252 1.9 ws if (cl == CLUST_FREE)
253 1.9 ws return "free";
254 1.1 ws if (cl < CLUST_BAD)
255 1.1 ws return "reserved";
256 1.1 ws if (cl > CLUST_BAD)
257 1.1 ws return "as EOF";
258 1.1 ws return "bad";
259 1.1 ws }
260 1.1 ws
261 1.1 ws static int
262 1.16 xtraeme clustdiffer(cl_t cl, cl_t *cp1, cl_t *cp2, int fatnum)
263 1.1 ws {
264 1.9 ws if (*cp1 == CLUST_FREE || *cp1 >= CLUST_RSRVD) {
265 1.9 ws if (*cp2 == CLUST_FREE || *cp2 >= CLUST_RSRVD) {
266 1.9 ws if ((*cp1 != CLUST_FREE && *cp1 < CLUST_BAD
267 1.9 ws && *cp2 != CLUST_FREE && *cp2 < CLUST_BAD)
268 1.1 ws || (*cp1 > CLUST_BAD && *cp2 > CLUST_BAD)) {
269 1.8 ws pwarn("Cluster %u is marked %s with different indicators, ",
270 1.1 ws cl, rsrvdcltype(*cp1));
271 1.1 ws if (ask(1, "fix")) {
272 1.1 ws *cp2 = *cp1;
273 1.1 ws return FSFATMOD;
274 1.1 ws }
275 1.1 ws return FSFATAL;
276 1.1 ws }
277 1.8 ws pwarn("Cluster %u is marked %s in FAT 0, %s in FAT %d\n",
278 1.1 ws cl, rsrvdcltype(*cp1), rsrvdcltype(*cp2), fatnum);
279 1.8 ws if (ask(0, "use FAT 0's entry")) {
280 1.1 ws *cp2 = *cp1;
281 1.1 ws return FSFATMOD;
282 1.1 ws }
283 1.8 ws if (ask(0, "use FAT %d's entry", fatnum)) {
284 1.1 ws *cp1 = *cp2;
285 1.1 ws return FSFATMOD;
286 1.1 ws }
287 1.1 ws return FSFATAL;
288 1.1 ws }
289 1.8 ws pwarn("Cluster %u is marked %s in FAT 0, but continues with cluster %u in FAT %d\n",
290 1.1 ws cl, rsrvdcltype(*cp1), *cp2, fatnum);
291 1.1 ws if (ask(0, "Use continuation from FAT %d", fatnum)) {
292 1.1 ws *cp1 = *cp2;
293 1.1 ws return FSFATMOD;
294 1.1 ws }
295 1.8 ws if (ask(0, "Use mark from FAT 0")) {
296 1.1 ws *cp2 = *cp1;
297 1.1 ws return FSFATMOD;
298 1.1 ws }
299 1.1 ws return FSFATAL;
300 1.1 ws }
301 1.9 ws if (*cp2 == CLUST_FREE || *cp2 >= CLUST_RSRVD) {
302 1.8 ws pwarn("Cluster %u continues with cluster %u in FAT 0, but is marked %s in FAT %d\n",
303 1.1 ws cl, *cp1, rsrvdcltype(*cp2), fatnum);
304 1.8 ws if (ask(0, "Use continuation from FAT 0")) {
305 1.1 ws *cp2 = *cp1;
306 1.1 ws return FSFATMOD;
307 1.1 ws }
308 1.1 ws if (ask(0, "Use mark from FAT %d", fatnum)) {
309 1.1 ws *cp1 = *cp2;
310 1.1 ws return FSFATMOD;
311 1.1 ws }
312 1.1 ws return FSERROR;
313 1.1 ws }
314 1.8 ws pwarn("Cluster %u continues with cluster %u in FAT 0, but with cluster %u in FAT %d\n",
315 1.1 ws cl, *cp1, *cp2, fatnum);
316 1.8 ws if (ask(0, "Use continuation from FAT 0")) {
317 1.1 ws *cp2 = *cp1;
318 1.1 ws return FSFATMOD;
319 1.1 ws }
320 1.1 ws if (ask(0, "Use continuation from FAT %d", fatnum)) {
321 1.1 ws *cp1 = *cp2;
322 1.1 ws return FSFATMOD;
323 1.1 ws }
324 1.1 ws return FSERROR;
325 1.1 ws }
326 1.1 ws
327 1.1 ws /*
328 1.1 ws * Compare two FAT copies in memory. Resolve any conflicts and merge them
329 1.1 ws * into the first one.
330 1.1 ws */
331 1.1 ws int
332 1.16 xtraeme comparefat(struct bootblock *boot, struct fatEntry *first,
333 1.16 xtraeme struct fatEntry *second, int fatnum)
334 1.1 ws {
335 1.1 ws cl_t cl;
336 1.1 ws int ret = FSOK;
337 1.1 ws
338 1.1 ws for (cl = CLUST_FIRST; cl < boot->NumClusters; cl++)
339 1.1 ws if (first[cl].next != second[cl].next)
340 1.1 ws ret |= clustdiffer(cl, &first[cl].next, &second[cl].next, fatnum);
341 1.1 ws return ret;
342 1.1 ws }
343 1.1 ws
344 1.1 ws void
345 1.16 xtraeme clearchain(struct bootblock *boot, struct fatEntry *fat, cl_t head)
346 1.1 ws {
347 1.1 ws cl_t p, q;
348 1.1 ws
349 1.1 ws for (p = head; p >= CLUST_FIRST && p < boot->NumClusters; p = q) {
350 1.1 ws if (fat[p].head != head)
351 1.1 ws break;
352 1.1 ws q = fat[p].next;
353 1.1 ws fat[p].next = fat[p].head = CLUST_FREE;
354 1.1 ws fat[p].length = 0;
355 1.1 ws }
356 1.1 ws }
357 1.1 ws
358 1.9 ws int
359 1.16 xtraeme tryclear(struct bootblock *boot, struct fatEntry *fat, cl_t head, cl_t *truncp)
360 1.9 ws {
361 1.9 ws if (ask(0, "Clear chain starting at %u", head)) {
362 1.9 ws clearchain(boot, fat, head);
363 1.9 ws return FSFATMOD;
364 1.9 ws } else if (ask(0, "Truncate")) {
365 1.15 matt *truncp = CLUST_EOF;
366 1.9 ws return FSFATMOD;
367 1.9 ws } else
368 1.9 ws return FSERROR;
369 1.9 ws }
370 1.9 ws
371 1.1 ws /*
372 1.1 ws * Check a complete FAT in-memory for crosslinks
373 1.1 ws */
374 1.1 ws int
375 1.16 xtraeme checkfat(struct bootblock *boot, struct fatEntry *fat)
376 1.1 ws {
377 1.9 ws cl_t head, p, h, n;
378 1.1 ws u_int len;
379 1.1 ws int ret = 0;
380 1.1 ws int conf;
381 1.8 ws
382 1.1 ws /*
383 1.1 ws * pass 1: figure out the cluster chains.
384 1.1 ws */
385 1.1 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++) {
386 1.8 ws /* find next untravelled chain */
387 1.6 ws if (fat[head].head != 0 /* cluster already belongs to some chain */
388 1.5 ws || fat[head].next == CLUST_FREE
389 1.5 ws || fat[head].next == CLUST_BAD)
390 1.1 ws continue; /* skip it. */
391 1.1 ws
392 1.1 ws /* follow the chain and mark all clusters on the way */
393 1.1 ws for (len = 0, p = head;
394 1.1 ws p >= CLUST_FIRST && p < boot->NumClusters;
395 1.1 ws p = fat[p].next) {
396 1.1 ws fat[p].head = head;
397 1.1 ws len++;
398 1.1 ws }
399 1.1 ws
400 1.1 ws /* the head record gets the length */
401 1.8 ws fat[head].length = fat[head].next == CLUST_FREE ? 0 : len;
402 1.1 ws }
403 1.8 ws
404 1.1 ws /*
405 1.1 ws * pass 2: check for crosslinked chains (we couldn't do this in pass 1 because
406 1.1 ws * we didn't know the real start of the chain then - would have treated partial
407 1.1 ws * chains as interlinked with their main chain)
408 1.1 ws */
409 1.1 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++) {
410 1.8 ws /* find next untravelled chain */
411 1.1 ws if (fat[head].head != head)
412 1.1 ws continue;
413 1.1 ws
414 1.1 ws /* follow the chain to its end (hopefully) */
415 1.1 ws for (p = head;
416 1.9 ws (n = fat[p].next) >= CLUST_FIRST && n < boot->NumClusters;
417 1.9 ws p = n)
418 1.9 ws if (fat[n].head != head)
419 1.1 ws break;
420 1.9 ws if (n >= CLUST_EOFS)
421 1.1 ws continue;
422 1.8 ws
423 1.9 ws if (n == CLUST_FREE || n >= CLUST_RSRVD) {
424 1.8 ws pwarn("Cluster chain starting at %u ends with cluster marked %s\n",
425 1.9 ws head, rsrvdcltype(n));
426 1.9 ws ret |= tryclear(boot, fat, head, &fat[p].next);
427 1.1 ws continue;
428 1.1 ws }
429 1.9 ws if (n < CLUST_FIRST || n >= boot->NumClusters) {
430 1.8 ws pwarn("Cluster chain starting at %u ends with cluster out of range (%u)\n",
431 1.9 ws head, n);
432 1.9 ws ret |= tryclear(boot, fat, head, &fat[p].next);
433 1.9 ws continue;
434 1.1 ws }
435 1.8 ws pwarn("Cluster chains starting at %u and %u are linked at cluster %u\n",
436 1.9 ws head, fat[n].head, n);
437 1.9 ws conf = tryclear(boot, fat, head, &fat[p].next);
438 1.9 ws if (ask(0, "Clear chain starting at %u", h = fat[n].head)) {
439 1.1 ws if (conf == FSERROR) {
440 1.1 ws /*
441 1.1 ws * Transfer the common chain to the one not cleared above.
442 1.1 ws */
443 1.9 ws for (p = n;
444 1.9 ws p >= CLUST_FIRST && p < boot->NumClusters;
445 1.1 ws p = fat[p].next) {
446 1.1 ws if (h != fat[p].head) {
447 1.1 ws /*
448 1.1 ws * Have to reexamine this chain.
449 1.1 ws */
450 1.1 ws head--;
451 1.1 ws break;
452 1.1 ws }
453 1.1 ws fat[p].head = head;
454 1.1 ws }
455 1.1 ws }
456 1.1 ws clearchain(boot, fat, h);
457 1.1 ws conf |= FSFATMOD;
458 1.1 ws }
459 1.1 ws ret |= conf;
460 1.1 ws }
461 1.1 ws
462 1.1 ws return ret;
463 1.1 ws }
464 1.1 ws
465 1.1 ws /*
466 1.1 ws * Write out FATs encoding them from the internal format
467 1.1 ws */
468 1.1 ws int
469 1.16 xtraeme writefat(int fs, struct bootblock *boot, struct fatEntry *fat, int correct_fat)
470 1.1 ws {
471 1.1 ws u_char *buffer, *p;
472 1.1 ws cl_t cl;
473 1.1 ws int i;
474 1.1 ws u_int32_t fatsz;
475 1.1 ws off_t off;
476 1.1 ws int ret = FSOK;
477 1.8 ws
478 1.1 ws buffer = malloc(fatsz = boot->FATsecs * boot->BytesPerSec);
479 1.1 ws if (buffer == NULL) {
480 1.18 christos perr("No space for FAT sectors (%zu)", fatsz);
481 1.1 ws return FSFATAL;
482 1.1 ws }
483 1.1 ws memset(buffer, 0, fatsz);
484 1.1 ws boot->NumFree = 0;
485 1.6 ws p = buffer;
486 1.10 jdolecek if (correct_fat) {
487 1.10 jdolecek *p++ = (u_char)boot->Media;
488 1.8 ws *p++ = 0xff;
489 1.8 ws *p++ = 0xff;
490 1.10 jdolecek switch (boot->ClustMask) {
491 1.10 jdolecek case CLUST16_MASK:
492 1.10 jdolecek *p++ = 0xff;
493 1.10 jdolecek break;
494 1.10 jdolecek case CLUST32_MASK:
495 1.10 jdolecek *p++ = 0x0f;
496 1.10 jdolecek *p++ = 0xff;
497 1.10 jdolecek *p++ = 0xff;
498 1.10 jdolecek *p++ = 0xff;
499 1.10 jdolecek *p++ = 0x0f;
500 1.10 jdolecek break;
501 1.10 jdolecek }
502 1.10 jdolecek } else {
503 1.10 jdolecek /* use same FAT signature as the old FAT has */
504 1.10 jdolecek int count;
505 1.10 jdolecek u_char *old_fat;
506 1.10 jdolecek
507 1.10 jdolecek switch (boot->ClustMask) {
508 1.10 jdolecek case CLUST32_MASK:
509 1.10 jdolecek count = 8;
510 1.10 jdolecek break;
511 1.10 jdolecek case CLUST16_MASK:
512 1.10 jdolecek count = 4;
513 1.10 jdolecek break;
514 1.10 jdolecek default:
515 1.10 jdolecek count = 3;
516 1.10 jdolecek break;
517 1.10 jdolecek }
518 1.10 jdolecek
519 1.10 jdolecek if (!_readfat(fs, boot, boot->ValidFat >= 0 ? boot->ValidFat :0,
520 1.10 jdolecek &old_fat)) {
521 1.10 jdolecek free(buffer);
522 1.10 jdolecek return FSFATAL;
523 1.10 jdolecek }
524 1.10 jdolecek
525 1.10 jdolecek memcpy(p, old_fat, count);
526 1.10 jdolecek free(old_fat);
527 1.10 jdolecek p += count;
528 1.8 ws }
529 1.10 jdolecek
530 1.6 ws for (cl = CLUST_FIRST; cl < boot->NumClusters; cl++) {
531 1.8 ws switch (boot->ClustMask) {
532 1.8 ws case CLUST32_MASK:
533 1.8 ws if (fat[cl].next == CLUST_FREE)
534 1.8 ws boot->NumFree++;
535 1.8 ws *p++ = (u_char)fat[cl].next;
536 1.8 ws *p++ = (u_char)(fat[cl].next >> 8);
537 1.8 ws *p++ = (u_char)(fat[cl].next >> 16);
538 1.8 ws *p &= 0xf0;
539 1.8 ws *p++ |= (fat[cl].next >> 24)&0x0f;
540 1.8 ws break;
541 1.8 ws case CLUST16_MASK:
542 1.1 ws if (fat[cl].next == CLUST_FREE)
543 1.1 ws boot->NumFree++;
544 1.8 ws *p++ = (u_char)fat[cl].next;
545 1.8 ws *p++ = (u_char)(fat[cl].next >> 8);
546 1.8 ws break;
547 1.8 ws default:
548 1.1 ws if (fat[cl].next == CLUST_FREE)
549 1.1 ws boot->NumFree++;
550 1.1 ws if (cl + 1 < boot->NumClusters
551 1.1 ws && fat[cl + 1].next == CLUST_FREE)
552 1.1 ws boot->NumFree++;
553 1.8 ws *p++ = (u_char)fat[cl].next;
554 1.8 ws *p++ = (u_char)((fat[cl].next >> 8) & 0xf)
555 1.8 ws |(u_char)(fat[cl+1].next << 4);
556 1.8 ws *p++ = (u_char)(fat[++cl].next >> 4);
557 1.8 ws break;
558 1.1 ws }
559 1.1 ws }
560 1.1 ws for (i = 0; i < boot->FATs; i++) {
561 1.1 ws off = boot->ResSectors + i * boot->FATsecs;
562 1.1 ws off *= boot->BytesPerSec;
563 1.1 ws if (lseek(fs, off, SEEK_SET) != off
564 1.1 ws || write(fs, buffer, fatsz) != fatsz) {
565 1.18 christos perr("Unable to write FAT");
566 1.1 ws ret = FSFATAL; /* Return immediately? XXX */
567 1.1 ws }
568 1.1 ws }
569 1.1 ws free(buffer);
570 1.1 ws return ret;
571 1.1 ws }
572 1.1 ws
573 1.1 ws /*
574 1.1 ws * Check a complete in-memory FAT for lost cluster chains
575 1.1 ws */
576 1.1 ws int
577 1.16 xtraeme checklost(int dosfs, struct bootblock *boot, struct fatEntry *fat)
578 1.1 ws {
579 1.1 ws cl_t head;
580 1.1 ws int mod = FSOK;
581 1.8 ws int ret;
582 1.1 ws
583 1.1 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++) {
584 1.8 ws /* find next untravelled chain */
585 1.1 ws if (fat[head].head != head
586 1.1 ws || fat[head].next == CLUST_FREE
587 1.1 ws || (fat[head].next >= CLUST_RSRVD
588 1.2 ws && fat[head].next < CLUST_EOFS)
589 1.2 ws || (fat[head].flags & FAT_USED))
590 1.1 ws continue;
591 1.1 ws
592 1.8 ws pwarn("Lost cluster chain at cluster %u\n%d Cluster(s) lost\n",
593 1.2 ws head, fat[head].length);
594 1.8 ws mod |= ret = reconnect(dosfs, boot, fat, head);
595 1.2 ws if (mod & FSFATAL)
596 1.2 ws break;
597 1.8 ws if (ret == FSERROR && ask(0, "Clear")) {
598 1.8 ws clearchain(boot, fat, head);
599 1.8 ws mod |= FSFATMOD;
600 1.8 ws }
601 1.1 ws }
602 1.1 ws finishlf();
603 1.8 ws
604 1.8 ws if (boot->FSInfo) {
605 1.8 ws ret = 0;
606 1.8 ws if (boot->FSFree != boot->NumFree) {
607 1.8 ws pwarn("Free space in FSInfo block (%d) not correct (%d)\n",
608 1.8 ws boot->FSFree, boot->NumFree);
609 1.8 ws if (ask(1, "fix")) {
610 1.8 ws boot->FSFree = boot->NumFree;
611 1.8 ws ret = 1;
612 1.8 ws }
613 1.8 ws }
614 1.8 ws if (boot->NumFree && fat[boot->FSNext].next != CLUST_FREE) {
615 1.8 ws pwarn("Next free cluster in FSInfo block (%u) not free\n",
616 1.8 ws boot->FSNext);
617 1.8 ws if (ask(1, "fix"))
618 1.8 ws for (head = CLUST_FIRST; head < boot->NumClusters; head++)
619 1.8 ws if (fat[head].next == CLUST_FREE) {
620 1.8 ws boot->FSNext = head;
621 1.8 ws ret = 1;
622 1.8 ws break;
623 1.8 ws }
624 1.8 ws }
625 1.8 ws if (ret)
626 1.8 ws mod |= writefsinfo(dosfs, boot);
627 1.8 ws }
628 1.8 ws
629 1.1 ws return mod;
630 1.1 ws }
631