#include <sys/param.h>
#include <sys/errno.h>
#include <sys/buf.h>
#include <sys/vfs.h>
#include <sys/vnode.h>
#include <sys/cmn_err.h>
#include <sys/debug.h>
#include <sys/sysmacros.h>
#include <sys/systm.h>
#include <sys/fs/pc_label.h>
#include <sys/fs/pc_fs.h>
#include <sys/fs/pc_dir.h>
#include <sys/fs/pc_node.h>
static pc_cluster32_t pc_getcluster(struct pcfs *fsp, pc_cluster32_t cn);
int
pc_bmap(struct pcnode *pcp, daddr_t lcn, daddr_t *dbnp, uint_t *contigbp)
{
struct pcfs *fsp;
struct vnode *vp;
pc_cluster32_t cn, ncn;
daddr_t olcn = lcn;
vp = PCTOV(pcp);
fsp = VFSTOPCFS(vp->v_vfsp);
if (lcn < 0)
return (ENOENT);
if (!IS_FAT32(fsp) && (vp->v_flag & VROOT)) {
daddr_t lbn;
lbn = pc_cltodb(fsp, lcn);
if (lbn >= fsp->pcfs_rdirsec) {
PC_DPRINTF0(2, "pc_bmap: ENOENT1\n");
return (ENOENT);
}
*dbnp = pc_dbdaddr(fsp, fsp->pcfs_rdirstart + lbn);
if (contigbp) {
ASSERT (*contigbp >= fsp->pcfs_secsize);
*contigbp = MIN(*contigbp,
fsp->pcfs_secsize * (fsp->pcfs_rdirsec - lbn));
}
return (0);
}
if (lcn >= fsp->pcfs_ncluster) {
PC_DPRINTF0(2, "pc_bmap: ENOENT2\n");
return (ENOENT);
}
if (vp->v_type == VREG &&
(pcp->pc_size == 0 ||
lcn >= (daddr_t)howmany((offset_t)pcp->pc_size,
fsp->pcfs_clsize))) {
PC_DPRINTF0(2, "pc_bmap: ENOENT3\n");
return (ENOENT);
}
ncn = pcp->pc_scluster;
if (IS_FAT32(fsp) && ncn == 0)
ncn = fsp->pcfs_rdirstart;
if (pcp->pc_lindex > 0 && lcn >= pcp->pc_lindex) {
lcn -= pcp->pc_lindex;
ncn = pcp->pc_lcluster;
}
do {
cn = ncn;
if (!pc_validcl(fsp, cn)) {
if (IS_FAT32(fsp) && cn >= PCF_LASTCLUSTER32 &&
vp->v_type == VDIR) {
PC_DPRINTF0(2, "pc_bmap: ENOENT4\n");
return (ENOENT);
} else if (!IS_FAT32(fsp) &&
cn >= PCF_LASTCLUSTER &&
vp->v_type == VDIR) {
PC_DPRINTF0(2, "pc_bmap: ENOENT5\n");
return (ENOENT);
} else {
PC_DPRINTF1(1,
"pc_bmap: badfs cn=%d\n", cn);
(void) pc_badfs(fsp);
return (EIO);
}
}
ncn = pc_getcluster(fsp, cn);
} while (lcn--);
pcp->pc_lindex = olcn;
pcp->pc_lcluster = cn;
*dbnp = pc_cldaddr(fsp, cn);
if (contigbp && *contigbp > fsp->pcfs_clsize) {
uint_t count = fsp->pcfs_clsize;
while ((cn + 1) == ncn && count < *contigbp &&
pc_validcl(fsp, ncn)) {
count += fsp->pcfs_clsize;
cn = ncn;
ncn = pc_getcluster(fsp, ncn);
}
*contigbp = count;
}
return (0);
}
int
pc_balloc(
struct pcnode *pcp,
daddr_t lcn,
int zwrite,
daddr_t *dbnp)
{
struct pcfs *fsp;
struct vnode *vp;
pc_cluster32_t cn;
pc_cluster32_t ncn;
vp = PCTOV(pcp);
fsp = VFSTOPCFS(vp -> v_vfsp);
if (lcn < 0) {
return (EFBIG);
}
if (!IS_FAT32(fsp) && (vp->v_flag & VROOT)) {
daddr_t lbn;
lbn = pc_cltodb(fsp, lcn);
if (lbn >= fsp->pcfs_rdirsec)
return (ENOSPC);
*dbnp = pc_dbdaddr(fsp, fsp->pcfs_rdirstart + lbn);
return (0);
}
if (lcn >= fsp->pcfs_ncluster)
return (ENOSPC);
if ((vp->v_type == VREG && pcp->pc_size == 0) ||
(vp->v_type == VDIR && lcn == 0)) {
switch (cn = pc_alloccluster(fsp, 1)) {
case PCF_FREECLUSTER:
return (ENOSPC);
case PCF_ERRORCLUSTER:
return (EIO);
}
pcp->pc_scluster = cn;
} else {
cn = pcp->pc_scluster;
if (IS_FAT32(fsp) && cn == 0)
cn = fsp->pcfs_rdirstart;
if (!pc_validcl(fsp, cn)) {
PC_DPRINTF1(1, "pc_balloc: badfs cn=%d\n", cn);
(void) pc_badfs(fsp);
return (EIO);
}
}
if (pcp->pc_lindex > 0 && lcn > pcp->pc_lindex) {
lcn -= pcp->pc_lindex;
cn = pcp->pc_lcluster;
}
while (lcn-- > 0) {
ncn = pc_getcluster(fsp, cn);
if ((IS_FAT32(fsp) && ncn >= PCF_LASTCLUSTER32) ||
(!IS_FAT32(fsp) && ncn >= PCF_LASTCLUSTER)) {
switch (ncn = pc_alloccluster(fsp, zwrite)) {
case PCF_FREECLUSTER:
return (ENOSPC);
case PCF_ERRORCLUSTER:
return (EIO);
}
pc_setcluster(fsp, cn, ncn);
} else if (!pc_validcl(fsp, ncn)) {
PC_DPRINTF1(1,
"pc_balloc: badfs ncn=%d\n", ncn);
(void) pc_badfs(fsp);
return (EIO);
}
cn = ncn;
}
*dbnp = pc_cldaddr(fsp, cn);
return (0);
}
int
pc_bfree(struct pcnode *pcp, pc_cluster32_t skipcl)
{
struct pcfs *fsp;
pc_cluster32_t cn;
pc_cluster32_t ncn;
int n;
struct vnode *vp;
vp = PCTOV(pcp);
fsp = VFSTOPCFS(vp->v_vfsp);
if (!IS_FAT32(fsp) && (vp->v_flag & VROOT)) {
panic("pc_bfree");
}
if (pcp->pc_size == 0 && vp->v_type == VREG) {
return (0);
}
if (vp->v_type == VREG) {
n = (int)howmany((offset_t)pcp->pc_size, fsp->pcfs_clsize);
if (n > fsp->pcfs_ncluster) {
PC_DPRINTF1(1, "pc_bfree: badfs n=%d\n", n);
(void) pc_badfs(fsp);
return (EIO);
}
} else {
n = fsp->pcfs_ncluster;
}
cn = pcp->pc_scluster;
if (IS_FAT32(fsp) && cn == 0)
cn = fsp->pcfs_rdirstart;
if (skipcl == 0) {
if (IS_FAT32(fsp))
pcp->pc_scluster = PCF_LASTCLUSTERMARK32;
else
pcp->pc_scluster = PCF_LASTCLUSTERMARK;
}
pcp->pc_lindex = 0;
pcp->pc_lcluster = pcp->pc_scluster;
while (n--) {
if (!pc_validcl(fsp, cn)) {
PC_DPRINTF1(1, "pc_bfree: badfs cn=%d\n", cn);
(void) pc_badfs(fsp);
return (EIO);
}
ncn = pc_getcluster(fsp, cn);
if (skipcl == 0) {
pc_setcluster(fsp, cn, PCF_FREECLUSTER);
} else {
skipcl--;
if (skipcl == 0) {
if (IS_FAT32(fsp)) {
pc_setcluster(fsp, cn,
PCF_LASTCLUSTERMARK32);
} else
pc_setcluster(fsp, cn,
PCF_LASTCLUSTERMARK);
}
}
if (IS_FAT32(fsp) && ncn >= PCF_LASTCLUSTER32 &&
vp->v_type == VDIR)
break;
if (!IS_FAT32(fsp) && ncn >= PCF_LASTCLUSTER &&
vp->v_type == VDIR)
break;
cn = ncn;
}
return (0);
}
int
pc_freeclusters(struct pcfs *fsp)
{
pc_cluster32_t cn;
int free = 0;
if (IS_FAT32(fsp) &&
fsp->pcfs_fsinfo.fs_free_clusters != FSINFO_UNKNOWN)
return (fsp->pcfs_fsinfo.fs_free_clusters);
for (cn = PCF_FIRSTCLUSTER; pc_validcl(fsp, cn); cn++) {
if (pc_getcluster(fsp, cn) == PCF_FREECLUSTER) {
free++;
}
}
if (IS_FAT32(fsp)) {
ASSERT(fsp->pcfs_fsinfo.fs_free_clusters == FSINFO_UNKNOWN);
fsp->pcfs_fsinfo.fs_free_clusters = free;
}
return (free);
}
static pc_cluster32_t
pc_getcluster(struct pcfs *fsp, pc_cluster32_t cn)
{
unsigned char *fp;
if (fsp->pcfs_fatp == NULL || !pc_validcl(fsp, cn))
panic("pc_getcluster");
switch (fsp->pcfs_fattype) {
case FAT32:
fp = fsp->pcfs_fatp + (cn << 2);
cn = ltohi(*(pc_cluster32_t *)fp) & 0x0FFFFFFF;
break;
case FAT16:
fp = fsp->pcfs_fatp + (cn << 1);
cn = ltohs(*(pc_cluster16_t *)fp);
break;
case FAT12:
fp = fsp->pcfs_fatp + (cn + (cn >> 1));
if (cn & 01) {
cn = (((unsigned int)*fp++ & 0xf0) >> 4);
cn += (*fp << 4);
} else {
cn = *fp++;
cn += ((*fp & 0x0f) << 8);
}
if (cn >= PCF_12BCLUSTER)
cn |= PCF_RESCLUSTER;
break;
default:
pc_mark_irrecov(fsp);
cn = PCF_ERRORCLUSTER;
}
return (cn);
}
void
pc_setcluster(struct pcfs *fsp, pc_cluster32_t cn, pc_cluster32_t ncn)
{
unsigned char *fp;
pc_cluster16_t ncn16;
pc_cluster32_t ncn32;
if (fsp->pcfs_fatp == NULL || !pc_validcl(fsp, cn))
panic("pc_setcluster");
fsp->pcfs_flags |= PCFS_FATMOD;
pc_mark_fat_updated(fsp, cn);
switch (fsp->pcfs_fattype) {
case FAT32:
fp = fsp->pcfs_fatp + (cn << 2);
ncn32 = ltohi(*(pc_cluster32_t *)fp) & 0xF0000000;
ncn32 |= (ncn & 0x0FFFFFFF);
*(pc_cluster32_t *)fp = htoli(ncn32);
break;
case FAT16:
fp = fsp->pcfs_fatp + (cn << 1);
ncn16 = (pc_cluster16_t)ncn;
*(pc_cluster16_t *)fp = htols(ncn16);
break;
case FAT12:
fp = fsp->pcfs_fatp + (cn + (cn >> 1));
if (cn & 01) {
*fp = (*fp & 0x0f) | ((ncn << 4) & 0xf0);
fp++;
*fp = (ncn >> 4) & 0xff;
} else {
*fp++ = ncn & 0xff;
*fp = (*fp & 0xf0) | ((ncn >> 8) & 0x0f);
}
break;
default:
pc_mark_irrecov(fsp);
}
if (ncn == PCF_FREECLUSTER) {
fsp->pcfs_nxfrecls = PCF_FIRSTCLUSTER;
if (IS_FAT32(fsp)) {
if (fsp->pcfs_fsinfo.fs_free_clusters !=
FSINFO_UNKNOWN)
fsp->pcfs_fsinfo.fs_free_clusters++;
}
}
}
pc_cluster32_t
pc_alloccluster(
struct pcfs *fsp,
int zwrite)
{
pc_cluster32_t cn;
int error;
if (fsp->pcfs_fatp == NULL)
panic("pc_addcluster: no FAT");
for (cn = fsp->pcfs_nxfrecls; pc_validcl(fsp, cn); cn++) {
if (pc_getcluster(fsp, cn) == PCF_FREECLUSTER) {
struct buf *bp;
if (IS_FAT32(fsp)) {
pc_setcluster(fsp, cn, PCF_LASTCLUSTERMARK32);
if (fsp->pcfs_fsinfo.fs_free_clusters !=
FSINFO_UNKNOWN)
fsp->pcfs_fsinfo.fs_free_clusters--;
} else
pc_setcluster(fsp, cn, PCF_LASTCLUSTERMARK);
if (zwrite) {
bp = ngeteblk(fsp->pcfs_clsize);
bp->b_edev = fsp->pcfs_xdev;
bp->b_dev = cmpdev(bp->b_edev);
bp->b_blkno = pc_cldaddr(fsp, cn);
clrbuf(bp);
bwrite2(bp);
error = geterror(bp);
brelse(bp);
if (error) {
pc_mark_irrecov(fsp);
return (PCF_ERRORCLUSTER);
}
}
fsp->pcfs_nxfrecls = cn + 1;
return (cn);
}
}
return (PCF_FREECLUSTER);
}
int
pc_fileclsize(
struct pcfs *fsp,
pc_cluster32_t startcl, pc_cluster32_t *ncl)
{
int count = 0;
*ncl = 0;
for (count = 0; pc_validcl(fsp, startcl);
startcl = pc_getcluster(fsp, startcl)) {
if (count++ >= fsp->pcfs_ncluster)
return (EIO);
}
*ncl = (pc_cluster32_t)count;
return (0);
}