[linux-block.git] / drivers / infiniband / hw / hns / hns_roce_alloc.c

/*
 * Copyright (c) 2016 Hisilicon Limited.
 * Copyright (c) 2007, 2008 Mellanox Technologies. All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * OpenIB.org BSD license below:
 *
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
 *
 *      - Redistributions of source code must retain the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer.
 *
 *      - Redistributions in binary form must reproduce the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer in the documentation and/or other materials
 *        provided with the distribution.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */

#include <linux/platform_device.h>
#include <linux/vmalloc.h>
#include "hns_roce_device.h"
#include <rdma/ib_umem.h>

int hns_roce_bitmap_alloc(struct hns_roce_bitmap *bitmap, unsigned long *obj)
{
	int ret = 0;

	spin_lock(&bitmap->lock);
	*obj = find_next_zero_bit(bitmap->table, bitmap->max, bitmap->last);
	if (*obj >= bitmap->max) {
		bitmap->top = (bitmap->top + bitmap->max + bitmap->reserved_top)
			       & bitmap->mask;
		*obj = find_first_zero_bit(bitmap->table, bitmap->max);
	}

	if (*obj < bitmap->max) {
		set_bit(*obj, bitmap->table);
		bitmap->last = (*obj + 1);
		if (bitmap->last == bitmap->max)
			bitmap->last = 0;
		*obj |= bitmap->top;
	} else {
		ret = -EINVAL;
	}

	spin_unlock(&bitmap->lock);

	return ret;
}

void hns_roce_bitmap_free(struct hns_roce_bitmap *bitmap, unsigned long obj,
			  int rr)
{
	hns_roce_bitmap_free_range(bitmap, obj, 1, rr);
}

int hns_roce_bitmap_alloc_range(struct hns_roce_bitmap *bitmap, int cnt,
				int align, unsigned long *obj)
{
	int ret = 0;
	int i;

	if (likely(cnt == 1 && align == 1))
		return hns_roce_bitmap_alloc(bitmap, obj);

	spin_lock(&bitmap->lock);

	*obj = bitmap_find_next_zero_area(bitmap->table, bitmap->max,
					  bitmap->last, cnt, align - 1);
	if (*obj >= bitmap->max) {
		bitmap->top = (bitmap->top + bitmap->max + bitmap->reserved_top)
			       & bitmap->mask;
		*obj = bitmap_find_next_zero_area(bitmap->table, bitmap->max, 0,
						  cnt, align - 1);
	}

	if (*obj < bitmap->max) {
		for (i = 0; i < cnt; i++)
			set_bit(*obj + i, bitmap->table);

		if (*obj == bitmap->last) {
			bitmap->last = (*obj + cnt);
			if (bitmap->last >= bitmap->max)
				bitmap->last = 0;
		}
		*obj |= bitmap->top;
	} else {
		ret = -EINVAL;
	}

	spin_unlock(&bitmap->lock);

	return ret;
}

void hns_roce_bitmap_free_range(struct hns_roce_bitmap *bitmap,
				unsigned long obj, int cnt,
				int rr)
{
	int i;

	obj &= bitmap->max + bitmap->reserved_top - 1;

	spin_lock(&bitmap->lock);
	for (i = 0; i < cnt; i++)
		clear_bit(obj + i, bitmap->table);

	if (!rr)
		bitmap->last = min(bitmap->last, obj);
	bitmap->top = (bitmap->top + bitmap->max + bitmap->reserved_top)
		       & bitmap->mask;
	spin_unlock(&bitmap->lock);
}

int hns_roce_bitmap_init(struct hns_roce_bitmap *bitmap, u32 num, u32 mask,
			 u32 reserved_bot, u32 reserved_top)
{
	u32 i;

	if (num != roundup_pow_of_two(num))
		return -EINVAL;

	bitmap->last = 0;
	bitmap->top = 0;
	bitmap->max = num - reserved_top;
	bitmap->mask = mask;
	bitmap->reserved_top = reserved_top;
	spin_lock_init(&bitmap->lock);
	bitmap->table = kcalloc(BITS_TO_LONGS(bitmap->max), sizeof(long),
				GFP_KERNEL);
	if (!bitmap->table)
		return -ENOMEM;

	for (i = 0; i < reserved_bot; ++i)
		set_bit(i, bitmap->table);

	return 0;
}

void hns_roce_bitmap_cleanup(struct hns_roce_bitmap *bitmap)
{
	kfree(bitmap->table);
}

void hns_roce_buf_free(struct hns_roce_dev *hr_dev, struct hns_roce_buf *buf)
{
	struct device *dev = hr_dev->dev;
	u32 size = buf->size;
	int i;

	if (size == 0)
		return;

	buf->size = 0;

	if (hns_roce_buf_is_direct(buf)) {
		dma_free_coherent(dev, size, buf->direct.buf, buf->direct.map);
	} else {
		for (i = 0; i < buf->npages; ++i)
			if (buf->page_list[i].buf)
				dma_free_coherent(dev, 1 << buf->page_shift,
						  buf->page_list[i].buf,
						  buf->page_list[i].map);
		kfree(buf->page_list);
		buf->page_list = NULL;
	}
}

int hns_roce_buf_alloc(struct hns_roce_dev *hr_dev, u32 size, u32 max_direct,
		       struct hns_roce_buf *buf, u32 page_shift)
{
	struct hns_roce_buf_list *buf_list;
	struct device *dev = hr_dev->dev;
	u32 page_size;
	int i;

	/* The minimum shift of the page accessed by hw is HNS_HW_PAGE_SHIFT */
	buf->page_shift = max_t(int, HNS_HW_PAGE_SHIFT, page_shift);

	page_size = 1 << buf->page_shift;
	buf->npages = DIV_ROUND_UP(size, page_size);

	/* required size is not bigger than one trunk size */
	if (size <= max_direct) {
		buf->page_list = NULL;
		buf->direct.buf = dma_alloc_coherent(dev, size,
						     &buf->direct.map,
						     GFP_KERNEL);
		if (!buf->direct.buf)
			return -ENOMEM;
	} else {
		buf_list = kcalloc(buf->npages, sizeof(*buf_list), GFP_KERNEL);
		if (!buf_list)
			return -ENOMEM;

		for (i = 0; i < buf->npages; i++) {
			buf_list[i].buf = dma_alloc_coherent(dev, page_size,
							     &buf_list[i].map,
							     GFP_KERNEL);
			if (!buf_list[i].buf)
				break;
		}

		if (i != buf->npages && i > 0) {
			while (i-- > 0)
				dma_free_coherent(dev, page_size,
						  buf_list[i].buf,
						  buf_list[i].map);
			kfree(buf_list);
			return -ENOMEM;
		}
		buf->page_list = buf_list;
	}
	buf->size = size;

	return 0;
}

int hns_roce_get_kmem_bufs(struct hns_roce_dev *hr_dev, dma_addr_t *bufs,
			   int buf_cnt, int start, struct hns_roce_buf *buf)
{
	int i, end;
	int total;

	end = start + buf_cnt;
	if (end > buf->npages) {
		dev_err(hr_dev->dev,
			"Failed to check kmem bufs, end %d + %d total %d!\n",
			start, buf_cnt, buf->npages);
		return -EINVAL;
	}

	total = 0;
	for (i = start; i < end; i++)
		bufs[total++] = hns_roce_buf_page(buf, i);

	return total;
}

int hns_roce_get_umem_bufs(struct hns_roce_dev *hr_dev, dma_addr_t *bufs,
			   int buf_cnt, int start, struct ib_umem *umem,
			   unsigned int page_shift)
{
	struct ib_block_iter biter;
	int total = 0;
	int idx = 0;
	u64 addr;

	if (page_shift < HNS_HW_PAGE_SHIFT) {
		dev_err(hr_dev->dev, "Failed to check umem page shift %d!\n",
			page_shift);
		return -EINVAL;
	}

	/* convert system page cnt to hw page cnt */
	rdma_for_each_block(umem->sg_head.sgl, &biter, umem->nmap,
			    1 << page_shift) {
		addr = rdma_block_iter_dma_address(&biter);
		if (idx >= start) {
			bufs[total++] = addr;
			if (total >= buf_cnt)
				goto done;
		}
		idx++;
	}

done:
	return total;
}

void hns_roce_cleanup_bitmap(struct hns_roce_dev *hr_dev)
{
	if (hr_dev->caps.flags & HNS_ROCE_CAP_FLAG_SRQ)
		hns_roce_cleanup_srq_table(hr_dev);
	hns_roce_cleanup_qp_table(hr_dev);
	hns_roce_cleanup_cq_table(hr_dev);
	hns_roce_cleanup_mr_table(hr_dev);
	hns_roce_cleanup_pd_table(hr_dev);
	hns_roce_cleanup_uar_table(hr_dev);
}
Commit	Line	Data
9a443537	1	/*
	2	* Copyright (c) 2016 Hisilicon Limited.
	3	* Copyright (c) 2007, 2008 Mellanox Technologies. All rights reserved.
	4	*
	5	* This software is available to you under a choice of one of two
	6	* licenses. You may choose to be licensed under the terms of the GNU
	7	* General Public License (GPL) Version 2, available from the file
	8	* COPYING in the main directory of this source tree, or the
	9	* OpenIB.org BSD license below:
	10	*
	11	* Redistribution and use in source and binary forms, with or
	12	* without modification, are permitted provided that the following
	13	* conditions are met:
	14	*
	15	* - Redistributions of source code must retain the above
	16	* copyright notice, this list of conditions and the following
	17	* disclaimer.
	18	*
	19	* - Redistributions in binary form must reproduce the above
	20	* copyright notice, this list of conditions and the following
	21	* disclaimer in the documentation and/or other materials
	22	* provided with the distribution.
	23	*
	24	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	25	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	26	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
	27	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
	28	* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
	29	* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
	30	* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	31	* SOFTWARE.
	32	*/
	33
	34	#include <linux/platform_device.h>
e89bf462	35	#include <linux/vmalloc.h>
9a443537	36	#include "hns_roce_device.h"
2ac0bc5e	37	#include <rdma/ib_umem.h>
9a443537	38
	39	int hns_roce_bitmap_alloc(struct hns_roce_bitmap bitmap, unsigned long obj)
	40	{
	41	int ret = 0;
	42
	43	spin_lock(&bitmap->lock);
	44	*obj = find_next_zero_bit(bitmap->table, bitmap->max, bitmap->last);
	45	if (*obj >= bitmap->max) {
	46	bitmap->top = (bitmap->top + bitmap->max + bitmap->reserved_top)
	47	& bitmap->mask;
	48	*obj = find_first_zero_bit(bitmap->table, bitmap->max);
	49	}
	50
	51	if (*obj < bitmap->max) {
	52	set_bit(*obj, bitmap->table);
	53	bitmap->last = (*obj + 1);
	54	if (bitmap->last == bitmap->max)
	55	bitmap->last = 0;
	56	*obj \|= bitmap->top;
	57	} else {
1ceb0b11	58	ret = -EINVAL;
9a443537	59	}
	60
	61	spin_unlock(&bitmap->lock);
	62
	63	return ret;
	64	}
	65
5e6ff78a WHX	66	void hns_roce_bitmap_free(struct hns_roce_bitmap *bitmap, unsigned long obj,
5e6ff78a WHX	67	int rr)
9a443537	68	{
5e6ff78a	69	hns_roce_bitmap_free_range(bitmap, obj, 1, rr);
9a443537	70	}
	71
	72	int hns_roce_bitmap_alloc_range(struct hns_roce_bitmap *bitmap, int cnt,
	73	int align, unsigned long *obj)
	74	{
	75	int ret = 0;
	76	int i;
	77
	78	if (likely(cnt == 1 && align == 1))
	79	return hns_roce_bitmap_alloc(bitmap, obj);
	80
	81	spin_lock(&bitmap->lock);
	82
	83	*obj = bitmap_find_next_zero_area(bitmap->table, bitmap->max,
	84	bitmap->last, cnt, align - 1);
	85	if (*obj >= bitmap->max) {
	86	bitmap->top = (bitmap->top + bitmap->max + bitmap->reserved_top)
	87	& bitmap->mask;
	88	*obj = bitmap_find_next_zero_area(bitmap->table, bitmap->max, 0,
	89	cnt, align - 1);
	90	}
	91
	92	if (*obj < bitmap->max) {
	93	for (i = 0; i < cnt; i++)
	94	set_bit(*obj + i, bitmap->table);
	95
	96	if (*obj == bitmap->last) {
	97	bitmap->last = (*obj + cnt);
	98	if (bitmap->last >= bitmap->max)
	99	bitmap->last = 0;
	100	}
	101	*obj \|= bitmap->top;
	102	} else {
1ceb0b11	103	ret = -EINVAL;
9a443537	104	}
	105
	106	spin_unlock(&bitmap->lock);
	107
	108	return ret;
	109	}
	110
	111	void hns_roce_bitmap_free_range(struct hns_roce_bitmap *bitmap,
5e6ff78a WHX	112	unsigned long obj, int cnt,
5e6ff78a WHX	113	int rr)
9a443537	114	{
	115	int i;
	116
	117	obj &= bitmap->max + bitmap->reserved_top - 1;
	118
	119	spin_lock(&bitmap->lock);
	120	for (i = 0; i < cnt; i++)
	121	clear_bit(obj + i, bitmap->table);
	122
5e6ff78a WHX	123	if (!rr)
5e6ff78a WHX	124	bitmap->last = min(bitmap->last, obj);
9a443537	125	bitmap->top = (bitmap->top + bitmap->max + bitmap->reserved_top)
	126	& bitmap->mask;
	127	spin_unlock(&bitmap->lock);
	128	}
	129
	130	int hns_roce_bitmap_init(struct hns_roce_bitmap *bitmap, u32 num, u32 mask,
	131	u32 reserved_bot, u32 reserved_top)
	132	{
	133	u32 i;
	134
	135	if (num != roundup_pow_of_two(num))
	136	return -EINVAL;
	137
	138	bitmap->last = 0;
	139	bitmap->top = 0;
	140	bitmap->max = num - reserved_top;
	141	bitmap->mask = mask;
	142	bitmap->reserved_top = reserved_top;
	143	spin_lock_init(&bitmap->lock);
	144	bitmap->table = kcalloc(BITS_TO_LONGS(bitmap->max), sizeof(long),
	145	GFP_KERNEL);
	146	if (!bitmap->table)
	147	return -ENOMEM;
	148
	149	for (i = 0; i < reserved_bot; ++i)
	150	set_bit(i, bitmap->table);
	151
	152	return 0;
	153	}
	154
	155	void hns_roce_bitmap_cleanup(struct hns_roce_bitmap *bitmap)
	156	{
	157	kfree(bitmap->table);
	158	}
	159
cc23267a	160	void hns_roce_buf_free(struct hns_roce_dev hr_dev, struct hns_roce_buf buf)
9a443537	161	{
13ca970e	162	struct device *dev = hr_dev->dev;
cc23267a XW	163	u32 size = buf->size;
	164	int i;
	165
	166	if (size == 0)
	167	return;
	168
	169	buf->size = 0;
9a443537	170
cc23267a	171	if (hns_roce_buf_is_direct(buf)) {
9a443537	172	dma_free_coherent(dev, size, buf->direct.buf, buf->direct.map);
9a443537	173	} else {
cc23267a	174	for (i = 0; i < buf->npages; ++i)
9a443537	175	if (buf->page_list[i].buf)
9a8982dc	176	dma_free_coherent(dev, 1 << buf->page_shift,
9a443537	177	buf->page_list[i].buf,
	178	buf->page_list[i].map);
	179	kfree(buf->page_list);
cc23267a	180	buf->page_list = NULL;
9a443537	181	}
	182	}
	183
	184	int hns_roce_buf_alloc(struct hns_roce_dev *hr_dev, u32 size, u32 max_direct,
9a8982dc	185	struct hns_roce_buf *buf, u32 page_shift)
9a443537	186	{
cc23267a	187	struct hns_roce_buf_list *buf_list;
13ca970e	188	struct device *dev = hr_dev->dev;
cc23267a XW	189	u32 page_size;
	190	int i;
	191
9581a356 XW	192	/* The minimum shift of the page accessed by hw is HNS_HW_PAGE_SHIFT */
9581a356 XW	193	buf->page_shift = max_t(int, HNS_HW_PAGE_SHIFT, page_shift);
9a443537	194
cc23267a XW	195	page_size = 1 << buf->page_shift;
	196	buf->npages = DIV_ROUND_UP(size, page_size);
	197
	198	/* required size is not bigger than one trunk size */
9a443537	199	if (size <= max_direct) {
cc23267a XW	200	buf->page_list = NULL;
	201	buf->direct.buf = dma_alloc_coherent(dev, size,
	202	&buf->direct.map,
750afb08	203	GFP_KERNEL);
9a443537	204	if (!buf->direct.buf)
9a443537	205	return -ENOMEM;
9a443537	206	} else {
cc23267a XW	207	buf_list = kcalloc(buf->npages, sizeof(*buf_list), GFP_KERNEL);
cc23267a XW	208	if (!buf_list)
9a443537	209	return -ENOMEM;
9a443537	210
cc23267a XW	211	for (i = 0; i < buf->npages; i++) {
	212	buf_list[i].buf = dma_alloc_coherent(dev, page_size,
	213	&buf_list[i].map,
	214	GFP_KERNEL);
	215	if (!buf_list[i].buf)
	216	break;
	217	}
9a443537	218
cc23267a XW	219	if (i != buf->npages && i > 0) {
	220	while (i-- > 0)
	221	dma_free_coherent(dev, page_size,
	222	buf_list[i].buf,
	223	buf_list[i].map);
	224	kfree(buf_list);
	225	return -ENOMEM;
9a443537	226	}
cc23267a	227	buf->page_list = buf_list;
9a443537	228	}
cc23267a	229	buf->size = size;
9a443537	230
9a443537	231	return 0;
9a443537	232	}
9a443537	233
2ac0bc5e LO	234	int hns_roce_get_kmem_bufs(struct hns_roce_dev hr_dev, dma_addr_t bufs,
	235	int buf_cnt, int start, struct hns_roce_buf *buf)
	236	{
	237	int i, end;
	238	int total;
	239
	240	end = start + buf_cnt;
	241	if (end > buf->npages) {
	242	dev_err(hr_dev->dev,
cc23267a	243	"Failed to check kmem bufs, end %d + %d total %d!\n",
2ac0bc5e LO	244	start, buf_cnt, buf->npages);
	245	return -EINVAL;
	246	}
	247
	248	total = 0;
	249	for (i = start; i < end; i++)
cc23267a	250	bufs[total++] = hns_roce_buf_page(buf, i);
2ac0bc5e LO	251
	252	return total;
	253	}
	254
	255	int hns_roce_get_umem_bufs(struct hns_roce_dev hr_dev, dma_addr_t bufs,
	256	int buf_cnt, int start, struct ib_umem *umem,
82d07a4e	257	unsigned int page_shift)
2ac0bc5e LO	258	{
	259	struct ib_block_iter biter;
	260	int total = 0;
	261	int idx = 0;
	262	u64 addr;
	263
9581a356	264	if (page_shift < HNS_HW_PAGE_SHIFT) {
cc23267a XW	265	dev_err(hr_dev->dev, "Failed to check umem page shift %d!\n",
cc23267a XW	266	page_shift);
2ac0bc5e LO	267	return -EINVAL;
	268	}
	269
	270	/* convert system page cnt to hw page cnt */
	271	rdma_for_each_block(umem->sg_head.sgl, &biter, umem->nmap,
	272	1 << page_shift) {
	273	addr = rdma_block_iter_dma_address(&biter);
	274	if (idx >= start) {
	275	bufs[total++] = addr;
	276	if (total >= buf_cnt)
	277	goto done;
	278	}
	279	idx++;
	280	}
	281
	282	done:
	283	return total;
	284	}
	285
9a443537	286	void hns_roce_cleanup_bitmap(struct hns_roce_dev *hr_dev)
9a443537	287	{
5c1f167a LO	288	if (hr_dev->caps.flags & HNS_ROCE_CAP_FLAG_SRQ)
5c1f167a LO	289	hns_roce_cleanup_srq_table(hr_dev);
9a443537	290	hns_roce_cleanup_qp_table(hr_dev);
	291	hns_roce_cleanup_cq_table(hr_dev);
	292	hns_roce_cleanup_mr_table(hr_dev);
	293	hns_roce_cleanup_pd_table(hr_dev);
	294	hns_roce_cleanup_uar_table(hr_dev);
	295	}