[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);

	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 mlx5e_qp_set_frag_buf(struct mlx5_frag_buf *buf,
				  struct mlx5_wq_qp *qp)
{
	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 = 1 << get_order(rqb->size);

	sqb = &qp->sq.fbc.frag_buf;
	*sqb = *buf;
	sqb->size   = mlx5_wq_cyc_get_byte_size(&qp->rq);
	sqb->npages = 1 << get_order(sqb->size);
	sqb->frags += rqb->npages; /* first part is for the rq */
}

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)
{
	int err;

	mlx5_fill_fbc(MLX5_GET(qpc, qpc, log_rq_stride) + 4,
		      MLX5_GET(qpc, qpc, log_rq_size),
		      &wq->rq.fbc);
	mlx5_fill_fbc(ilog2(MLX5_SEND_WQE_BB),
		      MLX5_GET(qpc, qpc, log_sq_size),
		      &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;
	}

	mlx5e_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);
e586b3b0	88
311c7c71	89	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
e586b3b0	90	if (err) {
f299a02d	91	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
e586b3b0 AV	92	return err;
	93	}
	94
3a2f7033 TT	95	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_cyc_get_byte_size(wq),
3a2f7033 TT	96	&wq_ctrl->buf, param->buf_numa_node);
e586b3b0	97	if (err) {
3a2f7033	98	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
e586b3b0 AV	99	goto err_db_free;
	100	}
	101
3a2f7033	102	fbc->frag_buf = wq_ctrl->buf;
e586b3b0 AV	103	wq->db = wq_ctrl->db.db;
	104
	105	wq_ctrl->mdev = mdev;
	106
	107	return 0;
	108
	109	err_db_free:
	110	mlx5_db_free(mdev, &wq_ctrl->db);
	111
	112	return err;
	113	}
	114
3a2f7033 TT	115	static void mlx5e_qp_set_frag_buf(struct mlx5_frag_buf *buf,
	116	struct mlx5_wq_qp *qp)
	117	{
	118	struct mlx5_frag_buf rqb, sqb;
	119
	120	rqb = &qp->rq.fbc.frag_buf;
	121	rqb = buf;
	122	rqb->size = mlx5_wq_cyc_get_byte_size(&qp->rq);
	123	rqb->npages = 1 << get_order(rqb->size);
	124
	125	sqb = &qp->sq.fbc.frag_buf;
	126	sqb = buf;
	127	sqb->size = mlx5_wq_cyc_get_byte_size(&qp->rq);
	128	sqb->npages = 1 << get_order(sqb->size);
	129	sqb->frags += rqb->npages; /* first part is for the rq */
	130	}
	131
3f2b7edd IT	132	int mlx5_wq_qp_create(struct mlx5_core_dev mdev, struct mlx5_wq_param param,
	133	void qpc, struct mlx5_wq_qp wq,
	134	struct mlx5_wq_ctrl *wq_ctrl)
	135	{
	136	int err;
	137
3a2f7033 TT	138	mlx5_fill_fbc(MLX5_GET(qpc, qpc, log_rq_stride) + 4,
	139	MLX5_GET(qpc, qpc, log_rq_size),
	140	&wq->rq.fbc);
	141	mlx5_fill_fbc(ilog2(MLX5_SEND_WQE_BB),
	142	MLX5_GET(qpc, qpc, log_sq_size),
	143	&wq->sq.fbc);
3f2b7edd IT	144
	145	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
	146	if (err) {
	147	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
	148	return err;
	149	}
	150
3a2f7033 TT	151	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_qp_get_byte_size(wq),
3a2f7033 TT	152	&wq_ctrl->buf, param->buf_numa_node);
3f2b7edd	153	if (err) {
3a2f7033	154	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
3f2b7edd IT	155	goto err_db_free;
	156	}
	157
3a2f7033 TT	158	mlx5e_qp_set_frag_buf(&wq_ctrl->buf, wq);
3a2f7033 TT	159
3f2b7edd IT	160	wq->rq.db = &wq_ctrl->db.db[MLX5_RCV_DBR];
	161	wq->sq.db = &wq_ctrl->db.db[MLX5_SND_DBR];
	162
	163	wq_ctrl->mdev = mdev;
	164
	165	return 0;
	166
	167	err_db_free:
	168	mlx5_db_free(mdev, &wq_ctrl->db);
	169
	170	return err;
	171	}
	172
e586b3b0 AV	173	int mlx5_cqwq_create(struct mlx5_core_dev mdev, struct mlx5_wq_param param,
e586b3b0 AV	174	void cqc, struct mlx5_cqwq wq,
3a2f7033	175	struct mlx5_wq_ctrl *wq_ctrl)
e586b3b0 AV	176	{
	177	int err;
	178
388ca8be	179	mlx5_core_init_cq_frag_buf(&wq->fbc, cqc);
e586b3b0	180
311c7c71	181	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
e586b3b0	182	if (err) {
f299a02d	183	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
e586b3b0 AV	184	return err;
	185	}
	186
1c1b5228	187	err = mlx5_frag_buf_alloc_node(mdev, mlx5_cqwq_get_byte_size(wq),
3a2f7033	188	&wq_ctrl->buf,
1c1b5228	189	param->buf_numa_node);
e586b3b0	190	if (err) {
1c1b5228 TT	191	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n",
1c1b5228 TT	192	err);
e586b3b0 AV	193	goto err_db_free;
	194	}
	195
3a2f7033	196	wq->fbc.frag_buf = wq_ctrl->buf;
e586b3b0 AV	197	wq->db = wq_ctrl->db.db;
	198
	199	wq_ctrl->mdev = mdev;
	200
	201	return 0;
	202
	203	err_db_free:
	204	mlx5_db_free(mdev, &wq_ctrl->db);
	205
	206	return err;
	207	}
	208
	209	int mlx5_wq_ll_create(struct mlx5_core_dev mdev, struct mlx5_wq_param param,
	210	void wqc, struct mlx5_wq_ll wq,
	211	struct mlx5_wq_ctrl *wq_ctrl)
	212	{
3a2f7033	213	struct mlx5_frag_buf_ctrl *fbc = &wq->fbc;
e586b3b0 AV	214	struct mlx5_wqe_srq_next_seg *next_seg;
	215	int err;
	216	int i;
	217
3a2f7033 TT	218	mlx5_fill_fbc(MLX5_GET(wq, wqc, log_wq_stride),
	219	MLX5_GET(wq, wqc, log_wq_sz),
	220	fbc);
e586b3b0	221
311c7c71	222	err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node);
e586b3b0	223	if (err) {
f299a02d	224	mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err);
e586b3b0 AV	225	return err;
	226	}
	227
3a2f7033 TT	228	err = mlx5_frag_buf_alloc_node(mdev, mlx5_wq_ll_get_byte_size(wq),
3a2f7033 TT	229	&wq_ctrl->buf, param->buf_numa_node);
e586b3b0	230	if (err) {
3a2f7033	231	mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err);
e586b3b0 AV	232	goto err_db_free;
	233	}
	234
3a2f7033	235	wq->fbc.frag_buf = wq_ctrl->buf;
e586b3b0 AV	236	wq->db = wq_ctrl->db.db;
e586b3b0 AV	237
3a2f7033	238	for (i = 0; i < fbc->sz_m1; i++) {
e586b3b0 AV	239	next_seg = mlx5_wq_ll_get_wqe(wq, i);
	240	next_seg->next_wqe_index = cpu_to_be16(i + 1);
	241	}
	242	next_seg = mlx5_wq_ll_get_wqe(wq, i);
	243	wq->tail_next = &next_seg->next_wqe_index;
	244
	245	wq_ctrl->mdev = mdev;
	246
	247	return 0;
	248
	249	err_db_free:
	250	mlx5_db_free(mdev, &wq_ctrl->db);
	251
	252	return err;
	253	}
	254
	255	void mlx5_wq_destroy(struct mlx5_wq_ctrl *wq_ctrl)
	256	{
3a2f7033	257	mlx5_frag_buf_free(wq_ctrl->mdev, &wq_ctrl->buf);
e586b3b0 AV	258	mlx5_db_free(wq_ctrl->mdev, &wq_ctrl->db);
e586b3b0 AV	259	}
1c1b5228	260