#include <sys/param.h>
#include <sys/systm.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/kernel.h>
#include <sys/sysctl.h>
#include <sys/syslog.h>
#include <sys/protosw.h>
#include <sys/domain.h>
#include <sys/queue.h>
#include <sys/proc.h>
#include <kern/kern_types.h>
#include <kern/simple_lock.h>
#include <kern/queue.h>
#include <kern/sched_prim.h>
#include <kern/cpu_number.h>
#include <libkern/OSAtomic.h>
#include <libkern/libkern.h>
#include <IOKit/IOMapper.h>
#include <machine/limits.h>
#include <machine/machine_routines.h>
#if CONFIG_MACF_NET
#include <security/mac_framework.h>
#endif
#include <sys/mcache.h>
extern vm_offset_t kmem_mb_alloc(vm_map_t, int, int);
extern ppnum_t pmap_find_phys(pmap_t pmap, addr64_t va);
extern vm_map_t mb_map;
static lck_mtx_t *mbuf_mlock;
static lck_attr_t *mbuf_mlock_attr;
static lck_grp_t *mbuf_mlock_grp;
static lck_grp_attr_t *mbuf_mlock_grp_attr;
static void *mbuf_worker_run;
static int mbuf_worker_ready;
static int mbuf_expand_mcl;
static int mbuf_expand_big;
static int mbuf_expand_16k;
static int ncpu;
static ppnum_t *mcl_paddr;
static ppnum_t mcl_pages;
static ppnum_t mcl_paddr_base;
static mcache_t *ref_cache;
static mcache_t *mcl_audit_con_cache;
static unsigned int mbuf_debug;
static unsigned int mb_normalized;
static unsigned int mbuf_gscale;
#define MB_GROWTH_AGGRESSIVE 1
#define MB_GROWTH_NORMAL 4
typedef enum {
MC_MBUF = 0,
MC_CL,
MC_BIGCL,
MC_16KCL,
MC_MBUF_CL,
MC_MBUF_BIGCL,
MC_MBUF_16KCL
} mbuf_class_t;
#define MBUF_CLASS_MIN MC_MBUF
#define MBUF_CLASS_MAX MC_MBUF_16KCL
#define MBUF_CLASS_LAST MC_16KCL
#define MBUF_CLASS_VALID(c) \
((int)(c) >= MBUF_CLASS_MIN && (int)(c) <= MBUF_CLASS_MAX)
#define MBUF_CLASS_COMPOSITE(c) \
((int)(c) > MBUF_CLASS_LAST)
#define MCR_COMP MCR_USR1
typedef struct mcl_slab {
struct mcl_slab *sl_next;
u_int8_t sl_class;
int8_t sl_refcnt;
int8_t sl_chunks;
u_int16_t sl_flags;
u_int16_t sl_len;
void *sl_base;
void *sl_head;
TAILQ_ENTRY(mcl_slab) sl_link;
} mcl_slab_t;
#define SLF_MAPPED 0x0001
#define SLF_PARTIAL 0x0002
#define SLF_DETACHED 0x0004
#define NSLABSPMB ((1 << MBSHIFT) >> MCLSHIFT)
typedef struct mcl_slabg {
mcl_slab_t slg_slab[NSLABSPMB];
} mcl_slabg_t;
typedef struct {
mcache_audit_t *cl_audit[NMBPCL];
} mcl_audit_t;
#if CONFIG_MBUF_NOEXPAND
static unsigned int maxmbufcl;
#endif
#define AUDIT_CONTENTS_SIZE ((MSIZE - MHLEN) + sizeof (_m_ext_t))
#define MB_INUSE 0x01
#define MB_COMP_INUSE 0x02
#define MB_SCVALID 0x04
static mcl_audit_t *mclaudit;
static mcl_slabg_t **slabstbl;
static unsigned int maxslabgrp;
static unsigned int slabgrp;
int nclusters;
int njcl;
int njclbytes;
union mcluster *mbutl;
union mcluster *embutl;
int max_linkhdr;
int max_protohdr;
int max_hdr;
int max_datalen;
extern u_int32_t high_sb_max;
int do_reclaim = 0;
#define MINCL 32
#define MINBIGCL (MINCL >> 1)
#define MIN16KCL (MINCL >> 2)
#define MCL_LOWAT MINCL
#define MBIGCL_LOWAT MINBIGCL
#define M16KCL_LOWAT MIN16KCL
typedef struct {
mbuf_class_t mtbl_class;
mcache_t *mtbl_cache;
TAILQ_HEAD(mcl_slhead, mcl_slab) mtbl_slablist;
mcache_obj_t *mtbl_cobjlist;
mb_class_stat_t *mtbl_stats;
u_int32_t mtbl_maxsize;
int mtbl_minlimit;
int mtbl_maxlimit;
u_int32_t mtbl_wantpurge;
} mbuf_table_t;
#define m_class(c) mbuf_table[c].mtbl_class
#define m_cache(c) mbuf_table[c].mtbl_cache
#define m_slablist(c) mbuf_table[c].mtbl_slablist
#define m_cobjlist(c) mbuf_table[c].mtbl_cobjlist
#define m_maxsize(c) mbuf_table[c].mtbl_maxsize
#define m_minlimit(c) mbuf_table[c].mtbl_minlimit
#define m_maxlimit(c) mbuf_table[c].mtbl_maxlimit
#define m_wantpurge(c) mbuf_table[c].mtbl_wantpurge
#define m_cname(c) mbuf_table[c].mtbl_stats->mbcl_cname
#define m_size(c) mbuf_table[c].mtbl_stats->mbcl_size
#define m_total(c) mbuf_table[c].mtbl_stats->mbcl_total
#define m_active(c) mbuf_table[c].mtbl_stats->mbcl_active
#define m_infree(c) mbuf_table[c].mtbl_stats->mbcl_infree
#define m_slab_cnt(c) mbuf_table[c].mtbl_stats->mbcl_slab_cnt
#define m_alloc_cnt(c) mbuf_table[c].mtbl_stats->mbcl_alloc_cnt
#define m_free_cnt(c) mbuf_table[c].mtbl_stats->mbcl_free_cnt
#define m_notified(c) mbuf_table[c].mtbl_stats->mbcl_notified
#define m_purge_cnt(c) mbuf_table[c].mtbl_stats->mbcl_purge_cnt
#define m_fail_cnt(c) mbuf_table[c].mtbl_stats->mbcl_fail_cnt
#define m_ctotal(c) mbuf_table[c].mtbl_stats->mbcl_ctotal
static mbuf_table_t mbuf_table[] = {
{ MC_MBUF, NULL, TAILQ_HEAD_INITIALIZER(m_slablist(MC_MBUF)),
NULL, NULL, 0, 0, 0, 0 },
{ MC_CL, NULL, TAILQ_HEAD_INITIALIZER(m_slablist(MC_CL)),
NULL, NULL, 0, 0, 0, 0 },
{ MC_BIGCL, NULL, TAILQ_HEAD_INITIALIZER(m_slablist(MC_BIGCL)),
NULL, NULL, 0, 0, 0, 0 },
{ MC_16KCL, NULL, TAILQ_HEAD_INITIALIZER(m_slablist(MC_16KCL)),
NULL, NULL, 0, 0, 0, 0 },
{ MC_MBUF_CL, NULL, { NULL, NULL }, NULL, NULL, 0, 0, 0, 0 },
{ MC_MBUF_BIGCL, NULL, { NULL, NULL }, NULL, NULL, 0, 0, 0, 0 },
{ MC_MBUF_16KCL, NULL, { NULL, NULL }, NULL, NULL, 0, 0, 0, 0 },
};
#define NELEM(a) (sizeof (a) / sizeof ((a)[0]))
static void *mb_waitchan = &mbuf_table;
static int mb_waiters;
static boolean_t mb_clalloc_busy;
static void *mb_clalloc_waitchan = &mb_clalloc_busy;
static int mb_clalloc_waiters;
static int mbstat_sysctl SYSCTL_HANDLER_ARGS;
static int mb_stat_sysctl SYSCTL_HANDLER_ARGS;
static void mbuf_table_init(void);
static inline void m_incref(struct mbuf *);
static inline u_int32_t m_decref(struct mbuf *);
static int m_clalloc(const u_int32_t, const int, const u_int32_t);
static void mbuf_worker_thread_init(void);
static mcache_obj_t *slab_alloc(mbuf_class_t, int);
static void slab_free(mbuf_class_t, mcache_obj_t *);
static unsigned int mbuf_slab_alloc(void *, mcache_obj_t ***,
unsigned int, int);
static void mbuf_slab_free(void *, mcache_obj_t *, int);
static void mbuf_slab_audit(void *, mcache_obj_t *, boolean_t);
static void mbuf_slab_notify(void *, u_int32_t);
static unsigned int cslab_alloc(mbuf_class_t, mcache_obj_t ***,
unsigned int);
static unsigned int cslab_free(mbuf_class_t, mcache_obj_t *, int);
static unsigned int mbuf_cslab_alloc(void *, mcache_obj_t ***,
unsigned int, int);
static void mbuf_cslab_free(void *, mcache_obj_t *, int);
static void mbuf_cslab_audit(void *, mcache_obj_t *, boolean_t);
static int freelist_populate(mbuf_class_t, unsigned int, int);
static boolean_t mbuf_cached_above(mbuf_class_t, int);
static boolean_t mbuf_steal(mbuf_class_t, unsigned int);
static void m_reclaim(mbuf_class_t, unsigned int, boolean_t);
static int m_howmany(int, size_t);
static void mbuf_worker_thread(void);
static boolean_t mbuf_sleep(mbuf_class_t, unsigned int, int);
static void mcl_audit_init(void *, mcache_audit_t **, mcache_obj_t **,
size_t, unsigned int);
static mcache_audit_t *mcl_audit_buf2mca(mbuf_class_t, mcache_obj_t *);
static void mcl_audit_mbuf(mcache_audit_t *, void *, boolean_t, boolean_t);
static void mcl_audit_cluster(mcache_audit_t *, void *, size_t, boolean_t,
boolean_t);
static void mcl_audit_restore_mbuf(struct mbuf *, mcache_audit_t *, boolean_t);
static void mcl_audit_save_mbuf(struct mbuf *, mcache_audit_t *);
static void mcl_audit_mcheck_panic(struct mbuf *);
static void mcl_audit_verify_nextptr(void *, mcache_audit_t *);
static mcl_slab_t *slab_get(void *);
static void slab_init(mcl_slab_t *, mbuf_class_t, u_int32_t,
void *, void *, unsigned int, int, int);
static void slab_insert(mcl_slab_t *, mbuf_class_t);
static void slab_remove(mcl_slab_t *, mbuf_class_t);
static boolean_t slab_inrange(mcl_slab_t *, void *);
static void slab_nextptr_panic(mcl_slab_t *, void *);
static void slab_detach(mcl_slab_t *);
static boolean_t slab_is_detached(mcl_slab_t *);
static unsigned int m_length(struct mbuf *);
static int m_copyback0(struct mbuf **, int, int, const void *, int, int);
static struct mbuf *m_split0(struct mbuf *, int, int, int);
#define M_COPYBACK0_COPYBACK 0x0001
#define M_COPYBACK0_PRESERVE 0x0002
#define M_COPYBACK0_COW 0x0004
#define M_COPYBACK0_EXTEND 0x0008
#define EXTF_COMPOSITE 0x1
#define MEXT_RFA(m) ((m)->m_ext.ext_refflags)
#define MEXT_REF(m) (MEXT_RFA(m)->refcnt)
#define MEXT_FLAGS(m) (MEXT_RFA(m)->flags)
#define MBUF_IS_COMPOSITE(m) \
(MEXT_REF(m) == 0 && (MEXT_FLAGS(m) & EXTF_COMPOSITE))
#define _MCHECK(m) { \
if ((m)->m_type != MT_FREE) { \
if (mclaudit == NULL) \
panic("MCHECK: m_type=%d m=%p", \
(u_int16_t)(m)->m_type, m); \
else \
mcl_audit_mcheck_panic(m); \
} \
}
#define MBUF_IN_MAP(addr) \
((void *)(addr) >= (void *)mbutl && (void *)(addr) < (void *)embutl)
#define MRANGE(addr) { \
if (!MBUF_IN_MAP(addr)) \
panic("MRANGE: address out of range 0x%p", addr); \
}
#define MTOD(m, t) ((t)((m)->m_data))
#define MTOCL(x) (((char *)(x) - (char *)mbutl) >> MCLSHIFT)
#define CLTOM(x) ((union mcluster *)(mbutl + (x)))
#define MCLIDX(c, m) (((char *)(m) - (char *)(c)) >> 8)
#define MBUF_INIT(m, pkthdr, type) { \
_MCHECK(m); \
(m)->m_next = (m)->m_nextpkt = NULL; \
(m)->m_len = 0; \
(m)->m_type = type; \
if ((pkthdr) == 0) { \
(m)->m_data = (m)->m_dat; \
(m)->m_flags = 0; \
} else { \
(m)->m_data = (m)->m_pktdat; \
(m)->m_flags = M_PKTHDR; \
(m)->m_pkthdr.rcvif = NULL; \
(m)->m_pkthdr.len = 0; \
(m)->m_pkthdr.header = NULL; \
(m)->m_pkthdr.csum_flags = 0; \
(m)->m_pkthdr.csum_data = 0; \
(m)->m_pkthdr.tso_segsz = 0; \
(m)->m_pkthdr.vlan_tag = 0; \
(m)->m_pkthdr.socket_id = 0; \
m_tag_init(m); \
} \
}
#define MEXT_INIT(m, buf, size, free, arg, rfa, ref, flag) { \
(m)->m_data = (m)->m_ext.ext_buf = (buf); \
(m)->m_flags |= M_EXT; \
(m)->m_ext.ext_size = (size); \
(m)->m_ext.ext_free = (free); \
(m)->m_ext.ext_arg = (arg); \
(m)->m_ext.ext_refs.forward = (m)->m_ext.ext_refs.backward = \
&(m)->m_ext.ext_refs; \
MEXT_RFA(m) = (rfa); \
MEXT_REF(m) = (ref); \
MEXT_FLAGS(m) = (flag); \
}
#define MBUF_CL_INIT(m, buf, rfa, ref, flag) \
MEXT_INIT(m, buf, m_maxsize(MC_CL), NULL, NULL, rfa, ref, flag)
#define MBUF_BIGCL_INIT(m, buf, rfa, ref, flag) \
MEXT_INIT(m, buf, m_maxsize(MC_BIGCL), m_bigfree, NULL, rfa, ref, flag)
#define MBUF_16KCL_INIT(m, buf, rfa, ref, flag) \
MEXT_INIT(m, buf, m_maxsize(MC_16KCL), m_16kfree, NULL, rfa, ref, flag)
#define MSLEEPF(f) ((!((f) & M_DONTWAIT)) ? MCR_SLEEP : MCR_NOSLEEP)
struct mb_stat *mb_stat;
struct omb_stat *omb_stat;
#define MB_STAT_SIZE(n) \
((size_t)(&((mb_stat_t *)0)->mbs_class[n]))
#define OMB_STAT_SIZE(n) \
((size_t)(&((struct omb_stat *)0)->mbs_class[n]))
struct mbstat mbstat;
#define MBSTAT_MTYPES_MAX \
(sizeof (mbstat.m_mtypes) / sizeof (mbstat.m_mtypes[0]))
typedef struct {
unsigned int cpu_mtypes[MT_MAX];
} __attribute__((aligned(CPU_CACHE_SIZE), packed)) mtypes_cpu_t;
typedef struct {
mtypes_cpu_t mbs_cpu[1];
} mbuf_mtypes_t;
static mbuf_mtypes_t *mbuf_mtypes;
#define MBUF_MTYPES_SIZE(n) \
((size_t)(&((mbuf_mtypes_t *)0)->mbs_cpu[n]))
#define MTYPES_CPU(p) \
((mtypes_cpu_t *)((char *)(p) + MBUF_MTYPES_SIZE(cpu_number())))
#define atomic_add_16(a, n) ((void) OSAddAtomic16(n, a))
#define atomic_add_32(a, n) ((void) OSAddAtomic(n, a))
#define mtype_stat_add(type, n) { \
if ((unsigned)(type) < MT_MAX) { \
mtypes_cpu_t *mbs = MTYPES_CPU(mbuf_mtypes); \
atomic_add_32(&mbs->cpu_mtypes[type], n); \
} else if ((unsigned)(type) < (unsigned)MBSTAT_MTYPES_MAX) { \
atomic_add_16((int16_t*)&mbstat.m_mtypes[type], n); \
} \
}
#define mtype_stat_sub(t, n) mtype_stat_add(t, -(n))
#define mtype_stat_inc(t) mtype_stat_add(t, 1)
#define mtype_stat_dec(t) mtype_stat_sub(t, 1)
static int
mbstat_sysctl SYSCTL_HANDLER_ARGS
{
#pragma unused(oidp, arg1, arg2)
int m, n;
mtypes_cpu_t mtc;
bzero(&mtc, sizeof (mtc));
for (m = 0; m < ncpu; m++) {
mtypes_cpu_t *scp = &mbuf_mtypes->mbs_cpu[m];
mtypes_cpu_t temp;
bcopy(&scp->cpu_mtypes, &temp.cpu_mtypes,
sizeof (temp.cpu_mtypes));
for (n = 0; n < MT_MAX; n++)
mtc.cpu_mtypes[n] += temp.cpu_mtypes[n];
}
lck_mtx_lock(mbuf_mlock);
for (n = 0; n < MT_MAX; n++)
mbstat.m_mtypes[n] = mtc.cpu_mtypes[n];
lck_mtx_unlock(mbuf_mlock);
return (SYSCTL_OUT(req, &mbstat, sizeof (mbstat)));
}
static int
mb_stat_sysctl SYSCTL_HANDLER_ARGS
{
#pragma unused(oidp, arg1, arg2)
mcache_t *cp;
mcache_cpu_t *ccp;
mb_class_stat_t *sp;
void *statp;
int k, m, bktsize, statsz, proc64 = proc_is64bit(req->p);
lck_mtx_lock(mbuf_mlock);
for (k = 0; k < NELEM(mbuf_table); k++) {
cp = m_cache(k);
ccp = &cp->mc_cpu[0];
bktsize = ccp->cc_bktsize;
sp = mbuf_table[k].mtbl_stats;
if (cp->mc_flags & MCF_NOCPUCACHE)
sp->mbcl_mc_state = MCS_DISABLED;
else if (cp->mc_purge_cnt > 0)
sp->mbcl_mc_state = MCS_PURGING;
else if (bktsize == 0)
sp->mbcl_mc_state = MCS_OFFLINE;
else
sp->mbcl_mc_state = MCS_ONLINE;
sp->mbcl_mc_cached = 0;
for (m = 0; m < ncpu; m++) {
ccp = &cp->mc_cpu[m];
if (ccp->cc_objs > 0)
sp->mbcl_mc_cached += ccp->cc_objs;
if (ccp->cc_pobjs > 0)
sp->mbcl_mc_cached += ccp->cc_pobjs;
}
sp->mbcl_mc_cached += (cp->mc_full.bl_total * bktsize);
sp->mbcl_active = sp->mbcl_total - sp->mbcl_mc_cached -
sp->mbcl_infree;
sp->mbcl_mc_waiter_cnt = cp->mc_waiter_cnt;
sp->mbcl_mc_wretry_cnt = cp->mc_wretry_cnt;
sp->mbcl_mc_nwretry_cnt = cp->mc_nwretry_cnt;
sp->mbcl_ctotal = sp->mbcl_total;
switch (m_class(k)) {
case MC_MBUF:
sp->mbcl_ctotal -= (m_total(MC_MBUF_CL) +
m_total(MC_MBUF_BIGCL));
break;
case MC_CL:
sp->mbcl_ctotal -= (m_total(MC_MBUF_CL) +
(P2ROUNDUP(m_total(MC_MBUF), NMBPCL)/NMBPCL));
break;
case MC_BIGCL:
sp->mbcl_ctotal -= m_total(MC_MBUF_BIGCL);
break;
case MC_16KCL:
sp->mbcl_ctotal -= m_total(MC_MBUF_16KCL);
break;
default:
break;
}
}
if (!proc64) {
struct omb_class_stat *oc;
struct mb_class_stat *c;
omb_stat->mbs_cnt = mb_stat->mbs_cnt;
oc = &omb_stat->mbs_class[0];
c = &mb_stat->mbs_class[0];
for (k = 0; k < omb_stat->mbs_cnt; k++, oc++, c++) {
(void) snprintf(oc->mbcl_cname, sizeof (oc->mbcl_cname),
"%s", c->mbcl_cname);
oc->mbcl_size = c->mbcl_size;
oc->mbcl_total = c->mbcl_total;
oc->mbcl_active = c->mbcl_active;
oc->mbcl_infree = c->mbcl_infree;
oc->mbcl_slab_cnt = c->mbcl_slab_cnt;
oc->mbcl_alloc_cnt = c->mbcl_alloc_cnt;
oc->mbcl_free_cnt = c->mbcl_free_cnt;
oc->mbcl_notified = c->mbcl_notified;
oc->mbcl_purge_cnt = c->mbcl_purge_cnt;
oc->mbcl_fail_cnt = c->mbcl_fail_cnt;
oc->mbcl_ctotal = c->mbcl_ctotal;
oc->mbcl_mc_state = c->mbcl_mc_state;
oc->mbcl_mc_cached = c->mbcl_mc_cached;
oc->mbcl_mc_waiter_cnt = c->mbcl_mc_waiter_cnt;
oc->mbcl_mc_wretry_cnt = c->mbcl_mc_wretry_cnt;
oc->mbcl_mc_nwretry_cnt = c->mbcl_mc_nwretry_cnt;
}
statp = omb_stat;
statsz = OMB_STAT_SIZE(NELEM(mbuf_table));
} else {
statp = mb_stat;
statsz = MB_STAT_SIZE(NELEM(mbuf_table));
}
lck_mtx_unlock(mbuf_mlock);
return (SYSCTL_OUT(req, statp, statsz));
}
static inline void
m_incref(struct mbuf *m)
{
UInt32 old, new;
volatile UInt32 *addr = (volatile UInt32 *)&MEXT_REF(m);
do {
old = *addr;
new = old + 1;
ASSERT(new != 0);
} while (!OSCompareAndSwap(old, new, addr));
}
static inline u_int32_t
m_decref(struct mbuf *m)
{
UInt32 old, new;
volatile UInt32 *addr = (volatile UInt32 *)&MEXT_REF(m);
do {
old = *addr;
new = old - 1;
ASSERT(old != 0);
} while (!OSCompareAndSwap(old, new, addr));
return (new);
}
static void
mbuf_table_init(void)
{
int m;
MALLOC(omb_stat, struct omb_stat *, OMB_STAT_SIZE(NELEM(mbuf_table)),
M_TEMP, M_WAITOK | M_ZERO);
VERIFY(omb_stat != NULL);
MALLOC(mb_stat, mb_stat_t *, MB_STAT_SIZE(NELEM(mbuf_table)),
M_TEMP, M_WAITOK | M_ZERO);
VERIFY(mb_stat != NULL);
mb_stat->mbs_cnt = NELEM(mbuf_table);
for (m = 0; m < NELEM(mbuf_table); m++)
mbuf_table[m].mtbl_stats = &mb_stat->mbs_class[m];
#if CONFIG_MBUF_JUMBO
njcl = nmbclusters / 3;
njclbytes = M16KCLBYTES;
#endif
nclusters = P2ROUNDDOWN(nmbclusters - njcl, 4);
if (njcl > 0) {
njcl = P2ROUNDDOWN(nmbclusters - nclusters, 8);
}
#if CONFIG_MBUF_NOEXPAND
if (nmbclusters <= 128) {
maxmbufcl = nmbclusters / 4;
} else {
maxmbufcl = (nmbclusters / 4) * 3;
}
#endif
m_minlimit(MC_CL) = (nclusters >> 5);
m_maxlimit(MC_CL) = (nclusters >> 1);
m_maxsize(MC_CL) = m_size(MC_CL) = MCLBYTES;
(void) snprintf(m_cname(MC_CL), MAX_MBUF_CNAME, "cl");
m_minlimit(MC_MBUF) = 0;
m_maxlimit(MC_MBUF) = (m_maxlimit(MC_CL) - m_minlimit(MC_CL)) * NMBPCL;
m_maxsize(MC_MBUF) = m_size(MC_MBUF) = MSIZE;
(void) snprintf(m_cname(MC_MBUF), MAX_MBUF_CNAME, "mbuf");
m_minlimit(MC_BIGCL) = 0;
m_maxlimit(MC_BIGCL) = m_maxlimit(MC_CL) >> 1;
m_maxsize(MC_BIGCL) = m_size(MC_BIGCL) = NBPG;
(void) snprintf(m_cname(MC_BIGCL), MAX_MBUF_CNAME, "bigcl");
m_minlimit(MC_MBUF_CL) = 0;
m_maxlimit(MC_MBUF_CL) = m_maxlimit(MC_CL) - m_minlimit(MC_CL);
m_maxsize(MC_MBUF_CL) = MCLBYTES;
m_size(MC_MBUF_CL) = m_size(MC_MBUF) + m_size(MC_CL);
(void) snprintf(m_cname(MC_MBUF_CL), MAX_MBUF_CNAME, "mbuf_cl");
m_minlimit(MC_MBUF_BIGCL) = 0;
m_maxlimit(MC_MBUF_BIGCL) = m_maxlimit(MC_BIGCL);
m_maxsize(MC_MBUF_BIGCL) = NBPG;
m_size(MC_MBUF_BIGCL) = m_size(MC_MBUF) + m_size(MC_BIGCL);
(void) snprintf(m_cname(MC_MBUF_BIGCL), MAX_MBUF_CNAME, "mbuf_bigcl");
m_minlimit(MC_16KCL) = 0;
m_maxlimit(MC_16KCL) = (njcl >> 3);
m_maxsize(MC_16KCL) = m_size(MC_16KCL) = M16KCLBYTES;
(void) snprintf(m_cname(MC_16KCL), MAX_MBUF_CNAME, "16kcl");
m_minlimit(MC_MBUF_16KCL) = 0;
m_maxlimit(MC_MBUF_16KCL) = m_maxlimit(MC_16KCL);
m_maxsize(MC_MBUF_16KCL) = M16KCLBYTES;
m_size(MC_MBUF_16KCL) = m_size(MC_MBUF) + m_size(MC_16KCL);
(void) snprintf(m_cname(MC_MBUF_16KCL), MAX_MBUF_CNAME, "mbuf_16kcl");
bzero(&mbstat, sizeof (mbstat));
mbstat.m_msize = m_maxsize(MC_MBUF);
mbstat.m_mclbytes = m_maxsize(MC_CL);
mbstat.m_minclsize = MINCLSIZE;
mbstat.m_mlen = MLEN;
mbstat.m_mhlen = MHLEN;
mbstat.m_bigmclbytes = m_maxsize(MC_BIGCL);
}
#if defined(__LP64__)
typedef struct ncl_tbl {
uint64_t nt_maxmem;
uint32_t nt_mbpool;
} ncl_tbl_t;
static ncl_tbl_t ncl_table[] = {
{ (1ULL << GBSHIFT) , (64 << MBSHIFT) },
{ (1ULL << (GBSHIFT + 3)) , (96 << MBSHIFT) },
{ (1ULL << (GBSHIFT + 4)) , (128 << MBSHIFT) },
{ 0, 0 }
};
static ncl_tbl_t ncl_table_srv[] = {
{ (1ULL << GBSHIFT) , (96 << MBSHIFT) },
{ (1ULL << (GBSHIFT + 2)) , (128 << MBSHIFT) },
{ (1ULL << (GBSHIFT + 3)) , (160 << MBSHIFT) },
{ (1ULL << (GBSHIFT + 4)) , (192 << MBSHIFT) },
{ (1ULL << (GBSHIFT + 5)) , (256 << MBSHIFT) },
{ (1ULL << (GBSHIFT + 6)) , (384 << MBSHIFT) },
{ 0, 0 }
};
#endif
__private_extern__ unsigned int
mbuf_default_ncl(int srv, uint64_t mem)
{
#if !defined(__LP64__)
#pragma unused(srv)
unsigned int n;
if ((n = ((mem / 16) / MCLBYTES)) > 32768)
n = 32768;
#else
unsigned int n, i;
ncl_tbl_t *tbl = (srv ? ncl_table_srv : ncl_table);
n = tbl[0].nt_mbpool;
for (i = 0; tbl[i].nt_mbpool != 0; i++) {
if (mem < tbl[i].nt_maxmem)
break;
n = tbl[i].nt_mbpool;
}
n >>= MCLSHIFT;
#endif
return (n);
}
__private_extern__ void
mbinit(void)
{
unsigned int m;
int initmcl = MINCL;
void *buf;
thread_t thread = THREAD_NULL;
if (nmbclusters == 0)
nmbclusters = NMBCLUSTERS;
mbuf_table_init();
mbuf_mlock_grp_attr = lck_grp_attr_alloc_init();
mbuf_mlock_grp = lck_grp_alloc_init("mbuf", mbuf_mlock_grp_attr);
mbuf_mlock_attr = lck_attr_alloc_init();
mbuf_mlock = lck_mtx_alloc_init(mbuf_mlock_grp, mbuf_mlock_attr);
maxslabgrp = P2ROUNDUP(nmbclusters, NSLABSPMB) / NSLABSPMB;
MALLOC(slabstbl, mcl_slabg_t **, maxslabgrp * sizeof (mcl_slabg_t *),
M_TEMP, M_WAITOK | M_ZERO);
VERIFY(slabstbl != NULL);
PE_parse_boot_argn("mbuf_debug", &mbuf_debug, sizeof (mbuf_debug));
mbuf_debug |= mcache_getflags();
if (mbuf_debug & MCF_AUDIT) {
MALLOC(mclaudit, mcl_audit_t *,
nmbclusters * sizeof (*mclaudit), M_TEMP,
M_WAITOK | M_ZERO);
VERIFY(mclaudit != NULL);
mcl_audit_con_cache = mcache_create("mcl_audit_contents",
AUDIT_CONTENTS_SIZE, 0, 0, MCR_SLEEP);
VERIFY(mcl_audit_con_cache != NULL);
}
mcl_pages = (nmbclusters * MCLBYTES) / CLBYTES;
MALLOC(mcl_paddr, ppnum_t *, mcl_pages * sizeof (ppnum_t),
M_TEMP, M_WAITOK);
VERIFY(mcl_paddr != NULL);
mcl_paddr_base = IOMapperIOVMAlloc(mcl_pages);
bzero((char *)mcl_paddr, mcl_pages * sizeof (ppnum_t));
embutl = (union mcluster *)
((unsigned char *)mbutl + (nmbclusters * MCLBYTES));
PE_parse_boot_argn("initmcl", &initmcl, sizeof (initmcl));
lck_mtx_lock(mbuf_mlock);
if (m_clalloc(MAX(NBPG/CLBYTES, 1) * initmcl, M_WAIT, MCLBYTES) == 0)
panic("mbinit: m_clalloc failed\n");
lck_mtx_unlock(mbuf_mlock);
(void) kernel_thread_start((thread_continue_t)mbuf_worker_thread_init, NULL, &thread);
thread_deallocate(thread);
ref_cache = mcache_create("mext_ref", sizeof (struct ext_ref),
0, 0, MCR_SLEEP);
for (m = 0; m < NELEM(mbuf_table); m++) {
void *allocfunc, *freefunc, *auditfunc;
u_int32_t flags;
flags = mbuf_debug;
if (m_class(m) == MC_MBUF_CL || m_class(m) == MC_MBUF_BIGCL ||
m_class(m) == MC_MBUF_16KCL) {
allocfunc = mbuf_cslab_alloc;
freefunc = mbuf_cslab_free;
auditfunc = mbuf_cslab_audit;
} else {
allocfunc = mbuf_slab_alloc;
freefunc = mbuf_slab_free;
auditfunc = mbuf_slab_audit;
}
if ((m_class(m) == MC_MBUF_16KCL || m_class(m) == MC_16KCL) &&
njcl == 0)
flags |= MCF_NOCPUCACHE;
m_cache(m) = mcache_create_ext(m_cname(m), m_maxsize(m),
allocfunc, freefunc, auditfunc, mbuf_slab_notify,
(void *)(uintptr_t)m, flags, MCR_SLEEP);
}
ncpu = ml_get_max_cpus();
MALLOC(buf, void *, MBUF_MTYPES_SIZE(ncpu) + CPU_CACHE_SIZE,
M_TEMP, M_WAITOK);
VERIFY(buf != NULL);
mbuf_mtypes = (mbuf_mtypes_t *)P2ROUNDUP((intptr_t)buf, CPU_CACHE_SIZE);
bzero(mbuf_mtypes, MBUF_MTYPES_SIZE(ncpu));
mbuf_gscale = MB_GROWTH_NORMAL;
high_sb_max = (nmbclusters << (MCLSHIFT - 4));
if (high_sb_max < sb_max) {
if (high_sb_max > (1 << MBSHIFT)) {
sb_max = high_sb_max;
} else if ((nmbclusters << MCLSHIFT) > (1 << MBSHIFT)) {
sb_max = high_sb_max = (1 << MBSHIFT);
} else {
sb_max = high_sb_max;
}
}
printf("mbinit: done (%d MB memory set for mbuf pool)\n",
(nmbclusters << MCLSHIFT) >> MBSHIFT);
}
static mcache_obj_t *
slab_alloc(mbuf_class_t class, int wait)
{
mcl_slab_t *sp;
mcache_obj_t *buf;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
VERIFY(class != MC_16KCL || njcl > 0);
VERIFY(m_cobjlist(class) == NULL);
if (class == MC_MBUF && (wait & MCR_COMP))
sp = (mcl_slab_t *)TAILQ_LAST(&m_slablist(class), mcl_slhead);
else
sp = (mcl_slab_t *)TAILQ_FIRST(&m_slablist(class));
if (sp == NULL) {
VERIFY(m_infree(class) == 0 && m_slab_cnt(class) == 0);
return (NULL);
}
VERIFY(m_infree(class) > 0);
VERIFY(!slab_is_detached(sp));
VERIFY(sp->sl_class == class &&
(sp->sl_flags & (SLF_MAPPED | SLF_PARTIAL)) == SLF_MAPPED);
buf = sp->sl_head;
VERIFY(slab_inrange(sp, buf) && sp == slab_get(buf));
if (class == MC_MBUF) {
sp->sl_head = buf->obj_next;
VERIFY(sp->sl_head != NULL || sp->sl_refcnt == (NMBPCL - 1));
} else {
sp->sl_head = NULL;
}
if (sp->sl_head != NULL && !slab_inrange(sp, sp->sl_head)) {
slab_nextptr_panic(sp, sp->sl_head);
VERIFY(slab_inrange(sp, sp->sl_head));
}
sp->sl_refcnt++;
if (mclaudit != NULL) {
mcache_audit_t *mca = mcl_audit_buf2mca(class, buf);
mca->mca_uflags = 0;
if (class == MC_MBUF)
mca->mca_uflags |= MB_SCVALID;
}
if (class == MC_CL) {
mbstat.m_clfree = (--m_infree(MC_CL)) + m_infree(MC_MBUF_CL);
VERIFY(sp->sl_refcnt == 1 && sp->sl_chunks == 1 &&
sp->sl_len == m_maxsize(MC_CL) && sp->sl_head == NULL);
} else if (class == MC_BIGCL) {
mcl_slab_t *nsp = sp->sl_next;
mbstat.m_bigclfree = (--m_infree(MC_BIGCL)) +
m_infree(MC_MBUF_BIGCL);
VERIFY(sp->sl_refcnt == 1 && sp->sl_chunks == 1 &&
sp->sl_len == m_maxsize(MC_BIGCL) && sp->sl_head == NULL);
VERIFY(nsp != NULL);
nsp->sl_refcnt++;
VERIFY(!slab_is_detached(nsp));
VERIFY(nsp->sl_class == MC_BIGCL &&
nsp->sl_flags == (SLF_MAPPED | SLF_PARTIAL) &&
nsp->sl_refcnt == 1 && nsp->sl_chunks == 0 &&
nsp->sl_len == 0 && nsp->sl_base == sp->sl_base &&
nsp->sl_head == NULL);
} else if (class == MC_16KCL) {
mcl_slab_t *nsp;
int k;
--m_infree(MC_16KCL);
VERIFY(sp->sl_refcnt == 1 && sp->sl_chunks == 1 &&
sp->sl_len == m_maxsize(MC_16KCL) && sp->sl_head == NULL);
for (nsp = sp, k = 1; k < (M16KCLBYTES / MCLBYTES); k++) {
nsp = nsp->sl_next;
VERIFY(nsp != NULL);
nsp->sl_refcnt++;
VERIFY(!slab_is_detached(nsp));
VERIFY(nsp->sl_class == MC_16KCL &&
nsp->sl_flags == (SLF_MAPPED | SLF_PARTIAL) &&
nsp->sl_refcnt == 1 && nsp->sl_chunks == 0 &&
nsp->sl_len == 0 && nsp->sl_base == sp->sl_base &&
nsp->sl_head == NULL);
}
} else {
ASSERT(class == MC_MBUF);
--m_infree(MC_MBUF);
if (mclaudit == NULL)
_MCHECK((struct mbuf *)buf);
VERIFY(sp->sl_refcnt >= 1 &&
(unsigned short)sp->sl_refcnt <= NMBPCL &&
sp->sl_chunks == NMBPCL && sp->sl_len == m_maxsize(MC_CL));
VERIFY((unsigned short)sp->sl_refcnt < NMBPCL ||
sp->sl_head == NULL);
}
if (sp->sl_head == NULL) {
VERIFY(class != MC_MBUF || sp->sl_refcnt == NMBPCL);
slab_remove(sp, class);
}
return (buf);
}
static void
slab_free(mbuf_class_t class, mcache_obj_t *buf)
{
mcl_slab_t *sp;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
VERIFY(class != MC_16KCL || njcl > 0);
VERIFY(buf->obj_next == NULL);
sp = slab_get(buf);
VERIFY(sp->sl_class == class && slab_inrange(sp, buf) &&
(sp->sl_flags & (SLF_MAPPED | SLF_PARTIAL)) == SLF_MAPPED);
sp->sl_refcnt--;
if (class == MC_CL || class == MC_BIGCL) {
VERIFY(IS_P2ALIGNED(buf, MCLBYTES));
VERIFY(sp->sl_refcnt == 0 && sp->sl_chunks == 1 &&
sp->sl_len == m_maxsize(class) && sp->sl_head == NULL);
VERIFY(slab_is_detached(sp));
if (class == MC_BIGCL) {
mcl_slab_t *nsp = sp->sl_next;
VERIFY(IS_P2ALIGNED(buf, NBPG));
VERIFY(nsp != NULL);
nsp->sl_refcnt--;
VERIFY(slab_is_detached(nsp));
VERIFY(nsp->sl_class == MC_BIGCL &&
(nsp->sl_flags & (SLF_MAPPED | SLF_PARTIAL)) &&
nsp->sl_refcnt == 0 && nsp->sl_chunks == 0 &&
nsp->sl_len == 0 && nsp->sl_base == sp->sl_base &&
nsp->sl_head == NULL);
}
} else if (class == MC_16KCL) {
mcl_slab_t *nsp;
int k;
VERIFY(IS_P2ALIGNED(buf, NBPG));
VERIFY(sp->sl_refcnt == 0 && sp->sl_chunks == 1 &&
sp->sl_len == m_maxsize(MC_16KCL) && sp->sl_head == NULL);
VERIFY(slab_is_detached(sp));
for (nsp = sp, k = 1; k < (M16KCLBYTES / MCLBYTES); k++) {
nsp = nsp->sl_next;
VERIFY(nsp != NULL);
nsp->sl_refcnt--;
VERIFY(slab_is_detached(nsp));
VERIFY(nsp->sl_class == MC_16KCL &&
(nsp->sl_flags & (SLF_MAPPED | SLF_PARTIAL)) &&
nsp->sl_refcnt == 0 && nsp->sl_chunks == 0 &&
nsp->sl_len == 0 && nsp->sl_base == sp->sl_base &&
nsp->sl_head == NULL);
}
} else {
VERIFY(sp->sl_refcnt >= 0 &&
(unsigned short)sp->sl_refcnt <= (NMBPCL - 1) &&
sp->sl_chunks == NMBPCL && sp->sl_len == m_maxsize(MC_CL));
VERIFY(sp->sl_refcnt < (NMBPCL - 1) ||
(slab_is_detached(sp) && sp->sl_head == NULL));
}
if (mclaudit != NULL) {
mcache_audit_t *mca = mcl_audit_buf2mca(class, buf);
mcache_audit_free_verify(mca, buf, 0, m_maxsize(class));
mca->mca_uflags &= ~MB_SCVALID;
}
if (class == MC_CL) {
mbstat.m_clfree = (++m_infree(MC_CL)) + m_infree(MC_MBUF_CL);
} else if (class == MC_BIGCL) {
mbstat.m_bigclfree = (++m_infree(MC_BIGCL)) +
m_infree(MC_MBUF_BIGCL);
} else if (class == MC_16KCL) {
++m_infree(MC_16KCL);
} else {
++m_infree(MC_MBUF);
buf->obj_next = sp->sl_head;
}
sp->sl_head = buf;
if (sp->sl_refcnt == 0 && class == MC_MBUF) {
int i = NMBPCL;
m_total(MC_MBUF) -= NMBPCL;
mbstat.m_mbufs = m_total(MC_MBUF);
m_infree(MC_MBUF) -= NMBPCL;
mtype_stat_add(MT_FREE, -((unsigned)NMBPCL));
while (i--) {
struct mbuf *m = sp->sl_head;
VERIFY(m != NULL);
sp->sl_head = m->m_next;
m->m_next = NULL;
}
VERIFY(sp->sl_head == NULL);
slab_remove(sp, class);
slab_init(sp, MC_CL, sp->sl_flags, sp->sl_base, sp->sl_base,
sp->sl_len, 0, 1);
if (mclaudit != NULL)
mcache_set_pattern(MCACHE_FREE_PATTERN,
(caddr_t)sp->sl_head, m_maxsize(MC_CL));
mbstat.m_clfree = (++m_infree(MC_CL)) + m_infree(MC_MBUF_CL);
VERIFY(slab_is_detached(sp));
class = MC_CL;
}
if (slab_is_detached(sp))
slab_insert(sp, class);
}
static unsigned int
mbuf_slab_alloc(void *arg, mcache_obj_t ***plist, unsigned int num, int wait)
{
mbuf_class_t class = (mbuf_class_t)arg;
unsigned int need = num;
mcache_obj_t **list = *plist;
ASSERT(MBUF_CLASS_VALID(class) && !MBUF_CLASS_COMPOSITE(class));
ASSERT(need > 0);
lck_mtx_lock(mbuf_mlock);
for (;;) {
if ((*list = slab_alloc(class, wait)) != NULL) {
(*list)->obj_next = NULL;
list = *plist = &(*list)->obj_next;
if (--need == 0) {
if (!mbuf_cached_above(class, wait) &&
m_infree(class) < m_total(class) >> 5) {
(void) freelist_populate(class, 1,
M_DONTWAIT);
}
break;
}
} else {
VERIFY(m_infree(class) == 0 || class == MC_CL);
(void) freelist_populate(class, 1,
(wait & MCR_NOSLEEP) ? M_DONTWAIT : M_WAIT);
if (m_infree(class) > 0)
continue;
if (mbuf_cached_above(class, wait))
break;
if (wait & MCR_NOSLEEP) {
if (!(wait & MCR_TRYHARD)) {
m_fail_cnt(class)++;
mbstat.m_drops++;
break;
}
}
if (mbuf_worker_ready &&
mbuf_sleep(class, need, wait))
break;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
}
}
m_alloc_cnt(class) += num - need;
lck_mtx_unlock(mbuf_mlock);
return (num - need);
}
static void
mbuf_slab_free(void *arg, mcache_obj_t *list, __unused int purged)
{
mbuf_class_t class = (mbuf_class_t)arg;
mcache_obj_t *nlist;
unsigned int num = 0;
int w;
ASSERT(MBUF_CLASS_VALID(class) && !MBUF_CLASS_COMPOSITE(class));
lck_mtx_lock(mbuf_mlock);
for (;;) {
nlist = list->obj_next;
list->obj_next = NULL;
slab_free(class, list);
++num;
if ((list = nlist) == NULL)
break;
}
m_free_cnt(class) += num;
if ((w = mb_waiters) > 0)
mb_waiters = 0;
lck_mtx_unlock(mbuf_mlock);
if (w != 0)
wakeup(mb_waitchan);
}
static void
mbuf_slab_audit(void *arg, mcache_obj_t *list, boolean_t alloc)
{
mbuf_class_t class = (mbuf_class_t)arg;
mcache_audit_t *mca;
ASSERT(MBUF_CLASS_VALID(class) && !MBUF_CLASS_COMPOSITE(class));
while (list != NULL) {
lck_mtx_lock(mbuf_mlock);
mca = mcl_audit_buf2mca(class, list);
if (class == MC_MBUF) {
mcl_audit_mbuf(mca, list, FALSE, alloc);
ASSERT(mca->mca_uflags & MB_SCVALID);
} else {
mcl_audit_cluster(mca, list, m_maxsize(class),
alloc, TRUE);
ASSERT(!(mca->mca_uflags & MB_SCVALID));
}
mcache_buffer_log(mca, list, m_cache(class));
if (alloc)
mca->mca_uflags |= MB_INUSE;
else
mca->mca_uflags &= ~MB_INUSE;
mca->mca_uptr = NULL;
lck_mtx_unlock(mbuf_mlock);
list = list->obj_next;
}
}
static void
mbuf_slab_notify(void *arg, u_int32_t reason)
{
mbuf_class_t class = (mbuf_class_t)arg;
int w;
ASSERT(MBUF_CLASS_VALID(class));
if (reason != MCN_RETRYALLOC)
return;
lck_mtx_lock(mbuf_mlock);
if ((w = mb_waiters) > 0) {
m_notified(class)++;
mb_waiters = 0;
}
lck_mtx_unlock(mbuf_mlock);
if (w != 0)
wakeup(mb_waitchan);
}
static unsigned int
cslab_alloc(mbuf_class_t class, mcache_obj_t ***plist, unsigned int num)
{
unsigned int need = num;
mcl_slab_t *sp, *clsp, *nsp;
struct mbuf *m;
mcache_obj_t **list = *plist;
void *cl;
VERIFY(need > 0);
VERIFY(class != MC_MBUF_16KCL || njcl > 0);
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
while ((*list = m_cobjlist(class)) != NULL) {
MRANGE(*list);
m = (struct mbuf *)*list;
sp = slab_get(m);
cl = m->m_ext.ext_buf;
clsp = slab_get(cl);
VERIFY(m->m_flags == M_EXT && cl != NULL);
VERIFY(MEXT_RFA(m) != NULL && MBUF_IS_COMPOSITE(m));
VERIFY(clsp->sl_refcnt == 1);
if (class == MC_MBUF_BIGCL) {
nsp = clsp->sl_next;
VERIFY(nsp != NULL);
VERIFY(nsp->sl_refcnt == 1);
} else if (class == MC_MBUF_16KCL) {
int k;
for (nsp = clsp, k = 1;
k < (M16KCLBYTES / MCLBYTES); k++) {
nsp = nsp->sl_next;
VERIFY(nsp != NULL);
VERIFY(nsp->sl_refcnt == 1);
}
}
if ((m_cobjlist(class) = (*list)->obj_next) != NULL &&
!MBUF_IN_MAP(m_cobjlist(class))) {
slab_nextptr_panic(sp, m_cobjlist(class));
}
(*list)->obj_next = NULL;
list = *plist = &(*list)->obj_next;
if (--need == 0)
break;
}
m_infree(class) -= (num - need);
return (num - need);
}
static unsigned int
cslab_free(mbuf_class_t class, mcache_obj_t *list, int purged)
{
mcache_obj_t *o, *tail;
unsigned int num = 0;
struct mbuf *m, *ms;
mcache_audit_t *mca = NULL;
mcache_obj_t *ref_list = NULL;
mcl_slab_t *clsp, *nsp;
void *cl;
ASSERT(MBUF_CLASS_VALID(class) && MBUF_CLASS_COMPOSITE(class));
VERIFY(class != MC_MBUF_16KCL || njcl > 0);
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
o = tail = list;
while ((m = ms = (struct mbuf *)o) != NULL) {
mcache_obj_t *rfa, *nexto = o->obj_next;
if (mclaudit != NULL) {
mca = mcl_audit_buf2mca(MC_MBUF, (mcache_obj_t *)m);
mcache_audit_free_verify(mca, m, 0, m_maxsize(MC_MBUF));
ms = (struct mbuf *)mca->mca_contents;
}
cl = ms->m_ext.ext_buf;
clsp = slab_get(cl);
if (mclaudit != NULL) {
size_t size;
if (class == MC_MBUF_CL)
size = m_maxsize(MC_CL);
else if (class == MC_MBUF_BIGCL)
size = m_maxsize(MC_BIGCL);
else
size = m_maxsize(MC_16KCL);
mcache_audit_free_verify(mcl_audit_buf2mca(MC_CL,
(mcache_obj_t *)cl), cl, 0, size);
}
VERIFY(ms->m_type == MT_FREE);
VERIFY(ms->m_flags == M_EXT);
VERIFY(MEXT_RFA(ms) != NULL && MBUF_IS_COMPOSITE(ms));
VERIFY(clsp->sl_refcnt == 1);
if (class == MC_MBUF_BIGCL) {
nsp = clsp->sl_next;
VERIFY(nsp != NULL);
VERIFY(nsp->sl_refcnt == 1);
} else if (class == MC_MBUF_16KCL) {
int k;
for (nsp = clsp, k = 1;
k < (M16KCLBYTES / MCLBYTES); k++) {
nsp = nsp->sl_next;
VERIFY(nsp != NULL);
VERIFY(nsp->sl_refcnt == 1);
}
}
if (purged) {
if (mclaudit != NULL)
mcl_audit_restore_mbuf(m, mca, TRUE);
MEXT_REF(m) = 0;
MEXT_FLAGS(m) = 0;
rfa = (mcache_obj_t *)MEXT_RFA(m);
rfa->obj_next = ref_list;
ref_list = rfa;
MEXT_RFA(m) = NULL;
m->m_type = MT_FREE;
m->m_flags = m->m_len = 0;
m->m_next = m->m_nextpkt = NULL;
if (mclaudit != NULL)
mcl_audit_mbuf(mca, o, FALSE, FALSE);
VERIFY(m_total(class) > 0);
m_total(class)--;
o->obj_next = NULL;
slab_free(MC_MBUF, o);
((mcache_obj_t *)cl)->obj_next = NULL;
if (class == MC_MBUF_CL)
slab_free(MC_CL, cl);
else if (class == MC_MBUF_BIGCL)
slab_free(MC_BIGCL, cl);
else
slab_free(MC_16KCL, cl);
}
++num;
tail = o;
o = nexto;
}
if (!purged) {
tail->obj_next = m_cobjlist(class);
m_cobjlist(class) = list;
m_infree(class) += num;
} else if (ref_list != NULL) {
mcache_free_ext(ref_cache, ref_list);
}
return (num);
}
static unsigned int
mbuf_cslab_alloc(void *arg, mcache_obj_t ***plist, unsigned int needed,
int wait)
{
mbuf_class_t class = (mbuf_class_t)arg;
mcache_t *cp = NULL;
unsigned int num = 0, cnum = 0, want = needed;
mcache_obj_t *ref_list = NULL;
mcache_obj_t *mp_list = NULL;
mcache_obj_t *clp_list = NULL;
mcache_obj_t **list;
struct ext_ref *rfa;
struct mbuf *m;
void *cl;
ASSERT(MBUF_CLASS_VALID(class) && MBUF_CLASS_COMPOSITE(class));
ASSERT(needed > 0);
VERIFY(class != MC_MBUF_16KCL || njcl > 0);
VERIFY(m_slab_cnt(class) == 0 &&
m_slablist(class).tqh_first == NULL &&
m_slablist(class).tqh_last == NULL);
lck_mtx_lock(mbuf_mlock);
num = cslab_alloc(class, plist, needed);
list = *plist;
if (num == needed) {
m_alloc_cnt(class) += num;
lck_mtx_unlock(mbuf_mlock);
return (needed);
}
lck_mtx_unlock(mbuf_mlock);
needed -= num;
wait |= MCR_COMP;
if (!(wait & MCR_NOSLEEP))
wait |= MCR_FAILOK;
needed = mcache_alloc_ext(m_cache(MC_MBUF), &mp_list, needed, wait);
if (needed == 0) {
ASSERT(mp_list == NULL);
goto fail;
}
if (class == MC_MBUF_CL)
cp = m_cache(MC_CL);
else if (class == MC_MBUF_BIGCL)
cp = m_cache(MC_BIGCL);
else
cp = m_cache(MC_16KCL);
needed = mcache_alloc_ext(cp, &clp_list, needed, wait);
if (needed == 0) {
ASSERT(clp_list == NULL);
goto fail;
}
needed = mcache_alloc_ext(ref_cache, &ref_list, needed, wait);
if (needed == 0) {
ASSERT(ref_list == NULL);
goto fail;
}
for (cnum = 0; cnum < needed; cnum++) {
struct mbuf *ms;
m = ms = (struct mbuf *)mp_list;
mp_list = mp_list->obj_next;
cl = clp_list;
clp_list = clp_list->obj_next;
((mcache_obj_t *)cl)->obj_next = NULL;
rfa = (struct ext_ref *)ref_list;
ref_list = ref_list->obj_next;
((mcache_obj_t *)rfa)->obj_next = NULL;
if (mclaudit != NULL) {
mcache_audit_t *mca, *cl_mca;
size_t size;
lck_mtx_lock(mbuf_mlock);
mca = mcl_audit_buf2mca(MC_MBUF, (mcache_obj_t *)m);
ms = ((struct mbuf *)mca->mca_contents);
cl_mca = mcl_audit_buf2mca(MC_CL, (mcache_obj_t *)cl);
mca->mca_uptr = cl_mca;
cl_mca->mca_uptr = mca;
ASSERT(mca->mca_uflags & MB_SCVALID);
ASSERT(!(cl_mca->mca_uflags & MB_SCVALID));
lck_mtx_unlock(mbuf_mlock);
mcache_set_pattern(MCACHE_FREE_PATTERN, m,
m_maxsize(MC_MBUF));
if (class == MC_MBUF_CL)
size = m_maxsize(MC_CL);
else if (class == MC_MBUF_BIGCL)
size = m_maxsize(MC_BIGCL);
else
size = m_maxsize(MC_16KCL);
mcache_set_pattern(MCACHE_FREE_PATTERN, cl, size);
}
MBUF_INIT(ms, 0, MT_FREE);
if (class == MC_MBUF_16KCL) {
MBUF_16KCL_INIT(ms, cl, rfa, 0, EXTF_COMPOSITE);
} else if (class == MC_MBUF_BIGCL) {
MBUF_BIGCL_INIT(ms, cl, rfa, 0, EXTF_COMPOSITE);
} else {
MBUF_CL_INIT(ms, cl, rfa, 0, EXTF_COMPOSITE);
}
VERIFY(ms->m_flags == M_EXT);
VERIFY(MEXT_RFA(ms) != NULL && MBUF_IS_COMPOSITE(ms));
*list = (mcache_obj_t *)m;
(*list)->obj_next = NULL;
list = *plist = &(*list)->obj_next;
}
fail:
if (mp_list != NULL)
mcache_free_ext(m_cache(MC_MBUF), mp_list);
if (clp_list != NULL)
mcache_free_ext(cp, clp_list);
if (ref_list != NULL)
mcache_free_ext(ref_cache, ref_list);
lck_mtx_lock(mbuf_mlock);
if (num > 0 || cnum > 0) {
m_total(class) += cnum;
VERIFY(m_total(class) <= m_maxlimit(class));
m_alloc_cnt(class) += num + cnum;
}
if ((num + cnum) < want)
m_fail_cnt(class) += (want - (num + cnum));
lck_mtx_unlock(mbuf_mlock);
return (num + cnum);
}
static void
mbuf_cslab_free(void *arg, mcache_obj_t *list, int purged)
{
mbuf_class_t class = (mbuf_class_t)arg;
unsigned int num;
int w;
ASSERT(MBUF_CLASS_VALID(class) && MBUF_CLASS_COMPOSITE(class));
lck_mtx_lock(mbuf_mlock);
num = cslab_free(class, list, purged);
m_free_cnt(class) += num;
if ((w = mb_waiters) > 0)
mb_waiters = 0;
lck_mtx_unlock(mbuf_mlock);
if (w != 0)
wakeup(mb_waitchan);
}
static void
mbuf_cslab_audit(void *arg, mcache_obj_t *list, boolean_t alloc)
{
mbuf_class_t class = (mbuf_class_t)arg;
mcache_audit_t *mca;
struct mbuf *m, *ms;
mcl_slab_t *clsp, *nsp;
size_t size;
void *cl;
ASSERT(MBUF_CLASS_VALID(class) && MBUF_CLASS_COMPOSITE(class));
while ((m = ms = (struct mbuf *)list) != NULL) {
lck_mtx_lock(mbuf_mlock);
mca = mcl_audit_buf2mca(MC_MBUF, (mcache_obj_t *)m);
mcl_audit_mbuf(mca, m, TRUE, alloc);
mcache_buffer_log(mca, m, m_cache(class));
if (alloc)
mca->mca_uflags |= MB_COMP_INUSE;
else
mca->mca_uflags &= ~MB_COMP_INUSE;
if (!alloc)
ms = (struct mbuf *)mca->mca_contents;
cl = ms->m_ext.ext_buf;
clsp = slab_get(cl);
VERIFY(ms->m_flags == M_EXT && cl != NULL);
VERIFY(MEXT_RFA(ms) != NULL && MBUF_IS_COMPOSITE(ms));
VERIFY(clsp->sl_refcnt == 1);
if (class == MC_MBUF_BIGCL) {
nsp = clsp->sl_next;
VERIFY(nsp != NULL);
VERIFY(nsp->sl_refcnt == 1);
} else if (class == MC_MBUF_16KCL) {
int k;
for (nsp = clsp, k = 1;
k < (M16KCLBYTES / MCLBYTES); k++) {
nsp = nsp->sl_next;
VERIFY(nsp != NULL);
VERIFY(nsp->sl_refcnt == 1);
}
}
mca = mcl_audit_buf2mca(MC_CL, cl);
if (class == MC_MBUF_CL)
size = m_maxsize(MC_CL);
else if (class == MC_MBUF_BIGCL)
size = m_maxsize(MC_BIGCL);
else
size = m_maxsize(MC_16KCL);
mcl_audit_cluster(mca, cl, size, alloc, FALSE);
mcache_buffer_log(mca, cl, m_cache(class));
if (alloc)
mca->mca_uflags |= MB_COMP_INUSE;
else
mca->mca_uflags &= ~MB_COMP_INUSE;
lck_mtx_unlock(mbuf_mlock);
list = list->obj_next;
}
}
static int
m_clalloc(const u_int32_t num, const int wait, const u_int32_t bufsize)
{
int i;
vm_size_t size = 0;
int numpages = 0, large_buffer = (bufsize == m_maxsize(MC_16KCL));
vm_offset_t page = 0;
mcache_audit_t *mca_list = NULL;
mcache_obj_t *con_list = NULL;
mcl_slab_t *sp;
VERIFY(bufsize == m_maxsize(MC_CL) ||
bufsize == m_maxsize(MC_BIGCL) || bufsize == m_maxsize(MC_16KCL));
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
while (mb_clalloc_busy) {
mb_clalloc_waiters++;
(void) msleep(mb_clalloc_waitchan, mbuf_mlock,
(PZERO-1), "m_clalloc", NULL);
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
}
mb_clalloc_busy = TRUE;
i = m_howmany(num, bufsize);
if (i == 0 || (wait & M_DONTWAIT))
goto out;
lck_mtx_unlock(mbuf_mlock);
size = round_page(i * bufsize);
page = kmem_mb_alloc(mb_map, size, large_buffer);
if (large_buffer && page == 0)
page = kmem_mb_alloc(mb_map, size, 0);
if (page == 0) {
if (bufsize <= m_maxsize(MC_BIGCL)) {
size = NBPG;
page = kmem_mb_alloc(mb_map, size, 0);
}
if (page == 0) {
lck_mtx_lock(mbuf_mlock);
goto out;
}
}
VERIFY(IS_P2ALIGNED(page, NBPG));
numpages = size / NBPG;
if (mclaudit != NULL) {
int needed;
if (bufsize == m_maxsize(MC_CL)) {
needed = numpages * 2 * NMBPCL;
i = mcache_alloc_ext(mcl_audit_con_cache,
&con_list, needed, MCR_SLEEP);
VERIFY(con_list != NULL && i == needed);
} else if (bufsize == m_maxsize(MC_BIGCL)) {
needed = numpages;
} else {
needed = numpages / (M16KCLBYTES / NBPG);
}
i = mcache_alloc_ext(mcache_audit_cache,
(mcache_obj_t **)&mca_list, needed, MCR_SLEEP);
VERIFY(mca_list != NULL && i == needed);
}
lck_mtx_lock(mbuf_mlock);
for (i = 0; i < numpages; i++, page += NBPG) {
ppnum_t offset = ((char *)page - (char *)mbutl) / NBPG;
ppnum_t new_page = pmap_find_phys(kernel_pmap,
(vm_offset_t)page);
VERIFY(offset < mcl_pages);
new_page = IOMapperInsertPage(mcl_paddr_base, offset, new_page);
mcl_paddr[offset] = new_page << PGSHIFT;
if (mclaudit != NULL)
mcache_set_pattern(MCACHE_FREE_PATTERN,
(caddr_t)page, NBPG);
if (bufsize == m_maxsize(MC_CL)) {
union mcluster *mcl = (union mcluster *)page;
sp = slab_get(mcl);
if (mclaudit != NULL)
mcl_audit_init(mcl, &mca_list, &con_list,
AUDIT_CONTENTS_SIZE, NMBPCL);
VERIFY(sp->sl_refcnt == 0 && sp->sl_flags == 0);
slab_init(sp, MC_CL, SLF_MAPPED,
mcl, mcl, bufsize, 0, 1);
slab_insert(sp, MC_CL);
mbstat.m_clfree = ++m_infree(MC_CL) +
m_infree(MC_MBUF_CL);
mbstat.m_clusters = ++m_total(MC_CL);
VERIFY(m_total(MC_CL) <= m_maxlimit(MC_CL));
sp = slab_get(++mcl);
if (mclaudit != NULL)
mcl_audit_init(mcl, &mca_list, &con_list,
AUDIT_CONTENTS_SIZE, NMBPCL);
VERIFY(sp->sl_refcnt == 0 && sp->sl_flags == 0);
slab_init(sp, MC_CL, SLF_MAPPED,
mcl, mcl, bufsize, 0, 1);
slab_insert(sp, MC_CL);
mbstat.m_clfree = ++m_infree(MC_CL) +
m_infree(MC_MBUF_CL);
mbstat.m_clusters = ++m_total(MC_CL);
VERIFY(m_total(MC_CL) <= m_maxlimit(MC_CL));
} else if (bufsize == m_maxsize(MC_BIGCL)) {
union mbigcluster *mbc = (union mbigcluster *)page;
mcl_slab_t *nsp;
sp = slab_get(mbc);
if (mclaudit != NULL)
mcl_audit_init(mbc, &mca_list, NULL, 0, 1);
VERIFY(sp->sl_refcnt == 0 && sp->sl_flags == 0);
slab_init(sp, MC_BIGCL, SLF_MAPPED,
mbc, mbc, bufsize, 0, 1);
nsp = slab_get(((union mcluster *)page) + 1);
slab_init(nsp, MC_BIGCL, SLF_MAPPED | SLF_PARTIAL,
mbc, NULL, 0, 0, 0);
slab_insert(sp, MC_BIGCL);
mbstat.m_bigclfree = ++m_infree(MC_BIGCL) +
m_infree(MC_MBUF_BIGCL);
mbstat.m_bigclusters = ++m_total(MC_BIGCL);
VERIFY(m_total(MC_BIGCL) <= m_maxlimit(MC_BIGCL));
} else if ((i % (M16KCLBYTES / NBPG)) == 0) {
union m16kcluster *m16kcl = (union m16kcluster *)page;
mcl_slab_t *nsp;
int k;
VERIFY(njcl > 0);
sp = slab_get(m16kcl);
if (mclaudit != NULL)
mcl_audit_init(m16kcl, &mca_list, NULL, 0, 1);
VERIFY(sp->sl_refcnt == 0 && sp->sl_flags == 0);
slab_init(sp, MC_16KCL, SLF_MAPPED,
m16kcl, m16kcl, bufsize, 0, 1);
for (k = 1; k < (M16KCLBYTES / MCLBYTES); k++) {
nsp = slab_get(((union mcluster *)page) + k);
VERIFY(nsp->sl_refcnt == 0 &&
nsp->sl_flags == 0);
slab_init(nsp, MC_16KCL,
SLF_MAPPED | SLF_PARTIAL,
m16kcl, NULL, 0, 0, 0);
}
slab_insert(sp, MC_16KCL);
m_infree(MC_16KCL)++;
m_total(MC_16KCL)++;
VERIFY(m_total(MC_16KCL) <= m_maxlimit(MC_16KCL));
}
}
VERIFY(mca_list == NULL && con_list == NULL);
mb_clalloc_busy = FALSE;
if (mb_clalloc_waiters > 0) {
mb_clalloc_waiters = 0;
wakeup(mb_clalloc_waitchan);
}
if (bufsize == m_maxsize(MC_CL))
return (numpages << 1);
else if (bufsize == m_maxsize(MC_BIGCL))
return (numpages);
VERIFY(bufsize == m_maxsize(MC_16KCL));
return (numpages / (M16KCLBYTES / NBPG));
out:
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
mb_clalloc_busy = FALSE;
if (mb_clalloc_waiters > 0) {
mb_clalloc_waiters = 0;
wakeup(mb_clalloc_waitchan);
}
if (bufsize == m_maxsize(MC_CL)) {
if (i > 0) {
i += m_total(MC_CL);
if (i > mbuf_expand_mcl) {
mbuf_expand_mcl = i;
if (mbuf_worker_ready)
wakeup((caddr_t)&mbuf_worker_run);
}
}
if (m_infree(MC_CL) >= num)
return (1);
} else if (bufsize == m_maxsize(MC_BIGCL)) {
if (i > 0) {
i += m_total(MC_BIGCL);
if (i > mbuf_expand_big) {
mbuf_expand_big = i;
if (mbuf_worker_ready)
wakeup((caddr_t)&mbuf_worker_run);
}
}
if (m_infree(MC_BIGCL) >= num)
return (1);
} else {
if (i > 0) {
i += m_total(MC_16KCL);
if (i > mbuf_expand_16k) {
mbuf_expand_16k = i;
if (mbuf_worker_ready)
wakeup((caddr_t)&mbuf_worker_run);
}
}
if (m_infree(MC_16KCL) >= num)
return (1);
}
return (0);
}
static int
freelist_populate(mbuf_class_t class, unsigned int num, int wait)
{
mcache_obj_t *o = NULL;
int i;
VERIFY(class == MC_MBUF || class == MC_CL || class == MC_BIGCL ||
class == MC_16KCL);
#if CONFIG_MBUF_NOEXPAND
if ((mbstat.m_mbufs / NMBPCL) >= maxmbufcl) {
#if DEBUG
static int printonce = 1;
if (printonce == 1) {
printonce = 0;
printf("m_expand failed, allocated %ld out of %d "
"clusters\n", mbstat.m_mbufs / NMBPCL,
nmbclusters);
}
#endif
return (0);
}
#endif
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
switch (class) {
case MC_MBUF:
case MC_CL:
i = m_clalloc(num, wait, m_maxsize(MC_CL));
if (m_total(MC_CL) == m_maxlimit(MC_CL) &&
m_infree(MC_CL) <= m_minlimit(MC_CL)) {
if (class != MC_CL || (wait & MCR_COMP))
return (0);
}
if (class == MC_CL)
return (i != 0);
break;
case MC_BIGCL:
case MC_16KCL:
return (m_clalloc(num, wait, m_maxsize(class)) != 0);
default:
VERIFY(0);
}
if ((o = slab_alloc(MC_CL, wait)) != NULL) {
struct mbuf *m = (struct mbuf *)o;
mcache_audit_t *mca = NULL;
mcl_slab_t *sp = slab_get(o);
VERIFY(slab_is_detached(sp) &&
(sp->sl_flags & (SLF_MAPPED | SLF_PARTIAL)) == SLF_MAPPED);
if (mclaudit != NULL) {
mca = mcl_audit_buf2mca(MC_CL, o);
mcache_audit_free_verify(mca, o, 0, m_maxsize(MC_CL));
}
slab_init(sp, MC_MBUF, sp->sl_flags, sp->sl_base, NULL,
sp->sl_len, 0, NMBPCL);
VERIFY(m == (struct mbuf *)sp->sl_base);
VERIFY(sp->sl_head == NULL);
m_total(MC_MBUF) += NMBPCL;
mbstat.m_mbufs = m_total(MC_MBUF);
m_infree(MC_MBUF) += NMBPCL;
mtype_stat_add(MT_FREE, NMBPCL);
i = NMBPCL;
while (i--) {
if (mclaudit != NULL) {
struct mbuf *ms;
mca = mcl_audit_buf2mca(MC_MBUF,
(mcache_obj_t *)m);
ms = ((struct mbuf *)mca->mca_contents);
ms->m_type = MT_FREE;
} else {
m->m_type = MT_FREE;
}
m->m_next = sp->sl_head;
sp->sl_head = (void *)m++;
}
slab_insert(sp, MC_MBUF);
if ((i = mb_waiters) > 0)
mb_waiters = 0;
if (i != 0)
wakeup(mb_waitchan);
return (1);
}
return (0);
}
static boolean_t
mbuf_cached_above(mbuf_class_t class, int wait)
{
switch (class) {
case MC_MBUF:
if (wait & MCR_COMP)
return (!mcache_bkt_isempty(m_cache(MC_MBUF_CL)) ||
!mcache_bkt_isempty(m_cache(MC_MBUF_BIGCL)));
break;
case MC_CL:
if (wait & MCR_COMP)
return (!mcache_bkt_isempty(m_cache(MC_MBUF_CL)));
break;
case MC_BIGCL:
if (wait & MCR_COMP)
return (!mcache_bkt_isempty(m_cache(MC_MBUF_BIGCL)));
break;
case MC_16KCL:
if (wait & MCR_COMP)
return (!mcache_bkt_isempty(m_cache(MC_MBUF_16KCL)));
break;
case MC_MBUF_CL:
case MC_MBUF_BIGCL:
case MC_MBUF_16KCL:
break;
default:
VERIFY(0);
}
return (!mcache_bkt_isempty(m_cache(class)));
}
static boolean_t
mbuf_steal(mbuf_class_t class, unsigned int num)
{
mcache_obj_t *top = NULL;
mcache_obj_t **list = ⊤
unsigned int tot = 0;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
switch (class) {
case MC_MBUF:
case MC_CL:
case MC_BIGCL:
case MC_16KCL:
return (FALSE);
case MC_MBUF_CL:
case MC_MBUF_BIGCL:
case MC_MBUF_16KCL:
if (m_infree(class) > m_minlimit(class)) {
tot = cslab_alloc(class, &list,
MIN(num, m_infree(class)));
}
if (top != NULL)
(void) cslab_free(class, top, 1);
break;
default:
VERIFY(0);
}
return (tot == num);
}
static void
m_reclaim(mbuf_class_t class, unsigned int num, boolean_t comp)
{
int m, bmap = 0;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
VERIFY(m_total(MC_CL) <= m_maxlimit(MC_CL));
VERIFY(m_total(MC_BIGCL) <= m_maxlimit(MC_BIGCL));
VERIFY(m_total(MC_16KCL) <= m_maxlimit(MC_16KCL));
switch (class) {
case MC_MBUF:
m_wantpurge(MC_CL)++;
m_wantpurge(MC_MBUF_CL)++;
m_wantpurge(MC_MBUF_BIGCL)++;
break;
case MC_CL:
m_wantpurge(MC_MBUF)++;
if (!comp)
m_wantpurge(MC_MBUF_CL)++;
break;
case MC_BIGCL:
if (!comp)
m_wantpurge(MC_MBUF_BIGCL)++;
break;
case MC_16KCL:
if (!comp)
m_wantpurge(MC_MBUF_16KCL)++;
break;
default:
VERIFY(0);
}
for (m = 0; m < NELEM(mbuf_table); m++) {
if (m_wantpurge(m) > 0) {
m_wantpurge(m) = 0;
if (!mbuf_steal(m, num))
bmap |= (1 << m);
}
}
lck_mtx_unlock(mbuf_mlock);
if (bmap != 0) {
do_reclaim = 1;
for (m = 0; m < NELEM(mbuf_table); m++) {
if ((bmap & (1 << m)) &&
mcache_purge_cache(m_cache(m))) {
lck_mtx_lock(mbuf_mlock);
m_purge_cnt(m)++;
mbstat.m_drain++;
lck_mtx_unlock(mbuf_mlock);
}
}
} else {
mcache_reap();
}
lck_mtx_lock(mbuf_mlock);
}
static inline struct mbuf *
m_get_common(int wait, short type, int hdr)
{
struct mbuf *m;
int mcflags = MSLEEPF(wait);
if (mcflags & MCR_NOSLEEP)
mcflags |= MCR_TRYHARD;
m = mcache_alloc(m_cache(MC_MBUF), mcflags);
if (m != NULL) {
MBUF_INIT(m, hdr, type);
mtype_stat_inc(type);
mtype_stat_dec(MT_FREE);
#if CONFIG_MACF_NET
if (hdr && mac_init_mbuf(m, wait) != 0) {
m_free(m);
return (NULL);
}
#endif
}
return (m);
}
#define _M_GET(wait, type) m_get_common(wait, type, 0)
#define _M_GETHDR(wait, type) m_get_common(wait, type, 1)
#define _M_RETRY(wait, type) _M_GET(wait, type)
#define _M_RETRYHDR(wait, type) _M_GETHDR(wait, type)
#define _MGET(m, how, type) ((m) = _M_GET(how, type))
#define _MGETHDR(m, how, type) ((m) = _M_GETHDR(how, type))
struct mbuf *
m_get(int wait, int type)
{
return (_M_GET(wait, type));
}
struct mbuf *
m_gethdr(int wait, int type)
{
return (_M_GETHDR(wait, type));
}
struct mbuf *
m_retry(int wait, int type)
{
return (_M_RETRY(wait, type));
}
struct mbuf *
m_retryhdr(int wait, int type)
{
return (_M_RETRYHDR(wait, type));
}
struct mbuf *
m_getclr(int wait, int type)
{
struct mbuf *m;
_MGET(m, wait, type);
if (m != NULL)
bzero(MTOD(m, caddr_t), MLEN);
return (m);
}
struct mbuf *
m_free(struct mbuf *m)
{
struct mbuf *n = m->m_next;
if (m->m_type == MT_FREE)
panic("m_free: freeing an already freed mbuf");
if (m->m_flags & M_PKTHDR) {
m_tag_delete_chain(m, NULL);
}
if (m->m_flags & M_EXT) {
u_int32_t refcnt;
u_int32_t flags;
refcnt = m_decref(m);
flags = MEXT_FLAGS(m);
if (refcnt == 0 && flags == 0) {
if (m->m_ext.ext_free == NULL) {
mcache_free(m_cache(MC_CL), m->m_ext.ext_buf);
} else if (m->m_ext.ext_free == m_bigfree) {
mcache_free(m_cache(MC_BIGCL),
m->m_ext.ext_buf);
} else if (m->m_ext.ext_free == m_16kfree) {
mcache_free(m_cache(MC_16KCL),
m->m_ext.ext_buf);
} else {
(*(m->m_ext.ext_free))(m->m_ext.ext_buf,
m->m_ext.ext_size, m->m_ext.ext_arg);
}
mcache_free(ref_cache, MEXT_RFA(m));
MEXT_RFA(m) = NULL;
} else if (refcnt == 0 && (flags & EXTF_COMPOSITE)) {
VERIFY(m->m_type != MT_FREE);
mtype_stat_dec(m->m_type);
mtype_stat_inc(MT_FREE);
m->m_type = MT_FREE;
m->m_flags = M_EXT;
m->m_len = 0;
m->m_next = m->m_nextpkt = NULL;
if (m->m_ext.ext_free == NULL) {
mcache_free(m_cache(MC_MBUF_CL), m);
} else if (m->m_ext.ext_free == m_bigfree) {
mcache_free(m_cache(MC_MBUF_BIGCL), m);
} else {
VERIFY(m->m_ext.ext_free == m_16kfree);
mcache_free(m_cache(MC_MBUF_16KCL), m);
}
return (n);
}
}
if (m->m_type != MT_FREE) {
mtype_stat_dec(m->m_type);
mtype_stat_inc(MT_FREE);
}
m->m_type = MT_FREE;
m->m_flags = m->m_len = 0;
m->m_next = m->m_nextpkt = NULL;
mcache_free(m_cache(MC_MBUF), m);
return (n);
}
__private_extern__ struct mbuf *
m_clattach(struct mbuf *m, int type, caddr_t extbuf,
void (*extfree)(caddr_t, u_int, caddr_t), u_int extsize, caddr_t extarg,
int wait)
{
struct ext_ref *rfa = NULL;
if (m == NULL && (m = _M_GETHDR(wait, type)) == NULL)
return (NULL);
if (m->m_flags & M_EXT) {
u_int32_t refcnt;
u_int32_t flags;
refcnt = m_decref(m);
flags = MEXT_FLAGS(m);
if (refcnt == 0 && flags == 0) {
if (m->m_ext.ext_free == NULL) {
mcache_free(m_cache(MC_CL), m->m_ext.ext_buf);
} else if (m->m_ext.ext_free == m_bigfree) {
mcache_free(m_cache(MC_BIGCL),
m->m_ext.ext_buf);
} else if (m->m_ext.ext_free == m_16kfree) {
mcache_free(m_cache(MC_16KCL),
m->m_ext.ext_buf);
} else {
(*(m->m_ext.ext_free))(m->m_ext.ext_buf,
m->m_ext.ext_size, m->m_ext.ext_arg);
}
rfa = MEXT_RFA(m);
} else if (refcnt == 0 && (flags & EXTF_COMPOSITE)) {
VERIFY(m->m_type != MT_FREE);
mtype_stat_dec(m->m_type);
mtype_stat_inc(MT_FREE);
m->m_type = MT_FREE;
m->m_flags = M_EXT;
m->m_len = 0;
m->m_next = m->m_nextpkt = NULL;
if (m->m_ext.ext_free == NULL) {
mcache_free(m_cache(MC_MBUF_CL), m);
} else if (m->m_ext.ext_free == m_bigfree) {
mcache_free(m_cache(MC_MBUF_BIGCL), m);
} else {
VERIFY(m->m_ext.ext_free == m_16kfree);
mcache_free(m_cache(MC_MBUF_16KCL), m);
}
if ((m = _M_GETHDR(wait, type)) == NULL)
return (NULL);
}
}
if (rfa == NULL &&
(rfa = mcache_alloc(ref_cache, MSLEEPF(wait))) == NULL) {
m_free(m);
return (NULL);
}
MEXT_INIT(m, extbuf, extsize, extfree, extarg, rfa, 1, 0);
return (m);
}
struct mbuf *
m_getcl(int wait, int type, int flags)
{
struct mbuf *m;
int mcflags = MSLEEPF(wait);
int hdr = (flags & M_PKTHDR);
if (mcflags & MCR_NOSLEEP)
mcflags |= MCR_TRYHARD;
m = mcache_alloc(m_cache(MC_MBUF_CL), mcflags);
if (m != NULL) {
MBUF_INIT(m, hdr, type);
mtype_stat_inc(type);
mtype_stat_dec(MT_FREE);
#if CONFIG_MACF_NET
if (hdr && mac_init_mbuf(m, wait) != 0) {
m_free(m);
return (NULL);
}
#endif
}
return (m);
}
struct mbuf *
m_mclget(struct mbuf *m, int wait)
{
struct ext_ref *rfa;
if ((rfa = mcache_alloc(ref_cache, MSLEEPF(wait))) == NULL)
return (m);
m->m_ext.ext_buf = m_mclalloc(wait);
if (m->m_ext.ext_buf != NULL) {
MBUF_CL_INIT(m, m->m_ext.ext_buf, rfa, 1, 0);
} else {
mcache_free(ref_cache, rfa);
}
return (m);
}
caddr_t
m_mclalloc(int wait)
{
int mcflags = MSLEEPF(wait);
if (mcflags & MCR_NOSLEEP)
mcflags |= MCR_TRYHARD;
return (mcache_alloc(m_cache(MC_CL), mcflags));
}
void
m_mclfree(caddr_t p)
{
mcache_free(m_cache(MC_CL), p);
}
int
m_mclhasreference(struct mbuf *m)
{
if (!(m->m_flags & M_EXT))
return (0);
ASSERT(MEXT_RFA(m) != NULL);
return (MEXT_REF(m) > 1);
}
__private_extern__ caddr_t
m_bigalloc(int wait)
{
int mcflags = MSLEEPF(wait);
if (mcflags & MCR_NOSLEEP)
mcflags |= MCR_TRYHARD;
return (mcache_alloc(m_cache(MC_BIGCL), mcflags));
}
__private_extern__ void
m_bigfree(caddr_t p, __unused u_int size, __unused caddr_t arg)
{
mcache_free(m_cache(MC_BIGCL), p);
}
__private_extern__ struct mbuf *
m_mbigget(struct mbuf *m, int wait)
{
struct ext_ref *rfa;
if ((rfa = mcache_alloc(ref_cache, MSLEEPF(wait))) == NULL)
return (m);
m->m_ext.ext_buf = m_bigalloc(wait);
if (m->m_ext.ext_buf != NULL) {
MBUF_BIGCL_INIT(m, m->m_ext.ext_buf, rfa, 1, 0);
} else {
mcache_free(ref_cache, rfa);
}
return (m);
}
__private_extern__ caddr_t
m_16kalloc(int wait)
{
int mcflags = MSLEEPF(wait);
if (mcflags & MCR_NOSLEEP)
mcflags |= MCR_TRYHARD;
return (mcache_alloc(m_cache(MC_16KCL), mcflags));
}
__private_extern__ void
m_16kfree(caddr_t p, __unused u_int size, __unused caddr_t arg)
{
mcache_free(m_cache(MC_16KCL), p);
}
__private_extern__ struct mbuf *
m_m16kget(struct mbuf *m, int wait)
{
struct ext_ref *rfa;
if ((rfa = mcache_alloc(ref_cache, MSLEEPF(wait))) == NULL)
return (m);
m->m_ext.ext_buf = m_16kalloc(wait);
if (m->m_ext.ext_buf != NULL) {
MBUF_16KCL_INIT(m, m->m_ext.ext_buf, rfa, 1, 0);
} else {
mcache_free(ref_cache, rfa);
}
return (m);
}
void
m_copy_pkthdr(struct mbuf *to, struct mbuf *from)
{
if (to->m_flags & M_PKTHDR)
m_tag_delete_chain(to, NULL);
to->m_pkthdr = from->m_pkthdr;
m_tag_init(from);
to->m_flags = (from->m_flags & M_COPYFLAGS) | (to->m_flags & M_EXT);
if ((to->m_flags & M_EXT) == 0)
to->m_data = to->m_pktdat;
}
static int
m_dup_pkthdr(struct mbuf *to, struct mbuf *from, int how)
{
if (to->m_flags & M_PKTHDR)
m_tag_delete_chain(to, NULL);
to->m_flags = (from->m_flags & M_COPYFLAGS) | (to->m_flags & M_EXT);
if ((to->m_flags & M_EXT) == 0)
to->m_data = to->m_pktdat;
to->m_pkthdr = from->m_pkthdr;
m_tag_init(to);
return (m_tag_copy_chain(to, from, how));
}
__private_extern__ struct mbuf *
m_getpackets_internal(unsigned int *num_needed, int num_with_pkthdrs,
int wait, int wantall, size_t bufsize)
{
struct mbuf *m;
struct mbuf **np, *top;
unsigned int pnum, needed = *num_needed;
mcache_obj_t *mp_list = NULL;
int mcflags = MSLEEPF(wait);
u_int32_t flag;
struct ext_ref *rfa;
mcache_t *cp;
void *cl;
ASSERT(bufsize == m_maxsize(MC_CL) ||
bufsize == m_maxsize(MC_BIGCL) ||
bufsize == m_maxsize(MC_16KCL));
VERIFY(bufsize != m_maxsize(MC_16KCL) || njcl > 0);
top = NULL;
np = ⊤
pnum = 0;
if (!wantall || (mcflags & MCR_NOSLEEP))
mcflags |= MCR_TRYHARD;
if (bufsize == m_maxsize(MC_CL))
cp = m_cache(MC_MBUF_CL);
else if (bufsize == m_maxsize(MC_BIGCL))
cp = m_cache(MC_MBUF_BIGCL);
else
cp = m_cache(MC_MBUF_16KCL);
needed = mcache_alloc_ext(cp, &mp_list, needed, mcflags);
for (pnum = 0; pnum < needed; pnum++) {
m = (struct mbuf *)mp_list;
mp_list = mp_list->obj_next;
VERIFY(m->m_type == MT_FREE && m->m_flags == M_EXT);
cl = m->m_ext.ext_buf;
rfa = MEXT_RFA(m);
ASSERT(cl != NULL && rfa != NULL);
VERIFY(MBUF_IS_COMPOSITE(m));
flag = MEXT_FLAGS(m);
MBUF_INIT(m, num_with_pkthdrs, MT_DATA);
if (bufsize == m_maxsize(MC_16KCL)) {
MBUF_16KCL_INIT(m, cl, rfa, 1, flag);
} else if (bufsize == m_maxsize(MC_BIGCL)) {
MBUF_BIGCL_INIT(m, cl, rfa, 1, flag);
} else {
MBUF_CL_INIT(m, cl, rfa, 1, flag);
}
if (num_with_pkthdrs > 0) {
--num_with_pkthdrs;
#if CONFIG_MACF_NET
if (mac_mbuf_label_init(m, wait) != 0) {
m_free(m);
break;
}
#endif
}
*np = m;
if (num_with_pkthdrs > 0)
np = &m->m_nextpkt;
else
np = &m->m_next;
}
ASSERT(pnum != *num_needed || mp_list == NULL);
if (mp_list != NULL)
mcache_free_ext(cp, mp_list);
if (pnum > 0) {
mtype_stat_add(MT_DATA, pnum);
mtype_stat_sub(MT_FREE, pnum);
}
if (wantall && (pnum != *num_needed)) {
if (top != NULL)
m_freem_list(top);
return (NULL);
}
*num_needed = pnum;
return (top);
}
__private_extern__ struct mbuf *
m_allocpacket_internal(unsigned int *numlist, size_t packetlen,
unsigned int *maxsegments, int wait, int wantall, size_t wantsize)
{
struct mbuf **np, *top, *first = NULL;
size_t bufsize, r_bufsize;
unsigned int num = 0;
unsigned int nsegs = 0;
unsigned int needed, resid;
int mcflags = MSLEEPF(wait);
mcache_obj_t *mp_list = NULL, *rmp_list = NULL;
mcache_t *cp = NULL, *rcp = NULL;
if (*numlist == 0)
return (NULL);
top = NULL;
np = ⊤
if (wantsize == 0) {
if (packetlen <= MINCLSIZE) {
bufsize = packetlen;
} else if (packetlen > m_maxsize(MC_CL)) {
if (packetlen <= m_maxsize(MC_BIGCL) || njcl == 0)
bufsize = m_maxsize(MC_BIGCL);
else
bufsize = m_maxsize(MC_16KCL);
} else {
bufsize = m_maxsize(MC_CL);
}
} else if (wantsize == m_maxsize(MC_CL) ||
wantsize == m_maxsize(MC_BIGCL) ||
(wantsize == m_maxsize(MC_16KCL) && njcl > 0)) {
bufsize = wantsize;
} else {
return (NULL);
}
if (bufsize <= MHLEN) {
nsegs = 1;
} else if (bufsize <= MINCLSIZE) {
if (maxsegments != NULL && *maxsegments == 1) {
bufsize = m_maxsize(MC_CL);
nsegs = 1;
} else {
nsegs = 2;
}
} else if (bufsize == m_maxsize(MC_16KCL)) {
VERIFY(njcl > 0);
nsegs = ((packetlen - 1) >> (PGSHIFT + 2)) + 1;
} else if (bufsize == m_maxsize(MC_BIGCL)) {
nsegs = ((packetlen - 1) >> PGSHIFT) + 1;
} else {
nsegs = ((packetlen - 1) >> MCLSHIFT) + 1;
}
if (maxsegments != NULL) {
if (*maxsegments && nsegs > *maxsegments) {
*maxsegments = nsegs;
return (NULL);
}
*maxsegments = nsegs;
}
if (!wantall || (mcflags & MCR_NOSLEEP))
mcflags |= MCR_TRYHARD;
if (bufsize <= MINCLSIZE) {
ASSERT(bufsize <= MHLEN || nsegs == 2);
cp = m_cache(MC_MBUF);
needed = mcache_alloc_ext(cp, &mp_list,
(*numlist) * nsegs, mcflags);
if (bufsize > MHLEN && (needed & 0x1))
needed--;
while (num < needed) {
struct mbuf *m;
m = (struct mbuf *)mp_list;
mp_list = mp_list->obj_next;
ASSERT(m != NULL);
MBUF_INIT(m, 1, MT_DATA);
#if CONFIG_MACF_NET
if (mac_init_mbuf(m, wait) != 0) {
m_free(m);
break;
}
#endif
num++;
if (bufsize > MHLEN) {
m->m_next = (struct mbuf *)mp_list;
mp_list = mp_list->obj_next;
ASSERT(m->m_next != NULL);
MBUF_INIT(m->m_next, 0, MT_DATA);
num++;
}
*np = m;
np = &m->m_nextpkt;
}
ASSERT(num != *numlist || mp_list == NULL);
if (num > 0) {
mtype_stat_add(MT_DATA, num);
mtype_stat_sub(MT_FREE, num);
}
num /= nsegs;
if (num == *numlist)
return (top);
goto fail;
}
r_bufsize = bufsize;
resid = packetlen > bufsize ? packetlen % bufsize : 0;
if (resid > 0) {
if (wantsize == 0 && packetlen > MINCLSIZE) {
if (njcl > 0 && resid > m_maxsize(MC_BIGCL))
r_bufsize = m_maxsize(MC_16KCL);
else if (resid > m_maxsize(MC_CL))
r_bufsize = m_maxsize(MC_BIGCL);
else
r_bufsize = m_maxsize(MC_CL);
} else {
resid = 0;
}
}
needed = *numlist;
if (resid > 0) {
if (r_bufsize <= m_maxsize(MC_CL))
rcp = m_cache(MC_MBUF_CL);
else if (r_bufsize <= m_maxsize(MC_BIGCL))
rcp = m_cache(MC_MBUF_BIGCL);
else
rcp = m_cache(MC_MBUF_16KCL);
needed = mcache_alloc_ext(rcp, &rmp_list, *numlist, mcflags);
if (needed == 0)
goto fail;
ASSERT(nsegs > 1);
nsegs--;
}
if (bufsize <= m_maxsize(MC_CL))
cp = m_cache(MC_MBUF_CL);
else if (bufsize <= m_maxsize(MC_BIGCL))
cp = m_cache(MC_MBUF_BIGCL);
else
cp = m_cache(MC_MBUF_16KCL);
needed = mcache_alloc_ext(cp, &mp_list, needed * nsegs, mcflags);
needed = (needed / nsegs) * nsegs;
if (needed == 0)
goto fail;
if (resid > 0) {
ASSERT(nsegs > 0);
needed += needed / nsegs;
nsegs++;
}
for (;;) {
struct mbuf *m;
u_int32_t flag;
struct ext_ref *rfa;
void *cl;
int pkthdr;
++num;
if (nsegs == 1 || (num % nsegs) != 0 || resid == 0) {
m = (struct mbuf *)mp_list;
mp_list = mp_list->obj_next;
} else {
m = (struct mbuf *)rmp_list;
rmp_list = rmp_list->obj_next;
}
ASSERT(m != NULL);
VERIFY(m->m_type == MT_FREE && m->m_flags == M_EXT);
VERIFY(m->m_ext.ext_free == NULL ||
m->m_ext.ext_free == m_bigfree ||
m->m_ext.ext_free == m_16kfree);
cl = m->m_ext.ext_buf;
rfa = MEXT_RFA(m);
ASSERT(cl != NULL && rfa != NULL);
VERIFY(MBUF_IS_COMPOSITE(m));
flag = MEXT_FLAGS(m);
pkthdr = (nsegs == 1 || (num % nsegs) == 1);
if (pkthdr)
first = m;
MBUF_INIT(m, pkthdr, MT_DATA);
if (m->m_ext.ext_free == m_16kfree) {
MBUF_16KCL_INIT(m, cl, rfa, 1, flag);
} else if (m->m_ext.ext_free == m_bigfree) {
MBUF_BIGCL_INIT(m, cl, rfa, 1, flag);
} else {
MBUF_CL_INIT(m, cl, rfa, 1, flag);
}
#if CONFIG_MACF_NET
if (pkthdr && mac_init_mbuf(m, wait) != 0) {
--num;
m_free(m);
break;
}
#endif
*np = m;
if ((num % nsegs) == 0)
np = &first->m_nextpkt;
else
np = &m->m_next;
if (num == needed)
break;
}
if (num > 0) {
mtype_stat_add(MT_DATA, num);
mtype_stat_sub(MT_FREE, num);
}
num /= nsegs;
if (num == *numlist) {
ASSERT(mp_list == NULL && rmp_list == NULL);
return (top);
}
fail:
if (mp_list != NULL)
mcache_free_ext(cp, mp_list);
if (rmp_list != NULL)
mcache_free_ext(rcp, rmp_list);
if (wantall && top != NULL) {
m_freem(top);
return (NULL);
}
*numlist = num;
return (top);
}
__private_extern__ struct mbuf *
m_getpacket_how(int wait)
{
unsigned int num_needed = 1;
return (m_getpackets_internal(&num_needed, 1, wait, 1,
m_maxsize(MC_CL)));
}
struct mbuf *
m_getpacket(void)
{
unsigned int num_needed = 1;
return (m_getpackets_internal(&num_needed, 1, M_WAIT, 1,
m_maxsize(MC_CL)));
}
struct mbuf *
m_getpackets(int num_needed, int num_with_pkthdrs, int how)
{
unsigned int n = num_needed;
return (m_getpackets_internal(&n, num_with_pkthdrs, how, 0,
m_maxsize(MC_CL)));
}
struct mbuf *
m_getpackethdrs(int num_needed, int how)
{
struct mbuf *m;
struct mbuf **np, *top;
top = NULL;
np = ⊤
while (num_needed--) {
m = _M_RETRYHDR(how, MT_DATA);
if (m == NULL)
break;
*np = m;
np = &m->m_nextpkt;
}
return (top);
}
int
m_freem_list(struct mbuf *m)
{
struct mbuf *nextpkt;
mcache_obj_t *mp_list = NULL;
mcache_obj_t *mcl_list = NULL;
mcache_obj_t *mbc_list = NULL;
mcache_obj_t *m16k_list = NULL;
mcache_obj_t *m_mcl_list = NULL;
mcache_obj_t *m_mbc_list = NULL;
mcache_obj_t *m_m16k_list = NULL;
mcache_obj_t *ref_list = NULL;
int pktcount = 0;
int mt_free = 0, mt_data = 0, mt_header = 0, mt_soname = 0, mt_tag = 0;
while (m != NULL) {
pktcount++;
nextpkt = m->m_nextpkt;
m->m_nextpkt = NULL;
while (m != NULL) {
struct mbuf *next = m->m_next;
mcache_obj_t *o, *rfa;
u_int32_t refcnt, flags;
if (m->m_type == MT_FREE)
panic("m_free: freeing an already freed mbuf");
if (m->m_type != MT_FREE)
mt_free++;
if (m->m_flags & M_PKTHDR) {
m_tag_delete_chain(m, NULL);
}
if (!(m->m_flags & M_EXT))
goto simple_free;
o = (mcache_obj_t *)m->m_ext.ext_buf;
refcnt = m_decref(m);
flags = MEXT_FLAGS(m);
if (refcnt == 0 && flags == 0) {
if (m->m_ext.ext_free == NULL) {
o->obj_next = mcl_list;
mcl_list = o;
} else if (m->m_ext.ext_free == m_bigfree) {
o->obj_next = mbc_list;
mbc_list = o;
} else if (m->m_ext.ext_free == m_16kfree) {
o->obj_next = m16k_list;
m16k_list = o;
} else {
(*(m->m_ext.ext_free))((caddr_t)o,
m->m_ext.ext_size,
m->m_ext.ext_arg);
}
rfa = (mcache_obj_t *)MEXT_RFA(m);
rfa->obj_next = ref_list;
ref_list = rfa;
MEXT_RFA(m) = NULL;
} else if (refcnt == 0 && (flags & EXTF_COMPOSITE)) {
VERIFY(m->m_type != MT_FREE);
if (m->m_type == MT_DATA)
mt_data++;
else if (m->m_type == MT_HEADER)
mt_header++;
else if (m->m_type == MT_SONAME)
mt_soname++;
else if (m->m_type == MT_TAG)
mt_tag++;
else
mtype_stat_dec(m->m_type);
m->m_type = MT_FREE;
m->m_flags = M_EXT;
m->m_len = 0;
m->m_next = m->m_nextpkt = NULL;
o = (mcache_obj_t *)m;
if (m->m_ext.ext_free == NULL) {
o->obj_next = m_mcl_list;
m_mcl_list = o;
} else if (m->m_ext.ext_free == m_bigfree) {
o->obj_next = m_mbc_list;
m_mbc_list = o;
} else {
VERIFY(m->m_ext.ext_free == m_16kfree);
o->obj_next = m_m16k_list;
m_m16k_list = o;
}
m = next;
continue;
}
simple_free:
if (m->m_type == MT_DATA)
mt_data++;
else if (m->m_type == MT_HEADER)
mt_header++;
else if (m->m_type == MT_SONAME)
mt_soname++;
else if (m->m_type == MT_TAG)
mt_tag++;
else if (m->m_type != MT_FREE)
mtype_stat_dec(m->m_type);
m->m_type = MT_FREE;
m->m_flags = m->m_len = 0;
m->m_next = m->m_nextpkt = NULL;
((mcache_obj_t *)m)->obj_next = mp_list;
mp_list = (mcache_obj_t *)m;
m = next;
}
m = nextpkt;
}
if (mt_free > 0)
mtype_stat_add(MT_FREE, mt_free);
if (mt_data > 0)
mtype_stat_sub(MT_DATA, mt_data);
if (mt_header > 0)
mtype_stat_sub(MT_HEADER, mt_header);
if (mt_soname > 0)
mtype_stat_sub(MT_SONAME, mt_soname);
if (mt_tag > 0)
mtype_stat_sub(MT_TAG, mt_tag);
if (mp_list != NULL)
mcache_free_ext(m_cache(MC_MBUF), mp_list);
if (mcl_list != NULL)
mcache_free_ext(m_cache(MC_CL), mcl_list);
if (mbc_list != NULL)
mcache_free_ext(m_cache(MC_BIGCL), mbc_list);
if (m16k_list != NULL)
mcache_free_ext(m_cache(MC_16KCL), m16k_list);
if (m_mcl_list != NULL)
mcache_free_ext(m_cache(MC_MBUF_CL), m_mcl_list);
if (m_mbc_list != NULL)
mcache_free_ext(m_cache(MC_MBUF_BIGCL), m_mbc_list);
if (m_m16k_list != NULL)
mcache_free_ext(m_cache(MC_MBUF_16KCL), m_m16k_list);
if (ref_list != NULL)
mcache_free_ext(ref_cache, ref_list);
return (pktcount);
}
void
m_freem(struct mbuf *m)
{
while (m != NULL)
m = m_free(m);
}
int
m_leadingspace(struct mbuf *m)
{
if (m->m_flags & M_EXT) {
if (MCLHASREFERENCE(m))
return (0);
return (m->m_data - m->m_ext.ext_buf);
}
if (m->m_flags & M_PKTHDR)
return (m->m_data - m->m_pktdat);
return (m->m_data - m->m_dat);
}
int
m_trailingspace(struct mbuf *m)
{
if (m->m_flags & M_EXT) {
if (MCLHASREFERENCE(m))
return (0);
return (m->m_ext.ext_buf + m->m_ext.ext_size -
(m->m_data + m->m_len));
}
return (&m->m_dat[MLEN] - (m->m_data + m->m_len));
}
struct mbuf *
m_prepend(struct mbuf *m, int len, int how)
{
struct mbuf *mn;
_MGET(mn, how, m->m_type);
if (mn == NULL) {
m_freem(m);
return (NULL);
}
if (m->m_flags & M_PKTHDR) {
M_COPY_PKTHDR(mn, m);
m->m_flags &= ~M_PKTHDR;
}
mn->m_next = m;
m = mn;
if (len < MHLEN)
MH_ALIGN(m, len);
m->m_len = len;
return (m);
}
struct mbuf *
m_prepend_2(struct mbuf *m, int len, int how)
{
if (M_LEADINGSPACE(m) >= len) {
m->m_data -= len;
m->m_len += len;
} else {
m = m_prepend(m, len, how);
}
if ((m) && (m->m_flags & M_PKTHDR))
m->m_pkthdr.len += len;
return (m);
}
int MCFail;
struct mbuf *
m_copym(struct mbuf *m, int off0, int len, int wait)
{
struct mbuf *n, *mhdr = NULL, **np;
int off = off0;
struct mbuf *top;
int copyhdr = 0;
if (off < 0 || len < 0)
panic("m_copym: invalid offset %d or len %d", off, len);
if (off == 0 && (m->m_flags & M_PKTHDR)) {
mhdr = m;
copyhdr = 1;
}
while (off >= m->m_len) {
if (m->m_next == NULL)
panic("m_copym: invalid mbuf chain");
off -= m->m_len;
m = m->m_next;
}
np = ⊤
top = NULL;
while (len > 0) {
if (m == NULL) {
if (len != M_COPYALL)
panic("m_copym: len != M_COPYALL");
break;
}
n = _M_RETRY(wait, m->m_type);
*np = n;
if (n == NULL)
goto nospace;
if (copyhdr != 0) {
M_COPY_PKTHDR(n, mhdr);
if (len == M_COPYALL)
n->m_pkthdr.len -= off0;
else
n->m_pkthdr.len = len;
copyhdr = 0;
}
if (len == M_COPYALL) {
if (MIN(len, (m->m_len - off)) == len) {
printf("m->m_len %d - off %d = %d, %d\n",
m->m_len, off, m->m_len - off,
MIN(len, (m->m_len - off)));
}
}
n->m_len = MIN(len, (m->m_len - off));
if (n->m_len == M_COPYALL) {
printf("n->m_len == M_COPYALL, fixing\n");
n->m_len = MHLEN;
}
if (m->m_flags & M_EXT) {
n->m_ext = m->m_ext;
m_incref(m);
n->m_data = m->m_data + off;
n->m_flags |= M_EXT;
} else {
bcopy(MTOD(m, caddr_t)+off, MTOD(n, caddr_t),
(unsigned)n->m_len);
}
if (len != M_COPYALL)
len -= n->m_len;
off = 0;
m = m->m_next;
np = &n->m_next;
}
if (top == NULL)
MCFail++;
return (top);
nospace:
m_freem(top);
MCFail++;
return (NULL);
}
struct mbuf *
m_copym_with_hdrs(struct mbuf *m, int off0, int len0, int wait,
struct mbuf **m_last, int *m_off)
{
struct mbuf *n, **np = NULL;
int off = off0, len = len0;
struct mbuf *top = NULL;
int mcflags = MSLEEPF(wait);
int copyhdr = 0;
int type = 0;
mcache_obj_t *list = NULL;
int needed = 0;
if (off == 0 && (m->m_flags & M_PKTHDR))
copyhdr = 1;
if (*m_last != NULL) {
m = *m_last;
off = *m_off;
} else {
while (off >= m->m_len) {
off -= m->m_len;
m = m->m_next;
}
}
n = m;
while (len > 0) {
needed++;
ASSERT(n != NULL);
len -= MIN(len, (n->m_len - ((needed == 1) ? off : 0)));
n = n->m_next;
}
needed++;
len = len0;
if (mcflags & MCR_NOSLEEP)
mcflags |= MCR_TRYHARD;
if (mcache_alloc_ext(m_cache(MC_MBUF), &list, needed,
mcflags) != needed)
goto nospace;
needed = 0;
while (len > 0) {
n = (struct mbuf *)list;
list = list->obj_next;
ASSERT(n != NULL && m != NULL);
type = (top == NULL) ? MT_HEADER : m->m_type;
MBUF_INIT(n, (top == NULL), type);
#if CONFIG_MACF_NET
if (top == NULL && mac_mbuf_label_init(n, wait) != 0) {
mtype_stat_inc(MT_HEADER);
mtype_stat_dec(MT_FREE);
m_free(n);
goto nospace;
}
#endif
if (top == NULL) {
top = n;
np = &top->m_next;
continue;
} else {
needed++;
*np = n;
}
if (copyhdr) {
M_COPY_PKTHDR(n, m);
n->m_pkthdr.len = len;
copyhdr = 0;
}
n->m_len = MIN(len, (m->m_len - off));
if (m->m_flags & M_EXT) {
n->m_ext = m->m_ext;
m_incref(m);
n->m_data = m->m_data + off;
n->m_flags |= M_EXT;
} else {
bcopy(MTOD(m, caddr_t)+off, MTOD(n, caddr_t),
(unsigned)n->m_len);
}
len -= n->m_len;
if (len == 0) {
if ((off + n->m_len) == m->m_len) {
*m_last = m->m_next;
*m_off = 0;
} else {
*m_last = m;
*m_off = off + n->m_len;
}
break;
}
off = 0;
m = m->m_next;
np = &n->m_next;
}
mtype_stat_inc(MT_HEADER);
mtype_stat_add(type, needed);
mtype_stat_sub(MT_FREE, needed + 1);
ASSERT(list == NULL);
return (top);
nospace:
if (list != NULL)
mcache_free_ext(m_cache(MC_MBUF), list);
if (top != NULL)
m_freem(top);
MCFail++;
return (NULL);
}
void
m_copydata(struct mbuf *m, int off, int len, void *vp)
{
unsigned count;
char *cp = vp;
if (off < 0 || len < 0)
panic("m_copydata: invalid offset %d or len %d", off, len);
while (off > 0) {
if (m == NULL)
panic("m_copydata: invalid mbuf chain");
if (off < m->m_len)
break;
off -= m->m_len;
m = m->m_next;
}
while (len > 0) {
if (m == NULL)
panic("m_copydata: invalid mbuf chain");
count = MIN(m->m_len - off, len);
bcopy(MTOD(m, caddr_t) + off, cp, count);
len -= count;
cp += count;
off = 0;
m = m->m_next;
}
}
void
m_cat(struct mbuf *m, struct mbuf *n)
{
while (m->m_next)
m = m->m_next;
while (n) {
if ((m->m_flags & M_EXT) ||
m->m_data + m->m_len + n->m_len >= &m->m_dat[MLEN]) {
m->m_next = n;
return;
}
bcopy(MTOD(n, caddr_t), MTOD(m, caddr_t) + m->m_len,
(u_int)n->m_len);
m->m_len += n->m_len;
n = m_free(n);
}
}
void
m_adj(struct mbuf *mp, int req_len)
{
int len = req_len;
struct mbuf *m;
int count;
if ((m = mp) == NULL)
return;
if (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;
}
}
m = mp;
if (m->m_flags & M_PKTHDR)
m->m_pkthdr.len -= (req_len - len);
} else {
len = -len;
count = 0;
for (;;) {
count += m->m_len;
if (m->m_next == (struct mbuf *)0)
break;
m = m->m_next;
}
if (m->m_len >= len) {
m->m_len -= len;
m = mp;
if (m->m_flags & M_PKTHDR)
m->m_pkthdr.len -= len;
return;
}
count -= len;
if (count < 0)
count = 0;
m = mp;
if (m->m_flags & M_PKTHDR)
m->m_pkthdr.len = count;
for (; m; m = m->m_next) {
if (m->m_len >= count) {
m->m_len = count;
break;
}
count -= m->m_len;
}
while ((m = m->m_next))
m->m_len = 0;
}
}
int MPFail;
struct mbuf *
m_pullup(struct mbuf *n, int len)
{
struct mbuf *m;
int count;
int space;
if ((n->m_flags & M_EXT) == 0 &&
n->m_data + len < &n->m_dat[MLEN] && n->m_next) {
if (n->m_len >= len)
return (n);
m = n;
n = n->m_next;
len -= m->m_len;
} else {
if (len > MHLEN)
goto bad;
_MGET(m, M_DONTWAIT, n->m_type);
if (m == 0)
goto bad;
m->m_len = 0;
if (n->m_flags & M_PKTHDR) {
M_COPY_PKTHDR(m, n);
n->m_flags &= ~M_PKTHDR;
}
}
space = &m->m_dat[MLEN] - (m->m_data + m->m_len);
do {
count = MIN(MIN(MAX(len, max_protohdr), space), n->m_len);
bcopy(MTOD(n, caddr_t), MTOD(m, caddr_t) + m->m_len,
(unsigned)count);
len -= count;
m->m_len += count;
n->m_len -= count;
space -= count;
if (n->m_len)
n->m_data += count;
else
n = m_free(n);
} while (len > 0 && n);
if (len > 0) {
(void) m_free(m);
goto bad;
}
m->m_next = n;
return (m);
bad:
m_freem(n);
MPFail++;
return (0);
}
struct mbuf *
m_split(struct mbuf *m0, int len0, int wait)
{
return (m_split0(m0, len0, wait, 1));
}
static struct mbuf *
m_split0(struct mbuf *m0, int len0, int wait, int copyhdr)
{
struct mbuf *m, *n;
unsigned len = len0, remain;
for (m = m0; m && len > m->m_len; m = m->m_next)
len -= m->m_len;
if (m == NULL)
return (NULL);
remain = m->m_len - len;
if (copyhdr && (m0->m_flags & M_PKTHDR)) {
_MGETHDR(n, wait, m0->m_type);
if (n == NULL)
return (NULL);
n->m_pkthdr.rcvif = m0->m_pkthdr.rcvif;
n->m_pkthdr.len = m0->m_pkthdr.len - len0;
m0->m_pkthdr.len = len0;
if (m->m_flags & M_EXT)
goto extpacket;
if (remain > MHLEN) {
MH_ALIGN(n, 0);
n->m_next = m_split(m, len, wait);
if (n->m_next == NULL) {
(void) m_free(n);
return (NULL);
} else
return (n);
} else
MH_ALIGN(n, remain);
} else if (remain == 0) {
n = m->m_next;
m->m_next = NULL;
return (n);
} else {
_MGET(n, wait, m->m_type);
if (n == NULL)
return (NULL);
M_ALIGN(n, remain);
}
extpacket:
if (m->m_flags & M_EXT) {
n->m_flags |= M_EXT;
n->m_ext = m->m_ext;
m_incref(m);
n->m_data = m->m_data + len;
} else {
bcopy(MTOD(m, caddr_t) + len, MTOD(n, caddr_t), remain);
}
n->m_len = remain;
m->m_len = len;
n->m_next = m->m_next;
m->m_next = NULL;
return (n);
}
struct mbuf *
m_devget(char *buf, int totlen, int off0, struct ifnet *ifp,
void (*copy)(const void *, void *, size_t))
{
struct mbuf *m;
struct mbuf *top = NULL, **mp = ⊤
int off = off0, len;
char *cp;
char *epkt;
cp = buf;
epkt = cp + totlen;
if (off) {
cp += off + 2 * sizeof (u_int16_t);
totlen -= 2 * sizeof (u_int16_t);
}
_MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL)
return (NULL);
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = totlen;
m->m_len = MHLEN;
while (totlen > 0) {
if (top != NULL) {
_MGET(m, M_DONTWAIT, MT_DATA);
if (m == NULL) {
m_freem(top);
return (NULL);
}
m->m_len = MLEN;
}
len = MIN(totlen, epkt - cp);
if (len >= MINCLSIZE) {
MCLGET(m, M_DONTWAIT);
if (m->m_flags & M_EXT) {
m->m_len = len = MIN(len, m_maxsize(MC_CL));
} else {
if (top != NULL)
m_freem(top);
m_freem(m);
return (NULL);
}
} else {
if (len < m->m_len) {
if (top == NULL &&
len + max_linkhdr <= m->m_len)
m->m_data += max_linkhdr;
m->m_len = len;
} else {
len = m->m_len;
}
}
if (copy)
copy(cp, MTOD(m, caddr_t), (unsigned)len);
else
bcopy(cp, MTOD(m, caddr_t), (unsigned)len);
cp += len;
*mp = m;
mp = &m->m_next;
totlen -= len;
if (cp == epkt)
cp = buf;
}
return (top);
}
void
mbuf_growth_aggressive(void)
{
lck_mtx_lock(mbuf_mlock);
mbuf_gscale = MB_GROWTH_AGGRESSIVE;
lck_mtx_unlock(mbuf_mlock);
}
void
mbuf_growth_normal(void)
{
lck_mtx_lock(mbuf_mlock);
mbuf_gscale = MB_GROWTH_NORMAL;
lck_mtx_unlock(mbuf_mlock);
}
static int
m_howmany(int num, size_t bufsize)
{
int i = 0, j = 0;
u_int32_t m_clusters, m_bigclusters, m_16kclusters;
u_int32_t m_clfree, m_bigclfree, m_16kclfree;
u_int32_t s = mbuf_gscale;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
m_clusters = m_total(MC_CL);
m_bigclusters = m_total(MC_BIGCL);
m_16kclusters = m_total(MC_16KCL);
m_clfree = m_infree(MC_CL);
m_bigclfree = m_infree(MC_BIGCL);
m_16kclfree = m_infree(MC_16KCL);
if ((bufsize != m_maxsize(MC_16KCL) &&
(m_clusters + (m_bigclusters << 1) >= nclusters)) ||
(njcl > 0 && bufsize == m_maxsize(MC_16KCL) &&
(m_16kclusters << 3) >= njcl)) {
#if DEBUG
if (bufsize == MCLBYTES && num > m_clfree) {
printf("m_howmany - out of small clusters, "
"%d short\n", num - mbstat.m_clfree);
}
#endif
return (0);
}
if (bufsize == m_maxsize(MC_CL)) {
if (m_clusters < MINCL)
return (MINCL - m_clusters);
if (m_clusters < m_maxlimit(MC_CL)) {
if (m_clfree >= MCL_LOWAT)
return (0);
if (num >= m_clfree)
i = num - m_clfree;
if (((m_clusters + num) >> s) > m_clfree)
j = ((m_clusters + num) >> s) - m_clfree;
i = MAX(i, j);
if (i + m_clusters >= m_maxlimit(MC_CL))
i = m_maxlimit(MC_CL) - m_clusters;
}
VERIFY((m_total(MC_CL) + i) <= m_maxlimit(MC_CL));
} else if (bufsize == m_maxsize(MC_BIGCL)) {
if (m_bigclusters < MINBIGCL)
return (MINBIGCL - m_bigclusters);
if (m_bigclusters < m_maxlimit(MC_BIGCL)) {
if (m_bigclfree >= MBIGCL_LOWAT)
return (0);
if (num >= m_bigclfree)
i = num - m_bigclfree;
if (((m_bigclusters + num) >> 4) > m_bigclfree)
j = ((m_bigclusters + num) >> 4) - m_bigclfree;
i = MAX(i, j);
if (i + m_bigclusters >= m_maxlimit(MC_BIGCL))
i = m_maxlimit(MC_BIGCL) - m_bigclusters;
}
VERIFY((m_total(MC_BIGCL) + i) <= m_maxlimit(MC_BIGCL));
} else {
VERIFY(njcl > 0);
if (m_16kclusters < MIN16KCL)
return (MIN16KCL - m_16kclusters);
if (m_16kclusters < m_maxlimit(MC_16KCL)) {
if (m_16kclfree >= M16KCL_LOWAT)
return (0);
if (num >= m_16kclfree)
i = num - m_16kclfree;
if (((m_16kclusters + num) >> 4) > m_16kclfree)
j = ((m_16kclusters + num) >> 4) - m_16kclfree;
i = MAX(i, j);
if (i + m_16kclusters >= m_maxlimit(MC_16KCL))
i = m_maxlimit(MC_16KCL) - m_16kclusters;
}
VERIFY((m_total(MC_16KCL) + i) <= m_maxlimit(MC_16KCL));
}
return (i);
}
static unsigned int
m_length(struct mbuf *m)
{
struct mbuf *m0;
unsigned int pktlen;
if (m->m_flags & M_PKTHDR)
return (m->m_pkthdr.len);
pktlen = 0;
for (m0 = m; m0 != NULL; m0 = m0->m_next)
pktlen += m0->m_len;
return (pktlen);
}
void
m_copyback(struct mbuf *m0, int off, int len, const void *cp)
{
#if DEBUG
struct mbuf *origm = m0;
int error;
#endif
if (m0 == NULL)
return;
#if DEBUG
error =
#endif
m_copyback0(&m0, off, len, cp,
M_COPYBACK0_COPYBACK | M_COPYBACK0_EXTEND, M_DONTWAIT);
#if DEBUG
if (error != 0 || (m0 != NULL && origm != m0))
panic("m_copyback");
#endif
}
struct mbuf *
m_copyback_cow(struct mbuf *m0, int off, int len, const void *cp, int how)
{
int error;
VERIFY(off + len <= m_length(m0));
error = m_copyback0(&m0, off, len, cp,
M_COPYBACK0_COPYBACK | M_COPYBACK0_COW, how);
if (error) {
m_freem(m0);
return (NULL);
}
return (m0);
}
int
m_makewritable(struct mbuf **mp, int off, int len, int how)
{
int error;
#if DEBUG
struct mbuf *n;
int origlen, reslen;
origlen = m_length(*mp);
#endif
#if 0
if (len == M_COPYALL)
len = m_length(*mp) - off;
#endif
error = m_copyback0(mp, off, len, NULL,
M_COPYBACK0_PRESERVE | M_COPYBACK0_COW, how);
#if DEBUG
reslen = 0;
for (n = *mp; n; n = n->m_next)
reslen += n->m_len;
if (origlen != reslen)
panic("m_makewritable: length changed");
if (((*mp)->m_flags & M_PKTHDR) && reslen != (*mp)->m_pkthdr.len)
panic("m_makewritable: inconsist");
#endif
return (error);
}
static int
m_copyback0(struct mbuf **mp0, int off, int len, const void *vp, int flags,
int how)
{
int mlen;
struct mbuf *m, *n;
struct mbuf **mp;
int totlen = 0;
const char *cp = vp;
VERIFY(mp0 != NULL);
VERIFY(*mp0 != NULL);
VERIFY((flags & M_COPYBACK0_PRESERVE) == 0 || cp == NULL);
VERIFY((flags & M_COPYBACK0_COPYBACK) == 0 || cp != NULL);
VERIFY((~flags & (M_COPYBACK0_EXTEND|M_COPYBACK0_COW)) != 0);
mp = mp0;
m = *mp;
while (off > (mlen = m->m_len)) {
off -= mlen;
totlen += mlen;
if (m->m_next == NULL) {
int tspace;
extend:
if (!(flags & M_COPYBACK0_EXTEND))
goto out;
mlen = m->m_len;
if (off + len >= MINCLSIZE &&
!(m->m_flags & M_EXT) && m->m_len == 0) {
MCLGET(m, how);
}
tspace = M_TRAILINGSPACE(m);
if (tspace > 0) {
tspace = MIN(tspace, off + len);
VERIFY(tspace > 0);
bzero(mtod(m, char *) + m->m_len,
MIN(off, tspace));
m->m_len += tspace;
off += mlen;
totlen -= mlen;
continue;
}
if (off + len >= MINCLSIZE) {
n = m_getcl(how, m->m_type, 0);
} else {
n = _M_GET(how, m->m_type);
}
if (n == NULL) {
goto out;
}
n->m_len = 0;
n->m_len = MIN(M_TRAILINGSPACE(n), off + len);
bzero(mtod(n, char *), MIN(n->m_len, off));
m->m_next = n;
}
mp = &m->m_next;
m = m->m_next;
}
while (len > 0) {
mlen = m->m_len - off;
if (mlen != 0 && m_mclhasreference(m)) {
char *datap;
int eatlen;
#if defined(DIAGNOSTIC)
if (!(flags & M_COPYBACK0_COW))
panic("m_copyback0: read-only");
#endif
if (off > 0 && len < mlen) {
n = m_split0(m, off, how, 0);
if (n == NULL)
goto enobufs;
m->m_next = n;
mp = &m->m_next;
m = n;
off = 0;
continue;
}
n = _M_GET(how, m->m_type);
if (n == NULL)
goto enobufs;
if (off == 0 && (m->m_flags & M_PKTHDR)) {
M_COPY_PKTHDR(n, m);
n->m_len = MHLEN;
} else {
if (len >= MINCLSIZE)
MCLGET(n, M_DONTWAIT);
n->m_len =
(n->m_flags & M_EXT) ? MCLBYTES : MLEN;
}
if (n->m_len > len)
n->m_len = len;
if (flags & M_COPYBACK0_PRESERVE)
datap = mtod(n, char *);
else
datap = NULL;
eatlen = n->m_len;
VERIFY(off == 0 || eatlen >= mlen);
if (off > 0) {
VERIFY(len >= mlen);
m->m_len = off;
m->m_next = n;
if (datap) {
m_copydata(m, off, mlen, datap);
datap += mlen;
}
eatlen -= mlen;
mp = &m->m_next;
m = m->m_next;
}
while (m != NULL && m_mclhasreference(m) &&
n->m_type == m->m_type && eatlen > 0) {
mlen = MIN(eatlen, m->m_len);
if (datap) {
m_copydata(m, 0, mlen, datap);
datap += mlen;
}
m->m_data += mlen;
m->m_len -= mlen;
eatlen -= mlen;
if (m->m_len == 0)
*mp = m = m_free(m);
}
if (eatlen > 0)
n->m_len -= eatlen;
n->m_next = m;
*mp = m = n;
continue;
}
mlen = MIN(mlen, len);
if (flags & M_COPYBACK0_COPYBACK) {
bcopy(cp, mtod(m, caddr_t) + off, (unsigned)mlen);
cp += mlen;
}
len -= mlen;
mlen += off;
off = 0;
totlen += mlen;
if (len == 0)
break;
if (m->m_next == NULL) {
goto extend;
}
mp = &m->m_next;
m = m->m_next;
}
out:
if (((m = *mp0)->m_flags & M_PKTHDR) && (m->m_pkthdr.len < totlen)) {
VERIFY(flags & M_COPYBACK0_EXTEND);
m->m_pkthdr.len = totlen;
}
return (0);
enobufs:
return (ENOBUFS);
}
char *
mcl_to_paddr(char *addr)
{
vm_offset_t base_phys;
if (!MBUF_IN_MAP(addr))
return (NULL);
base_phys = mcl_paddr[(addr - (char *)mbutl) >> PGSHIFT];
if (base_phys == 0)
return (NULL);
return ((char *)((uintptr_t)base_phys | ((uintptr_t)addr & PGOFSET)));
}
int MDFail;
struct mbuf *
m_dup(struct mbuf *m, int how)
{
struct mbuf *n, **np;
struct mbuf *top;
int copyhdr = 0;
np = ⊤
top = NULL;
if (m->m_flags & M_PKTHDR)
copyhdr = 1;
if (m->m_next == NULL) {
if (copyhdr) {
if (m->m_pkthdr.len <= MHLEN && m->m_len <= MHLEN) {
if ((n = _M_GETHDR(how, m->m_type)) == NULL)
return (NULL);
n->m_len = m->m_len;
m_dup_pkthdr(n, m, how);
bcopy(m->m_data, n->m_data, m->m_len);
return (n);
}
} else if (m->m_len <= MLEN) {
if ((n = _M_GET(how, m->m_type)) == NULL)
return (NULL);
bcopy(m->m_data, n->m_data, m->m_len);
n->m_len = m->m_len;
return (n);
}
}
while (m != NULL) {
#if BLUE_DEBUG
kprintf("<%x: %x, %x, %x\n", m, m->m_flags, m->m_len,
m->m_data);
#endif
if (copyhdr)
n = _M_GETHDR(how, m->m_type);
else
n = _M_GET(how, m->m_type);
if (n == NULL)
goto nospace;
if (m->m_flags & M_EXT) {
if (m->m_len <= m_maxsize(MC_CL))
MCLGET(n, how);
else if (m->m_len <= m_maxsize(MC_BIGCL))
n = m_mbigget(n, how);
else if (m->m_len <= m_maxsize(MC_16KCL) && njcl > 0)
n = m_m16kget(n, how);
if (!(n->m_flags & M_EXT)) {
(void) m_free(n);
goto nospace;
}
}
*np = n;
if (copyhdr) {
m_dup_pkthdr(n, m, how);
copyhdr = 0;
if (!(n->m_flags & M_EXT))
n->m_data = n->m_pktdat;
}
n->m_len = m->m_len;
bcopy(MTOD(m, caddr_t), MTOD(n, caddr_t), (unsigned)n->m_len);
m = m->m_next;
np = &n->m_next;
#if BLUE_DEBUG
kprintf(">%x: %x, %x, %x\n", n, n->m_flags, n->m_len,
n->m_data);
#endif
}
if (top == NULL)
MDFail++;
return (top);
nospace:
m_freem(top);
MDFail++;
return (NULL);
}
#define MBUF_MULTIPAGES(m) \
(((m)->m_flags & M_EXT) && \
((IS_P2ALIGNED((m)->m_data, NBPG) && (m)->m_len > NBPG) || \
(!IS_P2ALIGNED((m)->m_data, NBPG) && \
P2ROUNDUP((m)->m_data, NBPG) < ((uintptr_t)(m)->m_data + (m)->m_len))))
static struct mbuf *
m_expand(struct mbuf *m, struct mbuf **last)
{
struct mbuf *top = NULL;
struct mbuf **nm = ⊤
uintptr_t data0, data;
unsigned int len0, len;
VERIFY(MBUF_MULTIPAGES(m));
VERIFY(m->m_next == NULL);
data0 = (uintptr_t)m->m_data;
len0 = m->m_len;
*last = top;
for (;;) {
struct mbuf *n;
data = data0;
if (IS_P2ALIGNED(data, NBPG) && len0 > NBPG)
len = NBPG;
else if (!IS_P2ALIGNED(data, NBPG) &&
P2ROUNDUP(data, NBPG) < (data + len0))
len = P2ROUNDUP(data, NBPG) - data;
else
len = len0;
VERIFY(len > 0);
VERIFY(m->m_flags & M_EXT);
m->m_data = (void *)data;
m->m_len = len;
*nm = *last = m;
nm = &m->m_next;
m->m_next = NULL;
data0 += len;
len0 -= len;
if (len0 == 0)
break;
n = _M_RETRY(M_DONTWAIT, MT_DATA);
if (n == NULL) {
m_freem(top);
top = *last = NULL;
break;
}
n->m_ext = m->m_ext;
m_incref(m);
n->m_flags |= M_EXT;
m = n;
}
return (top);
}
struct mbuf *
m_normalize(struct mbuf *m)
{
struct mbuf *top = NULL;
struct mbuf **nm = ⊤
boolean_t expanded = FALSE;
while (m != NULL) {
struct mbuf *n;
n = m->m_next;
m->m_next = NULL;
if (MBUF_MULTIPAGES(m)) {
struct mbuf *last;
if ((m = m_expand(m, &last)) == NULL) {
m_freem(n);
m_freem(top);
top = NULL;
break;
}
*nm = m;
nm = &last->m_next;
expanded = TRUE;
} else {
*nm = m;
nm = &m->m_next;
}
m = n;
}
if (expanded)
atomic_add_32(&mb_normalized, 1);
return (top);
}
void
m_mchtype(struct mbuf *m, int t)
{
mtype_stat_inc(t);
mtype_stat_dec(m->m_type);
(m)->m_type = t;
}
void *
m_mtod(struct mbuf *m)
{
return (MTOD(m, void *));
}
struct mbuf *
m_dtom(void *x)
{
return ((struct mbuf *)((uintptr_t)(x) & ~(MSIZE-1)));
}
void
m_mcheck(struct mbuf *m)
{
_MCHECK(m);
}
static void
mbuf_waiter_inc(mbuf_class_t class, boolean_t comp)
{
mcache_waiter_inc(m_cache(class));
if (comp) {
if (class == MC_CL) {
mcache_waiter_inc(m_cache(MC_MBUF_CL));
} else if (class == MC_BIGCL) {
mcache_waiter_inc(m_cache(MC_MBUF_BIGCL));
} else if (class == MC_16KCL) {
mcache_waiter_inc(m_cache(MC_MBUF_16KCL));
} else {
mcache_waiter_inc(m_cache(MC_MBUF_CL));
mcache_waiter_inc(m_cache(MC_MBUF_BIGCL));
}
}
}
static void
mbuf_waiter_dec(mbuf_class_t class, boolean_t comp)
{
mcache_waiter_dec(m_cache(class));
if (comp) {
if (class == MC_CL) {
mcache_waiter_dec(m_cache(MC_MBUF_CL));
} else if (class == MC_BIGCL) {
mcache_waiter_dec(m_cache(MC_MBUF_BIGCL));
} else if (class == MC_16KCL) {
mcache_waiter_dec(m_cache(MC_MBUF_16KCL));
} else {
mcache_waiter_dec(m_cache(MC_MBUF_CL));
mcache_waiter_dec(m_cache(MC_MBUF_BIGCL));
}
}
}
static boolean_t
mbuf_sleep(mbuf_class_t class, unsigned int num, int wait)
{
boolean_t mcache_retry = FALSE;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
if (mbuf_cached_above(class, wait)) {
mcache_retry = TRUE;
goto done;
}
m_reclaim(class, num, (wait & MCR_COMP));
if (m_infree(class) > 0) {
mbstat.m_wait++;
goto done;
} else if (mbuf_cached_above(class, wait)) {
mbstat.m_wait++;
mcache_retry = TRUE;
goto done;
} else if (wait & MCR_TRYHARD) {
mcache_retry = TRUE;
goto done;
}
mbuf_waiter_inc(class, (wait & MCR_COMP));
VERIFY(!(wait & MCR_NOSLEEP));
mb_waiters++;
(void) msleep(mb_waitchan, mbuf_mlock, (PZERO-1), m_cname(class), NULL);
mbuf_waiter_dec(class, (wait & MCR_COMP));
if (m_infree(class) > 0) {
mbstat.m_wait++;
goto done;
} else if (mbuf_cached_above(class, wait)) {
mbstat.m_wait++;
mcache_retry = TRUE;
}
done:
return (mcache_retry);
}
static void
mbuf_worker_thread(void)
{
int mbuf_expand;
while (1) {
lck_mtx_lock(mbuf_mlock);
mbuf_expand = 0;
if (mbuf_expand_mcl) {
int n;
n = mbuf_expand_mcl -
(m_total(MC_CL) - m_infree(MC_CL));
if ((n + m_total(MC_CL)) > m_maxlimit(MC_CL))
n = m_maxlimit(MC_CL) - m_total(MC_CL);
mbuf_expand_mcl = 0;
if (n > 0 && freelist_populate(MC_CL, n, M_WAIT) > 0)
mbuf_expand++;
}
if (mbuf_expand_big) {
int n;
n = mbuf_expand_big -
(m_total(MC_BIGCL) - m_infree(MC_BIGCL));
if ((n + m_total(MC_BIGCL)) > m_maxlimit(MC_BIGCL))
n = m_maxlimit(MC_BIGCL) - m_total(MC_BIGCL);
mbuf_expand_big = 0;
if (n > 0 && freelist_populate(MC_BIGCL, n, M_WAIT) > 0)
mbuf_expand++;
}
if (mbuf_expand_16k) {
int n;
n = mbuf_expand_16k -
(m_total(MC_16KCL) - m_infree(MC_16KCL));
if ((n + m_total(MC_16KCL)) > m_maxlimit(MC_16KCL))
n = m_maxlimit(MC_16KCL) - m_total(MC_16KCL);
mbuf_expand_16k = 0;
if (n > 0)
(void) freelist_populate(MC_16KCL, n, M_WAIT);
}
if (mbuf_expand) {
while (m_total(MC_MBUF) <
(m_total(MC_BIGCL) + m_total(MC_CL))) {
if (freelist_populate(MC_MBUF, 1, M_WAIT) == 0)
break;
}
}
lck_mtx_unlock(mbuf_mlock);
assert_wait(&mbuf_worker_run, THREAD_UNINT);
(void) thread_block((thread_continue_t)mbuf_worker_thread);
}
}
static void
mbuf_worker_thread_init(void)
{
mbuf_worker_ready++;
mbuf_worker_thread();
}
static mcl_slab_t *
slab_get(void *buf)
{
mcl_slabg_t *slg;
unsigned int ix, k;
lck_mtx_assert(mbuf_mlock, LCK_MTX_ASSERT_OWNED);
VERIFY(MBUF_IN_MAP(buf));
ix = ((char *)buf - (char *)mbutl) >> MBSHIFT;
VERIFY(ix < maxslabgrp);
if ((slg = slabstbl[ix]) == NULL) {
++slabgrp;
VERIFY(ix < slabgrp);
VERIFY(mb_clalloc_busy);
lck_mtx_unlock(mbuf_mlock);
MALLOC(slg, mcl_slabg_t *, sizeof (*slg), M_TEMP,
M_WAITOK | M_ZERO);
VERIFY(slg != NULL);
lck_mtx_lock(mbuf_mlock);
VERIFY(mb_clalloc_busy);
slabstbl[ix] = slg;
for (k = 1; k < NSLABSPMB; k++)
slg->slg_slab[k - 1].sl_next = &slg->slg_slab[k];
VERIFY(slg->slg_slab[NSLABSPMB - 1].sl_next == NULL);
if (ix > 0) {
VERIFY(slabstbl[ix - 1]->
slg_slab[NSLABSPMB - 1].sl_next == NULL);
slabstbl[ix - 1]->slg_slab[NSLABSPMB - 1].sl_next =
&slg->slg_slab[0];
}
}
ix = MTOCL(buf) % NSLABSPMB;
VERIFY(ix < NSLABSPMB);
return (&slg->slg_slab[ix]);
}
static void
slab_init(mcl_slab_t *sp, mbuf_class_t class, u_int32_t flags,
void *base, void *head, unsigned int len, int refcnt, int chunks)
{
sp->sl_class = class;
sp->sl_flags = flags;
sp->sl_base = base;
sp->sl_head = head;
sp->sl_len = len;
sp->sl_refcnt = refcnt;
sp->sl_chunks = chunks;
slab_detach(sp);
}
static void
slab_insert(mcl_slab_t *sp, mbuf_class_t class)
{
VERIFY(slab_is_detached(sp));
m_slab_cnt(class)++;
TAILQ_INSERT_TAIL(&m_slablist(class), sp, sl_link);
sp->sl_flags &= ~SLF_DETACHED;
if (class == MC_BIGCL) {
sp = sp->sl_next;
VERIFY(sp != NULL);
VERIFY(slab_is_detached(sp));
sp->sl_flags &= ~SLF_DETACHED;
} else if (class == MC_16KCL) {
int k;
for (k = 1; k < (M16KCLBYTES / MCLBYTES); k++) {
sp = sp->sl_next;
VERIFY(sp != NULL);
VERIFY(slab_is_detached(sp));
sp->sl_flags &= ~SLF_DETACHED;
}
}
}
static void
slab_remove(mcl_slab_t *sp, mbuf_class_t class)
{
VERIFY(!slab_is_detached(sp));
VERIFY(m_slab_cnt(class) > 0);
m_slab_cnt(class)--;
TAILQ_REMOVE(&m_slablist(class), sp, sl_link);
slab_detach(sp);
if (class == MC_BIGCL) {
sp = sp->sl_next;
VERIFY(sp != NULL);
VERIFY(!slab_is_detached(sp));
slab_detach(sp);
} else if (class == MC_16KCL) {
int k;
for (k = 1; k < (M16KCLBYTES / MCLBYTES); k++) {
sp = sp->sl_next;
VERIFY(sp != NULL);
VERIFY(!slab_is_detached(sp));
slab_detach(sp);
}
}
}
static boolean_t
slab_inrange(mcl_slab_t *sp, void *buf)
{
return ((uintptr_t)buf >= (uintptr_t)sp->sl_base &&
(uintptr_t)buf < ((uintptr_t)sp->sl_base + sp->sl_len));
}
#undef panic
static void
slab_nextptr_panic(mcl_slab_t *sp, void *addr)
{
int i;
unsigned int chunk_len = sp->sl_len / sp->sl_chunks;
uintptr_t buf = (uintptr_t)sp->sl_base;
for (i = 0; i < sp->sl_chunks; i++, buf += chunk_len) {
void *next = ((mcache_obj_t *)buf)->obj_next;
if (next != addr)
continue;
if (mclaudit == NULL) {
if (next != NULL && !MBUF_IN_MAP(next)) {
mcache_t *cp = m_cache(sp->sl_class);
panic("%s: %s buffer %p in slab %p modified "
"after free at offset 0: %p out of range "
"[%p-%p)\n", __func__, cp->mc_name,
(void *)buf, sp, next, mbutl, embutl);
}
} else {
mcache_audit_t *mca = mcl_audit_buf2mca(sp->sl_class,
(mcache_obj_t *)buf);
mcl_audit_verify_nextptr(next, mca);
}
}
}
static void
slab_detach(mcl_slab_t *sp)
{
sp->sl_link.tqe_next = (mcl_slab_t *)-1;
sp->sl_link.tqe_prev = (mcl_slab_t **)-1;
sp->sl_flags |= SLF_DETACHED;
}
static boolean_t
slab_is_detached(mcl_slab_t *sp)
{
return ((intptr_t)sp->sl_link.tqe_next == -1 &&
(intptr_t)sp->sl_link.tqe_prev == -1 &&
(sp->sl_flags & SLF_DETACHED));
}
static void
mcl_audit_init(void *buf, mcache_audit_t **mca_list,
mcache_obj_t **con_list, size_t con_size, unsigned int num)
{
mcache_audit_t *mca, *mca_tail;
mcache_obj_t *con = NULL;
boolean_t save_contents = (con_list != NULL);
unsigned int i, ix;
ASSERT(num <= NMBPCL);
ASSERT(con_list == NULL || con_size != 0);
ix = MTOCL(buf);
for (i = 0; i < NMBPCL; i++)
VERIFY(mclaudit[ix].cl_audit[i] == NULL);
mca = mca_tail = *mca_list;
if (save_contents)
con = *con_list;
for (i = 0; i < num; i++) {
mcache_audit_t *next;
next = mca->mca_next;
bzero(mca, sizeof (*mca));
mca->mca_next = next;
mclaudit[ix].cl_audit[i] = mca;
if (save_contents) {
VERIFY(con != NULL);
mca->mca_contents_size = con_size;
mca->mca_contents = con;
con = con->obj_next;
bzero(mca->mca_contents, mca->mca_contents_size);
}
mca_tail = mca;
mca = mca->mca_next;
}
if (save_contents)
*con_list = con;
*mca_list = mca_tail->mca_next;
mca_tail->mca_next = NULL;
}
static mcache_audit_t *
mcl_audit_buf2mca(mbuf_class_t class, mcache_obj_t *o)
{
mcache_audit_t *mca = NULL;
int ix = MTOCL(o);
VERIFY(IS_P2ALIGNED(o, MIN(m_maxsize(class), NBPG)));
switch (class) {
case MC_MBUF:
VERIFY(MCLIDX(CLTOM(ix), o) < (int)NMBPCL);
mca = mclaudit[ix].cl_audit[MCLIDX(CLTOM(ix), o)];
break;
case MC_CL:
case MC_BIGCL:
case MC_16KCL:
mca = mclaudit[ix].cl_audit[0];
break;
default:
VERIFY(0);
}
return (mca);
}
static void
mcl_audit_mbuf(mcache_audit_t *mca, void *addr, boolean_t composite,
boolean_t alloc)
{
struct mbuf *m = addr;
mcache_obj_t *next = ((mcache_obj_t *)m)->obj_next;
VERIFY(mca->mca_contents != NULL &&
mca->mca_contents_size == AUDIT_CONTENTS_SIZE);
mcl_audit_verify_nextptr(next, mca);
if (!alloc) {
mcl_audit_save_mbuf(m, mca);
mcache_set_pattern(MCACHE_FREE_PATTERN, m, m_maxsize(MC_MBUF));
((mcache_obj_t *)m)->obj_next = next;
return;
}
mcache_audit_free_verify_set(mca, addr, 0, m_maxsize(MC_MBUF));
mcl_audit_restore_mbuf(m, mca, composite);
}
static void
mcl_audit_restore_mbuf(struct mbuf *m, mcache_audit_t *mca, boolean_t composite)
{
struct mbuf *ms = (struct mbuf *)mca->mca_contents;
if (composite) {
struct mbuf *next = m->m_next;
VERIFY(ms->m_flags == M_EXT && MEXT_RFA(ms) != NULL &&
MBUF_IS_COMPOSITE(ms));
bcopy(ms, m, mca->mca_contents_size);
m->m_next = next;
} else {
m->m_type = ms->m_type;
}
_MCHECK(m);
}
static void
mcl_audit_save_mbuf(struct mbuf *m, mcache_audit_t *mca)
{
_MCHECK(m);
bcopy(m, mca->mca_contents, mca->mca_contents_size);
}
static void
mcl_audit_cluster(mcache_audit_t *mca, void *addr, size_t size, boolean_t alloc,
boolean_t save_next)
{
mcache_obj_t *next = ((mcache_obj_t *)addr)->obj_next;
if (!alloc) {
mcache_set_pattern(MCACHE_FREE_PATTERN, addr, size);
if (save_next) {
mcl_audit_verify_nextptr(next, mca);
((mcache_obj_t *)addr)->obj_next = next;
}
} else {
mcl_audit_verify_nextptr(next, mca);
mcache_audit_free_verify_set(mca, addr, 0, size);
}
}
static void
mcl_audit_mcheck_panic(struct mbuf *m)
{
mcache_audit_t *mca;
MRANGE(m);
mca = mcl_audit_buf2mca(MC_MBUF, (mcache_obj_t *)m);
panic("mcl_audit: freed mbuf %p with type 0x%x (instead of 0x%x)\n%s\n",
m, (u_int16_t)m->m_type, MT_FREE, mcache_dump_mca(mca));
}
static void
mcl_audit_verify_nextptr(void *next, mcache_audit_t *mca)
{
if (next != NULL && next != (void *)MCACHE_FREE_PATTERN &&
!MBUF_IN_MAP(next)) {
panic("mcl_audit: buffer %p modified after free at offset 0: "
"%p out of range [%p-%p)\n%s\n",
mca->mca_addr, next, mbutl, embutl, mcache_dump_mca(mca));
}
}
SYSCTL_DECL(_kern_ipc);
SYSCTL_PROC(_kern_ipc, KIPC_MBSTAT, mbstat, CTLFLAG_RD | CTLFLAG_LOCKED,
0, 0, mbstat_sysctl, "S,mbstat", "");
SYSCTL_PROC(_kern_ipc, OID_AUTO, mb_stat, CTLFLAG_RD | CTLFLAG_LOCKED,
0, 0, mb_stat_sysctl, "S,mb_stat", "");
SYSCTL_INT(_kern_ipc, OID_AUTO, mb_normalized, CTLFLAG_RD | CTLFLAG_LOCKED,
&mb_normalized, 0, "");