1 /* SPDX-License-Identifier: BSD-3-Clause
2 * Copyright(c) 2010-2018 Intel Corporation
8 #include <rte_cycles.h>
9 #include <rte_atomic.h>
10 #include <rte_malloc.h>
13 #include "rte_power.h"
14 #include "rte_power_empty_poll.h"
16 #define INTERVALS_PER_SECOND 100 /* (10ms) */
17 #define SECONDS_TO_TRAIN_FOR 2
18 #define DEFAULT_MED_TO_HIGH_PERCENT_THRESHOLD 70
19 #define DEFAULT_HIGH_TO_MED_PERCENT_THRESHOLD 30
20 #define DEFAULT_CYCLES_PER_PACKET 800
22 static struct ep_params *ep_params;
23 static uint32_t med_to_high_threshold = DEFAULT_MED_TO_HIGH_PERCENT_THRESHOLD;
24 static uint32_t high_to_med_threshold = DEFAULT_HIGH_TO_MED_PERCENT_THRESHOLD;
26 static uint32_t avail_freqs[RTE_MAX_LCORE][NUM_FREQS];
28 static uint32_t total_avail_freqs[RTE_MAX_LCORE];
30 static uint32_t freq_index[NUM_FREQ];
33 get_freq_index(enum freq_val index)
35 return freq_index[index];
40 set_power_freq(int lcore_id, enum freq_val freq, bool specific_freq)
43 uint32_t power_freq_index;
45 power_freq_index = get_freq_index(freq);
47 power_freq_index = freq;
49 err = rte_power_set_freq(lcore_id, power_freq_index);
55 static __rte_always_inline void
56 exit_training_state(struct priority_worker *poll_stats)
58 RTE_SET_USED(poll_stats);
61 static __rte_always_inline void
62 enter_training_state(struct priority_worker *poll_stats)
64 poll_stats->iter_counter = 0;
65 poll_stats->cur_freq = LOW;
66 poll_stats->queue_state = TRAINING;
69 static __rte_always_inline void
70 enter_normal_state(struct priority_worker *poll_stats)
72 /* Clear the averages arrays and strs */
73 memset(poll_stats->edpi_av, 0, sizeof(poll_stats->edpi_av));
75 memset(poll_stats->ppi_av, 0, sizeof(poll_stats->ppi_av));
78 poll_stats->cur_freq = MED;
79 poll_stats->iter_counter = 0;
80 poll_stats->threshold_ctr = 0;
81 poll_stats->queue_state = MED_NORMAL;
82 RTE_LOG(INFO, POWER, "Set the power freq to MED\n");
83 set_power_freq(poll_stats->lcore_id, MED, false);
85 poll_stats->thresh[MED].threshold_percent = med_to_high_threshold;
86 poll_stats->thresh[HGH].threshold_percent = high_to_med_threshold;
89 static __rte_always_inline void
90 enter_busy_state(struct priority_worker *poll_stats)
92 memset(poll_stats->edpi_av, 0, sizeof(poll_stats->edpi_av));
94 memset(poll_stats->ppi_av, 0, sizeof(poll_stats->ppi_av));
97 poll_stats->cur_freq = HGH;
98 poll_stats->iter_counter = 0;
99 poll_stats->threshold_ctr = 0;
100 poll_stats->queue_state = HGH_BUSY;
101 set_power_freq(poll_stats->lcore_id, HGH, false);
104 static __rte_always_inline void
105 enter_purge_state(struct priority_worker *poll_stats)
107 poll_stats->iter_counter = 0;
108 poll_stats->queue_state = LOW_PURGE;
111 static __rte_always_inline void
112 set_state(struct priority_worker *poll_stats,
113 enum queue_state new_state)
115 enum queue_state old_state = poll_stats->queue_state;
116 if (old_state != new_state) {
118 /* Call any old state exit functions */
119 if (old_state == TRAINING)
120 exit_training_state(poll_stats);
122 /* Call any new state entry functions */
123 if (new_state == TRAINING)
124 enter_training_state(poll_stats);
125 if (new_state == MED_NORMAL)
126 enter_normal_state(poll_stats);
127 if (new_state == HGH_BUSY)
128 enter_busy_state(poll_stats);
129 if (new_state == LOW_PURGE)
130 enter_purge_state(poll_stats);
134 static __rte_always_inline void
135 set_policy(struct priority_worker *poll_stats,
136 struct ep_policy *policy)
138 set_state(poll_stats, policy->state);
140 if (policy->state == TRAINING)
143 poll_stats->thresh[MED_NORMAL].base_edpi = policy->med_base_edpi;
144 poll_stats->thresh[HGH_BUSY].base_edpi = policy->hgh_base_edpi;
146 poll_stats->thresh[MED_NORMAL].trained = true;
147 poll_stats->thresh[HGH_BUSY].trained = true;
152 update_training_stats(struct priority_worker *poll_stats,
155 uint32_t max_train_iter)
157 RTE_SET_USED(specific_freq);
159 uint64_t p0_empty_deq;
161 if (poll_stats->cur_freq == freq &&
162 poll_stats->thresh[freq].trained == false) {
163 if (poll_stats->thresh[freq].cur_train_iter == 0) {
165 set_power_freq(poll_stats->lcore_id,
166 freq, specific_freq);
168 poll_stats->empty_dequeues_prev =
169 poll_stats->empty_dequeues;
171 poll_stats->thresh[freq].cur_train_iter++;
174 } else if (poll_stats->thresh[freq].cur_train_iter
177 p0_empty_deq = poll_stats->empty_dequeues -
178 poll_stats->empty_dequeues_prev;
180 poll_stats->empty_dequeues_prev =
181 poll_stats->empty_dequeues;
183 poll_stats->thresh[freq].base_edpi += p0_empty_deq;
184 poll_stats->thresh[freq].cur_train_iter++;
187 if (poll_stats->thresh[freq].trained == false) {
188 poll_stats->thresh[freq].base_edpi =
189 poll_stats->thresh[freq].base_edpi /
192 /* Add on a factor of 0.05%
193 * this should remove any
194 * false negatives when the system is 0% busy
196 poll_stats->thresh[freq].base_edpi +=
197 poll_stats->thresh[freq].base_edpi / 2000;
199 poll_stats->thresh[freq].trained = true;
200 poll_stats->cur_freq++;
207 static __rte_always_inline uint32_t
208 update_stats(struct priority_worker *poll_stats)
210 uint64_t tot_edpi = 0, tot_ppi = 0;
213 struct priority_worker *s = poll_stats;
215 uint64_t cur_edpi = s->empty_dequeues - s->empty_dequeues_prev;
217 s->empty_dequeues_prev = s->empty_dequeues;
219 uint64_t ppi = s->num_dequeue_pkts - s->num_dequeue_pkts_prev;
221 s->num_dequeue_pkts_prev = s->num_dequeue_pkts;
223 if (s->thresh[s->cur_freq].base_edpi < cur_edpi) {
225 /* edpi mean empty poll counter difference per interval */
226 RTE_LOG(DEBUG, POWER, "cur_edpi is too large "
227 "cur edpi %"PRId64" "
228 "base edpi %"PRId64"\n",
230 s->thresh[s->cur_freq].base_edpi);
231 /* Value to make us fail need debug log*/
235 s->edpi_av[s->ec++ % BINS_AV] = cur_edpi;
236 s->ppi_av[s->pc++ % BINS_AV] = ppi;
238 for (j = 0; j < BINS_AV; j++) {
239 tot_edpi += s->edpi_av[j];
240 tot_ppi += s->ppi_av[j];
243 tot_edpi = tot_edpi / BINS_AV;
245 percent = 100 - (uint32_t)(((float)tot_edpi /
246 (float)s->thresh[s->cur_freq].base_edpi) * 100);
248 return (uint32_t)percent;
252 static __rte_always_inline void
253 update_stats_normal(struct priority_worker *poll_stats)
257 if (poll_stats->thresh[poll_stats->cur_freq].base_edpi == 0) {
259 enum freq_val cur_freq = poll_stats->cur_freq;
261 /* edpi mean empty poll counter difference per interval */
262 RTE_LOG(DEBUG, POWER, "cure freq is %d, edpi is %"PRIu64"\n",
264 poll_stats->thresh[cur_freq].base_edpi);
268 percent = update_stats(poll_stats);
271 /* edpi mean empty poll counter difference per interval */
272 RTE_LOG(DEBUG, POWER, "Edpi is bigger than threshold\n");
276 if (poll_stats->cur_freq == LOW)
277 RTE_LOG(INFO, POWER, "Purge Mode is not currently supported\n");
278 else if (poll_stats->cur_freq == MED) {
281 poll_stats->thresh[MED].threshold_percent) {
283 if (poll_stats->threshold_ctr < INTERVALS_PER_SECOND)
284 poll_stats->threshold_ctr++;
286 set_state(poll_stats, HGH_BUSY);
287 RTE_LOG(INFO, POWER, "MOVE to HGH\n");
292 poll_stats->threshold_ctr = 0;
295 } else if (poll_stats->cur_freq == HGH) {
298 poll_stats->thresh[HGH].threshold_percent) {
300 if (poll_stats->threshold_ctr < INTERVALS_PER_SECOND)
301 poll_stats->threshold_ctr++;
303 set_state(poll_stats, MED_NORMAL);
304 RTE_LOG(INFO, POWER, "MOVE to MED\n");
308 poll_stats->threshold_ctr = 0;
315 empty_poll_training(struct priority_worker *poll_stats,
316 uint32_t max_train_iter)
319 if (poll_stats->iter_counter < INTERVALS_PER_SECOND) {
320 poll_stats->iter_counter++;
325 update_training_stats(poll_stats,
330 update_training_stats(poll_stats,
335 update_training_stats(poll_stats,
341 if (poll_stats->thresh[LOW].trained == true
342 && poll_stats->thresh[MED].trained == true
343 && poll_stats->thresh[HGH].trained == true) {
345 set_state(poll_stats, MED_NORMAL);
347 RTE_LOG(INFO, POWER, "LOW threshold is %"PRIu64"\n",
348 poll_stats->thresh[LOW].base_edpi);
350 RTE_LOG(INFO, POWER, "MED threshold is %"PRIu64"\n",
351 poll_stats->thresh[MED].base_edpi);
354 RTE_LOG(INFO, POWER, "HIGH threshold is %"PRIu64"\n",
355 poll_stats->thresh[HGH].base_edpi);
357 RTE_LOG(INFO, POWER, "Training is Complete for %d\n",
358 poll_stats->lcore_id);
365 rte_empty_poll_detection(struct rte_timer *tim, void *arg)
370 struct priority_worker *poll_stats;
376 for (i = 0; i < NUM_NODES; i++) {
378 poll_stats = &(ep_params->wrk_data.wrk_stats[i]);
380 if (rte_lcore_is_enabled(poll_stats->lcore_id) == 0)
383 switch (poll_stats->queue_state) {
385 empty_poll_training(poll_stats,
386 ep_params->max_train_iter);
391 update_stats_normal(poll_stats);
406 rte_power_empty_poll_stat_init(struct ep_params **eptr, uint8_t *freq_tlb,
407 struct ep_policy *policy)
410 /* Allocate the ep_params structure */
411 ep_params = rte_zmalloc_socket(NULL,
412 sizeof(struct ep_params),
419 if (freq_tlb == NULL) {
420 freq_index[LOW] = 14;
424 freq_index[LOW] = freq_tlb[LOW];
425 freq_index[MED] = freq_tlb[MED];
426 freq_index[HGH] = freq_tlb[HGH];
429 RTE_LOG(INFO, POWER, "Initialize the Empty Poll\n");
431 /* Train for pre-defined period */
432 ep_params->max_train_iter = INTERVALS_PER_SECOND * SECONDS_TO_TRAIN_FOR;
434 struct stats_data *w = &ep_params->wrk_data;
438 /* initialize all wrk_stats state */
439 for (i = 0; i < NUM_NODES; i++) {
441 if (rte_lcore_is_enabled(i) == 0)
443 /*init the freqs table */
444 total_avail_freqs[i] = rte_power_freqs(i,
448 RTE_LOG(INFO, POWER, "total avail freq is %d , lcoreid %d\n",
449 total_avail_freqs[i],
452 if (get_freq_index(LOW) > total_avail_freqs[i])
455 if (rte_get_main_lcore() != i) {
456 w->wrk_stats[i].lcore_id = i;
457 set_policy(&w->wrk_stats[i], policy);
465 rte_power_empty_poll_stat_free(void)
468 RTE_LOG(INFO, POWER, "Close the Empty Poll\n");
470 if (ep_params != NULL)
475 rte_power_empty_poll_stat_update(unsigned int lcore_id)
477 struct priority_worker *poll_stats;
479 if (lcore_id >= NUM_NODES)
482 poll_stats = &(ep_params->wrk_data.wrk_stats[lcore_id]);
484 if (poll_stats->lcore_id == 0)
485 poll_stats->lcore_id = lcore_id;
487 poll_stats->empty_dequeues++;
493 rte_power_poll_stat_update(unsigned int lcore_id, uint8_t nb_pkt)
496 struct priority_worker *poll_stats;
498 if (lcore_id >= NUM_NODES)
501 poll_stats = &(ep_params->wrk_data.wrk_stats[lcore_id]);
503 if (poll_stats->lcore_id == 0)
504 poll_stats->lcore_id = lcore_id;
506 poll_stats->num_dequeue_pkts += nb_pkt;
513 rte_power_empty_poll_stat_fetch(unsigned int lcore_id)
515 struct priority_worker *poll_stats;
517 if (lcore_id >= NUM_NODES)
520 poll_stats = &(ep_params->wrk_data.wrk_stats[lcore_id]);
522 if (poll_stats->lcore_id == 0)
523 poll_stats->lcore_id = lcore_id;
525 return poll_stats->empty_dequeues;
529 rte_power_poll_stat_fetch(unsigned int lcore_id)
531 struct priority_worker *poll_stats;
533 if (lcore_id >= NUM_NODES)
536 poll_stats = &(ep_params->wrk_data.wrk_stats[lcore_id]);
538 if (poll_stats->lcore_id == 0)
539 poll_stats->lcore_id = lcore_id;
541 return poll_stats->num_dequeue_pkts;