diff options
Diffstat (limited to 'sys/kern/subr_disk.c')
| -rw-r--r-- | sys/kern/subr_disk.c | 243 |
1 files changed, 243 insertions, 0 deletions
diff --git a/sys/kern/subr_disk.c b/sys/kern/subr_disk.c new file mode 100644 index 0000000..a28079c --- /dev/null +++ b/sys/kern/subr_disk.c @@ -0,0 +1,243 @@ +/* + * ---------------------------------------------------------------------------- + * "THE BEER-WARE LICENSE" (Revision 42): + * <phk@FreeBSD.ORG> wrote this file. As long as you retain this notice you + * can do whatever you want with this stuff. If we meet some day, and you think + * this stuff is worth it, you can buy me a beer in return. Poul-Henning Kamp + * ---------------------------------------------------------------------------- + * + * $FreeBSD$ + * + */ + +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/kernel.h> +#include <sys/sysctl.h> +#include <sys/buf.h> +#include <sys/conf.h> +#include <sys/disk.h> +#include <sys/malloc.h> +#include <machine/md_var.h> + +MALLOC_DEFINE(M_DISK, "disk", "disk data"); + +static d_strategy_t diskstrategy; +static d_open_t diskopen; +static d_close_t diskclose; +static d_ioctl_t diskioctl; +static d_psize_t diskpsize; + +dev_t +disk_create(int unit, struct disk *dp, int flags, struct cdevsw *cdevsw, struct cdevsw *proto) +{ + dev_t dev; + + bzero(dp, sizeof(*dp)); + + dev = makedev(cdevsw->d_maj, 0); + if (!devsw(dev)) { + *proto = *cdevsw; + proto->d_open = diskopen; + proto->d_close = diskclose; + proto->d_ioctl = diskioctl; + proto->d_strategy = diskstrategy; + proto->d_psize = diskpsize; + cdevsw_add(proto); + } + + if (bootverbose) + printf("Creating DISK %s%d\n", cdevsw->d_name, unit); + dev = make_dev(proto, dkmakeminor(unit, WHOLE_DISK_SLICE, RAW_PART), + 0, 0, 0, "r%s%d", cdevsw->d_name, unit); + + dev->si_disk = dp; + dp->d_dev = dev; + dp->d_dsflags = flags; + dp->d_devsw = cdevsw; + return (dev); +} + +int +disk_dumpcheck(dev_t dev, u_int *count, u_int *blkno, u_int *secsize) +{ + struct disk *dp; + struct disklabel *dl; + u_int boff; + + dp = dev->si_disk; + if (!dp) + return (ENXIO); + if (!dp->d_slice) + return (ENXIO); + dl = dsgetlabel(dev, dp->d_slice); + if (!dl) + return (ENXIO); + *count = (u_long)Maxmem * PAGE_SIZE / dl->d_secsize; + if (dumplo < 0 || + (dumplo + *count > dl->d_partitions[dkpart(dev)].p_size)) + return (EINVAL); + boff = dl->d_partitions[dkpart(dev)].p_offset + + dp->d_slice->dss_slices[dkslice(dev)].ds_offset; + *blkno = boff + dumplo; + *secsize = dl->d_secsize; + return (0); + +} + +void +disk_invalidate (struct disk *disk) +{ + dsgone(&disk->d_slice); +} + +void +disk_delete(dev_t dev) +{ + return; +} + +/* + * The cdevsw functions + */ + +static int +diskopen(dev_t dev, int oflags, int devtype, struct proc *p) +{ + dev_t pdev; + struct disk *dp; + int error; + + error = 0; + pdev = dkmodpart(dkmodslice(dev, WHOLE_DISK_SLICE), RAW_PART); + + dp = pdev->si_disk; + if (!dp) + return (ENXIO); + + while (dp->d_flags & DISKFLAG_LOCK) { + dp->d_flags |= DISKFLAG_WANTED; + tsleep(dp, PRIBIO | PCATCH, "diskopen", hz); + } + dp->d_flags |= DISKFLAG_LOCK; + + if (!dsisopen(dp->d_slice)) { + if (!pdev->si_iosize_max) + pdev->si_iosize_max = dev->si_iosize_max; + error = dp->d_devsw->d_open(pdev, oflags, devtype, p); + } + + /* Inherit properties from the whole/raw dev_t */ + dev->si_disk = pdev->si_disk; + dev->si_drv1 = pdev->si_drv1; + dev->si_drv2 = pdev->si_drv2; + dev->si_iosize_max = pdev->si_iosize_max; + dev->si_bsize_phys = pdev->si_bsize_phys; + dev->si_bsize_best = pdev->si_bsize_best; + + if (error) + goto out; + + error = dsopen(dev, devtype, dp->d_dsflags, &dp->d_slice, &dp->d_label); + + if (!dsisopen(dp->d_slice)) + dp->d_devsw->d_close(pdev, oflags, devtype, p); +out: + dp->d_flags &= ~DISKFLAG_LOCK; + if (dp->d_flags & DISKFLAG_WANTED) { + dp->d_flags &= ~DISKFLAG_WANTED; + wakeup(dp); + } + + return(error); +} + +static int +diskclose(dev_t dev, int fflag, int devtype, struct proc *p) +{ + struct disk *dp; + int error; + + error = 0; + dp = dev->si_disk; + dsclose(dev, devtype, dp->d_slice); + if (!dsisopen(dp->d_slice)) { + error = dp->d_devsw->d_close(dp->d_dev, fflag, devtype, p); + } + return (error); +} + +static void +diskstrategy(struct buf *bp) +{ + dev_t pdev; + struct disk *dp; + + dp = bp->b_dev->si_disk; + if (!dp) { + pdev = dkmodpart(dkmodslice(bp->b_dev, WHOLE_DISK_SLICE), RAW_PART); + dp = bp->b_dev->si_disk = pdev->si_disk; + bp->b_dev->si_drv1 = pdev->si_drv1; + bp->b_dev->si_drv2 = pdev->si_drv2; + bp->b_dev->si_iosize_max = pdev->si_iosize_max; + bp->b_dev->si_bsize_phys = pdev->si_bsize_phys; + bp->b_dev->si_bsize_best = pdev->si_bsize_best; + } + + if (!dp) { + bp->b_error = ENXIO; + bp->b_flags |= B_ERROR; + biodone(bp); + return; + } + + if (dscheck(bp, dp->d_slice) < 0) { + biodone(bp); + return; + } + + dp->d_devsw->d_strategy(bp); + return; + +} + +static int +diskioctl(dev_t dev, u_long cmd, caddr_t data, int fflag, struct proc *p) +{ + struct disk *dp; + int error; + + dp = dev->si_disk; + error = dsioctl(dev, cmd, data, fflag, &dp->d_slice); + if (error == ENOIOCTL) + error = dp->d_devsw->d_ioctl(dev, cmd, data, fflag, p); + return (error); +} + +static int +diskpsize(dev_t dev) +{ + struct disk *dp; + dev_t pdev; + + dp = dev->si_disk; + if (!dp) { + pdev = dkmodpart(dkmodslice(dev, WHOLE_DISK_SLICE), RAW_PART); + dp = pdev->si_disk; + dev->si_drv1 = pdev->si_drv1; + dev->si_drv2 = pdev->si_drv2; + /* XXX: don't set bp->b_dev->si_disk (?) */ + } + return (dssize(dev, &dp->d_slice)); +} + +SYSCTL_DECL(_debug_sizeof); + +SYSCTL_INT(_debug_sizeof, OID_AUTO, disklabel, CTLFLAG_RD, + 0, sizeof(struct disklabel), "sizeof(struct disklabel)"); + +SYSCTL_INT(_debug_sizeof, OID_AUTO, diskslices, CTLFLAG_RD, + 0, sizeof(struct diskslices), "sizeof(struct diskslices)"); + +SYSCTL_INT(_debug_sizeof, OID_AUTO, disk, CTLFLAG_RD, + 0, sizeof(struct disk), "sizeof(struct disk)"); |
