#include <sys/types.h>
#include <sys/conf.h>
#include <sys/crc32.h>
#include <sys/ddi.h>
#include <sys/dkio.h>
#include <sys/file.h>
#include <sys/fs/hsfs_isospec.h>
#include <sys/mdeg.h>
#include <sys/mhd.h>
#include <sys/modhash.h>
#include <sys/note.h>
#include <sys/pathname.h>
#include <sys/sdt.h>
#include <sys/sunddi.h>
#include <sys/sunldi.h>
#include <sys/sysmacros.h>
#include <sys/vio_common.h>
#include <sys/vio_util.h>
#include <sys/vdsk_mailbox.h>
#include <sys/vdsk_common.h>
#include <sys/vtoc.h>
#include <sys/vfs.h>
#include <sys/stat.h>
#include <sys/scsi/impl/uscsi.h>
#include <sys/ontrap.h>
#include <vm/seg_map.h>
#define ONE_MEGABYTE (1ULL << 20)
#define ONE_GIGABYTE (1ULL << 30)
#define ONE_TERABYTE (1ULL << 40)
#define VDS_LDI 0x01
#define VDS_MDEG 0x02
#define VDS_RETRIES 5
#define VDS_LDC_DELAY 1000
#define VDS_DEV_DELAY 10000000
#define VDS_NCHAINS 32
#define VDS_NAME "virtual-disk-server"
#define VD_NAME "vd"
#define VD_VOLUME_NAME "vdisk"
#define VD_ASCIILABEL "Virtual Disk"
#define VD_CHANNEL_ENDPOINT "channel-endpoint"
#define VD_ID_PROP "id"
#define VD_BLOCK_DEVICE_PROP "vds-block-device"
#define VD_BLOCK_DEVICE_OPTS "vds-block-device-opts"
#define VD_REG_PROP "reg"
#define VD_DISK_READY 0x01
#define VD_LOCKING 0x02
#define VD_LDC 0x04
#define VD_DRING 0x08
#define VD_SID 0x10
#define VD_SEQ_NUM 0x20
#define VD_SETUP_ERROR 0x40
#define VD_DSKIMG_NUM_BACKUP 5
#define VD_SCSI_RDWR_TIMEOUT 30
#define VD_IOQ_NTHREADS 8
#define VD_MAXPART (NDKMAP + 1)
#define VD_ENTIRE_DISK_SLICE 2
#define VD_EFI_LBA_GPT 1
#define VD_EFI_LBA_GPE 2
#define VD_EFI_DEV_SET(dev, vdsk, ioctl) \
VDSK_EFI_DEV_SET(dev, vdsk, ioctl, \
(vdsk)->vdisk_bsize, (vdsk)->vdisk_size)
#define VD_AWFLUSH_IMMEDIATE 0x01
#define VD_AWFLUSH_DEFER 0x02
#define VD_AWFLUSH_GROUP 0x04
typedef enum vd_driver {
VD_DRIVER_UNKNOWN = 0,
VD_DRIVER_DISK,
VD_DRIVER_VOLUME
} vd_driver_t;
#define VD_DRIVER_NAME_LEN 64
#define VDS_NUM_DRIVERS (sizeof (vds_driver_types) / sizeof (vd_driver_type_t))
typedef struct vd_driver_type {
char name[VD_DRIVER_NAME_LEN];
vd_driver_t type;
} vd_driver_type_t;
vd_driver_type_t vds_driver_types[] = {
{ "dad", VD_DRIVER_DISK },
{ "did", VD_DRIVER_DISK },
{ "dlmfdrv", VD_DRIVER_DISK },
{ "emcp", VD_DRIVER_DISK },
{ "lofi", VD_DRIVER_VOLUME },
{ "md", VD_DRIVER_VOLUME },
{ "sd", VD_DRIVER_DISK },
{ "ssd", VD_DRIVER_DISK },
{ "vdc", VD_DRIVER_DISK },
{ "vxdmp", VD_DRIVER_DISK },
{ "vxio", VD_DRIVER_VOLUME },
{ "zfs", VD_DRIVER_VOLUME }
};
#define STRINGIZE(token) #token
#define PRN(...) _PRN("?%s(): "__VA_ARGS__, "")
#define _PRN(format, ...) \
cmn_err(CE_CONT, format"%s", __func__, __VA_ARGS__)
#define VD_DRING_ELEM(i) ((vd_dring_entry_t *)(void *) \
(vd->dring + (i)*vd->descriptor_size))
#define VD_CLIENT(vd) \
(((vd)->xfer_mode == VIO_DESC_MODE) ? "in-band client" : \
(((vd)->xfer_mode == VIO_DRING_MODE_V1_0) ? "dring client" : \
(((vd)->xfer_mode == 0) ? "null client" : \
"unsupported client")))
#define VD_DSKIMG_LABEL_READ(vd, labelp) \
vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BREAD, (caddr_t)labelp, \
0, sizeof (struct dk_label))
#define VD_DSKIMG_LABEL_WRITE(vd, labelp) \
vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BWRITE, (caddr_t)labelp, \
0, sizeof (struct dk_label))
#define VD_DSKIMG(vd) ((vd)->vdisk_type == VD_DISK_TYPE_DISK && \
((vd)->file || (vd)->volume))
#define VD_WRITE_INDEX_NEXT(vd, id) \
((((id) + 1) >= vd->dring_len)? 0 : (id) + 1)
#define VD_RESET_ACCESS_FAILURE_MSG \
"Fail to reset disk access rights for disk %s"
static mdeg_prop_spec_t vds_prop_template[] = {
{ MDET_PROP_STR, "name", VDS_NAME },
{ MDET_PROP_VAL, "cfg-handle", NULL },
{ MDET_LIST_END, NULL, NULL }
};
#define VDS_SET_MDEG_PROP_INST(specp, val) (specp)[1].ps_val = (val);
static md_prop_match_t vd_prop_match[] = {
{ MDET_PROP_VAL, VD_ID_PROP },
{ MDET_LIST_END, NULL }
};
static mdeg_node_match_t vd_match = {"virtual-device-port",
vd_prop_match};
#define VD_OPT_RDONLY 0x1
#define VD_OPT_SLICE 0x2
#define VD_OPT_EXCLUSIVE 0x4
#define VD_OPTION_NLEN 128
typedef struct vd_option {
char vdo_name[VD_OPTION_NLEN];
uint64_t vdo_value;
} vd_option_t;
vd_option_t vd_bdev_options[] = {
{ "ro", VD_OPT_RDONLY },
{ "slice", VD_OPT_SLICE },
{ "excl", VD_OPT_EXCLUSIVE }
};
#ifdef DEBUG
static int vd_msglevel = 0;
#define PR0 if (vd_msglevel > 0) PRN
#define PR1 if (vd_msglevel > 1) PRN
#define PR2 if (vd_msglevel > 2) PRN
#define VD_DUMP_DRING_ELEM(elem) \
PR0("dst:%x op:%x st:%u nb:%lx addr:%lx ncook:%u\n", \
elem->hdr.dstate, \
elem->payload.operation, \
elem->payload.status, \
elem->payload.nbytes, \
elem->payload.addr, \
elem->payload.ncookies);
char *
vd_decode_state(int state)
{
char *str;
#define CASE_STATE(_s) case _s: str = #_s; break;
switch (state) {
CASE_STATE(VD_STATE_INIT)
CASE_STATE(VD_STATE_VER)
CASE_STATE(VD_STATE_ATTR)
CASE_STATE(VD_STATE_DRING)
CASE_STATE(VD_STATE_RDX)
CASE_STATE(VD_STATE_DATA)
default: str = "unknown"; break;
}
#undef CASE_STATE
return (str);
}
void
vd_decode_tag(vio_msg_t *msg)
{
char *tstr, *sstr, *estr;
#define CASE_TYPE(_s) case _s: tstr = #_s; break;
switch (msg->tag.vio_msgtype) {
CASE_TYPE(VIO_TYPE_CTRL)
CASE_TYPE(VIO_TYPE_DATA)
CASE_TYPE(VIO_TYPE_ERR)
default: tstr = "unknown"; break;
}
#undef CASE_TYPE
#define CASE_SUBTYPE(_s) case _s: sstr = #_s; break;
switch (msg->tag.vio_subtype) {
CASE_SUBTYPE(VIO_SUBTYPE_INFO)
CASE_SUBTYPE(VIO_SUBTYPE_ACK)
CASE_SUBTYPE(VIO_SUBTYPE_NACK)
default: sstr = "unknown"; break;
}
#undef CASE_SUBTYPE
#define CASE_ENV(_s) case _s: estr = #_s; break;
switch (msg->tag.vio_subtype_env) {
CASE_ENV(VIO_VER_INFO)
CASE_ENV(VIO_ATTR_INFO)
CASE_ENV(VIO_DRING_REG)
CASE_ENV(VIO_DRING_UNREG)
CASE_ENV(VIO_RDX)
CASE_ENV(VIO_PKT_DATA)
CASE_ENV(VIO_DESC_DATA)
CASE_ENV(VIO_DRING_DATA)
default: estr = "unknown"; break;
}
#undef CASE_ENV
PR1("(%x/%x/%x) message : (%s/%s/%s)",
msg->tag.vio_msgtype, msg->tag.vio_subtype,
msg->tag.vio_subtype_env, tstr, sstr, estr);
}
#else
#define PR0(...)
#define PR1(...)
#define PR2(...)
#define VD_DUMP_DRING_ELEM(elem)
#define vd_decode_state(_s) (NULL)
#define vd_decode_tag(_s) (NULL)
#endif
typedef struct vds {
uint_t initialized;
dev_info_t *dip;
ldi_ident_t ldi_ident;
mod_hash_t *vd_table;
mdeg_node_spec_t *ispecp;
mdeg_handle_t mdeg;
vd_driver_type_t *driver_types;
int num_drivers;
} vds_t;
typedef enum vd_task_type {
VD_NONFINAL_RANGE_TASK,
VD_FINAL_RANGE_TASK,
} vd_task_type_t;
typedef struct vd_task {
struct vd *vd;
vd_task_type_t type;
int index;
vio_msg_t *msg;
size_t msglen;
vd_dring_payload_t *request;
struct buf buf;
ldc_mem_handle_t mhdl;
int status;
int (*completef)(struct vd_task *task);
uint32_t write_index;
} vd_task_t;
typedef struct vd {
uint64_t id;
uint_t initialized;
uint64_t operations;
vio_ver_t version;
vds_t *vds;
ddi_taskq_t *startq;
ddi_taskq_t *completionq;
ddi_taskq_t *ioq;
uint32_t write_index;
buf_t **write_queue;
ldi_handle_t ldi_handle[V_NUMPAR];
char device_path[MAXPATHLEN + 1];
dev_t dev[V_NUMPAR];
int open_flags;
uint_t nslices;
size_t vdisk_size;
size_t vdisk_bsize;
vd_disk_type_t vdisk_type;
vd_disk_label_t vdisk_label;
vd_media_t vdisk_media;
boolean_t is_atapi_dev;
ushort_t max_xfer_sz;
size_t backend_bsize;
int vio_bshift;
boolean_t volume;
boolean_t zvol;
boolean_t file;
boolean_t scsi;
vnode_t *file_vnode;
size_t dskimg_size;
ddi_devid_t dskimg_devid;
int efi_reserved;
caddr_t flabel;
uint_t flabel_size;
uint_t flabel_limit;
struct dk_geom dk_geom;
struct extvtoc vtoc;
vd_slice_t slices[VD_MAXPART];
boolean_t ownership;
ldc_status_t ldc_state;
ldc_handle_t ldc_handle;
size_t max_msglen;
vd_state_t state;
uint8_t xfer_mode;
uint32_t sid;
uint64_t seq_num;
uint64_t dring_ident;
ldc_dring_handle_t dring_handle;
uint32_t descriptor_size;
uint32_t dring_len;
uint8_t dring_mtype;
caddr_t dring;
caddr_t vio_msgp;
vd_task_t inband_task;
vd_task_t *dring_task;
kmutex_t lock;
boolean_t enabled;
boolean_t reset_state;
boolean_t reset_ldc;
} vd_t;
#define VD_LABEL_VTOC_SIZE(lba) \
P2ROUNDUP(sizeof (struct dk_label), (lba))
#define VD_LABEL_EFI_SIZE(lba) \
P2ROUNDUP(2 * (lba) + sizeof (efi_gpe_t) * VD_MAXPART, \
(lba))
#define VD_LABEL_VTOC(vd) \
((struct dk_label *)(void *)((vd)->flabel))
#define VD_LABEL_EFI_GPT(vd, lba) \
((efi_gpt_t *)(void *)((vd)->flabel + (lba)))
#define VD_LABEL_EFI_GPE(vd, lba) \
((efi_gpe_t *)(void *)((vd)->flabel + 2 * (lba)))
typedef struct vds_operation {
char *namep;
uint8_t operation;
int (*start)(vd_task_t *task);
int (*complete)(vd_task_t *task);
} vds_operation_t;
typedef struct vd_ioctl {
uint8_t operation;
const char *operation_name;
size_t nbytes;
int cmd;
const char *cmd_name;
void *arg;
int (*copyin)(void *vd_buf, size_t, void *ioctl_arg);
void (*copyout)(void *ioctl_arg, void *vd_buf);
boolean_t write;
} vd_ioctl_t;
#define VD_IDENTITY_IN ((int (*)(void *, size_t, void *))-1)
#define VD_IDENTITY_OUT ((void (*)(void *, void *))-1)
static int vds_ldc_retries = VDS_RETRIES;
static int vds_ldc_delay = VDS_LDC_DELAY;
static int vds_dev_retries = VDS_RETRIES;
static int vds_dev_delay = VDS_DEV_DELAY;
static void *vds_state;
static short vd_scsi_rdwr_timeout = VD_SCSI_RDWR_TIMEOUT;
static int vd_scsi_debug = USCSI_SILENT;
static int vd_ioq_nthreads = VD_IOQ_NTHREADS;
static int vd_awflush = VD_AWFLUSH_IMMEDIATE | VD_AWFLUSH_GROUP;
static int vd_reset_access_failure = 0;
static boolean_t vd_volume_force_slice = B_FALSE;
static boolean_t vd_dskimg_validate_sanity = B_FALSE;
static boolean_t vd_direct_mapped_drings = B_TRUE;
static vd_disk_label_t vd_slice_label = VD_DISK_LABEL_UNK;
static vd_disk_label_t vd_file_slice_label = VD_DISK_LABEL_VTOC;
static boolean_t vd_slice_single_slice = B_FALSE;
static const vio_ver_t vds_version[] = {{1, 1}};
static const size_t vds_num_versions =
sizeof (vds_version)/sizeof (vds_version[0]);
static void vd_free_dring_task(vd_t *vdp);
static int vd_setup_vd(vd_t *vd);
static int vd_setup_single_slice_disk(vd_t *vd);
static int vd_setup_slice_image(vd_t *vd);
static int vd_setup_disk_image(vd_t *vd);
static int vd_backend_check_size(vd_t *vd);
static boolean_t vd_enabled(vd_t *vd);
static ushort_t vd_lbl2cksum(struct dk_label *label);
static int vd_dskimg_validate_geometry(vd_t *vd);
static boolean_t vd_dskimg_is_iso_image(vd_t *vd);
static void vd_set_exported_operations(vd_t *vd);
static void vd_reset_access(vd_t *vd);
static int vd_backend_ioctl(vd_t *vd, int cmd, caddr_t arg);
static int vds_efi_alloc_and_read(vd_t *, efi_gpt_t **, efi_gpe_t **);
static void vds_efi_free(vd_t *, efi_gpt_t *, efi_gpe_t *);
static void vds_driver_types_free(vds_t *vds);
static void vd_vtocgeom_to_label(struct extvtoc *vtoc, struct dk_geom *geom,
struct dk_label *label);
static void vd_label_to_vtocgeom(struct dk_label *label, struct extvtoc *vtoc,
struct dk_geom *geom);
static boolean_t vd_slice_geom_isvalid(vd_t *vd, struct dk_geom *geom);
static boolean_t vd_slice_vtoc_isvalid(vd_t *vd, struct extvtoc *vtoc);
extern int is_pseudo_device(dev_info_t *);
static void
vd_get_readable_size(size_t full_size, size_t *size, char *unit)
{
if (full_size < (1ULL << 20)) {
*size = full_size >> 10;
*unit = 'K';
} else if (full_size < (1ULL << 30)) {
*size = full_size >> 20;
*unit = 'M';
} else if (full_size < (1ULL << 40)) {
*size = full_size >> 30;
*unit = 'G';
} else {
*size = full_size >> 40;
*unit = 'T';
}
}
static int
vd_dskimg_io_params(vd_t *vd, int slice, size_t *blkp, size_t *lenp)
{
size_t blk = *blkp;
size_t len = *lenp;
size_t offset, maxlen;
ASSERT(vd->file || VD_DSKIMG(vd));
ASSERT(len > 0);
ASSERT(vd->vdisk_bsize == DEV_BSIZE);
if (vd->vdisk_type == VD_DISK_TYPE_SLICE || slice == VD_SLICE_NONE) {
offset = blk * DEV_BSIZE;
if (offset >= vd->dskimg_size) {
PR0("offset (0x%lx) >= size (0x%lx)",
offset, vd->dskimg_size);
return (ENODATA);
}
maxlen = vd->dskimg_size - offset;
} else {
ASSERT(slice >= 0 && slice < V_NUMPAR);
if (vd->vdisk_label == VD_DISK_LABEL_UNK &&
vio_ver_is_supported(vd->version, 1, 1)) {
(void) vd_dskimg_validate_geometry(vd);
if (vd->vdisk_label == VD_DISK_LABEL_UNK) {
PR0("Unknown disk label, can't do I/O "
"from slice %d", slice);
return (EINVAL);
}
}
if (vd->vdisk_label == VD_DISK_LABEL_VTOC) {
ASSERT(vd->vtoc.v_sectorsz == DEV_BSIZE);
} else {
ASSERT(vd->vdisk_label == VD_DISK_LABEL_EFI);
}
if (blk >= vd->slices[slice].nblocks) {
PR0("req_addr (0x%lx) >= psize (0x%lx)",
blk, vd->slices[slice].nblocks);
return (ENODATA);
}
offset = (vd->slices[slice].start + blk) * DEV_BSIZE;
maxlen = (vd->slices[slice].nblocks - blk) * DEV_BSIZE;
}
if (len > maxlen) {
PR0("I/O size truncated to %lu bytes from %lu bytes",
maxlen, len);
len = maxlen;
}
if ((offset + len) > vd->dskimg_size) {
PR0("offset + nbytes (0x%lx + 0x%lx) > "
"dskimg_size (0x%lx)", offset, len, vd->dskimg_size);
return (EINVAL);
}
*blkp = offset / DEV_BSIZE;
*lenp = len;
return (0);
}
static ssize_t
vd_dskimg_rw(vd_t *vd, int slice, int operation, caddr_t data, size_t offset,
size_t len)
{
ssize_t resid;
struct buf buf;
int status;
ASSERT(vd->file || VD_DSKIMG(vd));
ASSERT(len > 0);
ASSERT(vd->vdisk_bsize == DEV_BSIZE);
if ((status = vd_dskimg_io_params(vd, slice, &offset, &len)) != 0)
return ((status == ENODATA)? 0: -1);
if (vd->volume) {
bioinit(&buf);
buf.b_flags = B_BUSY |
((operation == VD_OP_BREAD)? B_READ : B_WRITE);
buf.b_bcount = len;
buf.b_lblkno = offset;
buf.b_edev = vd->dev[0];
buf.b_un.b_addr = data;
if (ldi_strategy(vd->ldi_handle[0], &buf) != 0) {
biofini(&buf);
return (-1);
}
if (biowait(&buf) != 0) {
biofini(&buf);
return (-1);
}
resid = buf.b_resid;
biofini(&buf);
ASSERT(resid <= len);
return (len - resid);
}
ASSERT(vd->file);
status = vn_rdwr((operation == VD_OP_BREAD)? UIO_READ : UIO_WRITE,
vd->file_vnode, data, len, offset * DEV_BSIZE, UIO_SYSSPACE, FSYNC,
RLIM64_INFINITY, kcred, &resid);
if (status != 0)
return (-1);
return (len);
}
static void
vd_build_default_label(size_t disk_size, size_t bsize, struct dk_label *label)
{
size_t size;
char unit;
ASSERT(bsize > 0);
bzero(label, sizeof (struct dk_label));
if (disk_size >= 8 * ONE_GIGABYTE) {
label->dkl_nhead = 96;
label->dkl_nsect = 768;
} else if (disk_size >= 2 * ONE_MEGABYTE) {
label->dkl_nhead = 1;
label->dkl_nsect = 600;
} else {
label->dkl_nhead = 1;
label->dkl_nsect = 200;
}
label->dkl_pcyl = disk_size /
(label->dkl_nsect * label->dkl_nhead * bsize);
if (label->dkl_pcyl == 0)
label->dkl_pcyl = 1;
label->dkl_acyl = 0;
if (label->dkl_pcyl > 2)
label->dkl_acyl = 2;
label->dkl_ncyl = label->dkl_pcyl - label->dkl_acyl;
label->dkl_write_reinstruct = 0;
label->dkl_read_reinstruct = 0;
label->dkl_rpm = 7200;
label->dkl_apc = 0;
label->dkl_intrlv = 0;
PR0("requested disk size: %ld bytes\n", disk_size);
PR0("setup: ncyl=%d nhead=%d nsec=%d\n", label->dkl_pcyl,
label->dkl_nhead, label->dkl_nsect);
PR0("provided disk size: %ld bytes\n", (uint64_t)
(label->dkl_pcyl * label->dkl_nhead *
label->dkl_nsect * bsize));
vd_get_readable_size(disk_size, &size, &unit);
(void) snprintf(label->dkl_asciilabel, LEN_DKL_ASCII,
"SUN-DiskImage-%ld%cB cyl %d alt %d hd %d sec %d",
size, unit,
label->dkl_ncyl, label->dkl_acyl, label->dkl_nhead,
label->dkl_nsect);
label->dkl_vtoc.v_version = V_EXTVERSION;
label->dkl_vtoc.v_nparts = V_NUMPAR;
label->dkl_vtoc.v_sanity = VTOC_SANE;
label->dkl_vtoc.v_part[VD_ENTIRE_DISK_SLICE].p_tag = V_BACKUP;
label->dkl_map[VD_ENTIRE_DISK_SLICE].dkl_cylno = 0;
label->dkl_map[VD_ENTIRE_DISK_SLICE].dkl_nblk = label->dkl_ncyl *
label->dkl_nhead * label->dkl_nsect;
label->dkl_magic = DKL_MAGIC;
label->dkl_cksum = vd_lbl2cksum(label);
}
static int
vd_dskimg_set_vtoc(vd_t *vd, struct dk_label *label)
{
size_t blk, sec, cyl, head, cnt;
ASSERT(VD_DSKIMG(vd));
if (VD_DSKIMG_LABEL_WRITE(vd, label) < 0) {
PR0("fail to write disk label");
return (EIO);
}
if (label->dkl_acyl == 0) {
PR0("no alternate cylinder, can not store backup labels");
return (0);
}
cyl = label->dkl_ncyl + label->dkl_acyl - 1;
head = label->dkl_nhead - 1;
blk = (cyl * ((label->dkl_nhead * label->dkl_nsect) - label->dkl_apc)) +
(head * label->dkl_nsect);
sec = 1;
for (cnt = 0; cnt < VD_DSKIMG_NUM_BACKUP; cnt++) {
if (sec >= label->dkl_nsect) {
PR0("not enough sector to store all backup labels");
return (0);
}
if (vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BWRITE,
(caddr_t)label, blk + sec, sizeof (struct dk_label)) < 0) {
PR0("error writing backup label at block %lu\n",
blk + sec);
return (EIO);
}
PR1("wrote backup label at block %lu\n", blk + sec);
sec += 2;
}
return (0);
}
static int
vd_dskimg_get_devid_block(vd_t *vd, size_t *blkp)
{
diskaddr_t spc, head, cyl;
ASSERT(VD_DSKIMG(vd));
if (vd->vdisk_label == VD_DISK_LABEL_UNK) {
return (ENOSPC);
}
if (vd->vdisk_label == VD_DISK_LABEL_EFI) {
if (vd->efi_reserved == -1) {
PR0("EFI disk has no reserved slice");
return (ENOSPC);
}
*blkp = vd->slices[vd->efi_reserved].start;
return (0);
}
ASSERT(vd->vdisk_label == VD_DISK_LABEL_VTOC);
if (vd->dk_geom.dkg_acyl < 2) {
PR0("not enough alternate cylinder available for devid "
"(acyl=%u)", vd->dk_geom.dkg_acyl);
return (ENOSPC);
}
cyl = vd->dk_geom.dkg_ncyl + vd->dk_geom.dkg_acyl - 2;
spc = vd->dk_geom.dkg_nhead * vd->dk_geom.dkg_nsect;
head = vd->dk_geom.dkg_nhead - 1;
*blkp = (cyl * (spc - vd->dk_geom.dkg_apc)) +
(head * vd->dk_geom.dkg_nsect) + 1;
return (0);
}
static uint_t
vd_dkdevid2cksum(struct dk_devid *dkdevid)
{
uint_t chksum, *ip;
int i;
chksum = 0;
ip = (void *)dkdevid;
for (i = 0; i < ((DEV_BSIZE - sizeof (int)) / sizeof (int)); i++)
chksum ^= ip[i];
return (chksum);
}
static int
vd_dskimg_read_devid(vd_t *vd, ddi_devid_t *devid)
{
struct dk_devid *dkdevid;
size_t blk;
uint_t chksum;
int status, sz;
ASSERT(vd->vdisk_bsize == DEV_BSIZE);
if ((status = vd_dskimg_get_devid_block(vd, &blk)) != 0)
return (status);
dkdevid = kmem_zalloc(DEV_BSIZE, KM_SLEEP);
if ((vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BREAD, (caddr_t)dkdevid, blk,
DEV_BSIZE)) < 0) {
PR0("error reading devid block at %lu", blk);
status = EIO;
goto done;
}
if ((dkdevid->dkd_rev_hi != DK_DEVID_REV_MSB) ||
(dkdevid->dkd_rev_lo != DK_DEVID_REV_LSB)) {
PR0("invalid devid found at block %lu (bad revision)", blk);
status = EINVAL;
goto done;
}
chksum = vd_dkdevid2cksum(dkdevid);
if (DKD_GETCHKSUM(dkdevid) != chksum) {
PR0("invalid devid found at block %lu (bad checksum)", blk);
status = EINVAL;
goto done;
}
if (ddi_devid_valid((ddi_devid_t)&dkdevid->dkd_devid) != DDI_SUCCESS) {
PR0("invalid devid found at block %lu", blk);
status = EINVAL;
goto done;
}
PR1("devid read at block %lu", blk);
sz = ddi_devid_sizeof((ddi_devid_t)&dkdevid->dkd_devid);
*devid = kmem_alloc(sz, KM_SLEEP);
bcopy(&dkdevid->dkd_devid, *devid, sz);
done:
kmem_free(dkdevid, DEV_BSIZE);
return (status);
}
static int
vd_dskimg_write_devid(vd_t *vd, ddi_devid_t devid)
{
struct dk_devid *dkdevid;
uint_t chksum;
size_t blk;
int status;
ASSERT(vd->vdisk_bsize == DEV_BSIZE);
if (devid == NULL) {
return (0);
}
if ((status = vd_dskimg_get_devid_block(vd, &blk)) != 0)
return (status);
dkdevid = kmem_zalloc(DEV_BSIZE, KM_SLEEP);
dkdevid->dkd_rev_hi = DK_DEVID_REV_MSB;
dkdevid->dkd_rev_lo = DK_DEVID_REV_LSB;
bcopy(devid, &dkdevid->dkd_devid, ddi_devid_sizeof(devid));
chksum = vd_dkdevid2cksum(dkdevid);
DKD_FORMCHKSUM(chksum, dkdevid);
if ((status = vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BWRITE,
(caddr_t)dkdevid, blk, DEV_BSIZE)) < 0) {
PR0("Error writing devid block at %lu", blk);
status = EIO;
} else {
PR1("devid written at block %lu", blk);
status = 0;
}
kmem_free(dkdevid, DEV_BSIZE);
return (status);
}
static int
vd_do_scsi_rdwr(vd_t *vd, int operation, caddr_t data, size_t blk, size_t len)
{
struct uscsi_cmd ucmd;
union scsi_cdb cdb;
int nsectors, nblk;
int max_sectors;
int status, rval;
ASSERT(!vd->file);
ASSERT(!vd->volume);
ASSERT(vd->vdisk_bsize > 0);
max_sectors = vd->max_xfer_sz;
nblk = (len / vd->vdisk_bsize);
if (len % vd->vdisk_bsize != 0)
return (EINVAL);
while (nblk) {
bzero(&ucmd, sizeof (ucmd));
bzero(&cdb, sizeof (cdb));
nsectors = (max_sectors < nblk) ? max_sectors : nblk;
if (blk < (2 << 20) && nsectors <= 0xff && !vd->is_atapi_dev) {
FORMG0ADDR(&cdb, blk);
FORMG0COUNT(&cdb, (uchar_t)nsectors);
ucmd.uscsi_cdblen = CDB_GROUP0;
} else if (blk > 0xffffffff) {
FORMG4LONGADDR(&cdb, blk);
FORMG4COUNT(&cdb, nsectors);
ucmd.uscsi_cdblen = CDB_GROUP4;
cdb.scc_cmd |= SCMD_GROUP4;
} else {
FORMG1ADDR(&cdb, blk);
FORMG1COUNT(&cdb, nsectors);
ucmd.uscsi_cdblen = CDB_GROUP1;
cdb.scc_cmd |= SCMD_GROUP1;
}
ucmd.uscsi_cdb = (caddr_t)&cdb;
ucmd.uscsi_bufaddr = data;
ucmd.uscsi_buflen = nsectors * vd->backend_bsize;
ucmd.uscsi_timeout = vd_scsi_rdwr_timeout;
ucmd.uscsi_flags = USCSI_ISOLATE | USCSI_SILENT;
if (operation == VD_OP_BREAD) {
cdb.scc_cmd |= SCMD_READ;
ucmd.uscsi_flags |= USCSI_READ;
} else {
cdb.scc_cmd |= SCMD_WRITE;
}
status = ldi_ioctl(vd->ldi_handle[VD_ENTIRE_DISK_SLICE],
USCSICMD, (intptr_t)&ucmd, (vd->open_flags | FKIOCTL),
kcred, &rval);
if (status == 0)
status = ucmd.uscsi_status;
if (status != 0)
break;
if (ucmd.uscsi_resid == ucmd.uscsi_buflen) {
max_sectors >>= 1;
if (max_sectors <= 0) {
status = EIO;
break;
}
continue;
}
if (ucmd.uscsi_resid != 0) {
status = EIO;
break;
}
blk += nsectors;
nblk -= nsectors;
data += nsectors * vd->vdisk_bsize;
}
return (status);
}
static int
vd_scsi_rdwr(vd_t *vd, int operation, caddr_t data, size_t vblk, size_t vlen)
{
int rv;
size_t pblk;
size_t delta;
size_t pnblk;
size_t plen;
char *buf;
if (vd->backend_bsize == 0) {
if (vd_backend_check_size(vd) != 0)
return (EIO);
}
if (vd->vdisk_bsize == vd->backend_bsize)
return (vd_do_scsi_rdwr(vd, operation, data, vblk, vlen));
if (vd->vdisk_bsize > vd->backend_bsize)
return (EINVAL);
if (operation == VD_OP_BWRITE)
return (ENOTSUP);
pblk = (vblk * vd->vdisk_bsize) / vd->backend_bsize;
delta = (vblk * vd->vdisk_bsize) - (pblk * vd->backend_bsize);
pnblk = ((delta + vlen - 1) / vd->backend_bsize) + 1;
plen = pnblk * vd->backend_bsize;
PR2("vblk %lx:pblk %lx: vlen %ld:plen %ld", vblk, pblk, vlen, plen);
buf = kmem_zalloc(sizeof (caddr_t) * plen, KM_SLEEP);
rv = vd_do_scsi_rdwr(vd, operation, (caddr_t)buf, pblk, plen);
bcopy(buf + delta, data, vlen);
kmem_free(buf, sizeof (caddr_t) * plen);
return (rv);
}
static ssize_t
vd_slice_flabel_read(vd_t *vd, caddr_t data, size_t offset, size_t length)
{
size_t n = 0;
uint_t limit = vd->flabel_limit * vd->vdisk_bsize;
ASSERT(vd->vdisk_type == VD_DISK_TYPE_SLICE);
ASSERT(vd->flabel != NULL);
if (offset >= limit)
return (0);
if (offset < vd->flabel_size) {
if (offset + length <= vd->flabel_size) {
bcopy(vd->flabel + offset, data, length);
return (length);
}
n = vd->flabel_size - offset;
bcopy(vd->flabel + offset, data, n);
data += n;
}
if (offset + length <= limit) {
bzero(data, length - n);
return (length);
}
bzero(data, limit - offset - n);
return (limit - offset);
}
static ssize_t
vd_slice_flabel_write(vd_t *vd, caddr_t data, size_t offset, size_t length)
{
uint_t limit = vd->flabel_limit * vd->vdisk_bsize;
struct dk_label *label;
struct dk_geom geom;
struct extvtoc vtoc;
ASSERT(vd->vdisk_type == VD_DISK_TYPE_SLICE);
ASSERT(vd->flabel != NULL);
if (offset >= limit)
return (0);
if (vd->vdisk_label == VD_DISK_LABEL_VTOC &&
offset == 0 && length == vd->vdisk_bsize) {
label = (void *)data;
if (label->dkl_magic != DKL_MAGIC ||
label->dkl_cksum != vd_lbl2cksum(label))
return (-1);
vd_label_to_vtocgeom(label, &vtoc, &geom);
if (vd_slice_geom_isvalid(vd, &geom) &&
vd_slice_vtoc_isvalid(vd, &vtoc))
return (length);
}
return (-1);
}
static int
vd_slice_fake_rdwr(vd_t *vd, int slice, int operation, caddr_t *datap,
size_t *blkp, size_t *lengthp)
{
struct dk_label *label;
caddr_t data;
size_t blk, length, csize;
size_t ablk, asize, aoff, alen;
ssize_t n;
int sec, status;
size_t bsize = vd->vdisk_bsize;
ASSERT(vd->vdisk_type == VD_DISK_TYPE_SLICE);
ASSERT(slice != 0);
data = *datap;
blk = *blkp;
length = *lengthp;
if (slice != VD_SLICE_NONE &&
(slice != VD_ENTIRE_DISK_SLICE ||
vd->vdisk_label != VD_DISK_LABEL_VTOC) &&
(slice != VD_EFI_WD_SLICE ||
vd->vdisk_label != VD_DISK_LABEL_EFI)) {
return (EIO);
}
if (length % bsize != 0)
return (EINVAL);
if (operation == VD_OP_BWRITE)
n = vd_slice_flabel_write(vd, data, blk * bsize, length);
else
n = vd_slice_flabel_read(vd, data, blk * bsize, length);
if (n == -1)
return (EINVAL);
ASSERT(n % bsize == 0);
data += n;
blk += n / bsize;
length -= n;
if (length == 0) {
status = 0;
goto done;
}
if (vd->vdisk_label == VD_DISK_LABEL_VTOC &&
slice == VD_ENTIRE_DISK_SLICE) {
status = EAGAIN;
goto done;
}
if (vd->vdisk_label == VD_DISK_LABEL_EFI) {
asize = EFI_MIN_RESV_SIZE + (EFI_MIN_ARRAY_SIZE / bsize) + 1;
ablk = vd->vdisk_size - asize;
} else {
ASSERT(vd->vdisk_label == VD_DISK_LABEL_VTOC);
ASSERT(vd->dk_geom.dkg_apc == 0);
csize = vd->dk_geom.dkg_nhead * vd->dk_geom.dkg_nsect;
ablk = vd->dk_geom.dkg_ncyl * csize;
asize = vd->dk_geom.dkg_acyl * csize;
}
alen = length / bsize;
aoff = blk;
if (aoff == ablk + asize) {
status = 0;
goto done;
}
if (aoff > ablk + asize)
return (EIO);
if (aoff + alen < ablk) {
status = EAGAIN;
goto done;
}
if (operation == VD_OP_BWRITE)
return (EIO);
if (aoff < ablk) {
alen -= (ablk - aoff);
aoff = ablk;
}
if (aoff + alen > ablk + asize) {
alen = ablk + asize - aoff;
}
alen *= bsize;
if (operation == VD_OP_BREAD) {
bzero(data + (aoff - blk) * bsize, alen);
if (vd->vdisk_label == VD_DISK_LABEL_VTOC) {
label = VD_LABEL_VTOC(vd);
ablk += (label->dkl_acyl - 1) * csize +
(label->dkl_nhead - 1) * label->dkl_nsect;
for (sec = 1; (sec < 5 * 2 + 1); sec += 2) {
if (ablk + sec >= blk &&
ablk + sec < blk + (length / bsize)) {
bcopy(label, data +
(ablk + sec - blk) * bsize,
sizeof (struct dk_label));
}
}
}
}
length -= alen;
status = (length == 0)? 0: EAGAIN;
done:
ASSERT(length == 0 || blk >= vd->flabel_limit);
*datap = data;
*blkp = blk - vd->flabel_limit;
*lengthp = length;
return (status);
}
static int
vd_flush_write(vd_t *vd)
{
int status, rval;
if (vd->file) {
status = VOP_FSYNC(vd->file_vnode, FSYNC, kcred, NULL);
} else {
status = ldi_ioctl(vd->ldi_handle[0], DKIOCFLUSHWRITECACHE,
(intptr_t)NULL, vd->open_flags | FKIOCTL, kcred, &rval);
}
return (status);
}
static void
vd_bio_task(void *arg)
{
struct buf *buf = (struct buf *)arg;
vd_task_t *task = (vd_task_t *)buf->b_private;
vd_t *vd = task->vd;
ssize_t resid;
int status;
ASSERT(vd->vdisk_bsize == DEV_BSIZE);
if (vd->zvol) {
status = ldi_strategy(vd->ldi_handle[0], buf);
} else {
ASSERT(vd->file);
status = vn_rdwr((buf->b_flags & B_READ)? UIO_READ : UIO_WRITE,
vd->file_vnode, buf->b_un.b_addr, buf->b_bcount,
buf->b_lblkno * DEV_BSIZE, UIO_SYSSPACE, 0,
RLIM64_INFINITY, kcred, &resid);
if (status == 0) {
buf->b_resid = resid;
biodone(buf);
return;
}
}
if (status != 0) {
bioerror(buf, status);
biodone(buf);
}
}
static int
vd_biodone(struct buf *bp)
{
ASSERT((bp->b_flags & B_DONE) == 0);
ASSERT(SEMA_HELD(&bp->b_sem));
bp->b_flags |= B_DONE;
sema_v(&bp->b_io);
return (0);
}
static int
vd_start_bio(vd_task_t *task)
{
int rv, status = 0;
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
struct buf *buf = &task->buf;
uint8_t mtype;
int slice;
char *bufaddr = 0;
size_t buflen;
size_t offset, length, nbytes;
ASSERT(vd != NULL);
ASSERT(request != NULL);
slice = request->slice;
ASSERT(slice == VD_SLICE_NONE || slice < vd->nslices);
ASSERT((request->operation == VD_OP_BREAD) ||
(request->operation == VD_OP_BWRITE));
if (request->nbytes == 0) {
request->status = EINVAL;
return (0);
}
PR1("%s %lu bytes at block %lu",
(request->operation == VD_OP_BREAD) ? "Read" : "Write",
request->nbytes, request->addr);
if (request->operation == VD_OP_BWRITE && !(vd->open_flags & FWRITE)) {
PR0("write fails because backend is opened read-only");
request->nbytes = 0;
request->status = EROFS;
return (0);
}
mtype = LDC_SHADOW_MAP;
status = ldc_mem_map(task->mhdl, request->cookie, request->ncookies,
mtype, (request->operation == VD_OP_BREAD) ? LDC_MEM_W : LDC_MEM_R,
&bufaddr, NULL);
if (status != 0) {
PR0("ldc_mem_map() returned err %d ", status);
return (EIO);
}
buflen = P2ROUNDUP(request->nbytes, 8);
status = ldc_mem_acquire(task->mhdl, 0, buflen);
if (status != 0) {
(void) ldc_mem_unmap(task->mhdl);
PR0("ldc_mem_acquire() returned err %d ", status);
return (EIO);
}
offset = request->addr;
nbytes = request->nbytes;
length = nbytes;
request->nbytes = 0;
if (vd->vdisk_type == VD_DISK_TYPE_SLICE) {
if (slice != 0) {
rv = vd_slice_fake_rdwr(vd, slice, request->operation,
&bufaddr, &offset, &length);
request->nbytes = nbytes - length;
if (rv == 0) {
request->status = 0;
goto io_done;
}
if (rv != EAGAIN) {
request->nbytes = 0;
request->status = EIO;
goto io_done;
}
ASSERT(length != 0);
slice = 0;
}
} else if (vd->volume || vd->file) {
rv = vd_dskimg_io_params(vd, slice, &offset, &length);
if (rv != 0) {
request->status = (rv == ENODATA)? 0: EIO;
goto io_done;
}
slice = 0;
} else if (slice == VD_SLICE_NONE) {
rv = vd_scsi_rdwr(vd, request->operation, bufaddr, offset,
length);
if (rv != 0) {
request->status = EIO;
} else {
request->nbytes = length;
request->status = 0;
}
goto io_done;
}
bioinit(buf);
buf->b_flags = B_BUSY;
buf->b_bcount = length;
buf->b_lblkno = offset;
buf->b_bufsize = buflen;
buf->b_edev = vd->dev[slice];
buf->b_un.b_addr = bufaddr;
buf->b_iodone = vd_biodone;
if (vd->file || vd->zvol) {
if (request->operation == VD_OP_BREAD) {
buf->b_flags |= B_READ;
} else {
buf->b_flags |= B_WRITE | B_ASYNC;
task->write_index = vd->write_index;
vd->write_queue[task->write_index] = buf;
vd->write_index =
VD_WRITE_INDEX_NEXT(vd, vd->write_index);
}
buf->b_private = task;
ASSERT(vd->ioq != NULL);
request->status = 0;
(void) ddi_taskq_dispatch(task->vd->ioq, vd_bio_task, buf,
DDI_SLEEP);
} else {
if (request->operation == VD_OP_BREAD) {
buf->b_flags |= B_READ;
} else {
buf->b_flags |= B_WRITE;
}
buf->b_lblkno = offset << vd->vio_bshift;
request->status = ldi_strategy(vd->ldi_handle[slice], buf);
}
if (request->status == 0)
return (EINPROGRESS);
biofini(buf);
io_done:
rv = ldc_mem_release(task->mhdl, 0, buflen);
if (rv) {
PR0("ldc_mem_release() returned err %d ", rv);
status = EIO;
}
rv = ldc_mem_unmap(task->mhdl);
if (rv) {
PR0("ldc_mem_unmap() returned err %d ", rv);
status = EIO;
}
return (status);
}
static int
send_msg(ldc_handle_t ldc_handle, void *msg, size_t msglen)
{
int status;
size_t nbytes;
do {
nbytes = msglen;
status = ldc_write(ldc_handle, msg, &nbytes);
if (status != EWOULDBLOCK)
break;
drv_usecwait(vds_ldc_delay);
} while (status == EWOULDBLOCK);
if (status != 0) {
if (status != ECONNRESET)
PR0("ldc_write() returned errno %d", status);
return (status);
} else if (nbytes != msglen) {
PR0("ldc_write() performed only partial write");
return (EIO);
}
PR1("SENT %lu bytes", msglen);
return (0);
}
static void
vd_need_reset(vd_t *vd, boolean_t reset_ldc)
{
mutex_enter(&vd->lock);
vd->reset_state = B_TRUE;
vd->reset_ldc = reset_ldc;
mutex_exit(&vd->lock);
}
static void
vd_reset_if_needed(vd_t *vd)
{
int status = 0;
mutex_enter(&vd->lock);
if (!vd->reset_state) {
ASSERT(!vd->reset_ldc);
mutex_exit(&vd->lock);
return;
}
mutex_exit(&vd->lock);
PR0("Resetting connection state with %s", VD_CLIENT(vd));
if (vd->ioq != NULL)
ddi_taskq_wait(vd->ioq);
ddi_taskq_wait(vd->completionq);
status = vd_flush_write(vd);
if (status) {
PR0("flushwrite returned error %d", status);
}
if ((vd->initialized & VD_DRING) &&
((status = ldc_mem_dring_unmap(vd->dring_handle)) != 0))
PR0("ldc_mem_dring_unmap() returned errno %d", status);
vd_free_dring_task(vd);
if (vd->vio_msgp != NULL) {
kmem_free(vd->vio_msgp, vd->max_msglen);
vd->vio_msgp = NULL;
}
if (vd->inband_task.msg != NULL) {
kmem_free(vd->inband_task.msg, vd->max_msglen);
vd->inband_task.msg = NULL;
}
mutex_enter(&vd->lock);
if (vd->reset_ldc)
PR0("taking down LDC channel");
if (vd->reset_ldc && ((status = ldc_down(vd->ldc_handle)) != 0))
PR0("ldc_down() returned errno %d", status);
vd_reset_access(vd);
vd->initialized &= ~(VD_SID | VD_SEQ_NUM | VD_DRING);
vd->state = VD_STATE_INIT;
vd->max_msglen = sizeof (vio_msg_t);
vd->vio_msgp = kmem_alloc(vd->max_msglen, KM_SLEEP);
PR0("calling ldc_up\n");
(void) ldc_up(vd->ldc_handle);
vd->reset_state = B_FALSE;
vd->reset_ldc = B_FALSE;
mutex_exit(&vd->lock);
}
static void vd_recv_msg(void *arg);
static void
vd_mark_in_reset(vd_t *vd)
{
int status;
PR0("vd_mark_in_reset: marking vd in reset\n");
vd_need_reset(vd, B_FALSE);
status = ddi_taskq_dispatch(vd->startq, vd_recv_msg, vd, DDI_SLEEP);
if (status == DDI_FAILURE) {
PR0("cannot schedule task to recv msg\n");
vd_need_reset(vd, B_TRUE);
return;
}
}
static int
vd_mark_elem_done(vd_t *vd, int idx, int elem_status, int elem_nbytes)
{
boolean_t accepted;
int status;
on_trap_data_t otd;
vd_dring_entry_t *elem = VD_DRING_ELEM(idx);
if (vd->reset_state)
return (0);
if ((status = VIO_DRING_ACQUIRE(&otd, vd->dring_mtype,
vd->dring_handle, idx, idx)) != 0) {
if (status == ECONNRESET) {
vd_mark_in_reset(vd);
return (0);
} else {
return (status);
}
}
accepted = (elem->hdr.dstate == VIO_DESC_ACCEPTED);
if (accepted) {
elem->payload.nbytes = elem_nbytes;
elem->payload.status = elem_status;
elem->hdr.dstate = VIO_DESC_DONE;
} else {
PR0("element %u no longer \"accepted\"", idx);
VD_DUMP_DRING_ELEM(elem);
}
if ((status = VIO_DRING_RELEASE(vd->dring_mtype,
vd->dring_handle, idx, idx)) != 0) {
if (status == ECONNRESET) {
vd_mark_in_reset(vd);
return (0);
} else {
PR0("VIO_DRING_RELEASE() returned errno %d",
status);
return (status);
}
}
return (accepted ? 0 : EINVAL);
}
static int
vd_complete_bio(vd_task_t *task)
{
int status = 0;
int rv = 0;
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
struct buf *buf = &task->buf;
int wid, nwrites;
ASSERT(vd != NULL);
ASSERT(request != NULL);
ASSERT(task->msg != NULL);
ASSERT(task->msglen >= sizeof (*task->msg));
if (buf->b_flags & B_DONE) {
request->status = geterror(buf);
} else {
request->status = biowait(buf);
}
if (buf->b_flags & B_ASYNC) {
ASSERT(task->request->operation == VD_OP_BWRITE);
wid = task->write_index;
if (vd->write_queue[wid] != NULL) {
vd->write_queue[wid] = NULL;
wid = VD_WRITE_INDEX_NEXT(vd, wid);
if (vd_awflush & VD_AWFLUSH_GROUP) {
nwrites = 1;
while (vd->write_queue[wid] != NULL) {
(void) biowait(vd->write_queue[wid]);
vd->write_queue[wid] = NULL;
wid = VD_WRITE_INDEX_NEXT(vd, wid);
nwrites++;
}
DTRACE_PROBE2(flushgrp, vd_task_t *, task,
int, nwrites);
}
if (vd_awflush & VD_AWFLUSH_IMMEDIATE) {
request->status = vd_flush_write(vd);
} else if (vd_awflush & VD_AWFLUSH_DEFER) {
(void) taskq_dispatch(system_taskq,
(void (*)(void *))vd_flush_write, vd,
DDI_SLEEP);
request->status = 0;
}
}
}
request->nbytes += buf->b_bcount - buf->b_resid;
if (!vd->reset_state)
status = ldc_mem_release(task->mhdl, 0, buf->b_bufsize);
if (status) {
PR0("ldc_mem_release() returned errno %d copying to "
"client", status);
if (status == ECONNRESET) {
vd_mark_in_reset(vd);
}
rv = EIO;
}
status = ldc_mem_unmap(task->mhdl);
if (status) {
PR0("ldc_mem_unmap() returned errno %d copying to client",
status);
if (status == ECONNRESET) {
vd_mark_in_reset(vd);
}
rv = EIO;
}
biofini(buf);
return (rv);
}
static void
vd_notify(vd_task_t *task)
{
int status;
ASSERT(task != NULL);
ASSERT(task->vd != NULL);
PR2("Sending %s",
(task->msg->tag.vio_subtype == VIO_SUBTYPE_ACK) ? "ACK" : "NACK");
status = send_msg(task->vd->ldc_handle, task->msg, task->msglen);
switch (status) {
case 0:
break;
case ECONNRESET:
vd_mark_in_reset(task->vd);
break;
default:
PR0("initiating full reset");
vd_need_reset(task->vd, B_TRUE);
break;
}
DTRACE_PROBE1(task__end, vd_task_t *, task);
}
static void
vd_complete_notify(vd_task_t *task)
{
int status = 0;
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
if (!vd->reset_state && (vd->xfer_mode == VIO_DRING_MODE_V1_0)) {
status = vd_mark_elem_done(vd, task->index,
request->status, request->nbytes);
if (status == ECONNRESET)
vd_mark_in_reset(vd);
else if (status == EACCES)
vd_need_reset(vd, B_TRUE);
}
if ((status != 0) || (task->status != 0))
task->msg->tag.vio_subtype = VIO_SUBTYPE_NACK;
if (task->type == VD_NONFINAL_RANGE_TASK) {
return;
}
if (!vd->reset_state)
vd_notify(task);
}
static void
vd_serial_notify(void *arg)
{
vd_task_t *task = (vd_task_t *)arg;
ASSERT(task != NULL);
vd_notify(task);
}
static int
vd_geom2dk_geom(void *vd_buf, size_t vd_buf_len, void *ioctl_arg)
{
VD_GEOM2DK_GEOM((vd_geom_t *)vd_buf, (struct dk_geom *)ioctl_arg);
return (0);
}
static int
vd_vtoc2vtoc(void *vd_buf, size_t vd_buf_len, void *ioctl_arg)
{
VD_VTOC2VTOC((vd_vtoc_t *)vd_buf, (struct extvtoc *)ioctl_arg);
return (0);
}
static void
dk_geom2vd_geom(void *ioctl_arg, void *vd_buf)
{
DK_GEOM2VD_GEOM((struct dk_geom *)ioctl_arg, (vd_geom_t *)vd_buf);
}
static void
vtoc2vd_vtoc(void *ioctl_arg, void *vd_buf)
{
VTOC2VD_VTOC((struct extvtoc *)ioctl_arg, (vd_vtoc_t *)vd_buf);
}
static int
vd_get_efi_in(void *vd_buf, size_t vd_buf_len, void *ioctl_arg)
{
vd_efi_t *vd_efi = (vd_efi_t *)vd_buf;
dk_efi_t *dk_efi = (dk_efi_t *)ioctl_arg;
size_t data_len;
data_len = vd_buf_len - (sizeof (vd_efi_t) - sizeof (uint64_t));
if (vd_efi->length > data_len)
return (EINVAL);
dk_efi->dki_lba = vd_efi->lba;
dk_efi->dki_length = vd_efi->length;
dk_efi->dki_data = kmem_zalloc(vd_efi->length, KM_SLEEP);
return (0);
}
static void
vd_get_efi_out(void *ioctl_arg, void *vd_buf)
{
int len;
vd_efi_t *vd_efi = (vd_efi_t *)vd_buf;
dk_efi_t *dk_efi = (dk_efi_t *)ioctl_arg;
len = vd_efi->length;
DK_EFI2VD_EFI(dk_efi, vd_efi);
kmem_free(dk_efi->dki_data, len);
}
static int
vd_set_efi_in(void *vd_buf, size_t vd_buf_len, void *ioctl_arg)
{
vd_efi_t *vd_efi = (vd_efi_t *)vd_buf;
dk_efi_t *dk_efi = (dk_efi_t *)ioctl_arg;
size_t data_len;
data_len = vd_buf_len - (sizeof (vd_efi_t) - sizeof (uint64_t));
if (vd_efi->length > data_len)
return (EINVAL);
dk_efi->dki_data = kmem_alloc(vd_efi->length, KM_SLEEP);
VD_EFI2DK_EFI(vd_efi, dk_efi);
return (0);
}
static void
vd_set_efi_out(void *ioctl_arg, void *vd_buf)
{
vd_efi_t *vd_efi = (vd_efi_t *)vd_buf;
dk_efi_t *dk_efi = (dk_efi_t *)ioctl_arg;
kmem_free(dk_efi->dki_data, vd_efi->length);
}
static int
vd_scsicmd_in(void *vd_buf, size_t vd_buf_len, void *ioctl_arg)
{
size_t vd_scsi_len;
vd_scsi_t *vd_scsi = (vd_scsi_t *)vd_buf;
struct uscsi_cmd *uscsi = (struct uscsi_cmd *)ioctl_arg;
vd_scsi_len = VD_SCSI_SIZE;
vd_scsi_len += P2ROUNDUP(vd_scsi->cdb_len, sizeof (uint64_t));
vd_scsi_len += P2ROUNDUP(vd_scsi->sense_len, sizeof (uint64_t));
vd_scsi_len += P2ROUNDUP(vd_scsi->datain_len, sizeof (uint64_t));
vd_scsi_len += P2ROUNDUP(vd_scsi->dataout_len, sizeof (uint64_t));
ASSERT(vd_scsi_len % sizeof (uint64_t) == 0);
if (vd_buf_len < vd_scsi_len)
return (EINVAL);
uscsi->uscsi_flags = vd_scsi_debug;
if (vd_scsi->options & VD_SCSI_OPT_NORETRY) {
uscsi->uscsi_flags |= USCSI_ISOLATE;
uscsi->uscsi_flags |= USCSI_DIAGNOSE;
}
switch (vd_scsi->task_attribute) {
case VD_SCSI_TASK_ACA:
uscsi->uscsi_flags |= USCSI_HEAD;
break;
case VD_SCSI_TASK_HQUEUE:
uscsi->uscsi_flags |= USCSI_HTAG;
break;
case VD_SCSI_TASK_ORDERED:
uscsi->uscsi_flags |= USCSI_OTAG;
break;
default:
uscsi->uscsi_flags |= USCSI_NOTAG;
break;
}
uscsi->uscsi_timeout = vd_scsi->timeout;
uscsi->uscsi_cdb = (caddr_t)VD_SCSI_DATA_CDB(vd_scsi);
uscsi->uscsi_cdblen = vd_scsi->cdb_len;
if (vd_scsi->sense_len != 0) {
uscsi->uscsi_flags |= USCSI_RQENABLE;
uscsi->uscsi_rqbuf = (caddr_t)VD_SCSI_DATA_SENSE(vd_scsi);
uscsi->uscsi_rqlen = vd_scsi->sense_len;
}
if (vd_scsi->datain_len != 0 && vd_scsi->dataout_len != 0) {
return (EINVAL);
}
if (vd_scsi->datain_len != 0) {
uscsi->uscsi_flags |= USCSI_READ;
uscsi->uscsi_buflen = vd_scsi->datain_len;
uscsi->uscsi_bufaddr = (char *)VD_SCSI_DATA_IN(vd_scsi);
}
if (vd_scsi->dataout_len != 0) {
uscsi->uscsi_buflen = vd_scsi->dataout_len;
uscsi->uscsi_bufaddr = (char *)VD_SCSI_DATA_OUT(vd_scsi);
}
return (0);
}
static void
vd_scsicmd_out(void *ioctl_arg, void *vd_buf)
{
vd_scsi_t *vd_scsi = (vd_scsi_t *)vd_buf;
struct uscsi_cmd *uscsi = (struct uscsi_cmd *)ioctl_arg;
vd_scsi->cmd_status = uscsi->uscsi_status;
if ((uscsi->uscsi_flags & USCSI_RQENABLE) &&
(uscsi->uscsi_status == STATUS_CHECK ||
uscsi->uscsi_status == STATUS_TERMINATED)) {
vd_scsi->sense_status = uscsi->uscsi_rqstatus;
if (uscsi->uscsi_rqstatus == STATUS_GOOD)
vd_scsi->sense_len -= uscsi->uscsi_rqresid;
else
vd_scsi->sense_len = 0;
} else {
vd_scsi->sense_len = 0;
}
if (uscsi->uscsi_status != STATUS_GOOD) {
vd_scsi->dataout_len = 0;
vd_scsi->datain_len = 0;
return;
}
if (uscsi->uscsi_flags & USCSI_READ) {
vd_scsi->datain_len -= uscsi->uscsi_resid;
vd_scsi->dataout_len = 0;
} else {
vd_scsi->datain_len = 0;
vd_scsi->dataout_len -= uscsi->uscsi_resid;
}
}
static ushort_t
vd_lbl2cksum(struct dk_label *label)
{
int count;
ushort_t sum, *sp;
count = (sizeof (struct dk_label)) / (sizeof (short)) - 1;
sp = (ushort_t *)label;
sum = 0;
while (count--) {
sum ^= *sp++;
}
return (sum);
}
static void
vd_vtocgeom_to_label(struct extvtoc *vtoc, struct dk_geom *geom,
struct dk_label *label)
{
int i;
ASSERT(vtoc->v_nparts == V_NUMPAR);
ASSERT(vtoc->v_sanity == VTOC_SANE);
bzero(label, sizeof (struct dk_label));
label->dkl_ncyl = geom->dkg_ncyl;
label->dkl_acyl = geom->dkg_acyl;
label->dkl_pcyl = geom->dkg_pcyl;
label->dkl_nhead = geom->dkg_nhead;
label->dkl_nsect = geom->dkg_nsect;
label->dkl_intrlv = geom->dkg_intrlv;
label->dkl_apc = geom->dkg_apc;
label->dkl_rpm = geom->dkg_rpm;
label->dkl_write_reinstruct = geom->dkg_write_reinstruct;
label->dkl_read_reinstruct = geom->dkg_read_reinstruct;
label->dkl_vtoc.v_nparts = V_NUMPAR;
label->dkl_vtoc.v_sanity = VTOC_SANE;
label->dkl_vtoc.v_version = vtoc->v_version;
for (i = 0; i < V_NUMPAR; i++) {
label->dkl_vtoc.v_timestamp[i] = vtoc->timestamp[i];
label->dkl_vtoc.v_part[i].p_tag = vtoc->v_part[i].p_tag;
label->dkl_vtoc.v_part[i].p_flag = vtoc->v_part[i].p_flag;
label->dkl_map[i].dkl_cylno = vtoc->v_part[i].p_start /
(label->dkl_nhead * label->dkl_nsect);
label->dkl_map[i].dkl_nblk = vtoc->v_part[i].p_size;
}
label->dkl_vtoc.v_bootinfo[0] = vtoc->v_bootinfo[0];
label->dkl_vtoc.v_bootinfo[1] = vtoc->v_bootinfo[1];
label->dkl_vtoc.v_bootinfo[2] = vtoc->v_bootinfo[2];
bcopy(vtoc->v_asciilabel, label->dkl_asciilabel, LEN_DKL_ASCII);
bcopy(vtoc->v_volume, label->dkl_vtoc.v_volume, LEN_DKL_VVOL);
label->dkl_magic = DKL_MAGIC;
label->dkl_cksum = vd_lbl2cksum(label);
}
static void
vd_label_to_vtocgeom(struct dk_label *label, struct extvtoc *vtoc,
struct dk_geom *geom)
{
int i;
bzero(vtoc, sizeof (struct extvtoc));
bzero(geom, sizeof (struct dk_geom));
geom->dkg_ncyl = label->dkl_ncyl;
geom->dkg_acyl = label->dkl_acyl;
geom->dkg_nhead = label->dkl_nhead;
geom->dkg_nsect = label->dkl_nsect;
geom->dkg_intrlv = label->dkl_intrlv;
geom->dkg_apc = label->dkl_apc;
geom->dkg_rpm = label->dkl_rpm;
geom->dkg_pcyl = label->dkl_pcyl;
geom->dkg_write_reinstruct = label->dkl_write_reinstruct;
geom->dkg_read_reinstruct = label->dkl_read_reinstruct;
vtoc->v_sanity = label->dkl_vtoc.v_sanity;
vtoc->v_version = label->dkl_vtoc.v_version;
vtoc->v_sectorsz = DEV_BSIZE;
vtoc->v_nparts = label->dkl_vtoc.v_nparts;
for (i = 0; i < vtoc->v_nparts; i++) {
vtoc->v_part[i].p_tag = label->dkl_vtoc.v_part[i].p_tag;
vtoc->v_part[i].p_flag = label->dkl_vtoc.v_part[i].p_flag;
vtoc->v_part[i].p_start = label->dkl_map[i].dkl_cylno *
(label->dkl_nhead * label->dkl_nsect);
vtoc->v_part[i].p_size = label->dkl_map[i].dkl_nblk;
vtoc->timestamp[i] = label->dkl_vtoc.v_timestamp[i];
}
vtoc->v_bootinfo[0] = label->dkl_vtoc.v_bootinfo[0];
vtoc->v_bootinfo[1] = label->dkl_vtoc.v_bootinfo[1];
vtoc->v_bootinfo[2] = label->dkl_vtoc.v_bootinfo[2];
bcopy(label->dkl_asciilabel, vtoc->v_asciilabel, LEN_DKL_ASCII);
bcopy(label->dkl_vtoc.v_volume, vtoc->v_volume, LEN_DKL_VVOL);
}
static boolean_t
vd_slice_geom_isvalid(vd_t *vd, struct dk_geom *geom)
{
ASSERT(vd->vdisk_type == VD_DISK_TYPE_SLICE);
ASSERT(vd->vdisk_label == VD_DISK_LABEL_VTOC);
if (geom->dkg_ncyl != vd->dk_geom.dkg_ncyl ||
geom->dkg_acyl != vd->dk_geom.dkg_acyl ||
geom->dkg_nsect != vd->dk_geom.dkg_nsect ||
geom->dkg_pcyl != vd->dk_geom.dkg_pcyl)
return (B_FALSE);
return (B_TRUE);
}
static boolean_t
vd_slice_vtoc_isvalid(vd_t *vd, struct extvtoc *vtoc)
{
size_t csize;
int i;
ASSERT(vd->vdisk_type == VD_DISK_TYPE_SLICE);
ASSERT(vd->vdisk_label == VD_DISK_LABEL_VTOC);
if (vtoc->v_sanity != vd->vtoc.v_sanity ||
vtoc->v_version != vd->vtoc.v_version ||
vtoc->v_nparts != vd->vtoc.v_nparts ||
strcmp(vtoc->v_volume, vd->vtoc.v_volume) != 0 ||
strcmp(vtoc->v_asciilabel, vd->vtoc.v_asciilabel) != 0)
return (B_FALSE);
if (vtoc->v_part[VD_ENTIRE_DISK_SLICE].p_start !=
vd->vtoc.v_part[VD_ENTIRE_DISK_SLICE].p_start ||
vtoc->v_part[VD_ENTIRE_DISK_SLICE].p_size !=
vd->vtoc.v_part[VD_ENTIRE_DISK_SLICE].p_size)
return (B_FALSE);
csize = vd->dk_geom.dkg_nhead * vd->dk_geom.dkg_nsect;
if (vtoc->v_part[0].p_start > 4 * csize ||
vtoc->v_part[0].p_size > vtoc->v_part[VD_ENTIRE_DISK_SLICE].p_size)
return (B_FALSE);
if (vd->vtoc.v_part[0].p_size >= 4 * csize &&
vtoc->v_part[0].p_size < vd->vtoc.v_part[0].p_size - 4 *csize)
return (B_FALSE);
for (i = 1; i < vtoc->v_nparts; i++) {
if (i != VD_ENTIRE_DISK_SLICE &&
vtoc->v_part[i].p_size != 0)
return (B_FALSE);
}
return (B_TRUE);
}
static int
vd_do_slice_ioctl(vd_t *vd, int cmd, void *ioctl_arg)
{
dk_efi_t *dk_ioc;
struct extvtoc *vtoc;
struct dk_geom *geom;
size_t len, lba;
ASSERT(vd->vdisk_type == VD_DISK_TYPE_SLICE);
if (cmd == DKIOCFLUSHWRITECACHE)
return (vd_flush_write(vd));
switch (vd->vdisk_label) {
case VD_DISK_LABEL_VTOC:
switch (cmd) {
case DKIOCGGEOM:
ASSERT(ioctl_arg != NULL);
bcopy(&vd->dk_geom, ioctl_arg, sizeof (vd->dk_geom));
return (0);
case DKIOCGEXTVTOC:
ASSERT(ioctl_arg != NULL);
bcopy(&vd->vtoc, ioctl_arg, sizeof (vd->vtoc));
return (0);
case DKIOCSGEOM:
ASSERT(ioctl_arg != NULL);
if (vd_slice_single_slice)
return (ENOTSUP);
geom = (struct dk_geom *)ioctl_arg;
if (!vd_slice_geom_isvalid(vd, geom))
return (EINVAL);
return (0);
case DKIOCSEXTVTOC:
ASSERT(ioctl_arg != NULL);
if (vd_slice_single_slice)
return (ENOTSUP);
vtoc = (struct extvtoc *)ioctl_arg;
if (!vd_slice_vtoc_isvalid(vd, vtoc))
return (EINVAL);
return (0);
default:
return (ENOTSUP);
}
case VD_DISK_LABEL_EFI:
if (cmd != DKIOCGETEFI && cmd != DKIOCSETEFI)
return (ENOTSUP);
ASSERT(ioctl_arg != NULL);
dk_ioc = (dk_efi_t *)ioctl_arg;
len = dk_ioc->dki_length;
lba = dk_ioc->dki_lba;
if ((lba != VD_EFI_LBA_GPT && lba != VD_EFI_LBA_GPE) ||
(lba == VD_EFI_LBA_GPT && len < sizeof (efi_gpt_t)) ||
(lba == VD_EFI_LBA_GPE && len < sizeof (efi_gpe_t)))
return (EINVAL);
switch (cmd) {
case DKIOCGETEFI:
len = vd_slice_flabel_read(vd,
(caddr_t)dk_ioc->dki_data,
lba * vd->vdisk_bsize, len);
ASSERT(len > 0);
return (0);
case DKIOCSETEFI:
if (vd_slice_single_slice)
return (ENOTSUP);
return (EIO);
}
default:
return (ENOTSUP);
}
}
static int
vds_efi_alloc_and_read(vd_t *vd, efi_gpt_t **gpt, efi_gpe_t **gpe)
{
vd_efi_dev_t edev;
int status;
VD_EFI_DEV_SET(edev, vd, (vd_efi_ioctl_func)vd_backend_ioctl);
status = vd_efi_alloc_and_read(&edev, gpt, gpe);
return (status);
}
static void
vds_efi_free(vd_t *vd, efi_gpt_t *gpt, efi_gpe_t *gpe)
{
vd_efi_dev_t edev;
VD_EFI_DEV_SET(edev, vd, (vd_efi_ioctl_func)vd_backend_ioctl);
vd_efi_free(&edev, gpt, gpe);
}
static int
vd_dskimg_validate_efi(vd_t *vd)
{
efi_gpt_t *gpt;
efi_gpe_t *gpe;
int i, nparts, status;
struct uuid efi_reserved = EFI_RESERVED;
if ((status = vds_efi_alloc_and_read(vd, &gpt, &gpe)) != 0)
return (status);
bzero(&vd->vtoc, sizeof (struct extvtoc));
bzero(&vd->dk_geom, sizeof (struct dk_geom));
bzero(vd->slices, sizeof (vd_slice_t) * VD_MAXPART);
vd->efi_reserved = -1;
nparts = gpt->efi_gpt_NumberOfPartitionEntries;
for (i = 0; i < nparts && i < VD_MAXPART; i++) {
if (gpe[i].efi_gpe_StartingLBA == 0 &&
gpe[i].efi_gpe_EndingLBA == 0) {
continue;
}
vd->slices[i].start = gpe[i].efi_gpe_StartingLBA;
vd->slices[i].nblocks = gpe[i].efi_gpe_EndingLBA -
gpe[i].efi_gpe_StartingLBA + 1;
if (bcmp(&gpe[i].efi_gpe_PartitionTypeGUID, &efi_reserved,
sizeof (struct uuid)) == 0)
vd->efi_reserved = i;
}
ASSERT(vd->vdisk_size != 0);
vd->slices[VD_EFI_WD_SLICE].start = 0;
vd->slices[VD_EFI_WD_SLICE].nblocks = vd->vdisk_size;
vds_efi_free(vd, gpt, gpe);
return (status);
}
static int
vd_dskimg_validate_geometry(vd_t *vd)
{
struct dk_label label;
struct dk_geom *geom = &vd->dk_geom;
struct extvtoc *vtoc = &vd->vtoc;
int i;
int status = 0;
ASSERT(VD_DSKIMG(vd));
if (VD_DSKIMG_LABEL_READ(vd, &label) < 0)
return (EIO);
if (label.dkl_magic != DKL_MAGIC ||
label.dkl_cksum != vd_lbl2cksum(&label) ||
(vd_dskimg_validate_sanity &&
label.dkl_vtoc.v_sanity != VTOC_SANE) ||
label.dkl_vtoc.v_nparts != V_NUMPAR) {
if (vd_dskimg_validate_efi(vd) == 0) {
vd->vdisk_label = VD_DISK_LABEL_EFI;
return (ENOTSUP);
}
vd->vdisk_label = VD_DISK_LABEL_UNK;
vd_build_default_label(vd->dskimg_size, vd->vdisk_bsize,
&label);
status = EINVAL;
} else {
vd->vdisk_label = VD_DISK_LABEL_VTOC;
}
vd_label_to_vtocgeom(&label, vtoc, geom);
bzero(vd->slices, sizeof (vd_slice_t) * VD_MAXPART);
if (vd->vdisk_label != VD_DISK_LABEL_UNK) {
for (i = 0; i < vtoc->v_nparts; i++) {
vd->slices[i].start = vtoc->v_part[i].p_start;
vd->slices[i].nblocks = vtoc->v_part[i].p_size;
}
}
return (status);
}
static int
vd_do_dskimg_ioctl(vd_t *vd, int cmd, void *ioctl_arg)
{
struct dk_label label;
struct dk_geom *geom;
struct extvtoc *vtoc;
dk_efi_t *efi;
int rc;
ASSERT(VD_DSKIMG(vd));
switch (cmd) {
case DKIOCGGEOM:
ASSERT(ioctl_arg != NULL);
geom = (struct dk_geom *)ioctl_arg;
rc = vd_dskimg_validate_geometry(vd);
if (rc != 0 && rc != EINVAL)
return (rc);
bcopy(&vd->dk_geom, geom, sizeof (struct dk_geom));
return (0);
case DKIOCGEXTVTOC:
ASSERT(ioctl_arg != NULL);
vtoc = (struct extvtoc *)ioctl_arg;
rc = vd_dskimg_validate_geometry(vd);
if (rc != 0 && rc != EINVAL)
return (rc);
bcopy(&vd->vtoc, vtoc, sizeof (struct extvtoc));
return (0);
case DKIOCSGEOM:
ASSERT(ioctl_arg != NULL);
geom = (struct dk_geom *)ioctl_arg;
if (geom->dkg_nhead == 0 || geom->dkg_nsect == 0)
return (EINVAL);
bcopy(ioctl_arg, &vd->dk_geom, sizeof (vd->dk_geom));
return (0);
case DKIOCSEXTVTOC:
ASSERT(ioctl_arg != NULL);
ASSERT(vd->dk_geom.dkg_nhead != 0 &&
vd->dk_geom.dkg_nsect != 0);
vtoc = (struct extvtoc *)ioctl_arg;
if (vtoc->v_sanity != VTOC_SANE ||
vtoc->v_sectorsz != DEV_BSIZE ||
vtoc->v_nparts != V_NUMPAR)
return (EINVAL);
vd_vtocgeom_to_label(vtoc, &vd->dk_geom, &label);
if ((rc = vd_dskimg_set_vtoc(vd, &label)) != 0)
return (rc);
break;
case DKIOCFLUSHWRITECACHE:
return (vd_flush_write(vd));
case DKIOCGETEFI:
ASSERT(ioctl_arg != NULL);
efi = (dk_efi_t *)ioctl_arg;
if (vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BREAD,
(caddr_t)efi->dki_data, efi->dki_lba, efi->dki_length) < 0)
return (EIO);
return (0);
case DKIOCSETEFI:
ASSERT(ioctl_arg != NULL);
efi = (dk_efi_t *)ioctl_arg;
if (vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BWRITE,
(caddr_t)efi->dki_data, efi->dki_lba, efi->dki_length) < 0)
return (EIO);
break;
default:
return (ENOTSUP);
}
ASSERT(cmd == DKIOCSEXTVTOC || cmd == DKIOCSETEFI);
(void) vd_dskimg_validate_geometry(vd);
if (vd_dskimg_write_devid(vd, vd->dskimg_devid) != 0) {
PR0("Fail to write devid");
}
return (0);
}
static int
vd_backend_ioctl(vd_t *vd, int cmd, caddr_t arg)
{
int rval = 0, status;
struct vtoc vtoc;
if (vd->vdisk_type == VD_DISK_TYPE_SLICE) {
status = vd_do_slice_ioctl(vd, cmd, arg);
} else if (VD_DSKIMG(vd)) {
status = vd_do_dskimg_ioctl(vd, cmd, arg);
} else {
status = ldi_ioctl(vd->ldi_handle[0], cmd, (intptr_t)arg,
vd->open_flags | FKIOCTL, kcred, &rval);
if (status == ENOTTY) {
switch (cmd) {
case DKIOCGEXTVTOC:
cmd = DKIOCGVTOC;
status = ldi_ioctl(vd->ldi_handle[0], cmd,
(intptr_t)&vtoc, vd->open_flags | FKIOCTL,
kcred, &rval);
vtoctoextvtoc(vtoc,
(*(struct extvtoc *)(void *)arg));
break;
case DKIOCSEXTVTOC:
cmd = DKIOCSVTOC;
extvtoctovtoc((*(struct extvtoc *)(void *)arg),
vtoc);
status = ldi_ioctl(vd->ldi_handle[0], cmd,
(intptr_t)&vtoc, vd->open_flags | FKIOCTL,
kcred, &rval);
break;
}
}
}
#ifdef DEBUG
if (rval != 0) {
PR0("ioctl %x set rval = %d, which is not being returned"
" to caller", cmd, rval);
}
#endif
return (status);
}
static int
vd_do_ioctl(vd_t *vd, vd_dring_payload_t *request, void* buf, vd_ioctl_t *ioctl)
{
int status = 0;
size_t nbytes = request->nbytes;
ASSERT(request->slice < vd->nslices);
PR0("Performing %s", ioctl->operation_name);
if (ioctl->copyin != NULL) {
ASSERT(nbytes != 0 && buf != NULL);
PR1("Getting \"arg\" data from client");
if ((status = ldc_mem_copy(vd->ldc_handle, buf, 0, &nbytes,
request->cookie, request->ncookies,
LDC_COPY_IN)) != 0) {
PR0("ldc_mem_copy() returned errno %d "
"copying from client", status);
return (status);
}
if (ioctl->copyin == VD_IDENTITY_IN) {
ioctl->arg = buf;
} else {
status = (ioctl->copyin)(buf, nbytes,
(void *)ioctl->arg);
if (status != 0) {
request->status = status;
return (0);
}
}
}
if (ioctl->operation == VD_OP_SCSICMD) {
struct uscsi_cmd *uscsi = (struct uscsi_cmd *)ioctl->arg;
if (!(vd->open_flags & FWRITE) &&
!(uscsi->uscsi_flags & USCSI_READ)) {
PR0("uscsi fails because backend is opened read-only");
request->status = EROFS;
return (0);
}
}
request->status = vd_backend_ioctl(vd, ioctl->cmd, ioctl->arg);
if (request->status != 0) {
PR0("ioctl(%s) = errno %d", ioctl->cmd_name, request->status);
if (ioctl->operation == VD_OP_SCSICMD &&
((struct uscsi_cmd *)ioctl->arg)->uscsi_status != 0)
request->status = 0;
else
return (0);
}
if (ioctl->copyout != NULL) {
ASSERT(nbytes != 0 && buf != NULL);
PR1("Sending \"arg\" data to client");
if (ioctl->copyout != VD_IDENTITY_OUT)
(ioctl->copyout)((void *)ioctl->arg, buf);
if ((status = ldc_mem_copy(vd->ldc_handle, buf, 0, &nbytes,
request->cookie, request->ncookies,
LDC_COPY_OUT)) != 0) {
PR0("ldc_mem_copy() returned errno %d "
"copying to client", status);
return (status);
}
}
return (status);
}
#define RNDSIZE(expr) P2ROUNDUP(sizeof (expr), sizeof (uint64_t))
static void
vd_complete(void *arg)
{
vd_task_t *task = (vd_task_t *)arg;
ASSERT(task != NULL);
ASSERT(task->status == EINPROGRESS);
ASSERT(task->completef != NULL);
task->status = task->completef(task);
if (task->status)
PR0("%s: Error %d completing task", __func__, task->status);
vd_complete_notify(task);
}
static int
vd_ioctl(vd_task_t *task)
{
int i, status;
void *buf = NULL;
struct dk_geom dk_geom = {0};
struct extvtoc vtoc = {0};
struct dk_efi dk_efi = {0};
struct uscsi_cmd uscsi = {0};
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
vd_ioctl_t ioctl[] = {
{VD_OP_FLUSH, STRINGIZE(VD_OP_FLUSH), 0,
DKIOCFLUSHWRITECACHE, STRINGIZE(DKIOCFLUSHWRITECACHE),
NULL, NULL, NULL, B_TRUE},
{VD_OP_GET_WCE, STRINGIZE(VD_OP_GET_WCE), RNDSIZE(int),
DKIOCGETWCE, STRINGIZE(DKIOCGETWCE),
NULL, VD_IDENTITY_IN, VD_IDENTITY_OUT, B_FALSE},
{VD_OP_GET_DISKGEOM, STRINGIZE(VD_OP_GET_DISKGEOM),
RNDSIZE(vd_geom_t),
DKIOCGGEOM, STRINGIZE(DKIOCGGEOM),
&dk_geom, NULL, dk_geom2vd_geom, B_FALSE},
{VD_OP_GET_VTOC, STRINGIZE(VD_OP_GET_VTOC), RNDSIZE(vd_vtoc_t),
DKIOCGEXTVTOC, STRINGIZE(DKIOCGEXTVTOC),
&vtoc, NULL, vtoc2vd_vtoc, B_FALSE},
{VD_OP_GET_EFI, STRINGIZE(VD_OP_GET_EFI), RNDSIZE(vd_efi_t),
DKIOCGETEFI, STRINGIZE(DKIOCGETEFI),
&dk_efi, vd_get_efi_in, vd_get_efi_out, B_FALSE},
{VD_OP_SET_WCE, STRINGIZE(VD_OP_SET_WCE), RNDSIZE(int),
DKIOCSETWCE, STRINGIZE(DKIOCSETWCE),
NULL, VD_IDENTITY_IN, VD_IDENTITY_OUT, B_TRUE},
{VD_OP_SET_DISKGEOM, STRINGIZE(VD_OP_SET_DISKGEOM),
RNDSIZE(vd_geom_t),
DKIOCSGEOM, STRINGIZE(DKIOCSGEOM),
&dk_geom, vd_geom2dk_geom, NULL, B_TRUE},
{VD_OP_SET_VTOC, STRINGIZE(VD_OP_SET_VTOC), RNDSIZE(vd_vtoc_t),
DKIOCSEXTVTOC, STRINGIZE(DKIOCSEXTVTOC),
&vtoc, vd_vtoc2vtoc, NULL, B_TRUE},
{VD_OP_SET_EFI, STRINGIZE(VD_OP_SET_EFI), RNDSIZE(vd_efi_t),
DKIOCSETEFI, STRINGIZE(DKIOCSETEFI),
&dk_efi, vd_set_efi_in, vd_set_efi_out, B_TRUE},
{VD_OP_SCSICMD, STRINGIZE(VD_OP_SCSICMD), RNDSIZE(vd_scsi_t),
USCSICMD, STRINGIZE(USCSICMD),
&uscsi, vd_scsicmd_in, vd_scsicmd_out, B_FALSE},
};
size_t nioctls = (sizeof (ioctl))/(sizeof (ioctl[0]));
ASSERT(vd != NULL);
ASSERT(request != NULL);
ASSERT(request->slice < vd->nslices);
for (i = 0; i < nioctls; i++) {
if (request->operation == ioctl[i].operation) {
ASSERT(ioctl[i].nbytes % sizeof (uint64_t) == 0);
if (request->operation == VD_OP_GET_EFI ||
request->operation == VD_OP_SET_EFI ||
request->operation == VD_OP_SCSICMD) {
if (request->nbytes >= ioctl[i].nbytes)
break;
PR0("%s: Expected at least nbytes = %lu, "
"got %lu", ioctl[i].operation_name,
ioctl[i].nbytes, request->nbytes);
return (EINVAL);
}
if (request->nbytes != ioctl[i].nbytes) {
PR0("%s: Expected nbytes = %lu, got %lu",
ioctl[i].operation_name, ioctl[i].nbytes,
request->nbytes);
return (EINVAL);
}
break;
}
}
VERIFY(i < nioctls);
if (!(vd->open_flags & FWRITE) && ioctl[i].write) {
PR0("%s fails because backend is opened read-only",
ioctl[i].operation_name);
request->status = EROFS;
return (0);
}
if (request->nbytes)
buf = kmem_zalloc(request->nbytes, KM_SLEEP);
status = vd_do_ioctl(vd, request, buf, &ioctl[i]);
if (request->nbytes)
kmem_free(buf, request->nbytes);
return (status);
}
static int
vd_get_devid(vd_task_t *task)
{
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
vd_devid_t *vd_devid;
impl_devid_t *devid;
int status, bufid_len, devid_len, len, sz;
int bufbytes;
PR1("Get Device ID, nbytes=%ld", request->nbytes);
if (vd->vdisk_type == VD_DISK_TYPE_SLICE) {
PR2("No Device ID for slices");
request->status = ENOTSUP;
return (0);
}
if (VD_DSKIMG(vd)) {
if (vd->dskimg_devid == NULL) {
PR2("No Device ID");
request->status = ENOENT;
return (0);
} else {
sz = ddi_devid_sizeof(vd->dskimg_devid);
devid = kmem_alloc(sz, KM_SLEEP);
bcopy(vd->dskimg_devid, devid, sz);
}
} else {
if (ddi_lyr_get_devid(vd->dev[request->slice],
(ddi_devid_t *)&devid) != DDI_SUCCESS) {
PR2("No Device ID");
request->status = ENOENT;
return (0);
}
}
bufid_len = request->nbytes - sizeof (vd_devid_t) + 1;
devid_len = DEVID_GETLEN(devid);
bufbytes = request->nbytes;
vd_devid = kmem_zalloc(bufbytes, KM_SLEEP);
vd_devid->length = devid_len;
vd_devid->type = DEVID_GETTYPE(devid);
len = (devid_len > bufid_len)? bufid_len : devid_len;
bcopy(devid->did_id, vd_devid->id, len);
request->status = 0;
ASSERT(request->nbytes % sizeof (uint64_t) == 0);
if ((status = ldc_mem_copy(vd->ldc_handle, (caddr_t)vd_devid, 0,
&request->nbytes, request->cookie, request->ncookies,
LDC_COPY_OUT)) != 0) {
PR0("ldc_mem_copy() returned errno %d copying to client",
status);
}
PR1("post mem_copy: nbytes=%ld", request->nbytes);
kmem_free(vd_devid, bufbytes);
ddi_devid_free((ddi_devid_t)devid);
return (status);
}
static int
vd_scsi_reset(vd_t *vd)
{
int rval, status;
struct uscsi_cmd uscsi = { 0 };
uscsi.uscsi_flags = vd_scsi_debug | USCSI_RESET;
uscsi.uscsi_timeout = vd_scsi_rdwr_timeout;
status = ldi_ioctl(vd->ldi_handle[0], USCSICMD, (intptr_t)&uscsi,
(vd->open_flags | FKIOCTL), kcred, &rval);
return (status);
}
static int
vd_reset(vd_task_t *task)
{
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
ASSERT(request->operation == VD_OP_RESET);
ASSERT(vd->scsi);
PR0("Performing VD_OP_RESET");
if (request->nbytes != 0) {
PR0("VD_OP_RESET: Expected nbytes = 0, got %lu",
request->nbytes);
return (EINVAL);
}
request->status = vd_scsi_reset(vd);
return (0);
}
static int
vd_get_capacity(vd_task_t *task)
{
int rv;
size_t nbytes;
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
vd_capacity_t vd_cap = { 0 };
ASSERT(request->operation == VD_OP_GET_CAPACITY);
PR0("Performing VD_OP_GET_CAPACITY");
nbytes = request->nbytes;
if (nbytes != RNDSIZE(vd_capacity_t)) {
PR0("VD_OP_GET_CAPACITY: Expected nbytes = %lu, got %lu",
RNDSIZE(vd_capacity_t), nbytes);
return (EINVAL);
}
(void) vd_backend_check_size(vd);
ASSERT(vd->vdisk_size != 0);
request->status = 0;
vd_cap.vdisk_block_size = vd->vdisk_bsize;
vd_cap.vdisk_size = vd->vdisk_size;
if ((rv = ldc_mem_copy(vd->ldc_handle, (char *)&vd_cap, 0, &nbytes,
request->cookie, request->ncookies, LDC_COPY_OUT)) != 0) {
PR0("ldc_mem_copy() returned errno %d copying to client", rv);
return (rv);
}
return (0);
}
static int
vd_get_access(vd_task_t *task)
{
uint64_t access;
int rv, rval = 0;
size_t nbytes;
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
ASSERT(request->operation == VD_OP_GET_ACCESS);
ASSERT(vd->scsi);
PR0("Performing VD_OP_GET_ACCESS");
nbytes = request->nbytes;
if (nbytes != sizeof (uint64_t)) {
PR0("VD_OP_GET_ACCESS: Expected nbytes = %lu, got %lu",
sizeof (uint64_t), nbytes);
return (EINVAL);
}
request->status = ldi_ioctl(vd->ldi_handle[request->slice], MHIOCSTATUS,
(intptr_t)NULL, (vd->open_flags | FKIOCTL), kcred, &rval);
if (request->status != 0)
return (0);
access = (rval == 0)? VD_ACCESS_ALLOWED : VD_ACCESS_DENIED;
if ((rv = ldc_mem_copy(vd->ldc_handle, (char *)&access, 0, &nbytes,
request->cookie, request->ncookies, LDC_COPY_OUT)) != 0) {
PR0("ldc_mem_copy() returned errno %d copying to client", rv);
return (rv);
}
return (0);
}
static int
vd_set_access(vd_task_t *task)
{
uint64_t flags;
int rv, rval;
size_t nbytes;
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
ASSERT(request->operation == VD_OP_SET_ACCESS);
ASSERT(vd->scsi);
nbytes = request->nbytes;
if (nbytes != sizeof (uint64_t)) {
PR0("VD_OP_SET_ACCESS: Expected nbytes = %lu, got %lu",
sizeof (uint64_t), nbytes);
return (EINVAL);
}
if ((rv = ldc_mem_copy(vd->ldc_handle, (char *)&flags, 0, &nbytes,
request->cookie, request->ncookies, LDC_COPY_IN)) != 0) {
PR0("ldc_mem_copy() returned errno %d copying from client", rv);
return (rv);
}
if (flags == VD_ACCESS_SET_CLEAR) {
PR0("Performing VD_OP_SET_ACCESS (CLEAR)");
request->status = ldi_ioctl(vd->ldi_handle[request->slice],
MHIOCRELEASE, (intptr_t)NULL, (vd->open_flags | FKIOCTL),
kcred, &rval);
if (request->status == 0)
vd->ownership = B_FALSE;
return (0);
}
if (!(flags & VD_ACCESS_SET_EXCLUSIVE)) {
PR0("Invalid VD_OP_SET_ACCESS flags: 0x%lx", flags);
request->status = EINVAL;
return (0);
}
switch (flags & (VD_ACCESS_SET_PREEMPT | VD_ACCESS_SET_PRESERVE)) {
case VD_ACCESS_SET_PREEMPT | VD_ACCESS_SET_PRESERVE:
PR0("Performing VD_OP_SET_ACCESS (EXCLUSIVE|PREEMPT|PRESERVE)");
request->status = ldi_ioctl(vd->ldi_handle[request->slice],
MHIOCTKOWN, (intptr_t)NULL, (vd->open_flags | FKIOCTL),
kcred, &rval);
break;
case VD_ACCESS_SET_PRESERVE:
PR0("Performing VD_OP_SET_ACCESS (EXCLUSIVE|PRESERVE)");
request->status = ldi_ioctl(vd->ldi_handle[request->slice],
MHIOCQRESERVE, (intptr_t)NULL, (vd->open_flags | FKIOCTL),
kcred, &rval);
if (request->status != 0)
break;
request->status = ldi_ioctl(vd->ldi_handle[request->slice],
MHIOCTKOWN, (intptr_t)NULL, (vd->open_flags | FKIOCTL),
kcred, &rval);
break;
case VD_ACCESS_SET_PREEMPT:
PR0("Performing VD_OP_SET_ACCESS (EXCLUSIVE|PREEMPT)");
request->status = ldi_ioctl(vd->ldi_handle[request->slice],
MHIOCQRESERVE, (intptr_t)NULL, (vd->open_flags | FKIOCTL),
kcred, &rval);
if (request->status == 0)
break;
(void) vd_scsi_reset(vd);
request->status = ldi_ioctl(vd->ldi_handle[request->slice],
MHIOCQRESERVE, (intptr_t)NULL, (vd->open_flags | FKIOCTL),
kcred, &rval);
break;
case 0:
PR0("Performing VD_OP_SET_ACCESS (EXCLUSIVE)");
request->status = ldi_ioctl(vd->ldi_handle[request->slice],
MHIOCQRESERVE, (intptr_t)NULL, (vd->open_flags | FKIOCTL),
kcred, &rval);
break;
}
if (request->status == 0)
vd->ownership = B_TRUE;
else
PR0("VD_OP_SET_ACCESS: error %d", request->status);
return (0);
}
static void
vd_reset_access(vd_t *vd)
{
int status, rval;
if (vd->file || vd->volume || !vd->ownership)
return;
PR0("Releasing disk ownership");
status = ldi_ioctl(vd->ldi_handle[0], MHIOCRELEASE, (intptr_t)NULL,
(vd->open_flags | FKIOCTL), kcred, &rval);
if (status == 0 || status == EACCES) {
vd->ownership = B_FALSE;
return;
}
PR0("Fail to release ownership, error %d", status);
PR0("Resetting disk");
status = vd_scsi_reset(vd);
if (status != 0)
PR0("Fail to reset disk, error %d", status);
status = ldi_ioctl(vd->ldi_handle[0], MHIOCRELEASE, (intptr_t)NULL,
(vd->open_flags | FKIOCTL), kcred, &rval);
if (status == 0 || status == EACCES) {
vd->ownership = B_FALSE;
return;
}
PR0("Fail to release ownership, error %d", status);
if (vd_reset_access_failure == A_REBOOT) {
cmn_err(CE_WARN, VD_RESET_ACCESS_FAILURE_MSG
", rebooting the system", vd->device_path);
(void) uadmin(A_SHUTDOWN, AD_BOOT, (uintptr_t)NULL);
} else if (vd_reset_access_failure == A_DUMP) {
panic(VD_RESET_ACCESS_FAILURE_MSG, vd->device_path);
}
cmn_err(CE_WARN, VD_RESET_ACCESS_FAILURE_MSG, vd->device_path);
}
static const vds_operation_t vds_operation[] = {
#define X(_s) #_s, _s
{X(VD_OP_BREAD), vd_start_bio, vd_complete_bio},
{X(VD_OP_BWRITE), vd_start_bio, vd_complete_bio},
{X(VD_OP_FLUSH), vd_ioctl, NULL},
{X(VD_OP_GET_WCE), vd_ioctl, NULL},
{X(VD_OP_SET_WCE), vd_ioctl, NULL},
{X(VD_OP_GET_VTOC), vd_ioctl, NULL},
{X(VD_OP_SET_VTOC), vd_ioctl, NULL},
{X(VD_OP_GET_DISKGEOM), vd_ioctl, NULL},
{X(VD_OP_SET_DISKGEOM), vd_ioctl, NULL},
{X(VD_OP_GET_EFI), vd_ioctl, NULL},
{X(VD_OP_SET_EFI), vd_ioctl, NULL},
{X(VD_OP_GET_DEVID), vd_get_devid, NULL},
{X(VD_OP_SCSICMD), vd_ioctl, NULL},
{X(VD_OP_RESET), vd_reset, NULL},
{X(VD_OP_GET_CAPACITY), vd_get_capacity, NULL},
{X(VD_OP_SET_ACCESS), vd_set_access, NULL},
{X(VD_OP_GET_ACCESS), vd_get_access, NULL},
#undef X
};
static const size_t vds_noperations =
(sizeof (vds_operation))/(sizeof (vds_operation[0]));
static int
vd_do_process_task(vd_task_t *task)
{
int i;
vd_t *vd = task->vd;
vd_dring_payload_t *request = task->request;
ASSERT(vd != NULL);
ASSERT(request != NULL);
for (i = 0; i < vds_noperations; i++) {
if (request->operation == vds_operation[i].operation) {
ASSERT(vds_operation[i].start != NULL);
task->completef = vds_operation[i].complete;
break;
}
}
if ((VD_OP_SUPPORTED(vd->operations, request->operation) == B_FALSE) ||
(i == vds_noperations)) {
PR0("Unsupported operation %u", request->operation);
request->status = ENOTSUP;
return (0);
}
if (request->slice >= vd->nslices &&
((vd->vdisk_type != VD_DISK_TYPE_DISK && vd_slice_single_slice) ||
request->slice != VD_SLICE_NONE)) {
PR0("Invalid \"slice\" %u (max %u) for virtual disk",
request->slice, (vd->nslices - 1));
request->status = EINVAL;
return (0);
}
return (vds_operation[i].start(task));
}
static int
vd_process_task(vd_task_t *task)
{
vd_t *vd = task->vd;
int status;
DTRACE_PROBE1(task__start, vd_task_t *, task);
task->status = vd_do_process_task(task);
if (task->status == EINPROGRESS) {
(void) ddi_taskq_dispatch(vd->completionq, vd_complete,
task, DDI_SLEEP);
return (EINPROGRESS);
}
if (!vd->reset_state && (vd->xfer_mode == VIO_DRING_MODE_V1_0)) {
status = vd_mark_elem_done(vd, task->index,
task->request->status, task->request->nbytes);
if (status == ECONNRESET)
vd_mark_in_reset(vd);
else if (status == EACCES)
vd_need_reset(vd, B_TRUE);
}
return (task->status);
}
boolean_t
vd_msgtype(vio_msg_tag_t *tag, int type, int subtype, int env)
{
return ((tag->vio_msgtype == type) &&
(tag->vio_subtype == subtype) &&
(tag->vio_subtype_env == env)) ? B_TRUE : B_FALSE;
}
static boolean_t
vds_supported_version(vio_ver_msg_t *ver_msg)
{
for (int i = 0; i < vds_num_versions; i++) {
ASSERT(vds_version[i].major > 0);
ASSERT((i == 0) ||
(vds_version[i].major < vds_version[i-1].major));
if (ver_msg->ver_major == vds_version[i].major) {
if (ver_msg->ver_minor > vds_version[i].minor) {
PR0("Adjusting minor version from %u to %u",
ver_msg->ver_minor, vds_version[i].minor);
ver_msg->ver_minor = vds_version[i].minor;
}
return (B_TRUE);
}
if (ver_msg->ver_major > vds_version[i].major) {
ver_msg->ver_major = vds_version[i].major;
ver_msg->ver_minor = vds_version[i].minor;
return (B_FALSE);
}
}
ver_msg->ver_major = 0;
ver_msg->ver_minor = 0;
return (B_FALSE);
}
static int
vd_process_ver_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
vio_ver_msg_t *ver_msg = (vio_ver_msg_t *)msg;
ASSERT(msglen >= sizeof (msg->tag));
if (!vd_msgtype(&msg->tag, VIO_TYPE_CTRL, VIO_SUBTYPE_INFO,
VIO_VER_INFO)) {
return (ENOMSG);
}
if (msglen != sizeof (*ver_msg)) {
PR0("Expected %lu-byte version message; "
"received %lu bytes", sizeof (*ver_msg), msglen);
return (EBADMSG);
}
if (ver_msg->dev_class != VDEV_DISK) {
PR0("Expected device class %u (disk); received %u",
VDEV_DISK, ver_msg->dev_class);
return (EBADMSG);
}
ver_msg->dev_class = VDEV_DISK_SERVER;
if (!vds_supported_version(ver_msg))
return (EBADMSG);
ASSERT(!(vd->initialized & VD_SID));
vd->sid = ver_msg->tag.vio_sid;
vd->initialized |= VD_SID;
vd->version.major = ver_msg->ver_major;
vd->version.minor = ver_msg->ver_minor;
PR0("Using major version %u, minor version %u",
ver_msg->ver_major, ver_msg->ver_minor);
return (0);
}
static void
vd_set_exported_operations(vd_t *vd)
{
vd->operations = 0;
if (vio_ver_is_supported(vd->version, 1, 1)) {
ASSERT(vd->open_flags & FREAD);
vd->operations |= VD_OP_MASK_READ | (1 << VD_OP_GET_CAPACITY);
if (vd->open_flags & FWRITE)
vd->operations |= VD_OP_MASK_WRITE;
if (vd->scsi)
vd->operations |= VD_OP_MASK_SCSI;
if (VD_DSKIMG(vd) && vd_dskimg_is_iso_image(vd)) {
vd->operations &= ~VD_OP_MASK_WRITE;
}
} else if (vio_ver_is_supported(vd->version, 1, 0)) {
vd->operations = VD_OP_MASK_READ | VD_OP_MASK_WRITE;
}
ASSERT(vd->operations != 0);
}
static int
vd_process_attr_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
vd_attr_msg_t *attr_msg = (vd_attr_msg_t *)msg;
int status, retry = 0;
ASSERT(msglen >= sizeof (msg->tag));
if (!vd_msgtype(&msg->tag, VIO_TYPE_CTRL, VIO_SUBTYPE_INFO,
VIO_ATTR_INFO)) {
PR0("Message is not an attribute message");
return (ENOMSG);
}
if (msglen != sizeof (*attr_msg)) {
PR0("Expected %lu-byte attribute message; "
"received %lu bytes", sizeof (*attr_msg), msglen);
return (EBADMSG);
}
if (attr_msg->max_xfer_sz == 0) {
PR0("Received maximum transfer size of 0 from client");
return (EBADMSG);
}
if ((attr_msg->xfer_mode != VIO_DESC_MODE) &&
(attr_msg->xfer_mode != VIO_DRING_MODE_V1_0)) {
PR0("Client requested unsupported transfer mode");
return (EBADMSG);
}
if ((vd->initialized & VD_DISK_READY) == 0) {
PR0("Retry setting up disk (%s)", vd->device_path);
do {
status = vd_setup_vd(vd);
if (status != EAGAIN || ++retry > vds_dev_retries)
break;
delay(drv_usectohz(vds_dev_delay));
if (!vd_enabled(vd))
return (ENXIO);
} while (status == EAGAIN);
if (status)
return (ENXIO);
vd->initialized |= VD_DISK_READY;
ASSERT(vd->nslices > 0 && vd->nslices <= V_NUMPAR);
PR0("vdisk_type = %s, volume = %s, file = %s, nslices = %u",
((vd->vdisk_type == VD_DISK_TYPE_DISK) ? "disk" : "slice"),
(vd->volume ? "yes" : "no"),
(vd->file ? "yes" : "no"),
vd->nslices);
}
vd->xfer_mode = attr_msg->xfer_mode;
if (vd->xfer_mode == VIO_DESC_MODE) {
size_t max_xfer_bytes = attr_msg->vdisk_block_size ?
attr_msg->vdisk_block_size * attr_msg->max_xfer_sz :
attr_msg->max_xfer_sz;
size_t max_inband_msglen =
sizeof (vd_dring_inband_msg_t) +
((max_xfer_bytes/PAGESIZE +
((max_xfer_bytes % PAGESIZE) ? 1 : 0))*
(sizeof (ldc_mem_cookie_t)));
vd->max_msglen = MAX(vd->max_msglen, max_inband_msglen);
vd->inband_task.vd = vd;
vd->inband_task.msg = kmem_alloc(vd->max_msglen, KM_SLEEP);
vd->inband_task.index = 0;
vd->inband_task.type = VD_FINAL_RANGE_TASK;
}
attr_msg->vdisk_block_size = vd->vdisk_bsize;
attr_msg->max_xfer_sz = vd->max_xfer_sz;
attr_msg->vdisk_size = vd->vdisk_size;
attr_msg->vdisk_type = (vd_slice_single_slice)? vd->vdisk_type :
VD_DISK_TYPE_DISK;
attr_msg->vdisk_media = vd->vdisk_media;
vd_set_exported_operations(vd);
attr_msg->operations = vd->operations;
PR0("%s", VD_CLIENT(vd));
ASSERT(vd->dring_task == NULL);
return (0);
}
static int
vd_process_dring_reg_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
int status;
size_t expected;
ldc_mem_info_t dring_minfo;
uint8_t mtype;
vio_dring_reg_msg_t *reg_msg = (vio_dring_reg_msg_t *)msg;
ASSERT(msglen >= sizeof (msg->tag));
if (!vd_msgtype(&msg->tag, VIO_TYPE_CTRL, VIO_SUBTYPE_INFO,
VIO_DRING_REG)) {
PR0("Message is not a register-dring message");
return (ENOMSG);
}
if (msglen < sizeof (*reg_msg)) {
PR0("Expected at least %lu-byte register-dring message; "
"received %lu bytes", sizeof (*reg_msg), msglen);
return (EBADMSG);
}
expected = sizeof (*reg_msg) +
(reg_msg->ncookies - 1)*(sizeof (reg_msg->cookie[0]));
if (msglen != expected) {
PR0("Expected %lu-byte register-dring message; "
"received %lu bytes", expected, msglen);
return (EBADMSG);
}
if (vd->initialized & VD_DRING) {
PR0("A dring was previously registered; only support one");
return (EBADMSG);
}
if (reg_msg->num_descriptors > INT32_MAX) {
PR0("reg_msg->num_descriptors = %u; must be <= %u (%s)",
reg_msg->ncookies, INT32_MAX, STRINGIZE(INT32_MAX));
return (EBADMSG);
}
if (reg_msg->ncookies != 1) {
PR0("reg_msg->ncookies = %u != 1", reg_msg->ncookies);
return (EBADMSG);
}
if (vd_direct_mapped_drings)
mtype = LDC_DIRECT_MAP;
else
mtype = LDC_SHADOW_MAP;
status = ldc_mem_dring_map(vd->ldc_handle, reg_msg->cookie,
reg_msg->ncookies, reg_msg->num_descriptors,
reg_msg->descriptor_size, mtype, &vd->dring_handle);
if (status != 0) {
PR0("ldc_mem_dring_map() returned errno %d", status);
return (status);
}
ASSERT(reg_msg->ncookies == 1);
if ((status =
ldc_mem_dring_info(vd->dring_handle, &dring_minfo)) != 0) {
PR0("ldc_mem_dring_info() returned errno %d", status);
if ((status = ldc_mem_dring_unmap(vd->dring_handle)) != 0)
PR0("ldc_mem_dring_unmap() returned errno %d", status);
return (status);
}
if (dring_minfo.vaddr == NULL) {
PR0("Descriptor ring virtual address is NULL");
return (ENXIO);
}
vd->initialized |= VD_DRING;
vd->dring_ident = 1;
vd->dring = dring_minfo.vaddr;
vd->descriptor_size = reg_msg->descriptor_size;
vd->dring_len = reg_msg->num_descriptors;
vd->dring_mtype = dring_minfo.mtype;
reg_msg->dring_ident = vd->dring_ident;
PR1("descriptor size = %u, dring length = %u",
vd->descriptor_size, vd->dring_len);
vd->dring_task =
kmem_zalloc((sizeof (*vd->dring_task)) * vd->dring_len, KM_SLEEP);
for (int i = 0; i < vd->dring_len; i++) {
vd->dring_task[i].vd = vd;
vd->dring_task[i].index = i;
status = ldc_mem_alloc_handle(vd->ldc_handle,
&(vd->dring_task[i].mhdl));
if (status) {
PR0("ldc_mem_alloc_handle() returned err %d ", status);
return (ENXIO);
}
vd->dring_task[i].request = kmem_zalloc((vd->descriptor_size -
sizeof (vio_dring_entry_hdr_t)), KM_SLEEP);
vd->dring_task[i].msg = kmem_alloc(vd->max_msglen, KM_SLEEP);
}
if (vd->file || vd->zvol) {
vd->write_queue =
kmem_zalloc(sizeof (buf_t *) * vd->dring_len, KM_SLEEP);
}
return (0);
}
static int
vd_process_dring_unreg_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
vio_dring_unreg_msg_t *unreg_msg = (vio_dring_unreg_msg_t *)msg;
ASSERT(msglen >= sizeof (msg->tag));
if (!vd_msgtype(&msg->tag, VIO_TYPE_CTRL, VIO_SUBTYPE_INFO,
VIO_DRING_UNREG)) {
PR0("Message is not an unregister-dring message");
return (ENOMSG);
}
if (msglen != sizeof (*unreg_msg)) {
PR0("Expected %lu-byte unregister-dring message; "
"received %lu bytes", sizeof (*unreg_msg), msglen);
return (EBADMSG);
}
if (unreg_msg->dring_ident != vd->dring_ident) {
PR0("Expected dring ident %lu; received %lu",
vd->dring_ident, unreg_msg->dring_ident);
return (EBADMSG);
}
return (0);
}
static int
process_rdx_msg(vio_msg_t *msg, size_t msglen)
{
ASSERT(msglen >= sizeof (msg->tag));
if (!vd_msgtype(&msg->tag, VIO_TYPE_CTRL, VIO_SUBTYPE_INFO, VIO_RDX)) {
PR0("Message is not an RDX message");
return (ENOMSG);
}
if (msglen != sizeof (vio_rdx_msg_t)) {
PR0("Expected %lu-byte RDX message; received %lu bytes",
sizeof (vio_rdx_msg_t), msglen);
return (EBADMSG);
}
PR0("Valid RDX message");
return (0);
}
static int
vd_check_seq_num(vd_t *vd, uint64_t seq_num)
{
if ((vd->initialized & VD_SEQ_NUM) && (seq_num != vd->seq_num + 1)) {
PR0("Received seq_num %lu; expected %lu",
seq_num, (vd->seq_num + 1));
PR0("initiating soft reset");
vd_need_reset(vd, B_FALSE);
return (1);
}
vd->seq_num = seq_num;
vd->initialized |= VD_SEQ_NUM;
return (0);
}
static size_t
expected_inband_size(vd_dring_inband_msg_t *msg)
{
return ((sizeof (*msg)) +
(msg->payload.ncookies - 1)*(sizeof (msg->payload.cookie[0])));
}
static int
vd_process_desc_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
size_t expected;
vd_dring_inband_msg_t *desc_msg = (vd_dring_inband_msg_t *)msg;
ASSERT(msglen >= sizeof (msg->tag));
if (!vd_msgtype(&msg->tag, VIO_TYPE_DATA, VIO_SUBTYPE_INFO,
VIO_DESC_DATA)) {
PR1("Message is not an in-band-descriptor message");
return (ENOMSG);
}
if (msglen < sizeof (*desc_msg)) {
PR0("Expected at least %lu-byte descriptor message; "
"received %lu bytes", sizeof (*desc_msg), msglen);
return (EBADMSG);
}
if (msglen != (expected = expected_inband_size(desc_msg))) {
PR0("Expected %lu-byte descriptor message; "
"received %lu bytes", expected, msglen);
return (EBADMSG);
}
if (vd_check_seq_num(vd, desc_msg->hdr.seq_num) != 0)
return (EBADMSG);
PR1("Valid in-band-descriptor message");
msg->tag.vio_subtype = VIO_SUBTYPE_ACK;
ASSERT(vd->inband_task.msg != NULL);
bcopy(msg, vd->inband_task.msg, msglen);
vd->inband_task.msglen = msglen;
desc_msg = (vd_dring_inband_msg_t *)vd->inband_task.msg;
vd->inband_task.request = &desc_msg->payload;
return (vd_process_task(&vd->inband_task));
}
static int
vd_process_element(vd_t *vd, vd_task_type_t type, uint32_t idx,
vio_msg_t *msg, size_t msglen)
{
int status;
boolean_t ready;
on_trap_data_t otd;
vd_dring_entry_t *elem = VD_DRING_ELEM(idx);
if ((status = VIO_DRING_ACQUIRE(&otd, vd->dring_mtype,
vd->dring_handle, idx, idx)) != 0) {
return (status);
}
ready = (elem->hdr.dstate == VIO_DESC_READY);
if (ready) {
elem->hdr.dstate = VIO_DESC_ACCEPTED;
bcopy(&elem->payload, vd->dring_task[idx].request,
(vd->descriptor_size - sizeof (vio_dring_entry_hdr_t)));
} else {
PR0("descriptor %u not ready", idx);
VD_DUMP_DRING_ELEM(elem);
}
if ((status = VIO_DRING_RELEASE(vd->dring_mtype,
vd->dring_handle, idx, idx)) != 0) {
PR0("VIO_DRING_RELEASE() returned errno %d", status);
return (status);
}
if (!ready)
return (EBUSY);
PR1("Processing dring element %u", idx);
vd->dring_task[idx].type = type;
bcopy(msg, vd->dring_task[idx].msg, msglen);
vd->dring_task[idx].msglen = msglen;
return (vd_process_task(&vd->dring_task[idx]));
}
static int
vd_process_element_range(vd_t *vd, int start, int end,
vio_msg_t *msg, size_t msglen)
{
int i, n, nelem, status = 0;
boolean_t inprogress = B_FALSE;
vd_task_type_t type;
ASSERT(start >= 0);
ASSERT(end >= 0);
msg->tag.vio_subtype = VIO_SUBTYPE_ACK;
nelem = ((end < start) ? end + vd->dring_len : end) - start + 1;
for (i = start, n = nelem; n > 0; i = (i + 1) % vd->dring_len, n--) {
((vio_dring_msg_t *)msg)->end_idx = i;
type = (n == 1) ? VD_FINAL_RANGE_TASK : VD_NONFINAL_RANGE_TASK;
status = vd_process_element(vd, type, i, msg, msglen);
if (status == EINPROGRESS)
inprogress = B_TRUE;
else if (status != 0)
break;
}
if ((nelem > 1) && (status != EINPROGRESS) && inprogress) {
if (vd->ioq != NULL)
ddi_taskq_wait(vd->ioq);
ddi_taskq_wait(vd->completionq);
}
return (status);
}
static int
vd_process_dring_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
vio_dring_msg_t *dring_msg = (vio_dring_msg_t *)msg;
ASSERT(msglen >= sizeof (msg->tag));
if (!vd_msgtype(&msg->tag, VIO_TYPE_DATA, VIO_SUBTYPE_INFO,
VIO_DRING_DATA)) {
PR1("Message is not a dring-data message");
return (ENOMSG);
}
if (msglen != sizeof (*dring_msg)) {
PR0("Expected %lu-byte dring message; received %lu bytes",
sizeof (*dring_msg), msglen);
return (EBADMSG);
}
if (vd_check_seq_num(vd, dring_msg->seq_num) != 0)
return (EBADMSG);
if (dring_msg->dring_ident != vd->dring_ident) {
PR0("Expected dring ident %lu; received ident %lu",
vd->dring_ident, dring_msg->dring_ident);
return (EBADMSG);
}
if (dring_msg->start_idx >= vd->dring_len) {
PR0("\"start_idx\" = %u; must be less than %u",
dring_msg->start_idx, vd->dring_len);
return (EBADMSG);
}
if ((dring_msg->end_idx < 0) ||
(dring_msg->end_idx >= vd->dring_len)) {
PR0("\"end_idx\" = %u; must be >= 0 and less than %u",
dring_msg->end_idx, vd->dring_len);
return (EBADMSG);
}
PR1("Processing descriptor range, start = %u, end = %u",
dring_msg->start_idx, dring_msg->end_idx);
return (vd_process_element_range(vd, dring_msg->start_idx,
dring_msg->end_idx, msg, msglen));
}
static int
recv_msg(ldc_handle_t ldc_handle, void *msg, size_t *nbytes)
{
int retry, status;
size_t size = *nbytes;
for (retry = 0, status = ETIMEDOUT;
retry < vds_ldc_retries && status == ETIMEDOUT;
retry++) {
PR1("ldc_read() attempt %d", (retry + 1));
*nbytes = size;
status = ldc_read(ldc_handle, msg, nbytes);
}
if (status) {
PR0("ldc_read() returned errno %d", status);
if (status != ECONNRESET)
return (ENOMSG);
return (status);
} else if (*nbytes == 0) {
PR1("ldc_read() returned 0 and no message read");
return (ENOMSG);
}
PR1("RCVD %lu-byte message", *nbytes);
return (0);
}
static int
vd_do_process_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
int status;
PR1("Processing (%x/%x/%x) message", msg->tag.vio_msgtype,
msg->tag.vio_subtype, msg->tag.vio_subtype_env);
#ifdef DEBUG
vd_decode_tag(msg);
#endif
if ((msg->tag.vio_sid != vd->sid) && (vd->initialized & VD_SID)) {
PR0("Expected SID %u, received %u", vd->sid,
msg->tag.vio_sid);
return (EBADMSG);
}
PR1("\tWhile in state %d (%s)", vd->state, vd_decode_state(vd->state));
switch (vd->state) {
case VD_STATE_INIT:
if ((status = vd_process_ver_msg(vd, msg, msglen)) != 0)
return (status);
vd->state = VD_STATE_VER;
return (0);
case VD_STATE_VER:
if ((status = vd_process_attr_msg(vd, msg, msglen)) != 0)
return (status);
vd->state = VD_STATE_ATTR;
return (0);
case VD_STATE_ATTR:
switch (vd->xfer_mode) {
case VIO_DESC_MODE:
if ((status = process_rdx_msg(msg, msglen)) != 0)
return (status);
vd->state = VD_STATE_DATA;
return (0);
case VIO_DRING_MODE_V1_0:
if ((status =
vd_process_dring_reg_msg(vd, msg, msglen)) != 0)
return (status);
vd->state = VD_STATE_DRING;
return (0);
default:
ASSERT("Unsupported transfer mode");
PR0("Unsupported transfer mode");
return (ENOTSUP);
}
case VD_STATE_DRING:
if ((status = process_rdx_msg(msg, msglen)) == 0) {
vd->state = VD_STATE_DATA;
return (0);
} else if (status != ENOMSG) {
return (status);
}
if ((status =
vd_process_dring_reg_msg(vd, msg, msglen)) != ENOMSG)
return (status);
status = vd_process_dring_unreg_msg(vd, msg, msglen);
return ((status == 0) ? ENOTSUP : status);
case VD_STATE_DATA:
switch (vd->xfer_mode) {
case VIO_DESC_MODE:
return (vd_process_desc_msg(vd, msg, msglen));
case VIO_DRING_MODE_V1_0:
if ((status = vd_process_dring_msg(vd, msg,
msglen)) != ENOMSG)
return (status);
status = vd_process_dring_unreg_msg(vd, msg, msglen);
return ((status == 0) ? ENOTSUP : status);
default:
ASSERT("Unsupported transfer mode");
PR0("Unsupported transfer mode");
return (ENOTSUP);
}
default:
ASSERT("Invalid client connection state");
PR0("Invalid client connection state");
return (ENOTSUP);
}
}
static int
vd_process_msg(vd_t *vd, vio_msg_t *msg, size_t msglen)
{
int status;
boolean_t reset_ldc = B_FALSE;
vd_task_t task;
if (msglen < sizeof (vio_msg_tag_t)) {
PR0("Received short (%lu-byte) message", msglen);
PR0("initiating full reset");
vd_need_reset(vd, B_TRUE);
return (EBADMSG);
}
switch (status = vd_do_process_msg(vd, msg, msglen)) {
case 0:
msg->tag.vio_subtype = VIO_SUBTYPE_ACK;
break;
case EINPROGRESS:
return (EINPROGRESS);
case ENOMSG:
PR0("Received unexpected message");
_NOTE(FALLTHROUGH);
case EBADMSG:
case ENOTSUP:
msg->tag.vio_subtype = VIO_SUBTYPE_NACK;
break;
default:
msg->tag.vio_subtype = VIO_SUBTYPE_NACK;
reset_ldc = B_TRUE;
break;
}
PR1("\tResulting in state %d (%s)", vd->state,
vd_decode_state(vd->state));
task.vd = vd;
task.msg = msg;
task.msglen = msglen;
(void) ddi_taskq_dispatch(vd->completionq, vd_serial_notify,
&task, DDI_SLEEP);
ddi_taskq_wait(vd->completionq);
if ((status != 0) || reset_ldc) {
PR0("initiating %s reset",
(reset_ldc) ? "full" : "soft");
vd_need_reset(vd, reset_ldc);
}
return (status);
}
static boolean_t
vd_enabled(vd_t *vd)
{
boolean_t enabled;
mutex_enter(&vd->lock);
enabled = vd->enabled;
mutex_exit(&vd->lock);
return (enabled);
}
static void
vd_recv_msg(void *arg)
{
vd_t *vd = (vd_t *)arg;
int rv = 0, status = 0;
ASSERT(vd != NULL);
PR2("New task to receive incoming message(s)");
while (vd_enabled(vd) && status == 0) {
size_t msglen, msgsize;
ldc_status_t lstatus;
vd_reset_if_needed(vd);
status = ldc_status(vd->ldc_handle, &lstatus);
if (lstatus != LDC_UP) {
PR0("channel not up (status=%d), exiting recv loop\n",
lstatus);
break;
}
ASSERT(vd->max_msglen != 0);
msgsize = vd->max_msglen;
msglen = msgsize;
status = recv_msg(vd->ldc_handle, vd->vio_msgp, &msglen);
switch (status) {
case 0:
rv = vd_process_msg(vd, (void *)vd->vio_msgp, msglen);
if (msgsize != vd->max_msglen) {
PR0("max_msglen changed 0x%lx to 0x%lx bytes\n",
msgsize, vd->max_msglen);
kmem_free(vd->vio_msgp, msgsize);
vd->vio_msgp =
kmem_alloc(vd->max_msglen, KM_SLEEP);
}
if (rv == EINPROGRESS)
continue;
break;
case ENOMSG:
break;
case ECONNRESET:
PR0("initiating soft reset (ECONNRESET)\n");
vd_need_reset(vd, B_FALSE);
status = 0;
break;
default:
PR0("initiating full reset (status=0x%x)", status);
vd_need_reset(vd, B_TRUE);
break;
}
}
PR2("Task finished");
}
static uint_t
vd_handle_ldc_events(uint64_t event, caddr_t arg)
{
vd_t *vd = (vd_t *)(void *)arg;
int status;
ASSERT(vd != NULL);
if (!vd_enabled(vd))
return (LDC_SUCCESS);
if (event & LDC_EVT_DOWN) {
PR0("LDC_EVT_DOWN: LDC channel went down");
vd_need_reset(vd, B_TRUE);
status = ddi_taskq_dispatch(vd->startq, vd_recv_msg, vd,
DDI_SLEEP);
if (status == DDI_FAILURE) {
PR0("cannot schedule task to recv msg\n");
vd_need_reset(vd, B_TRUE);
}
}
if (event & LDC_EVT_RESET) {
PR0("LDC_EVT_RESET: LDC channel was reset");
if (vd->state != VD_STATE_INIT) {
PR0("scheduling full reset");
vd_need_reset(vd, B_FALSE);
status = ddi_taskq_dispatch(vd->startq, vd_recv_msg,
vd, DDI_SLEEP);
if (status == DDI_FAILURE) {
PR0("cannot schedule task to recv msg\n");
vd_need_reset(vd, B_TRUE);
}
} else {
PR0("channel already reset, ignoring...\n");
PR0("doing ldc up...\n");
(void) ldc_up(vd->ldc_handle);
}
return (LDC_SUCCESS);
}
if (event & LDC_EVT_UP) {
PR0("EVT_UP: LDC is up\nResetting client connection state");
PR0("initiating soft reset");
vd_need_reset(vd, B_FALSE);
status = ddi_taskq_dispatch(vd->startq, vd_recv_msg,
vd, DDI_SLEEP);
if (status == DDI_FAILURE) {
PR0("cannot schedule task to recv msg\n");
vd_need_reset(vd, B_TRUE);
return (LDC_SUCCESS);
}
}
if (event & LDC_EVT_READ) {
int status;
PR1("New data available");
status = ddi_taskq_dispatch(vd->startq, vd_recv_msg, vd,
DDI_SLEEP);
if (status == DDI_FAILURE) {
PR0("cannot schedule task to recv msg\n");
vd_need_reset(vd, B_TRUE);
}
}
return (LDC_SUCCESS);
}
static uint_t
vds_check_for_vd(mod_hash_key_t key, mod_hash_val_t *val, void *arg)
{
_NOTE(ARGUNUSED(key, val))
(*((uint_t *)arg))++;
return (MH_WALK_TERMINATE);
}
static int
vds_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
uint_t vd_present = 0;
minor_t instance;
vds_t *vds;
switch (cmd) {
case DDI_DETACH:
break;
case DDI_SUSPEND:
PR0("No action required for DDI_SUSPEND");
return (DDI_SUCCESS);
default:
PR0("Unrecognized \"cmd\"");
return (DDI_FAILURE);
}
ASSERT(cmd == DDI_DETACH);
instance = ddi_get_instance(dip);
if ((vds = ddi_get_soft_state(vds_state, instance)) == NULL) {
PR0("Could not get state for instance %u", instance);
ddi_soft_state_free(vds_state, instance);
return (DDI_FAILURE);
}
mod_hash_walk(vds->vd_table, vds_check_for_vd, &vd_present);
if (vd_present) {
PR0("Not detaching because serving vdisks");
return (DDI_FAILURE);
}
PR0("Detaching");
if (vds->initialized & VDS_MDEG) {
(void) mdeg_unregister(vds->mdeg);
kmem_free(vds->ispecp->specp, sizeof (vds_prop_template));
kmem_free(vds->ispecp, sizeof (mdeg_node_spec_t));
vds->ispecp = NULL;
vds->mdeg = 0;
}
vds_driver_types_free(vds);
if (vds->initialized & VDS_LDI)
(void) ldi_ident_release(vds->ldi_ident);
mod_hash_destroy_hash(vds->vd_table);
ddi_soft_state_free(vds_state, instance);
return (DDI_SUCCESS);
}
static boolean_t
vd_dskimg_is_iso_image(vd_t *vd)
{
char iso_buf[ISO_SECTOR_SIZE];
int i, rv;
uint_t sec;
ASSERT(VD_DSKIMG(vd));
if (vd->vdisk_media == VD_MEDIA_DVD || vd->vdisk_media == VD_MEDIA_CD)
return (B_TRUE);
sec = (ISO_VOLDESC_SEC * ISO_SECTOR_SIZE) / vd->vdisk_bsize;
rv = vd_dskimg_rw(vd, VD_SLICE_NONE, VD_OP_BREAD, (caddr_t)iso_buf,
sec, ISO_SECTOR_SIZE);
if (rv < 0)
return (B_FALSE);
for (i = 0; i < ISO_ID_STRLEN; i++) {
if (ISO_STD_ID(iso_buf)[i] != ISO_ID_STRING[i])
return (B_FALSE);
}
return (B_TRUE);
}
static boolean_t
vd_is_atapi_device(vd_t *vd)
{
boolean_t is_atapi = B_FALSE;
char *variantp;
int rv;
ASSERT(vd->ldi_handle[0] != NULL);
ASSERT(!vd->file);
rv = ldi_prop_lookup_string(vd->ldi_handle[0],
(LDI_DEV_T_ANY | DDI_PROP_DONTPASS), "variant", &variantp);
if (rv == DDI_PROP_SUCCESS) {
PR0("'variant' property exists for %s", vd->device_path);
if (strcmp(variantp, "atapi") == 0)
is_atapi = B_TRUE;
ddi_prop_free(variantp);
}
rv = ldi_prop_exists(vd->ldi_handle[0], LDI_DEV_T_ANY, "atapi");
if (rv) {
PR0("'atapi' property exists for %s", vd->device_path);
is_atapi = B_TRUE;
}
return (is_atapi);
}
static int
vd_setup_full_disk(vd_t *vd)
{
int status;
major_t major = getmajor(vd->dev[0]);
minor_t minor = getminor(vd->dev[0]) - VD_ENTIRE_DISK_SLICE;
ASSERT(vd->vdisk_type == VD_DISK_TYPE_DISK);
status = vd_backend_check_size(vd);
if (status != 0) {
if (!vd->scsi) {
PRN("Check size failed for %s (errno %d)",
vd->device_path, status);
return (EIO);
}
vd->vdisk_size = VD_SIZE_UNKNOWN;
vd->vdisk_bsize = 0;
vd->backend_bsize = 0;
vd->vdisk_media = VD_MEDIA_FIXED;
}
vd->dev[VD_ENTIRE_DISK_SLICE] = vd->dev[0];
vd->dev[0] = 0;
vd->ldi_handle[VD_ENTIRE_DISK_SLICE] = vd->ldi_handle[0];
vd->ldi_handle[0] = NULL;
for (int slice = 0; slice < vd->nslices; slice++) {
if (slice == VD_ENTIRE_DISK_SLICE)
continue;
ASSERT(vd->dev[slice] == 0);
ASSERT(vd->ldi_handle[slice] == NULL);
vd->dev[slice] = makedevice(major, (minor + slice));
PR0("Opening device major %u, minor %u = slice %u",
major, minor, slice);
status = ldi_open_by_dev(&vd->dev[slice], OTYP_BLK,
vd->open_flags, kcred, &vd->ldi_handle[slice],
vd->vds->ldi_ident);
if (status != 0) {
status = ldi_open_by_dev(&vd->dev[slice], OTYP_BLK,
vd->open_flags | FNDELAY, kcred,
&vd->ldi_handle[slice], vd->vds->ldi_ident);
}
if (status != 0) {
PRN("ldi_open_by_dev() returned errno %d "
"for slice %u", status, slice);
vd->ldi_handle[slice] = NULL;
return (status);
}
}
return (0);
}
static int
vd_setup_partition_vtoc(vd_t *vd)
{
char *device_path = vd->device_path;
char unit;
size_t size, csize;
if (vd->dk_geom.dkg_nsect == 0) {
PRN("%s geometry claims 0 sectors per track", device_path);
return (EIO);
}
if (vd->dk_geom.dkg_nhead == 0) {
PRN("%s geometry claims 0 heads", device_path);
return (EIO);
}
csize = vd->dk_geom.dkg_nhead * vd->dk_geom.dkg_nsect;
vd->dk_geom.dkg_ncyl = vd->vdisk_size / csize + 1;
vd->dk_geom.dkg_acyl = 2;
vd->dk_geom.dkg_pcyl = vd->dk_geom.dkg_ncyl + vd->dk_geom.dkg_acyl;
bzero(vd->vtoc.v_part, sizeof (vd->vtoc.v_part));
vd->vtoc.v_part[0].p_tag = V_UNASSIGNED;
vd->vtoc.v_part[0].p_flag = 0;
vd->vtoc.v_part[0].p_start = csize;
vd->vtoc.v_part[0].p_size = (vd->vdisk_size / csize) * csize;
if (vd_slice_single_slice) {
vd->vtoc.v_nparts = 1;
bcopy(VD_ASCIILABEL, vd->vtoc.v_asciilabel,
MIN(sizeof (VD_ASCIILABEL),
sizeof (vd->vtoc.v_asciilabel)));
bcopy(VD_VOLUME_NAME, vd->vtoc.v_volume,
MIN(sizeof (VD_VOLUME_NAME), sizeof (vd->vtoc.v_volume)));
} else {
vd->nslices = V_NUMPAR;
vd->vtoc.v_nparts = V_NUMPAR;
vd->vtoc.v_part[VD_ENTIRE_DISK_SLICE].p_tag = V_BACKUP;
vd->vtoc.v_part[VD_ENTIRE_DISK_SLICE].p_flag = 0;
vd->vtoc.v_part[VD_ENTIRE_DISK_SLICE].p_start = 0;
vd->vtoc.v_part[VD_ENTIRE_DISK_SLICE].p_size =
vd->dk_geom.dkg_ncyl * csize;
vd_get_readable_size(vd->vdisk_size * vd->vdisk_bsize,
&size, &unit);
vd->dk_geom.dkg_bcyl = 0;
vd->dk_geom.dkg_intrlv = 1;
vd->dk_geom.dkg_write_reinstruct = 0;
vd->dk_geom.dkg_read_reinstruct = 0;
(void) snprintf(vd->vtoc.v_asciilabel, LEN_DKL_ASCII,
"SUN-DiskSlice-%ld%cB cyl %d alt %d hd %d sec %d",
size, unit,
vd->dk_geom.dkg_ncyl, vd->dk_geom.dkg_acyl,
vd->dk_geom.dkg_nhead, vd->dk_geom.dkg_nsect);
bzero(vd->vtoc.v_volume, sizeof (vd->vtoc.v_volume));
vd->flabel_limit = (uint_t)csize;
vd->flabel_size = VD_LABEL_VTOC_SIZE(vd->vdisk_bsize);
vd->flabel = kmem_zalloc(vd->flabel_size, KM_SLEEP);
vd_vtocgeom_to_label(&vd->vtoc, &vd->dk_geom,
VD_LABEL_VTOC(vd));
}
vd->vdisk_size += csize * 3;
return (0);
}
static int
vd_setup_partition_efi(vd_t *vd)
{
efi_gpt_t *gpt;
efi_gpe_t *gpe;
struct uuid uuid = EFI_USR;
struct uuid efi_reserved = EFI_RESERVED;
uint32_t crc;
uint64_t s0_start, s0_end, first_u_lba;
size_t bsize;
ASSERT(vd->vdisk_bsize > 0);
bsize = vd->vdisk_bsize;
first_u_lba = (EFI_MIN_ARRAY_SIZE / bsize) + 2;
vd->flabel_limit = (uint_t)first_u_lba;
vd->flabel_size = VD_LABEL_EFI_SIZE(bsize);
vd->flabel = kmem_zalloc(vd->flabel_size, KM_SLEEP);
gpt = VD_LABEL_EFI_GPT(vd, bsize);
gpe = VD_LABEL_EFI_GPE(vd, bsize);
vd->vdisk_size += first_u_lba;
s0_start = first_u_lba;
s0_end = vd->vdisk_size - 1;
gpt->efi_gpt_Signature = LE_64(EFI_SIGNATURE);
gpt->efi_gpt_Revision = LE_32(EFI_VERSION_CURRENT);
gpt->efi_gpt_HeaderSize = LE_32(EFI_HEADER_SIZE);
gpt->efi_gpt_FirstUsableLBA = LE_64(first_u_lba);
gpt->efi_gpt_PartitionEntryLBA = LE_64(2ULL);
gpt->efi_gpt_SizeOfPartitionEntry = LE_32(sizeof (efi_gpe_t));
UUID_LE_CONVERT(gpe[0].efi_gpe_PartitionTypeGUID, uuid);
gpe[0].efi_gpe_StartingLBA = LE_64(s0_start);
gpe[0].efi_gpe_EndingLBA = LE_64(s0_end);
if (vd_slice_single_slice) {
gpt->efi_gpt_NumberOfPartitionEntries = LE_32(1);
} else {
gpt->efi_gpt_NumberOfPartitionEntries = LE_32(VD_MAXPART);
vd->nslices = V_NUMPAR;
UUID_LE_CONVERT(gpe[VD_MAXPART - 1].efi_gpe_PartitionTypeGUID,
efi_reserved);
gpe[VD_MAXPART - 1].efi_gpe_StartingLBA =
LE_64(s0_end + 1);
gpe[VD_MAXPART - 1].efi_gpe_EndingLBA =
LE_64(s0_end + EFI_MIN_RESV_SIZE);
vd->vdisk_size += EFI_MIN_RESV_SIZE;
}
gpt->efi_gpt_LastUsableLBA = LE_64(vd->vdisk_size - 1);
vd->vdisk_size += (EFI_MIN_ARRAY_SIZE / bsize) + 1;
gpt->efi_gpt_AlternateLBA = LE_64(vd->vdisk_size - 1);
CRC32(crc, gpe, sizeof (efi_gpe_t) * VD_MAXPART, -1U, crc32_table);
gpt->efi_gpt_PartitionEntryArrayCRC32 = LE_32(~crc);
CRC32(crc, gpt, EFI_HEADER_SIZE, -1U, crc32_table);
gpt->efi_gpt_HeaderCRC32 = LE_32(~crc);
return (0);
}
static int
vd_setup_backend_vnode(vd_t *vd)
{
int rval, status;
dev_t dev;
char *file_path = vd->device_path;
ldi_handle_t lhandle;
struct dk_cinfo dk_cinfo;
ASSERT(!vd->volume);
if ((status = vn_open(file_path, UIO_SYSSPACE, vd->open_flags | FOFFMAX,
0, &vd->file_vnode, 0, 0)) != 0) {
if ((status == ENXIO || status == ENODEV || status == ENOENT ||
status == EROFS) && (!(vd->initialized & VD_SETUP_ERROR) &&
!(DEVI_IS_ATTACHING(vd->vds->dip)))) {
PRN("vn_open(%s) = errno %d", file_path, status);
}
return (status);
}
vd->file = B_TRUE;
vd->max_xfer_sz = maxphys / DEV_BSIZE;
dev = vd->file_vnode->v_vfsp->vfs_dev;
PR0("underlying device of %s = (%d, %d)\n", file_path,
getmajor(dev), getminor(dev));
status = ldi_open_by_dev(&dev, OTYP_BLK, FREAD, kcred, &lhandle,
vd->vds->ldi_ident);
if (status != 0) {
PR0("ldi_open() returned errno %d for underlying device",
status);
} else {
if ((status = ldi_ioctl(lhandle, DKIOCINFO,
(intptr_t)&dk_cinfo, (vd->open_flags | FKIOCTL), kcred,
&rval)) != 0) {
PR0("ldi_ioctl(DKIOCINFO) returned errno %d for "
"underlying device", status);
} else {
vd->max_xfer_sz = dk_cinfo.dki_maxtransfer;
}
PR0("close the underlying device");
(void) ldi_close(lhandle, FREAD, kcred);
}
PR0("using file %s on device (%d, %d), max_xfer = %u blks",
file_path, getmajor(dev), getminor(dev), vd->max_xfer_sz);
if (vd->vdisk_type == VD_DISK_TYPE_SLICE)
status = vd_setup_slice_image(vd);
else
status = vd_setup_disk_image(vd);
return (status);
}
static int
vd_setup_slice_image(vd_t *vd)
{
struct dk_label label;
int status;
if ((status = vd_backend_check_size(vd)) != 0) {
PRN("Check size failed for %s (errno %d)",
vd->device_path, status);
return (EIO);
}
vd->vdisk_media = VD_MEDIA_FIXED;
vd->vdisk_label = (vd_slice_label == VD_DISK_LABEL_UNK)?
vd_file_slice_label : vd_slice_label;
if (vd->vdisk_label == VD_DISK_LABEL_EFI ||
vd->dskimg_size >= 2 * ONE_TERABYTE) {
status = vd_setup_partition_efi(vd);
} else {
vd_build_default_label(vd->dskimg_size, vd->vdisk_bsize,
&label);
vd_label_to_vtocgeom(&label, &vd->vtoc, &vd->dk_geom);
status = vd_setup_partition_vtoc(vd);
}
return (status);
}
static int
vd_setup_disk_image(vd_t *vd)
{
int status;
char *backend_path = vd->device_path;
if ((status = vd_backend_check_size(vd)) != 0) {
PRN("Check size failed for %s (errno %d)",
backend_path, status);
return (EIO);
}
if (vd->dskimg_size < sizeof (struct dk_label)) {
PRN("Size of file has to be at least %ld bytes",
sizeof (struct dk_label));
return (EIO);
}
status = vd_dskimg_validate_geometry(vd);
if (status != 0 && status != EINVAL && status != ENOTSUP) {
PRN("Failed to read label from %s", backend_path);
return (EIO);
}
if (vd_dskimg_is_iso_image(vd)) {
if ((vd->vdisk_size * vd->vdisk_bsize) > ONE_GIGABYTE)
vd->vdisk_media = VD_MEDIA_DVD;
else
vd->vdisk_media = VD_MEDIA_CD;
} else {
vd->vdisk_media = VD_MEDIA_FIXED;
}
if (vd->vdisk_label != VD_DISK_LABEL_UNK) {
status = vd_dskimg_read_devid(vd, &vd->dskimg_devid);
if (status == 0) {
return (0);
}
if (status != EINVAL) {
PR0("can not read devid for %s", backend_path);
vd->dskimg_devid = NULL;
return (0);
}
}
PR1("creating devid for %s", backend_path);
if (ddi_devid_init(vd->vds->dip, DEVID_FAB, 0, 0,
&vd->dskimg_devid) != DDI_SUCCESS) {
PR0("fail to create devid for %s", backend_path);
vd->dskimg_devid = NULL;
return (0);
}
if (vd->vdisk_label != VD_DISK_LABEL_UNK) {
if (vd_dskimg_write_devid(vd, vd->dskimg_devid) != 0) {
PR0("fail to write devid for %s", backend_path);
ddi_devid_free(vd->dskimg_devid);
vd->dskimg_devid = NULL;
}
}
return (0);
}
static int
vd_open_using_ldi_by_name(vd_t *vd, int flags)
{
int status;
char *device_path = vd->device_path;
status = ldi_open_by_name(device_path, flags, kcred,
&vd->ldi_handle[0], vd->vds->ldi_ident);
if (status != 0)
status = ldi_open_by_name(device_path, flags | FNDELAY,
kcred, &vd->ldi_handle[0], vd->vds->ldi_ident);
if (status != 0) {
PR0("ldi_open_by_name(%s) = errno %d", device_path, status);
vd->ldi_handle[0] = NULL;
return (status);
}
return (0);
}
static int
vd_setup_backend_ldi(vd_t *vd)
{
int rval, status;
struct dk_cinfo dk_cinfo;
char *device_path = vd->device_path;
ASSERT(vd->ldi_handle[0] != NULL);
ASSERT(vd->dev[0] != NULL);
vd->file = B_FALSE;
if ((status = ldi_ioctl(vd->ldi_handle[0], DKIOCINFO,
(intptr_t)&dk_cinfo, (vd->open_flags | FKIOCTL), kcred,
&rval)) != 0) {
PRN("ldi_ioctl(DKIOCINFO) returned errno %d for %s",
status, device_path);
return (status);
}
if (dk_cinfo.dki_partition >= V_NUMPAR) {
PRN("slice %u >= maximum slice %u for %s",
dk_cinfo.dki_partition, V_NUMPAR, device_path);
return (EIO);
}
if (dk_cinfo.dki_ctype == DKC_CDROM) {
vd->open_flags &= ~FWRITE;
} else if (vd->open_flags & FWRITE) {
(void) ldi_close(vd->ldi_handle[0], vd->open_flags & ~FWRITE,
kcred);
status = vd_open_using_ldi_by_name(vd, vd->open_flags);
if (status != 0) {
PR0("Failed to open (%s) = errno %d",
device_path, status);
return (status);
}
}
vd->max_xfer_sz = dk_cinfo.dki_maxtransfer;
vd->is_atapi_dev = vd_is_atapi_device(vd);
if (vd->vdisk_type == VD_DISK_TYPE_DISK) {
if (vd->volume) {
return (vd_setup_disk_image(vd));
}
if (dk_cinfo.dki_partition == VD_ENTIRE_DISK_SLICE ||
dk_cinfo.dki_ctype == DKC_CDROM) {
ASSERT(!vd->volume);
if (dk_cinfo.dki_ctype == DKC_SCSI_CCS)
vd->scsi = B_TRUE;
return (vd_setup_full_disk(vd));
}
}
return (vd_setup_single_slice_disk(vd));
}
static int
vd_setup_single_slice_disk(vd_t *vd)
{
int status, rval;
struct dk_label label;
char *device_path = vd->device_path;
struct vtoc vtoc;
vd->vdisk_media = VD_MEDIA_FIXED;
if (vd->volume) {
ASSERT(vd->vdisk_type == VD_DISK_TYPE_SLICE);
}
vd->vdisk_type = VD_DISK_TYPE_SLICE;
vd->nslices = 1;
if ((status = vd_backend_check_size(vd)) != 0) {
PRN("Check size failed for %s (errno %d)", device_path, status);
return (EIO);
}
if (vd_slice_label == VD_DISK_LABEL_EFI ||
vd->vdisk_size >= ONE_TERABYTE / vd->vdisk_bsize) {
vd->vdisk_label = VD_DISK_LABEL_EFI;
} else {
status = ldi_ioctl(vd->ldi_handle[0], DKIOCGEXTVTOC,
(intptr_t)&vd->vtoc, (vd->open_flags | FKIOCTL),
kcred, &rval);
if (status == ENOTTY) {
status = ldi_ioctl(vd->ldi_handle[0], DKIOCGVTOC,
(intptr_t)&vtoc, (vd->open_flags | FKIOCTL),
kcred, &rval);
vtoctoextvtoc(vtoc, vd->vtoc);
}
if (status == 0) {
status = ldi_ioctl(vd->ldi_handle[0], DKIOCGGEOM,
(intptr_t)&vd->dk_geom, (vd->open_flags | FKIOCTL),
kcred, &rval);
if (status != 0) {
PRN("ldi_ioctl(DKIOCGEOM) returned errno %d "
"for %s", status, device_path);
return (status);
}
vd->vdisk_label = VD_DISK_LABEL_VTOC;
} else if (vd_slice_label == VD_DISK_LABEL_VTOC) {
vd->vdisk_label = VD_DISK_LABEL_VTOC;
vd_build_default_label(vd->vdisk_size * vd->vdisk_bsize,
vd->vdisk_bsize, &label);
vd_label_to_vtocgeom(&label, &vd->vtoc, &vd->dk_geom);
} else {
vd->vdisk_label = VD_DISK_LABEL_EFI;
}
}
if (vd->vdisk_label == VD_DISK_LABEL_VTOC) {
status = vd_setup_partition_vtoc(vd);
} else {
status = vd_setup_partition_efi(vd);
}
return (status);
}
static int
vd_backend_check_size(vd_t *vd)
{
size_t backend_size, backend_bsize, vdisk_bsize;
size_t old_size, new_size;
struct dk_minfo minfo;
vattr_t vattr;
int rval, rv, media, nshift = 0;
uint32_t n;
if (vd->file) {
vattr.va_mask = AT_SIZE;
rv = VOP_GETATTR(vd->file_vnode, &vattr, 0, kcred, NULL);
if (rv != 0) {
PR0("VOP_GETATTR(%s) = errno %d", vd->device_path, rv);
return (rv);
}
backend_size = vattr.va_size;
backend_bsize = DEV_BSIZE;
vdisk_bsize = DEV_BSIZE;
} else if (vd->volume) {
rv = ldi_get_size(vd->ldi_handle[0], &backend_size);
if (rv != DDI_SUCCESS) {
PR0("ldi_get_size() failed for %s", vd->device_path);
return (EIO);
}
backend_bsize = DEV_BSIZE;
vdisk_bsize = DEV_BSIZE;
} else {
rv = ldi_ioctl(vd->ldi_handle[0], DKIOCGMEDIAINFO,
(intptr_t)&minfo, (vd->open_flags | FKIOCTL),
kcred, &rval);
if (rv != 0) {
PR0("DKIOCGMEDIAINFO failed for %s (err=%d)",
vd->device_path, rv);
return (rv);
}
if (vd->vdisk_type == VD_DISK_TYPE_SLICE) {
rv = ldi_get_size(vd->ldi_handle[0], &backend_size);
if (rv != DDI_SUCCESS) {
PR0("ldi_get_size() failed for %s",
vd->device_path);
return (EIO);
}
} else {
ASSERT(vd->vdisk_type == VD_DISK_TYPE_DISK);
backend_size = minfo.dki_capacity * minfo.dki_lbsize;
}
backend_bsize = minfo.dki_lbsize;
media = DK_MEDIATYPE2VD_MEDIATYPE(minfo.dki_media_type);
if (media == VD_MEDIA_CD || media == VD_MEDIA_DVD)
vdisk_bsize = DEV_BSIZE;
else
vdisk_bsize = backend_bsize;
}
if (vdisk_bsize == 0 || vdisk_bsize % DEV_BSIZE != 0)
return (EINVAL);
old_size = vd->vdisk_size;
new_size = backend_size / vdisk_bsize;
if (old_size != VD_SIZE_UNKNOWN && old_size == new_size &&
vd->vdisk_bsize == vdisk_bsize)
return (0);
for (n = vdisk_bsize / DEV_BSIZE; n > 1; n >>= 1) {
if ((n & 0x1) != 0) {
return (EINVAL);
}
nshift++;
}
vd->vio_bshift = nshift;
vd->vdisk_size = new_size;
vd->vdisk_bsize = vdisk_bsize;
vd->backend_bsize = backend_bsize;
if (vd->file || vd->volume)
vd->dskimg_size = backend_size;
if (vd->vdisk_type == VD_DISK_TYPE_SLICE) {
if (vd->vdisk_label == VD_DISK_LABEL_VTOC) {
rv = vd_setup_partition_vtoc(vd);
if (rv != 0) {
PR0("vd_setup_partition_vtoc() failed for %s "
"(err = %d)", vd->device_path, rv);
return (rv);
}
} else {
rv = vd_setup_partition_efi(vd);
if (rv != 0) {
PR0("vd_setup_partition_efi() failed for %s "
"(err = %d)", vd->device_path, rv);
return (rv);
}
}
} else if (!vd->file && !vd->volume) {
ASSERT(vd->vdisk_type == VD_DISK_TYPE_DISK);
vd->vdisk_media = media;
}
return (0);
}
static int
vd_identify_dev(vd_t *vd, int *dtype)
{
int status, i;
char *device_path = vd->device_path;
char *drv_name;
int drv_type;
vds_t *vds = vd->vds;
status = vd_open_using_ldi_by_name(vd, vd->open_flags & ~FWRITE);
if (status != 0) {
PR0("Failed to open (%s) = errno %d", device_path, status);
return (status);
}
if ((status = ldi_get_dev(vd->ldi_handle[0], &vd->dev[0])) != 0) {
PRN("ldi_get_dev() returned errno %d for %s",
status, device_path);
return (status);
}
drv_name = ddi_major_to_name(getmajor(vd->dev[0]));
drv_type = VD_DRIVER_UNKNOWN;
for (i = 0; i < vds->num_drivers; i++) {
if (vds->driver_types[i].type == VD_DRIVER_UNKNOWN) {
continue;
}
if (strcmp(drv_name, vds->driver_types[i].name) == 0) {
drv_type = vds->driver_types[i].type;
goto done;
}
}
for (i = 0; i < VDS_NUM_DRIVERS; i++) {
if (strcmp(drv_name, vds_driver_types[i].name) == 0) {
drv_type = vds_driver_types[i].type;
goto done;
}
}
done:
PR0("driver %s identified as %s", drv_name,
(drv_type == VD_DRIVER_DISK)? "DISK" :
(drv_type == VD_DRIVER_VOLUME)? "VOLUME" : "UNKNOWN");
if (strcmp(drv_name, "zfs") == 0)
vd->zvol = B_TRUE;
*dtype = drv_type;
return (0);
}
static int
vd_setup_vd(vd_t *vd)
{
int status, drv_type, pseudo;
dev_info_t *dip;
vnode_t *vnp;
char *path = vd->device_path;
char tq_name[TASKQ_NAMELEN];
if ((status = lookupname(path, UIO_SYSSPACE,
FOLLOW, NULLVPP, &vnp)) != 0) {
PR0("Cannot lookup %s errno %d", path, status);
goto done;
}
switch (vnp->v_type) {
case VREG:
VN_RELE(vnp);
vd->volume = B_FALSE;
status = vd_setup_backend_vnode(vd);
break;
case VBLK:
case VCHR:
if ((dip = ddi_hold_devi_by_instance(getmajor(vnp->v_rdev),
dev_to_instance(vnp->v_rdev), 0)) == NULL) {
PRN("%s is no longer accessible", path);
VN_RELE(vnp);
status = EIO;
break;
}
pseudo = is_pseudo_device(dip);
ddi_release_devi(dip);
VN_RELE(vnp);
if ((status = vd_identify_dev(vd, &drv_type)) != 0) {
if (status != ENODEV && status != ENXIO &&
status != ENOENT && status != EROFS) {
PRN("%s identification failed with status %d",
path, status);
status = EIO;
}
break;
}
if (drv_type == VD_DRIVER_VOLUME ||
(drv_type == VD_DRIVER_UNKNOWN && pseudo)) {
vd->volume = B_TRUE;
}
if (vd->volume && vd_volume_force_slice) {
vd->vdisk_type = VD_DISK_TYPE_SLICE;
vd->nslices = 1;
}
status = vd_setup_backend_ldi(vd);
break;
default:
PRN("Unsupported vdisk backend %s", path);
VN_RELE(vnp);
status = EBADF;
}
done:
if (status != 0) {
if (status == ENXIO || status == ENODEV ||
status == ENOENT || status == EROFS) {
if (!(vd->initialized & VD_SETUP_ERROR) &&
!(DEVI_IS_ATTACHING(vd->vds->dip))) {
PRN("%s is currently inaccessible (error %d)",
path, status);
}
status = EAGAIN;
} else {
PRN("%s can not be exported as a virtual disk "
"(error %d)", path, status);
}
vd->initialized |= VD_SETUP_ERROR;
} else if (vd->initialized & VD_SETUP_ERROR) {
PRN("%s is now online", path);
vd->initialized &= ~VD_SETUP_ERROR;
}
if ((vd->file || vd->zvol) && vd->ioq == NULL) {
(void) snprintf(tq_name, sizeof (tq_name), "vd_ioq%lu", vd->id);
if ((vd->ioq = ddi_taskq_create(vd->vds->dip, tq_name,
vd_ioq_nthreads, TASKQ_DEFAULTPRI, 0)) == NULL) {
PRN("Could not create io task queue");
return (EIO);
}
}
return (status);
}
static int
vds_do_init_vd(vds_t *vds, uint64_t id, char *device_path, uint64_t options,
uint64_t ldc_id, vd_t **vdp)
{
char tq_name[TASKQ_NAMELEN];
int status;
ddi_iblock_cookie_t iblock = NULL;
ldc_attr_t ldc_attr;
vd_t *vd;
ASSERT(vds != NULL);
ASSERT(device_path != NULL);
ASSERT(vdp != NULL);
PR0("Adding vdisk for %s", device_path);
if ((vd = kmem_zalloc(sizeof (*vd), KM_NOSLEEP)) == NULL) {
PRN("No memory for virtual disk");
return (EAGAIN);
}
*vdp = vd;
vd->id = id;
vd->vds = vds;
(void) strncpy(vd->device_path, device_path, MAXPATHLEN);
vd->open_flags = FREAD;
if (!(options & VD_OPT_RDONLY))
vd->open_flags |= FWRITE;
if (options & VD_OPT_EXCLUSIVE)
vd->open_flags |= FEXCL;
if (options & VD_OPT_SLICE) {
vd->vdisk_type = VD_DISK_TYPE_SLICE;
vd->nslices = 1;
} else {
vd->vdisk_type = VD_DISK_TYPE_DISK;
vd->nslices = V_NUMPAR;
}
vd->vdisk_label = VD_DISK_LABEL_UNK;
if ((status = vd_setup_vd(vd)) == 0) {
vd->initialized |= VD_DISK_READY;
ASSERT(vd->nslices > 0 && vd->nslices <= V_NUMPAR);
PR0("vdisk_type = %s, volume = %s, file = %s, nslices = %u",
((vd->vdisk_type == VD_DISK_TYPE_DISK) ? "disk" : "slice"),
(vd->volume ? "yes" : "no"), (vd->file ? "yes" : "no"),
vd->nslices);
} else {
if (status != EAGAIN)
return (status);
}
if (ddi_get_soft_iblock_cookie(vds->dip, DDI_SOFTINT_MED,
&iblock) != DDI_SUCCESS) {
PRN("Could not get iblock cookie.");
return (EIO);
}
mutex_init(&vd->lock, NULL, MUTEX_DRIVER, iblock);
vd->initialized |= VD_LOCKING;
(void) snprintf(tq_name, sizeof (tq_name), "vd_startq%lu", id);
PR1("tq_name = %s", tq_name);
if ((vd->startq = ddi_taskq_create(vds->dip, tq_name, 1,
TASKQ_DEFAULTPRI, 0)) == NULL) {
PRN("Could not create task queue");
return (EIO);
}
(void) snprintf(tq_name, sizeof (tq_name), "vd_completionq%lu", id);
PR1("tq_name = %s", tq_name);
if ((vd->completionq = ddi_taskq_create(vds->dip, tq_name, 1,
TASKQ_DEFAULTPRI, 0)) == NULL) {
PRN("Could not create task queue");
return (EIO);
}
vd->max_msglen = sizeof (vio_msg_t);
vd->vio_msgp = kmem_alloc(vd->max_msglen, KM_SLEEP);
vd->enabled = 1;
ldc_attr.devclass = LDC_DEV_BLK_SVC;
ldc_attr.instance = ddi_get_instance(vds->dip);
ldc_attr.mode = LDC_MODE_UNRELIABLE;
ldc_attr.mtu = VD_LDC_MTU;
if ((status = ldc_init(ldc_id, &ldc_attr, &vd->ldc_handle)) != 0) {
PRN("Could not initialize LDC channel %lx, "
"init failed with error %d", ldc_id, status);
return (status);
}
vd->initialized |= VD_LDC;
if ((status = ldc_reg_callback(vd->ldc_handle, vd_handle_ldc_events,
(caddr_t)vd)) != 0) {
PRN("Could not initialize LDC channel %lu,"
"reg_callback failed with error %d", ldc_id, status);
return (status);
}
if ((status = ldc_open(vd->ldc_handle)) != 0) {
PRN("Could not initialize LDC channel %lu,"
"open failed with error %d", ldc_id, status);
return (status);
}
if ((status = ldc_up(vd->ldc_handle)) != 0) {
PR0("ldc_up() returned errno %d", status);
}
status = ldc_mem_alloc_handle(vd->ldc_handle, &(vd->inband_task.mhdl));
if (status) {
PRN("Could not initialize LDC channel %lu,"
"alloc_handle failed with error %d", ldc_id, status);
return (ENXIO);
}
if (mod_hash_insert(vds->vd_table, (mod_hash_key_t)id, vd) != 0) {
PRN("Error adding vdisk ID %lu to table", id);
return (EIO);
}
vd->state = VD_STATE_INIT;
return (0);
}
static void
vd_free_dring_task(vd_t *vdp)
{
if (vdp->dring_task != NULL) {
ASSERT(vdp->dring_len != 0);
for (int i = 0; i < vdp->dring_len; i++) {
(void) ldc_mem_free_handle(vdp->dring_task[i].mhdl);
kmem_free(vdp->dring_task[i].request,
(vdp->descriptor_size -
sizeof (vio_dring_entry_hdr_t)));
vdp->dring_task[i].request = NULL;
kmem_free(vdp->dring_task[i].msg, vdp->max_msglen);
vdp->dring_task[i].msg = NULL;
}
kmem_free(vdp->dring_task,
(sizeof (*vdp->dring_task)) * vdp->dring_len);
vdp->dring_task = NULL;
}
if (vdp->write_queue != NULL) {
kmem_free(vdp->write_queue, sizeof (buf_t *) * vdp->dring_len);
vdp->write_queue = NULL;
}
}
static void
vds_destroy_vd(void *arg)
{
vd_t *vd = (vd_t *)arg;
int retry = 0, rv;
if (vd == NULL)
return;
PR0("Destroying vdisk state");
if (vd->initialized & VD_LOCKING) {
mutex_enter(&vd->lock);
vd->enabled = 0;
mutex_exit(&vd->lock);
}
if (vd->startq != NULL)
ddi_taskq_destroy(vd->startq);
if (vd->ioq != NULL)
ddi_taskq_destroy(vd->ioq);
if (vd->completionq != NULL)
ddi_taskq_destroy(vd->completionq);
vd_free_dring_task(vd);
(void) ldc_mem_free_handle(vd->inband_task.mhdl);
if (vd->initialized & VD_LDC) {
if (vd->initialized & VD_DRING)
(void) ldc_mem_dring_unmap(vd->dring_handle);
while ((rv = ldc_close(vd->ldc_handle)) == EAGAIN) {
if (++retry > vds_ldc_retries) {
PR0("Timed out closing channel");
break;
}
drv_usecwait(vds_ldc_delay);
}
if (rv == 0) {
(void) ldc_unreg_callback(vd->ldc_handle);
(void) ldc_fini(vd->ldc_handle);
} else {
(void) ldc_set_cb_mode(vd->ldc_handle, LDC_CB_DISABLE);
while (ldc_unreg_callback(vd->ldc_handle) == EAGAIN)
drv_usecwait(vds_ldc_delay);
}
}
if (vd->vio_msgp != NULL) {
kmem_free(vd->vio_msgp, vd->max_msglen);
vd->vio_msgp = NULL;
}
if (vd->inband_task.msg != NULL) {
kmem_free(vd->inband_task.msg, vd->max_msglen);
vd->inband_task.msg = NULL;
}
if (vd->file) {
(void) VOP_CLOSE(vd->file_vnode, vd->open_flags, 1,
0, kcred, NULL);
VN_RELE(vd->file_vnode);
} else {
for (uint_t slice = 0; slice < V_NUMPAR; slice++) {
if (vd->ldi_handle[slice] != NULL) {
PR0("Closing slice %u", slice);
(void) ldi_close(vd->ldi_handle[slice],
vd->open_flags, kcred);
}
}
}
if (vd->dskimg_devid != NULL)
ddi_devid_free(vd->dskimg_devid);
if (vd->flabel) {
kmem_free(vd->flabel, vd->flabel_size);
vd->flabel = NULL;
vd->flabel_size = 0;
}
if (vd->initialized & VD_LOCKING)
mutex_destroy(&vd->lock);
kmem_free(vd, sizeof (*vd));
}
static int
vds_init_vd(vds_t *vds, uint64_t id, char *device_path, uint64_t options,
uint64_t ldc_id)
{
int status;
vd_t *vd = NULL;
if ((status = vds_do_init_vd(vds, id, device_path, options,
ldc_id, &vd)) != 0)
vds_destroy_vd(vd);
return (status);
}
static int
vds_do_get_ldc_id(md_t *md, mde_cookie_t vd_node, mde_cookie_t *channel,
uint64_t *ldc_id)
{
int num_channels;
if ((num_channels = md_scan_dag(md, vd_node,
md_find_name(md, VD_CHANNEL_ENDPOINT),
md_find_name(md, "fwd"), channel)) <= 0) {
PRN("No \"%s\" found for virtual disk", VD_CHANNEL_ENDPOINT);
return (-1);
}
if (md_get_prop_val(md, channel[0], VD_ID_PROP, ldc_id) != 0) {
PRN("No \"%s\" property found for \"%s\" of vdisk",
VD_ID_PROP, VD_CHANNEL_ENDPOINT);
return (-1);
}
if (num_channels > 1) {
PRN("Using ID of first of multiple channels for this vdisk");
}
return (0);
}
static int
vds_get_ldc_id(md_t *md, mde_cookie_t vd_node, uint64_t *ldc_id)
{
int num_nodes, status;
size_t size;
mde_cookie_t *channel;
if ((num_nodes = md_node_count(md)) <= 0) {
PRN("Invalid node count in Machine Description subtree");
return (-1);
}
size = num_nodes*(sizeof (*channel));
channel = kmem_zalloc(size, KM_SLEEP);
status = vds_do_get_ldc_id(md, vd_node, channel, ldc_id);
kmem_free(channel, size);
return (status);
}
static void
vds_get_options(md_t *md, mde_cookie_t vd_node, uint64_t *options)
{
char *optstr, *opt;
int len, n, i;
*options = 0;
if (md_get_prop_data(md, vd_node, VD_BLOCK_DEVICE_OPTS,
(uint8_t **)&optstr, &len) != 0) {
PR0("No options found");
return;
}
opt = optstr;
n = sizeof (vd_bdev_options) / sizeof (vd_option_t);
while (opt < optstr + len) {
for (i = 0; i < n; i++) {
if (strncmp(vd_bdev_options[i].vdo_name,
opt, VD_OPTION_NLEN) == 0) {
*options |= vd_bdev_options[i].vdo_value;
break;
}
}
if (i < n) {
PR0("option: %s", opt);
} else {
PRN("option %s is unknown or unsupported", opt);
}
opt += strlen(opt) + 1;
}
}
static void
vds_driver_types_free(vds_t *vds)
{
if (vds->driver_types != NULL) {
kmem_free(vds->driver_types, sizeof (vd_driver_type_t) *
vds->num_drivers);
vds->driver_types = NULL;
vds->num_drivers = 0;
}
}
static void
vds_driver_types_update(vds_t *vds)
{
char **list, *s;
uint_t i, num, count = 0, len;
if (ddi_prop_lookup_string_array(DDI_DEV_T_ANY, vds->dip,
DDI_PROP_DONTPASS, "driver-type-list", &list, &num) !=
DDI_PROP_SUCCESS)
return;
vds->num_drivers = num;
vds->driver_types = kmem_zalloc(sizeof (vd_driver_type_t) * num,
KM_SLEEP);
for (i = 0; i < num; i++) {
s = strchr(list[i], ':');
if (s == NULL) {
PRN("vds.conf: driver-type-list, entry %d (%s): "
"a colon is expected in the entry",
i, list[i]);
continue;
}
len = (uintptr_t)s - (uintptr_t)list[i];
if (len == 0) {
PRN("vds.conf: driver-type-list, entry %d (%s): "
"the driver name is empty",
i, list[i]);
continue;
}
if (len >= VD_DRIVER_NAME_LEN) {
PRN("vds.conf: driver-type-list, entry %d (%s): "
"the driver name is too long",
i, list[i]);
continue;
}
if (strcmp(s + 1, "disk") == 0) {
vds->driver_types[i].type = VD_DRIVER_DISK;
} else if (strcmp(s + 1, "volume") == 0) {
vds->driver_types[i].type = VD_DRIVER_VOLUME;
} else {
PRN("vds.conf: driver-type-list, entry %d (%s): "
"the driver type is invalid",
i, list[i]);
continue;
}
(void) strncpy(vds->driver_types[i].name, list[i], len);
PR0("driver-type-list, entry %d (%s) added",
i, list[i]);
count++;
}
ddi_prop_free(list);
if (count == 0) {
vds_driver_types_free(vds);
}
}
static void
vds_add_vd(vds_t *vds, md_t *md, mde_cookie_t vd_node)
{
char *device_path = NULL;
uint64_t id = 0, ldc_id = 0, options = 0;
if (md_get_prop_val(md, vd_node, VD_ID_PROP, &id) != 0) {
PRN("Error getting vdisk \"%s\"", VD_ID_PROP);
return;
}
PR0("Adding vdisk ID %lu", id);
if (md_get_prop_str(md, vd_node, VD_BLOCK_DEVICE_PROP,
&device_path) != 0) {
PRN("Error getting vdisk \"%s\"", VD_BLOCK_DEVICE_PROP);
return;
}
vds_get_options(md, vd_node, &options);
if (vds_get_ldc_id(md, vd_node, &ldc_id) != 0) {
PRN("Error getting LDC ID for vdisk %lu", id);
return;
}
if (vds_init_vd(vds, id, device_path, options, ldc_id) != 0) {
PRN("Failed to add vdisk ID %lu", id);
if (mod_hash_destroy(vds->vd_table, (mod_hash_key_t)id) != 0)
PRN("No vDisk entry found for vdisk ID %lu", id);
return;
}
}
static void
vds_remove_vd(vds_t *vds, md_t *md, mde_cookie_t vd_node)
{
uint64_t id = 0;
if (md_get_prop_val(md, vd_node, VD_ID_PROP, &id) != 0) {
PRN("Unable to get \"%s\" property from vdisk's MD node",
VD_ID_PROP);
return;
}
PR0("Removing vdisk ID %lu", id);
if (mod_hash_destroy(vds->vd_table, (mod_hash_key_t)id) != 0)
PRN("No vdisk entry found for vdisk ID %lu", id);
}
static void
vds_change_vd(vds_t *vds, md_t *prev_md, mde_cookie_t prev_vd_node,
md_t *curr_md, mde_cookie_t curr_vd_node)
{
char *curr_dev, *prev_dev;
uint64_t curr_id = 0, curr_ldc_id = 0, curr_options = 0;
uint64_t prev_id = 0, prev_ldc_id = 0, prev_options = 0;
size_t len;
if (md_get_prop_val(prev_md, prev_vd_node, VD_ID_PROP, &prev_id) != 0) {
PRN("Error getting previous vdisk \"%s\" property",
VD_ID_PROP);
return;
}
if (md_get_prop_val(curr_md, curr_vd_node, VD_ID_PROP, &curr_id) != 0) {
PRN("Error getting current vdisk \"%s\" property", VD_ID_PROP);
return;
}
if (curr_id != prev_id) {
PRN("Not changing vdisk: ID changed from %lu to %lu",
prev_id, curr_id);
return;
}
if (vds_get_ldc_id(prev_md, prev_vd_node, &prev_ldc_id) != 0) {
PRN("Error getting LDC ID for vdisk %lu", prev_id);
return;
}
if (vds_get_ldc_id(curr_md, curr_vd_node, &curr_ldc_id) != 0) {
PRN("Error getting LDC ID for vdisk %lu", curr_id);
return;
}
if (curr_ldc_id != prev_ldc_id) {
_NOTE(NOTREACHED);
PRN("Not changing vdisk: "
"LDC ID changed from %lu to %lu", prev_ldc_id, curr_ldc_id);
return;
}
if (md_get_prop_str(prev_md, prev_vd_node, VD_BLOCK_DEVICE_PROP,
&prev_dev) != 0) {
PRN("Error getting previous vdisk \"%s\"",
VD_BLOCK_DEVICE_PROP);
return;
}
if (md_get_prop_str(curr_md, curr_vd_node, VD_BLOCK_DEVICE_PROP,
&curr_dev) != 0) {
PRN("Error getting current vdisk \"%s\"", VD_BLOCK_DEVICE_PROP);
return;
}
if (((len = strlen(curr_dev)) == strlen(prev_dev)) &&
(strncmp(curr_dev, prev_dev, len) == 0))
return;
vds_get_options(prev_md, prev_vd_node, &prev_options);
vds_get_options(curr_md, curr_vd_node, &curr_options);
if (prev_options != curr_options) {
PRN("Not changing vdisk: options changed from %lx to %lx",
prev_options, curr_options);
return;
}
PR0("Changing vdisk ID %lu", prev_id);
if (mod_hash_destroy(vds->vd_table, (mod_hash_key_t)prev_id) != 0)
PRN("No entry found for vdisk ID %lu", prev_id);
if (vds_init_vd(vds, curr_id, curr_dev, curr_options,
curr_ldc_id) != 0) {
PRN("Failed to change vdisk ID %lu", curr_id);
return;
}
}
static int
vds_process_md(void *arg, mdeg_result_t *md)
{
int i;
vds_t *vds = arg;
if (md == NULL)
return (MDEG_FAILURE);
ASSERT(vds != NULL);
for (i = 0; i < md->removed.nelem; i++)
vds_remove_vd(vds, md->removed.mdp, md->removed.mdep[i]);
for (i = 0; i < md->match_curr.nelem; i++)
vds_change_vd(vds, md->match_prev.mdp, md->match_prev.mdep[i],
md->match_curr.mdp, md->match_curr.mdep[i]);
for (i = 0; i < md->added.nelem; i++)
vds_add_vd(vds, md->added.mdp, md->added.mdep[i]);
return (MDEG_SUCCESS);
}
static int
vds_do_attach(dev_info_t *dip)
{
int status, sz;
int cfg_handle;
minor_t instance = ddi_get_instance(dip);
vds_t *vds;
mdeg_prop_spec_t *pspecp;
mdeg_node_spec_t *ispecp;
if (!ddi_prop_exists(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS,
VD_REG_PROP)) {
PRN("vds \"%s\" property does not exist", VD_REG_PROP);
return (DDI_FAILURE);
}
cfg_handle = ddi_prop_get_int(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS,
VD_REG_PROP, -1);
if (ddi_soft_state_zalloc(vds_state, instance) != DDI_SUCCESS) {
PRN("Could not allocate state for instance %u", instance);
return (DDI_FAILURE);
}
if ((vds = ddi_get_soft_state(vds_state, instance)) == NULL) {
PRN("Could not get state for instance %u", instance);
ddi_soft_state_free(vds_state, instance);
return (DDI_FAILURE);
}
vds->dip = dip;
vds->vd_table = mod_hash_create_ptrhash("vds_vd_table", VDS_NCHAINS,
vds_destroy_vd, sizeof (void *));
ASSERT(vds->vd_table != NULL);
if ((status = ldi_ident_from_dip(dip, &vds->ldi_ident)) != 0) {
PRN("ldi_ident_from_dip() returned errno %d", status);
return (DDI_FAILURE);
}
vds->initialized |= VDS_LDI;
sz = sizeof (vds_prop_template);
pspecp = kmem_alloc(sz, KM_SLEEP);
bcopy(vds_prop_template, pspecp, sz);
VDS_SET_MDEG_PROP_INST(pspecp, cfg_handle);
ispecp = kmem_zalloc(sizeof (mdeg_node_spec_t), KM_SLEEP);
ispecp->namep = "virtual-device";
ispecp->specp = pspecp;
if (mdeg_register(ispecp, &vd_match, vds_process_md, vds,
&vds->mdeg) != MDEG_SUCCESS) {
PRN("Unable to register for MD updates");
kmem_free(ispecp, sizeof (mdeg_node_spec_t));
kmem_free(pspecp, sz);
return (DDI_FAILURE);
}
vds->ispecp = ispecp;
vds->initialized |= VDS_MDEG;
if (ddi_prop_update_int(DDI_DEV_T_NONE, dip, DDI_NO_AUTODETACH, 1) !=
DDI_PROP_SUCCESS) {
PRN("failed to set \"%s\" property for instance %u",
DDI_NO_AUTODETACH, instance);
}
vds_driver_types_update(vds);
ddi_report_dev(dip);
return (DDI_SUCCESS);
}
static int
vds_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
int status;
switch (cmd) {
case DDI_ATTACH:
PR0("Attaching");
if ((status = vds_do_attach(dip)) != DDI_SUCCESS)
(void) vds_detach(dip, DDI_DETACH);
return (status);
case DDI_RESUME:
PR0("No action required for DDI_RESUME");
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
}
static struct dev_ops vds_ops = {
DEVO_REV,
0,
ddi_no_info,
nulldev,
nulldev,
vds_attach,
vds_detach,
nodev,
NULL,
NULL,
nulldev,
ddi_quiesce_not_needed,
};
static struct modldrv modldrv = {
&mod_driverops,
"virtual disk server",
&vds_ops,
};
static struct modlinkage modlinkage = {
MODREV_1,
&modldrv,
NULL
};
int
_init(void)
{
int status;
if ((status = ddi_soft_state_init(&vds_state, sizeof (vds_t), 1)) != 0)
return (status);
if ((status = mod_install(&modlinkage)) != 0) {
ddi_soft_state_fini(&vds_state);
return (status);
}
return (0);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
int
_fini(void)
{
int status;
if ((status = mod_remove(&modlinkage)) != 0)
return (status);
ddi_soft_state_fini(&vds_state);
return (0);
}