usr.sbin/makefs/ffs/ffs_subr.c

   1 /*      $NetBSD: ffs_subr.c,v 1.32 2003/12/30 12:33:24 pk Exp $ */
   2
   3 /*-
   4  * SPDX-License-Identifier: BSD-3-Clause
   5  *
   6  * Copyright (c) 1982, 1986, 1989, 1993
   7  *      The Regents of the University of California.  All rights reserved.
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice, this list of conditions and the following disclaimer.
  14  * 2. Redistributions in binary form must reproduce the above copyright
  15  *    notice, this list of conditions and the following disclaimer in the
  16  *    documentation and/or other materials provided with the distribution.
  17  * 3. Neither the name of the University nor the names of its contributors
  18  *    may be used to endorse or promote products derived from this software
  19  *    without specific prior written permission.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31  * SUCH DAMAGE.
  32  *
  33  *      @(#)ffs_subr.c  8.5 (Berkeley) 3/21/95
  34  * $FreeBSD: head/usr.sbin/makefs/ffs/ffs_subr.c 333664 2018-05-16 02:58:05Z emaste $
  35  */
  36
  37 #include <sys/param.h>
  38 #include <sys/types.h>
  39
  40 #include <vfs/ufs/dinode.h>
  41 #include <vfs/ufs/fs.h>
  42 #include "ffs/ffs_extern.h"
  43 #include "ffs/ufs_bswap.h"
  44
  45 /*
  46  * Update the frsum fields to reflect addition or deletion
  47  * of some frags.
  48  */
  49 void
  50 ffs_fragacct_swap(struct fs *fs, int fragmap, int32_t fraglist[], int cnt, int needswap)
  51 {
  52         int inblk;
  53         int field, subfield;
  54         int siz, pos;
  55
  56         inblk = (int)(fragtbl[fs->fs_frag][fragmap]) << 1;
  57         fragmap <<= 1;
  58         for (siz = 1; siz < fs->fs_frag; siz++) {
  59                 if ((inblk & (1 << (siz + (fs->fs_frag & (NBBY - 1))))) == 0)
  60                         continue;
  61                 field = around[siz];
  62                 subfield = inside[siz];
  63                 for (pos = siz; pos <= fs->fs_frag; pos++) {
  64                         if ((fragmap & field) == subfield) {
  65                                 fraglist[siz] = ufs_rw32(
  66                                     ufs_rw32(fraglist[siz], needswap) + cnt,
  67                                     needswap);
  68                                 pos += siz;
  69                                 field <<= siz;
  70                                 subfield <<= siz;
  71                         }
  72                         field <<= 1;
  73                         subfield <<= 1;
  74                 }
  75         }
  76 }
  77
  78 /*
  79  * block operations
  80  *
  81  * check if a block is available
  82  *  returns true if all the corresponding bits in the free map are 1
  83  *  returns false if any corresponding bit in the free map is 0
  84  */
  85 int
  86 ffs_isblock(struct fs *fs, u_char *cp, int32_t h)
  87 {
  88         u_char mask;
  89
  90         switch ((int)fs->fs_fragshift) {
  91         case 3:
  92                 return (cp[h] == 0xff);
  93         case 2:
  94                 mask = 0x0f << ((h & 0x1) << 2);
  95                 return ((cp[h >> 1] & mask) == mask);
  96         case 1:
  97                 mask = 0x03 << ((h & 0x3) << 1);
  98                 return ((cp[h >> 2] & mask) == mask);
  99         case 0:
 100                 mask = 0x01 << (h & 0x7);
 101                 return ((cp[h >> 3] & mask) == mask);
 102         default:
 103                 panic("ffs_isblock: unknown fs_fragshift %d",
 104                     (int)fs->fs_fragshift);
 105         }
 106 }
 107
 108 /*
 109  * check if a block is completely allocated
 110  *  returns true if all the corresponding bits in the free map are 0
 111  *  returns false if any corresponding bit in the free map is 1
 112  */
 113 int
 114 ffs_isfreeblock(struct fs *fs, u_char *cp, int32_t h)
 115 {
 116
 117         switch ((int)fs->fs_fragshift) {
 118         case 3:
 119                 return (cp[h] == 0);
 120         case 2:
 121                 return ((cp[h >> 1] & (0x0f << ((h & 0x1) << 2))) == 0);
 122         case 1:
 123                 return ((cp[h >> 2] & (0x03 << ((h & 0x3) << 1))) == 0);
 124         case 0:
 125                 return ((cp[h >> 3] & (0x01 << (h & 0x7))) == 0);
 126         default:
 127                 panic("ffs_isfreeblock: unknown fs_fragshift %d",
 128                     (int)fs->fs_fragshift);
 129         }
 130 }
 131
 132 /*
 133  * take a block out of the map
 134  */
 135 void
 136 ffs_clrblock(struct fs *fs, u_char *cp, int32_t h)
 137 {
 138
 139         switch ((int)fs->fs_fragshift) {
 140         case 3:
 141                 cp[h] = 0;
 142                 return;
 143         case 2:
 144                 cp[h >> 1] &= ~(0x0f << ((h & 0x1) << 2));
 145                 return;
 146         case 1:
 147                 cp[h >> 2] &= ~(0x03 << ((h & 0x3) << 1));
 148                 return;
 149         case 0:
 150                 cp[h >> 3] &= ~(0x01 << (h & 0x7));
 151                 return;
 152         default:
 153                 panic("ffs_clrblock: unknown fs_fragshift %d",
 154                     (int)fs->fs_fragshift);
 155         }
 156 }
 157
 158 /*
 159  * put a block into the map
 160  */
 161 void
 162 ffs_setblock(struct fs *fs, u_char *cp, int32_t h)
 163 {
 164
 165         switch ((int)fs->fs_fragshift) {
 166         case 3:
 167                 cp[h] = 0xff;
 168                 return;
 169         case 2:
 170                 cp[h >> 1] |= (0x0f << ((h & 0x1) << 2));
 171                 return;
 172         case 1:
 173                 cp[h >> 2] |= (0x03 << ((h & 0x3) << 1));
 174                 return;
 175         case 0:
 176                 cp[h >> 3] |= (0x01 << (h & 0x7));
 177                 return;
 178         default:
 179                 panic("ffs_setblock: unknown fs_fragshift %d",
 180                     (int)fs->fs_fragshift);
 181         }
 182 }