1 // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
19 			return -EINVAL;  in __counter_set_mode()
20 		if (port_counter->num_counters)  in __counter_set_mode()
21 			return -EBUSY;  in __counter_set_mode()
24 	port_counter->mode.mode = new_mode;  in __counter_set_mode()
25 	port_counter->mode.mask = new_mask;  in __counter_set_mode()
26 	return 0;  in __counter_set_mode()
30  * rdma_counter_set_auto_mode() - Turn on/off per-port auto mode
37  * Return 0 on success. If counter mode wasn't changed then it is considered
39  * Return -EBUSY when changing to auto mode while there are bounded counters.
50 	port_counter = &dev->port_data[port].port_counter;  in rdma_counter_set_auto_mode()
51 	if (!port_counter->hstats)  in rdma_counter_set_auto_mode()
52 		return -EOPNOTSUPP;  in rdma_counter_set_auto_mode()
54 	mutex_lock(&port_counter->lock);  in rdma_counter_set_auto_mode()
58 		mode = (port_counter->num_counters) ? RDMA_COUNTER_MODE_MANUAL :  in rdma_counter_set_auto_mode()
61 	if (port_counter->mode.mode == mode &&  in rdma_counter_set_auto_mode()
62 	    port_counter->mode.mask == mask) {  in rdma_counter_set_auto_mode()
63 		ret = 0;  in rdma_counter_set_auto_mode()
70 	mutex_unlock(&port_counter->lock);  in rdma_counter_set_auto_mode()
71 	if (ret == -EBUSY)  in rdma_counter_set_auto_mode()
78 static void auto_mode_init_counter(struct rdma_counter *counter,  in auto_mode_init_counter()  argument
82 	struct auto_mode_param *param = &counter->mode.param;  in auto_mode_init_counter()
84 	counter->mode.mode = RDMA_COUNTER_MODE_AUTO;  in auto_mode_init_counter()
85 	counter->mode.mask = new_mask;  in auto_mode_init_counter()
88 		param->qp_type = qp->qp_type;  in auto_mode_init_counter()
91 static int __rdma_counter_bind_qp(struct rdma_counter *counter,  in __rdma_counter_bind_qp()  argument
96 	if (qp->counter)  in __rdma_counter_bind_qp()
97 		return -EINVAL;  in __rdma_counter_bind_qp()
99 	if (!qp->device->ops.counter_bind_qp)  in __rdma_counter_bind_qp()
100 		return -EOPNOTSUPP;  in __rdma_counter_bind_qp()
102 	mutex_lock(&counter->lock);  in __rdma_counter_bind_qp()
103 	ret = qp->device->ops.counter_bind_qp(counter, qp);  in __rdma_counter_bind_qp()
104 	mutex_unlock(&counter->lock);  in __rdma_counter_bind_qp()
114 	struct rdma_counter *counter;  in alloc_and_bind()  local
117 	if (!dev->ops.counter_dealloc || !dev->ops.counter_alloc_stats)  in alloc_and_bind()
120 	counter = kzalloc(sizeof(*counter), GFP_KERNEL);  in alloc_and_bind()
121 	if (!counter)  in alloc_and_bind()
124 	counter->device    = dev;  in alloc_and_bind()
125 	counter->port      = port;  in alloc_and_bind()
127 	rdma_restrack_new(&counter->res, RDMA_RESTRACK_COUNTER);  in alloc_and_bind()
128 	counter->stats = dev->ops.counter_alloc_stats(counter);  in alloc_and_bind()
129 	if (!counter->stats)  in alloc_and_bind()
132 	port_counter = &dev->port_data[port].port_counter;  in alloc_and_bind()
133 	mutex_lock(&port_counter->lock);  in alloc_and_bind()
137 					 0);  in alloc_and_bind()
139 			mutex_unlock(&port_counter->lock);  in alloc_and_bind()
144 		auto_mode_init_counter(counter, qp, port_counter->mode.mask);  in alloc_and_bind()
147 		ret = -EOPNOTSUPP;  in alloc_and_bind()
148 		mutex_unlock(&port_counter->lock);  in alloc_and_bind()
152 	port_counter->num_counters++;  in alloc_and_bind()
153 	mutex_unlock(&port_counter->lock);  in alloc_and_bind()
155 	counter->mode.mode = mode;  in alloc_and_bind()
156 	kref_init(&counter->kref);  in alloc_and_bind()
157 	mutex_init(&counter->lock);  in alloc_and_bind()
159 	ret = __rdma_counter_bind_qp(counter, qp);  in alloc_and_bind()
163 	rdma_restrack_parent_name(&counter->res, &qp->res);  in alloc_and_bind()
164 	rdma_restrack_add(&counter->res);  in alloc_and_bind()
165 	return counter;  in alloc_and_bind()
168 	kfree(counter->stats);  in alloc_and_bind()
170 	rdma_restrack_put(&counter->res);  in alloc_and_bind()
171 	kfree(counter);  in alloc_and_bind()
175 static void rdma_counter_free(struct rdma_counter *counter)  in rdma_counter_free()  argument
179 	port_counter = &counter->device->port_data[counter->port].port_counter;  in rdma_counter_free()
180 	mutex_lock(&port_counter->lock);  in rdma_counter_free()
181 	port_counter->num_counters--;  in rdma_counter_free()
182 	if (!port_counter->num_counters &&  in rdma_counter_free()
183 	    (port_counter->mode.mode == RDMA_COUNTER_MODE_MANUAL))  in rdma_counter_free()
184 		__counter_set_mode(port_counter, RDMA_COUNTER_MODE_NONE, 0);  in rdma_counter_free()
186 	mutex_unlock(&port_counter->lock);  in rdma_counter_free()
188 	rdma_restrack_del(&counter->res);  in rdma_counter_free()
189 	kfree(counter->stats);  in rdma_counter_free()
190 	kfree(counter);  in rdma_counter_free()
193 static bool auto_mode_match(struct ib_qp *qp, struct rdma_counter *counter,  in auto_mode_match()  argument
196 	struct auto_mode_param *param = &counter->mode.param;  in auto_mode_match()
200 		match &= (param->qp_type == qp->qp_type);  in auto_mode_match()
203 		match &= (task_pid_nr(counter->res.task) ==  in auto_mode_match()
204 			  task_pid_nr(qp->res.task));  in auto_mode_match()
211 	struct rdma_counter *counter = qp->counter;  in __rdma_counter_unbind_qp()  local
214 	if (!qp->device->ops.counter_unbind_qp)  in __rdma_counter_unbind_qp()
215 		return -EOPNOTSUPP;  in __rdma_counter_unbind_qp()
217 	mutex_lock(&counter->lock);  in __rdma_counter_unbind_qp()
218 	ret = qp->device->ops.counter_unbind_qp(qp);  in __rdma_counter_unbind_qp()
219 	mutex_unlock(&counter->lock);  in __rdma_counter_unbind_qp()
224 static void counter_history_stat_update(struct rdma_counter *counter)  in counter_history_stat_update()  argument
226 	struct ib_device *dev = counter->device;  in counter_history_stat_update()
230 	port_counter = &dev->port_data[counter->port].port_counter;  in counter_history_stat_update()
231 	if (!port_counter->hstats)  in counter_history_stat_update()
234 	rdma_counter_query_stats(counter);  in counter_history_stat_update()
236 	for (i = 0; i < counter->stats->num_counters; i++)  in counter_history_stat_update()
237 		port_counter->hstats->value[i] += counter->stats->value[i];  in counter_history_stat_update()
241  * rdma_get_counter_auto_mode - Find the counter that @qp should be bound
244  * Return: The counter (with ref-count increased) if found
250 	struct rdma_counter *counter = NULL;  in rdma_get_counter_auto_mode()  local
251 	struct ib_device *dev = qp->device;  in rdma_get_counter_auto_mode()
254 	unsigned long id = 0;  in rdma_get_counter_auto_mode()
256 	port_counter = &dev->port_data[port].port_counter;  in rdma_get_counter_auto_mode()
257 	rt = &dev->res[RDMA_RESTRACK_COUNTER];  in rdma_get_counter_auto_mode()
258 	xa_lock(&rt->xa);  in rdma_get_counter_auto_mode()
259 	xa_for_each(&rt->xa, id, res) {  in rdma_get_counter_auto_mode()
260 		counter = container_of(res, struct rdma_counter, res);  in rdma_get_counter_auto_mode()
261 		if ((counter->device != qp->device) || (counter->port != port))  in rdma_get_counter_auto_mode()
264 		if (auto_mode_match(qp, counter, port_counter->mode.mask))  in rdma_get_counter_auto_mode()
267 		counter = NULL;  in rdma_get_counter_auto_mode()
270 	if (counter && !kref_get_unless_zero(&counter->kref))  in rdma_get_counter_auto_mode()
271 		counter = NULL;  in rdma_get_counter_auto_mode()
273 	xa_unlock(&rt->xa);  in rdma_get_counter_auto_mode()
274 	return counter;  in rdma_get_counter_auto_mode()
279 	struct rdma_counter *counter;  in counter_release()  local
281 	counter = container_of(kref, struct rdma_counter, kref);  in counter_release()
282 	counter_history_stat_update(counter);  in counter_release()
283 	counter->device->ops.counter_dealloc(counter);  in counter_release()
284 	rdma_counter_free(counter);  in counter_release()
288  * rdma_counter_bind_qp_auto - Check and bind the QP to a counter base on
289  *   the auto-mode rule
294 	struct ib_device *dev = qp->device;  in rdma_counter_bind_qp_auto()
295 	struct rdma_counter *counter;  in rdma_counter_bind_qp_auto()  local
298 	if (!rdma_restrack_is_tracked(&qp->res) || rdma_is_kernel_res(&qp->res))  in rdma_counter_bind_qp_auto()
299 		return 0;  in rdma_counter_bind_qp_auto()
302 		return -EINVAL;  in rdma_counter_bind_qp_auto()
304 	port_counter = &dev->port_data[port].port_counter;  in rdma_counter_bind_qp_auto()
305 	if (port_counter->mode.mode != RDMA_COUNTER_MODE_AUTO)  in rdma_counter_bind_qp_auto()
306 		return 0;  in rdma_counter_bind_qp_auto()
308 	counter = rdma_get_counter_auto_mode(qp, port);  in rdma_counter_bind_qp_auto()
309 	if (counter) {  in rdma_counter_bind_qp_auto()
310 		ret = __rdma_counter_bind_qp(counter, qp);  in rdma_counter_bind_qp_auto()
312 			kref_put(&counter->kref, counter_release);  in rdma_counter_bind_qp_auto()
316 		counter = alloc_and_bind(dev, port, qp, RDMA_COUNTER_MODE_AUTO);  in rdma_counter_bind_qp_auto()
317 		if (!counter)  in rdma_counter_bind_qp_auto()
318 			return -ENOMEM;  in rdma_counter_bind_qp_auto()
321 	return 0;  in rdma_counter_bind_qp_auto()
325  * rdma_counter_unbind_qp - Unbind a qp from a counter
327  *   true - Decrease the counter ref-count anyway (e.g., qp destroy)
331 	struct rdma_counter *counter = qp->counter;  in rdma_counter_unbind_qp()  local
334 	if (!counter)  in rdma_counter_unbind_qp()
335 		return -EINVAL;  in rdma_counter_unbind_qp()
341 	kref_put(&counter->kref, counter_release);  in rdma_counter_unbind_qp()
342 	return 0;  in rdma_counter_unbind_qp()
345 int rdma_counter_query_stats(struct rdma_counter *counter)  in rdma_counter_query_stats()  argument
347 	struct ib_device *dev = counter->device;  in rdma_counter_query_stats()
350 	if (!dev->ops.counter_update_stats)  in rdma_counter_query_stats()
351 		return -EINVAL;  in rdma_counter_query_stats()
353 	mutex_lock(&counter->lock);  in rdma_counter_query_stats()
354 	ret = dev->ops.counter_update_stats(counter);  in rdma_counter_query_stats()
355 	mutex_unlock(&counter->lock);  in rdma_counter_query_stats()
365 	struct rdma_counter *counter;  in get_running_counters_hwstat_sum()  local
366 	unsigned long id = 0;  in get_running_counters_hwstat_sum()
367 	u64 sum = 0;  in get_running_counters_hwstat_sum()
369 	rt = &dev->res[RDMA_RESTRACK_COUNTER];  in get_running_counters_hwstat_sum()
370 	xa_lock(&rt->xa);  in get_running_counters_hwstat_sum()
371 	xa_for_each(&rt->xa, id, res) {  in get_running_counters_hwstat_sum()
375 		xa_unlock(&rt->xa);  in get_running_counters_hwstat_sum()
377 		counter = container_of(res, struct rdma_counter, res);  in get_running_counters_hwstat_sum()
378 		if ((counter->device != dev) || (counter->port != port) ||  in get_running_counters_hwstat_sum()
379 		    rdma_counter_query_stats(counter))  in get_running_counters_hwstat_sum()
382 		sum += counter->stats->value[index];  in get_running_counters_hwstat_sum()
385 		xa_lock(&rt->xa);  in get_running_counters_hwstat_sum()
389 	xa_unlock(&rt->xa);  in get_running_counters_hwstat_sum()
394  * rdma_counter_get_hwstat_value() - Get the sum value of all counters on a
402 	port_counter = &dev->port_data[port].port_counter;  in rdma_counter_get_hwstat_value()
403 	if (!port_counter->hstats)  in rdma_counter_get_hwstat_value()
404 		return 0;  in rdma_counter_get_hwstat_value()
407 	sum += port_counter->hstats->value[index];  in rdma_counter_get_hwstat_value()
422 	if (qp->qp_type == IB_QPT_RAW_PACKET && !capable(CAP_NET_RAW))  in rdma_counter_get_qp()
436 	struct rdma_counter *counter;  in rdma_get_counter_by_id()  local
442 	counter = container_of(res, struct rdma_counter, res);  in rdma_get_counter_by_id()
443 	kref_get(&counter->kref);  in rdma_get_counter_by_id()
446 	return counter;  in rdma_get_counter_by_id()
450  * rdma_counter_bind_qpn() - Bind QP @qp_num to counter @counter_id
456 	struct rdma_counter *counter;  in rdma_counter_bind_qpn()  local
460 	port_counter = &dev->port_data[port].port_counter;  in rdma_counter_bind_qpn()
461 	if (port_counter->mode.mode == RDMA_COUNTER_MODE_AUTO)  in rdma_counter_bind_qpn()
462 		return -EINVAL;  in rdma_counter_bind_qpn()
466 		return -ENOENT;  in rdma_counter_bind_qpn()
468 	counter = rdma_get_counter_by_id(dev, counter_id);  in rdma_counter_bind_qpn()
469 	if (!counter) {  in rdma_counter_bind_qpn()
470 		ret = -ENOENT;  in rdma_counter_bind_qpn()
474 	if (rdma_is_kernel_res(&counter->res) != rdma_is_kernel_res(&qp->res)) {  in rdma_counter_bind_qpn()
475 		ret = -EINVAL;  in rdma_counter_bind_qpn()
479 	if ((counter->device != qp->device) || (counter->port != qp->port)) {  in rdma_counter_bind_qpn()
480 		ret = -EINVAL;  in rdma_counter_bind_qpn()
484 	ret = __rdma_counter_bind_qp(counter, qp);  in rdma_counter_bind_qpn()
488 	rdma_restrack_put(&qp->res);  in rdma_counter_bind_qpn()
489 	return 0;  in rdma_counter_bind_qpn()
492 	kref_put(&counter->kref, counter_release);  in rdma_counter_bind_qpn()
494 	rdma_restrack_put(&qp->res);  in rdma_counter_bind_qpn()
499  * rdma_counter_bind_qpn_alloc() - Alloc a counter and bind QP @qp_num to it
500  *   The id of new counter is returned in @counter_id
506 	struct rdma_counter *counter;  in rdma_counter_bind_qpn_alloc()  local
511 		return -EINVAL;  in rdma_counter_bind_qpn_alloc()
513 	port_counter = &dev->port_data[port].port_counter;  in rdma_counter_bind_qpn_alloc()
514 	if (!port_counter->hstats)  in rdma_counter_bind_qpn_alloc()
515 		return -EOPNOTSUPP;  in rdma_counter_bind_qpn_alloc()
517 	if (port_counter->mode.mode == RDMA_COUNTER_MODE_AUTO)  in rdma_counter_bind_qpn_alloc()
518 		return -EINVAL;  in rdma_counter_bind_qpn_alloc()
522 		return -ENOENT;  in rdma_counter_bind_qpn_alloc()
524 	if (rdma_is_port_valid(dev, qp->port) && (qp->port != port)) {  in rdma_counter_bind_qpn_alloc()
525 		ret = -EINVAL;  in rdma_counter_bind_qpn_alloc()
529 	counter = alloc_and_bind(dev, port, qp, RDMA_COUNTER_MODE_MANUAL);  in rdma_counter_bind_qpn_alloc()
530 	if (!counter) {  in rdma_counter_bind_qpn_alloc()
531 		ret = -ENOMEM;  in rdma_counter_bind_qpn_alloc()
536 		*counter_id = counter->id;  in rdma_counter_bind_qpn_alloc()
538 	rdma_restrack_put(&qp->res);  in rdma_counter_bind_qpn_alloc()
539 	return 0;  in rdma_counter_bind_qpn_alloc()
542 	rdma_restrack_put(&qp->res);  in rdma_counter_bind_qpn_alloc()
547  * rdma_counter_unbind_qpn() - Unbind QP @qp_num from a counter
557 		return -EINVAL;  in rdma_counter_unbind_qpn()
561 		return -ENOENT;  in rdma_counter_unbind_qpn()
563 	if (rdma_is_port_valid(dev, qp->port) && (qp->port != port)) {  in rdma_counter_unbind_qpn()
564 		ret = -EINVAL;  in rdma_counter_unbind_qpn()
568 	port_counter = &dev->port_data[port].port_counter;  in rdma_counter_unbind_qpn()
569 	if (!qp->counter || qp->counter->id != counter_id ||  in rdma_counter_unbind_qpn()
570 	    port_counter->mode.mode != RDMA_COUNTER_MODE_MANUAL) {  in rdma_counter_unbind_qpn()
571 		ret = -EINVAL;  in rdma_counter_unbind_qpn()
578 	rdma_restrack_put(&qp->res);  in rdma_counter_unbind_qpn()
588 	port_counter = &dev->port_data[port].port_counter;  in rdma_counter_get_mode()
589 	*mode = port_counter->mode.mode;  in rdma_counter_get_mode()
590 	*mask = port_counter->mode.mask;  in rdma_counter_get_mode()
592 	return 0;  in rdma_counter_get_mode()
600 	if (!dev->port_data)  in rdma_counter_init()
604 		port_counter = &dev->port_data[port].port_counter;  in rdma_counter_init()
605 		port_counter->mode.mode = RDMA_COUNTER_MODE_NONE;  in rdma_counter_init()
606 		mutex_init(&port_counter->lock);  in rdma_counter_init()
608 		if (!dev->ops.alloc_hw_port_stats)  in rdma_counter_init()
611 		port_counter->hstats = dev->ops.alloc_hw_port_stats(dev, port);  in rdma_counter_init()
612 		if (!port_counter->hstats)  in rdma_counter_init()
619 	for (i = port; i >= rdma_start_port(dev); i--) {  in rdma_counter_init()
620 		port_counter = &dev->port_data[port].port_counter;  in rdma_counter_init()
621 		kfree(port_counter->hstats);  in rdma_counter_init()
622 		port_counter->hstats = NULL;  in rdma_counter_init()
623 		mutex_destroy(&port_counter->lock);  in rdma_counter_init()
633 		port_counter = &dev->port_data[port].port_counter;  in rdma_counter_release()
634 		kfree(port_counter->hstats);  in rdma_counter_release()
635 		mutex_destroy(&port_counter->lock);  in rdma_counter_release()