1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause) 2 /* 3 * Copyright(c) 2018 Intel Corporation. 4 * 5 */ 6 #include "iowait.h" 7 #include "trace_iowait.h" 8 9 /* 1 priority == 16 starve_cnt */ 10 #define IOWAIT_PRIORITY_STARVE_SHIFT 4 11 12 void iowait_set_flag(struct iowait *wait, u32 flag) 13 { 14 trace_hfi1_iowait_set(wait, flag); 15 set_bit(flag, &wait->flags); 16 } 17 18 bool iowait_flag_set(struct iowait *wait, u32 flag) 19 { 20 return test_bit(flag, &wait->flags); 21 } 22 23 inline void iowait_clear_flag(struct iowait *wait, u32 flag) 24 { 25 trace_hfi1_iowait_clear(wait, flag); 26 clear_bit(flag, &wait->flags); 27 } 28 29 /** 30 * iowait_init() - initialize wait structure 31 * @wait: wait struct to initialize 32 * @tx_limit: limit for overflow queuing 33 * @func: restart function for workqueue 34 * @sleep: sleep function for no space 35 * @resume: wakeup function for no space 36 * 37 * This function initializes the iowait 38 * structure embedded in the QP or PQ. 39 * 40 */ 41 void iowait_init(struct iowait *wait, u32 tx_limit, 42 void (*func)(struct work_struct *work), 43 void (*tidfunc)(struct work_struct *work), 44 int (*sleep)(struct sdma_engine *sde, 45 struct iowait_work *wait, 46 struct sdma_txreq *tx, 47 uint seq, 48 bool pkts_sent), 49 void (*wakeup)(struct iowait *wait, int reason), 50 void (*sdma_drained)(struct iowait *wait), 51 void (*init_priority)(struct iowait *wait)) 52 { 53 int i; 54 55 wait->count = 0; 56 INIT_LIST_HEAD(&wait->list); 57 init_waitqueue_head(&wait->wait_dma); 58 init_waitqueue_head(&wait->wait_pio); 59 atomic_set(&wait->sdma_busy, 0); 60 atomic_set(&wait->pio_busy, 0); 61 wait->tx_limit = tx_limit; 62 wait->sleep = sleep; 63 wait->wakeup = wakeup; 64 wait->sdma_drained = sdma_drained; 65 wait->init_priority = init_priority; 66 wait->flags = 0; 67 for (i = 0; i < IOWAIT_SES; i++) { 68 wait->wait[i].iow = wait; 69 INIT_LIST_HEAD(&wait->wait[i].tx_head); 70 if (i == IOWAIT_IB_SE) 71 INIT_WORK(&wait->wait[i].iowork, func); 72 else 73 INIT_WORK(&wait->wait[i].iowork, tidfunc); 74 } 75 } 76 77 /** 78 * iowait_cancel_work - cancel all work in iowait 79 * @w: the iowait struct 80 */ 81 void iowait_cancel_work(struct iowait *w) 82 { 83 cancel_work_sync(&iowait_get_ib_work(w)->iowork); 84 /* Make sure that the iowork for TID RDMA is used */ 85 if (iowait_get_tid_work(w)->iowork.func) 86 cancel_work_sync(&iowait_get_tid_work(w)->iowork); 87 } 88 89 /** 90 * iowait_set_work_flag - set work flag based on leg 91 * @w - the iowait work struct 92 */ 93 int iowait_set_work_flag(struct iowait_work *w) 94 { 95 if (w == &w->iow->wait[IOWAIT_IB_SE]) { 96 iowait_set_flag(w->iow, IOWAIT_PENDING_IB); 97 return IOWAIT_IB_SE; 98 } 99 iowait_set_flag(w->iow, IOWAIT_PENDING_TID); 100 return IOWAIT_TID_SE; 101 } 102 103 /** 104 * iowait_priority_update_top - update the top priority entry 105 * @w: the iowait struct 106 * @top: a pointer to the top priority entry 107 * @idx: the index of the current iowait in an array 108 * @top_idx: the array index for the iowait entry that has the top priority 109 * 110 * This function is called to compare the priority of a given 111 * iowait with the given top priority entry. The top index will 112 * be returned. 113 */ 114 uint iowait_priority_update_top(struct iowait *w, 115 struct iowait *top, 116 uint idx, uint top_idx) 117 { 118 u8 cnt, tcnt; 119 120 /* Convert priority into starve_cnt and compare the total.*/ 121 cnt = (w->priority << IOWAIT_PRIORITY_STARVE_SHIFT) + w->starved_cnt; 122 tcnt = (top->priority << IOWAIT_PRIORITY_STARVE_SHIFT) + 123 top->starved_cnt; 124 if (cnt > tcnt) 125 return idx; 126 else 127 return top_idx; 128 } 129