#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: efs_subr.c,v 1.14 2021/12/10 20:36:04 andvar Exp $");
#include <sys/param.h>
#include <sys/kauth.h>
#include <sys/lwp.h>
#include <sys/proc.h>
#include <sys/buf.h>
#include <sys/mount.h>
#include <sys/vnode.h>
#include <sys/namei.h>
#include <sys/stat.h>
#include <sys/malloc.h>
#include <miscfs/genfs/genfs_node.h>
#include <fs/efs/efs.h>
#include <fs/efs/efs_sb.h>
#include <fs/efs/efs_dir.h>
#include <fs/efs/efs_genfs.h>
#include <fs/efs/efs_mount.h>
#include <fs/efs/efs_extent.h>
#include <fs/efs/efs_dinode.h>
#include <fs/efs/efs_inode.h>
#include <fs/efs/efs_subr.h>
struct pool efs_inode_pool;
int32_t
efs_sb_checksum(struct efs_sb *esb, int new)
{
int i;
int32_t cksum;
uint8_t *sbarray = (uint8_t *)esb;
KASSERT((EFS_SB_CHECKSUM_SIZE % 2) == 0);
for (i = cksum = 0; i < EFS_SB_CHECKSUM_SIZE; i += 2) {
uint16_t v;
memcpy(&v, &sbarray[i], sizeof(v));
cksum ^= be16toh(v);
cksum = (cksum << 1) | (new && cksum < 0);
}
return (cksum);
}
int
efs_sb_validate(struct efs_sb *esb, const char **why)
{
uint32_t ocksum, ncksum;
*why = NULL;
if (be32toh(esb->sb_magic) != EFS_SB_MAGIC &&
be32toh(esb->sb_magic) != EFS_SB_NEWMAGIC) {
*why = "sb_magic invalid";
return (1);
}
ocksum = htobe32(efs_sb_checksum(esb, 0));
ncksum = htobe32(efs_sb_checksum(esb, 1));
if (esb->sb_checksum != ocksum && esb->sb_checksum != ncksum) {
*why = "sb_checksum invalid";
return (1);
}
if (be32toh(esb->sb_size) > EFS_SIZE_MAX) {
*why = "sb_size > EFS_SIZE_MAX";
return (1);
}
if (be32toh(esb->sb_firstcg) <= EFS_BB_BITMAP) {
*why = "sb_firstcg <= EFS_BB_BITMAP";
return (1);
}
if (esb->sb_cgfsize == 0 ||
esb->sb_cgisize == 0 ||
esb->sb_ncg == 0 ||
esb->sb_bmsize == 0) {
*why = "something bad happened";
return (1);
}
return (0);
}
void
efs_locate_inode(ino_t ino, struct efs_sb *sbp, uint32_t *bboff, int *index)
{
uint32_t cgfsize, firstcg;
uint16_t cgisize;
cgisize = be16toh(sbp->sb_cgisize);
cgfsize = be32toh(sbp->sb_cgfsize);
firstcg = be32toh(sbp->sb_firstcg);
*bboff = firstcg + ((ino / (cgisize * EFS_DINODES_PER_BB)) * cgfsize) +
((ino % (cgisize * EFS_DINODES_PER_BB)) / EFS_DINODES_PER_BB);
*index = ino & (EFS_DINODES_PER_BB - 1);
}
int
efs_read_inode(struct efs_mount *emp, ino_t ino, struct lwp *l,
struct efs_dinode *di)
{
struct efs_sb *sbp;
struct buf *bp;
int index, err;
uint32_t bboff;
sbp = &emp->em_sb;
efs_locate_inode(ino, sbp, &bboff, &index);
err = efs_bread(emp, bboff, l, &bp);
if (err) {
return (err);
}
memcpy(di, ((struct efs_dinode *)bp->b_data) + index, sizeof(*di));
brelse(bp, 0);
return (0);
}
int
efs_bread(struct efs_mount *emp, uint32_t bboff, struct lwp *l, struct buf **bp)
{
KASSERT(bboff < EFS_SIZE_MAX);
return (bread(emp->em_devvp, (daddr_t)bboff * (EFS_BB_SIZE / DEV_BSIZE),
EFS_BB_SIZE, 0, bp));
}
void
efs_sync_dinode_to_inode(struct efs_inode *ei)
{
ei->ei_mode = be16toh(ei->ei_di.di_mode);
ei->ei_nlink = be16toh(ei->ei_di.di_nlink);
ei->ei_uid = be16toh(ei->ei_di.di_uid);
ei->ei_gid = be16toh(ei->ei_di.di_gid);
ei->ei_size = be32toh(ei->ei_di.di_size);
ei->ei_atime = be32toh(ei->ei_di.di_atime);
ei->ei_mtime = be32toh(ei->ei_di.di_mtime);
ei->ei_ctime = be32toh(ei->ei_di.di_ctime);
ei->ei_gen = be32toh(ei->ei_di.di_gen);
ei->ei_numextents = be16toh(ei->ei_di.di_numextents);
ei->ei_version = ei->ei_di.di_version;
}
void
efs_sync_inode_to_dinode(struct efs_inode *ei)
{
panic("readonly -- no need to call me");
}
#ifdef DIAGNOSTIC
static int
efs_is_inode_synced(struct efs_inode *ei)
{
int s;
s = 0;
s += (ei->ei_mode != be16toh(ei->ei_di.di_mode));
s += (ei->ei_nlink != be16toh(ei->ei_di.di_nlink));
s += (ei->ei_uid != be16toh(ei->ei_di.di_uid));
s += (ei->ei_gid != be16toh(ei->ei_di.di_gid));
s += (ei->ei_size != be32toh(ei->ei_di.di_size));
s += (ei->ei_atime != be32toh(ei->ei_di.di_atime));
s += (ei->ei_mtime != be32toh(ei->ei_di.di_mtime));
s += (ei->ei_ctime != be32toh(ei->ei_di.di_ctime));
s += (ei->ei_gen != be32toh(ei->ei_di.di_gen));
s += (ei->ei_numextents != be16toh(ei->ei_di.di_numextents));
s += (ei->ei_version != ei->ei_di.di_version);
return (s);
}
#endif
static int
efs_dirblk_lookup(struct efs_dirblk *dir, struct componentname *cn,
ino_t *inode)
{
struct efs_dirent *de;
int i, slot __diagused, offset;
KASSERT(cn->cn_namelen <= EFS_DIRENT_NAMELEN_MAX);
slot = offset = 0;
for (i = 0; i < dir->db_slots; i++) {
offset = EFS_DIRENT_OFF_EXPND(dir->db_space[i]);
if (offset == EFS_DIRBLK_SLOT_FREE)
continue;
de = (struct efs_dirent *)((char *)dir + offset);
if (de->de_namelen == cn->cn_namelen &&
(strncmp(cn->cn_nameptr, de->de_name, cn->cn_namelen) == 0)){
slot = i;
break;
}
}
if (i == dir->db_slots)
return (ENOENT);
KASSERT(slot < offset && offset < EFS_DIRBLK_SPACE_SIZE);
de = (struct efs_dirent *)((char *)dir + offset);
*inode = be32toh(de->de_inumber);
return (0);
}
static int
efs_extent_lookup(struct efs_mount *emp, struct efs_extent *ex,
struct componentname *cn, ino_t *ino)
{
struct efs_dirblk *db;
struct buf *bp;
int i, err;
for (i = 0; i < ex->ex_length; i++) {
err = efs_bread(emp, ex->ex_bn + i, NULL, &bp);
if (err) {
printf("efs: warning: invalid extent descriptor\n");
return (err);
}
db = (struct efs_dirblk *)bp->b_data;
if (efs_dirblk_lookup(db, cn, ino) == 0) {
brelse(bp, 0);
return (0);
}
brelse(bp, 0);
}
return (ENOENT);
}
int
efs_inode_lookup(struct efs_mount *emp, struct efs_inode *ei,
struct componentname *cn, ino_t *ino)
{
struct efs_extent ex;
struct efs_extent_iterator exi;
int ret;
KASSERT(VOP_ISLOCKED(ei->ei_vp));
#ifdef DIAGNOSTIC
KASSERT(efs_is_inode_synced(ei) == 0);
#endif
KASSERT((ei->ei_mode & S_IFMT) == S_IFDIR);
efs_extent_iterator_init(&exi, ei, 0);
while ((ret = efs_extent_iterator_next(&exi, &ex)) == 0) {
if (efs_extent_lookup(emp, &ex, cn, ino) == 0) {
return (0);
}
}
return ((ret == -1) ? ENOENT : ret);
}
void
efs_dextent_to_extent(struct efs_dextent *dex, struct efs_extent *ex)
{
KASSERT(dex != NULL && ex != NULL);
ex->ex_magic = dex->ex_bytes[0];
ex->ex_bn = be32toh(dex->ex_words[0]) & 0x00ffffff;
ex->ex_length = dex->ex_bytes[4];
ex->ex_offset = be32toh(dex->ex_words[1]) & 0x00ffffff;
}
void
efs_extent_to_dextent(struct efs_extent *ex, struct efs_dextent *dex)
{
KASSERT(ex != NULL && dex != NULL);
KASSERT(ex->ex_magic == EFS_EXTENT_MAGIC);
KASSERT((ex->ex_bn & ~EFS_EXTENT_BN_MASK) == 0);
KASSERT((ex->ex_offset & ~EFS_EXTENT_OFFSET_MASK) == 0);
dex->ex_words[0] = htobe32(ex->ex_bn);
dex->ex_bytes[0] = ex->ex_magic;
dex->ex_words[1] = htobe32(ex->ex_offset);
dex->ex_bytes[4] = ex->ex_length;
}
void
efs_extent_iterator_init(struct efs_extent_iterator *exi, struct efs_inode *eip,
off_t start_hint)
{
struct efs_extent ex, ex2;
struct buf *bp;
struct efs_mount *emp = VFSTOEFS(eip->ei_vp->v_mount);
off_t offset, length, next;
int i, err, numextents, numinextents;
int hi, lo, mid;
int indir;
exi->exi_eip = eip;
exi->exi_next = 0;
exi->exi_dnext = 0;
exi->exi_innext = 0;
if (start_hint == 0)
return;
if (start_hint >= eip->ei_size) {
exi->exi_next = eip->ei_numextents;
return;
}
if (eip->ei_numextents <= EFS_DIRECTEXTENTS) {
for (i = 0; i < eip->ei_numextents; i++) {
efs_dextent_to_extent(&eip->ei_di.di_extents[i], &ex);
offset = ex.ex_offset * EFS_BB_SIZE;
length = ex.ex_length * EFS_BB_SIZE;
if (start_hint >= offset &&
start_hint < (offset + length)) {
exi->exi_next = exi->exi_dnext = i;
return;
}
}
EFS_DPRINTF(("efs_extent_iterator_init: bad direct extents\n"));
return;
}
efs_dextent_to_extent(&eip->ei_di.di_extents[0], &ex);
numinextents = ex.ex_offset;
if (numinextents < 1 || numinextents >= EFS_DIRECTEXTENTS) {
EFS_DPRINTF(("efs_extent_iterator_init: bad ex.ex_offset\n"));
return;
}
next = 0;
indir = -1;
numextents = 0;
for (i = 0; i < numinextents; i++) {
efs_dextent_to_extent(&eip->ei_di.di_extents[i], &ex);
err = efs_bread(emp, ex.ex_bn, NULL, &bp);
if (err) {
return;
}
efs_dextent_to_extent((struct efs_dextent *)bp->b_data, &ex2);
brelse(bp, 0);
offset = ex2.ex_offset * EFS_BB_SIZE;
if (offset > start_hint) {
indir = MAX(0, i - 1);
break;
}
next += numextents;
numextents = ex.ex_length * EFS_EXTENTS_PER_BB;
numextents = MIN(numextents, eip->ei_numextents - next);
}
if (indir == -1)
indir = numinextents - 1;
lo = 0;
mid = 0;
hi = numextents - 1;
efs_dextent_to_extent(&eip->ei_di.di_extents[indir], &ex);
while (lo <= hi) {
int bboff;
int index;
mid = (lo + hi) / 2;
bboff = mid / EFS_EXTENTS_PER_BB;
index = mid % EFS_EXTENTS_PER_BB;
err = efs_bread(emp, ex.ex_bn + bboff, NULL, &bp);
if (err) {
EFS_DPRINTF(("efs_extent_iterator_init: bsrch read\n"));
return;
}
efs_dextent_to_extent((struct efs_dextent *)bp->b_data + index,
&ex2);
brelse(bp, 0);
offset = ex2.ex_offset * EFS_BB_SIZE;
length = ex2.ex_length * EFS_BB_SIZE;
if (start_hint >= offset && start_hint < (offset + length))
break;
if (start_hint < offset)
hi = mid - 1;
else
lo = mid + 1;
}
if (lo > hi) {
EFS_DPRINTF(("efs_extent_iterator_init: bsearch "
"failed to find extent\n"));
return;
}
exi->exi_next = next + mid;
exi->exi_dnext = indir;
exi->exi_innext = mid;
}
int
efs_extent_iterator_next(struct efs_extent_iterator *exi,
struct efs_extent *exp)
{
struct efs_extent ex;
struct efs_dextent *dexp;
struct efs_inode *eip = exi->exi_eip;
struct buf *bp;
int err, bboff, index;
if (exi->exi_next++ >= eip->ei_numextents)
return (-1);
if (eip->ei_numextents <= EFS_DIRECTEXTENTS) {
if (exp != NULL) {
dexp = &eip->ei_di.di_extents[exi->exi_dnext++];
efs_dextent_to_extent(dexp, exp);
}
} else {
efs_dextent_to_extent(
&eip->ei_di.di_extents[exi->exi_dnext], &ex);
bboff = exi->exi_innext / EFS_EXTENTS_PER_BB;
index = exi->exi_innext % EFS_EXTENTS_PER_BB;
err = efs_bread(VFSTOEFS(eip->ei_vp->v_mount),
ex.ex_bn + bboff, NULL, &bp);
if (err) {
EFS_DPRINTF(("efs_extent_iterator_next: "
"efs_bread failed: %d\n", err));
return (err);
}
if (exp != NULL) {
dexp = (struct efs_dextent *)bp->b_data + index;
efs_dextent_to_extent(dexp, exp);
}
brelse(bp, 0);
bboff = exi->exi_innext++ / EFS_EXTENTS_PER_BB;
if (bboff >= ex.ex_length) {
exi->exi_innext = 0;
exi->exi_dnext++;
}
}
return (0);
}