source: mainline/uspace/srv/fs/fat/fat_fat.c@ 7ece4247

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 7ece4247 was 7ece4247, checked in by Jakub Jermar <jakub@…>, 14 years ago

Cleanup.

  • Property mode set to 100644
File size: 25.4 KB
RevLine 
[6ebaff9]1/*
2 * Copyright (c) 2008 Jakub Jermar
[c4bbca8]3 * Copyright (c) 2011 Oleg Romanenko
[6ebaff9]4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * - Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * - Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * - The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30/** @addtogroup fs
31 * @{
[97bc3ee]32 */
[6ebaff9]33
34/**
35 * @file fat_fat.c
[0ec862d]36 * @brief Functions that manipulate the File Allocation Tables.
[6ebaff9]37 */
38
[0f57d0e]39#include "fat_fat.h"
40#include "fat_dentry.h"
41#include "fat.h"
42#include "../../vfs/vfs.h"
43#include <libfs.h>
[fc840d9]44#include <libblock.h>
[0f57d0e]45#include <errno.h>
46#include <byteorder.h>
47#include <align.h>
48#include <assert.h>
[1e4cada]49#include <fibril_synch.h>
[c7bbf029]50#include <malloc.h>
[c20aa06]51#include <mem.h>
[0ec862d]52
[979c313a]53#define IS_ODD(number) (number & 0x1)
54
[0ec862d]55/**
[6ebe721]56 * The fat_alloc_lock mutex protects all copies of the File Allocation Table
[0ec862d]57 * during allocation of clusters. The lock does not have to be held durring
58 * deallocation of clusters.
[97bc3ee]59 */
[6ebe721]60static FIBRIL_MUTEX_INITIALIZE(fat_alloc_lock);
[0f57d0e]61
[4f1c0b4]62/** Walk the cluster chain.
[9f95a80]63 *
[4f1c0b4]64 * @param bs Buffer holding the boot sector for the file.
[15f3c3f]65 * @param service_id Service ID of the device with the file.
[4f1c0b4]66 * @param firstc First cluster to start the walk with.
[e402382]67 * @param lastc If non-NULL, output argument hodling the last cluster
68 * number visited.
69 * @param numc If non-NULL, output argument holding the number of
70 * clusters seen during the walk.
[97bc3ee]71 * @param max_clusters Maximum number of clusters to visit.
[9f95a80]72 *
[e402382]73 * @return EOK on success or a negative error code.
[9f95a80]74 */
[97bc3ee]75int
[15f3c3f]76fat_cluster_walk(fat_bs_t *bs, service_id_t service_id, fat_cluster_t firstc,
[d963742]77 fat_cluster_t *lastc, uint32_t *numc, uint32_t max_clusters)
[0f57d0e]78{
[d963742]79 uint32_t clusters = 0;
[d260a95]80 fat_cluster_t clst = firstc, clst_last1 = FAT_CLST_LAST1(bs);
81 fat_cluster_t clst_bad = FAT_CLST_BAD(bs);
[c91f2d1b]82 int rc;
[0f57d0e]83
[4f1c0b4]84 if (firstc == FAT_CLST_RES0) {
85 /* No space allocated to the file. */
[6c8d267]86 if (lastc)
87 *lastc = firstc;
[e402382]88 if (numc)
89 *numc = 0;
90 return EOK;
[0f57d0e]91 }
92
[fc35e98]93 while (clst < clst_last1 && clusters < max_clusters) {
[4f1c0b4]94 assert(clst >= FAT_CLST_FIRST);
[6c8d267]95 if (lastc)
96 *lastc = clst; /* remember the last cluster number */
[fc35e98]97
[0f57d0e]98 /* read FAT1 */
[375ab5e]99 rc = fat_get_cluster(bs, service_id, FAT1, clst, &clst);
[e402382]100 if (rc != EOK)
101 return rc;
[fc35e98]102
[d260a95]103 assert(clst != clst_bad);
[4f1c0b4]104 clusters++;
[0f57d0e]105 }
106
[fc35e98]107 if (lastc && clst < clst_last1)
[6c8d267]108 *lastc = clst;
[e402382]109 if (numc)
110 *numc = clusters;
[0f57d0e]111
[e402382]112 return EOK;
[0f57d0e]113}
114
[746f623]115/** Read block from file located on a FAT file system.
116 *
117 * @param block Pointer to a block pointer for storing result.
118 * @param bs Buffer holding the boot sector of the file system.
119 * @param nodep FAT node.
120 * @param bn Block number.
121 * @param flags Flags passed to libblock.
122 *
123 * @return EOK on success or a negative error code.
124 */
125int
126fat_block_get(block_t **block, struct fat_bs *bs, fat_node_t *nodep,
127 aoff64_t bn, int flags)
128{
[dba4a23]129 fat_cluster_t firstc = nodep->firstc;
130 fat_cluster_t currc;
131 aoff64_t relbn = bn;
132 int rc;
133
[746f623]134 if (!nodep->size)
135 return ELIMIT;
136
[b5db2ae]137 if (!FAT_IS_FAT32(bs) && nodep->firstc == FAT_CLST_ROOT)
[ed6cf34b]138 goto fall_through;
139
140 if (((((nodep->size - 1) / BPS(bs)) / SPC(bs)) == bn / SPC(bs)) &&
141 nodep->lastc_cached_valid) {
[746f623]142 /*
143 * This is a request to read a block within the last cluster
144 * when fortunately we have the last cluster number cached.
145 */
[15f3c3f]146 return block_get(block, nodep->idx->service_id,
[ed6cf34b]147 CLBN2PBN(bs, nodep->lastc_cached_value, bn), flags);
[746f623]148 }
[ed6cf34b]149
[dba4a23]150 if (nodep->currc_cached_valid && bn >= nodep->currc_cached_bn) {
151 /*
152 * We can start with the cluster cached by the previous call to
153 * fat_block_get().
154 */
155 firstc = nodep->currc_cached_value;
156 relbn -= (nodep->currc_cached_bn / SPC(bs)) * SPC(bs);
157 }
158
[ed6cf34b]159fall_through:
[15f3c3f]160 rc = _fat_block_get(block, bs, nodep->idx->service_id, firstc,
[dba4a23]161 &currc, relbn, flags);
162 if (rc != EOK)
163 return rc;
[97bc3ee]164
[dba4a23]165 /*
166 * Update the "current" cluster cache.
167 */
168 nodep->currc_cached_valid = true;
169 nodep->currc_cached_bn = bn;
170 nodep->currc_cached_value = currc;
171
172 return rc;
[746f623]173}
174
[4f1c0b4]175/** Read block from file located on a FAT file system.
[0f57d0e]176 *
[684b655]177 * @param block Pointer to a block pointer for storing result.
[4f1c0b4]178 * @param bs Buffer holding the boot sector of the file system.
[15f3c3f]179 * @param service_id Service ID handle of the file system.
[6da81e0]180 * @param fcl First cluster used by the file. Can be zero if the file
[4f1c0b4]181 * is empty.
[6da81e0]182 * @param clp If not NULL, address where the cluster containing bn
183 * will be stored.
[97bc3ee]184 * stored
[6c8d267]185 * @param bn Block number.
[1d8cdb1]186 * @param flags Flags passed to libblock.
[0f57d0e]187 *
[684b655]188 * @return EOK on success or a negative error code.
[0f57d0e]189 */
[684b655]190int
[15f3c3f]191_fat_block_get(block_t **block, fat_bs_t *bs, service_id_t service_id,
[6da81e0]192 fat_cluster_t fcl, fat_cluster_t *clp, aoff64_t bn, int flags)
[0f57d0e]193{
[d963742]194 uint32_t clusters;
195 uint32_t max_clusters;
[6da81e0]196 fat_cluster_t c;
[c91f2d1b]197 int rc;
[0f57d0e]198
[5178ee2]199 /*
200 * This function can only operate on non-zero length files.
201 */
[6da81e0]202 if (fcl == FAT_CLST_RES0)
[5178ee2]203 return ELIMIT;
204
[b5db2ae]205 if (!FAT_IS_FAT32(bs) && fcl == FAT_CLST_ROOT) {
[4f1c0b4]206 /* root directory special case */
[ed6cf34b]207 assert(bn < RDS(bs));
[15f3c3f]208 rc = block_get(block, service_id,
[ed6cf34b]209 RSCNT(bs) + FATCNT(bs) * SF(bs) + bn, flags);
[684b655]210 return rc;
[0f57d0e]211 }
212
[ed6cf34b]213 max_clusters = bn / SPC(bs);
[15f3c3f]214 rc = fat_cluster_walk(bs, service_id, fcl, &c, &clusters, max_clusters);
[e402382]215 if (rc != EOK)
216 return rc;
[4f1c0b4]217 assert(clusters == max_clusters);
[0f57d0e]218
[15f3c3f]219 rc = block_get(block, service_id, CLBN2PBN(bs, c, bn), flags);
[6da81e0]220
221 if (clp)
222 *clp = c;
[0f57d0e]223
[684b655]224 return rc;
[0f57d0e]225}
226
227/** Fill the gap between EOF and a new file position.
228 *
[cb682eb]229 * @param bs Buffer holding the boot sector for nodep.
[0f57d0e]230 * @param nodep FAT node with the gap.
231 * @param mcl First cluster in an independent cluster chain that will
232 * be later appended to the end of the node's own cluster
233 * chain. If pos is still in the last allocated cluster,
234 * this argument is ignored.
235 * @param pos Position in the last node block.
[cca29e3c]236 *
237 * @return EOK on success or a negative error code.
[0f57d0e]238 */
[5d95f02]239int
240fat_fill_gap(fat_bs_t *bs, fat_node_t *nodep, fat_cluster_t mcl, aoff64_t pos)
[0f57d0e]241{
[cb682eb]242 block_t *b;
[ed903174]243 aoff64_t o, boundary;
[c91f2d1b]244 int rc;
[0f57d0e]245
[ed6cf34b]246 boundary = ROUND_UP(nodep->size, BPS(bs) * SPC(bs));
[0f57d0e]247
248 /* zero out already allocated space */
[abd36f7]249 for (o = nodep->size; o < pos && o < boundary;
[ed6cf34b]250 o = ALIGN_DOWN(o + BPS(bs), BPS(bs))) {
251 int flags = (o % BPS(bs) == 0) ?
[1d8cdb1]252 BLOCK_FLAGS_NOREAD : BLOCK_FLAGS_NONE;
[ed6cf34b]253 rc = fat_block_get(&b, bs, nodep, o / BPS(bs), flags);
[cca29e3c]254 if (rc != EOK)
255 return rc;
[ed6cf34b]256 memset(b->data + o % BPS(bs), 0, BPS(bs) - o % BPS(bs));
[0f57d0e]257 b->dirty = true; /* need to sync node */
[c91f2d1b]258 rc = block_put(b);
[cca29e3c]259 if (rc != EOK)
260 return rc;
[0f57d0e]261 }
[97bc3ee]262
[0f57d0e]263 if (o >= pos)
[cca29e3c]264 return EOK;
[97bc3ee]265
[0f57d0e]266 /* zero out the initial part of the new cluster chain */
[ed6cf34b]267 for (o = boundary; o < pos; o += BPS(bs)) {
[15f3c3f]268 rc = _fat_block_get(&b, bs, nodep->idx->service_id, mcl,
[6da81e0]269 NULL, (o - boundary) / BPS(bs), BLOCK_FLAGS_NOREAD);
[cca29e3c]270 if (rc != EOK)
271 return rc;
[ed6cf34b]272 memset(b->data, 0, min(BPS(bs), pos - o));
[0f57d0e]273 b->dirty = true; /* need to sync node */
[c91f2d1b]274 rc = block_put(b);
[cca29e3c]275 if (rc != EOK)
276 return rc;
[0f57d0e]277 }
[cca29e3c]278
279 return EOK;
[0f57d0e]280}
281
[5d95f02]282/** Get cluster from the first FAT.
[913a821c]283 *
284 * @param bs Buffer holding the boot sector for the file system.
[375ab5e]285 * @param service_id Service ID for the file system.
[913a821c]286 * @param clst Cluster which to get.
[dc87ad11]287 * @param value Output argument holding the value of the cluster.
[913a821c]288 *
[dc87ad11]289 * @return EOK or a negative error code.
[913a821c]290 */
[7ece4247]291static int
[375ab5e]292fat_get_cluster_fat12(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[711e1f32]293 fat_cluster_t clst, fat_cluster_t *value)
[913a821c]294{
[97bc3ee]295 block_t *b, *b1;
[0182e5cc]296 uint16_t byte1, byte2;
[d260a95]297 aoff64_t offset;
[c91f2d1b]298 int rc;
[913a821c]299
[5d95f02]300 offset = (clst + clst / 2);
[b9060a83]301 if (offset / BPS(bs) >= SF(bs))
302 return ERANGE;
303
[375ab5e]304 rc = block_get(&b, service_id, RSCNT(bs) + SF(bs) * fatno +
[d260a95]305 offset / BPS(bs), BLOCK_FLAGS_NONE);
306 if (rc != EOK)
307 return rc;
308
[5d95f02]309 byte1 = ((uint8_t *) b->data)[offset % BPS(bs)];
[88a27f1]310 /* This cluster access spans a sector boundary. Check only for FAT12 */
[b9060a83]311 if ((offset % BPS(bs)) + 1 == BPS(bs)) {
[5d95f02]312 /* Is this the last sector of FAT? */
[88a27f1]313 if (offset / BPS(bs) < SF(bs)) {
[5d95f02]314 /* No, read the next sector */
[375ab5e]315 rc = block_get(&b1, service_id, 1 + RSCNT(bs) +
[5d95f02]316 SF(bs) * fatno + offset / BPS(bs),
317 BLOCK_FLAGS_NONE);
[88a27f1]318 if (rc != EOK) {
319 block_put(b);
320 return rc;
[d260a95]321 }
[88a27f1]322 /*
323 * Combining value with last byte of current sector and
324 * first byte of next sector
325 */
[0182e5cc]326 byte2 = ((uint8_t*) b1->data)[0];
[88a27f1]327
328 rc = block_put(b1);
329 if (rc != EOK) {
[d260a95]330 block_put(b);
[88a27f1]331 return rc;
[d260a95]332 }
[5d95f02]333 } else {
334 /* Yes. This is the last sector of FAT */
[88a27f1]335 block_put(b);
336 return ERANGE;
337 }
[5d95f02]338 } else
339 byte2 = ((uint8_t *) b->data)[(offset % BPS(bs)) + 1];
[0182e5cc]340
[efa8ed93]341 *value = uint16_t_le2host(byte1 | (byte2 << 8));
[88a27f1]342 if (IS_ODD(clst))
[b9060a83]343 *value = (*value) >> 4;
[88a27f1]344 else
[b9060a83]345 *value = (*value) & FAT12_MASK;
346
[c91f2d1b]347 rc = block_put(b);
[5d95f02]348
[dc87ad11]349 return rc;
[913a821c]350}
351
[5d95f02]352/** Get cluster from the first FAT.
[88a27f1]353 *
354 * @param bs Buffer holding the boot sector for the file system.
[375ab5e]355 * @param service_id Service ID for the file system.
[88a27f1]356 * @param clst Cluster which to get.
357 * @param value Output argument holding the value of the cluster.
358 *
359 * @return EOK or a negative error code.
360 */
[7ece4247]361static int
[375ab5e]362fat_get_cluster_fat16(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[88a27f1]363 fat_cluster_t clst, fat_cluster_t *value)
364{
365 block_t *b;
366 aoff64_t offset;
367 int rc;
368
369 offset = (clst * FAT16_CLST_SIZE);
370
[375ab5e]371 rc = block_get(&b, service_id, RSCNT(bs) + SF(bs) * fatno +
[88a27f1]372 offset / BPS(bs), BLOCK_FLAGS_NONE);
373 if (rc != EOK)
374 return rc;
375
376 *value = uint16_t_le2host(*(uint16_t *)(b->data + offset % BPS(bs)));
377
378 rc = block_put(b);
379
380 return rc;
381}
382
[5d95f02]383/** Get cluster from the first FAT.
[88a27f1]384 *
385 * @param bs Buffer holding the boot sector for the file system.
[375ab5e]386 * @param service_id Service ID for the file system.
[88a27f1]387 * @param clst Cluster which to get.
388 * @param value Output argument holding the value of the cluster.
389 *
390 * @return EOK or a negative error code.
391 */
[7ece4247]392static int
[375ab5e]393fat_get_cluster_fat32(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[88a27f1]394 fat_cluster_t clst, fat_cluster_t *value)
395{
396 block_t *b;
397 aoff64_t offset;
398 int rc;
399
400 offset = (clst * FAT32_CLST_SIZE);
401
[375ab5e]402 rc = block_get(&b, service_id, RSCNT(bs) + SF(bs) * fatno +
[88a27f1]403 offset / BPS(bs), BLOCK_FLAGS_NONE);
404 if (rc != EOK)
405 return rc;
406
[5d95f02]407 *value = uint32_t_le2host(*(uint32_t *)(b->data + offset % BPS(bs))) &
408 FAT32_MASK;
[88a27f1]409
410 rc = block_put(b);
411
412 return rc;
413}
414
415
[913a821c]416/** Get cluster from the first FAT.
417 *
418 * @param bs Buffer holding the boot sector for the file system.
[15f3c3f]419 * @param service_id Service ID for the file system.
[913a821c]420 * @param clst Cluster which to get.
[dc87ad11]421 * @param value Output argument holding the value of the cluster.
[913a821c]422 *
[dc87ad11]423 * @return EOK or a negative error code.
[913a821c]424 */
[dc87ad11]425int
[15f3c3f]426fat_get_cluster(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[711e1f32]427 fat_cluster_t clst, fat_cluster_t *value)
[88a27f1]428{
429 int rc;
430
431 assert(fatno < FATCNT(bs));
432
[5d95f02]433 if (FAT_IS_FAT12(bs))
[375ab5e]434 rc = fat_get_cluster_fat12(bs, service_id, fatno, clst, value);
[5d95f02]435 else if (FAT_IS_FAT16(bs))
436 rc = fat_get_cluster_fat16(bs, service_id, fatno, clst, value);
437 else
438 rc = fat_get_cluster_fat32(bs, service_id, fatno, clst, value);
[88a27f1]439
440 return rc;
441}
442
[5d95f02]443/** Set cluster in one instance of FAT.
[9f95a80]444 *
445 * @param bs Buffer holding the boot sector for the file system.
[375ab5e]446 * @param service_id Service ID for the file system.
[9f95a80]447 * @param fatno Number of the FAT instance where to make the change.
[913a821c]448 * @param clst Cluster which is to be set.
449 * @param value Value to set the cluster with.
[cca29e3c]450 *
451 * @return EOK on success or a negative error code.
[9f95a80]452 */
[7ece4247]453static int
[375ab5e]454fat_set_cluster_fat12(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[cb682eb]455 fat_cluster_t clst, fat_cluster_t value)
[0f57d0e]456{
[5d95f02]457 block_t *b, *b1 = NULL;
[d260a95]458 aoff64_t offset;
[0182e5cc]459 uint16_t byte1, byte2;
[c91f2d1b]460 int rc;
[fc35e98]461
[5d95f02]462 offset = (clst + clst / 2);
[b9060a83]463 if (offset / BPS(bs) >= SF(bs))
464 return ERANGE;
465
[375ab5e]466 rc = block_get(&b, service_id, RSCNT(bs) + SF(bs) * fatno +
[d260a95]467 offset / BPS(bs), BLOCK_FLAGS_NONE);
[cca29e3c]468 if (rc != EOK)
469 return rc;
[fc35e98]470
[b9060a83]471 byte1 = ((uint8_t*) b->data)[offset % BPS(bs)];
[88a27f1]472 bool border = false;
[5d95f02]473 /* This cluster access spans a sector boundary. */
474 if ((offset % BPS(bs)) + 1 == BPS(bs)) {
475 /* Is it the last sector of FAT? */
[88a27f1]476 if (offset / BPS(bs) < SF(bs)) {
[5d95f02]477 /* No, read the next sector */
[375ab5e]478 rc = block_get(&b1, service_id, 1 + RSCNT(bs) +
[5d95f02]479 SF(bs) * fatno + offset / BPS(bs),
480 BLOCK_FLAGS_NONE);
[88a27f1]481 if (rc != EOK) {
[d260a95]482 block_put(b);
[88a27f1]483 return rc;
[d260a95]484 }
[88a27f1]485 /*
[b9060a83]486 * Combining value with last byte of current sector and
487 * first byte of next sector
488 */
[5d95f02]489 byte2 = ((uint8_t *) b1->data)[0];
[88a27f1]490 border = true;
[5d95f02]491 } else {
492 /* Yes. This is the last sector of FAT */
[88a27f1]493 block_put(b);
494 return ERANGE;
[d260a95]495 }
[7ece4247]496 } else
[5d95f02]497 byte2 = ((uint8_t*) b->data)[(offset % BPS(bs)) + 1];
[d260a95]498
[88a27f1]499 if (IS_ODD(clst)) {
[0182e5cc]500 byte1 &= 0x0f;
501 byte2 = 0;
502 value = (value << 4);
503 } else {
504 byte1 = 0;
505 byte2 &= 0xf0;
506 value &= FAT12_MASK;
[a8c14aa]507 }
508
[0182e5cc]509 byte1 = byte1 | (value & 0xff);
510 byte2 = byte2 | (value >> 8);
511
[5d95f02]512 ((uint8_t *) b->data)[(offset % BPS(bs))] = byte1;
[88a27f1]513 if (border) {
[5d95f02]514 ((uint8_t *) b1->data)[0] = byte2;
[88a27f1]515
[0182e5cc]516 b1->dirty = true;
[a8c14aa]517 rc = block_put(b1);
518 if (rc != EOK) {
519 block_put(b);
520 return rc;
[d260a95]521 }
[0182e5cc]522 } else
[5d95f02]523 ((uint8_t *) b->data)[(offset % BPS(bs)) + 1] = byte2;
[d260a95]524
525 b->dirty = true; /* need to sync block */
[c91f2d1b]526 rc = block_put(b);
[5d95f02]527
[cca29e3c]528 return rc;
[0f57d0e]529}
530
[5d95f02]531/** Set cluster in one instance of FAT.
[88a27f1]532 *
533 * @param bs Buffer holding the boot sector for the file system.
[375ab5e]534 * @param service_id Service ID for the file system.
[88a27f1]535 * @param fatno Number of the FAT instance where to make the change.
536 * @param clst Cluster which is to be set.
537 * @param value Value to set the cluster with.
538 *
539 * @return EOK on success or a negative error code.
540 */
[7ece4247]541static int
[375ab5e]542fat_set_cluster_fat16(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[88a27f1]543 fat_cluster_t clst, fat_cluster_t value)
[913a821c]544{
545 block_t *b;
[88a27f1]546 aoff64_t offset;
[c91f2d1b]547 int rc;
[913a821c]548
[88a27f1]549 offset = (clst * FAT16_CLST_SIZE);
550
[15f3c3f]551 rc = block_get(&b, service_id, RSCNT(bs) + SF(bs) * fatno +
[88a27f1]552 offset / BPS(bs), BLOCK_FLAGS_NONE);
[dc87ad11]553 if (rc != EOK)
554 return rc;
[88a27f1]555
[0182e5cc]556 *(uint16_t *)(b->data + offset % BPS(bs)) = host2uint16_t_le(value);
[88a27f1]557
558 b->dirty = true; /* need to sync block */
[c91f2d1b]559 rc = block_put(b);
[5d95f02]560
[dc87ad11]561 return rc;
[913a821c]562}
563
[5d95f02]564/** Set cluster in one instance of FAT.
[9f95a80]565 *
566 * @param bs Buffer holding the boot sector for the file system.
[375ab5e]567 * @param service_id Service ID for the file system.
[9f95a80]568 * @param fatno Number of the FAT instance where to make the change.
[913a821c]569 * @param clst Cluster which is to be set.
570 * @param value Value to set the cluster with.
[cca29e3c]571 *
572 * @return EOK on success or a negative error code.
[9f95a80]573 */
[7ece4247]574static int
[375ab5e]575fat_set_cluster_fat32(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[cb682eb]576 fat_cluster_t clst, fat_cluster_t value)
[0f57d0e]577{
[cb682eb]578 block_t *b;
[88a27f1]579 aoff64_t offset;
[c91f2d1b]580 int rc;
[17fa0280]581 fat_cluster_t temp;
[88a27f1]582
583 offset = (clst * FAT32_CLST_SIZE);
[23b56ca]584
[15f3c3f]585 rc = block_get(&b, service_id, RSCNT(bs) + SF(bs) * fatno +
[88a27f1]586 offset / BPS(bs), BLOCK_FLAGS_NONE);
[cca29e3c]587 if (rc != EOK)
588 return rc;
[88a27f1]589
[17fa0280]590 temp = uint32_t_le2host(*(uint32_t *)(b->data + offset % BPS(bs)));
591 temp &= 0xf0000000;
592 temp |= (value & FAT32_MASK);
593 *(uint32_t *)(b->data + offset % BPS(bs)) = host2uint32_t_le(temp);
[88a27f1]594
595 b->dirty = true; /* need to sync block */
[c91f2d1b]596 rc = block_put(b);
[5d95f02]597
[cca29e3c]598 return rc;
[0f57d0e]599}
600
[88a27f1]601/** Set cluster in one instance of FAT.
602 *
603 * @param bs Buffer holding the boot sector for the file system.
[375ab5e]604 * @param service_id Device service ID for the file system.
[88a27f1]605 * @param fatno Number of the FAT instance where to make the change.
606 * @param clst Cluster which is to be set.
607 * @param value Value to set the cluster with.
608 *
609 * @return EOK on success or a negative error code.
610 */
611int
[375ab5e]612fat_set_cluster(fat_bs_t *bs, service_id_t service_id, unsigned fatno,
[88a27f1]613 fat_cluster_t clst, fat_cluster_t value)
614{
615 int rc;
616
617 assert(fatno < FATCNT(bs));
618
619 if (FAT_IS_FAT12(bs))
[375ab5e]620 rc = fat_set_cluster_fat12(bs, service_id, fatno, clst, value);
[5d95f02]621 else if (FAT_IS_FAT16(bs))
[375ab5e]622 rc = fat_set_cluster_fat16(bs, service_id, fatno, clst, value);
[5d95f02]623 else
624 rc = fat_set_cluster_fat32(bs, service_id, fatno, clst, value);
[88a27f1]625
626 return rc;
627}
628
[9f95a80]629/** Replay the allocatoin of clusters in all shadow instances of FAT.
630 *
631 * @param bs Buffer holding the boot sector of the file system.
[15f3c3f]632 * @param service_id Service ID of the file system.
[9f95a80]633 * @param lifo Chain of allocated clusters.
634 * @param nclsts Number of clusters in the lifo chain.
[cca29e3c]635 *
636 * @return EOK on success or a negative error code.
[9f95a80]637 */
[15f3c3f]638int fat_alloc_shadow_clusters(fat_bs_t *bs, service_id_t service_id,
[cb682eb]639 fat_cluster_t *lifo, unsigned nclsts)
[0f57d0e]640{
[b1178d0]641 uint8_t fatno;
642 unsigned c;
[d260a95]643 fat_cluster_t clst_last1 = FAT_CLST_LAST1(bs);
[cca29e3c]644 int rc;
[b1178d0]645
[0a51029f]646 for (fatno = FAT1 + 1; fatno < FATCNT(bs); fatno++) {
[b1178d0]647 for (c = 0; c < nclsts; c++) {
[15f3c3f]648 rc = fat_set_cluster(bs, service_id, fatno, lifo[c],
[fc35e98]649 c == 0 ? clst_last1 : lifo[c - 1]);
[cca29e3c]650 if (rc != EOK)
651 return rc;
[b1178d0]652 }
653 }
[cca29e3c]654
655 return EOK;
[0f57d0e]656}
657
[e478b2a4]658/** Allocate clusters in all copies of FAT.
[9f95a80]659 *
660 * This function will attempt to allocate the requested number of clusters in
[e478b2a4]661 * all instances of the FAT. The FAT will be altered so that the allocated
[9f95a80]662 * clusters form an independent chain (i.e. a chain which does not belong to any
663 * file yet).
664 *
665 * @param bs Buffer holding the boot sector of the file system.
[15f3c3f]666 * @param service_id Device service ID of the file system.
[9f95a80]667 * @param nclsts Number of clusters to allocate.
668 * @param mcl Output parameter where the first cluster in the chain
669 * will be returned.
670 * @param lcl Output parameter where the last cluster in the chain
671 * will be returned.
672 *
673 * @return EOK on success, a negative error code otherwise.
674 */
[0f57d0e]675int
[15f3c3f]676fat_alloc_clusters(fat_bs_t *bs, service_id_t service_id, unsigned nclsts,
[cb682eb]677 fat_cluster_t *mcl, fat_cluster_t *lcl)
[0f57d0e]678{
[d260a95]679 fat_cluster_t *lifo; /* stack for storing free cluster numbers */
680 unsigned found = 0; /* top of the free cluster number stack */
681 fat_cluster_t clst, value, clst_last1 = FAT_CLST_LAST1(bs);
682 int rc = EOK;
[0f57d0e]683
684 lifo = (fat_cluster_t *) malloc(nclsts * sizeof(fat_cluster_t));
[e478b2a4]685 if (!lifo)
[0f57d0e]686 return ENOMEM;
687 /*
688 * Search FAT1 for unused clusters.
689 */
[6ebe721]690 fibril_mutex_lock(&fat_alloc_lock);
[5d95f02]691 for (clst = FAT_CLST_FIRST; clst < CC(bs) + 2 && found < nclsts;
692 clst++) {
[375ab5e]693 rc = fat_get_cluster(bs, service_id, FAT1, clst, &value);
[2f636b6]694 if (rc != EOK)
[5d95f02]695 break;
[3a8faba]696
[d260a95]697 if (value == FAT_CLST_RES0) {
[5d95f02]698 /*
699 * The cluster is free. Put it into our stack
700 * of found clusters and mark it as non-free.
701 */
702 lifo[found] = clst;
703 rc = fat_set_cluster(bs, service_id, FAT1, clst,
704 (found == 0) ? clst_last1 : lifo[found - 1]);
705 if (rc != EOK)
706 break;
[d260a95]707
[5d95f02]708 found++;
[0f57d0e]709 }
[d260a95]710 }
711
712 if (rc == EOK && found == nclsts) {
[375ab5e]713 rc = fat_alloc_shadow_clusters(bs, service_id, lifo, nclsts);
[d260a95]714 if (rc == EOK) {
715 *mcl = lifo[found - 1];
716 *lcl = lifo[0];
[2f636b6]717 free(lifo);
[d260a95]718 fibril_mutex_unlock(&fat_alloc_lock);
719 return EOK;
[2f636b6]720 }
[0f57d0e]721 }
722
[d260a95]723 /* If something wrong - free the clusters */
[5d95f02]724 while (found--) {
725 (void) fat_set_cluster(bs, service_id, FAT1, lifo[found],
[cb682eb]726 FAT_CLST_RES0);
727 }
[d260a95]728
[0f57d0e]729 free(lifo);
[d260a95]730 fibril_mutex_unlock(&fat_alloc_lock);
[5d95f02]731
[0f57d0e]732 return ENOSPC;
733}
734
[913a821c]735/** Free clusters forming a cluster chain in all copies of FAT.
736 *
737 * @param bs Buffer hodling the boot sector of the file system.
[15f3c3f]738 * @param service_id Device service ID of the file system.
[913a821c]739 * @param firstc First cluster in the chain which is to be freed.
[cca29e3c]740 *
741 * @return EOK on success or a negative return code.
[913a821c]742 */
[cca29e3c]743int
[15f3c3f]744fat_free_clusters(fat_bs_t *bs, service_id_t service_id, fat_cluster_t firstc)
[913a821c]745{
746 unsigned fatno;
[d260a95]747 fat_cluster_t nextc, clst_bad = FAT_CLST_BAD(bs);
[dc87ad11]748 int rc;
[913a821c]749
750 /* Mark all clusters in the chain as free in all copies of FAT. */
[d260a95]751 while (firstc < FAT_CLST_LAST1(bs)) {
[fc35e98]752 assert(firstc >= FAT_CLST_FIRST && firstc < clst_bad);
[5d95f02]753
[15f3c3f]754 rc = fat_get_cluster(bs, service_id, FAT1, firstc, &nextc);
[cca29e3c]755 if (rc != EOK)
756 return rc;
[5d95f02]757
[0a51029f]758 for (fatno = FAT1; fatno < FATCNT(bs); fatno++) {
[15f3c3f]759 rc = fat_set_cluster(bs, service_id, fatno, firstc,
[913a821c]760 FAT_CLST_RES0);
[cca29e3c]761 if (rc != EOK)
762 return rc;
763 }
[913a821c]764 firstc = nextc;
765 }
[cca29e3c]766
767 return EOK;
[913a821c]768}
769
[9f95a80]770/** Append a cluster chain to the last file cluster in all FATs.
771 *
[913a821c]772 * @param bs Buffer holding the boot sector of the file system.
[9f95a80]773 * @param nodep Node representing the file.
774 * @param mcl First cluster of the cluster chain to append.
[377cce8]775 * @param lcl Last cluster of the cluster chain to append.
[cca29e3c]776 *
777 * @return EOK on success or a negative error code.
[9f95a80]778 */
[5d95f02]779int fat_append_clusters(fat_bs_t *bs, fat_node_t *nodep, fat_cluster_t mcl,
[377cce8]780 fat_cluster_t lcl)
[0f57d0e]781{
[15f3c3f]782 service_id_t service_id = nodep->idx->service_id;
[377cce8]783 fat_cluster_t lastc;
[cb682eb]784 uint8_t fatno;
[e402382]785 int rc;
786
[db4ec8d]787 if (nodep->firstc == FAT_CLST_RES0) {
788 /* No clusters allocated to the node yet. */
789 nodep->firstc = mcl;
790 nodep->dirty = true; /* need to sync node */
[377cce8]791 } else {
[db4ec8d]792 if (nodep->lastc_cached_valid) {
793 lastc = nodep->lastc_cached_value;
794 nodep->lastc_cached_valid = false;
795 } else {
[15f3c3f]796 rc = fat_cluster_walk(bs, service_id, nodep->firstc,
[4bf6895]797 &lastc, NULL, (uint32_t) -1);
[db4ec8d]798 if (rc != EOK)
799 return rc;
[377cce8]800 }
[cca29e3c]801
[0a51029f]802 for (fatno = FAT1; fatno < FATCNT(bs); fatno++) {
[375ab5e]803 rc = fat_set_cluster(bs, nodep->idx->service_id,
[d260a95]804 fatno, lastc, mcl);
[db4ec8d]805 if (rc != EOK)
806 return rc;
807 }
[e17d986]808 }
809
[377cce8]810 nodep->lastc_cached_valid = true;
811 nodep->lastc_cached_value = lcl;
812
[cca29e3c]813 return EOK;
[913a821c]814}
815
816/** Chop off node clusters in all copies of FAT.
817 *
818 * @param bs Buffer holding the boot sector of the file system.
819 * @param nodep FAT node where the chopping will take place.
[377cce8]820 * @param lcl Last cluster which will remain in the node. If this
[913a821c]821 * argument is FAT_CLST_RES0, then all clusters will
[ac49f5d1]822 * be chopped off.
[cca29e3c]823 *
824 * @return EOK on success or a negative return code.
[913a821c]825 */
[377cce8]826int fat_chop_clusters(fat_bs_t *bs, fat_node_t *nodep, fat_cluster_t lcl)
[913a821c]827{
[d260a95]828 fat_cluster_t clst_last1 = FAT_CLST_LAST1(bs);
[dc87ad11]829 int rc;
[15f3c3f]830 service_id_t service_id = nodep->idx->service_id;
[377cce8]831
[dba4a23]832 /*
833 * Invalidate cached cluster numbers.
834 */
[377cce8]835 nodep->lastc_cached_valid = false;
[dba4a23]836 if (nodep->currc_cached_value != lcl)
837 nodep->currc_cached_valid = false;
838
[377cce8]839 if (lcl == FAT_CLST_RES0) {
[913a821c]840 /* The node will have zero size and no clusters allocated. */
[15f3c3f]841 rc = fat_free_clusters(bs, service_id, nodep->firstc);
[cca29e3c]842 if (rc != EOK)
843 return rc;
[913a821c]844 nodep->firstc = FAT_CLST_RES0;
845 nodep->dirty = true; /* need to sync node */
846 } else {
847 fat_cluster_t nextc;
848 unsigned fatno;
849
[15f3c3f]850 rc = fat_get_cluster(bs, service_id, FAT1, lcl, &nextc);
[cca29e3c]851 if (rc != EOK)
852 return rc;
[913a821c]853
854 /* Terminate the cluster chain in all copies of FAT. */
[0a51029f]855 for (fatno = FAT1; fatno < FATCNT(bs); fatno++) {
[15f3c3f]856 rc = fat_set_cluster(bs, service_id, fatno, lcl,
[fc35e98]857 clst_last1);
[cca29e3c]858 if (rc != EOK)
859 return rc;
860 }
[913a821c]861
862 /* Free all following clusters. */
[15f3c3f]863 rc = fat_free_clusters(bs, service_id, nextc);
[cca29e3c]864 if (rc != EOK)
865 return rc;
[913a821c]866 }
[cca29e3c]867
[dba4a23]868 /*
869 * Update and re-enable the last cluster cache.
870 */
[377cce8]871 nodep->lastc_cached_valid = true;
872 nodep->lastc_cached_value = lcl;
873
[cca29e3c]874 return EOK;
[0f57d0e]875}
[6ebaff9]876
[cca29e3c]877int
[15f3c3f]878fat_zero_cluster(struct fat_bs *bs, service_id_t service_id, fat_cluster_t c)
[5f116e7]879{
880 int i;
881 block_t *b;
[c91f2d1b]882 int rc;
[5f116e7]883
[ed6cf34b]884 for (i = 0; i < SPC(bs); i++) {
[15f3c3f]885 rc = _fat_block_get(&b, bs, service_id, c, NULL, i,
[684b655]886 BLOCK_FLAGS_NOREAD);
[cca29e3c]887 if (rc != EOK)
888 return rc;
[ed6cf34b]889 memset(b->data, 0, BPS(bs));
[5f116e7]890 b->dirty = true;
[c91f2d1b]891 rc = block_put(b);
[cca29e3c]892 if (rc != EOK)
893 return rc;
[5f116e7]894 }
[cca29e3c]895
896 return EOK;
[5f116e7]897}
898
[7efc517]899/** Perform basic sanity checks on the file system.
900 *
901 * Verify if values of boot sector fields are sane. Also verify media
902 * descriptor. This is used to rule out cases when a device obviously
903 * does not contain a fat file system.
904 */
[15f3c3f]905int fat_sanity_check(fat_bs_t *bs, service_id_t service_id)
[7efc517]906{
907 fat_cluster_t e0, e1;
908 unsigned fat_no;
909 int rc;
910
911 /* Check number of FATs. */
[875edff6]912 if (FATCNT(bs) == 0)
[7efc517]913 return ENOTSUP;
914
915 /* Check total number of sectors. */
[875edff6]916 if (TS(bs) == 0)
[7efc517]917 return ENOTSUP;
918
919 if (bs->totsec16 != 0 && bs->totsec32 != 0 &&
[97bc3ee]920 bs->totsec16 != bs->totsec32)
[7efc517]921 return ENOTSUP;
922
923 /* Check media descriptor. Must be between 0xf0 and 0xff. */
924 if ((bs->mdesc & 0xf0) != 0xf0)
925 return ENOTSUP;
926
927 /* Check number of sectors per FAT. */
[875edff6]928 if (SF(bs) == 0)
[7efc517]929 return ENOTSUP;
930
931 /*
932 * Check that the root directory entries take up whole blocks.
933 * This check is rather strict, but it allows us to treat the root
934 * directory and non-root directories uniformly in some places.
935 * It can be removed provided that functions such as fat_read() are
936 * sanitized to support file systems with this property.
937 */
[5d95f02]938 if (!FAT_IS_FAT32(bs) &&
939 (RDE(bs) * sizeof(fat_dentry_t)) % BPS(bs) != 0)
[7efc517]940 return ENOTSUP;
941
942 /* Check signature of each FAT. */
[875edff6]943 for (fat_no = 0; fat_no < FATCNT(bs); fat_no++) {
[15f3c3f]944 rc = fat_get_cluster(bs, service_id, fat_no, 0, &e0);
[7efc517]945 if (rc != EOK)
946 return EIO;
947
[15f3c3f]948 rc = fat_get_cluster(bs, service_id, fat_no, 1, &e1);
[7efc517]949 if (rc != EOK)
950 return EIO;
951
[5d95f02]952 /*
953 * Check that first byte of FAT contains the media descriptor.
954 */
[7efc517]955 if ((e0 & 0xff) != bs->mdesc)
956 return ENOTSUP;
957
958 /*
959 * Check that remaining bits of the first two entries are
960 * set to one.
961 */
[aa2ea13]962 if (!FAT_IS_FAT12(bs) &&
[5d95f02]963 ((e0 >> 8) != (FAT_MASK(bs) >> 8) || e1 != FAT_MASK(bs)))
[7efc517]964 return ENOTSUP;
965 }
966
967 return EOK;
968}
969
[6ebaff9]970/**
971 * @}
[97bc3ee]972 */
Note: See TracBrowser for help on using the repository browser.