gems-kernel/source/THIRDPARTY/xnu/bsd/net/pktsched/pktsched_netem.c
2024-06-03 11:29:39 -05:00

1673 lines
57 KiB
C

/*
* Copyright (c) 2018 Apple Inc. All rights reserved.
*
* @APPLE_OSREFERENCE_LICENSE_HEADER_START@
*
* This file contains Original Code and/or Modifications of Original Code
* as defined in and that are subject to the Apple Public Source License
* Version 2.0 (the 'License'). You may not use this file except in
* compliance with the License. The rights granted to you under the License
* may not be used to create, or enable the creation or redistribution of,
* unlawful or unlicensed copies of an Apple operating system, or to
* circumvent, violate, or enable the circumvention or violation of, any
* terms of an Apple operating system software license agreement.
*
* Please obtain a copy of the License at
* http://www.opensource.apple.com/apsl/ and read it before using this file.
*
* The Original Code and all software distributed under the License are
* distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
* EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
* INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
* Please see the License for the specific language governing rights and
* limitations under the License.
*
* @APPLE_OSREFERENCE_LICENSE_HEADER_END@
*/
#include <kern/thread.h>
#include <kern/sched_prim.h>
#include <dev/random/randomdev.h>
#include <net/if.h>
#include <net/classq/classq.h>
#include <net/pktsched/pktsched.h>
#include <net/pktsched/pktsched_netem.h>
#define NETEM_STUB \
int \
netem_config(__unused struct netem **ne, __unused const char *name, \
__unused struct ifnet *ifp, __unused const struct if_netem_params *p,\
__unused void *output_handle, __unused netem_output_func_t *output_func, \
__unused uint32_t output_max_batch_size) \
{ \
printf("%s error: unavailable on this platform\n", __func__); \
return ENOTSUP; \
} \
\
void \
__attribute__((noreturn)) \
netem_get_params(__unused struct netem *ne, \
__unused struct if_netem_params *p) \
{ \
panic("unexpected netem call"); \
} \
\
void \
__attribute__((noreturn)) \
netem_destroy(__unused struct netem *ne) \
{ \
panic("unexpected netem call"); \
} \
\
int \
netem_enqueue(__unused struct netem *ne, __unused classq_pkt_t *p, \
__unused bool *pdrop) \
{ \
panic("unexpected netem call"); \
return 0; \
}
#if SKYWALK
#include <skywalk/os_skywalk_private.h>
/*
* The NetEm pktsched is designed with time-to-send scheduler model, scheduling
* decision are made at enqueue time only and the dequeue happens in a fixed
* routine, which determines wheter to send the next packet based on it's
* Time-To-Send (TTS) property.
*
* ##Enqueue##
* The enqueue model looks at various parameters of the
* current NetEm settings and calculates the packet's TTS:
* 1. Bandwidth regulator
* TTS is spaced out into future time based on the (pkt_len/rate).
* 2. Latency
* which is linearly added on top of TTS.
* 3. Reorder
* is done by making non-monotonic TTS.
* 4. Loss recovery (applies to IOD and FPD only)
* by adding recovery interval on top of TTS.
*
* ##Dequeue##
* The dequeue model has only one parameter, the output thread wakeup interval,
* which controls the granularity of packet scheduling. The output thread is
* created if the NetEm is created with a output handler and function (thus
* NetEm managed dequeue model). The thread wakes up periodically based on the
* interval. Upon wakeup, it dequeues all packets whose TTS is older than now
* and sends them to output handler.
*
*/
#if __LP64__
#define CONFIG_NETEM 1
#else
#define CONFIG_NETEM 0
#endif
#if CONFIG_NETEM
#define NETEM_PSCALE IF_NETEM_PARAMS_PSCALE
#define NETEM_LOG(_level, _fmt, ...) \
do { \
if (pktsched_verbose >= _level) { \
log(_level, "NETEM: %-30s "_fmt "\n", \
__FUNCTION__, ##__VA_ARGS__); \
} \
} while (0);
SYSCTL_NODE(_net_pktsched, OID_AUTO, netem, CTLFLAG_RW | CTLFLAG_LOCKED, 0,
"netem");
static unsigned int netem_output_ival_ms = 1;
SYSCTL_UINT(_net_pktsched_netem, OID_AUTO, sched_output_ival_ms,
CTLFLAG_RW | CTLFLAG_LOCKED, &netem_output_ival_ms, 0,
"Netem packet output interval");
#define NETEM_HEAP_SIZE_DEFAULT 2048
static unsigned int netem_heap_size = NETEM_HEAP_SIZE_DEFAULT;
SYSCTL_UINT(_net_pktsched_netem, OID_AUTO, heap_size,
CTLFLAG_RW | CTLFLAG_LOCKED, &netem_heap_size, 0,
"Netem heap size");
extern kern_return_t thread_terminate(thread_t);
static LCK_GRP_DECLARE(netem_lock_group, "pktsched_netem_lock");
static const int32_t NORM_DIST_SCALE = 8192;
/* normal distribution lookup table */
static int32_t norm_dist_table[] =
{
-32768, -28307, -26871, -25967, -25298, -24765, -24320, -23937,
-23600, -23298, -23025, -22776, -22546, -22333, -22133, -21946,
-21770, -21604, -21445, -21295, -21151, -21013, -20882, -20755,
-20633, -20516, -20403, -20293, -20187, -20084, -19984, -19887,
-19793, -19702, -19612, -19526, -19441, -19358, -19277, -19198,
-19121, -19045, -18971, -18899, -18828, -18758, -18690, -18623,
-18557, -18492, -18429, -18366, -18305, -18245, -18185, -18127,
-18070, -18013, -17957, -17902, -17848, -17794, -17741, -17690,
-17638, -17588, -17538, -17489, -17440, -17392, -17345, -17298,
-17252, -17206, -17160, -17116, -17071, -17028, -16984, -16942,
-16899, -16857, -16816, -16775, -16735, -16694, -16654, -16615,
-16576, -16538, -16499, -16461, -16424, -16386, -16350, -16313,
-16277, -16241, -16205, -16170, -16135, -16100, -16066, -16031,
-15998, -15964, -15931, -15897, -15865, -15832, -15800, -15768,
-15736, -15704, -15673, -15642, -15611, -15580, -15550, -15519,
-15489, -15460, -15430, -15401, -15371, -15342, -15313, -15285,
-15256, -15228, -15200, -15172, -15144, -15116, -15089, -15062,
-15035, -15008, -14981, -14954, -14928, -14902, -14875, -14850,
-14823, -14798, -14772, -14747, -14722, -14696, -14671, -14647,
-14622, -14597, -14573, -14549, -14524, -14500, -14476, -14453,
-14429, -14405, -14382, -14359, -14335, -14312, -14289, -14266,
-14243, -14221, -14198, -14176, -14153, -14131, -14109, -14087,
-14065, -14043, -14021, -14000, -13978, -13957, -13935, -13914,
-13893, -13872, -13851, -13830, -13809, -13788, -13768, -13747,
-13727, -13706, -13686, -13666, -13646, -13626, -13606, -13586,
-13566, -13547, -13527, -13507, -13488, -13468, -13449, -13430,
-13411, -13392, -13373, -13354, -13335, -13316, -13297, -13278,
-13260, -13242, -13223, -13204, -13186, -13168, -13150, -13131,
-13113, -13095, -13077, -13060, -13042, -13024, -13006, -12988,
-12971, -12954, -12936, -12918, -12901, -12884, -12867, -12850,
-12832, -12815, -12798, -12781, -12764, -12748, -12731, -12714,
-12697, -12681, -12664, -12648, -12631, -12615, -12598, -12582,
-12566, -12549, -12533, -12517, -12501, -12485, -12469, -12453,
-12437, -12422, -12406, -12390, -12374, -12358, -12343, -12327,
-12312, -12296, -12281, -12265, -12250, -12235, -12220, -12204,
-12189, -12174, -12159, -12144, -12129, -12114, -12099, -12084,
-12069, -12054, -12039, -12025, -12010, -11995, -11981, -11966,
-11952, -11937, -11923, -11908, -11894, -11879, -11865, -11851,
-11837, -11822, -11808, -11794, -11780, -11766, -11752, -11737,
-11724, -11710, -11696, -11682, -11668, -11654, -11640, -11627,
-11613, -11599, -11586, -11572, -11559, -11545, -11531, -11518,
-11504, -11491, -11478, -11464, -11451, -11438, -11425, -11411,
-11398, -11385, -11372, -11359, -11346, -11332, -11319, -11306,
-11293, -11280, -11268, -11255, -11242, -11229, -11216, -11203,
-11191, -11178, -11165, -11153, -11140, -11127, -11114, -11102,
-11090, -11077, -11065, -11052, -11040, -11027, -11015, -11002,
-10990, -10978, -10965, -10953, -10941, -10929, -10917, -10904,
-10892, -10880, -10868, -10856, -10844, -10832, -10820, -10808,
-10796, -10784, -10772, -10760, -10748, -10736, -10725, -10713,
-10701, -10689, -10677, -10666, -10654, -10643, -10631, -10619,
-10607, -10596, -10584, -10573, -10562, -10550, -10539, -10527,
-10516, -10504, -10493, -10481, -10470, -10459, -10447, -10436,
-10425, -10414, -10402, -10391, -10380, -10369, -10358, -10346,
-10335, -10324, -10313, -10302, -10291, -10280, -10269, -10258,
-10247, -10236, -10225, -10214, -10203, -10192, -10181, -10171,
-10160, -10149, -10138, -10127, -10117, -10106, -10095, -10085,
-10074, -10063, -10052, -10042, -10031, -10021, -10010, -10000,
-9989, -9978, -9968, -9957, -9947, -9936, -9926, -9916,
-9905, -9895, -9884, -9874, -9864, -9853, -9843, -9833,
-9822, -9812, -9802, -9791, -9781, -9771, -9761, -9751,
-9741, -9730, -9720, -9710, -9700, -9690, -9680, -9670,
-9660, -9650, -9640, -9630, -9619, -9610, -9600, -9590,
-9580, -9570, -9560, -9550, -9540, -9530, -9520, -9511,
-9501, -9491, -9481, -9472, -9462, -9452, -9442, -9432,
-9423, -9413, -9403, -9394, -9384, -9374, -9365, -9355,
-9345, -9336, -9326, -9317, -9307, -9298, -9288, -9278,
-9269, -9259, -9250, -9241, -9231, -9221, -9212, -9202,
-9193, -9184, -9175, -9165, -9156, -9146, -9137, -9128,
-9119, -9109, -9100, -9090, -9081, -9072, -9063, -9053,
-9044, -9035, -9026, -9017, -9008, -8998, -8989, -8980,
-8971, -8962, -8953, -8944, -8934, -8925, -8916, -8907,
-8898, -8889, -8880, -8871, -8862, -8853, -8844, -8835,
-8826, -8817, -8808, -8799, -8790, -8781, -8772, -8764,
-8755, -8746, -8737, -8728, -8719, -8711, -8702, -8693,
-8684, -8675, -8667, -8658, -8649, -8640, -8632, -8623,
-8614, -8605, -8597, -8588, -8579, -8570, -8562, -8553,
-8545, -8536, -8527, -8519, -8510, -8502, -8493, -8484,
-8476, -8467, -8459, -8450, -8442, -8433, -8425, -8416,
-8408, -8399, -8391, -8382, -8374, -8365, -8357, -8348,
-8340, -8332, -8323, -8315, -8306, -8298, -8290, -8281,
-8273, -8264, -8256, -8248, -8240, -8231, -8223, -8215,
-8206, -8198, -8190, -8182, -8174, -8165, -8157, -8149,
-8140, -8132, -8124, -8116, -8108, -8099, -8091, -8083,
-8075, -8067, -8059, -8051, -8042, -8034, -8027, -8018,
-8010, -8002, -7994, -7986, -7978, -7970, -7962, -7954,
-7946, -7938, -7930, -7922, -7913, -7906, -7897, -7890,
-7882, -7874, -7866, -7858, -7850, -7842, -7834, -7826,
-7818, -7810, -7802, -7795, -7787, -7779, -7771, -7763,
-7755, -7748, -7739, -7732, -7724, -7716, -7708, -7700,
-7693, -7685, -7677, -7669, -7662, -7654, -7646, -7638,
-7630, -7623, -7615, -7608, -7600, -7592, -7584, -7577,
-7569, -7561, -7553, -7546, -7538, -7530, -7523, -7515,
-7508, -7500, -7492, -7485, -7477, -7469, -7462, -7454,
-7447, -7439, -7432, -7424, -7417, -7409, -7401, -7394,
-7386, -7379, -7372, -7364, -7356, -7349, -7341, -7334,
-7327, -7319, -7311, -7304, -7297, -7289, -7281, -7274,
-7267, -7259, -7252, -7245, -7237, -7230, -7222, -7215,
-7208, -7200, -7193, -7186, -7178, -7171, -7163, -7156,
-7149, -7141, -7134, -7127, -7119, -7112, -7105, -7098,
-7090, -7083, -7075, -7068, -7061, -7054, -7046, -7039,
-7032, -7025, -7018, -7010, -7003, -6996, -6989, -6981,
-6974, -6967, -6960, -6953, -6946, -6938, -6931, -6924,
-6917, -6910, -6903, -6895, -6888, -6881, -6874, -6867,
-6860, -6853, -6845, -6838, -6831, -6824, -6817, -6810,
-6803, -6796, -6789, -6782, -6775, -6767, -6760, -6753,
-6747, -6740, -6732, -6725, -6718, -6711, -6704, -6697,
-6690, -6683, -6676, -6669, -6662, -6655, -6648, -6641,
-6634, -6627, -6620, -6613, -6607, -6600, -6593, -6586,
-6579, -6572, -6565, -6558, -6551, -6544, -6538, -6531,
-6524, -6517, -6510, -6503, -6496, -6489, -6482, -6476,
-6469, -6462, -6455, -6448, -6441, -6434, -6428, -6421,
-6414, -6407, -6400, -6394, -6387, -6380, -6373, -6366,
-6360, -6353, -6346, -6339, -6333, -6326, -6319, -6312,
-6306, -6299, -6292, -6286, -6279, -6272, -6265, -6259,
-6252, -6245, -6239, -6232, -6225, -6219, -6212, -6205,
-6198, -6192, -6185, -6178, -6172, -6165, -6158, -6152,
-6145, -6139, -6132, -6125, -6119, -6112, -6105, -6099,
-6092, -6085, -6079, -6072, -6066, -6059, -6053, -6046,
-6040, -6033, -6026, -6019, -6013, -6006, -6000, -5993,
-5987, -5980, -5974, -5967, -5961, -5954, -5948, -5941,
-5935, -5928, -5922, -5915, -5908, -5902, -5895, -5889,
-5883, -5876, -5870, -5863, -5857, -5850, -5844, -5837,
-5831, -5825, -5818, -5811, -5805, -5799, -5792, -5786,
-5779, -5773, -5766, -5760, -5754, -5747, -5741, -5734,
-5728, -5722, -5715, -5709, -5702, -5696, -5690, -5683,
-5677, -5671, -5664, -5658, -5651, -5645, -5639, -5632,
-5626, -5620, -5613, -5607, -5600, -5594, -5588, -5582,
-5575, -5569, -5563, -5556, -5550, -5544, -5537, -5531,
-5525, -5519, -5512, -5506, -5500, -5494, -5487, -5481,
-5475, -5468, -5462, -5456, -5450, -5443, -5437, -5431,
-5425, -5418, -5412, -5406, -5400, -5393, -5387, -5381,
-5375, -5369, -5362, -5356, -5350, -5344, -5337, -5331,
-5325, -5319, -5313, -5306, -5300, -5294, -5288, -5282,
-5276, -5270, -5263, -5257, -5251, -5245, -5239, -5233,
-5226, -5220, -5214, -5208, -5202, -5196, -5190, -5183,
-5177, -5171, -5165, -5159, -5153, -5147, -5140, -5135,
-5129, -5122, -5116, -5110, -5104, -5098, -5092, -5086,
-5080, -5074, -5068, -5061, -5055, -5050, -5043, -5037,
-5031, -5025, -5019, -5013, -5007, -5001, -4995, -4989,
-4983, -4977, -4971, -4965, -4959, -4953, -4947, -4941,
-4935, -4929, -4923, -4917, -4911, -4905, -4899, -4893,
-4887, -4881, -4875, -4869, -4863, -4857, -4851, -4845,
-4839, -4833, -4827, -4821, -4815, -4809, -4803, -4797,
-4791, -4785, -4779, -4773, -4767, -4762, -4755, -4750,
-4744, -4738, -4732, -4726, -4720, -4714, -4708, -4702,
-4696, -4690, -4685, -4678, -4673, -4667, -4661, -4655,
-4649, -4643, -4637, -4631, -4626, -4620, -4614, -4608,
-4602, -4596, -4590, -4585, -4579, -4573, -4567, -4561,
-4555, -4549, -4544, -4538, -4532, -4526, -4520, -4514,
-4508, -4503, -4497, -4491, -4485, -4479, -4474, -4468,
-4462, -4456, -4450, -4445, -4439, -4433, -4427, -4421,
-4415, -4410, -4404, -4398, -4392, -4386, -4381, -4375,
-4369, -4363, -4358, -4352, -4346, -4340, -4334, -4329,
-4323, -4317, -4311, -4306, -4300, -4294, -4289, -4283,
-4277, -4271, -4266, -4260, -4254, -4248, -4243, -4237,
-4231, -4225, -4220, -4214, -4208, -4202, -4197, -4191,
-4185, -4180, -4174, -4168, -4162, -4157, -4151, -4146,
-4140, -4134, -4128, -4123, -4117, -4111, -4105, -4100,
-4094, -4089, -4083, -4077, -4071, -4066, -4060, -4055,
-4049, -4043, -4037, -4032, -4026, -4021, -4015, -4009,
-4003, -3998, -3992, -3987, -3981, -3975, -3970, -3964,
-3958, -3953, -3947, -3942, -3936, -3930, -3925, -3919,
-3913, -3908, -3902, -3897, -3891, -3885, -3880, -3874,
-3869, -3863, -3857, -3852, -3846, -3840, -3835, -3829,
-3824, -3818, -3813, -3807, -3801, -3796, -3790, -3785,
-3779, -3774, -3768, -3762, -3757, -3751, -3746, -3740,
-3734, -3729, -3723, -3718, -3712, -3707, -3701, -3696,
-3690, -3684, -3679, -3673, -3668, -3662, -3657, -3651,
-3646, -3640, -3635, -3629, -3624, -3618, -3613, -3607,
-3602, -3596, -3591, -3585, -3579, -3574, -3568, -3563,
-3557, -3552, -3546, -3541, -3535, -3530, -3524, -3519,
-3514, -3508, -3502, -3497, -3491, -3486, -3480, -3475,
-3469, -3464, -3459, -3453, -3448, -3442, -3437, -3431,
-3425, -3420, -3415, -3409, -3404, -3398, -3393, -3387,
-3382, -3376, -3371, -3366, -3360, -3355, -3349, -3344,
-3338, -3333, -3328, -3322, -3317, -3311, -3305, -3300,
-3295, -3289, -3284, -3278, -3273, -3268, -3262, -3257,
-3251, -3246, -3240, -3235, -3230, -3224, -3219, -3213,
-3208, -3203, -3197, -3192, -3186, -3181, -3176, -3170,
-3165, -3159, -3154, -3149, -3143, -3138, -3132, -3127,
-3122, -3116, -3111, -3105, -3100, -3095, -3089, -3084,
-3079, -3073, -3068, -3062, -3057, -3052, -3046, -3041,
-3036, -3030, -3025, -3019, -3014, -3009, -3003, -2998,
-2993, -2987, -2982, -2977, -2971, -2966, -2961, -2955,
-2950, -2944, -2939, -2934, -2928, -2923, -2918, -2912,
-2907, -2902, -2896, -2891, -2886, -2880, -2875, -2870,
-2864, -2859, -2854, -2848, -2843, -2838, -2832, -2827,
-2822, -2816, -2811, -2806, -2800, -2795, -2790, -2784,
-2779, -2774, -2768, -2763, -2758, -2753, -2747, -2742,
-2737, -2732, -2726, -2721, -2716, -2710, -2705, -2700,
-2694, -2689, -2684, -2678, -2673, -2668, -2663, -2657,
-2652, -2647, -2642, -2636, -2631, -2626, -2620, -2615,
-2610, -2605, -2599, -2594, -2589, -2583, -2578, -2573,
-2568, -2562, -2557, -2552, -2546, -2542, -2536, -2531,
-2526, -2520, -2515, -2510, -2505, -2499, -2494, -2489,
-2483, -2478, -2473, -2468, -2463, -2457, -2452, -2447,
-2442, -2436, -2431, -2426, -2421, -2415, -2410, -2405,
-2400, -2395, -2389, -2384, -2379, -2374, -2368, -2363,
-2358, -2353, -2347, -2342, -2337, -2332, -2327, -2321,
-2316, -2311, -2306, -2300, -2295, -2290, -2285, -2279,
-2275, -2269, -2264, -2259, -2254, -2248, -2243, -2238,
-2233, -2227, -2222, -2217, -2212, -2207, -2202, -2196,
-2191, -2186, -2181, -2175, -2170, -2165, -2160, -2155,
-2150, -2144, -2139, -2134, -2129, -2124, -2118, -2113,
-2108, -2103, -2098, -2093, -2087, -2082, -2077, -2072,
-2067, -2062, -2056, -2051, -2046, -2041, -2036, -2030,
-2025, -2020, -2015, -2010, -2005, -2000, -1994, -1989,
-1984, -1979, -1974, -1969, -1963, -1958, -1953, -1948,
-1943, -1937, -1932, -1927, -1922, -1917, -1912, -1907,
-1901, -1896, -1891, -1886, -1881, -1876, -1871, -1865,
-1860, -1855, -1850, -1845, -1840, -1835, -1829, -1824,
-1819, -1814, -1809, -1804, -1799, -1794, -1788, -1783,
-1778, -1773, -1768, -1763, -1758, -1752, -1747, -1742,
-1737, -1732, -1727, -1722, -1717, -1711, -1706, -1701,
-1696, -1691, -1686, -1681, -1676, -1670, -1665, -1660,
-1655, -1650, -1645, -1640, -1635, -1629, -1624, -1619,
-1614, -1609, -1604, -1599, -1594, -1589, -1584, -1579,
-1573, -1568, -1563, -1558, -1553, -1548, -1543, -1538,
-1532, -1527, -1522, -1517, -1512, -1507, -1502, -1497,
-1492, -1486, -1482, -1477, -1471, -1466, -1461, -1456,
-1451, -1446, -1441, -1436, -1431, -1425, -1420, -1415,
-1410, -1405, -1400, -1395, -1390, -1385, -1380, -1375,
-1370, -1364, -1359, -1354, -1349, -1344, -1339, -1334,
-1329, -1324, -1319, -1314, -1309, -1303, -1298, -1294,
-1288, -1283, -1278, -1273, -1268, -1263, -1258, -1253,
-1248, -1243, -1237, -1232, -1228, -1222, -1217, -1212,
-1207, -1202, -1197, -1192, -1187, -1182, -1177, -1171,
-1167, -1162, -1156, -1151, -1146, -1141, -1136, -1131,
-1126, -1121, -1116, -1111, -1106, -1101, -1096, -1091,
-1085, -1081, -1076, -1070, -1065, -1060, -1055, -1050,
-1045, -1040, -1035, -1030, -1025, -1020, -1015, -1010,
-1005, -1000, -995, -990, -985, -979, -974, -970,
-964, -959, -954, -949, -944, -939, -934, -929,
-924, -919, -914, -909, -904, -899, -894, -889,
-884, -879, -874, -868, -863, -859, -853, -848,
-843, -838, -833, -828, -823, -818, -813, -808,
-803, -798, -793, -788, -783, -778, -773, -768,
-763, -758, -752, -748, -743, -738, -732, -727,
-723, -717, -712, -707, -702, -697, -692, -687,
-682, -677, -672, -667, -662, -657, -652, -647,
-642, -637, -632, -627, -622, -617, -612, -607,
-602, -597, -591, -587, -582, -577, -571, -566,
-562, -557, -551, -546, -541, -537, -531, -526,
-521, -516, -511, -506, -501, -496, -491, -486,
-481, -476, -471, -466, -461, -456, -451, -446,
-441, -436, -431, -426, -421, -416, -411, -406,
-401, -396, -391, -386, -381, -376, -371, -366,
-360, -356, -351, -346, -340, -335, -331, -326,
-320, -315, -310, -306, -300, -295, -290, -285,
-281, -275, -270, -265, -261, -255, -250, -245,
-240, -235, -230, -225, -220, -215, -210, -205,
-200, -195, -190, -185, -180, -175, -170, -165,
-160, -155, -150, -145, -140, -135, -130, -125,
-120, -115, -110, -105, -100, -95, -90, -85,
-80, -75, -70, -65, -60, -55, -50, -45,
-40, -35, -29, -25, -20, -15, -9, -5,
0, 5, 11, 16, 20, 25, 30, 36,
41, 45, 50, 56, 61, 66, 70, 76,
81, 86, 91, 96, 101, 106, 111, 116,
121, 126, 131, 136, 141, 146, 151, 156,
161, 166, 171, 176, 181, 186, 191, 196,
201, 206, 211, 216, 221, 226, 231, 236,
241, 246, 251, 256, 261, 266, 271, 276,
281, 286, 291, 296, 301, 306, 311, 316,
322, 326, 331, 336, 342, 347, 351, 356,
362, 367, 372, 376, 382, 387, 392, 396,
402, 407, 412, 417, 422, 427, 432, 437,
442, 447, 452, 457, 462, 467, 472, 477,
482, 487, 492, 497, 502, 507, 512, 517,
522, 527, 532, 537, 542, 547, 552, 557,
562, 567, 572, 578, 582, 587, 593, 598,
603, 607, 613, 618, 623, 628, 633, 638,
643, 648, 653, 658, 663, 668, 673, 678,
683, 688, 693, 698, 703, 708, 713, 718,
723, 728, 733, 739, 743, 748, 754, 759,
763, 768, 774, 779, 784, 789, 794, 799,
804, 809, 814, 819, 824, 829, 834, 839,
844, 849, 854, 859, 864, 869, 874, 879,
884, 890, 895, 899, 905, 910, 915, 920,
925, 930, 935, 940, 945, 950, 955, 960,
965, 970, 975, 980, 985, 990, 995, 1001,
1006, 1010, 1016, 1021, 1026, 1031, 1036, 1041,
1046, 1051, 1056, 1061, 1066, 1071, 1076, 1081,
1086, 1092, 1096, 1102, 1107, 1112, 1117, 1122,
1127, 1132, 1137, 1142, 1147, 1152, 1157, 1162,
1167, 1173, 1178, 1183, 1188, 1193, 1198, 1203,
1208, 1213, 1218, 1223, 1228, 1233, 1238, 1244,
1248, 1254, 1259, 1264, 1269, 1274, 1279, 1284,
1289, 1294, 1299, 1304, 1309, 1314, 1320, 1325,
1330, 1335, 1340, 1345, 1350, 1355, 1360, 1365,
1371, 1375, 1381, 1386, 1391, 1396, 1401, 1406,
1411, 1416, 1421, 1426, 1432, 1436, 1442, 1447,
1452, 1457, 1462, 1467, 1472, 1477, 1482, 1488,
1493, 1497, 1503, 1508, 1513, 1518, 1523, 1528,
1534, 1538, 1543, 1549, 1554, 1559, 1564, 1569,
1574, 1579, 1584, 1590, 1595, 1600, 1605, 1610,
1615, 1620, 1625, 1630, 1636, 1640, 1646, 1651,
1656, 1661, 1666, 1671, 1676, 1681, 1687, 1692,
1697, 1702, 1707, 1712, 1717, 1722, 1728, 1733,
1738, 1743, 1748, 1753, 1758, 1764, 1769, 1774,
1779, 1784, 1789, 1794, 1799, 1805, 1810, 1815,
1820, 1825, 1831, 1835, 1841, 1846, 1851, 1856,
1861, 1866, 1871, 1877, 1882, 1887, 1892, 1897,
1902, 1908, 1913, 1918, 1923, 1928, 1933, 1939,
1944, 1949, 1954, 1959, 1964, 1969, 1975, 1980,
1985, 1990, 1995, 2000, 2005, 2011, 2016, 2021,
2026, 2031, 2037, 2042, 2047, 2052, 2057, 2062,
2068, 2073, 2078, 2083, 2088, 2093, 2099, 2104,
2109, 2114, 2119, 2125, 2130, 2135, 2140, 2145,
2150, 2156, 2161, 2166, 2171, 2177, 2182, 2187,
2192, 2197, 2202, 2208, 2213, 2218, 2223, 2229,
2234, 2239, 2244, 2249, 2254, 2260, 2265, 2270,
2275, 2281, 2286, 2291, 2296, 2302, 2306, 2312,
2317, 2322, 2327, 2333, 2338, 2343, 2348, 2354,
2359, 2364, 2369, 2374, 2380, 2385, 2390, 2395,
2401, 2406, 2411, 2416, 2422, 2427, 2432, 2437,
2442, 2448, 2453, 2458, 2463, 2469, 2474, 2479,
2485, 2490, 2495, 2500, 2506, 2511, 2516, 2521,
2526, 2532, 2537, 2542, 2548, 2553, 2558, 2563,
2569, 2574, 2579, 2585, 2589, 2595, 2600, 2605,
2611, 2616, 2621, 2627, 2632, 2637, 2642, 2648,
2653, 2658, 2664, 2669, 2674, 2680, 2685, 2690,
2695, 2700, 2706, 2711, 2716, 2722, 2727, 2732,
2738, 2743, 2748, 2754, 2759, 2764, 2769, 2775,
2780, 2785, 2791, 2796, 2801, 2807, 2812, 2817,
2823, 2828, 2833, 2839, 2844, 2849, 2855, 2860,
2865, 2870, 2876, 2881, 2886, 2892, 2897, 2902,
2908, 2913, 2918, 2924, 2929, 2935, 2940, 2945,
2951, 2956, 2961, 2967, 2972, 2977, 2983, 2988,
2993, 2999, 3004, 3010, 3015, 3020, 3026, 3031,
3036, 3042, 3047, 3052, 3058, 3063, 3069, 3074,
3079, 3085, 3090, 3095, 3101, 3106, 3112, 3117,
3122, 3128, 3133, 3139, 3144, 3149, 3155, 3160,
3166, 3171, 3176, 3182, 3187, 3193, 3198, 3203,
3209, 3214, 3220, 3225, 3231, 3236, 3242, 3247,
3252, 3258, 3263, 3269, 3274, 3279, 3285, 3290,
3296, 3301, 3307, 3312, 3317, 3323, 3328, 3334,
3339, 3345, 3350, 3355, 3361, 3367, 3372, 3378,
3383, 3388, 3394, 3399, 3405, 3410, 3416, 3421,
3427, 3432, 3437, 3443, 3448, 3454, 3459, 3465,
3471, 3476, 3481, 3487, 3492, 3498, 3503, 3509,
3514, 3520, 3525, 3531, 3536, 3542, 3548, 3553,
3558, 3564, 3569, 3575, 3580, 3586, 3591, 3597,
3602, 3608, 3613, 3619, 3625, 3630, 3636, 3641,
3647, 3652, 3658, 3663, 3669, 3675, 3680, 3686,
3691, 3697, 3702, 3708, 3713, 3719, 3724, 3730,
3736, 3741, 3747, 3752, 3758, 3763, 3769, 3774,
3780, 3786, 3791, 3797, 3802, 3808, 3813, 3819,
3825, 3830, 3836, 3842, 3847, 3853, 3858, 3864,
3869, 3875, 3881, 3886, 3892, 3898, 3903, 3909,
3915, 3920, 3926, 3931, 3937, 3942, 3948, 3954,
3960, 3965, 3971, 3976, 3982, 3987, 3993, 3999,
4005, 4010, 4016, 4021, 4027, 4033, 4039, 4044,
4050, 4055, 4061, 4067, 4073, 4078, 4084, 4089,
4095, 4101, 4107, 4112, 4118, 4123, 4129, 4135,
4141, 4146, 4152, 4158, 4164, 4169, 4175, 4181,
4187, 4192, 4198, 4203, 4209, 4215, 4221, 4226,
4232, 4238, 4243, 4249, 4255, 4261, 4266, 4272,
4278, 4284, 4289, 4295, 4301, 4307, 4313, 4318,
4324, 4330, 4336, 4341, 4347, 4353, 4359, 4364,
4370, 4376, 4382, 4388, 4393, 4399, 4405, 4411,
4417, 4422, 4428, 4434, 4440, 4445, 4452, 4457,
4463, 4469, 4474, 4481, 4486, 4492, 4498, 4504,
4510, 4515, 4521, 4527, 4533, 4539, 4545, 4551,
4556, 4562, 4568, 4574, 4580, 4585, 4592, 4597,
4603, 4609, 4615, 4621, 4627, 4633, 4638, 4644,
4650, 4656, 4662, 4668, 4674, 4680, 4686, 4692,
4697, 4703, 4709, 4715, 4721, 4727, 4733, 4739,
4745, 4751, 4757, 4762, 4769, 4774, 4780, 4786,
4792, 4798, 4804, 4810, 4816, 4822, 4828, 4834,
4840, 4846, 4852, 4858, 4864, 4870, 4876, 4882,
4888, 4894, 4900, 4906, 4912, 4918, 4924, 4930,
4936, 4942, 4948, 4954, 4960, 4966, 4972, 4978,
4984, 4990, 4996, 5002, 5008, 5014, 5020, 5026,
5032, 5038, 5045, 5050, 5057, 5063, 5069, 5075,
5081, 5087, 5093, 5099, 5105, 5111, 5118, 5123,
5129, 5136, 5142, 5148, 5154, 5160, 5166, 5172,
5179, 5185, 5191, 5197, 5203, 5209, 5215, 5221,
5227, 5233, 5240, 5246, 5252, 5258, 5265, 5271,
5277, 5283, 5289, 5295, 5301, 5308, 5314, 5320,
5326, 5333, 5339, 5345, 5351, 5357, 5363, 5369,
5376, 5382, 5388, 5394, 5401, 5407, 5413, 5419,
5426, 5432, 5438, 5444, 5451, 5457, 5463, 5469,
5476, 5482, 5488, 5494, 5501, 5507, 5513, 5520,
5526, 5532, 5539, 5545, 5551, 5557, 5564, 5570,
5576, 5583, 5589, 5596, 5602, 5608, 5614, 5621,
5627, 5634, 5640, 5646, 5652, 5659, 5665, 5672,
5678, 5684, 5691, 5697, 5704, 5710, 5716, 5723,
5729, 5736, 5742, 5748, 5755, 5761, 5768, 5774,
5780, 5787, 5793, 5800, 5806, 5813, 5819, 5826,
5832, 5838, 5845, 5852, 5858, 5864, 5871, 5877,
5884, 5890, 5897, 5903, 5910, 5916, 5923, 5929,
5936, 5942, 5949, 5956, 5962, 5968, 5975, 5981,
5988, 5994, 6001, 6008, 6014, 6021, 6027, 6034,
6041, 6047, 6054, 6060, 6067, 6074, 6080, 6087,
6093, 6100, 6107, 6113, 6120, 6126, 6133, 6140,
6146, 6153, 6160, 6167, 6173, 6180, 6186, 6193,
6200, 6206, 6213, 6220, 6226, 6233, 6240, 6246,
6253, 6260, 6266, 6273, 6280, 6287, 6294, 6300,
6307, 6314, 6321, 6327, 6334, 6341, 6348, 6354,
6361, 6368, 6375, 6382, 6388, 6395, 6402, 6409,
6416, 6422, 6429, 6436, 6443, 6450, 6457, 6463,
6470, 6477, 6484, 6491, 6497, 6504, 6511, 6518,
6525, 6532, 6539, 6546, 6553, 6559, 6566, 6573,
6580, 6587, 6594, 6601, 6608, 6615, 6622, 6629,
6636, 6643, 6650, 6657, 6664, 6671, 6678, 6685,
6692, 6699, 6706, 6713, 6719, 6727, 6734, 6741,
6748, 6755, 6762, 6769, 6776, 6783, 6790, 6797,
6804, 6811, 6818, 6826, 6833, 6840, 6847, 6854,
6861, 6868, 6875, 6883, 6889, 6897, 6904, 6911,
6918, 6925, 6932, 6939, 6947, 6954, 6961, 6969,
6975, 6983, 6990, 6997, 7005, 7012, 7019, 7026,
7033, 7041, 7048, 7055, 7062, 7070, 7077, 7084,
7091, 7099, 7106, 7114, 7121, 7128, 7135, 7143,
7150, 7157, 7165, 7172, 7179, 7187, 7194, 7202,
7209, 7216, 7224, 7231, 7238, 7246, 7253, 7261,
7268, 7276, 7283, 7290, 7298, 7306, 7313, 7320,
7328, 7336, 7343, 7350, 7358, 7365, 7373, 7381,
7388, 7395, 7403, 7410, 7418, 7426, 7433, 7441,
7448, 7456, 7463, 7471, 7479, 7486, 7494, 7501,
7509, 7517, 7524, 7532, 7540, 7547, 7555, 7563,
7571, 7578, 7586, 7594, 7601, 7609, 7617, 7624,
7632, 7640, 7648, 7655, 7663, 7671, 7679, 7687,
7694, 7702, 7710, 7718, 7725, 7733, 7741, 7749,
7757, 7765, 7773, 7780, 7788, 7796, 7804, 7812,
7820, 7828, 7836, 7843, 7852, 7859, 7868, 7875,
7883, 7891, 7899, 7907, 7915, 7923, 7931, 7939,
7947, 7955, 7963, 7971, 7979, 7988, 7995, 8004,
8012, 8020, 8028, 8036, 8044, 8052, 8061, 8069,
8076, 8085, 8093, 8101, 8109, 8117, 8126, 8134,
8142, 8150, 8158, 8167, 8175, 8183, 8192, 8200,
8208, 8217, 8225, 8233, 8241, 8250, 8258, 8266,
8275, 8283, 8292, 8300, 8308, 8317, 8325, 8333,
8342, 8350, 8359, 8367, 8376, 8384, 8392, 8401,
8409, 8418, 8426, 8435, 8443, 8452, 8461, 8469,
8477, 8486, 8495, 8503, 8512, 8520, 8529, 8538,
8546, 8555, 8564, 8573, 8581, 8590, 8598, 8607,
8616, 8625, 8633, 8642, 8651, 8659, 8668, 8677,
8686, 8695, 8704, 8712, 8721, 8730, 8739, 8748,
8756, 8765, 8774, 8783, 8792, 8801, 8810, 8819,
8828, 8837, 8846, 8855, 8864, 8873, 8882, 8891,
8900, 8909, 8918, 8927, 8936, 8945, 8954, 8964,
8973, 8982, 8991, 9000, 9009, 9019, 9028, 9037,
9046, 9055, 9064, 9074, 9083, 9092, 9102, 9111,
9120, 9130, 9139, 9148, 9157, 9167, 9176, 9186,
9195, 9205, 9214, 9223, 9233, 9242, 9252, 9261,
9271, 9280, 9290, 9300, 9309, 9318, 9328, 9338,
9347, 9357, 9367, 9376, 9386, 9395, 9405, 9415,
9424, 9434, 9444, 9454, 9464, 9473, 9483, 9493,
9503, 9513, 9522, 9532, 9542, 9552, 9562, 9572,
9582, 9592, 9602, 9612, 9622, 9632, 9642, 9652,
9662, 9672, 9682, 9692, 9702, 9712, 9722, 9733,
9743, 9753, 9763, 9773, 9783, 9794, 9804, 9814,
9825, 9835, 9845, 9855, 9866, 9876, 9887, 9897,
9907, 9918, 9928, 9939, 9949, 9960, 9970, 9981,
9991, 10002, 10012, 10023, 10034, 10044, 10055, 10066,
10076, 10087, 10097, 10108, 10119, 10130, 10140, 10152,
10162, 10173, 10184, 10195, 10206, 10217, 10227, 10238,
10249, 10260, 10271, 10282, 10293, 10304, 10315, 10326,
10337, 10349, 10360, 10371, 10382, 10394, 10405, 10416,
10427, 10438, 10450, 10461, 10472, 10484, 10495, 10507,
10518, 10530, 10541, 10553, 10564, 10575, 10587, 10598,
10610, 10622, 10633, 10645, 10657, 10668, 10680, 10692,
10704, 10715, 10727, 10739, 10751, 10763, 10775, 10786,
10798, 10811, 10822, 10834, 10847, 10858, 10870, 10883,
10895, 10907, 10919, 10931, 10944, 10956, 10968, 10981,
10993, 11005, 11017, 11030, 11042, 11055, 11067, 11080,
11092, 11105, 11117, 11130, 11142, 11155, 11168, 11180,
11193, 11206, 11219, 11232, 11245, 11257, 11270, 11283,
11296, 11309, 11322, 11335, 11348, 11361, 11375, 11388,
11401, 11414, 11427, 11441, 11454, 11467, 11481, 11494,
11508, 11521, 11534, 11548, 11561, 11575, 11589, 11602,
11616, 11630, 11644, 11657, 11671, 11685, 11699, 11713,
11727, 11741, 11755, 11769, 11783, 11797, 11811, 11826,
11839, 11854, 11868, 11882, 11897, 11911, 11926, 11940,
11955, 11969, 11984, 11998, 12013, 12028, 12043, 12057,
12072, 12087, 12102, 12117, 12132, 12147, 12162, 12177,
12193, 12208, 12223, 12238, 12254, 12269, 12284, 12299,
12315, 12331, 12346, 12362, 12378, 12393, 12409, 12425,
12441, 12457, 12473, 12489, 12505, 12521, 12537, 12553,
12569, 12586, 12602, 12619, 12635, 12651, 12668, 12684,
12701, 12718, 12734, 12751, 12768, 12785, 12802, 12819,
12836, 12853, 12870, 12888, 12905, 12922, 12940, 12957,
12975, 12993, 13010, 13028, 13046, 13064, 13081, 13099,
13117, 13135, 13154, 13172, 13190, 13209, 13227, 13246,
13264, 13283, 13301, 13320, 13339, 13358, 13377, 13396,
13415, 13434, 13454, 13473, 13492, 13512, 13532, 13551,
13571, 13591, 13611, 13631, 13651, 13671, 13691, 13711,
13732, 13752, 13773, 13793, 13814, 13835, 13856, 13877,
13898, 13919, 13940, 13962, 13983, 14005, 14026, 14048,
14070, 14092, 14114, 14136, 14159, 14181, 14203, 14226,
14249, 14272, 14294, 14318, 14341, 14364, 14387, 14411,
14434, 14458, 14482, 14506, 14530, 14554, 14578, 14603,
14628, 14653, 14677, 14703, 14728, 14753, 14778, 14804,
14830, 14855, 14882, 14908, 14934, 14961, 14987, 15014,
15041, 15068, 15095, 15123, 15151, 15179, 15206, 15235,
15263, 15291, 15320, 15349, 15378, 15408, 15437, 15466,
15496, 15527, 15557, 15587, 15618, 15649, 15680, 15712,
15743, 15775, 15808, 15840, 15872, 15906, 15939, 15972,
16006, 16040, 16074, 16108, 16143, 16178, 16214, 16249,
16285, 16322, 16358, 16395, 16433, 16470, 16508, 16547,
16586, 16624, 16664, 16704, 16744, 16785, 16826, 16867,
16910, 16952, 16995, 17038, 17082, 17126, 17171, 17217,
17263, 17309, 17356, 17403, 17452, 17501, 17550, 17600,
17651, 17702, 17754, 17807, 17861, 17915, 17970, 18026,
18083, 18141, 18200, 18259, 18320, 18382, 18444, 18508,
18573, 18639, 18706, 18775, 18845, 18917, 18989, 19064,
19140, 19217, 19297, 19378, 19461, 19547, 19634, 19724,
19816, 19911, 20009, 20109, 20213, 20319, 20430, 20544,
20663, 20786, 20914, 21047, 21186, 21331, 21484, 21644,
21813, 21991, 22181, 22384, 22601, 22836, 23091, 23370,
23679, 24027, 24424, 24888, 25450, 26164, 27159, 28858,
};
#define NORM_DIST_TABLE_SIZE \
(sizeof (norm_dist_table) / sizeof (norm_dist_table[0]))
static uint32_t
norm_dist(uint32_t mean, uint32_t stdvar)
{
int32_t ret, var;
ret = mean;
var = 0;
if (stdvar != 0) {
int32_t rand, x, t, s = stdvar;
read_frandom(&rand, sizeof(rand));
t = norm_dist_table[rand % NORM_DIST_TABLE_SIZE];
x = (s % NORM_DIST_SCALE) * t;
if (x >= 0) {
x += NORM_DIST_SCALE / 2;
} else {
x -= NORM_DIST_SCALE / 2;
}
var = x / NORM_DIST_SCALE + (s * t / NORM_DIST_SCALE);
}
ret += var;
ret = MAX(ret, 0);
return ret;
}
struct heap_elem {
uint64_t key;
pktsched_pkt_t pkt;
};
struct heap {
size_t limit; /* max size */
size_t size; /* current size */
struct heap_elem p[0];
};
static struct heap *heap_create(size_t size);
static int heap_insert(struct heap *h, uint64_t k, pktsched_pkt_t *p);
static int heap_peek(struct heap *h, uint64_t *k, pktsched_pkt_t *p);
static int heap_extract(struct heap *h, uint64_t *k, pktsched_pkt_t *p);
typedef enum {
NETEM_MODEL_NULL = IF_NETEM_MODEL_NULL,
NETEM_MODEL_NLC = IF_NETEM_MODEL_NLC,
} netem_model_t;
typedef int (*netem_enqueue_fn_t)(struct netem *, classq_pkt_t *, bool *);
struct netem {
decl_lck_mtx_data(, netem_lock);
/************************ Init Time Constants *************************/
char netem_name[MAXTHREADNAMESIZE];
uint32_t netem_flags;
struct ifnet *netem_ifp;
struct thread *netem_output_thread;
void *netem_output_handle;
int (*netem_output)(void *handle,
pktsched_pkt_t *pkts, uint32_t n_pkts);
uint32_t netem_output_max_batch_size;
uint32_t netem_output_ival_ms;
struct heap *netem_heap;
/*********************** Parameters variables *************************/
netem_model_t netem_model;
netem_enqueue_fn_t netem_enqueue;
/* bandwidth token bucket limit */
#define TOKEN_INVALID UINT64_MAX
struct bandwidth {
uint64_t rate;
uint64_t prev_time_to_send;
} netem_bandwidth_model;
/* XXX (need correlated) naive corruption model */
struct corruption {
uint32_t corruption_p;
} netem_corruption_model;
/* naive duplication model */
struct duplication {
uint32_t duplication_p;
} netem_duplication_model;
/* latency (with jitter following random distribution) */
struct latency {
uint32_t latency_ms;
uint32_t jitter_ms;
uint64_t prev_time_to_send;
} netem_latency_model;
/* 4 state Markov packet loss model */
struct loss {
enum _4state_markov_packet_loss_state {
__NO_LOSS = 0,
GAP_RX = 1,
GAP_LOSS,
BURST_RX,
BURST_LOSS,
} state;
uint32_t p_gr_gl; /* P( gap_loss | gap_rx ) */
uint32_t p_gr_bl; /* P( burst_loss | gap_rx ) */
uint32_t p_bl_br; /* P( burst_rx | burst_loss ) */
uint32_t p_bl_gr; /* P( gap_rx | burst_loss ) */
uint32_t p_br_bl; /* P( burst_loss | burst_rx ) */
uint32_t recovery_ms; /* time to recovery from loss */
uint64_t recovery_window;/* time recovery will finish */
} netem_loss_model;
/*
* Reordering Model --
* randomly select packets and re-inject with additional delay
*/
struct reordering {
uint32_t reordering_p;
uint32_t reordering_ms;
} netem_reordering_model;
};
#define NETEMF_INITIALIZED 0x00000001 /* has been initialized */
#define NETEMF_RUNNING 0x00000002 /* thread is running */
#define NETEMF_OUTPUT_IVAL_ONLY 0x00000004 /* output on intervals only */
#define NETEMF_TERMINATEBLOCK 0x20000000 /* block waiting terminate */
#define NETEMF_TERMINATING 0x40000000 /* thread is terminating */
#define NETEMF_TERMINATED 0x80000000 /* thread is terminated */
#define NETEM_MTX_LOCK(_ne) \
lck_mtx_lock(&(_ne)->netem_lock)
#define NETEM_MTX_LOCK_ASSERT_HELD(_ne) \
LCK_MTX_ASSERT(&(_ne)->netem_lock, LCK_ASSERT_OWNED)
#define NETEM_MTX_LOCK_ASSERT_NOTHELD(_ne) \
LCK_MTX_ASSERT(&(_ne)->netem_lock, LCK_ASSERT_NOTOWNED)
#define NETEM_MTX_UNLOCK(_ne) \
lck_mtx_unlock(&(_ne)->netem_lock)
#define NETEM_OUTPUT_IVAL_ONLY(_ne) \
((_ne->netem_flags & NETEMF_OUTPUT_IVAL_ONLY) != 0)
static struct heap *
heap_create(size_t limit)
{
struct heap *h = NULL;
// verify limit
h = kalloc_type(struct heap, struct heap_elem, limit, Z_WAITOK | Z_ZERO);
if (h == NULL) {
return NULL;
}
h->limit = limit;
h->size = 0;
return h;
}
static void
heap_destroy(struct heap *h)
{
ASSERT(h->size == 0);
kfree_type(struct heap, struct heap_elem, h->limit, h);
}
#define HEAP_FATHER(child) (((child) - 1) / 2)
#define HEAP_SWAP(a, b, tmp) { tmp = a; a = b; b = tmp; }
#define HEAP_LEFT(x) (2 * (x) + 1)
static int
heap_insert(struct heap *h, uint64_t key, pktsched_pkt_t *pkt)
{
ASSERT(h != NULL);
if (h->size == h->limit) {
return ENOBUFS;
}
uint64_t child, parent;
if (pkt == NULL) {
child = key;
ASSERT(child < h->size);
} else {
child = h->size;
h->p[child].key = key;
h->p[child].pkt = *pkt;
h->size++;
}
while (child > 0) {
struct heap_elem tmp;
parent = HEAP_FATHER(child);
if (h->p[parent].key < h->p[child].key) {
break;
}
HEAP_SWAP(h->p[child], h->p[parent], tmp);
child = parent;
}
return 0;
}
static int
heap_peek(struct heap *h, uint64_t *key, pktsched_pkt_t *pkt)
{
if (h->size == 0) {
return ENOENT;
}
*key = h->p[0].key;
*pkt = h->p[0].pkt;
return 0;
}
static int
heap_extract(struct heap *h, uint64_t *key, pktsched_pkt_t *pkt)
{
uint64_t child, parent, max;
if (h->size == 0) {
return ENOENT;
}
*key = h->p[0].key;
*pkt = h->p[0].pkt;
/* re-heapify */
parent = 0;
child = HEAP_LEFT(parent); /* start from left child */
max = h->size - 1;
while (child <= max) {
if (child != max && h->p[child + 1].key < h->p[child].key) {
child = child + 1; /* right child */
}
h->p[parent] = h->p[child];
parent = child;
child = HEAP_LEFT(child); /* left child for next loop */
}
h->size--;
if (parent != max) {
/* Fill hole with last entry, bubble up reusing insert code */
h->p[parent] = h->p[max];
_PKTSCHED_PKT_INIT(&h->p[max].pkt);
heap_insert(h, parent, NULL); /* this one cannot fail */
}
return 0;
}
static void
corruption_event(struct netem *ne, pktsched_pkt_t *pkt)
{
struct corruption *corr = &ne->netem_corruption_model;
uint32_t rand;
if (corr->corruption_p == 0) {
return;
}
read_frandom(&rand, sizeof(rand));
rand %= NETEM_PSCALE;
if (rand < corr->corruption_p) {
NETEM_LOG(LOG_DEBUG, "| corrupted");
pktsched_corrupt_packet(pkt);
}
}
static bool
duplication_event(struct netem *ne)
{
struct duplication *dup = &ne->netem_duplication_model;
uint32_t rand;
if (dup->duplication_p == 0) {
return false;
}
read_frandom(&rand, sizeof(rand));
rand %= NETEM_PSCALE;
return rand < dup->duplication_p;
}
static bool
reordering_event(struct netem *ne)
{
struct reordering *reord = &ne->netem_reordering_model;
uint32_t rand;
if (reord->reordering_p != 0) {
read_frandom(&rand, sizeof(rand));
rand %= NETEM_PSCALE;
return rand < reord->reordering_p;
} else {
return false;
}
}
static uint64_t
latency_event(struct netem *ne, uint64_t now)
{
struct reordering *reord = &ne->netem_reordering_model;
struct latency *l = &ne->netem_latency_model;
bool reorder = false;
int32_t delay_ms = 0;
uint64_t abs_time_to_send = now, abs_interval;
if (reordering_event(ne)) {
reorder = true;
delay_ms += reord->reordering_ms;
NETEM_LOG(LOG_DEBUG, "| reorder %dms behind",
reord->reordering_ms);
}
if (l->latency_ms != 0 || l->jitter_ms != 0) {
delay_ms += norm_dist(l->latency_ms, l->jitter_ms);
NETEM_LOG(LOG_DEBUG, "| total delay %dms", delay_ms);
clock_interval_to_absolutetime_interval(delay_ms,
NSEC_PER_MSEC, &abs_interval);
abs_time_to_send += abs_interval;
}
if (l->prev_time_to_send != 0) {
/* make sure packet time to send is monotonic */
if (abs_time_to_send < l->prev_time_to_send) {
/* send this one immediately after previous packet */
abs_time_to_send = l->prev_time_to_send + 1;
}
}
if (!reorder) {
l->prev_time_to_send = abs_time_to_send;
}
return abs_time_to_send;
}
static bool
loss_event(struct netem *ne)
{
struct loss *loss = &ne->netem_loss_model;
uint32_t rand;
if (loss->state == __NO_LOSS) {
return false;
}
read_frandom(&rand, sizeof(rand));
rand %= NETEM_PSCALE;
switch (loss->state) {
case GAP_RX:
if (rand < loss->p_gr_gl) {
loss->state = GAP_RX;
return true;
} else if (loss->p_gr_gl < rand &&
rand < loss->p_gr_gl + loss->p_gr_bl) {
loss->state = BURST_LOSS;
return true;
} else {
loss->state = GAP_RX;
return false;
}
case BURST_LOSS:
if (rand < loss->p_bl_br) {
loss->state = BURST_RX;
return false;
} else if (loss->p_bl_br < rand &&
rand < loss->p_bl_br + loss->p_bl_gr) {
loss->state = GAP_RX;
return false;
} else {
loss->state = BURST_LOSS;
return true;
}
case BURST_RX:
if (rand < loss->p_br_bl) {
loss->state = BURST_LOSS;
return true;
} else {
loss->state = BURST_RX;
return false;
}
case GAP_LOSS:
/* This is instantaneous (stateless), should not be reached */
default:
VERIFY(0);
break;
}
/* not reached */
VERIFY(0);
return false;
}
static uint64_t
rate_limiter(struct netem *ne, pktsched_pkt_t *pkt, uint64_t start_abs_time)
{
struct bandwidth *bw = &ne->netem_bandwidth_model;
uint32_t ipg_ns; /* inter-packet-gap */
uint64_t abs_interval, abs_time_to_send;
if (bw->rate == UINT64_MAX) {
return start_abs_time;
}
if (bw->rate == 0) {
return UINT64_MAX; /* INF to block traffic */
}
ipg_ns = (pkt->pktsched_plen * 8 * NSEC_PER_SEC) / bw->rate;
clock_interval_to_absolutetime_interval(ipg_ns, 1, &abs_interval);
start_abs_time = MAX(start_abs_time, bw->prev_time_to_send);
abs_time_to_send = bw->prev_time_to_send = start_abs_time + abs_interval;
return abs_time_to_send;
}
static int
nlc_enqueue(struct netem *ne, classq_pkt_t *p, bool *pdrop)
{
int ret = 0;
int pkt_count = 1;
uint64_t now, abs_time_to_send;
pktsched_pkt_t pkt;
pktsched_pkt_encap(&pkt, p);
ASSERT(ne != NULL);
ASSERT(pdrop != NULL);
NETEM_MTX_LOCK(ne);
now = mach_absolute_time();
NETEM_LOG(LOG_DEBUG, "┌ begin p %p len %u, now %llu", p->cp_mbuf,
pkt.pktsched_plen, now);
abs_time_to_send = rate_limiter(ne, &pkt, now);
if (abs_time_to_send == UINT64_MAX) {
NETEM_LOG(LOG_DEBUG, "| zero-bw blocked");
goto done_no_output;
}
if (loss_event(ne)) {
NETEM_LOG(LOG_DEBUG, "| lost");
goto done_no_output;
}
if (duplication_event(ne)) {
NETEM_LOG(LOG_DEBUG, "| dup'ed");
pkt_count++;
}
do {
corruption_event(ne, &pkt);
abs_time_to_send = latency_event(ne, abs_time_to_send);
ret = heap_insert(ne->netem_heap, abs_time_to_send, &pkt);
if (ret != 0) {
NETEM_LOG(LOG_WARNING,
"| heap_insert p %p err(%d), freeing pkt",
p->cp_mbuf, ret);
pktsched_free_pkt(&pkt);
goto done;
}
NETEM_LOG(LOG_DEBUG, "| %p enqueued TTS %llu",
pkt.pktsched_pkt_mbuf, abs_time_to_send);
} while (--pkt_count > 0 &&
__probable((ret = pktsched_clone_pkt(&pkt, &pkt)) == 0));
done:
if (__probable(ne->netem_output_thread != THREAD_NULL)) {
if (!(ne->netem_flags & (NETEMF_RUNNING |
NETEMF_TERMINATING | NETEMF_TERMINATED)) &&
!NETEM_OUTPUT_IVAL_ONLY(ne)) {
NETEM_LOG(LOG_DEBUG, "| wakeup output thread");
(void) thread_wakeup((caddr_t)&ne->netem_flags);
}
}
NETEM_MTX_UNLOCK(ne);
NETEM_LOG(LOG_DEBUG, "└ %p end", p->cp_mbuf);
return ret;
done_no_output:
pktsched_free_pkt(&pkt);
*pdrop = true;
NETEM_MTX_UNLOCK(ne);
NETEM_LOG(LOG_DEBUG, "└ %p end", p->cp_mbuf);
return ret;
}
int
netem_enqueue(struct netem *ne, classq_pkt_t *p, bool *pdrop)
{
return ne->netem_enqueue(ne, p, pdrop);
}
static int
netem_dequeue_internal_locked(struct netem *ne, pktsched_pkt_t *pp,
bool *more)
{
int ret = 0;
uint64_t time_to_send;
pktsched_pkt_t pkt;
ASSERT(ne != NULL);
NETEM_MTX_LOCK_ASSERT_HELD(ne);
NETEM_LOG(LOG_DEBUG, "┌ begin");
ret = heap_peek(ne->netem_heap, &time_to_send, &pkt);
if (ret != 0) {
NETEM_LOG(LOG_DEBUG, "| heap empty");
ret = ENOENT;
goto done;
}
if (time_to_send > mach_absolute_time()) {
NETEM_LOG(LOG_DEBUG,
"| TTS not yet reached: %llu now %llu",
time_to_send, mach_absolute_time());
*more = true;
ret = EAGAIN;
goto done;
}
ret = heap_extract(ne->netem_heap, &time_to_send, &pkt);
ASSERT(ret == 0);
*pp = pkt;
done:
NETEM_LOG(LOG_DEBUG, "└ end");
return ret;
}
__attribute__((noreturn))
static void
netem_output_thread_cont(void *v, wait_result_t w)
{
struct netem *ne = v;
bool more = false;
pktsched_pkt_t pkts[NETEM_MAX_BATCH_SIZE];
uint32_t n_pkts = 0;
int ret;
NETEM_MTX_LOCK(ne);
ASSERT(!(ne->netem_flags & NETEMF_TERMINATED));
ne->netem_flags |= NETEMF_RUNNING;
if (__improbable(w == THREAD_INTERRUPTED ||
(ne->netem_flags & NETEMF_TERMINATING) != 0)) {
ASSERT(!(ne->netem_flags & NETEMF_TERMINATED));
ne->netem_flags &= ~(NETEMF_RUNNING | NETEMF_TERMINATING);
ne->netem_flags |= NETEMF_TERMINATED;
NETEM_LOG(LOG_INFO, "%s output thread terminated",
ne->netem_name);
if (ne->netem_flags & NETEMF_TERMINATEBLOCK) {
thread_wakeup((caddr_t)&ne->netem_output_thread);
}
NETEM_MTX_UNLOCK(ne);
/* for the extra refcnt from kernel_thread_start() */
thread_deallocate(current_thread());
/* this is the end */
thread_terminate(current_thread());
/* NOTREACHED */
__builtin_unreachable();
}
ASSERT(ne->netem_output != NULL);
n_pkts = 0;
for (;;) {
ret = netem_dequeue_internal_locked(ne, &pkts[n_pkts],
&more);
if (__probable(ret == 0 &&
++n_pkts < ne->netem_output_max_batch_size)) {
continue;
}
if (__probable(n_pkts != 0)) {
NETEM_MTX_UNLOCK(ne);
(void) ne->netem_output(ne->netem_output_handle,
pkts, n_pkts);
NETEM_MTX_LOCK(ne);
n_pkts = 0;
}
if (ret != 0) {
break;
}
}
uint64_t deadline = TIMEOUT_WAIT_FOREVER;
if (more || NETEM_OUTPUT_IVAL_ONLY(ne)) {
uint32_t delay_ms = ne->netem_output_ival_ms;
clock_interval_to_deadline(delay_ms, NSEC_PER_MSEC, &deadline);
}
(void) assert_wait_deadline(&ne->netem_flags, THREAD_UNINT, deadline);
ne->netem_flags &= ~NETEMF_RUNNING;
NETEM_MTX_UNLOCK(ne);
(void) thread_block_parameter(netem_output_thread_cont, ne);
/* NOTREACHED */
__builtin_unreachable();
}
__attribute__((noreturn))
static void
netem_output_thread_func(void *v, wait_result_t w)
{
#pragma unused(w)
struct netem *ne = v;
uint64_t wakeup;
ASSERT(ne->netem_output_thread == current_thread());
thread_set_thread_name(current_thread(), ne->netem_name);
NETEM_MTX_LOCK(ne);
VERIFY(!(ne->netem_flags & NETEMF_RUNNING));
clock_interval_to_deadline(1, NSEC_PER_MSEC, &wakeup);
(void) assert_wait_deadline(&ne->netem_flags, THREAD_UNINT, wakeup);
NETEM_MTX_UNLOCK(ne);
thread_block_parameter(netem_output_thread_cont, ne);
/* NOTREACHED */
__builtin_unreachable();
}
static struct netem *
netem_create(const char *name, struct ifnet *ifp, void *output_handle,
netem_output_func_t output, uint32_t output_max_batch_size)
{
struct netem *ne;
_CASSERT(IF_NETEM_MODEL_NULL == NETEM_MODEL_NULL);
_CASSERT(IF_NETEM_MODEL_NLC == NETEM_MODEL_NLC);
ne = kalloc_type(struct netem, Z_WAITOK | Z_ZERO);
lck_mtx_init(&ne->netem_lock, &netem_lock_group, LCK_ATTR_NULL);
ne->netem_heap = heap_create(netem_heap_size);
ne->netem_flags = NETEMF_INITIALIZED;
ne->netem_output_handle = output_handle;
ne->netem_output = output;
ne->netem_output_max_batch_size =
MIN(output_max_batch_size, NETEM_MAX_BATCH_SIZE);
ne->netem_output_thread = THREAD_NULL;
ne->netem_ifp = ifp;
if (output != NULL) {
strlcpy(ne->netem_name, name, sizeof(ne->netem_name));
if (kernel_thread_start(netem_output_thread_func, ne,
&ne->netem_output_thread) != KERN_SUCCESS) {
panic_plain("%s can't create thread", ne->netem_name);
}
}
return ne;
}
void
netem_destroy(struct netem *ne)
{
uint64_t f = (1 * NSEC_PER_MSEC); /* 1 ms */
uint64_t s = (1000 * NSEC_PER_MSEC); /* 1 sec */
uint32_t i = 0;
int ret = 0;
uint64_t key = 0;
pktsched_pkt_t pkt;
ASSERT(ne != NULL);
if (ne->netem_output_thread != THREAD_NULL) {
ASSERT(ne->netem_flags & NETEMF_INITIALIZED);
/* signal thread to begin self-termination */
NETEM_MTX_LOCK(ne);
ne->netem_flags |= NETEMF_TERMINATING;
/* and wait for thread to terminate */
while (!(ne->netem_flags & NETEMF_TERMINATED)) {
uint64_t t = 0;
nanoseconds_to_absolutetime((i++ == 0) ? f : s, &t);
clock_absolutetime_interval_to_deadline(t, &t);
ASSERT(t != 0);
ne->netem_flags |= NETEMF_TERMINATEBLOCK;
if (!(ne->netem_flags & NETEMF_RUNNING)) {
thread_wakeup((caddr_t)&ne->netem_flags);
}
(void) assert_wait_deadline(&ne->netem_output_thread,
THREAD_UNINT, t);
NETEM_MTX_UNLOCK(ne);
(void) thread_block(THREAD_CONTINUE_NULL);
NETEM_MTX_LOCK(ne);
ne->netem_flags &= ~NETEMF_TERMINATEBLOCK;
}
ASSERT(ne->netem_flags & NETEMF_TERMINATED);
NETEM_MTX_UNLOCK(ne);
ne->netem_output_thread = THREAD_NULL;
}
ASSERT(ne->netem_output_thread == THREAD_NULL);
lck_mtx_destroy(&ne->netem_lock, &netem_lock_group);
while ((ret = heap_extract(ne->netem_heap, &key, &pkt)) == 0) {
pktsched_free_pkt(&pkt);
}
heap_destroy(ne->netem_heap);
kfree_type(struct netem, ne);
}
static int
netem_check_params(const struct if_netem_params *p)
{
if (p->ifnetem_model != IF_NETEM_MODEL_NLC) {
NETEM_LOG(LOG_ERR, "| error: invalid scheduler model %d",
p->ifnetem_model);
return EINVAL;
}
if (p->ifnetem_corruption_p > NETEM_PSCALE) {
NETEM_LOG(LOG_ERR, "| error: corruption_p %d > %d",
p->ifnetem_corruption_p, NETEM_PSCALE);
return EINVAL;
}
if (p->ifnetem_duplication_p > NETEM_PSCALE) {
NETEM_LOG(LOG_ERR, "| error: duplication_p %d > %d",
p->ifnetem_duplication_p, NETEM_PSCALE);
return EINVAL;
}
if (p->ifnetem_duplication_p > 0 &&
p->ifnetem_latency_ms == 0) {
/* we need to insert dup'ed packet with latency */
NETEM_LOG(LOG_ERR,
"| error: duplication needs latency param");
return EINVAL;
}
if (p->ifnetem_latency_ms > 1000) {
NETEM_LOG(LOG_ERR,
"| error: latency %d too big (> 1 sec)",
p->ifnetem_latency_ms);
return EINVAL;
}
if (p->ifnetem_jitter_ms * 3 > p->ifnetem_latency_ms) {
NETEM_LOG(LOG_ERR,
"| error: jitter %dms too big (latency %dms)",
p->ifnetem_jitter_ms, p->ifnetem_latency_ms);
return EINVAL;
}
/* if gr_gl == 0 (no loss), other prob should all be zero */
if (p->ifnetem_loss_p_gr_gl == 0 &&
(p->ifnetem_loss_p_gr_bl != 0 ||
p->ifnetem_loss_p_bl_br != 0 ||
p->ifnetem_loss_p_bl_gr != 0 ||
p->ifnetem_loss_p_br_bl != 0)) {
NETEM_LOG(LOG_ERR,
"| error: loss params not all zero when p_gr_gl is zero");
return EINVAL;
}
if (p->ifnetem_loss_recovery_ms > 1000) {
NETEM_LOG(LOG_ERR,
"| error: loss recovery %dms too big",
p->ifnetem_loss_recovery_ms);
}
/* check state machine transition prob integrity */
if (p->ifnetem_loss_p_gr_gl > NETEM_PSCALE ||
/* gr_gl = NETEM_PSCALE for total loss */
p->ifnetem_loss_p_gr_bl > NETEM_PSCALE ||
p->ifnetem_loss_p_bl_br > NETEM_PSCALE ||
p->ifnetem_loss_p_bl_gr > NETEM_PSCALE ||
p->ifnetem_loss_p_br_bl > NETEM_PSCALE ||
p->ifnetem_loss_p_gr_gl + p->ifnetem_loss_p_gr_bl > NETEM_PSCALE ||
p->ifnetem_loss_p_bl_br + p->ifnetem_loss_p_bl_gr > NETEM_PSCALE) {
NETEM_LOG(LOG_ERR, "| error: loss params too big");
return EINVAL;
}
if (p->ifnetem_reordering_p > NETEM_PSCALE) {
NETEM_LOG(LOG_ERR, "| error: reordering %d > %d",
p->ifnetem_reordering_p, NETEM_PSCALE);
return EINVAL;
}
if (p->ifnetem_output_ival_ms > 1000) {
NETEM_LOG(LOG_ERR,
"| error: output interval %dms too big",
p->ifnetem_output_ival_ms);
return EINVAL;
}
return 0;
}
static char *
netem_model_str(netem_model_t model)
{
switch (model) {
case IF_NETEM_MODEL_NLC:
return "Network link conditioner";
default:
return "unknown";
}
}
static void
netem_set_params(struct netem *ne, __unused struct ifnet *ifp,
const struct if_netem_params *p)
{
NETEM_MTX_LOCK(ne);
ne->netem_model = (netem_model_t)p->ifnetem_model;
switch (ne->netem_model) {
case NETEM_MODEL_NLC:
ne->netem_enqueue = nlc_enqueue;
break;
default:
ASSERT(0);
__builtin_unreachable();
}
struct bandwidth *bw = &ne->netem_bandwidth_model;
bw->rate = p->ifnetem_bandwidth_bps;
struct corruption *corr = &ne->netem_corruption_model;
corr->corruption_p = p->ifnetem_corruption_p;
struct duplication *dup = &ne->netem_duplication_model;
dup->duplication_p = p->ifnetem_duplication_p;
struct latency *late = &ne->netem_latency_model;
late->latency_ms = p->ifnetem_latency_ms;
late->jitter_ms = p->ifnetem_jitter_ms;
struct loss *loss = &ne->netem_loss_model;
loss->state = GAP_RX;
loss->p_gr_gl = p->ifnetem_loss_p_gr_gl;
loss->p_gr_bl = p->ifnetem_loss_p_gr_bl;
loss->p_bl_gr = p->ifnetem_loss_p_bl_gr;
loss->p_bl_br = p->ifnetem_loss_p_bl_br;
loss->p_br_bl = p->ifnetem_loss_p_br_bl;
loss->recovery_ms = p->ifnetem_loss_recovery_ms;
struct reordering *r = &ne->netem_reordering_model;
r->reordering_p = p->ifnetem_reordering_p;
if (p->ifnetem_output_ival_ms != 0) {
ne->netem_output_ival_ms = p->ifnetem_output_ival_ms;
ne->netem_flags |= NETEMF_OUTPUT_IVAL_ONLY;
} else {
ne->netem_output_ival_ms = netem_output_ival_ms;
}
if (NETEM_OUTPUT_IVAL_ONLY(ne)) {
if (__probable(ne->netem_output_thread != THREAD_NULL)) {
if (!(ne->netem_flags & (NETEMF_RUNNING |
NETEMF_TERMINATING | NETEMF_TERMINATED))) {
NETEM_LOG(LOG_DEBUG, "| wakeup output thread");
(void) thread_wakeup((caddr_t)&ne->netem_flags);
}
}
}
NETEM_LOG(LOG_INFO, "| %s set_params success", ne->netem_name);
NETEM_LOG(LOG_INFO, "| model %s", netem_model_str(ne->netem_model));
NETEM_LOG(LOG_INFO, "| bandwidth %llu bps %s", bw->rate,
bw->rate == UINT64_MAX ? "no limit" : "");
NETEM_LOG(LOG_INFO, "| corruption %d%%",
corr->corruption_p);
NETEM_LOG(LOG_INFO, "| duplication %d%%",
dup->duplication_p);
NETEM_LOG(LOG_INFO, "| latency_ms %d jitter_ms %d",
late->latency_ms, late->jitter_ms);
NETEM_LOG(LOG_INFO, "| loss p_gr_gl %d%%", loss->p_gr_gl);
NETEM_LOG(LOG_INFO, "| p_gr_bl %d%%", loss->p_gr_bl);
NETEM_LOG(LOG_INFO, "| p_bl_gr %d%%", loss->p_bl_gr);
NETEM_LOG(LOG_INFO, "| p_bl_br %d%%", loss->p_bl_br);
NETEM_LOG(LOG_INFO, "| p_br_bl %d%%", loss->p_br_bl);
NETEM_LOG(LOG_INFO, "| recovery_ms %dms", loss->recovery_ms);
NETEM_LOG(LOG_INFO, "| reordering %d%% %d ms behind",
r->reordering_p, r->reordering_ms);
NETEM_LOG(LOG_INFO, "| output ival %d ms",
ne->netem_output_ival_ms);
NETEM_MTX_UNLOCK(ne);
}
void
netem_get_params(struct netem *ne, struct if_netem_params *p)
{
ASSERT(ne != NULL);
NETEM_MTX_LOCK(ne);
p->ifnetem_model = (if_netem_model_t)ne->netem_model;
struct bandwidth *bw = &ne->netem_bandwidth_model;
p->ifnetem_bandwidth_bps = bw->rate;
struct corruption *corr = &ne->netem_corruption_model;
p->ifnetem_corruption_p = corr->corruption_p;
struct duplication *dup = &ne->netem_duplication_model;
p->ifnetem_duplication_p = dup->duplication_p;
struct latency *late = &ne->netem_latency_model;
p->ifnetem_latency_ms = late->latency_ms;
p->ifnetem_jitter_ms = late->jitter_ms;
struct loss *loss = &ne->netem_loss_model;
p->ifnetem_loss_p_gr_gl = loss->p_gr_gl;
p->ifnetem_loss_p_gr_bl = loss->p_gr_bl;
p->ifnetem_loss_p_bl_gr = loss->p_bl_gr;
p->ifnetem_loss_p_bl_br = loss->p_bl_br;
p->ifnetem_loss_p_br_bl = loss->p_br_bl;
p->ifnetem_loss_recovery_ms = loss->recovery_ms;
struct reordering *r = &ne->netem_reordering_model;
p->ifnetem_reordering_p = r->reordering_p;
NETEM_MTX_UNLOCK(ne);
}
int
netem_config(struct netem **ne, const char *name, struct ifnet *ifp,
const struct if_netem_params *p, void *output_handle,
netem_output_func_t *output_func, uint32_t output_max_batch_size)
{
struct netem *netem = NULL;
bool enable = true;
int ret = 0;
NETEM_LOG(LOG_INFO, "┌ begin %s", name);
if (p == NULL || (
p->ifnetem_model == IF_NETEM_MODEL_NULL &&
p->ifnetem_bandwidth_bps == 0 &&
p->ifnetem_corruption_p == 0 &&
p->ifnetem_duplication_p == 0 &&
p->ifnetem_latency_ms == 0 &&
p->ifnetem_jitter_ms == 0 &&
p->ifnetem_loss_p_gr_gl == 0 &&
p->ifnetem_loss_p_gr_bl == 0 &&
p->ifnetem_loss_p_bl_br == 0 &&
p->ifnetem_loss_p_bl_gr == 0 &&
p->ifnetem_loss_p_br_bl == 0 &&
p->ifnetem_loss_recovery_ms == 0 &&
p->ifnetem_reordering_p == 0 &&
p->ifnetem_output_ival_ms == 0)) {
enable = false;
}
if (enable) {
if (p->ifnetem_model == IF_NETEM_MODEL_NLC &&
(ifp->if_xflags & IFXF_NO_TRAFFIC_SHAPING) != 0) {
NETEM_LOG(LOG_INFO, "| netem no traffic shapping %s on %s", name, if_name(ifp));
goto done;
}
ret = netem_check_params(p);
if (ret != 0) {
goto done;
}
if (*ne == NULL) {
NETEM_LOG(LOG_INFO, "| netem create %s", name);
netem = netem_create(name, ifp, output_handle,
output_func, output_max_batch_size);
if (netem == NULL) {
ret = ENOMEM;
goto done;
}
os_atomic_store(ne, netem, release);
}
netem_set_params(*ne, ifp, p);
} else {
NETEM_LOG(LOG_INFO, "| netem disable %s", name);
if (*ne != NULL) {
netem = *ne;
os_atomic_store(ne, NULL, release);
NETEM_LOG(LOG_INFO, "| netem destroy %s", name);
netem_destroy(netem);
}
ret = 0;
}
done:
NETEM_LOG(LOG_INFO, "└ ret %d", ret);
return ret;
}
#else /* !CONFIG_NETEM */
NETEM_STUB
#endif /* !CONFIG_NETEM */
#else /* !SKYWALK */
NETEM_STUB
#endif /* !SKYWALK */