#include <sys/types.h>
#include <sys/param.h>
#include <sys/sysmacros.h>
#include <sys/errno.h>
#include <sys/uio.h>
#include <sys/buf.h>
#include <sys/modctl.h>
#include <sys/open.h>
#include <sys/kmem.h>
#include <sys/poll.h>
#include <sys/conf.h>
#include <sys/cmn_err.h>
#include <sys/stat.h>
#include <sys/file.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/ramdisk.h>
#include <vm/seg_kmem.h>
#ifdef __sparc
extern int bootops_obp_ramdisk_disabled;
#endif
static void *rd_statep;
static dev_info_t *rd_dip = NULL;
static kmutex_t rd_lock;
static uint32_t rd_max_disks = RD_DFLT_DISKS;
static uint_t rd_percent_physmem = RD_DEFAULT_PERCENT_PHYSMEM;
static pgcnt_t rd_max_physmem;
static pgcnt_t rd_tot_physmem;
static uint_t rd_maxphys = RD_DEFAULT_MAXPHYS;
static int
rd_is_busy(void)
{
minor_t minor;
rd_devstate_t *rsp;
ASSERT(mutex_owned(&rd_lock));
for (minor = 1; minor <= rd_max_disks; ++minor) {
if ((rsp = ddi_get_soft_state(rd_statep, minor)) != NULL &&
rsp->rd_dip == rd_dip) {
return (EBUSY);
}
}
return (0);
}
static minor_t
rd_find_free_minor(void)
{
minor_t minor;
ASSERT(mutex_owned(&rd_lock));
for (minor = 1; minor <= rd_max_disks; ++minor) {
if (ddi_get_soft_state(rd_statep, minor) == NULL) {
return (minor);
}
}
return (0);
}
static rd_devstate_t *
rd_find_named_disk(char *name)
{
minor_t minor;
rd_devstate_t *rsp;
ASSERT(mutex_owned(&rd_lock));
for (minor = 1; minor <= rd_max_disks; ++minor) {
if ((rsp = ddi_get_soft_state(rd_statep, minor)) != NULL &&
strcmp(rsp->rd_name, name) == 0) {
return (rsp);
}
}
return (NULL);
}
static rd_devstate_t *
rd_find_dip_state(dev_info_t *dip)
{
minor_t minor;
rd_devstate_t *rsp;
ASSERT(mutex_owned(&rd_lock));
for (minor = 1; minor <= rd_max_disks; ++minor) {
if ((rsp = ddi_get_soft_state(rd_statep, minor)) != NULL &&
rsp->rd_dip == dip) {
return (rsp);
}
}
return (NULL);
}
static int
rd_is_open(rd_devstate_t *rsp)
{
ASSERT(mutex_owned(&rd_lock));
return (rsp->rd_chr_open || rsp->rd_blk_open || rsp->rd_lyr_open_cnt);
}
static int
rd_opened(rd_devstate_t *rsp, int otyp)
{
ASSERT(mutex_owned(&rd_lock));
switch (otyp) {
case OTYP_CHR:
rsp->rd_chr_open = 1;
break;
case OTYP_BLK:
rsp->rd_blk_open = 1;
break;
case OTYP_LYR:
rsp->rd_lyr_open_cnt++;
break;
default:
return (-1);
}
return (0);
}
static void
rd_closed(rd_devstate_t *rsp, int otyp)
{
ASSERT(mutex_owned(&rd_lock));
switch (otyp) {
case OTYP_CHR:
rsp->rd_chr_open = 0;
break;
case OTYP_BLK:
rsp->rd_blk_open = 0;
break;
case OTYP_LYR:
rsp->rd_lyr_open_cnt--;
break;
default:
break;
}
}
static void
rd_init_tuneables(void)
{
char *prop, *p;
if (ddi_prop_lookup_string(DDI_DEV_T_ANY, rd_dip, 0,
"max_disks", &prop) == DDI_PROP_SUCCESS) {
p = prop;
rd_max_disks = (uint32_t)stoi(&p);
ddi_prop_free(prop);
}
if (rd_max_disks >= RD_MAX_DISKS) {
cmn_err(CE_WARN, "ramdisk: rd_max_disks (%u) too big;"
" using default (%u).", rd_max_disks, RD_MAX_DISKS - 1);
rd_max_disks = RD_MAX_DISKS - 1;
}
if (ddi_prop_lookup_string(DDI_DEV_T_ANY, rd_dip, 0,
"percent_physmem", &prop) == DDI_PROP_SUCCESS) {
p = prop;
rd_percent_physmem = (uint_t)stoi(&p);
ddi_prop_free(prop);
}
if (rd_percent_physmem >= 100) {
cmn_err(CE_WARN, "ramdisk: rd_percent_physmem (%u) >= 100;"
" using default (%u%%).", rd_percent_physmem,
RD_DEFAULT_PERCENT_PHYSMEM);
rd_percent_physmem = RD_DEFAULT_PERCENT_PHYSMEM;
}
rd_max_physmem = (availrmem_initial * rd_percent_physmem) / 100;
}
page_t **
rd_phys_alloc(pgcnt_t npages)
{
page_t *pp, **ppa;
spgcnt_t i;
size_t ppalen;
struct seg kseg;
caddr_t addr;
if (rd_tot_physmem + npages > rd_max_physmem)
return (NULL);
if (!page_resv(npages, KM_NOSLEEP))
return (NULL);
if (!page_create_wait(npages, 0)) {
page_unresv(npages);
return (NULL);
}
ppalen = npages * sizeof (struct page_t *);
ppa = kmem_zalloc(ppalen, KM_NOSLEEP);
if (ppa == NULL) {
page_create_putback(npages);
page_unresv(npages);
return (NULL);
}
kseg.s_as = &kas;
for (i = 0, addr = NULL; i < npages; ++i, addr += PAGESIZE) {
pp = page_get_freelist(&kvp, 0, &kseg, addr, PAGESIZE, 0, NULL);
if (pp == NULL) {
pp = page_get_cachelist(&kvp, 0, &kseg, addr, 0, NULL);
if (pp == NULL)
goto out;
if (!PP_ISAGED(pp))
page_hashout(pp, NULL);
}
PP_CLRFREE(pp);
PP_CLRAGED(pp);
ppa[i] = pp;
}
for (i = 0; i < npages; i++)
page_downgrade(ppa[i]);
rd_tot_physmem += npages;
return (ppa);
out:
ASSERT(i < npages);
page_create_putback(npages - i);
while (--i >= 0)
page_free(ppa[i], 0);
kmem_free(ppa, ppalen);
page_unresv(npages);
return (NULL);
}
static void
rd_phys_free(page_t **ppa, pgcnt_t npages)
{
pgcnt_t i;
size_t ppalen = npages * sizeof (struct page_t *);
for (i = 0; i < npages; ++i) {
if (! page_tryupgrade(ppa[i])) {
page_unlock(ppa[i]);
while (! page_lock(ppa[i], SE_EXCL, NULL, P_RECLAIM))
;
}
page_free(ppa[i], 0);
}
kmem_free(ppa, ppalen);
page_unresv(npages);
rd_tot_physmem -= npages;
}
static void
rd_unmap_window(rd_devstate_t *rsp)
{
ASSERT(rsp->rd_window_obp == 0);
if (rsp->rd_window_base != RD_WINDOW_NOT_MAPPED) {
hat_unload(kas.a_hat, rsp->rd_window_virt, rsp->rd_window_size,
HAT_UNLOAD_UNLOCK);
}
}
static void
rd_map_window(rd_devstate_t *rsp, off_t offset)
{
pgcnt_t offpgs = btop(offset);
if (rsp->rd_window_base != RD_WINDOW_NOT_MAPPED) {
if (offset >= rsp->rd_window_base &&
offset < rsp->rd_window_base + rsp->rd_window_size) {
return;
}
rd_unmap_window(rsp);
}
rsp->rd_window_base = ptob(offpgs);
if (rsp->rd_dip == rd_dip) {
pgcnt_t pi, lastpi;
caddr_t vaddr;
pi = offpgs;
lastpi = pi + btopr(rsp->rd_window_size);
if (lastpi > rsp->rd_npages) {
lastpi = rsp->rd_npages;
}
vaddr = rsp->rd_window_virt;
for (; pi < lastpi; ++pi) {
hat_memload(kas.a_hat, vaddr, rsp->rd_ppa[pi],
(PROT_READ | PROT_WRITE) | HAT_NOSYNC,
HAT_LOAD_LOCK);
vaddr += ptob(1);
}
} else {
uint_t i;
pfn_t pfn;
for (i = 0; i < rsp->rd_nexisting; ++i) {
if (offset < rsp->rd_existing[i].size) {
break;
}
offset -= rsp->rd_existing[i].size;
}
ASSERT(i < rsp->rd_nexisting);
pfn = btop(rsp->rd_existing[i].phys + offset);
hat_devload(kas.a_hat, rsp->rd_window_virt, rsp->rd_window_size,
pfn, (PROT_READ | PROT_WRITE),
HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
}
}
static void
rd_fake_disk_geometry(rd_devstate_t *rsp)
{
if (rsp->rd_size < (2 * 1024 * 1024))
rsp->rd_dkg.dkg_ncyl = rsp->rd_size / (100 * 1024);
else
rsp->rd_dkg.dkg_ncyl = rsp->rd_size / (300 * 1024);
if (rsp->rd_dkg.dkg_ncyl == 0)
rsp->rd_dkg.dkg_ncyl = 1;
rsp->rd_dkg.dkg_acyl = 0;
rsp->rd_dkg.dkg_bcyl = 0;
rsp->rd_dkg.dkg_nhead = 1;
rsp->rd_dkg.dkg_obs1 = 0;
rsp->rd_dkg.dkg_intrlv = 0;
rsp->rd_dkg.dkg_obs2 = 0;
rsp->rd_dkg.dkg_obs3 = 0;
rsp->rd_dkg.dkg_apc = 0;
rsp->rd_dkg.dkg_rpm = 7200;
rsp->rd_dkg.dkg_pcyl = rsp->rd_dkg.dkg_ncyl + rsp->rd_dkg.dkg_acyl;
rsp->rd_dkg.dkg_nsect = rsp->rd_size /
(DEV_BSIZE * rsp->rd_dkg.dkg_ncyl);
rsp->rd_dkg.dkg_write_reinstruct = 0;
rsp->rd_dkg.dkg_read_reinstruct = 0;
bzero(&rsp->rd_vtoc, sizeof (struct vtoc));
rsp->rd_vtoc.v_sanity = VTOC_SANE;
rsp->rd_vtoc.v_version = V_VERSION;
bcopy(RD_DRIVER_NAME, rsp->rd_vtoc.v_volume, 7);
rsp->rd_vtoc.v_sectorsz = DEV_BSIZE;
rsp->rd_vtoc.v_nparts = 1;
rsp->rd_vtoc.v_part[0].p_tag = V_UNASSIGNED;
rsp->rd_vtoc.v_part[0].p_flag = V_UNMNT;
rsp->rd_vtoc.v_part[0].p_start = (daddr_t)0;
rsp->rd_vtoc.v_part[0].p_size = rsp->rd_dkg.dkg_pcyl *
rsp->rd_dkg.dkg_nsect * rsp->rd_dkg.dkg_nhead;
bzero(&rsp->rd_ci, sizeof (struct dk_cinfo));
(void) strcpy(rsp->rd_ci.dki_cname, RD_DRIVER_NAME);
rsp->rd_ci.dki_ctype = DKC_MD;
rsp->rd_ci.dki_flags = 0;
rsp->rd_ci.dki_cnum = 0;
rsp->rd_ci.dki_addr = 0;
rsp->rd_ci.dki_space = 0;
rsp->rd_ci.dki_prio = 0;
rsp->rd_ci.dki_vec = 0;
(void) strcpy(rsp->rd_ci.dki_dname, RD_DRIVER_NAME);
rsp->rd_ci.dki_unit = 0;
rsp->rd_ci.dki_slave = 0;
rsp->rd_ci.dki_partition = 0;
rsp->rd_ci.dki_maxtransfer = 16;
}
static void
rd_dealloc_resources(rd_devstate_t *rsp)
{
dev_info_t *dip = rsp->rd_dip;
char namebuf[RD_NAME_LEN + 5];
dev_t fulldev;
if (rsp->rd_window_obp == 0 && rsp->rd_window_virt != NULL) {
if (rsp->rd_window_base != RD_WINDOW_NOT_MAPPED) {
rd_unmap_window(rsp);
}
vmem_free(heap_arena, rsp->rd_window_virt, rsp->rd_window_size);
}
mutex_destroy(&rsp->rd_device_lock);
if (rsp->rd_existing) {
ddi_prop_free(rsp->rd_existing);
}
if (rsp->rd_ppa != NULL) {
rd_phys_free(rsp->rd_ppa, rsp->rd_npages);
}
if (dip == rd_dip) {
(void) snprintf(namebuf, sizeof (namebuf), "%s",
rsp->rd_name);
ddi_remove_minor_node(dip, namebuf);
(void) snprintf(namebuf, sizeof (namebuf), "%s,raw",
rsp->rd_name);
ddi_remove_minor_node(dip, namebuf);
} else {
ddi_remove_minor_node(dip, "a");
ddi_remove_minor_node(dip, "a,raw");
}
fulldev = makedevice(ddi_driver_major(dip), rsp->rd_minor);
(void) ddi_prop_remove(fulldev, dip, SIZE_PROP_NAME);
(void) ddi_prop_remove(fulldev, dip, NBLOCKS_PROP_NAME);
if (rsp->rd_kstat) {
kstat_delete(rsp->rd_kstat);
mutex_destroy(&rsp->rd_kstat_lock);
}
ddi_soft_state_free(rd_statep, rsp->rd_minor);
}
static rd_devstate_t *
rd_alloc_resources(char *name, uint_t addr, size_t size, dev_info_t *dip)
{
minor_t minor;
rd_devstate_t *rsp;
char namebuf[RD_NAME_LEN + 5];
dev_t fulldev;
int64_t Nblocks_prop_val;
int64_t Size_prop_val;
minor = rd_find_free_minor();
if (ddi_soft_state_zalloc(rd_statep, minor) == DDI_FAILURE) {
return (NULL);
}
rsp = ddi_get_soft_state(rd_statep, minor);
(void) strcpy(rsp->rd_name, name);
rsp->rd_dip = dip;
rsp->rd_minor = minor;
rsp->rd_size = size;
mutex_init(&rsp->rd_device_lock, NULL, MUTEX_DRIVER, NULL);
if (addr == 0) {
rsp->rd_window_obp = 0;
rsp->rd_window_base = RD_WINDOW_NOT_MAPPED;
rsp->rd_window_size = PAGESIZE;
rsp->rd_window_virt = vmem_alloc(heap_arena,
rsp->rd_window_size, VM_SLEEP);
if (rsp->rd_window_virt == NULL) {
goto create_failed;
}
} else {
rsp->rd_window_obp = 1;
rsp->rd_window_base = 0;
rsp->rd_window_size = size;
rsp->rd_window_virt = (caddr_t)((ulong_t)addr);
}
if (dip == rd_dip) {
rsp->rd_npages = btopr(size);
rsp->rd_ppa = rd_phys_alloc(rsp->rd_npages);
if (rsp->rd_ppa == NULL) {
goto create_failed;
}
(void) snprintf(namebuf, sizeof (namebuf), "%s",
rsp->rd_name);
if (ddi_create_minor_node(dip, namebuf, S_IFBLK, minor,
DDI_PSEUDO, 0) == DDI_FAILURE) {
goto create_failed;
}
(void) snprintf(namebuf, sizeof (namebuf), "%s,raw",
rsp->rd_name);
if (ddi_create_minor_node(dip, namebuf, S_IFCHR, minor,
DDI_PSEUDO, 0) == DDI_FAILURE) {
goto create_failed;
}
} else {
if (ddi_create_minor_node(dip, "a", S_IFBLK, minor,
DDI_PSEUDO, 0) == DDI_FAILURE) {
goto create_failed;
}
if (ddi_create_minor_node(dip, "a,raw", S_IFCHR, minor,
DDI_PSEUDO, 0) == DDI_FAILURE) {
goto create_failed;
}
}
fulldev = makedevice(ddi_driver_major(dip), minor);
Size_prop_val = size;
if ((ddi_prop_update_int64(fulldev, dip,
SIZE_PROP_NAME, Size_prop_val)) != DDI_PROP_SUCCESS) {
goto create_failed;
}
Nblocks_prop_val = size / DEV_BSIZE;
if ((ddi_prop_update_int64(fulldev, dip,
NBLOCKS_PROP_NAME, Nblocks_prop_val)) != DDI_PROP_SUCCESS) {
goto create_failed;
}
rsp->rd_kstat = kstat_create(RD_DRIVER_NAME, minor, NULL,
"disk", KSTAT_TYPE_IO, 1, 0);
if (rsp->rd_kstat) {
mutex_init(&rsp->rd_kstat_lock, NULL,
MUTEX_DRIVER, NULL);
rsp->rd_kstat->ks_lock = &rsp->rd_kstat_lock;
kstat_install(rsp->rd_kstat);
}
rd_fake_disk_geometry(rsp);
return (rsp);
create_failed:
rd_dealloc_resources(rsp);
return (NULL);
}
static int
rd_common_detach(dev_info_t *dip)
{
if (dip == rd_dip) {
if (rd_is_busy()) {
return (DDI_FAILURE);
}
ddi_soft_state_free(rd_statep, RD_CTL_MINOR);
rd_dip = NULL;
} else {
rd_devstate_t *rsp;
if ((rsp = rd_find_dip_state(dip)) != NULL) {
rd_dealloc_resources(rsp);
}
}
ddi_remove_minor_node(dip, NULL);
return (DDI_SUCCESS);
}
static int
rd_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
char *name;
rd_existing_t *ep = NULL;
uint_t obpaddr = 0, nep, i;
size_t size = 0;
rd_devstate_t *rsp;
switch (cmd) {
case DDI_ATTACH:
mutex_enter(&rd_lock);
if (is_pseudo_device(dip)) {
rd_dip = dip;
rd_init_tuneables();
if (ddi_soft_state_zalloc(rd_statep, RD_CTL_MINOR) ==
DDI_FAILURE) {
goto attach_failed;
}
rsp = ddi_get_soft_state(rd_statep, RD_CTL_MINOR);
rsp->rd_dip = dip;
if (ddi_create_minor_node(dip, RD_CTL_NODE,
S_IFCHR, 0, DDI_PSEUDO, 0) == DDI_FAILURE) {
goto attach_failed;
}
} else {
#ifdef __sparc
if (bootops_obp_ramdisk_disabled)
goto attach_failed;
#endif
RD_STRIP_PREFIX(name, ddi_node_name(dip));
if (strlen(name) > RD_NAME_LEN) {
cmn_err(CE_CONT,
"%s: name too long - ignoring\n", name);
goto attach_failed;
}
if (ddi_prop_lookup_byte_array(DDI_DEV_T_ANY, dip,
DDI_PROP_DONTPASS, OBP_EXISTING_PROP_NAME,
(uchar_t **)&ep, &nep) == DDI_SUCCESS) {
if (nep == 0 || (nep % sizeof (*ep)) != 0) {
cmn_err(CE_CONT,
"%s: " OBP_EXISTING_PROP_NAME
" illegal size\n", name);
goto attach_failed;
}
nep /= sizeof (*ep);
for (i = 0; i < nep; ++i) {
size += ep[i].size;
}
} else if ((obpaddr = ddi_prop_get_int(DDI_DEV_T_ANY,
dip, DDI_PROP_DONTPASS, OBP_ADDRESS_PROP_NAME,
0)) != 0) {
size = ddi_prop_get_int(DDI_DEV_T_ANY, dip,
DDI_PROP_DONTPASS, OBP_SIZE_PROP_NAME, 0);
} else {
cmn_err(CE_CONT, "%s: missing OBP properties\n",
name);
goto attach_failed;
}
if ((rsp = rd_alloc_resources(name, obpaddr, size,
dip)) == NULL) {
goto attach_failed;
}
rsp->rd_existing = ep;
rsp->rd_nexisting = nep;
}
mutex_exit(&rd_lock);
ddi_report_dev(dip);
return (DDI_SUCCESS);
case DDI_RESUME:
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
attach_failed:
(void) rd_common_detach(dip);
mutex_exit(&rd_lock);
if (ep != NULL) {
ddi_prop_free(ep);
}
return (DDI_FAILURE);
}
static int
rd_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
int e;
switch (cmd) {
case DDI_DETACH:
mutex_enter(&rd_lock);
e = rd_common_detach(dip);
mutex_exit(&rd_lock);
return (e);
case DDI_SUSPEND:
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
}
static int
rd_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg, void **result)
{
rd_devstate_t *rsp;
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
if ((rsp = ddi_get_soft_state(rd_statep,
getminor((dev_t)arg))) != NULL) {
*result = rsp->rd_dip;
return (DDI_SUCCESS);
}
*result = NULL;
return (DDI_FAILURE);
case DDI_INFO_DEVT2INSTANCE:
if ((rsp = ddi_get_soft_state(rd_statep,
getminor((dev_t)arg))) != NULL) {
*result = (void *)(uintptr_t)
ddi_get_instance(rsp->rd_dip);
return (DDI_SUCCESS);
}
*result = NULL;
return (DDI_FAILURE);
default:
return (DDI_FAILURE);
}
}
static int
rd_open(dev_t *devp, int flag, int otyp, cred_t *credp)
{
minor_t minor;
rd_devstate_t *rsp;
mutex_enter(&rd_lock);
minor = getminor(*devp);
if (minor == RD_CTL_MINOR) {
if ((flag & FEXCL) != FEXCL || otyp != OTYP_CHR) {
mutex_exit(&rd_lock);
return (EINVAL);
}
rsp = ddi_get_soft_state(rd_statep, RD_CTL_MINOR);
if (rsp == NULL) {
mutex_exit(&rd_lock);
return (ENXIO);
}
if (rd_is_open(rsp)) {
mutex_exit(&rd_lock);
return (EBUSY);
}
(void) rd_opened(rsp, OTYP_CHR);
mutex_exit(&rd_lock);
return (0);
}
rsp = ddi_get_soft_state(rd_statep, minor);
if (rsp == NULL) {
mutex_exit(&rd_lock);
return (ENXIO);
}
if (rd_opened(rsp, otyp) == -1) {
mutex_exit(&rd_lock);
return (EINVAL);
}
mutex_exit(&rd_lock);
return (0);
}
static int
rd_close(dev_t dev, int flag, int otyp, struct cred *credp)
{
minor_t minor;
rd_devstate_t *rsp;
mutex_enter(&rd_lock);
minor = getminor(dev);
rsp = ddi_get_soft_state(rd_statep, minor);
if (rsp == NULL) {
mutex_exit(&rd_lock);
return (EINVAL);
}
rd_closed(rsp, otyp);
mutex_exit(&rd_lock);
return (0);
}
static void
rd_minphys(struct buf *bp)
{
if (bp->b_bcount > rd_maxphys) {
bp->b_bcount = rd_maxphys;
}
}
static void
rd_rw(rd_devstate_t *rsp, struct buf *bp, offset_t offset, size_t nbytes)
{
int reading = bp->b_flags & B_READ;
caddr_t buf_addr;
bp_mapin(bp);
buf_addr = bp->b_un.b_addr;
while (nbytes > 0) {
offset_t off_in_window;
size_t rem_in_window, copy_bytes;
caddr_t raddr;
mutex_enter(&rsp->rd_device_lock);
rd_map_window(rsp, offset);
off_in_window = offset - rsp->rd_window_base;
rem_in_window = rsp->rd_window_size - off_in_window;
raddr = rsp->rd_window_virt + off_in_window;
copy_bytes = MIN(nbytes, rem_in_window);
if (reading) {
(void) bcopy(raddr, buf_addr, copy_bytes);
} else {
(void) bcopy(buf_addr, raddr, copy_bytes);
}
mutex_exit(&rsp->rd_device_lock);
offset += copy_bytes;
buf_addr += copy_bytes;
nbytes -= copy_bytes;
}
}
static int
rd_strategy(struct buf *bp)
{
rd_devstate_t *rsp;
offset_t offset;
rsp = ddi_get_soft_state(rd_statep, getminor(bp->b_edev));
offset = bp->b_blkno * DEV_BSIZE;
#ifdef __sparc
if (rsp == NULL ||
(bootops_obp_ramdisk_disabled &&
(rsp->rd_dip != rd_dip || rd_dip == NULL))) {
#else
if (rsp == NULL) {
#endif
bp->b_error = ENXIO;
bp->b_flags |= B_ERROR;
} else if (offset >= rsp->rd_size) {
bp->b_error = EINVAL;
bp->b_flags |= B_ERROR;
} else {
size_t nbytes;
if (rsp->rd_kstat) {
mutex_enter(rsp->rd_kstat->ks_lock);
kstat_runq_enter(KSTAT_IO_PTR(rsp->rd_kstat));
mutex_exit(rsp->rd_kstat->ks_lock);
}
nbytes = min(bp->b_bcount, rsp->rd_size - offset);
rd_rw(rsp, bp, offset, nbytes);
bp->b_resid = bp->b_bcount - nbytes;
if (rsp->rd_kstat) {
kstat_io_t *kioptr;
mutex_enter(rsp->rd_kstat->ks_lock);
kioptr = KSTAT_IO_PTR(rsp->rd_kstat);
if (bp->b_flags & B_READ) {
kioptr->nread += nbytes;
kioptr->reads++;
} else {
kioptr->nwritten += nbytes;
kioptr->writes++;
}
kstat_runq_exit(kioptr);
mutex_exit(rsp->rd_kstat->ks_lock);
}
}
biodone(bp);
return (0);
}
static int
rd_read(dev_t dev, struct uio *uiop, cred_t *credp)
{
rd_devstate_t *rsp;
rsp = ddi_get_soft_state(rd_statep, getminor(dev));
if (uiop->uio_offset >= rsp->rd_size)
return (EINVAL);
return (physio(rd_strategy, NULL, dev, B_READ, rd_minphys, uiop));
}
static int
rd_write(dev_t dev, register struct uio *uiop, cred_t *credp)
{
rd_devstate_t *rsp;
rsp = ddi_get_soft_state(rd_statep, getminor(dev));
if (uiop->uio_offset >= rsp->rd_size)
return (EINVAL);
return (physio(rd_strategy, NULL, dev, B_WRITE, rd_minphys, uiop));
}
static int
rd_create_disk(dev_t dev, struct rd_ioctl *urip, int mode, int *rvalp)
{
struct rd_ioctl kri;
size_t size;
rd_devstate_t *rsp;
if (ddi_copyin(urip, &kri, sizeof (kri), mode) == -1) {
return (EFAULT);
}
kri.ri_name[RD_NAME_LEN] = '\0';
size = kri.ri_size;
if (size == 0) {
return (EINVAL);
}
size = ptob(btopr(size));
mutex_enter(&rd_lock);
if (rd_find_named_disk(kri.ri_name) != NULL) {
mutex_exit(&rd_lock);
return (EEXIST);
}
rsp = rd_alloc_resources(kri.ri_name, 0, size, rd_dip);
if (rsp == NULL) {
mutex_exit(&rd_lock);
return (EAGAIN);
}
mutex_exit(&rd_lock);
return (ddi_copyout(&kri, urip, sizeof (kri), mode) == -1 ? EFAULT : 0);
}
static int
rd_delete_disk(dev_t dev, struct rd_ioctl *urip, int mode)
{
struct rd_ioctl kri;
rd_devstate_t *rsp;
if (ddi_copyin(urip, &kri, sizeof (kri), mode) == -1) {
return (EFAULT);
}
kri.ri_name[RD_NAME_LEN] = '\0';
mutex_enter(&rd_lock);
rsp = rd_find_named_disk(kri.ri_name);
if (rsp == NULL || rsp->rd_dip != rd_dip) {
mutex_exit(&rd_lock);
return (EINVAL);
}
if (rd_is_open(rsp)) {
mutex_exit(&rd_lock);
return (EBUSY);
}
rd_dealloc_resources(rsp);
mutex_exit(&rd_lock);
return (0);
}
static int
rd_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
minor_t minor;
int error;
enum dkio_state dkstate;
rd_devstate_t *rsp;
minor = getminor(dev);
if (minor == RD_CTL_MINOR) {
struct rd_ioctl *rip = (struct rd_ioctl *)arg;
switch (cmd) {
case RD_CREATE_DISK:
if ((mode & FWRITE) == 0)
return (EPERM);
return (rd_create_disk(dev, rip, mode, rvalp));
case RD_DELETE_DISK:
if ((mode & FWRITE) == 0)
return (EPERM);
return (rd_delete_disk(dev, rip, mode));
default:
return (EINVAL);
}
}
rsp = ddi_get_soft_state(rd_statep, minor);
if (rsp == NULL) {
return (ENXIO);
}
switch (cmd) {
case DKIOCGVTOC:
switch (ddi_model_convert_from(mode & FMODELS)) {
case DDI_MODEL_ILP32: {
struct vtoc32 vtoc32;
vtoctovtoc32(rsp->rd_vtoc, vtoc32);
if (ddi_copyout(&vtoc32, (void *)arg,
sizeof (struct vtoc32), mode))
return (EFAULT);
}
break;
case DDI_MODEL_NONE:
if (ddi_copyout(&rsp->rd_vtoc, (void *)arg,
sizeof (struct vtoc), mode))
return (EFAULT);
break;
}
return (0);
case DKIOCINFO:
error = ddi_copyout(&rsp->rd_ci, (void *)arg,
sizeof (struct dk_cinfo), mode);
if (error)
return (EFAULT);
return (0);
case DKIOCG_VIRTGEOM:
case DKIOCG_PHYGEOM:
case DKIOCGGEOM:
error = ddi_copyout(&rsp->rd_dkg, (void *)arg,
sizeof (struct dk_geom), mode);
if (error)
return (EFAULT);
return (0);
case DKIOCSTATE:
dkstate = DKIO_INSERTED;
error = ddi_copyout(&dkstate, (void *)arg,
sizeof (enum dkio_state), mode);
if (error)
return (EFAULT);
return (0);
default:
return (ENOTTY);
}
}
static struct cb_ops rd_cb_ops = {
rd_open,
rd_close,
rd_strategy,
nodev,
nodev,
rd_read,
rd_write,
rd_ioctl,
nodev,
nodev,
nodev,
nochpoll,
ddi_prop_op,
NULL,
D_NEW | D_MP
};
static struct dev_ops rd_ops = {
DEVO_REV,
0,
rd_getinfo,
nulldev,
nulldev,
rd_attach,
rd_detach,
nodev,
&rd_cb_ops,
(struct bus_ops *)0,
NULL,
ddi_quiesce_not_needed,
};
extern struct mod_ops mod_driverops;
static struct modldrv modldrv = {
&mod_driverops,
"ramdisk driver",
&rd_ops
};
static struct modlinkage modlinkage = {
MODREV_1,
&modldrv,
0
};
int
_init(void)
{
int e;
if ((e = ddi_soft_state_init(&rd_statep,
sizeof (rd_devstate_t), 0)) != 0) {
return (e);
}
mutex_init(&rd_lock, NULL, MUTEX_DRIVER, NULL);
if ((e = mod_install(&modlinkage)) != 0) {
mutex_destroy(&rd_lock);
ddi_soft_state_fini(&rd_statep);
}
return (e);
}
int
_fini(void)
{
int e;
if ((e = mod_remove(&modlinkage)) != 0) {
return (e);
}
ddi_soft_state_fini(&rd_statep);
mutex_destroy(&rd_lock);
return (e);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}