162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (c) 2018, Mellanox Technologies inc.  All rights reserved.
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/dim.h>
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci/*
962306a36Sopenharmony_ci * Net DIM profiles:
1062306a36Sopenharmony_ci *        There are different set of profiles for each CQ period mode.
1162306a36Sopenharmony_ci *        There are different set of profiles for RX/TX CQs.
1262306a36Sopenharmony_ci *        Each profile size must be of NET_DIM_PARAMS_NUM_PROFILES
1362306a36Sopenharmony_ci */
1462306a36Sopenharmony_ci#define NET_DIM_PARAMS_NUM_PROFILES 5
1562306a36Sopenharmony_ci#define NET_DIM_DEFAULT_RX_CQ_PKTS_FROM_EQE 256
1662306a36Sopenharmony_ci#define NET_DIM_DEFAULT_TX_CQ_PKTS_FROM_EQE 128
1762306a36Sopenharmony_ci#define NET_DIM_DEF_PROFILE_CQE 1
1862306a36Sopenharmony_ci#define NET_DIM_DEF_PROFILE_EQE 1
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci#define NET_DIM_RX_EQE_PROFILES { \
2162306a36Sopenharmony_ci	{.usec = 1,   .pkts = NET_DIM_DEFAULT_RX_CQ_PKTS_FROM_EQE,}, \
2262306a36Sopenharmony_ci	{.usec = 8,   .pkts = NET_DIM_DEFAULT_RX_CQ_PKTS_FROM_EQE,}, \
2362306a36Sopenharmony_ci	{.usec = 64,  .pkts = NET_DIM_DEFAULT_RX_CQ_PKTS_FROM_EQE,}, \
2462306a36Sopenharmony_ci	{.usec = 128, .pkts = NET_DIM_DEFAULT_RX_CQ_PKTS_FROM_EQE,}, \
2562306a36Sopenharmony_ci	{.usec = 256, .pkts = NET_DIM_DEFAULT_RX_CQ_PKTS_FROM_EQE,}  \
2662306a36Sopenharmony_ci}
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci#define NET_DIM_RX_CQE_PROFILES { \
2962306a36Sopenharmony_ci	{.usec = 2,  .pkts = 256,},             \
3062306a36Sopenharmony_ci	{.usec = 8,  .pkts = 128,},             \
3162306a36Sopenharmony_ci	{.usec = 16, .pkts = 64,},              \
3262306a36Sopenharmony_ci	{.usec = 32, .pkts = 64,},              \
3362306a36Sopenharmony_ci	{.usec = 64, .pkts = 64,}               \
3462306a36Sopenharmony_ci}
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci#define NET_DIM_TX_EQE_PROFILES { \
3762306a36Sopenharmony_ci	{.usec = 1,   .pkts = NET_DIM_DEFAULT_TX_CQ_PKTS_FROM_EQE,},  \
3862306a36Sopenharmony_ci	{.usec = 8,   .pkts = NET_DIM_DEFAULT_TX_CQ_PKTS_FROM_EQE,},  \
3962306a36Sopenharmony_ci	{.usec = 32,  .pkts = NET_DIM_DEFAULT_TX_CQ_PKTS_FROM_EQE,},  \
4062306a36Sopenharmony_ci	{.usec = 64,  .pkts = NET_DIM_DEFAULT_TX_CQ_PKTS_FROM_EQE,},  \
4162306a36Sopenharmony_ci	{.usec = 128, .pkts = NET_DIM_DEFAULT_TX_CQ_PKTS_FROM_EQE,}   \
4262306a36Sopenharmony_ci}
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci#define NET_DIM_TX_CQE_PROFILES { \
4562306a36Sopenharmony_ci	{.usec = 5,  .pkts = 128,},  \
4662306a36Sopenharmony_ci	{.usec = 8,  .pkts = 64,},  \
4762306a36Sopenharmony_ci	{.usec = 16, .pkts = 32,},  \
4862306a36Sopenharmony_ci	{.usec = 32, .pkts = 32,},  \
4962306a36Sopenharmony_ci	{.usec = 64, .pkts = 32,}   \
5062306a36Sopenharmony_ci}
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_cistatic const struct dim_cq_moder
5362306a36Sopenharmony_cirx_profile[DIM_CQ_PERIOD_NUM_MODES][NET_DIM_PARAMS_NUM_PROFILES] = {
5462306a36Sopenharmony_ci	NET_DIM_RX_EQE_PROFILES,
5562306a36Sopenharmony_ci	NET_DIM_RX_CQE_PROFILES,
5662306a36Sopenharmony_ci};
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_cistatic const struct dim_cq_moder
5962306a36Sopenharmony_citx_profile[DIM_CQ_PERIOD_NUM_MODES][NET_DIM_PARAMS_NUM_PROFILES] = {
6062306a36Sopenharmony_ci	NET_DIM_TX_EQE_PROFILES,
6162306a36Sopenharmony_ci	NET_DIM_TX_CQE_PROFILES,
6262306a36Sopenharmony_ci};
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_cistruct dim_cq_moder
6562306a36Sopenharmony_cinet_dim_get_rx_moderation(u8 cq_period_mode, int ix)
6662306a36Sopenharmony_ci{
6762306a36Sopenharmony_ci	struct dim_cq_moder cq_moder = rx_profile[cq_period_mode][ix];
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	cq_moder.cq_period_mode = cq_period_mode;
7062306a36Sopenharmony_ci	return cq_moder;
7162306a36Sopenharmony_ci}
7262306a36Sopenharmony_ciEXPORT_SYMBOL(net_dim_get_rx_moderation);
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_cistruct dim_cq_moder
7562306a36Sopenharmony_cinet_dim_get_def_rx_moderation(u8 cq_period_mode)
7662306a36Sopenharmony_ci{
7762306a36Sopenharmony_ci	u8 profile_ix = cq_period_mode == DIM_CQ_PERIOD_MODE_START_FROM_CQE ?
7862306a36Sopenharmony_ci			NET_DIM_DEF_PROFILE_CQE : NET_DIM_DEF_PROFILE_EQE;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	return net_dim_get_rx_moderation(cq_period_mode, profile_ix);
8162306a36Sopenharmony_ci}
8262306a36Sopenharmony_ciEXPORT_SYMBOL(net_dim_get_def_rx_moderation);
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_cistruct dim_cq_moder
8562306a36Sopenharmony_cinet_dim_get_tx_moderation(u8 cq_period_mode, int ix)
8662306a36Sopenharmony_ci{
8762306a36Sopenharmony_ci	struct dim_cq_moder cq_moder = tx_profile[cq_period_mode][ix];
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	cq_moder.cq_period_mode = cq_period_mode;
9062306a36Sopenharmony_ci	return cq_moder;
9162306a36Sopenharmony_ci}
9262306a36Sopenharmony_ciEXPORT_SYMBOL(net_dim_get_tx_moderation);
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_cistruct dim_cq_moder
9562306a36Sopenharmony_cinet_dim_get_def_tx_moderation(u8 cq_period_mode)
9662306a36Sopenharmony_ci{
9762306a36Sopenharmony_ci	u8 profile_ix = cq_period_mode == DIM_CQ_PERIOD_MODE_START_FROM_CQE ?
9862306a36Sopenharmony_ci			NET_DIM_DEF_PROFILE_CQE : NET_DIM_DEF_PROFILE_EQE;
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci	return net_dim_get_tx_moderation(cq_period_mode, profile_ix);
10162306a36Sopenharmony_ci}
10262306a36Sopenharmony_ciEXPORT_SYMBOL(net_dim_get_def_tx_moderation);
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_cistatic int net_dim_step(struct dim *dim)
10562306a36Sopenharmony_ci{
10662306a36Sopenharmony_ci	if (dim->tired == (NET_DIM_PARAMS_NUM_PROFILES * 2))
10762306a36Sopenharmony_ci		return DIM_TOO_TIRED;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	switch (dim->tune_state) {
11062306a36Sopenharmony_ci	case DIM_PARKING_ON_TOP:
11162306a36Sopenharmony_ci	case DIM_PARKING_TIRED:
11262306a36Sopenharmony_ci		break;
11362306a36Sopenharmony_ci	case DIM_GOING_RIGHT:
11462306a36Sopenharmony_ci		if (dim->profile_ix == (NET_DIM_PARAMS_NUM_PROFILES - 1))
11562306a36Sopenharmony_ci			return DIM_ON_EDGE;
11662306a36Sopenharmony_ci		dim->profile_ix++;
11762306a36Sopenharmony_ci		dim->steps_right++;
11862306a36Sopenharmony_ci		break;
11962306a36Sopenharmony_ci	case DIM_GOING_LEFT:
12062306a36Sopenharmony_ci		if (dim->profile_ix == 0)
12162306a36Sopenharmony_ci			return DIM_ON_EDGE;
12262306a36Sopenharmony_ci		dim->profile_ix--;
12362306a36Sopenharmony_ci		dim->steps_left++;
12462306a36Sopenharmony_ci		break;
12562306a36Sopenharmony_ci	}
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	dim->tired++;
12862306a36Sopenharmony_ci	return DIM_STEPPED;
12962306a36Sopenharmony_ci}
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_cistatic void net_dim_exit_parking(struct dim *dim)
13262306a36Sopenharmony_ci{
13362306a36Sopenharmony_ci	dim->tune_state = dim->profile_ix ? DIM_GOING_LEFT : DIM_GOING_RIGHT;
13462306a36Sopenharmony_ci	net_dim_step(dim);
13562306a36Sopenharmony_ci}
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_cistatic int net_dim_stats_compare(struct dim_stats *curr,
13862306a36Sopenharmony_ci				 struct dim_stats *prev)
13962306a36Sopenharmony_ci{
14062306a36Sopenharmony_ci	if (!prev->bpms)
14162306a36Sopenharmony_ci		return curr->bpms ? DIM_STATS_BETTER : DIM_STATS_SAME;
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	if (IS_SIGNIFICANT_DIFF(curr->bpms, prev->bpms))
14462306a36Sopenharmony_ci		return (curr->bpms > prev->bpms) ? DIM_STATS_BETTER :
14562306a36Sopenharmony_ci						   DIM_STATS_WORSE;
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci	if (!prev->ppms)
14862306a36Sopenharmony_ci		return curr->ppms ? DIM_STATS_BETTER :
14962306a36Sopenharmony_ci				    DIM_STATS_SAME;
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	if (IS_SIGNIFICANT_DIFF(curr->ppms, prev->ppms))
15262306a36Sopenharmony_ci		return (curr->ppms > prev->ppms) ? DIM_STATS_BETTER :
15362306a36Sopenharmony_ci						   DIM_STATS_WORSE;
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_ci	if (!prev->epms)
15662306a36Sopenharmony_ci		return DIM_STATS_SAME;
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	if (IS_SIGNIFICANT_DIFF(curr->epms, prev->epms))
15962306a36Sopenharmony_ci		return (curr->epms < prev->epms) ? DIM_STATS_BETTER :
16062306a36Sopenharmony_ci						   DIM_STATS_WORSE;
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci	return DIM_STATS_SAME;
16362306a36Sopenharmony_ci}
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_cistatic bool net_dim_decision(struct dim_stats *curr_stats, struct dim *dim)
16662306a36Sopenharmony_ci{
16762306a36Sopenharmony_ci	int prev_state = dim->tune_state;
16862306a36Sopenharmony_ci	int prev_ix = dim->profile_ix;
16962306a36Sopenharmony_ci	int stats_res;
17062306a36Sopenharmony_ci	int step_res;
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_ci	switch (dim->tune_state) {
17362306a36Sopenharmony_ci	case DIM_PARKING_ON_TOP:
17462306a36Sopenharmony_ci		stats_res = net_dim_stats_compare(curr_stats,
17562306a36Sopenharmony_ci						  &dim->prev_stats);
17662306a36Sopenharmony_ci		if (stats_res != DIM_STATS_SAME)
17762306a36Sopenharmony_ci			net_dim_exit_parking(dim);
17862306a36Sopenharmony_ci		break;
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_ci	case DIM_PARKING_TIRED:
18162306a36Sopenharmony_ci		dim->tired--;
18262306a36Sopenharmony_ci		if (!dim->tired)
18362306a36Sopenharmony_ci			net_dim_exit_parking(dim);
18462306a36Sopenharmony_ci		break;
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	case DIM_GOING_RIGHT:
18762306a36Sopenharmony_ci	case DIM_GOING_LEFT:
18862306a36Sopenharmony_ci		stats_res = net_dim_stats_compare(curr_stats,
18962306a36Sopenharmony_ci						  &dim->prev_stats);
19062306a36Sopenharmony_ci		if (stats_res != DIM_STATS_BETTER)
19162306a36Sopenharmony_ci			dim_turn(dim);
19262306a36Sopenharmony_ci
19362306a36Sopenharmony_ci		if (dim_on_top(dim)) {
19462306a36Sopenharmony_ci			dim_park_on_top(dim);
19562306a36Sopenharmony_ci			break;
19662306a36Sopenharmony_ci		}
19762306a36Sopenharmony_ci
19862306a36Sopenharmony_ci		step_res = net_dim_step(dim);
19962306a36Sopenharmony_ci		switch (step_res) {
20062306a36Sopenharmony_ci		case DIM_ON_EDGE:
20162306a36Sopenharmony_ci			dim_park_on_top(dim);
20262306a36Sopenharmony_ci			break;
20362306a36Sopenharmony_ci		case DIM_TOO_TIRED:
20462306a36Sopenharmony_ci			dim_park_tired(dim);
20562306a36Sopenharmony_ci			break;
20662306a36Sopenharmony_ci		}
20762306a36Sopenharmony_ci
20862306a36Sopenharmony_ci		break;
20962306a36Sopenharmony_ci	}
21062306a36Sopenharmony_ci
21162306a36Sopenharmony_ci	if (prev_state != DIM_PARKING_ON_TOP ||
21262306a36Sopenharmony_ci	    dim->tune_state != DIM_PARKING_ON_TOP)
21362306a36Sopenharmony_ci		dim->prev_stats = *curr_stats;
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	return dim->profile_ix != prev_ix;
21662306a36Sopenharmony_ci}
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_civoid net_dim(struct dim *dim, struct dim_sample end_sample)
21962306a36Sopenharmony_ci{
22062306a36Sopenharmony_ci	struct dim_stats curr_stats;
22162306a36Sopenharmony_ci	u16 nevents;
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_ci	switch (dim->state) {
22462306a36Sopenharmony_ci	case DIM_MEASURE_IN_PROGRESS:
22562306a36Sopenharmony_ci		nevents = BIT_GAP(BITS_PER_TYPE(u16),
22662306a36Sopenharmony_ci				  end_sample.event_ctr,
22762306a36Sopenharmony_ci				  dim->start_sample.event_ctr);
22862306a36Sopenharmony_ci		if (nevents < DIM_NEVENTS)
22962306a36Sopenharmony_ci			break;
23062306a36Sopenharmony_ci		if (!dim_calc_stats(&dim->start_sample, &end_sample, &curr_stats))
23162306a36Sopenharmony_ci			break;
23262306a36Sopenharmony_ci		if (net_dim_decision(&curr_stats, dim)) {
23362306a36Sopenharmony_ci			dim->state = DIM_APPLY_NEW_PROFILE;
23462306a36Sopenharmony_ci			schedule_work(&dim->work);
23562306a36Sopenharmony_ci			break;
23662306a36Sopenharmony_ci		}
23762306a36Sopenharmony_ci		fallthrough;
23862306a36Sopenharmony_ci	case DIM_START_MEASURE:
23962306a36Sopenharmony_ci		dim_update_sample(end_sample.event_ctr, end_sample.pkt_ctr,
24062306a36Sopenharmony_ci				  end_sample.byte_ctr, &dim->start_sample);
24162306a36Sopenharmony_ci		dim->state = DIM_MEASURE_IN_PROGRESS;
24262306a36Sopenharmony_ci		break;
24362306a36Sopenharmony_ci	case DIM_APPLY_NEW_PROFILE:
24462306a36Sopenharmony_ci		break;
24562306a36Sopenharmony_ci	}
24662306a36Sopenharmony_ci}
24762306a36Sopenharmony_ciEXPORT_SYMBOL(net_dim);
248