#include <smbsrv/smb_kproto.h>
#include <smbsrv/smb_kstat.h>
static kmem_cache_t *smb_mbc_cache = NULL;
static kmem_cache_t *smb_mbuf_cache = NULL;
static kmem_cache_t *smb_mbufcl_cache = NULL;
#ifdef _FAKE_KERNEL
size_t kmem_max_cached = 0x20000;
#endif
void
smb_mbc_init(void)
{
if (smb_mbc_cache != NULL)
return;
smb_mbc_cache = kmem_cache_create(SMBSRV_KSTAT_MBC_CACHE,
sizeof (mbuf_chain_t), 8, NULL, NULL, NULL, NULL, NULL, 0);
smb_mbuf_cache = kmem_cache_create("smb_mbuf_cache",
sizeof (mbuf_t), 8, NULL, NULL, NULL, NULL, NULL, 0);
smb_mbufcl_cache = kmem_cache_create("smb_mbufcl_cache",
MCLBYTES, 8, NULL, NULL, NULL, NULL, NULL, 0);
}
void
smb_mbc_fini(void)
{
if (smb_mbc_cache != NULL) {
kmem_cache_destroy(smb_mbc_cache);
smb_mbc_cache = NULL;
}
if (smb_mbuf_cache != NULL) {
kmem_cache_destroy(smb_mbuf_cache);
smb_mbuf_cache = NULL;
}
if (smb_mbufcl_cache != NULL) {
kmem_cache_destroy(smb_mbufcl_cache);
smb_mbufcl_cache = NULL;
}
}
mbuf_chain_t *
smb_mbc_alloc(uint32_t max_bytes)
{
mbuf_chain_t *mbc;
mbuf_t *m;
mbc = kmem_cache_alloc(smb_mbc_cache, KM_SLEEP);
bzero(mbc, sizeof (*mbc));
mbc->mbc_magic = SMB_MBC_MAGIC;
if (max_bytes != 0) {
MGET(m, M_WAIT, MT_DATA);
m->m_len = 0;
mbc->chain = m;
if (max_bytes > MINCLSIZE)
MCLGET(m, M_WAIT);
}
mbc->max_bytes = max_bytes;
return (mbc);
}
void
smb_mbc_free(mbuf_chain_t *mbc)
{
SMB_MBC_VALID(mbc);
m_freem(mbc->chain);
mbc->chain = NULL;
mbc->mbc_magic = 0;
kmem_cache_free(smb_mbc_cache, mbc);
}
struct mbuf *
smb_mbuf_get(uchar_t *buf, int nbytes)
{
struct mbuf *mhead = 0;
struct mbuf *m = 0;
int count;
int offset = 0;
while (nbytes) {
count = (nbytes > MCLBYTES) ? MCLBYTES : nbytes;
nbytes -= count;
if (mhead == 0) {
MGET(mhead, M_WAIT, MT_DATA);
m = mhead;
} else {
MGET(m->m_next, M_WAIT, MT_DATA);
m = m->m_next;
}
if (count > MLEN) {
MCLGET(m, M_WAIT);
}
m->m_len = count;
bcopy(buf + offset, m->m_data, count);
offset += count;
}
return (mhead);
}
mbuf_t *
smb_mbuf_alloc_ext(caddr_t buf, int len, m_ext_free_t ff, void *arg)
{
mbuf_t *m = 0;
MGET(m, M_WAIT, MT_DATA);
m->m_ext.ext_buf = buf;
m->m_data = m->m_ext.ext_buf;
m->m_flags |= M_EXT;
m->m_ext.ext_size = len;
m->m_ext.ext_free = ff;
m->m_ext.ext_arg1 = arg;
m->m_len = len;
return (m);
}
static void
smb_mbuf_kmem_free(mbuf_t *m)
{
ASSERT((m->m_flags & M_EXT) != 0);
kmem_free(m->m_ext.ext_buf, m->m_ext.ext_size);
}
mbuf_t *
smb_mbuf_alloc_kmem(int len)
{
mbuf_t *m;
caddr_t buf;
VERIFY(len > 0);
#ifdef DEBUG
if (len > kmem_max_cached) {
debug_enter("fix caller");
}
#endif
buf = kmem_alloc(len, KM_SLEEP);
m = smb_mbuf_alloc_ext(buf, len, smb_mbuf_kmem_free, NULL);
return (m);
}
struct mbuf *
smb_mbuf_alloc_chain(int nbytes)
{
struct mbuf *mhead = NULL;
struct mbuf *m;
int len;
ASSERT(nbytes > 0);
while (nbytes >= kmem_max_cached) {
len = kmem_max_cached;
m = smb_mbuf_alloc_kmem(len);
m->m_next = mhead;
mhead = m;
nbytes -= len;
}
if (nbytes > MCLBYTES) {
len = nbytes;
m = smb_mbuf_alloc_kmem(len);
m->m_next = mhead;
mhead = m;
nbytes -= len;
} else if (nbytes > 0) {
ASSERT(nbytes <= MCLBYTES);
len = nbytes;
MGET(m, M_WAIT, MT_DATA);
if (len > MLEN) {
MCLGET(m, M_WAIT);
}
m->m_len = len;
m->m_next = mhead;
mhead = m;
nbytes -= len;
}
return (mhead);
}
smb_vdb_t *
smb_get_vdb(smb_request_t *sr)
{
smb_vdb_t *vdb;
vdb = smb_srm_zalloc(sr, sizeof (*vdb));
vdb->vdb_uio.uio_iov = &vdb->vdb_iovec[0];
vdb->vdb_uio.uio_iovcnt = MAX_IOVEC;
vdb->vdb_uio.uio_segflg = UIO_SYSSPACE;
vdb->vdb_uio.uio_extflg = UIO_COPY_DEFAULT;
return (vdb);
}
struct mbuf *
smb_mbuf_allocate(struct uio *uio)
{
mbuf_t *mhead;
int rc;
ASSERT(uio->uio_resid > 0);
ASSERT(uio->uio_iovcnt == MAX_IOVEC);
mhead = smb_mbuf_alloc_chain(uio->uio_resid);
rc = smb_mbuf_mkuio(mhead, uio);
VERIFY(rc == 0);
return (mhead);
}
int
smb_mbuf_mkuio_cont(mbuf_t *m, uio_t *uio, int iov_off)
{
iovec_t *iov;
ssize_t off = 0;
int iovcnt = 0;
int tlen;
iov = uio->uio_iov;
while (iov_off > iovcnt) {
if (iovcnt >= uio->uio_iovcnt)
return (E2BIG);
iovcnt++;
off += iov->iov_len;
iov++;
}
while (off < uio->uio_resid) {
if (m == NULL)
return (EFAULT);
if (iovcnt >= uio->uio_iovcnt)
return (E2BIG);
tlen = m->m_len;
if ((off + tlen) > uio->uio_resid)
tlen = (int)(uio->uio_resid - off);
iov->iov_base = m->m_data;
iov->iov_len = tlen;
off += tlen;
m = m->m_next;
iovcnt++;
iov++;
}
uio->uio_iovcnt = iovcnt;
return (0);
}
int
smb_mbuf_mkuio(mbuf_t *m, uio_t *uio)
{
return (smb_mbuf_mkuio_cont(m, uio, 0));
}
void
smb_mbuf_trim(struct mbuf *mhead, int nbytes)
{
struct mbuf *m = mhead;
while (m != 0) {
if (nbytes <= m->m_len) {
m->m_len = nbytes;
if (m->m_next != 0) {
m_freem(m->m_next);
m->m_next = 0;
}
break;
}
nbytes -= m->m_len;
m = m->m_next;
}
}
int
MBC_LENGTH(struct mbuf_chain *MBC)
{
struct mbuf *m = (MBC)->chain;
int used = 0;
while (m != 0) {
used += m->m_len;
m = m->m_next;
}
return (used);
}
int
MBC_MAXBYTES(struct mbuf_chain *MBC)
{
return (MBC->max_bytes);
}
void
MBC_SETUP(struct mbuf_chain *MBC, uint32_t max_bytes)
{
bzero((MBC), sizeof (struct mbuf_chain));
(MBC)->max_bytes = max_bytes;
}
void
MBC_INIT(struct mbuf_chain *MBC, uint32_t max_bytes)
{
struct mbuf *m;
bzero((MBC), sizeof (struct mbuf_chain));
if (max_bytes != 0) {
MGET(m, M_WAIT, MT_DATA);
m->m_len = 0;
(MBC)->chain = m;
if (max_bytes > MINCLSIZE)
MCLGET(m, M_WAIT);
m->m_data += MH_PREPEND_SPACE;
}
(MBC)->max_bytes = max_bytes;
}
void
MBC_FLUSH(struct mbuf_chain *MBC)
{
extern void m_freem(struct mbuf *);
struct mbuf *m;
while ((m = (MBC)->chain) != 0) {
(MBC)->chain = m->m_nextpkt;
m->m_nextpkt = 0;
m_freem(m);
}
MBC_SETUP(MBC, (MBC)->max_bytes);
}
void
MBC_ATTACH_MBUF(struct mbuf_chain *MBC, struct mbuf *MBUF)
{
if (MBC->chain != 0)
MBC_FLUSH(MBC);
(MBC)->chain_offset = 0;
(MBC)->chain = (MBUF);
}
void
MBC_APPEND_MBUF(struct mbuf_chain *MBC, struct mbuf *MBUF)
{
struct mbuf *m;
if ((MBC)->chain == 0) {
(MBC)->chain = (MBUF);
} else {
m = (MBC)->chain;
while (m->m_next != 0)
m = m->m_next;
m->m_next = (MBUF);
}
}
static void
mclrefnoop(mbuf_t *m)
{
}
void
MBC_ATTACH_BUF(struct mbuf_chain *MBC, unsigned char *BUF, int LEN)
{
MGET((MBC)->chain, M_WAIT, MT_DATA);
(MBC)->chain_offset = 0;
(MBC)->chain->m_flags |= M_EXT;
(MBC)->chain->m_data = (caddr_t)(BUF);
(MBC)->chain->m_ext.ext_buf = (caddr_t)(BUF);
(MBC)->chain->m_len = (LEN);
(MBC)->chain->m_ext.ext_size = (LEN);
(MBC)->chain->m_ext.ext_free = mclrefnoop;
(MBC)->max_bytes = (LEN);
}
int
MBC_SHADOW_CHAIN(struct mbuf_chain *submbc, struct mbuf_chain *mbc,
int off, int len)
{
int x = off + len;
if (off < 0 || len < 0 || x < 0 ||
off > mbc->max_bytes || x > mbc->max_bytes)
return (EMSGSIZE);
*submbc = *mbc;
submbc->chain_offset = off;
submbc->max_bytes = x;
submbc->shadow_of = mbc;
return (0);
}
void
m_adjust(struct mbuf *mp, int req_len)
{
int len = req_len;
struct mbuf *m;
if ((m = mp) == NULL)
return;
VERIFY(len >= 0);
while (m != NULL && len > 0) {
if (m->m_len <= len) {
len -= m->m_len;
m->m_len = 0;
m = m->m_next;
} else {
m->m_len -= len;
m->m_data += len;
len = 0;
}
}
}
struct mbuf *
m_prepend(struct mbuf *m, int plen, int how)
{
struct mbuf *mn;
if (M_LEADINGSPACE(m) >= plen) {
m->m_data -= plen;
m->m_len += plen;
return (m);
}
if (m->m_flags & M_PKTHDR) {
MGETHDR(mn, how, m->m_type);
} else {
MGET(mn, how, m->m_type);
}
VERIFY(mn != NULL);
if (m->m_flags & M_PKTHDR) {
mn->m_pkthdr.len += plen;
}
mn->m_next = m;
m = mn;
if (plen < M_SIZE(m))
M_ALIGN(m, plen);
m->m_len = plen;
DTRACE_PROBE1(prepend_allocated, struct mbuf *, m);
return (m);
}
struct mbuf *
m_free(struct mbuf *m)
{
struct mbuf *n;
MFREE(m, n);
return (n);
}
void
m_freem(struct mbuf *m)
{
struct mbuf *n;
if (m == NULL)
return;
do {
MFREE(m, n);
} while ((m = n) != 0);
}
mbuf_t *
smb_mbuf_alloc(void)
{
mbuf_t *m;
m = kmem_cache_alloc(smb_mbuf_cache, KM_SLEEP);
bzero(m, sizeof (*m));
return (m);
}
void
smb_mbuf_free(mbuf_t *m)
{
kmem_cache_free(smb_mbuf_cache, m);
}
void *
smb_mbufcl_alloc(void)
{
void *p;
p = kmem_cache_alloc(smb_mbufcl_cache, KM_SLEEP);
bzero(p, MCLBYTES);
return (p);
}
void
smb_mbufcl_free(mbuf_t *m)
{
ASSERT((m->m_flags & M_EXT) != 0);
ASSERT(m->m_ext.ext_size == MCLBYTES);
kmem_cache_free(smb_mbufcl_cache, m->m_ext.ext_buf);
}
int
smb_mbufcl_ref(void *p, uint_t sz, int incr)
{
ASSERT3S(sz, ==, MCLBYTES);
if (incr < 0)
kmem_cache_free(smb_mbufcl_cache, p);
return (0);
}