[mirror_ubuntu-bionic-kernel.git] / drivers / infiniband / hw / amso1100 / c2_alloc.c

/*
 * Copyright (c) 2004 Topspin Communications.  All rights reserved.
 * Copyright (c) 2005 Open Grid Computing, Inc. 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/errno.h>
#include <linux/slab.h>
#include <linux/bitmap.h>

#include "c2.h"

static int c2_alloc_mqsp_chunk(struct c2_dev *c2dev, gfp_t gfp_mask,
			       struct sp_chunk **head)
{
	int i;
	struct sp_chunk *new_head;
	dma_addr_t dma_addr;

	new_head = dma_alloc_coherent(&c2dev->pcidev->dev, PAGE_SIZE,
				      &dma_addr, gfp_mask);
	if (new_head == NULL)
		return -ENOMEM;

	new_head->dma_addr = dma_addr;
	pci_unmap_addr_set(new_head, mapping, new_head->dma_addr);

	new_head->next = NULL;
	new_head->head = 0;

	/* build list where each index is the next free slot */
	for (i = 0;
	     i < (PAGE_SIZE - sizeof(struct sp_chunk) -
		  sizeof(u16)) / sizeof(u16) - 1;
	     i++) {
		new_head->shared_ptr[i] = i + 1;
	}
	/* terminate list */
	new_head->shared_ptr[i] = 0xFFFF;

	*head = new_head;
	return 0;
}

int c2_init_mqsp_pool(struct c2_dev *c2dev, gfp_t gfp_mask,
		      struct sp_chunk **root)
{
	return c2_alloc_mqsp_chunk(c2dev, gfp_mask, root);
}

void c2_free_mqsp_pool(struct c2_dev *c2dev, struct sp_chunk *root)
{
	struct sp_chunk *next;

	while (root) {
		next = root->next;
		dma_free_coherent(&c2dev->pcidev->dev, PAGE_SIZE, root,
				  pci_unmap_addr(root, mapping));
		root = next;
	}
}

__be16 *c2_alloc_mqsp(struct c2_dev *c2dev, struct sp_chunk *head,
		      dma_addr_t *dma_addr, gfp_t gfp_mask)
{
	u16 mqsp;

	while (head) {
		mqsp = head->head;
		if (mqsp != 0xFFFF) {
			head->head = head->shared_ptr[mqsp];
			break;
		} else if (head->next == NULL) {
			if (c2_alloc_mqsp_chunk(c2dev, gfp_mask, &head->next) ==
			    0) {
				head = head->next;
				mqsp = head->head;
				head->head = head->shared_ptr[mqsp];
				break;
			} else
				return NULL;
		} else
			head = head->next;
	}
	if (head) {
		*dma_addr = head->dma_addr +
			    ((unsigned long) &(head->shared_ptr[mqsp]) -
			     (unsigned long) head);
		pr_debug("%s addr %p dma_addr %llx\n", __func__,
			 &(head->shared_ptr[mqsp]), (unsigned long long) *dma_addr);
		return (__force __be16 *) &(head->shared_ptr[mqsp]);
	}
	return NULL;
}

void c2_free_mqsp(__be16 *mqsp)
{
	struct sp_chunk *head;
	u16 idx;

	/* The chunk containing this ptr begins at the page boundary */
	head = (struct sp_chunk *) ((unsigned long) mqsp & PAGE_MASK);

	/* Link head to new mqsp */
	*mqsp = (__force __be16) head->head;

	/* Compute the shared_ptr index */
	idx = ((unsigned long) mqsp & ~PAGE_MASK) >> 1;
	idx -= (unsigned long) &(((struct sp_chunk *) 0)->shared_ptr[0]) >> 1;

	/* Point this index at the head */
	head->shared_ptr[idx] = head->head;

	/* Point head at this index */
	head->head = idx;
}
Commit	Line	Data
f94b533d TT	1	/*
	2	* Copyright (c) 2004 Topspin Communications. All rights reserved.
	3	* Copyright (c) 2005 Open Grid Computing, Inc. 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/errno.h>
	35	#include <linux/slab.h>
	36	#include <linux/bitmap.h>
	37
	38	#include "c2.h"
	39
	40	static int c2_alloc_mqsp_chunk(struct c2_dev *c2dev, gfp_t gfp_mask,
	41	struct sp_chunk **head)
	42	{
	43	int i;
	44	struct sp_chunk *new_head;
8de94ce1	45	dma_addr_t dma_addr;
f94b533d	46
8de94ce1 SW	47	new_head = dma_alloc_coherent(&c2dev->pcidev->dev, PAGE_SIZE,
8de94ce1 SW	48	&dma_addr, gfp_mask);
f94b533d TT	49	if (new_head == NULL)
	50	return -ENOMEM;
	51
8de94ce1	52	new_head->dma_addr = dma_addr;
f94b533d TT	53	pci_unmap_addr_set(new_head, mapping, new_head->dma_addr);
	54
	55	new_head->next = NULL;
	56	new_head->head = 0;
	57
	58	/* build list where each index is the next free slot */
	59	for (i = 0;
	60	i < (PAGE_SIZE - sizeof(struct sp_chunk) -
	61	sizeof(u16)) / sizeof(u16) - 1;
	62	i++) {
	63	new_head->shared_ptr[i] = i + 1;
	64	}
	65	/* terminate list */
	66	new_head->shared_ptr[i] = 0xFFFF;
	67
	68	*head = new_head;
	69	return 0;
	70	}
	71
	72	int c2_init_mqsp_pool(struct c2_dev *c2dev, gfp_t gfp_mask,
	73	struct sp_chunk **root)
	74	{
	75	return c2_alloc_mqsp_chunk(c2dev, gfp_mask, root);
	76	}
	77
	78	void c2_free_mqsp_pool(struct c2_dev c2dev, struct sp_chunk root)
	79	{
	80	struct sp_chunk *next;
	81
	82	while (root) {
	83	next = root->next;
8de94ce1 SW	84	dma_free_coherent(&c2dev->pcidev->dev, PAGE_SIZE, root,
8de94ce1 SW	85	pci_unmap_addr(root, mapping));
f94b533d TT	86	root = next;
	87	}
	88	}
	89
26c4fc26 RD	90	__be16 c2_alloc_mqsp(struct c2_dev c2dev, struct sp_chunk *head,
26c4fc26 RD	91	dma_addr_t *dma_addr, gfp_t gfp_mask)
f94b533d TT	92	{
	93	u16 mqsp;
	94
	95	while (head) {
	96	mqsp = head->head;
	97	if (mqsp != 0xFFFF) {
	98	head->head = head->shared_ptr[mqsp];
	99	break;
	100	} else if (head->next == NULL) {
	101	if (c2_alloc_mqsp_chunk(c2dev, gfp_mask, &head->next) ==
	102	0) {
	103	head = head->next;
	104	mqsp = head->head;
	105	head->head = head->shared_ptr[mqsp];
	106	break;
	107	} else
	108	return NULL;
	109	} else
	110	head = head->next;
	111	}
	112	if (head) {
	113	*dma_addr = head->dma_addr +
	114	((unsigned long) &(head->shared_ptr[mqsp]) -
	115	(unsigned long) head);
33718363	116	pr_debug("%s addr %p dma_addr %llx\n", __func__,
6edf6023	117	&(head->shared_ptr[mqsp]), (unsigned long long) *dma_addr);
26c4fc26	118	return (__force __be16 *) &(head->shared_ptr[mqsp]);
f94b533d TT	119	}
	120	return NULL;
	121	}
	122
26c4fc26	123	void c2_free_mqsp(__be16 *mqsp)
f94b533d TT	124	{
	125	struct sp_chunk *head;
	126	u16 idx;
	127
	128	/* The chunk containing this ptr begins at the page boundary */
	129	head = (struct sp_chunk *) ((unsigned long) mqsp & PAGE_MASK);
	130
	131	/* Link head to new mqsp */
26c4fc26	132	*mqsp = (__force __be16) head->head;
f94b533d TT	133
	134	/* Compute the shared_ptr index */
	135	idx = ((unsigned long) mqsp & ~PAGE_MASK) >> 1;
	136	idx -= (unsigned long) &(((struct sp_chunk *) 0)->shared_ptr[0]) >> 1;
	137
	138	/* Point this index at the head */
	139	head->shared_ptr[idx] = head->head;
	140
	141	/* Point head at this index */
	142	head->head = idx;
	143	}