#include <sys/types.h>
#include <netinet/in.h>
#include <sys/sysmacros.h>
#include <sys/uio.h>
#include <sys/kmem.h>
#include <sys/cred.h>
#include <sys/mman.h>
#include <sys/errno.h>
#include <sys/aio_req.h>
#include <sys/stat.h>
#include <sys/file.h>
#include <sys/modctl.h>
#include <sys/conf.h>
#include <sys/debug.h>
#include <sys/vnode.h>
#include <sys/lofi.h>
#include <sys/lofi_impl.h>
#include <sys/fcntl.h>
#include <sys/pathname.h>
#include <sys/filio.h>
#include <sys/fdio.h>
#include <sys/open.h>
#include <sys/disp.h>
#include <vm/seg_map.h>
#include <sys/ddi.h>
#include <sys/dkioc_free_util.h>
#include <sys/sunddi.h>
#include <sys/zmod.h>
#include <sys/id_space.h>
#include <sys/mkdev.h>
#include <sys/crypto/common.h>
#include <sys/crypto/api.h>
#include <sys/rctl.h>
#include <sys/vtoc.h>
#include <sys/scsi/scsi.h>
#include <sys/scsi/impl/uscsi.h>
#include <sys/sysevent/dev.h>
#include <sys/efi_partition.h>
#include <LzmaDec.h>
#define NBLOCKS_PROP_NAME "Nblocks"
#define SIZE_PROP_NAME "Size"
#define ZONE_PROP_NAME "zone"
#define SETUP_C_DATA(cd, buf, len) \
(cd).cd_format = CRYPTO_DATA_RAW; \
(cd).cd_offset = 0; \
(cd).cd_miscdata = NULL; \
(cd).cd_length = (len); \
(cd).cd_raw.iov_base = (buf); \
(cd).cd_raw.iov_len = (len);
#define UIO_CHECK(uio) \
if (((uio)->uio_loffset % DEV_BSIZE) != 0 || \
((uio)->uio_resid % DEV_BSIZE) != 0) { \
return (EINVAL); \
}
#define LOFI_TIMEOUT 120
int lofi_timeout = LOFI_TIMEOUT;
static void *lofi_statep;
static kmutex_t lofi_lock;
static id_space_t *lofi_id;
static list_t lofi_list;
static zone_key_t lofi_zone_key;
static int lofi_taskq_maxalloc = 104857600 / DEV_BSIZE;
static int lofi_taskq_nthreads = 4;
const char lofi_crypto_magic[6] = LOFI_CRYPTO_MAGIC;
uint32_t lofi_max_comp_cache = 1;
static int gzip_decompress(void *src, size_t srclen, void *dst,
size_t *destlen, int level);
static int lzma_decompress(void *src, size_t srclen, void *dst,
size_t *dstlen, int level);
lofi_compress_info_t lofi_compress_table[LOFI_COMPRESS_FUNCTIONS] = {
{gzip_decompress, NULL, 6, "gzip"},
{gzip_decompress, NULL, 6, "gzip-6"},
{gzip_decompress, NULL, 9, "gzip-9"},
{lzma_decompress, NULL, 0, "lzma"}
};
static void lofi_strategy_task(void *);
static int lofi_tg_rdwr(dev_info_t *, uchar_t, void *, diskaddr_t,
size_t, void *);
static int lofi_tg_getinfo(dev_info_t *, int, void *, void *);
struct cmlb_tg_ops lofi_tg_ops = {
TG_DK_OPS_VERSION_1,
lofi_tg_rdwr,
lofi_tg_getinfo
};
typedef enum {
RDWR_RAW,
RDWR_BCOPY
} lofi_rdrw_method_t;
static void
*SzAlloc(void *p __unused, size_t size)
{
return (kmem_alloc(size, KM_SLEEP));
}
static void
SzFree(void *p __unused, void *address, size_t size)
{
kmem_free(address, size);
}
static ISzAlloc g_Alloc = { SzAlloc, SzFree };
static void
lofi_free_comp_cache(struct lofi_state *lsp)
{
struct lofi_comp_cache *lc;
while ((lc = list_remove_head(&lsp->ls_comp_cache)) != NULL) {
kmem_free(lc->lc_data, lsp->ls_uncomp_seg_sz);
kmem_free(lc, sizeof (struct lofi_comp_cache));
lsp->ls_comp_cache_count--;
}
ASSERT(lsp->ls_comp_cache_count == 0);
}
static int
is_opened(struct lofi_state *lsp)
{
int i;
boolean_t last = B_TRUE;
ASSERT(MUTEX_HELD(&lofi_lock));
for (i = 0; i < LOFI_PART_MAX; i++) {
if (lsp->ls_open_lyr[i]) {
last = B_FALSE;
break;
}
}
for (i = 0; last && (i < OTYP_LYR); i++) {
if (lsp->ls_open_reg[i]) {
last = B_FALSE;
}
}
return (!last);
}
static void
lofi_set_cleanup(struct lofi_state *lsp)
{
ASSERT(MUTEX_HELD(&lofi_lock));
lsp->ls_cleanup = B_TRUE;
cv_broadcast(&lsp->ls_vp_cv);
}
static void
lofi_free_crypto(struct lofi_state *lsp)
{
ASSERT(MUTEX_HELD(&lofi_lock));
if (lsp->ls_crypto_enabled) {
if (lsp->ls_key.ck_data != NULL) {
bzero(lsp->ls_key.ck_data,
CRYPTO_BITS2BYTES(lsp->ls_key.ck_length));
kmem_free(lsp->ls_key.ck_data,
CRYPTO_BITS2BYTES(lsp->ls_key.ck_length));
lsp->ls_key.ck_data = NULL;
lsp->ls_key.ck_length = 0;
}
if (lsp->ls_mech.cm_param != NULL) {
kmem_free(lsp->ls_mech.cm_param,
lsp->ls_mech.cm_param_len);
lsp->ls_mech.cm_param = NULL;
lsp->ls_mech.cm_param_len = 0;
}
if (lsp->ls_iv_mech.cm_param != NULL) {
kmem_free(lsp->ls_iv_mech.cm_param,
lsp->ls_iv_mech.cm_param_len);
lsp->ls_iv_mech.cm_param = NULL;
lsp->ls_iv_mech.cm_param_len = 0;
}
mutex_destroy(&lsp->ls_crypto_lock);
}
}
static int
lofi_tg_rdwr(dev_info_t *dip, uchar_t cmd, void *bufaddr, diskaddr_t start,
size_t length, void *tg_cookie __unused)
{
struct lofi_state *lsp;
buf_t *bp;
int instance;
int rv = 0;
instance = ddi_get_instance(dip);
if (instance == 0)
return (ENXIO);
lsp = ddi_get_soft_state(lofi_statep, instance);
if (lsp == NULL)
return (ENXIO);
if (cmd != TG_READ && cmd != TG_WRITE)
return (EINVAL);
mutex_enter(&lsp->ls_vp_lock);
while (lsp->ls_vp_ready == B_FALSE)
cv_wait(&lsp->ls_vp_cv, &lsp->ls_vp_lock);
mutex_exit(&lsp->ls_vp_lock);
if (P2PHASE(length, (1U << lsp->ls_lbshift)) != 0) {
return (EINVAL);
}
bp = getrbuf(KM_SLEEP);
if (cmd == TG_READ) {
bp->b_flags = B_READ;
} else {
if (lsp->ls_readonly == B_TRUE) {
freerbuf(bp);
return (EROFS);
}
bp->b_flags = B_WRITE;
}
bp->b_un.b_addr = bufaddr;
bp->b_bcount = length;
bp->b_lblkno = start;
bp->b_private = NULL;
bp->b_edev = lsp->ls_dev;
if (lsp->ls_kstat) {
mutex_enter(lsp->ls_kstat->ks_lock);
kstat_waitq_enter(KSTAT_IO_PTR(lsp->ls_kstat));
mutex_exit(lsp->ls_kstat->ks_lock);
}
(void) taskq_dispatch(lsp->ls_taskq, lofi_strategy_task, bp, KM_SLEEP);
(void) biowait(bp);
rv = geterror(bp);
freerbuf(bp);
return (rv);
}
static int
lofi_tg_getinfo(dev_info_t *dip, int cmd, void *arg, void *tg_cookie __unused)
{
struct lofi_state *lsp;
int instance;
int ashift;
instance = ddi_get_instance(dip);
if (instance == 0)
return (ENXIO);
lsp = ddi_get_soft_state(lofi_statep, instance);
if (lsp == NULL)
return (ENXIO);
mutex_enter(&lsp->ls_vp_lock);
if (tg_cookie != NULL && lsp->ls_vp_ready == B_FALSE) {
mutex_exit(&lsp->ls_vp_lock);
return (ENXIO);
}
while (lsp->ls_vp_ready == B_FALSE)
cv_wait(&lsp->ls_vp_cv, &lsp->ls_vp_lock);
mutex_exit(&lsp->ls_vp_lock);
ashift = lsp->ls_lbshift;
switch (cmd) {
case TG_GETPHYGEOM: {
cmlb_geom_t *geomp = arg;
geomp->g_capacity =
(lsp->ls_vp_size - lsp->ls_crypto_offset) >> ashift;
geomp->g_nsect = lsp->ls_dkg.dkg_nsect;
geomp->g_nhead = lsp->ls_dkg.dkg_nhead;
geomp->g_acyl = lsp->ls_dkg.dkg_acyl;
geomp->g_ncyl = lsp->ls_dkg.dkg_ncyl;
geomp->g_secsize = (1U << ashift);
geomp->g_intrlv = lsp->ls_dkg.dkg_intrlv;
geomp->g_rpm = lsp->ls_dkg.dkg_rpm;
return (0);
}
case TG_GETCAPACITY:
*(diskaddr_t *)arg =
(lsp->ls_vp_size - lsp->ls_crypto_offset) >> ashift;
return (0);
case TG_GETBLOCKSIZE:
*(uint32_t *)arg = (1U << ashift);
return (0);
case TG_GETATTR: {
tg_attribute_t *tgattr = arg;
tgattr->media_is_writable = !lsp->ls_readonly;
tgattr->media_is_solid_state = B_FALSE;
tgattr->media_is_rotational = B_FALSE;
return (0);
}
default:
return (EINVAL);
}
}
static void
lofi_teardown_task(void *arg)
{
struct lofi_state *lsp = arg;
int id = LOFI_MINOR2ID(getminor(lsp->ls_dev));
mutex_enter(&lofi_lock);
while (ndi_devi_offline(lsp->ls_dip, NDI_DEVI_REMOVE) != NDI_SUCCESS) {
mutex_exit(&lofi_lock);
;
delay(drv_usectohz(MICROSEC));
mutex_enter(&lofi_lock);
}
id_free(lofi_id, id);
mutex_exit(&lofi_lock);
}
static void
lofi_destroy(struct lofi_state *lsp, cred_t *credp)
{
int id = LOFI_MINOR2ID(getminor(lsp->ls_dev));
int i;
ASSERT(MUTEX_HELD(&lofi_lock));
if (lsp->ls_taskq != NULL) {
taskq_destroy(lsp->ls_taskq);
lsp->ls_taskq = NULL;
}
list_remove(&lofi_list, lsp);
lofi_free_crypto(lsp);
if (lsp->ls_comp_bufs != NULL) {
for (i = 0; i < lofi_taskq_nthreads; i++) {
if (lsp->ls_comp_bufs[i].bufsize > 0)
kmem_free(lsp->ls_comp_bufs[i].buf,
lsp->ls_comp_bufs[i].bufsize);
}
kmem_free(lsp->ls_comp_bufs,
sizeof (struct compbuf) * lofi_taskq_nthreads);
}
if (lsp->ls_vp != NULL) {
(void) VOP_PUTPAGE(lsp->ls_vp, 0, 0, B_FREE, credp, NULL);
(void) VOP_CLOSE(lsp->ls_vp, lsp->ls_openflag,
1, 0, credp, NULL);
VN_RELE(lsp->ls_vp);
}
if (lsp->ls_stacked_vp != lsp->ls_vp)
VN_RELE(lsp->ls_stacked_vp);
lsp->ls_vp = lsp->ls_stacked_vp = NULL;
if (lsp->ls_kstat != NULL) {
kstat_delete(lsp->ls_kstat);
lsp->ls_kstat = NULL;
}
lofi_free_comp_cache(lsp);
list_destroy(&lsp->ls_comp_cache);
if (lsp->ls_uncomp_seg_sz > 0) {
kmem_free(lsp->ls_comp_index_data, lsp->ls_comp_index_data_sz);
lsp->ls_uncomp_seg_sz = 0;
}
rctl_decr_lofi(lsp->ls_zone.zref_zone, 1);
zone_rele_ref(&lsp->ls_zone, ZONE_REF_LOFI);
mutex_destroy(&lsp->ls_comp_cache_lock);
mutex_destroy(&lsp->ls_comp_bufs_lock);
mutex_destroy(&lsp->ls_kstat_lock);
mutex_destroy(&lsp->ls_vp_lock);
cv_destroy(&lsp->ls_vp_cv);
lsp->ls_vp_ready = B_FALSE;
lsp->ls_vp_closereq = B_FALSE;
ASSERT(ddi_get_soft_state(lofi_statep, id) == lsp);
(void) taskq_dispatch(system_taskq, lofi_teardown_task, lsp, KM_SLEEP);
}
static void
lofi_free_dev(struct lofi_state *lsp)
{
ASSERT(MUTEX_HELD(&lofi_lock));
if (lsp->ls_cmlbhandle != NULL) {
cmlb_invalidate(lsp->ls_cmlbhandle, 0);
cmlb_detach(lsp->ls_cmlbhandle, 0);
cmlb_free_handle(&lsp->ls_cmlbhandle);
lsp->ls_cmlbhandle = NULL;
}
(void) ddi_prop_remove_all(lsp->ls_dip);
ddi_remove_minor_node(lsp->ls_dip, NULL);
}
static void
lofi_zone_shutdown(zoneid_t zoneid, void *arg __unused)
{
struct lofi_state *lsp;
struct lofi_state *next;
mutex_enter(&lofi_lock);
for (lsp = list_head(&lofi_list); lsp != NULL; lsp = next) {
next = list_next(&lofi_list, lsp);
if (lsp->ls_zone.zref_zone->zone_id != zoneid)
continue;
if (is_opened(lsp)) {
lofi_set_cleanup(lsp);
} else {
lofi_free_dev(lsp);
lofi_destroy(lsp, kcred);
}
}
mutex_exit(&lofi_lock);
}
static int
lofi_open(dev_t *devp, int flag, int otyp, struct cred *credp __unused)
{
int id;
minor_t part;
uint64_t mask;
diskaddr_t nblks;
diskaddr_t lba;
boolean_t ndelay;
struct lofi_state *lsp;
if (otyp >= OTYPCNT)
return (EINVAL);
ndelay = (flag & (FNDELAY | FNONBLOCK)) ? B_TRUE : B_FALSE;
if (mutex_owner(&lofi_lock) == curthread)
return (EINVAL);
mutex_enter(&lofi_lock);
id = LOFI_MINOR2ID(getminor(*devp));
part = LOFI_PART(getminor(*devp));
mask = (1U << part);
if (id == 0) {
mutex_exit(&lofi_lock);
return (0);
}
lsp = ddi_get_soft_state(lofi_statep, id);
if (lsp == NULL) {
mutex_exit(&lofi_lock);
return (EINVAL);
}
if (lsp->ls_cleanup == B_TRUE) {
mutex_exit(&lofi_lock);
return (ENXIO);
}
if (lsp->ls_vp == NULL) {
mutex_exit(&lofi_lock);
return (ENXIO);
}
if (lsp->ls_readonly && (flag & FWRITE)) {
mutex_exit(&lofi_lock);
return (EROFS);
}
if ((lsp->ls_open_excl) & (mask)) {
mutex_exit(&lofi_lock);
return (EBUSY);
}
if (flag & FEXCL) {
if (lsp->ls_open_lyr[part]) {
mutex_exit(&lofi_lock);
return (EBUSY);
}
for (int i = 0; i < OTYP_LYR; i++) {
if (lsp->ls_open_reg[i] & mask) {
mutex_exit(&lofi_lock);
return (EBUSY);
}
}
}
if (lsp->ls_cmlbhandle != NULL) {
if (cmlb_validate(lsp->ls_cmlbhandle, 0, 0) != 0) {
if (!ndelay) {
mutex_exit(&lofi_lock);
return (ENXIO);
}
} else if (cmlb_partinfo(lsp->ls_cmlbhandle, part, &nblks, &lba,
NULL, NULL, 0) == 0) {
if ((!nblks) && ((!ndelay) || (otyp != OTYP_CHR))) {
mutex_exit(&lofi_lock);
return (ENXIO);
}
} else if (!ndelay) {
mutex_exit(&lofi_lock);
return (ENXIO);
}
}
if (otyp == OTYP_LYR) {
lsp->ls_open_lyr[part]++;
} else {
lsp->ls_open_reg[otyp] |= mask;
}
if (flag & FEXCL) {
lsp->ls_open_excl |= mask;
}
mutex_exit(&lofi_lock);
return (0);
}
static int
lofi_close(dev_t dev, int flag __unused, int otyp, struct cred *credp)
{
minor_t part;
int id;
uint64_t mask;
struct lofi_state *lsp;
id = LOFI_MINOR2ID(getminor(dev));
part = LOFI_PART(getminor(dev));
mask = (1U << part);
mutex_enter(&lofi_lock);
lsp = ddi_get_soft_state(lofi_statep, id);
if (lsp == NULL) {
mutex_exit(&lofi_lock);
return (EINVAL);
}
if (id == 0) {
mutex_exit(&lofi_lock);
return (0);
}
if (lsp->ls_open_excl & mask)
lsp->ls_open_excl &= ~mask;
if (otyp == OTYP_LYR) {
lsp->ls_open_lyr[part]--;
} else {
lsp->ls_open_reg[otyp] &= ~mask;
}
if (!is_opened(lsp) &&
(lsp->ls_cleanup == B_TRUE || lsp->ls_vp == NULL)) {
lofi_free_dev(lsp);
lofi_destroy(lsp, credp);
}
mutex_exit(&lofi_lock);
return (0);
}
static int
lofi_blk_mech(struct lofi_state *lsp, longlong_t lblkno)
{
int ret;
crypto_data_t cdata;
char *iv;
size_t iv_len;
size_t min;
void *data;
size_t datasz;
ASSERT(MUTEX_HELD(&lsp->ls_crypto_lock));
if (lsp == NULL)
return (CRYPTO_DEVICE_ERROR);
if (lsp->ls_iv_type == IVM_NONE) {
return (CRYPTO_SUCCESS);
}
if (lsp->ls_mech.cm_param == NULL ||
lsp->ls_mech.cm_param_len != lsp->ls_iv_len) {
iv_len = lsp->ls_iv_len;
iv = kmem_zalloc(iv_len, KM_SLEEP);
} else {
iv_len = lsp->ls_mech.cm_param_len;
iv = lsp->ls_mech.cm_param;
bzero(iv, iv_len);
}
switch (lsp->ls_iv_type) {
case IVM_ENC_BLKNO:
data = &lblkno;
datasz = sizeof (lblkno);
break;
default:
data = 0;
datasz = 0;
break;
}
min = MIN(datasz, iv_len);
bcopy(data, iv + (iv_len - min), min);
SETUP_C_DATA(cdata, iv, iv_len);
ret = crypto_encrypt(&lsp->ls_iv_mech, &cdata, &lsp->ls_key,
NULL, NULL, NULL);
if (ret != CRYPTO_SUCCESS) {
cmn_err(CE_WARN, "failed to create iv for block %lld: (0x%x)",
lblkno, ret);
if (lsp->ls_mech.cm_param != iv)
kmem_free(iv, iv_len);
return (ret);
}
if (lsp->ls_mech.cm_param != NULL && lsp->ls_mech.cm_param != iv)
kmem_free(lsp->ls_mech.cm_param, lsp->ls_mech.cm_param_len);
lsp->ls_mech.cm_param_len = iv_len;
lsp->ls_mech.cm_param = iv;
return (CRYPTO_SUCCESS);
}
static int
lofi_crypto(struct lofi_state *lsp, struct buf *bp, caddr_t plaintext,
caddr_t ciphertext, size_t len, boolean_t op_encrypt)
{
crypto_data_t cdata;
crypto_data_t wdata;
int ret;
longlong_t lblkno = bp->b_lblkno;
mutex_enter(&lsp->ls_crypto_lock);
SETUP_C_DATA(cdata, plaintext, len);
cdata.cd_length = DEV_BSIZE;
if (ciphertext != NULL) {
SETUP_C_DATA(wdata, ciphertext, len);
wdata.cd_length = DEV_BSIZE;
}
do {
ret = lofi_blk_mech(lsp, lblkno);
if (ret != CRYPTO_SUCCESS)
continue;
if (op_encrypt) {
ret = crypto_encrypt(&lsp->ls_mech, &cdata,
&lsp->ls_key, NULL,
((ciphertext != NULL) ? &wdata : NULL), NULL);
} else {
ret = crypto_decrypt(&lsp->ls_mech, &cdata,
&lsp->ls_key, NULL,
((ciphertext != NULL) ? &wdata : NULL), NULL);
}
cdata.cd_offset += DEV_BSIZE;
if (ciphertext != NULL)
wdata.cd_offset += DEV_BSIZE;
lblkno++;
} while (ret == CRYPTO_SUCCESS && cdata.cd_offset < len);
mutex_exit(&lsp->ls_crypto_lock);
if (ret != CRYPTO_SUCCESS) {
cmn_err(CE_WARN, "%s failed for block %lld: (0x%x)",
op_encrypt ? "crypto_encrypt()" : "crypto_decrypt()",
lblkno, ret);
}
return (ret);
}
static int
lofi_rdwr(caddr_t bufaddr, offset_t offset, struct buf *bp,
struct lofi_state *lsp, size_t len, lofi_rdrw_method_t method,
caddr_t bcopy_locn)
{
ssize_t resid;
int isread;
int error;
isread = bp->b_flags & B_READ;
if (isread) {
if (method == RDWR_BCOPY) {
bcopy(bcopy_locn, bufaddr, len);
error = 0;
} else {
error = vn_rdwr(UIO_READ, lsp->ls_vp, bufaddr, len,
offset, UIO_SYSSPACE, 0, RLIM64_INFINITY, kcred,
&resid);
bp->b_resid = resid;
}
if (lsp->ls_crypto_enabled && error == 0) {
if (lofi_crypto(lsp, bp, bufaddr, NULL, len,
B_FALSE) != CRYPTO_SUCCESS) {
if (method != RDWR_BCOPY)
bp->b_resid = len;
error = EIO;
}
}
return (error);
} else {
void *iobuf = bufaddr;
if (lsp->ls_crypto_enabled) {
iobuf = kmem_alloc(len, KM_SLEEP);
if (lofi_crypto(lsp, bp, bufaddr, iobuf, len,
B_TRUE) != CRYPTO_SUCCESS) {
kmem_free(iobuf, len);
if (method != RDWR_BCOPY)
bp->b_resid = len;
return (EIO);
}
}
if (method == RDWR_BCOPY) {
bcopy(iobuf, bcopy_locn, len);
error = 0;
} else {
error = vn_rdwr(UIO_WRITE, lsp->ls_vp, iobuf, len,
offset, UIO_SYSSPACE, 0, RLIM64_INFINITY, kcred,
&resid);
bp->b_resid = resid;
}
if (lsp->ls_crypto_enabled) {
kmem_free(iobuf, len);
}
return (error);
}
}
static int
lofi_mapped_rdwr(caddr_t bufaddr, offset_t offset, struct buf *bp,
struct lofi_state *lsp)
{
int error;
offset_t alignedoffset, mapoffset;
size_t xfersize;
int isread;
int smflags;
caddr_t mapaddr;
size_t len;
enum seg_rw srw;
int save_error;
if (lsp->ls_crypto_enabled)
ASSERT(lsp->ls_vp_comp_size == lsp->ls_vp_size);
mapoffset = offset & MAXBOFFSET;
alignedoffset = offset - mapoffset;
bp->b_resid = bp->b_bcount;
isread = bp->b_flags & B_READ;
srw = isread ? S_READ : S_WRITE;
do {
xfersize = MIN(lsp->ls_vp_comp_size - offset,
MIN(MAXBSIZE - mapoffset, bp->b_resid));
len = roundup(mapoffset + xfersize, PAGESIZE);
mapaddr = segmap_getmapflt(segkmap, lsp->ls_vp,
alignedoffset, MAXBSIZE, 1, srw);
error = segmap_fault(kas.a_hat, segkmap, mapaddr,
len, F_SOFTLOCK, srw);
if (error) {
(void) segmap_release(segkmap, mapaddr, 0);
if (FC_CODE(error) == FC_OBJERR)
error = FC_ERRNO(error);
else
error = EIO;
break;
}
error = lofi_rdwr(bufaddr, 0, bp, lsp, xfersize,
RDWR_BCOPY, mapaddr + mapoffset);
if (error == 0) {
bp->b_resid -= xfersize;
bufaddr += xfersize;
offset += xfersize;
}
smflags = 0;
if (isread) {
smflags |= SM_FREE;
if (mapoffset == 0 && xfersize == MAXBSIZE)
smflags |= SM_DONTNEED;
} else {
if (error == 0)
smflags |= SM_WRITE | SM_ASYNC;
}
(void) segmap_fault(kas.a_hat, segkmap, mapaddr,
len, F_SOFTUNLOCK, srw);
save_error = segmap_release(segkmap, mapaddr, smflags);
if (error == 0)
error = save_error;
mapoffset = 0;
alignedoffset += MAXBSIZE;
} while ((error == 0) && (bp->b_resid > 0) &&
(offset < lsp->ls_vp_comp_size));
return (error);
}
static struct lofi_comp_cache *
lofi_find_comp_data(struct lofi_state *lsp, uint64_t seg_index)
{
struct lofi_comp_cache *lc;
ASSERT(MUTEX_HELD(&lsp->ls_comp_cache_lock));
for (lc = list_head(&lsp->ls_comp_cache); lc != NULL;
lc = list_next(&lsp->ls_comp_cache, lc)) {
if (lc->lc_index == seg_index) {
list_remove(&lsp->ls_comp_cache, lc);
list_insert_head(&lsp->ls_comp_cache, lc);
return (lc);
}
}
return (NULL);
}
static struct lofi_comp_cache *
lofi_add_comp_data(struct lofi_state *lsp, uint64_t seg_index,
uchar_t *data)
{
struct lofi_comp_cache *lc;
ASSERT(MUTEX_HELD(&lsp->ls_comp_cache_lock));
while (lsp->ls_comp_cache_count > lofi_max_comp_cache) {
lc = list_remove_tail(&lsp->ls_comp_cache);
ASSERT(lc != NULL);
kmem_free(lc->lc_data, lsp->ls_uncomp_seg_sz);
kmem_free(lc, sizeof (struct lofi_comp_cache));
lsp->ls_comp_cache_count--;
}
if (lofi_max_comp_cache == 0)
return (NULL);
if (lsp->ls_comp_cache_count < lofi_max_comp_cache) {
lc = kmem_alloc(sizeof (struct lofi_comp_cache), KM_SLEEP);
lc->lc_data = NULL;
list_insert_head(&lsp->ls_comp_cache, lc);
lsp->ls_comp_cache_count++;
} else {
lc = list_remove_tail(&lsp->ls_comp_cache);
if (lc == NULL)
return (NULL);
list_insert_head(&lsp->ls_comp_cache, lc);
}
if (lc->lc_data != NULL)
kmem_free(lc->lc_data, lsp->ls_uncomp_seg_sz);
lc->lc_data = data;
lc->lc_index = seg_index;
return (lc);
}
static int
gzip_decompress(void *src, size_t srclen, void *dst,
size_t *dstlen, int level __unused)
{
ASSERT(*dstlen >= srclen);
if (z_uncompress(dst, dstlen, src, srclen) != Z_OK)
return (-1);
return (0);
}
#define LZMA_HEADER_SIZE (LZMA_PROPS_SIZE + 8)
static int
lzma_decompress(void *src, size_t srclen, void *dst,
size_t *dstlen, int level __unused)
{
size_t insizepure;
void *actual_src;
ELzmaStatus status;
insizepure = srclen - LZMA_HEADER_SIZE;
actual_src = (void *)((Byte *)src + LZMA_HEADER_SIZE);
if (LzmaDecode((Byte *)dst, (size_t *)dstlen,
(const Byte *)actual_src, &insizepure,
(const Byte *)src, LZMA_PROPS_SIZE, LZMA_FINISH_ANY, &status,
&g_Alloc) != SZ_OK) {
return (-1);
}
return (0);
}
static void
lofi_trim_task(void *arg)
{
struct buf *bp = (struct buf *)arg;
diskaddr_t p_lba = (diskaddr_t)(uintptr_t)bp->b_private;
struct lofi_state *lsp;
off64_t start, length;
int error;
lsp = ddi_get_soft_state(lofi_statep,
LOFI_MINOR2ID(getminor(bp->b_edev)));
if (lsp == NULL) {
error = ENXIO;
goto errout;
}
if (lsp->ls_kstat != NULL) {
mutex_enter(lsp->ls_kstat->ks_lock);
kstat_waitq_to_runq(KSTAT_IO_PTR(lsp->ls_kstat));
mutex_exit(lsp->ls_kstat->ks_lock);
}
if (lsp->ls_vp == NULL || lsp->ls_vp_closereq) {
error = EIO;
goto errout;
}
mutex_enter(&lsp->ls_vp_lock);
lsp->ls_vp_iocount++;
mutex_exit(&lsp->ls_vp_lock);
start = (bp->b_lblkno + p_lba) << lsp->ls_lbshift;
length = bp->b_bcount;
if (lsp->ls_vp->v_type == VCHR || lsp->ls_vp->v_type == VBLK) {
int rv;
dkioc_free_list_t dfl = {
.dfl_num_exts = 1,
.dfl_offset = 0,
.dfl_flags = 0,
.dfl_exts = {
{
.dfle_start = start,
.dfle_length = length
}
}
};
error = VOP_IOCTL(lsp->ls_vp, DKIOCFREE, (intptr_t)&dfl,
FKIOCTL, kcred, &rv, NULL);
} else {
struct flock64 flck = { 0 };
flck.l_start = start;
flck.l_len = length;
flck.l_type = F_FREESP;
flck.l_whence = 0;
error = VOP_SPACE(lsp->ls_vp, F_FREESP, &flck, 0, 0, kcred,
NULL);
}
mutex_enter(&lsp->ls_vp_lock);
if (--lsp->ls_vp_iocount == 0)
cv_broadcast(&lsp->ls_vp_cv);
mutex_exit(&lsp->ls_vp_lock);
errout:
if (lsp != NULL && lsp->ls_kstat != NULL) {
mutex_enter(lsp->ls_kstat->ks_lock);
kstat_runq_exit(KSTAT_IO_PTR(lsp->ls_kstat));
mutex_exit(lsp->ls_kstat->ks_lock);
}
bioerror(bp, error);
biodone(bp);
}
static void
lofi_strategy_task(void *arg)
{
struct buf *bp = (struct buf *)arg;
diskaddr_t p_lba = (diskaddr_t)(uintptr_t)bp->b_private;
int error;
int syncflag = 0;
struct lofi_state *lsp;
offset_t offset;
caddr_t bufaddr;
size_t len;
size_t xfersize;
boolean_t bufinited = B_FALSE;
lsp = ddi_get_soft_state(lofi_statep,
LOFI_MINOR2ID(getminor(bp->b_edev)));
if (lsp == NULL) {
error = ENXIO;
goto errout;
}
if (lsp->ls_kstat) {
mutex_enter(lsp->ls_kstat->ks_lock);
kstat_waitq_to_runq(KSTAT_IO_PTR(lsp->ls_kstat));
mutex_exit(lsp->ls_kstat->ks_lock);
}
mutex_enter(&lsp->ls_vp_lock);
lsp->ls_vp_iocount++;
mutex_exit(&lsp->ls_vp_lock);
bp_mapin(bp);
bufaddr = bp->b_un.b_addr;
offset = (bp->b_lblkno + p_lba) << lsp->ls_lbshift;
if (lsp->ls_crypto_enabled) {
offset += lsp->ls_crypto_offset;
}
len = bp->b_bcount;
bufinited = B_TRUE;
if (lsp->ls_vp == NULL || lsp->ls_vp_closereq) {
error = EIO;
goto errout;
}
if (!(bp->b_flags & B_READ) && !(bp->b_flags & B_ASYNC))
syncflag = FSYNC;
if ((lsp->ls_vp->v_flag & VNOMAP) || (lsp->ls_vp->v_type == VCHR) ||
lsp->ls_crypto_enabled) {
error = lofi_rdwr(bufaddr, offset, bp, lsp, len, RDWR_RAW,
NULL);
} else if (lsp->ls_uncomp_seg_sz == 0) {
error = lofi_mapped_rdwr(bufaddr, offset, bp, lsp);
} else {
uchar_t *compressed_seg = NULL, *cmpbuf;
uchar_t *uncompressed_seg = NULL;
lofi_compress_info_t *li;
size_t oblkcount;
ulong_t seglen;
uint64_t sblkno, eblkno, cmpbytes;
uint64_t uncompressed_seg_index;
struct lofi_comp_cache *lc;
offset_t sblkoff, eblkoff;
u_offset_t salign, ealign;
u_offset_t sdiff;
uint32_t comp_data_sz;
uint64_t i;
int j;
ASSERT(!lsp->ls_crypto_enabled);
if (!(bp->b_flags & B_READ)) {
bp->b_resid = bp->b_bcount;
error = EROFS;
goto done;
}
ASSERT(lsp->ls_comp_algorithm_index >= 0);
li = &lofi_compress_table[lsp->ls_comp_algorithm_index];
sblkno = offset >> lsp->ls_comp_seg_shift;
sblkoff = offset & (lsp->ls_uncomp_seg_sz - 1);
eblkno = (offset + bp->b_bcount) >> lsp->ls_comp_seg_shift;
eblkoff = (offset + bp->b_bcount) & (lsp->ls_uncomp_seg_sz - 1);
if (sblkno == eblkno ||
(sblkno + 1 == eblkno && eblkoff == 0)) {
mutex_enter(&lsp->ls_comp_cache_lock);
lc = lofi_find_comp_data(lsp, sblkno);
if (lc != NULL) {
bcopy(lc->lc_data + sblkoff, bufaddr,
bp->b_bcount);
mutex_exit(&lsp->ls_comp_cache_lock);
bp->b_resid = 0;
error = 0;
goto done;
}
mutex_exit(&lsp->ls_comp_cache_lock);
}
salign = lsp->ls_comp_seg_index[sblkno];
sdiff = salign & (DEV_BSIZE - 1);
salign -= sdiff;
if (eblkno >= (lsp->ls_comp_index_sz - 1)) {
eblkoff = (offset + bp->b_bcount) &
(lsp->ls_uncomp_last_seg_sz - 1);
ealign = lsp->ls_vp_comp_size;
} else {
ealign = lsp->ls_comp_seg_index[eblkno + 1];
}
oblkcount = bp->b_bcount;
comp_data_sz = ealign - salign;
bp->b_bcount = comp_data_sz;
mutex_enter(&lsp->ls_comp_bufs_lock);
for (j = 0; j < lofi_taskq_nthreads; j++) {
if (lsp->ls_comp_bufs[j].inuse == 0) {
lsp->ls_comp_bufs[j].inuse = 1;
break;
}
}
mutex_exit(&lsp->ls_comp_bufs_lock);
ASSERT(j < lofi_taskq_nthreads);
if (lsp->ls_comp_bufs[j].bufsize < bp->b_bcount) {
if (lsp->ls_comp_bufs[j].bufsize > 0)
kmem_free(lsp->ls_comp_bufs[j].buf,
lsp->ls_comp_bufs[j].bufsize);
lsp->ls_comp_bufs[j].buf = kmem_alloc(bp->b_bcount,
KM_SLEEP);
lsp->ls_comp_bufs[j].bufsize = bp->b_bcount;
}
compressed_seg = lsp->ls_comp_bufs[j].buf;
error = lofi_mapped_rdwr((caddr_t)compressed_seg, salign,
bp, lsp);
bp->b_bcount = oblkcount;
bp->b_resid = oblkcount;
if (error != 0)
goto done;
cmpbuf = compressed_seg + sdiff;
for (i = sblkno; i <= eblkno; i++) {
ASSERT(i < lsp->ls_comp_index_sz - 1);
uchar_t *useg;
if (i == (lsp->ls_comp_index_sz - 2)) {
seglen = lsp->ls_uncomp_last_seg_sz;
} else {
seglen = lsp->ls_uncomp_seg_sz;
}
cmpbytes = lsp->ls_comp_seg_index[i + 1] -
lsp->ls_comp_seg_index[i];
if (*cmpbuf == UNCOMPRESSED) {
useg = cmpbuf + SEGHDR;
} else {
if (uncompressed_seg == NULL)
uncompressed_seg =
kmem_alloc(lsp->ls_uncomp_seg_sz,
KM_SLEEP);
useg = uncompressed_seg;
uncompressed_seg_index = i;
if (li->l_decompress((cmpbuf + SEGHDR),
(cmpbytes - SEGHDR), uncompressed_seg,
&seglen, li->l_level) != 0) {
error = EIO;
goto done;
}
}
xfersize = lsp->ls_uncomp_seg_sz - sblkoff;
if (i == eblkno)
xfersize -= (lsp->ls_uncomp_seg_sz - eblkoff);
bcopy((useg + sblkoff), bufaddr, xfersize);
cmpbuf += cmpbytes;
bufaddr += xfersize;
bp->b_resid -= xfersize;
sblkoff = 0;
if (bp->b_resid == 0)
break;
}
if (uncompressed_seg == NULL)
goto done;
mutex_enter(&lsp->ls_comp_cache_lock);
if ((lc = lofi_add_comp_data(lsp, uncompressed_seg_index,
uncompressed_seg)) != NULL) {
uncompressed_seg = NULL;
}
mutex_exit(&lsp->ls_comp_cache_lock);
done:
if (compressed_seg != NULL) {
mutex_enter(&lsp->ls_comp_bufs_lock);
lsp->ls_comp_bufs[j].inuse = 0;
mutex_exit(&lsp->ls_comp_bufs_lock);
}
if (uncompressed_seg != NULL)
kmem_free(uncompressed_seg, lsp->ls_uncomp_seg_sz);
}
if ((error == 0) && (syncflag != 0))
error = VOP_FSYNC(lsp->ls_vp, syncflag, kcred, NULL);
errout:
if (bufinited && lsp->ls_kstat) {
size_t n_done = bp->b_bcount - bp->b_resid;
kstat_io_t *kioptr;
mutex_enter(lsp->ls_kstat->ks_lock);
kioptr = KSTAT_IO_PTR(lsp->ls_kstat);
if (bp->b_flags & B_READ) {
kioptr->nread += n_done;
kioptr->reads++;
} else {
kioptr->nwritten += n_done;
kioptr->writes++;
}
kstat_runq_exit(kioptr);
mutex_exit(lsp->ls_kstat->ks_lock);
}
mutex_enter(&lsp->ls_vp_lock);
if (--lsp->ls_vp_iocount == 0)
cv_broadcast(&lsp->ls_vp_cv);
mutex_exit(&lsp->ls_vp_lock);
bioerror(bp, error);
biodone(bp);
}
static int
lofi_strategy_backend(struct buf *bp, task_func_t taskfunc)
{
struct lofi_state *lsp;
offset_t offset;
minor_t part;
diskaddr_t p_lba;
diskaddr_t p_nblks;
int shift;
lsp = ddi_get_soft_state(lofi_statep,
LOFI_MINOR2ID(getminor(bp->b_edev)));
part = LOFI_PART(getminor(bp->b_edev));
if (lsp == NULL) {
bioerror(bp, ENXIO);
biodone(bp);
return (0);
}
mutex_enter(&lsp->ls_vp_lock);
if (lsp->ls_vp == NULL || lsp->ls_vp_closereq) {
mutex_exit(&lsp->ls_vp_lock);
bioerror(bp, EIO);
biodone(bp);
return (0);
}
mutex_exit(&lsp->ls_vp_lock);
shift = lsp->ls_lbshift;
p_lba = 0;
p_nblks = lsp->ls_vp_size >> shift;
if (lsp->ls_cmlbhandle != NULL) {
if (cmlb_partinfo(lsp->ls_cmlbhandle, part, &p_nblks, &p_lba,
NULL, NULL, 0)) {
bioerror(bp, ENXIO);
biodone(bp);
return (0);
}
}
if (bp->b_lblkno > p_nblks) {
bioerror(bp, ENXIO);
biodone(bp);
return (0);
}
offset = (bp->b_lblkno + p_lba) << shift;
mutex_enter(&lsp->ls_vp_lock);
if (lsp->ls_crypto_enabled) {
offset += lsp->ls_crypto_offset;
}
if (offset == lsp->ls_vp_size ||
offset == (((p_lba + p_nblks) << shift) + lsp->ls_crypto_offset)) {
if ((bp->b_flags & B_READ) != 0) {
bp->b_resid = bp->b_bcount;
bioerror(bp, 0);
} else {
bioerror(bp, ENXIO);
}
biodone(bp);
mutex_exit(&lsp->ls_vp_lock);
return (0);
}
if ((offset > lsp->ls_vp_size) ||
(offset > (((p_lba + p_nblks) << shift) + lsp->ls_crypto_offset)) ||
((offset + bp->b_bcount) > ((p_lba + p_nblks) << shift))) {
bioerror(bp, ENXIO);
biodone(bp);
mutex_exit(&lsp->ls_vp_lock);
return (0);
}
mutex_exit(&lsp->ls_vp_lock);
if (lsp->ls_kstat) {
mutex_enter(lsp->ls_kstat->ks_lock);
kstat_waitq_enter(KSTAT_IO_PTR(lsp->ls_kstat));
mutex_exit(lsp->ls_kstat->ks_lock);
}
bp->b_private = (void *)(uintptr_t)p_lba;
(void) taskq_dispatch(lsp->ls_taskq, taskfunc, bp, KM_SLEEP);
return (0);
}
static int
lofi_strategy(struct buf *bp)
{
return (lofi_strategy_backend(bp, lofi_strategy_task));
}
static int
lofi_read(dev_t dev, struct uio *uio, struct cred *credp __unused)
{
if (getminor(dev) == 0)
return (EINVAL);
UIO_CHECK(uio);
return (physio(lofi_strategy, NULL, dev, B_READ, minphys, uio));
}
static int
lofi_write(dev_t dev, struct uio *uio, struct cred *credp __unused)
{
if (getminor(dev) == 0)
return (EINVAL);
UIO_CHECK(uio);
return (physio(lofi_strategy, NULL, dev, B_WRITE, minphys, uio));
}
static int
lofi_urw(struct lofi_state *lsp, uint16_t fmode, diskaddr_t off, size_t size,
intptr_t arg, int flag, cred_t *credp)
{
struct uio uio;
iovec_t iov;
if (size == 0 || size > 1024 * 1024 ||
(size % (1 << lsp->ls_lbshift)) != 0)
return (EINVAL);
iov.iov_base = (void *)arg;
iov.iov_len = size;
uio.uio_iov = &iov;
uio.uio_iovcnt = 1;
uio.uio_loffset = off;
uio.uio_segflg = (flag & FKIOCTL) ? UIO_SYSSPACE : UIO_USERSPACE;
uio.uio_llimit = MAXOFFSET_T;
uio.uio_resid = size;
uio.uio_fmode = fmode;
uio.uio_extflg = 0;
return (fmode == FREAD ?
lofi_read(lsp->ls_dev, &uio, credp) :
lofi_write(lsp->ls_dev, &uio, credp));
}
typedef struct {
struct lofi_state *lcd_lsp;
dev_t lcd_dev;
} lofi_cb_data_t;
static int
lofi_free_space_cb(dkioc_free_list_t *dfl, void *arg, int kmflag __unused)
{
dkioc_free_list_ext_t *ext;
lofi_cb_data_t *cbd = arg;
struct lofi_state *lsp = cbd->lcd_lsp;
buf_t *bp = NULL;
int error = 0;
bp = getrbuf(KM_SLEEP);
ext = dfl->dfl_exts;
for (uint_t i = 0; i < dfl->dfl_num_exts; i++, ext++) {
uint64_t start = dfl->dfl_offset + ext->dfle_start;
uint64_t length = ext->dfle_length;
bp->b_edev = cbd->lcd_dev;
bp->b_flags = B_WRITE;
bp->b_un.b_addr = NULL;
bp->b_resid = 0;
bp->b_lblkno = start >> lsp->ls_lbshift;
bp->b_bcount = length;
DTRACE_PROBE2(trim__issued, uint64_t, start, uint64_t, length);
error = lofi_strategy_backend(bp, lofi_trim_task);
if (error != 0)
break;
(void) biowait(bp);
}
freerbuf(bp);
dfl_free(dfl);
return (error);
}
static int
lofi_free_space(struct lofi_state *lsp, dkioc_free_list_t *dfl, dev_t dev)
{
dkioc_free_info_t dfi = {
.dfi_bshift = lsp->ls_lbshift,
.dfi_align = 1U << lsp->ls_lbshift,
.dfi_max_bytes = 0,
.dfi_max_ext = 0,
.dfi_max_ext_bytes = 0
};
lofi_cb_data_t cbd = {
.lcd_lsp = lsp,
.lcd_dev = dev
};
return (dfl_iter(dfl, &dfi, lsp->ls_vp_size, lofi_free_space_cb,
&cbd, KM_SLEEP));
}
static int
lofi_aread(dev_t dev, struct aio_req *aio, struct cred *credp __unused)
{
if (getminor(dev) == 0)
return (EINVAL);
UIO_CHECK(aio->aio_uio);
return (aphysio(lofi_strategy, anocancel, dev, B_READ, minphys, aio));
}
static int
lofi_awrite(dev_t dev, struct aio_req *aio, struct cred *credp __unused)
{
if (getminor(dev) == 0)
return (EINVAL);
UIO_CHECK(aio->aio_uio);
return (aphysio(lofi_strategy, anocancel, dev, B_WRITE, minphys, aio));
}
static int
lofi_info(dev_info_t *dip __unused, ddi_info_cmd_t infocmd, void *arg,
void **result)
{
struct lofi_state *lsp;
dev_t dev = (dev_t)arg;
int instance;
instance = LOFI_MINOR2ID(getminor(dev));
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
lsp = ddi_get_soft_state(lofi_statep, instance);
if (lsp == NULL)
return (DDI_FAILURE);
*result = lsp->ls_dip;
return (DDI_SUCCESS);
case DDI_INFO_DEVT2INSTANCE:
*result = (void *) (intptr_t)instance;
return (DDI_SUCCESS);
}
return (DDI_FAILURE);
}
static int
lofi_create_minor_nodes(struct lofi_state *lsp, boolean_t labeled)
{
int error = 0;
int instance = ddi_get_instance(lsp->ls_dip);
if (labeled == B_TRUE) {
cmlb_alloc_handle(&lsp->ls_cmlbhandle);
error = cmlb_attach(lsp->ls_dip, &lofi_tg_ops, DTYPE_DIRECT,
B_FALSE, B_FALSE, DDI_NT_BLOCK_CHAN,
CMLB_CREATE_P0_MINOR_NODE, lsp->ls_cmlbhandle, (void *)1);
if (error != DDI_SUCCESS) {
cmlb_free_handle(&lsp->ls_cmlbhandle);
lsp->ls_cmlbhandle = NULL;
error = ENXIO;
}
} else {
error = ddi_create_minor_node(lsp->ls_dip, LOFI_BLOCK_NODE,
S_IFBLK, LOFI_ID2MINOR(instance), DDI_PSEUDO, 0);
if (error == DDI_SUCCESS) {
error = ddi_create_minor_node(lsp->ls_dip,
LOFI_CHAR_NODE, S_IFCHR, LOFI_ID2MINOR(instance),
DDI_PSEUDO, 0);
if (error != DDI_SUCCESS) {
ddi_remove_minor_node(lsp->ls_dip,
LOFI_BLOCK_NODE);
error = ENXIO;
}
} else
error = ENXIO;
}
return (error);
}
static int
lofi_zone_bind(struct lofi_state *lsp)
{
int error = 0;
mutex_enter(&curproc->p_lock);
if ((error = rctl_incr_lofi(curproc, curproc->p_zone, 1)) != 0) {
mutex_exit(&curproc->p_lock);
return (error);
}
mutex_exit(&curproc->p_lock);
if (ddi_prop_update_string(DDI_DEV_T_NONE, lsp->ls_dip, ZONE_PROP_NAME,
(char *)curproc->p_zone->zone_name) != DDI_PROP_SUCCESS) {
rctl_decr_lofi(curproc->p_zone, 1);
error = EINVAL;
} else {
zone_init_ref(&lsp->ls_zone);
zone_hold_ref(curzone, &lsp->ls_zone, ZONE_REF_LOFI);
}
return (error);
}
static void
lofi_zone_unbind(struct lofi_state *lsp)
{
(void) ddi_prop_remove(DDI_DEV_T_NONE, lsp->ls_dip, ZONE_PROP_NAME);
rctl_decr_lofi(curproc->p_zone, 1);
zone_rele_ref(&lsp->ls_zone, ZONE_REF_LOFI);
}
static int
lofi_online_dev(dev_info_t *dip)
{
boolean_t labeled;
int error;
int instance = ddi_get_instance(dip);
struct lofi_state *lsp;
labeled = B_FALSE;
if (ddi_prop_exists(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS, "labeled"))
labeled = B_TRUE;
error = ddi_soft_state_zalloc(lofi_statep, instance);
if (error == DDI_FAILURE) {
return (ENOMEM);
}
lsp = ddi_get_soft_state(lofi_statep, instance);
lsp->ls_dip = dip;
if ((error = lofi_zone_bind(lsp)) != 0)
goto err;
cv_init(&lsp->ls_vp_cv, NULL, CV_DRIVER, NULL);
mutex_init(&lsp->ls_comp_cache_lock, NULL, MUTEX_DRIVER, NULL);
mutex_init(&lsp->ls_comp_bufs_lock, NULL, MUTEX_DRIVER, NULL);
mutex_init(&lsp->ls_kstat_lock, NULL, MUTEX_DRIVER, NULL);
mutex_init(&lsp->ls_vp_lock, NULL, MUTEX_DRIVER, NULL);
if ((error = lofi_create_minor_nodes(lsp, labeled)) != 0) {
lofi_zone_unbind(lsp);
goto lerr;
}
if (ddi_prop_create(DDI_DEV_T_NONE, dip, DDI_PROP_CANSLEEP,
DDI_KERNEL_IOCTL, NULL, 0) != DDI_PROP_SUCCESS) {
error = DDI_FAILURE;
goto merr;
}
lsp->ls_kstat = kstat_create_zone(LOFI_DRIVER_NAME, instance,
NULL, "disk", KSTAT_TYPE_IO, 1, 0, getzoneid());
if (lsp->ls_kstat == NULL) {
(void) ddi_prop_remove(DDI_DEV_T_NONE, lsp->ls_dip,
DDI_KERNEL_IOCTL);
error = ENOMEM;
goto merr;
}
lsp->ls_kstat->ks_lock = &lsp->ls_kstat_lock;
kstat_zone_add(lsp->ls_kstat, GLOBAL_ZONEID);
kstat_install(lsp->ls_kstat);
return (DDI_SUCCESS);
merr:
if (lsp->ls_cmlbhandle != NULL) {
cmlb_detach(lsp->ls_cmlbhandle, 0);
cmlb_free_handle(&lsp->ls_cmlbhandle);
}
ddi_remove_minor_node(dip, NULL);
lofi_zone_unbind(lsp);
lerr:
mutex_destroy(&lsp->ls_comp_cache_lock);
mutex_destroy(&lsp->ls_comp_bufs_lock);
mutex_destroy(&lsp->ls_kstat_lock);
mutex_destroy(&lsp->ls_vp_lock);
cv_destroy(&lsp->ls_vp_cv);
err:
ddi_soft_state_free(lofi_statep, instance);
return (error);
}
static int
lofi_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
int rv;
int instance = ddi_get_instance(dip);
struct lofi_state *lsp;
if (cmd != DDI_ATTACH)
return (DDI_FAILURE);
if (instance == 0) {
rv = ddi_soft_state_zalloc(lofi_statep, 0);
if (rv == DDI_FAILURE) {
return (DDI_FAILURE);
}
lsp = ddi_get_soft_state(lofi_statep, instance);
rv = ddi_create_minor_node(dip, LOFI_CTL_NODE, S_IFCHR, 0,
DDI_PSEUDO, 0);
if (rv == DDI_FAILURE) {
ddi_soft_state_free(lofi_statep, 0);
return (DDI_FAILURE);
}
if (ddi_prop_create(DDI_DEV_T_NONE, dip, DDI_PROP_CANSLEEP,
DDI_KERNEL_IOCTL, NULL, 0) != DDI_PROP_SUCCESS) {
ddi_remove_minor_node(dip, NULL);
ddi_soft_state_free(lofi_statep, 0);
return (DDI_FAILURE);
}
zone_key_create(&lofi_zone_key, NULL, lofi_zone_shutdown, NULL);
lsp->ls_dip = dip;
} else {
if (lofi_online_dev(dip) == DDI_FAILURE)
return (DDI_FAILURE);
}
ddi_report_dev(dip);
return (DDI_SUCCESS);
}
static int
lofi_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
struct lofi_state *lsp;
int instance = ddi_get_instance(dip);
if (cmd != DDI_DETACH)
return (DDI_FAILURE);
if (instance != 0) {
lsp = ddi_get_soft_state(lofi_statep, instance);
if (lsp != NULL && lsp->ls_vp_ready == B_FALSE) {
ddi_soft_state_free(lofi_statep, instance);
return (DDI_SUCCESS);
} else
return (DDI_FAILURE);
}
mutex_enter(&lofi_lock);
if (!list_is_empty(&lofi_list)) {
mutex_exit(&lofi_lock);
return (DDI_FAILURE);
}
ddi_remove_minor_node(dip, NULL);
ddi_prop_remove_all(dip);
mutex_exit(&lofi_lock);
if (zone_key_delete(lofi_zone_key) != 0)
cmn_err(CE_WARN, "failed to delete zone key");
ddi_soft_state_free(lofi_statep, 0);
return (DDI_SUCCESS);
}
static void
free_lofi_ioctl(struct lofi_ioctl *klip)
{
bzero(klip->li_key, sizeof (klip->li_key));
kmem_free(klip, sizeof (struct lofi_ioctl));
}
int
copy_in_lofi_ioctl(const struct lofi_ioctl *ulip, struct lofi_ioctl **klipp,
int flag)
{
struct lofi_ioctl *klip;
int error;
klip = *klipp = kmem_alloc(sizeof (struct lofi_ioctl), KM_SLEEP);
error = ddi_copyin(ulip, klip, sizeof (struct lofi_ioctl), flag);
if (error)
goto err;
klip->li_filename[MAXPATHLEN-1] = '\0';
klip->li_devpath[MAXPATHLEN-1] = '\0';
klip->li_algorithm[MAXALGLEN-1] = '\0';
klip->li_cipher[CRYPTO_MAX_MECH_NAME-1] = '\0';
klip->li_iv_cipher[CRYPTO_MAX_MECH_NAME-1] = '\0';
if (klip->li_id > L_MAXMIN32) {
error = EINVAL;
goto err;
}
return (0);
err:
free_lofi_ioctl(klip);
return (error);
}
int
copy_out_lofi_ioctl(const struct lofi_ioctl *klip, struct lofi_ioctl *ulip,
int flag)
{
int error;
error = ddi_copyout(klip, ulip, sizeof (struct lofi_ioctl), flag);
if (error)
return (EFAULT);
return (0);
}
static int
lofi_access(struct lofi_state *lsp)
{
ASSERT(MUTEX_HELD(&lofi_lock));
if (INGLOBALZONE(curproc) || lsp->ls_zone.zref_zone == curzone)
return (0);
return (EPERM);
}
static int
file_to_lofi_nocheck(char *filename, boolean_t readonly,
struct lofi_state **lspp)
{
struct lofi_state *lsp;
vnode_t *vp = NULL;
int err = 0;
int rdfiles = 0;
ASSERT(MUTEX_HELD(&lofi_lock));
if ((err = lookupname(filename, UIO_SYSSPACE, FOLLOW,
NULLVPP, &vp)) != 0)
goto out;
if (vp->v_type == VREG) {
vnode_t *realvp;
if (VOP_REALVP(vp, &realvp, NULL) == 0) {
VN_HOLD(realvp);
VN_RELE(vp);
vp = realvp;
}
}
for (lsp = list_head(&lofi_list); lsp != NULL;
lsp = list_next(&lofi_list, lsp)) {
if (lsp->ls_vp == vp) {
if (lspp != NULL)
*lspp = lsp;
if (lsp->ls_readonly) {
rdfiles++;
if (readonly)
continue;
}
goto out;
}
}
err = ENOENT;
if (lspp != NULL) {
if (rdfiles == 1)
err = 0;
else if (rdfiles > 1)
err = EBUSY;
}
out:
if (vp != NULL)
VN_RELE(vp);
return (err);
}
static int
file_to_lofi(char *filename, boolean_t readonly, struct lofi_state **lspp)
{
int err = 0;
ASSERT(MUTEX_HELD(&lofi_lock));
if ((err = file_to_lofi_nocheck(filename, readonly, lspp)) != 0)
return (err);
if ((err = lofi_access(*lspp)) != 0)
return (err);
return (0);
}
static void
fake_disk_geometry(struct lofi_state *lsp)
{
u_offset_t dsize = lsp->ls_vp_size - lsp->ls_crypto_offset;
bzero(&lsp->ls_dkg, sizeof (lsp->ls_dkg));
if (dsize < (2 * 1024 * 1024))
lsp->ls_dkg.dkg_ncyl = dsize / (100 * 1024);
else
lsp->ls_dkg.dkg_ncyl = dsize / (300 * 1024);
if (lsp->ls_dkg.dkg_ncyl == 0)
lsp->ls_dkg.dkg_ncyl = 1;
lsp->ls_dkg.dkg_pcyl = lsp->ls_dkg.dkg_ncyl;
lsp->ls_dkg.dkg_nhead = 1;
lsp->ls_dkg.dkg_rpm = 7200;
lsp->ls_dkg.dkg_nsect = dsize /
(lsp->ls_dkg.dkg_ncyl << lsp->ls_pbshift);
}
static void
fake_disk_vtoc(struct lofi_state *lsp, struct vtoc *vt)
{
bzero(vt, sizeof (struct vtoc));
vt->v_sanity = VTOC_SANE;
vt->v_version = V_VERSION;
(void) strncpy(vt->v_volume, LOFI_DRIVER_NAME,
sizeof (vt->v_volume));
vt->v_sectorsz = 1 << lsp->ls_pbshift;
vt->v_nparts = 1;
vt->v_part[0].p_tag = V_UNASSIGNED;
if (lsp->ls_uncomp_seg_sz > 0) {
vt->v_part[0].p_flag = V_UNMNT | V_RONLY;
} else {
vt->v_part[0].p_flag = V_UNMNT;
}
vt->v_part[0].p_start = (daddr_t)0;
vt->v_part[0].p_size = lsp->ls_dkg.dkg_pcyl *
lsp->ls_dkg.dkg_nsect * lsp->ls_dkg.dkg_nhead;
}
static void
fake_disk_info(dev_t dev, struct dk_cinfo *ci)
{
bzero(ci, sizeof (struct dk_cinfo));
(void) strlcpy(ci->dki_cname, LOFI_DRIVER_NAME, sizeof (ci->dki_cname));
ci->dki_ctype = DKC_SCSI_CCS;
(void) strlcpy(ci->dki_dname, LOFI_DRIVER_NAME, sizeof (ci->dki_dname));
ci->dki_unit = LOFI_MINOR2ID(getminor(dev));
ci->dki_partition = LOFI_PART(getminor(dev));
ci->dki_maxtransfer = 16;
}
static int
lofi_map_compressed_file(struct lofi_state *lsp, char *buf)
{
uint32_t index_sz, header_len, i;
ssize_t resid;
enum uio_rw rw;
char *tbuf = buf;
int error;
tbuf += sizeof (lsp->ls_comp_algorithm);
bcopy(tbuf, &(lsp->ls_uncomp_seg_sz), sizeof (lsp->ls_uncomp_seg_sz));
lsp->ls_uncomp_seg_sz = ntohl(lsp->ls_uncomp_seg_sz);
if (lsp->ls_uncomp_seg_sz < DEV_BSIZE ||
!ISP2(lsp->ls_uncomp_seg_sz))
return (EINVAL);
for (i = 0; !((lsp->ls_uncomp_seg_sz >> i) & 1); i++)
;
lsp->ls_comp_seg_shift = i;
tbuf += sizeof (lsp->ls_uncomp_seg_sz);
bcopy(tbuf, &(lsp->ls_comp_index_sz), sizeof (lsp->ls_comp_index_sz));
lsp->ls_comp_index_sz = ntohl(lsp->ls_comp_index_sz);
tbuf += sizeof (lsp->ls_comp_index_sz);
bcopy(tbuf, &(lsp->ls_uncomp_last_seg_sz),
sizeof (lsp->ls_uncomp_last_seg_sz));
lsp->ls_uncomp_last_seg_sz = ntohl(lsp->ls_uncomp_last_seg_sz);
lsp->ls_vp_size =
(u_offset_t)(lsp->ls_comp_index_sz - 2) * lsp->ls_uncomp_seg_sz
+ lsp->ls_uncomp_last_seg_sz;
index_sz = sizeof (*lsp->ls_comp_seg_index) * lsp->ls_comp_index_sz;
header_len = sizeof (lsp->ls_comp_algorithm) +
sizeof (lsp->ls_uncomp_seg_sz) +
sizeof (lsp->ls_comp_index_sz) +
sizeof (lsp->ls_uncomp_last_seg_sz);
lsp->ls_comp_offbase = header_len + index_sz;
index_sz += header_len;
index_sz = roundup(index_sz, DEV_BSIZE);
lsp->ls_comp_index_data = kmem_alloc(index_sz, KM_SLEEP);
lsp->ls_comp_index_data_sz = index_sz;
rw = UIO_READ;
error = vn_rdwr(rw, lsp->ls_vp, lsp->ls_comp_index_data, index_sz,
0, UIO_SYSSPACE, 0, RLIM64_INFINITY, kcred, &resid);
if (error != 0)
return (error);
lsp->ls_comp_seg_index =
(uint64_t *)(lsp->ls_comp_index_data + header_len);
for (i = 0; i < lsp->ls_comp_index_sz; i++) {
lsp->ls_comp_seg_index[i] = lsp->ls_comp_offbase +
BE_64(lsp->ls_comp_seg_index[i]);
}
return (error);
}
static int
lofi_init_crypto(struct lofi_state *lsp, struct lofi_ioctl *klip)
{
struct crypto_meta chead;
char buf[DEV_BSIZE];
ssize_t resid;
char *marker;
int error;
int ret;
int i;
if (!klip->li_crypto_enabled)
return (0);
if (klip->li_iv_len > CRYPTO_BITS2BYTES(512))
return (EINVAL);
if (CRYPTO_BITS2BYTES(klip->li_key_len) > sizeof (klip->li_key))
return (EINVAL);
lsp->ls_crypto_enabled = klip->li_crypto_enabled;
mutex_init(&lsp->ls_crypto_lock, NULL, MUTEX_DRIVER, NULL);
lsp->ls_mech.cm_type = crypto_mech2id(klip->li_cipher);
if (lsp->ls_mech.cm_type == CRYPTO_MECH_INVALID) {
cmn_err(CE_WARN, "invalid cipher %s requested for %s",
klip->li_cipher, klip->li_filename);
return (EINVAL);
}
lsp->ls_mech.cm_param = NULL;
lsp->ls_mech.cm_param_len = 0;
lsp->ls_iv_type = klip->li_iv_type;
lsp->ls_iv_mech.cm_type = crypto_mech2id(klip->li_iv_cipher);
if (lsp->ls_iv_mech.cm_type == CRYPTO_MECH_INVALID) {
cmn_err(CE_WARN, "invalid iv cipher %s requested"
" for %s", klip->li_iv_cipher, klip->li_filename);
return (EINVAL);
}
lsp->ls_iv_mech.cm_param = NULL;
lsp->ls_iv_mech.cm_param_len = 0;
lsp->ls_iv_len = klip->li_iv_len;
lsp->ls_key.ck_format = CRYPTO_KEY_RAW;
lsp->ls_key.ck_length = klip->li_key_len;
lsp->ls_key.ck_data = kmem_alloc(
CRYPTO_BITS2BYTES(lsp->ls_key.ck_length), KM_SLEEP);
bcopy(klip->li_key, lsp->ls_key.ck_data,
CRYPTO_BITS2BYTES(lsp->ls_key.ck_length));
ret = crypto_key_check(&lsp->ls_mech, &lsp->ls_key);
if (ret != CRYPTO_SUCCESS) {
cmn_err(CE_WARN, "weak key check failed for cipher "
"%s on file %s (0x%x)", klip->li_cipher,
klip->li_filename, ret);
return (EINVAL);
}
error = vn_rdwr(UIO_READ, lsp->ls_vp, buf, DEV_BSIZE,
CRYOFF, UIO_SYSSPACE, 0, RLIM64_INFINITY, kcred, &resid);
if (error != 0)
return (error);
if (strncmp(buf, lofi_crypto_magic, sizeof (lofi_crypto_magic)) == 0) {
marker = buf;
bcopy(marker, lsp->ls_crypto.magic,
sizeof (lsp->ls_crypto.magic));
marker += sizeof (lsp->ls_crypto.magic);
bcopy(marker, &(lsp->ls_crypto.version),
sizeof (lsp->ls_crypto.version));
lsp->ls_crypto.version = ntohs(lsp->ls_crypto.version);
marker += sizeof (lsp->ls_crypto.version);
bcopy(marker, lsp->ls_crypto.reserved1,
sizeof (lsp->ls_crypto.reserved1));
marker += sizeof (lsp->ls_crypto.reserved1);
bcopy(marker, &(lsp->ls_crypto.data_sector),
sizeof (lsp->ls_crypto.data_sector));
lsp->ls_crypto.data_sector = ntohl(lsp->ls_crypto.data_sector);
marker += sizeof (lsp->ls_crypto.data_sector);
lsp->ls_crypto_offset = lsp->ls_crypto.data_sector * DEV_BSIZE;
return (0);
}
for (i = 0; i < sizeof (struct crypto_meta); i++) {
if (buf[i] != '\0')
return (EINVAL);
}
marker = buf;
bcopy(lofi_crypto_magic, marker, sizeof (lofi_crypto_magic));
marker += sizeof (lofi_crypto_magic);
chead.version = htons(LOFI_CRYPTO_VERSION);
bcopy(&(chead.version), marker, sizeof (chead.version));
marker += sizeof (chead.version);
marker += sizeof (chead.reserved1);
chead.data_sector = htonl(LOFI_CRYPTO_DATA_SECTOR);
bcopy(&(chead.data_sector), marker, sizeof (chead.data_sector));
error = vn_rdwr(UIO_WRITE, lsp->ls_vp, buf, DEV_BSIZE,
CRYOFF, UIO_SYSSPACE, 0, RLIM64_INFINITY, kcred, &resid);
if (error != 0)
return (error);
bcopy(lofi_crypto_magic, lsp->ls_crypto.magic,
sizeof (lofi_crypto_magic));
lsp->ls_crypto.version = LOFI_CRYPTO_VERSION;
lsp->ls_crypto.data_sector = LOFI_CRYPTO_DATA_SECTOR;
lsp->ls_crypto_offset = lsp->ls_crypto.data_sector * DEV_BSIZE;
return (0);
}
static int
lofi_compress_select(const char *signature)
{
int i;
for (i = 0; i < LOFI_COMPRESS_FUNCTIONS; i++) {
if (strcmp(lofi_compress_table[i].l_name, signature) == 0)
return (i);
}
return (-1);
}
static int
lofi_init_compress(struct lofi_state *lsp)
{
char buf[DEV_BSIZE];
int compress_index;
ssize_t resid;
int error;
error = vn_rdwr(UIO_READ, lsp->ls_vp, buf, DEV_BSIZE, 0, UIO_SYSSPACE,
0, RLIM64_INFINITY, kcred, &resid);
if (error != 0)
return (error);
if ((compress_index = lofi_compress_select(buf)) == -1)
return (0);
if (lsp->ls_crypto_enabled)
return (ENOTSUP);
lsp->ls_comp_algorithm_index = compress_index;
(void) strlcpy(lsp->ls_comp_algorithm,
lofi_compress_table[compress_index].l_name,
sizeof (lsp->ls_comp_algorithm));
lsp->ls_comp_bufs = kmem_zalloc(lofi_taskq_nthreads *
sizeof (struct compbuf), KM_SLEEP);
return (lofi_map_compressed_file(lsp, buf));
}
static int
lofi_alloc_id(int *idp)
{
int id, error = DDI_SUCCESS;
if (*idp == -1) {
id = id_allocff_nosleep(lofi_id);
if (id == -1) {
error = EAGAIN;
goto err;
}
} else if (*idp == 0) {
error = EINVAL;
goto err;
} else if (*idp > ((1 << (L_BITSMINOR - LOFI_CMLB_SHIFT)) - 1)) {
error = ERANGE;
goto err;
} else {
if (ddi_get_soft_state(lofi_statep, *idp) != NULL) {
error = EEXIST;
goto err;
}
id = id_alloc_specific_nosleep(lofi_id, *idp);
if (id == -1) {
error = EAGAIN;
goto err;
}
}
*idp = id;
err:
return (error);
}
static int
lofi_create_dev(struct lofi_ioctl *klip)
{
dev_info_t *parent, *child;
struct lofi_state *lsp = NULL;
char namebuf[MAXNAMELEN];
int error;
lsp = ddi_get_soft_state(lofi_statep, 0);
parent = ddi_get_parent(lsp->ls_dip);
if ((error = lofi_alloc_id((int *)&klip->li_id)))
return (error);
(void) snprintf(namebuf, sizeof (namebuf), LOFI_DRIVER_NAME "@%d",
klip->li_id);
ndi_devi_enter(parent);
child = ndi_devi_findchild(parent, namebuf);
ndi_devi_exit(parent);
if (child == NULL) {
child = ddi_add_child(parent, LOFI_DRIVER_NAME,
(pnode_t)DEVI_SID_NODEID, klip->li_id);
if ((error = ddi_prop_update_int(DDI_DEV_T_NONE, child,
"instance", klip->li_id)) != DDI_PROP_SUCCESS)
goto err;
if (klip->li_labeled == B_TRUE) {
if ((error = ddi_prop_create(DDI_DEV_T_NONE, child,
DDI_PROP_CANSLEEP, "labeled", 0, 0))
!= DDI_PROP_SUCCESS)
goto err;
}
if ((error = ndi_devi_online(child, NDI_ONLINE_ATTACH))
!= NDI_SUCCESS)
goto err;
} else {
id_free(lofi_id, klip->li_id);
error = EEXIST;
return (error);
}
goto done;
err:
ddi_prop_remove_all(child);
(void) ndi_devi_offline(child, NDI_DEVI_REMOVE);
id_free(lofi_id, klip->li_id);
done:
return (error);
}
static void
lofi_create_inquiry(struct lofi_state *lsp, struct scsi_inquiry *inq)
{
char *p = NULL;
(void) strlcpy(inq->inq_vid, LOFI_DRIVER_NAME, sizeof (inq->inq_vid));
mutex_enter(&lsp->ls_vp_lock);
if (lsp->ls_vp != NULL)
p = strrchr(lsp->ls_vp->v_path, '/');
if (p != NULL)
(void) strncpy(inq->inq_pid, p + 1, sizeof (inq->inq_pid));
mutex_exit(&lsp->ls_vp_lock);
(void) strlcpy(inq->inq_revision, "1.0", sizeof (inq->inq_revision));
}
static void
lofi_copy_devpath(struct lofi_ioctl *klip)
{
int error;
char namebuf[MAXNAMELEN], *str;
clock_t ticks;
nvlist_t *nvl = NULL;
if (klip->li_labeled == B_TRUE)
klip->li_devpath[0] = '\0';
else {
(void) snprintf(klip->li_devpath, sizeof (klip->li_devpath),
"/dev/" LOFI_CHAR_NAME "/%d", klip->li_id);
return;
}
(void) snprintf(namebuf, sizeof (namebuf), "%d", klip->li_id);
mutex_enter(&lofi_devlink_cache.ln_lock);
for (;;) {
error = nvlist_lookup_nvlist(lofi_devlink_cache.ln_data,
namebuf, &nvl);
if (error == 0 &&
nvlist_lookup_string(nvl, DEV_NAME, &str) == 0 &&
strncmp(str, "/dev/" LOFI_CHAR_NAME,
sizeof ("/dev/" LOFI_CHAR_NAME) - 1) != 0) {
(void) strlcpy(klip->li_devpath, str,
sizeof (klip->li_devpath));
break;
}
ticks = ddi_get_lbolt() + lofi_timeout * drv_usectohz(1000000);
error = cv_timedwait(&lofi_devlink_cache.ln_cv,
&lofi_devlink_cache.ln_lock, ticks);
if (error == -1)
break;
}
mutex_exit(&lofi_devlink_cache.ln_lock);
}
static int
lofi_map_file(dev_t dev, struct lofi_ioctl *ulip, int pickminor,
int *rvalp, struct cred *credp, int ioctl_flag)
{
int id = -1;
struct lofi_state *lsp = NULL;
struct lofi_ioctl *klip;
int error, canfree;
struct vnode *vp = NULL;
vattr_t vattr;
int flag = 0;
char namebuf[MAXNAMELEN];
error = copy_in_lofi_ioctl(ulip, &klip, ioctl_flag);
if (error != 0)
return (error);
mutex_enter(&lofi_lock);
if (file_to_lofi_nocheck(klip->li_filename, klip->li_readonly,
NULL) == 0) {
error = EBUSY;
goto err;
}
flag = FREAD | FWRITE | FOFFMAX | FEXCL;
error = vn_open(klip->li_filename, UIO_SYSSPACE, flag, 0, &vp, 0, 0);
if (error) {
flag &= ~FWRITE;
error = vn_open(klip->li_filename, UIO_SYSSPACE, flag, 0,
&vp, 0, 0);
if (error)
goto err;
}
if (!V_ISLOFIABLE(vp->v_type)) {
error = EINVAL;
goto err;
}
vattr.va_mask = AT_SIZE;
error = VOP_GETATTR(vp, &vattr, 0, credp, NULL);
if (error)
goto err;
if ((vattr.va_size % DEV_BSIZE) != 0) {
error = EINVAL;
goto err;
}
if (pickminor) {
klip->li_id = (uint32_t)-1;
}
if ((error = lofi_create_dev(klip)) != 0)
goto err;
id = klip->li_id;
lsp = ddi_get_soft_state(lofi_statep, id);
if (lsp == NULL)
goto err;
list_insert_tail(&lofi_list, lsp);
lsp->ls_dev = makedevice(getmajor(dev), LOFI_ID2MINOR(id));
list_create(&lsp->ls_comp_cache, sizeof (struct lofi_comp_cache),
offsetof(struct lofi_comp_cache, lc_list));
lsp->ls_openflag = flag;
lsp->ls_vp = vp;
lsp->ls_stacked_vp = vp;
lsp->ls_vp_size = vattr.va_size;
lsp->ls_vp_comp_size = lsp->ls_vp_size;
if (vp->v_type == VREG) {
vnode_t *realvp;
if (VOP_REALVP(vp, &realvp, NULL) == 0) {
VN_HOLD(realvp);
lsp->ls_vp = realvp;
}
}
lsp->ls_lbshift = highbit(DEV_BSIZE) - 1;
lsp->ls_pbshift = lsp->ls_lbshift;
lsp->ls_readonly = klip->li_readonly;
lsp->ls_uncomp_seg_sz = 0;
lsp->ls_comp_algorithm[0] = '\0';
lsp->ls_crypto_offset = 0;
(void) snprintf(namebuf, sizeof (namebuf), "%s_taskq_%d",
LOFI_DRIVER_NAME, id);
lsp->ls_taskq = taskq_create_proc(namebuf, lofi_taskq_nthreads,
minclsyspri, 1, lofi_taskq_maxalloc, curzone->zone_zsched, 0);
if ((error = lofi_init_crypto(lsp, klip)) != 0)
goto err;
if ((error = lofi_init_compress(lsp)) != 0)
goto err;
fake_disk_geometry(lsp);
if (klip->li_labeled == B_FALSE) {
error = ddi_prop_update_int64(lsp->ls_dev, lsp->ls_dip,
SIZE_PROP_NAME, lsp->ls_vp_size - lsp->ls_crypto_offset);
if (error != DDI_PROP_SUCCESS) {
error = EINVAL;
goto err;
}
error = ddi_prop_update_int64(lsp->ls_dev, lsp->ls_dip,
NBLOCKS_PROP_NAME,
(lsp->ls_vp_size - lsp->ls_crypto_offset) / DEV_BSIZE);
if (error != DDI_PROP_SUCCESS) {
error = EINVAL;
goto err;
}
}
if (lsp->ls_vp->v_type == VCHR || lsp->ls_vp->v_type == VBLK) {
if (VOP_IOCTL(lsp->ls_vp, DKIOC_CANFREE, (intptr_t)&canfree,
FKIOCTL, kcred, &error, NULL) != 0) {
canfree = 0;
}
} else {
canfree = 1;
}
if (lsp->ls_readonly)
canfree = 0;
lsp->ls_canfree = (canfree != 0);
mutex_enter(&lsp->ls_vp_lock);
lsp->ls_vp_ready = B_TRUE;
cv_broadcast(&lsp->ls_vp_cv);
mutex_exit(&lsp->ls_vp_lock);
if (lsp->ls_cmlbhandle != NULL) {
(void) cmlb_validate(lsp->ls_cmlbhandle, 0, 0);
}
mutex_exit(&lofi_lock);
lofi_copy_devpath(klip);
if (rvalp)
*rvalp = id;
(void) copy_out_lofi_ioctl(klip, ulip, ioctl_flag);
free_lofi_ioctl(klip);
return (0);
err:
if (lsp != NULL) {
lofi_destroy(lsp, credp);
} else {
if (vp != NULL) {
(void) VOP_PUTPAGE(vp, 0, 0, B_FREE, credp, NULL);
(void) VOP_CLOSE(vp, flag, 1, 0, credp, NULL);
VN_RELE(vp);
}
}
mutex_exit(&lofi_lock);
free_lofi_ioctl(klip);
return (error);
}
static int
lofi_unmap_file(struct lofi_ioctl *ulip, int byfilename,
struct cred *credp, int ioctl_flag)
{
struct lofi_state *lsp;
struct lofi_ioctl *klip;
char namebuf[MAXNAMELEN];
int err;
err = copy_in_lofi_ioctl(ulip, &klip, ioctl_flag);
if (err != 0)
return (err);
mutex_enter(&lofi_lock);
if (byfilename) {
if ((err = file_to_lofi(klip->li_filename, klip->li_readonly,
&lsp)) != 0) {
goto done;
}
} else if (klip->li_id == 0) {
err = ENXIO;
goto done;
} else {
lsp = ddi_get_soft_state(lofi_statep, klip->li_id);
}
if (lsp == NULL || lsp->ls_vp == NULL || lofi_access(lsp) != 0) {
err = ENXIO;
goto done;
}
klip->li_id = LOFI_MINOR2ID(getminor(lsp->ls_dev));
(void) snprintf(namebuf, sizeof (namebuf), "%u", klip->li_id);
if (is_opened(lsp)) {
if (klip->li_force) {
lofi_set_cleanup(lsp);
mutex_enter(&lsp->ls_vp_lock);
lsp->ls_vp_closereq = B_TRUE;
cv_broadcast(&lsp->ls_vp_cv);
while (lsp->ls_vp_iocount > 0)
cv_wait(&lsp->ls_vp_cv, &lsp->ls_vp_lock);
mutex_exit(&lsp->ls_vp_lock);
} else if (klip->li_cleanup) {
lofi_set_cleanup(lsp);
} else {
err = EBUSY;
}
} else {
lofi_free_dev(lsp);
lofi_destroy(lsp, credp);
}
mutex_enter(&lofi_devlink_cache.ln_lock);
(void) nvlist_remove_all(lofi_devlink_cache.ln_data, namebuf);
cv_broadcast(&lofi_devlink_cache.ln_cv);
mutex_exit(&lofi_devlink_cache.ln_lock);
done:
mutex_exit(&lofi_lock);
if (err == 0)
(void) copy_out_lofi_ioctl(klip, ulip, ioctl_flag);
free_lofi_ioctl(klip);
return (err);
}
static int
lofi_get_info(dev_t dev __unused, struct lofi_ioctl *ulip, int which,
struct cred *credp __unused, int ioctl_flag)
{
struct lofi_ioctl *klip;
struct lofi_state *lsp;
int error;
error = copy_in_lofi_ioctl(ulip, &klip, ioctl_flag);
if (error != 0)
return (error);
switch (which) {
case LOFI_GET_FILENAME:
if (klip->li_id == 0) {
free_lofi_ioctl(klip);
return (EINVAL);
}
mutex_enter(&lofi_lock);
lsp = ddi_get_soft_state(lofi_statep, klip->li_id);
if (lsp == NULL || lofi_access(lsp) != 0) {
mutex_exit(&lofi_lock);
free_lofi_ioctl(klip);
return (ENXIO);
}
if (lsp->ls_stacked_vp == NULL ||
vnodetopath(NULL, lsp->ls_stacked_vp, klip->li_filename,
sizeof (klip->li_filename), CRED()) != 0) {
(void) strlcpy(klip->li_filename, "?",
sizeof (klip->li_filename));
}
klip->li_readonly = lsp->ls_readonly;
klip->li_labeled = lsp->ls_cmlbhandle != NULL;
(void) strlcpy(klip->li_algorithm, lsp->ls_comp_algorithm,
sizeof (klip->li_algorithm));
klip->li_crypto_enabled = lsp->ls_crypto_enabled;
mutex_exit(&lofi_lock);
lofi_copy_devpath(klip);
error = copy_out_lofi_ioctl(klip, ulip, ioctl_flag);
free_lofi_ioctl(klip);
return (error);
case LOFI_GET_MINOR:
mutex_enter(&lofi_lock);
error = file_to_lofi(klip->li_filename,
klip->li_readonly, &lsp);
if (error != 0) {
mutex_exit(&lofi_lock);
free_lofi_ioctl(klip);
return (error);
}
klip->li_id = LOFI_MINOR2ID(getminor(lsp->ls_dev));
klip->li_readonly = lsp->ls_readonly;
klip->li_labeled = lsp->ls_cmlbhandle != NULL;
mutex_exit(&lofi_lock);
lofi_copy_devpath(klip);
error = copy_out_lofi_ioctl(klip, ulip, ioctl_flag);
free_lofi_ioctl(klip);
return (error);
case LOFI_CHECK_COMPRESSED:
mutex_enter(&lofi_lock);
error = file_to_lofi(klip->li_filename,
klip->li_readonly, &lsp);
if (error != 0) {
mutex_exit(&lofi_lock);
free_lofi_ioctl(klip);
return (error);
}
klip->li_id = LOFI_MINOR2ID(getminor(lsp->ls_dev));
(void) strlcpy(klip->li_algorithm, lsp->ls_comp_algorithm,
sizeof (klip->li_algorithm));
mutex_exit(&lofi_lock);
error = copy_out_lofi_ioctl(klip, ulip, ioctl_flag);
free_lofi_ioctl(klip);
return (error);
default:
free_lofi_ioctl(klip);
return (EINVAL);
}
}
static int
uscsi_is_inquiry(intptr_t arg, int flag, union scsi_cdb *cdb,
struct uscsi_cmd *uscmd)
{
int rval;
#ifdef _MULTI_DATAMODEL
switch (ddi_model_convert_from(flag & FMODELS)) {
case DDI_MODEL_ILP32: {
struct uscsi_cmd32 ucmd32;
if (ddi_copyin((void *)arg, &ucmd32, sizeof (ucmd32), flag)) {
rval = EFAULT;
goto err;
}
uscsi_cmd32touscsi_cmd((&ucmd32), uscmd);
break;
}
case DDI_MODEL_NONE:
if (ddi_copyin((void *)arg, uscmd, sizeof (*uscmd), flag)) {
rval = EFAULT;
goto err;
}
break;
default:
rval = EFAULT;
goto err;
}
#else
if (ddi_copyin((void *)arg, uscmd, sizeof (*uscmd), flag)) {
rval = EFAULT;
goto err;
}
#endif
if (ddi_copyin(uscmd->uscsi_cdb, cdb, uscmd->uscsi_cdblen, flag)) {
rval = EFAULT;
goto err;
}
if (cdb->scc_cmd == SCMD_INQUIRY) {
return (0);
}
err:
return (rval);
}
static int
lofi_ioctl(dev_t dev, int cmd, intptr_t arg, int flag, cred_t *credp,
int *rvalp)
{
int error;
enum dkio_state dkstate;
struct lofi_state *lsp;
dk_efi_t user_efi;
int id;
id = LOFI_MINOR2ID(getminor(dev));
if (id == 0) {
struct lofi_ioctl *lip = (struct lofi_ioctl *)arg;
switch (cmd) {
case LOFI_MAP_FILE:
if ((flag & FWRITE) == 0)
return (EPERM);
return (lofi_map_file(dev, lip, 1, rvalp, credp, flag));
case LOFI_MAP_FILE_MINOR:
if ((flag & FWRITE) == 0)
return (EPERM);
return (lofi_map_file(dev, lip, 0, rvalp, credp, flag));
case LOFI_UNMAP_FILE:
if ((flag & FWRITE) == 0)
return (EPERM);
return (lofi_unmap_file(lip, 1, credp, flag));
case LOFI_UNMAP_FILE_MINOR:
if ((flag & FWRITE) == 0)
return (EPERM);
return (lofi_unmap_file(lip, 0, credp, flag));
case LOFI_GET_FILENAME:
return (lofi_get_info(dev, lip, LOFI_GET_FILENAME,
credp, flag));
case LOFI_GET_MINOR:
return (lofi_get_info(dev, lip, LOFI_GET_MINOR,
credp, flag));
case LOFI_GET_MAXMINOR:
id = 0;
mutex_enter(&lofi_lock);
for (lsp = list_head(&lofi_list); lsp != NULL;
lsp = list_next(&lofi_list, lsp)) {
int i;
if (lofi_access(lsp) != 0)
continue;
i = ddi_get_instance(lsp->ls_dip);
if (i > id)
id = i;
}
mutex_exit(&lofi_lock);
error = ddi_copyout(&id, &lip->li_id,
sizeof (id), flag);
if (error)
return (EFAULT);
return (0);
case LOFI_CHECK_COMPRESSED:
return (lofi_get_info(dev, lip, LOFI_CHECK_COMPRESSED,
credp, flag));
default:
return (EINVAL);
}
}
mutex_enter(&lofi_lock);
lsp = ddi_get_soft_state(lofi_statep, id);
if (lsp == NULL || lsp->ls_cleanup) {
mutex_exit(&lofi_lock);
return (ENXIO);
}
mutex_exit(&lofi_lock);
if (ddi_prop_exists(DDI_DEV_T_ANY, lsp->ls_dip, DDI_PROP_DONTPASS,
"labeled") == 1) {
error = cmlb_ioctl(lsp->ls_cmlbhandle, dev, cmd, arg, flag,
credp, rvalp, 0);
if (error != ENOTTY)
return (error);
}
if (lsp->ls_vp == NULL && cmd != DKIOCSTATE)
return (EIO);
switch (cmd) {
case DKIOCGMEDIAINFO:
case DKIOCGMEDIAINFOEXT: {
struct dk_minfo_ext media_info;
int shift = lsp->ls_lbshift;
int size;
if (cmd == DKIOCGMEDIAINFOEXT) {
media_info.dki_pbsize = 1U << lsp->ls_pbshift;
switch (ddi_model_convert_from(flag & FMODELS)) {
case DDI_MODEL_ILP32:
size = sizeof (struct dk_minfo_ext32);
break;
default:
size = sizeof (struct dk_minfo_ext);
break;
}
} else {
size = sizeof (struct dk_minfo);
}
media_info.dki_media_type = DK_FIXED_DISK;
media_info.dki_lbsize = 1U << shift;
media_info.dki_capacity =
(lsp->ls_vp_size - lsp->ls_crypto_offset) >> shift;
if (ddi_copyout(&media_info, (void *)arg, size, flag))
return (EFAULT);
return (0);
}
case DKIOCREMOVABLE: {
int i = 0;
if (ddi_copyout(&i, (caddr_t)arg, sizeof (int), flag))
return (EFAULT);
return (0);
}
case DKIOCGVTOC: {
struct vtoc vt;
fake_disk_vtoc(lsp, &vt);
switch (ddi_model_convert_from(flag & FMODELS)) {
case DDI_MODEL_ILP32: {
struct vtoc32 vtoc32;
vtoctovtoc32(vt, vtoc32);
if (ddi_copyout(&vtoc32, (void *)arg,
sizeof (struct vtoc32), flag))
return (EFAULT);
break;
}
case DDI_MODEL_NONE:
if (ddi_copyout(&vt, (void *)arg,
sizeof (struct vtoc), flag))
return (EFAULT);
break;
}
return (0);
}
case DKIOCINFO: {
struct dk_cinfo ci;
fake_disk_info(dev, &ci);
if (ddi_copyout(&ci, (void *)arg, sizeof (ci), flag))
return (EFAULT);
return (0);
}
case DKIOCG_VIRTGEOM:
case DKIOCG_PHYGEOM:
case DKIOCGGEOM:
error = ddi_copyout(&lsp->ls_dkg, (void *)arg,
sizeof (struct dk_geom), flag);
if (error)
return (EFAULT);
return (0);
case DKIOCSTATE:
if (ddi_copyin((void *)arg, &dkstate, sizeof (dkstate),
flag) != 0)
return (EFAULT);
mutex_enter(&lsp->ls_vp_lock);
while (((dkstate == DKIO_INSERTED && lsp->ls_vp != NULL) ||
(dkstate == DKIO_DEV_GONE && lsp->ls_vp == NULL)) &&
!lsp->ls_cleanup) {
if (!cv_wait_sig(&lsp->ls_vp_cv, &lsp->ls_vp_lock)) {
mutex_exit(&lsp->ls_vp_lock);
return (EINTR);
}
}
dkstate = (!lsp->ls_cleanup && lsp->ls_vp != NULL ?
DKIO_INSERTED : DKIO_DEV_GONE);
mutex_exit(&lsp->ls_vp_lock);
if (ddi_copyout(&dkstate, (void *)arg,
sizeof (dkstate), flag) != 0)
return (EFAULT);
return (0);
case USCSICMD: {
struct uscsi_cmd uscmd;
union scsi_cdb cdb;
if (uscsi_is_inquiry(arg, flag, &cdb, &uscmd) == 0) {
struct scsi_inquiry inq = {0};
lofi_create_inquiry(lsp, &inq);
if (ddi_copyout(&inq, uscmd.uscsi_bufaddr,
uscmd.uscsi_buflen, flag) != 0)
return (EFAULT);
return (0);
} else if (cdb.scc_cmd == SCMD_READ_CAPACITY) {
struct scsi_capacity capacity;
capacity.capacity =
BE_32((lsp->ls_vp_size - lsp->ls_crypto_offset) >>
lsp->ls_lbshift);
capacity.lbasize = BE_32(1 << lsp->ls_lbshift);
if (ddi_copyout(&capacity, uscmd.uscsi_bufaddr,
uscmd.uscsi_buflen, flag) != 0)
return (EFAULT);
return (0);
}
uscmd.uscsi_rqstatus = 0xff;
#ifdef _MULTI_DATAMODEL
switch (ddi_model_convert_from(flag & FMODELS)) {
case DDI_MODEL_ILP32: {
struct uscsi_cmd32 ucmd32;
uscsi_cmdtouscsi_cmd32((&uscmd), (&ucmd32));
if (ddi_copyout(&ucmd32, (void *)arg, sizeof (ucmd32),
flag) != 0)
return (EFAULT);
break;
}
case DDI_MODEL_NONE:
if (ddi_copyout(&uscmd, (void *)arg, sizeof (uscmd),
flag) != 0)
return (EFAULT);
break;
default:
return (EFAULT);
}
#else
if (ddi_copyout(&uscmd, (void *)arg, sizeof (uscmd), flag) != 0)
return (EFAULT);
#endif
return (0);
}
case DKIOCGMBOOT:
return (lofi_urw(lsp, FREAD, 0, 1 << lsp->ls_lbshift,
arg, flag, credp));
case DKIOCSMBOOT:
return (lofi_urw(lsp, FWRITE, 0, 1 << lsp->ls_lbshift,
arg, flag, credp));
case DKIOCGETEFI:
if (ddi_copyin((void *)arg, &user_efi,
sizeof (dk_efi_t), flag) != 0)
return (EFAULT);
return (lofi_urw(lsp, FREAD,
user_efi.dki_lba * (1 << lsp->ls_lbshift),
user_efi.dki_length, (intptr_t)user_efi.dki_data,
flag, credp));
case DKIOCSETEFI:
if (ddi_copyin((void *)arg, &user_efi,
sizeof (dk_efi_t), flag) != 0)
return (EFAULT);
return (lofi_urw(lsp, FWRITE,
user_efi.dki_lba * (1 << lsp->ls_lbshift),
user_efi.dki_length, (intptr_t)user_efi.dki_data,
flag, credp));
case DKIOC_CANFREE: {
int canfree = lsp->ls_canfree ? 1 : 0;
if (ddi_copyout(&canfree, (void *)arg, sizeof (canfree), flag))
return (EFAULT);
return (0);
}
case DKIOCFREE: {
dkioc_free_list_t *dfl;
if (!lsp->ls_canfree)
return (ENOTSUP);
error = dfl_copyin((void *)arg, &dfl, flag, KM_SLEEP);
if (error != 0)
return (error);
return (lofi_free_space(lsp, dfl, dev));
}
default:
#ifdef DEBUG
cmn_err(CE_WARN, "lofi_ioctl: %d is not implemented\n", cmd);
#endif
return (ENOTTY);
}
}
static int
lofi_prop_op(dev_t dev, dev_info_t *dip, ddi_prop_op_t prop_op, int mod_flags,
char *name, caddr_t valuep, int *lengthp)
{
struct lofi_state *lsp;
int rc;
lsp = ddi_get_soft_state(lofi_statep, ddi_get_instance(dip));
if (lsp == NULL) {
return (ddi_prop_op(dev, dip, prop_op, mod_flags,
name, valuep, lengthp));
}
rc = cmlb_prop_op(lsp->ls_cmlbhandle, dev, dip, prop_op, mod_flags,
name, valuep, lengthp, LOFI_PART(getminor(dev)), NULL);
if (rc == DDI_PROP_SUCCESS)
return (rc);
return (ddi_prop_op(DDI_DEV_T_ANY, dip, prop_op, mod_flags,
name, valuep, lengthp));
}
static struct cb_ops lofi_cb_ops = {
lofi_open,
lofi_close,
lofi_strategy,
nodev,
nodev,
lofi_read,
lofi_write,
lofi_ioctl,
nodev,
nodev,
nodev,
nochpoll,
lofi_prop_op,
0,
D_64BIT | D_NEW | D_MP,
CB_REV,
lofi_aread,
lofi_awrite
};
static struct dev_ops lofi_ops = {
DEVO_REV,
0,
lofi_info,
nulldev,
nulldev,
lofi_attach,
lofi_detach,
nodev,
&lofi_cb_ops,
NULL,
NULL,
ddi_quiesce_not_needed,
};
static struct modldrv modldrv = {
&mod_driverops,
"loopback file driver",
&lofi_ops,
};
static struct modlinkage modlinkage = {
MODREV_1,
&modldrv,
NULL
};
int
_init(void)
{
int error;
list_create(&lofi_list, sizeof (struct lofi_state),
offsetof(struct lofi_state, ls_list));
error = ddi_soft_state_init((void **)&lofi_statep,
sizeof (struct lofi_state), 0);
if (error) {
list_destroy(&lofi_list);
return (error);
}
lofi_id = id_space_create("lofi_id", 1,
(1 << (L_BITSMINOR - LOFI_CMLB_SHIFT)));
if (lofi_id == NULL) {
ddi_soft_state_fini((void **)&lofi_statep);
list_destroy(&lofi_list);
return (DDI_FAILURE);
}
mutex_init(&lofi_lock, NULL, MUTEX_DRIVER, NULL);
error = mod_install(&modlinkage);
if (error) {
id_space_destroy(lofi_id);
mutex_destroy(&lofi_lock);
ddi_soft_state_fini((void **)&lofi_statep);
list_destroy(&lofi_list);
}
return (error);
}
int
_fini(void)
{
int error;
mutex_enter(&lofi_lock);
if (!list_is_empty(&lofi_list)) {
mutex_exit(&lofi_lock);
return (EBUSY);
}
mutex_exit(&lofi_lock);
error = mod_remove(&modlinkage);
if (error)
return (error);
mutex_destroy(&lofi_lock);
id_space_destroy(lofi_id);
ddi_soft_state_fini((void **)&lofi_statep);
list_destroy(&lofi_list);
return (error);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}