[linux-2.6-block.git] / drivers / net / ethernet / mellanox / mlx5 / core / wq.c

/*
 * Copyright (c) 2013-2015, Mellanox Technologies, Ltd.  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/mlx5/driver.h>
#include "wq.h"
#include "mlx5_core.h"

u32 mlx5_wq_cyc_get_size(struct mlx5_wq_cyc *wq)
{
	return (u32)wq->fbc.sz_m1 + 1;
}

u32 mlx5_wq_cyc_get_frag_size(struct mlx5_wq_cyc *wq)
{
	return (u32)wq->fbc.frag_sz_m1 + 1;
}

u32 mlx5_cqwq_get_size(struct mlx5_cqwq *wq)
{
	return wq->fbc.sz_m1 + 1;
}

u32 mlx5_wq_ll_get_size(struct mlx5_wq_ll *wq)
{
	return (u32)wq->fbc.sz_m1 + 1;
}

static u32 mlx5_wq_cyc_get_byte_size(struct mlx5_wq_cyc *wq)
{
	return mlx5_wq_cyc_get_size(wq) << wq->fbc.log_stride;
}

static u32 mlx5_wq_qp_get_byte_size(struct mlx5_wq_qp *wq)
{
	return mlx5_wq_cyc_get_byte_size(&wq->rq) +
	       mlx5_wq_cyc_get_byte_size(&wq->sq);
}

static u32 mlx5_cqwq_get_byte_size(struct mlx5_cqwq *wq)
{
	return mlx5_cqwq_get_size(wq) << wq->fbc.log_stride;
}

static u32 mlx5_wq_ll_get_byte_size(struct mlx5_wq_ll *wq)
{
	return mlx5_wq_ll_get_size(wq) << wq->fbc.log_stride;
}

int mlx5_wq_cyc_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param,
		       void *wqc, struct mlx5_wq_cyc *wq,
		       struct mlx5_wq_ctrl *wq_ctrl)
{
	struct mlx5_frag_buf_ctrl *fbc = &wq->fbc;
	int err;

	mlx5_fill_fbc(MLX5_GET(wq, wqc, log_wq_stride),
		      MLX5_GET(wq, wqc, log_wq_sz),
		      fbc);
	wq->sz    = wq->fbc.sz_m1 + 1;

	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
		return err;
	}

	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_cyc_get_byte_size(wq),
				       &wq_ctrl->buf, param->buf_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
		goto err_db_free;
	}

	fbc->frag_buf = wq_ctrl->buf;
	wq->db  = wq_ctrl->db.db;

	wq_ctrl->mdev = mdev;

	return 0;

err_db_free:
	mlx5_db_free(mdev, &wq_ctrl->db);

	return err;
}

static void mlx5_qp_set_frag_buf(struct mlx5_frag_buf *buf,
				 struct mlx5_wq_qp *qp)
{
	struct mlx5_frag_buf_ctrl *sq_fbc;
	struct mlx5_frag_buf *rqb, *sqb;

	rqb  = &qp->rq.fbc.frag_buf;
	*rqb = *buf;
	rqb->size   = mlx5_wq_cyc_get_byte_size(&qp->rq);
	rqb->npages = DIV_ROUND_UP(rqb->size, PAGE_SIZE);

	sq_fbc = &qp->sq.fbc;
	sqb    = &sq_fbc->frag_buf;
	*sqb   = *buf;
	sqb->size   = mlx5_wq_cyc_get_byte_size(&qp->sq);
	sqb->npages = DIV_ROUND_UP(sqb->size, PAGE_SIZE);
	sqb->frags += rqb->npages; /* first part is for the rq */
	if (sq_fbc->strides_offset)
		sqb->frags--;
}

int mlx5_wq_qp_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param,
		      void *qpc, struct mlx5_wq_qp *wq,
		      struct mlx5_wq_ctrl *wq_ctrl)
{
	u32 sq_strides_offset;
	int err;

	mlx5_fill_fbc(MLX5_GET(qpc, qpc, log_rq_stride) + 4,
		      MLX5_GET(qpc, qpc, log_rq_size),
		      &wq->rq.fbc);

	sq_strides_offset =
		((wq->rq.fbc.frag_sz_m1 + 1) % PAGE_SIZE) / MLX5_SEND_WQE_BB;

	mlx5_fill_fbc_offset(ilog2(MLX5_SEND_WQE_BB),
			     MLX5_GET(qpc, qpc, log_sq_size),
			     sq_strides_offset,
			     &wq->sq.fbc);

	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
		return err;
	}

	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_qp_get_byte_size(wq),
				       &wq_ctrl->buf, param->buf_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
		goto err_db_free;
	}

	mlx5_qp_set_frag_buf(&wq_ctrl->buf, wq);

	wq->rq.db  = &wq_ctrl->db.db[MLX5_RCV_DBR];
	wq->sq.db  = &wq_ctrl->db.db[MLX5_SND_DBR];

	wq_ctrl->mdev = mdev;

	return 0;

err_db_free:
	mlx5_db_free(mdev, &wq_ctrl->db);

	return err;
}

int mlx5_cqwq_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param,
		     void *cqc, struct mlx5_cqwq *wq,
		     struct mlx5_wq_ctrl *wq_ctrl)
{
	int err;

	mlx5_core_init_cq_frag_buf(&wq->fbc, cqc);

	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
		return err;
	}

	err = mlx5_frag_buf_alloc_node(mdev, mlx5_cqwq_get_byte_size(wq),
				       &wq_ctrl->buf,
				       param->buf_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n",
			       err);
		goto err_db_free;
	}

	wq->fbc.frag_buf = wq_ctrl->buf;
	wq->db  = wq_ctrl->db.db;

	wq_ctrl->mdev = mdev;

	return 0;

err_db_free:
	mlx5_db_free(mdev, &wq_ctrl->db);

	return err;
}

int mlx5_wq_ll_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param,
		      void *wqc, struct mlx5_wq_ll *wq,
		      struct mlx5_wq_ctrl *wq_ctrl)
{
	struct mlx5_frag_buf_ctrl *fbc = &wq->fbc;
	struct mlx5_wqe_srq_next_seg *next_seg;
	int err;
	int i;

	mlx5_fill_fbc(MLX5_GET(wq, wqc, log_wq_stride),
		      MLX5_GET(wq, wqc, log_wq_sz),
		      fbc);

	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
		return err;
	}

	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_ll_get_byte_size(wq),
				       &wq_ctrl->buf, param->buf_numa_node);
	if (err) {
		mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
		goto err_db_free;
	}

	wq->fbc.frag_buf = wq_ctrl->buf;
	wq->db  = wq_ctrl->db.db;

	for (i = 0; i < fbc->sz_m1; i++) {
		next_seg = mlx5_wq_ll_get_wqe(wq, i);
		next_seg->next_wqe_index = cpu_to_be16(i + 1);
	}
	next_seg = mlx5_wq_ll_get_wqe(wq, i);
	wq->tail_next = &next_seg->next_wqe_index;

	wq_ctrl->mdev = mdev;

	return 0;

err_db_free:
	mlx5_db_free(mdev, &wq_ctrl->db);

	return err;
}

void mlx5_wq_destroy(struct mlx5_wq_ctrl *wq_ctrl)
{
	mlx5_frag_buf_free(wq_ctrl->mdev, &wq_ctrl->buf);
	mlx5_db_free(wq_ctrl->mdev, &wq_ctrl->db);
}
Commit	Line	Data
e586b3b0 AV	1	/*
	2	* Copyright (c) 2013-2015, Mellanox Technologies, Ltd. All rights reserved.
	3	*
	4	* This software is available to you under a choice of one of two
	5	* licenses. You may choose to be licensed under the terms of the GNU
	6	* General Public License (GPL) Version 2, available from the file
	7	* COPYING in the main directory of this source tree, or the
	8	* OpenIB.org BSD license below:
	9	*
	10	* Redistribution and use in source and binary forms, with or
	11	* without modification, are permitted provided that the following
	12	* conditions are met:
	13	*
	14	* - Redistributions of source code must retain the above
	15	* copyright notice, this list of conditions and the following
	16	* disclaimer.
	17	*
	18	* - Redistributions in binary form must reproduce the above
	19	* copyright notice, this list of conditions and the following
	20	* disclaimer in the documentation and/or other materials
	21	* provided with the distribution.
	22	*
	23	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	24	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	25	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
	26	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
	27	* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
	28	* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
	29	* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	30	* SOFTWARE.
	31	*/
	32
	33	#include <linux/mlx5/driver.h>
	34	#include "wq.h"
	35	#include "mlx5_core.h"
	36
	37	u32 mlx5_wq_cyc_get_size(struct mlx5_wq_cyc *wq)
	38	{
3a2f7033 TT	39	return (u32)wq->fbc.sz_m1 + 1;
	40	}
	41
	42	u32 mlx5_wq_cyc_get_frag_size(struct mlx5_wq_cyc *wq)
	43	{
	44	return (u32)wq->fbc.frag_sz_m1 + 1;
e586b3b0 AV	45	}
	46
	47	u32 mlx5_cqwq_get_size(struct mlx5_cqwq *wq)
	48	{
388ca8be	49	return wq->fbc.sz_m1 + 1;
e586b3b0 AV	50	}
	51
	52	u32 mlx5_wq_ll_get_size(struct mlx5_wq_ll *wq)
	53	{
3a2f7033	54	return (u32)wq->fbc.sz_m1 + 1;
e586b3b0 AV	55	}
	56
	57	static u32 mlx5_wq_cyc_get_byte_size(struct mlx5_wq_cyc *wq)
	58	{
3a2f7033	59	return mlx5_wq_cyc_get_size(wq) << wq->fbc.log_stride;
e586b3b0 AV	60	}
e586b3b0 AV	61
3f2b7edd IT	62	static u32 mlx5_wq_qp_get_byte_size(struct mlx5_wq_qp *wq)
	63	{
	64	return mlx5_wq_cyc_get_byte_size(&wq->rq) +
	65	mlx5_wq_cyc_get_byte_size(&wq->sq);
	66	}
	67
e586b3b0 AV	68	static u32 mlx5_cqwq_get_byte_size(struct mlx5_cqwq *wq)
e586b3b0 AV	69	{
388ca8be	70	return mlx5_cqwq_get_size(wq) << wq->fbc.log_stride;
e586b3b0 AV	71	}
	72
	73	static u32 mlx5_wq_ll_get_byte_size(struct mlx5_wq_ll *wq)
	74	{
3a2f7033	75	return mlx5_wq_ll_get_size(wq) << wq->fbc.log_stride;
e586b3b0 AV	76	}
	77
	78	int mlx5_wq_cyc_create(struct mlx5_core_dev mdev, struct mlx5_wq_param param,
	79	void wqc, struct mlx5_wq_cyc wq,
	80	struct mlx5_wq_ctrl *wq_ctrl)
	81	{
3a2f7033	82	struct mlx5_frag_buf_ctrl *fbc = &wq->fbc;
e586b3b0 AV	83	int err;
e586b3b0 AV	84
3a2f7033 TT	85	mlx5_fill_fbc(MLX5_GET(wq, wqc, log_wq_stride),
	86	MLX5_GET(wq, wqc, log_wq_sz),
	87	fbc);
99cbfa93	88	wq->sz = wq->fbc.sz_m1 + 1;
e586b3b0	89
311c7c71	90	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
e586b3b0	91	if (err) {
f299a02d	92	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
e586b3b0 AV	93	return err;
	94	}
	95
3a2f7033 TT	96	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_cyc_get_byte_size(wq),
3a2f7033 TT	97	&wq_ctrl->buf, param->buf_numa_node);
e586b3b0	98	if (err) {
3a2f7033	99	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
e586b3b0 AV	100	goto err_db_free;
	101	}
	102
3a2f7033	103	fbc->frag_buf = wq_ctrl->buf;
e586b3b0 AV	104	wq->db = wq_ctrl->db.db;
	105
	106	wq_ctrl->mdev = mdev;
	107
	108	return 0;
	109
	110	err_db_free:
	111	mlx5_db_free(mdev, &wq_ctrl->db);
	112
	113	return err;
	114	}
	115
d7037ad7 TT	116	static void mlx5_qp_set_frag_buf(struct mlx5_frag_buf *buf,
d7037ad7 TT	117	struct mlx5_wq_qp *qp)
3a2f7033	118	{
d7037ad7	119	struct mlx5_frag_buf_ctrl *sq_fbc;
3a2f7033 TT	120	struct mlx5_frag_buf rqb, sqb;
3a2f7033 TT	121
d7037ad7	122	rqb = &qp->rq.fbc.frag_buf;
3a2f7033 TT	123	rqb = buf;
3a2f7033 TT	124	rqb->size = mlx5_wq_cyc_get_byte_size(&qp->rq);
d7037ad7	125	rqb->npages = DIV_ROUND_UP(rqb->size, PAGE_SIZE);
3a2f7033	126
d7037ad7 TT	127	sq_fbc = &qp->sq.fbc;
	128	sqb = &sq_fbc->frag_buf;
	129	sqb = buf;
	130	sqb->size = mlx5_wq_cyc_get_byte_size(&qp->sq);
	131	sqb->npages = DIV_ROUND_UP(sqb->size, PAGE_SIZE);
3a2f7033	132	sqb->frags += rqb->npages; /* first part is for the rq */
d7037ad7 TT	133	if (sq_fbc->strides_offset)
d7037ad7 TT	134	sqb->frags--;
3a2f7033 TT	135	}
3a2f7033 TT	136
3f2b7edd IT	137	int mlx5_wq_qp_create(struct mlx5_core_dev mdev, struct mlx5_wq_param param,
	138	void qpc, struct mlx5_wq_qp wq,
	139	struct mlx5_wq_ctrl *wq_ctrl)
	140	{
d7037ad7	141	u32 sq_strides_offset;
3f2b7edd IT	142	int err;
3f2b7edd IT	143
3a2f7033 TT	144	mlx5_fill_fbc(MLX5_GET(qpc, qpc, log_rq_stride) + 4,
	145	MLX5_GET(qpc, qpc, log_rq_size),
	146	&wq->rq.fbc);
d7037ad7 TT	147
	148	sq_strides_offset =
	149	((wq->rq.fbc.frag_sz_m1 + 1) % PAGE_SIZE) / MLX5_SEND_WQE_BB;
	150
	151	mlx5_fill_fbc_offset(ilog2(MLX5_SEND_WQE_BB),
	152	MLX5_GET(qpc, qpc, log_sq_size),
	153	sq_strides_offset,
	154	&wq->sq.fbc);
3f2b7edd IT	155
	156	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
	157	if (err) {
	158	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
	159	return err;
	160	}
	161
3a2f7033 TT	162	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_qp_get_byte_size(wq),
3a2f7033 TT	163	&wq_ctrl->buf, param->buf_numa_node);
3f2b7edd	164	if (err) {
3a2f7033	165	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
3f2b7edd IT	166	goto err_db_free;
	167	}
	168
d7037ad7	169	mlx5_qp_set_frag_buf(&wq_ctrl->buf, wq);
3a2f7033	170
3f2b7edd IT	171	wq->rq.db = &wq_ctrl->db.db[MLX5_RCV_DBR];
	172	wq->sq.db = &wq_ctrl->db.db[MLX5_SND_DBR];
	173
	174	wq_ctrl->mdev = mdev;
	175
	176	return 0;
	177
	178	err_db_free:
	179	mlx5_db_free(mdev, &wq_ctrl->db);
	180
	181	return err;
	182	}
	183
e586b3b0 AV	184	int mlx5_cqwq_create(struct mlx5_core_dev mdev, struct mlx5_wq_param param,
e586b3b0 AV	185	void cqc, struct mlx5_cqwq wq,
3a2f7033	186	struct mlx5_wq_ctrl *wq_ctrl)
e586b3b0 AV	187	{
	188	int err;
	189
388ca8be	190	mlx5_core_init_cq_frag_buf(&wq->fbc, cqc);
e586b3b0	191
311c7c71	192	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
e586b3b0	193	if (err) {
f299a02d	194	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
e586b3b0 AV	195	return err;
	196	}
	197
1c1b5228	198	err = mlx5_frag_buf_alloc_node(mdev, mlx5_cqwq_get_byte_size(wq),
3a2f7033	199	&wq_ctrl->buf,
1c1b5228	200	param->buf_numa_node);
e586b3b0	201	if (err) {
1c1b5228 TT	202	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n",
1c1b5228 TT	203	err);
e586b3b0 AV	204	goto err_db_free;
	205	}
	206
3a2f7033	207	wq->fbc.frag_buf = wq_ctrl->buf;
e586b3b0 AV	208	wq->db = wq_ctrl->db.db;
	209
	210	wq_ctrl->mdev = mdev;
	211
	212	return 0;
	213
	214	err_db_free:
	215	mlx5_db_free(mdev, &wq_ctrl->db);
	216
	217	return err;
	218	}
	219
	220	int mlx5_wq_ll_create(struct mlx5_core_dev mdev, struct mlx5_wq_param param,
	221	void wqc, struct mlx5_wq_ll wq,
	222	struct mlx5_wq_ctrl *wq_ctrl)
	223	{
3a2f7033	224	struct mlx5_frag_buf_ctrl *fbc = &wq->fbc;
e586b3b0 AV	225	struct mlx5_wqe_srq_next_seg *next_seg;
	226	int err;
	227	int i;
	228
3a2f7033 TT	229	mlx5_fill_fbc(MLX5_GET(wq, wqc, log_wq_stride),
	230	MLX5_GET(wq, wqc, log_wq_sz),
	231	fbc);
e586b3b0	232
311c7c71	233	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
e586b3b0	234	if (err) {
f299a02d	235	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
e586b3b0 AV	236	return err;
	237	}
	238
3a2f7033 TT	239	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_ll_get_byte_size(wq),
3a2f7033 TT	240	&wq_ctrl->buf, param->buf_numa_node);
e586b3b0	241	if (err) {
3a2f7033	242	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
e586b3b0 AV	243	goto err_db_free;
	244	}
	245
3a2f7033	246	wq->fbc.frag_buf = wq_ctrl->buf;
e586b3b0 AV	247	wq->db = wq_ctrl->db.db;
e586b3b0 AV	248
3a2f7033	249	for (i = 0; i < fbc->sz_m1; i++) {
e586b3b0 AV	250	next_seg = mlx5_wq_ll_get_wqe(wq, i);
	251	next_seg->next_wqe_index = cpu_to_be16(i + 1);
	252	}
	253	next_seg = mlx5_wq_ll_get_wqe(wq, i);
	254	wq->tail_next = &next_seg->next_wqe_index;
	255
	256	wq_ctrl->mdev = mdev;
	257
	258	return 0;
	259
	260	err_db_free:
	261	mlx5_db_free(mdev, &wq_ctrl->db);
	262
	263	return err;
	264	}
	265
	266	void mlx5_wq_destroy(struct mlx5_wq_ctrl *wq_ctrl)
	267	{
3a2f7033	268	mlx5_frag_buf_free(wq_ctrl->mdev, &wq_ctrl->buf);
e586b3b0 AV	269	mlx5_db_free(wq_ctrl->mdev, &wq_ctrl->db);
e586b3b0 AV	270	}
1c1b5228	271