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

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since f73b291 was f73b291, checked in by Martin Decky <martin@…>, 13 years ago

libblock.{c|h} → block.{c|h}

  • 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>
[f73b291]44#include <block.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;
[dc6b148]687
[0f57d0e]688 /*
689 * Search FAT1 for unused clusters.
690 */
[6ebe721]691 fibril_mutex_lock(&fat_alloc_lock);
[5d95f02]692 for (clst = FAT_CLST_FIRST; clst < CC(bs) + 2 && found < nclsts;
693 clst++) {
[375ab5e]694 rc = fat_get_cluster(bs, service_id, FAT1, clst, &value);
[2f636b6]695 if (rc != EOK)
[5d95f02]696 break;
[3a8faba]697
[d260a95]698 if (value == FAT_CLST_RES0) {
[5d95f02]699 /*
700 * The cluster is free. Put it into our stack
701 * of found clusters and mark it as non-free.
702 */
703 lifo[found] = clst;
704 rc = fat_set_cluster(bs, service_id, FAT1, clst,
705 (found == 0) ? clst_last1 : lifo[found - 1]);
706 if (rc != EOK)
707 break;
[d260a95]708
[5d95f02]709 found++;
[0f57d0e]710 }
[d260a95]711 }
712
713 if (rc == EOK && found == nclsts) {
[375ab5e]714 rc = fat_alloc_shadow_clusters(bs, service_id, lifo, nclsts);
[d260a95]715 if (rc == EOK) {
716 *mcl = lifo[found - 1];
717 *lcl = lifo[0];
[2f636b6]718 free(lifo);
[d260a95]719 fibril_mutex_unlock(&fat_alloc_lock);
720 return EOK;
[2f636b6]721 }
[0f57d0e]722 }
723
[d260a95]724 /* If something wrong - free the clusters */
[5d95f02]725 while (found--) {
726 (void) fat_set_cluster(bs, service_id, FAT1, lifo[found],
[cb682eb]727 FAT_CLST_RES0);
728 }
[d260a95]729
[0f57d0e]730 free(lifo);
[d260a95]731 fibril_mutex_unlock(&fat_alloc_lock);
[5d95f02]732
[0f57d0e]733 return ENOSPC;
734}
735
[913a821c]736/** Free clusters forming a cluster chain in all copies of FAT.
737 *
738 * @param bs Buffer hodling the boot sector of the file system.
[15f3c3f]739 * @param service_id Device service ID of the file system.
[913a821c]740 * @param firstc First cluster in the chain which is to be freed.
[cca29e3c]741 *
742 * @return EOK on success or a negative return code.
[913a821c]743 */
[cca29e3c]744int
[15f3c3f]745fat_free_clusters(fat_bs_t *bs, service_id_t service_id, fat_cluster_t firstc)
[913a821c]746{
747 unsigned fatno;
[d260a95]748 fat_cluster_t nextc, clst_bad = FAT_CLST_BAD(bs);
[dc87ad11]749 int rc;
[913a821c]750
751 /* Mark all clusters in the chain as free in all copies of FAT. */
[d260a95]752 while (firstc < FAT_CLST_LAST1(bs)) {
[fc35e98]753 assert(firstc >= FAT_CLST_FIRST && firstc < clst_bad);
[5d95f02]754
[15f3c3f]755 rc = fat_get_cluster(bs, service_id, FAT1, firstc, &nextc);
[cca29e3c]756 if (rc != EOK)
757 return rc;
[5d95f02]758
[0a51029f]759 for (fatno = FAT1; fatno < FATCNT(bs); fatno++) {
[15f3c3f]760 rc = fat_set_cluster(bs, service_id, fatno, firstc,
[913a821c]761 FAT_CLST_RES0);
[cca29e3c]762 if (rc != EOK)
763 return rc;
764 }
[dc6b148]765
[913a821c]766 firstc = nextc;
767 }
[cca29e3c]768
769 return EOK;
[913a821c]770}
771
[9f95a80]772/** Append a cluster chain to the last file cluster in all FATs.
773 *
[913a821c]774 * @param bs Buffer holding the boot sector of the file system.
[9f95a80]775 * @param nodep Node representing the file.
776 * @param mcl First cluster of the cluster chain to append.
[377cce8]777 * @param lcl Last cluster of the cluster chain to append.
[cca29e3c]778 *
779 * @return EOK on success or a negative error code.
[9f95a80]780 */
[5d95f02]781int fat_append_clusters(fat_bs_t *bs, fat_node_t *nodep, fat_cluster_t mcl,
[377cce8]782 fat_cluster_t lcl)
[0f57d0e]783{
[15f3c3f]784 service_id_t service_id = nodep->idx->service_id;
[377cce8]785 fat_cluster_t lastc;
[cb682eb]786 uint8_t fatno;
[e402382]787 int rc;
788
[db4ec8d]789 if (nodep->firstc == FAT_CLST_RES0) {
790 /* No clusters allocated to the node yet. */
791 nodep->firstc = mcl;
792 nodep->dirty = true; /* need to sync node */
[377cce8]793 } else {
[db4ec8d]794 if (nodep->lastc_cached_valid) {
795 lastc = nodep->lastc_cached_value;
796 nodep->lastc_cached_valid = false;
797 } else {
[15f3c3f]798 rc = fat_cluster_walk(bs, service_id, nodep->firstc,
[4bf6895]799 &lastc, NULL, (uint32_t) -1);
[db4ec8d]800 if (rc != EOK)
801 return rc;
[377cce8]802 }
[cca29e3c]803
[0a51029f]804 for (fatno = FAT1; fatno < FATCNT(bs); fatno++) {
[375ab5e]805 rc = fat_set_cluster(bs, nodep->idx->service_id,
[d260a95]806 fatno, lastc, mcl);
[db4ec8d]807 if (rc != EOK)
808 return rc;
809 }
[e17d986]810 }
811
[377cce8]812 nodep->lastc_cached_valid = true;
813 nodep->lastc_cached_value = lcl;
814
[cca29e3c]815 return EOK;
[913a821c]816}
817
818/** Chop off node clusters in all copies of FAT.
819 *
820 * @param bs Buffer holding the boot sector of the file system.
821 * @param nodep FAT node where the chopping will take place.
[377cce8]822 * @param lcl Last cluster which will remain in the node. If this
[913a821c]823 * argument is FAT_CLST_RES0, then all clusters will
[ac49f5d1]824 * be chopped off.
[cca29e3c]825 *
826 * @return EOK on success or a negative return code.
[913a821c]827 */
[377cce8]828int fat_chop_clusters(fat_bs_t *bs, fat_node_t *nodep, fat_cluster_t lcl)
[913a821c]829{
[d260a95]830 fat_cluster_t clst_last1 = FAT_CLST_LAST1(bs);
[dc87ad11]831 int rc;
[15f3c3f]832 service_id_t service_id = nodep->idx->service_id;
[377cce8]833
[dba4a23]834 /*
835 * Invalidate cached cluster numbers.
836 */
[377cce8]837 nodep->lastc_cached_valid = false;
[dba4a23]838 if (nodep->currc_cached_value != lcl)
839 nodep->currc_cached_valid = false;
840
[377cce8]841 if (lcl == FAT_CLST_RES0) {
[913a821c]842 /* The node will have zero size and no clusters allocated. */
[15f3c3f]843 rc = fat_free_clusters(bs, service_id, nodep->firstc);
[cca29e3c]844 if (rc != EOK)
845 return rc;
[913a821c]846 nodep->firstc = FAT_CLST_RES0;
847 nodep->dirty = true; /* need to sync node */
848 } else {
849 fat_cluster_t nextc;
850 unsigned fatno;
851
[15f3c3f]852 rc = fat_get_cluster(bs, service_id, FAT1, lcl, &nextc);
[cca29e3c]853 if (rc != EOK)
854 return rc;
[913a821c]855
856 /* Terminate the cluster chain in all copies of FAT. */
[0a51029f]857 for (fatno = FAT1; fatno < FATCNT(bs); fatno++) {
[15f3c3f]858 rc = fat_set_cluster(bs, service_id, fatno, lcl,
[fc35e98]859 clst_last1);
[cca29e3c]860 if (rc != EOK)
861 return rc;
862 }
[913a821c]863
864 /* Free all following clusters. */
[15f3c3f]865 rc = fat_free_clusters(bs, service_id, nextc);
[cca29e3c]866 if (rc != EOK)
867 return rc;
[913a821c]868 }
[cca29e3c]869
[dba4a23]870 /*
871 * Update and re-enable the last cluster cache.
872 */
[377cce8]873 nodep->lastc_cached_valid = true;
874 nodep->lastc_cached_value = lcl;
875
[cca29e3c]876 return EOK;
[0f57d0e]877}
[6ebaff9]878
[cca29e3c]879int
[15f3c3f]880fat_zero_cluster(struct fat_bs *bs, service_id_t service_id, fat_cluster_t c)
[5f116e7]881{
882 int i;
883 block_t *b;
[c91f2d1b]884 int rc;
[5f116e7]885
[ed6cf34b]886 for (i = 0; i < SPC(bs); i++) {
[15f3c3f]887 rc = _fat_block_get(&b, bs, service_id, c, NULL, i,
[684b655]888 BLOCK_FLAGS_NOREAD);
[cca29e3c]889 if (rc != EOK)
890 return rc;
[ed6cf34b]891 memset(b->data, 0, BPS(bs));
[5f116e7]892 b->dirty = true;
[c91f2d1b]893 rc = block_put(b);
[cca29e3c]894 if (rc != EOK)
895 return rc;
[5f116e7]896 }
[cca29e3c]897
898 return EOK;
[5f116e7]899}
900
[7efc517]901/** Perform basic sanity checks on the file system.
902 *
903 * Verify if values of boot sector fields are sane. Also verify media
904 * descriptor. This is used to rule out cases when a device obviously
905 * does not contain a fat file system.
906 */
[15f3c3f]907int fat_sanity_check(fat_bs_t *bs, service_id_t service_id)
[7efc517]908{
909 fat_cluster_t e0, e1;
910 unsigned fat_no;
911 int rc;
912
913 /* Check number of FATs. */
[875edff6]914 if (FATCNT(bs) == 0)
[7efc517]915 return ENOTSUP;
916
917 /* Check total number of sectors. */
[875edff6]918 if (TS(bs) == 0)
[7efc517]919 return ENOTSUP;
920
921 if (bs->totsec16 != 0 && bs->totsec32 != 0 &&
[97bc3ee]922 bs->totsec16 != bs->totsec32)
[7efc517]923 return ENOTSUP;
924
925 /* Check media descriptor. Must be between 0xf0 and 0xff. */
926 if ((bs->mdesc & 0xf0) != 0xf0)
927 return ENOTSUP;
928
929 /* Check number of sectors per FAT. */
[875edff6]930 if (SF(bs) == 0)
[7efc517]931 return ENOTSUP;
932
933 /*
934 * Check that the root directory entries take up whole blocks.
935 * This check is rather strict, but it allows us to treat the root
936 * directory and non-root directories uniformly in some places.
937 * It can be removed provided that functions such as fat_read() are
938 * sanitized to support file systems with this property.
939 */
[5d95f02]940 if (!FAT_IS_FAT32(bs) &&
941 (RDE(bs) * sizeof(fat_dentry_t)) % BPS(bs) != 0)
[7efc517]942 return ENOTSUP;
943
944 /* Check signature of each FAT. */
[875edff6]945 for (fat_no = 0; fat_no < FATCNT(bs); fat_no++) {
[15f3c3f]946 rc = fat_get_cluster(bs, service_id, fat_no, 0, &e0);
[7efc517]947 if (rc != EOK)
948 return EIO;
949
[15f3c3f]950 rc = fat_get_cluster(bs, service_id, fat_no, 1, &e1);
[7efc517]951 if (rc != EOK)
952 return EIO;
953
[5d95f02]954 /*
955 * Check that first byte of FAT contains the media descriptor.
956 */
[7efc517]957 if ((e0 & 0xff) != bs->mdesc)
958 return ENOTSUP;
959
960 /*
961 * Check that remaining bits of the first two entries are
962 * set to one.
963 */
[aa2ea13]964 if (!FAT_IS_FAT12(bs) &&
[5d95f02]965 ((e0 >> 8) != (FAT_MASK(bs) >> 8) || e1 != FAT_MASK(bs)))
[7efc517]966 return ENOTSUP;
967 }
968
969 return EOK;
970}
971
[6ebaff9]972/**
973 * @}
[97bc3ee]974 */
Note: See TracBrowser for help on using the repository browser.