31  * into manual mode if there's any counter, so that the user is able to
71 	struct rdma_counter *counter;  in rdma_counter_alloc()  local
77 	counter = kzalloc(sizeof(*counter), GFP_KERNEL);  in rdma_counter_alloc()
78 	if (!counter)  in rdma_counter_alloc()
81 	counter->device    = dev;  in rdma_counter_alloc()
82 	counter->port      = port;  in rdma_counter_alloc()
84 	rdma_restrack_new(&counter->res, RDMA_RESTRACK_COUNTER);  in rdma_counter_alloc()
85 	counter->stats = dev->ops.counter_alloc_stats(counter);  in rdma_counter_alloc()
86 	if (!counter->stats)  in rdma_counter_alloc()
101 	counter->mode.mode = mode;  in rdma_counter_alloc()
102 	kref_init(&counter->kref);  in rdma_counter_alloc()
103 	mutex_init(&counter->lock);  in rdma_counter_alloc()
105 	return counter;  in rdma_counter_alloc()
109 	kfree(counter->stats);  in rdma_counter_alloc()
111 	rdma_restrack_put(&counter->res);  in rdma_counter_alloc()
112 	kfree(counter);  in rdma_counter_alloc()
116 static void rdma_counter_free(struct rdma_counter *counter)  in rdma_counter_free()  argument
120 	port_counter = &counter->device->port_data[counter->port].port_counter;  in rdma_counter_free()
130 	rdma_restrack_del(&counter->res);  in rdma_counter_free()
131 	kfree(counter->stats);  in rdma_counter_free()
132 	kfree(counter);  in rdma_counter_free()
135 static void auto_mode_init_counter(struct rdma_counter *counter,  in auto_mode_init_counter()  argument
139 	struct auto_mode_param *param = &counter->mode.param;  in auto_mode_init_counter()
141 	counter->mode.mode = RDMA_COUNTER_MODE_AUTO;  in auto_mode_init_counter()
142 	counter->mode.mask = new_mask;  in auto_mode_init_counter()
148 static bool auto_mode_match(struct ib_qp *qp, struct rdma_counter *counter,  in auto_mode_match()  argument
151 	struct auto_mode_param *param = &counter->mode.param;  in auto_mode_match()
158 		match &= (task_pid_nr(counter->res.task) ==  in auto_mode_match()
164 static int __rdma_counter_bind_qp(struct rdma_counter *counter,  in __rdma_counter_bind_qp()  argument
169 	if (qp->counter)  in __rdma_counter_bind_qp()
175 	mutex_lock(&counter->lock);  in __rdma_counter_bind_qp()
176 	ret = qp->device->ops.counter_bind_qp(counter, qp);  in __rdma_counter_bind_qp()
177 	mutex_unlock(&counter->lock);  in __rdma_counter_bind_qp()
184 	struct rdma_counter *counter = qp->counter;  in __rdma_counter_unbind_qp()  local
190 	mutex_lock(&counter->lock);  in __rdma_counter_unbind_qp()
192 	mutex_unlock(&counter->lock);  in __rdma_counter_unbind_qp()
197 static void counter_history_stat_update(struct rdma_counter *counter)  in counter_history_stat_update()  argument
199 	struct ib_device *dev = counter->device;  in counter_history_stat_update()
203 	port_counter = &dev->port_data[counter->port].port_counter;  in counter_history_stat_update()
207 	rdma_counter_query_stats(counter);  in counter_history_stat_update()
209 	for (i = 0; i < counter->stats->num_counters; i++)  in counter_history_stat_update()
210 		port_counter->hstats->value[i] += counter->stats->value[i];  in counter_history_stat_update()
214  * rdma_get_counter_auto_mode - Find the counter that @qp should be bound
217  * Return: The counter (with ref-count increased) if found
223 	struct rdma_counter *counter = NULL;  in rdma_get_counter_auto_mode()  local
233 		counter = container_of(res, struct rdma_counter, res);  in rdma_get_counter_auto_mode()
234 		if ((counter->device != qp->device) || (counter->port != port))  in rdma_get_counter_auto_mode()
237 		if (auto_mode_match(qp, counter, port_counter->mode.mask))  in rdma_get_counter_auto_mode()
240 		counter = NULL;  in rdma_get_counter_auto_mode()
243 	if (counter && !kref_get_unless_zero(&counter->kref))  in rdma_get_counter_auto_mode()
244 		counter = NULL;  in rdma_get_counter_auto_mode()
247 	return counter;  in rdma_get_counter_auto_mode()
250 static void rdma_counter_res_add(struct rdma_counter *counter,  in rdma_counter_res_add()  argument
253 	rdma_restrack_parent_name(&counter->res, &qp->res);  in rdma_counter_res_add()
254 	rdma_restrack_add(&counter->res);  in rdma_counter_res_add()
259 	struct rdma_counter *counter;  in counter_release()  local
261 	counter = container_of(kref, struct rdma_counter, kref);  in counter_release()
262 	counter_history_stat_update(counter);  in counter_release()
263 	counter->device->ops.counter_dealloc(counter);  in counter_release()
264 	rdma_counter_free(counter);  in counter_release()
268  * rdma_counter_bind_qp_auto - Check and bind the QP to a counter base on
275 	struct rdma_counter *counter;  in rdma_counter_bind_qp_auto()  local
288 	counter = rdma_get_counter_auto_mode(qp, port);  in rdma_counter_bind_qp_auto()
289 	if (counter) {  in rdma_counter_bind_qp_auto()
290 		ret = __rdma_counter_bind_qp(counter, qp);  in rdma_counter_bind_qp_auto()
292 			kref_put(&counter->kref, counter_release);  in rdma_counter_bind_qp_auto()
296 		counter = rdma_counter_alloc(dev, port, RDMA_COUNTER_MODE_AUTO);  in rdma_counter_bind_qp_auto()
297 		if (!counter)  in rdma_counter_bind_qp_auto()
300 		auto_mode_init_counter(counter, qp, port_counter->mode.mask);  in rdma_counter_bind_qp_auto()
302 		ret = __rdma_counter_bind_qp(counter, qp);  in rdma_counter_bind_qp_auto()
304 			rdma_counter_free(counter);  in rdma_counter_bind_qp_auto()
308 		rdma_counter_res_add(counter, qp);  in rdma_counter_bind_qp_auto()
315  * rdma_counter_unbind_qp - Unbind a qp from a counter
317  *   true - Decrease the counter ref-count anyway (e.g., qp destroy)
321 	struct rdma_counter *counter = qp->counter;  in rdma_counter_unbind_qp()  local
324 	if (!counter)  in rdma_counter_unbind_qp()
331 	kref_put(&counter->kref, counter_release);  in rdma_counter_unbind_qp()
335 int rdma_counter_query_stats(struct rdma_counter *counter)  in rdma_counter_query_stats()  argument
337 	struct ib_device *dev = counter->device;  in rdma_counter_query_stats()
343 	mutex_lock(&counter->lock);  in rdma_counter_query_stats()
344 	ret = dev->ops.counter_update_stats(counter);  in rdma_counter_query_stats()
345 	mutex_unlock(&counter->lock);  in rdma_counter_query_stats()
355 	struct rdma_counter *counter;  in get_running_counters_hwstat_sum()  local
367 		counter = container_of(res, struct rdma_counter, res);  in get_running_counters_hwstat_sum()
368 		if ((counter->device != dev) || (counter->port != port) ||  in get_running_counters_hwstat_sum()
369 		    rdma_counter_query_stats(counter))  in get_running_counters_hwstat_sum()
372 		sum += counter->stats->value[index];  in get_running_counters_hwstat_sum()
422 static int rdma_counter_bind_qp_manual(struct rdma_counter *counter,  in rdma_counter_bind_qp_manual()  argument
425 	if ((counter->device != qp->device) || (counter->port != qp->port))  in rdma_counter_bind_qp_manual()
428 	return __rdma_counter_bind_qp(counter, qp);  in rdma_counter_bind_qp_manual()
435 	struct rdma_counter *counter;  in rdma_get_counter_by_id()  local
441 	counter = container_of(res, struct rdma_counter, res);  in rdma_get_counter_by_id()
442 	kref_get(&counter->kref);  in rdma_get_counter_by_id()
445 	return counter;  in rdma_get_counter_by_id()
449  * rdma_counter_bind_qpn() - Bind QP @qp_num to counter @counter_id
455 	struct rdma_counter *counter;  in rdma_counter_bind_qpn()  local
467 	counter = rdma_get_counter_by_id(dev, counter_id);  in rdma_counter_bind_qpn()
468 	if (!counter) {  in rdma_counter_bind_qpn()
473 	if (rdma_is_kernel_res(&counter->res) != rdma_is_kernel_res(&qp->res)) {  in rdma_counter_bind_qpn()
478 	ret = rdma_counter_bind_qp_manual(counter, qp);  in rdma_counter_bind_qpn()
486 	kref_put(&counter->kref, counter_release);  in rdma_counter_bind_qpn()
493  * rdma_counter_bind_qpn_alloc() - Alloc a counter and bind QP @qp_num to it
494  *   The id of new counter is returned in @counter_id
500 	struct rdma_counter *counter;  in rdma_counter_bind_qpn_alloc()  local
523 	counter = rdma_counter_alloc(dev, port, RDMA_COUNTER_MODE_MANUAL);  in rdma_counter_bind_qpn_alloc()
524 	if (!counter) {  in rdma_counter_bind_qpn_alloc()
529 	ret = rdma_counter_bind_qp_manual(counter, qp);  in rdma_counter_bind_qpn_alloc()
534 		*counter_id = counter->id;  in rdma_counter_bind_qpn_alloc()
536 	rdma_counter_res_add(counter, qp);  in rdma_counter_bind_qpn_alloc()
542 	rdma_counter_free(counter);  in rdma_counter_bind_qpn_alloc()
549  * rdma_counter_unbind_qpn() - Unbind QP @qp_num from a counter
571 	if (!qp->counter || qp->counter->id != counter_id ||  in rdma_counter_unbind_qpn()