|
Packit |
13e616 |
/*
|
|
Packit |
13e616 |
* Copyright (c) 2004-2006 Voltaire, Inc. All rights reserved.
|
|
Packit |
13e616 |
* Copyright (c) 2002-2005 Mellanox Technologies LTD. All rights reserved.
|
|
Packit |
13e616 |
* Copyright (c) 1996-2003 Intel Corporation. All rights reserved.
|
|
Packit |
13e616 |
*
|
|
Packit |
13e616 |
* This software is available to you under a choice of one of two
|
|
Packit |
13e616 |
* licenses. You may choose to be licensed under the terms of the GNU
|
|
Packit |
13e616 |
* General Public License (GPL) Version 2, available from the file
|
|
Packit |
13e616 |
* COPYING in the main directory of this source tree, or the
|
|
Packit |
13e616 |
* OpenIB.org BSD license below:
|
|
Packit |
13e616 |
*
|
|
Packit |
13e616 |
* Redistribution and use in source and binary forms, with or
|
|
Packit |
13e616 |
* without modification, are permitted provided that the following
|
|
Packit |
13e616 |
* conditions are met:
|
|
Packit |
13e616 |
*
|
|
Packit |
13e616 |
* - Redistributions of source code must retain the above
|
|
Packit |
13e616 |
* copyright notice, this list of conditions and the following
|
|
Packit |
13e616 |
* disclaimer.
|
|
Packit |
13e616 |
*
|
|
Packit |
13e616 |
* - Redistributions in binary form must reproduce the above
|
|
Packit |
13e616 |
* copyright notice, this list of conditions and the following
|
|
Packit |
13e616 |
* disclaimer in the documentation and/or other materials
|
|
Packit |
13e616 |
* provided with the distribution.
|
|
Packit |
13e616 |
*
|
|
Packit |
13e616 |
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
Packit |
13e616 |
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
Packit |
13e616 |
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
Packit |
13e616 |
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
Packit |
13e616 |
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
Packit |
13e616 |
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
Packit |
13e616 |
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
Packit |
13e616 |
* SOFTWARE.
|
|
Packit |
13e616 |
*
|
|
Packit |
13e616 |
*/
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
#if HAVE_CONFIG_H
|
|
Packit |
13e616 |
# include <config.h>
|
|
Packit |
13e616 |
#endif /* HAVE_CONFIG_H */
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
#include <stdlib.h>
|
|
Packit |
13e616 |
#include <string.h>
|
|
Packit |
13e616 |
#include <stdio.h>
|
|
Packit |
13e616 |
#include <vendor/osm_vendor_mlx_sar.h>
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
ib_api_status_t
|
|
Packit |
13e616 |
osmv_rmpp_sar_init(osmv_rmpp_sar_t * p_sar, void *p_arbt_mad,
|
|
Packit |
13e616 |
uint32_t mad_size, boolean_t is_sa_mad)
|
|
Packit |
13e616 |
{
|
|
Packit |
13e616 |
CL_ASSERT(p_sar);
|
|
Packit |
13e616 |
p_sar->p_arbt_mad = p_arbt_mad;
|
|
Packit |
13e616 |
if (is_sa_mad) {
|
|
Packit |
13e616 |
p_sar->data_len = mad_size - IB_SA_MAD_HDR_SIZE;
|
|
Packit |
13e616 |
p_sar->hdr_sz = IB_SA_MAD_HDR_SIZE;
|
|
Packit |
13e616 |
p_sar->data_sz = IB_SA_DATA_SIZE;
|
|
Packit |
13e616 |
} else {
|
|
Packit |
13e616 |
p_sar->data_len = mad_size - MAD_RMPP_HDR_SIZE;
|
|
Packit |
13e616 |
p_sar->hdr_sz = MAD_RMPP_HDR_SIZE;
|
|
Packit |
13e616 |
p_sar->data_sz = MAD_RMPP_DATA_SIZE;
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
return IB_SUCCESS;
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
void osmv_rmpp_sar_done(osmv_rmpp_sar_t * p_sar)
|
|
Packit |
13e616 |
{
|
|
Packit |
13e616 |
p_sar->p_arbt_mad = NULL;
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
/* the big mad should be with mad header, rmpp header ( &sa hdr) space */
|
|
Packit |
13e616 |
ib_api_status_t
|
|
Packit |
13e616 |
osmv_rmpp_sar_get_mad_seg(IN osmv_rmpp_sar_t * p_sar,
|
|
Packit |
13e616 |
IN uint32_t seg_idx, OUT void *p_buf)
|
|
Packit |
13e616 |
{
|
|
Packit |
13e616 |
void *p_seg;
|
|
Packit |
13e616 |
uint32_t sz_left;
|
|
Packit |
13e616 |
uint32_t num_segs;
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
CL_ASSERT(p_sar);
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
num_segs = p_sar->data_len / p_sar->data_sz;
|
|
Packit |
13e616 |
if ((p_sar->data_len % p_sar->data_sz) > 0) {
|
|
Packit |
13e616 |
num_segs++;
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
if ((seg_idx > num_segs) && (seg_idx != 1)) {
|
|
Packit |
13e616 |
return IB_NOT_FOUND;
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
/* cleanup */
|
|
Packit |
13e616 |
memset(p_buf, 0, MAD_BLOCK_SIZE);
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
/* attach header */
|
|
Packit |
13e616 |
memcpy(p_buf, p_sar->p_arbt_mad, p_sar->hdr_sz);
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
/* fill data */
|
|
Packit |
13e616 |
p_seg =
|
|
Packit |
13e616 |
(char *)p_sar->p_arbt_mad + p_sar->hdr_sz +
|
|
Packit |
13e616 |
((seg_idx - 1) * p_sar->data_sz);
|
|
Packit |
13e616 |
sz_left = p_sar->data_len - ((seg_idx - 1) * p_sar->data_sz);
|
|
Packit |
13e616 |
if (sz_left > p_sar->data_sz)
|
|
Packit |
13e616 |
memcpy((char *)p_buf + p_sar->hdr_sz, (char *)p_seg,
|
|
Packit |
13e616 |
p_sar->data_sz);
|
|
Packit |
13e616 |
else
|
|
Packit |
13e616 |
memcpy((char *)p_buf + p_sar->hdr_sz, (char *)p_seg, sz_left);
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
return IB_SUCCESS;
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
/* turns a list of mads to one big mad - including header */
|
|
Packit |
13e616 |
/* ALSO - deallocates the list */
|
|
Packit |
13e616 |
ib_api_status_t
|
|
Packit |
13e616 |
osmv_rmpp_sar_reassemble_arbt_mad(osmv_rmpp_sar_t * p_sar, cl_qlist_t * p_bufs)
|
|
Packit |
13e616 |
{
|
|
Packit |
13e616 |
void *buf_tmp, *p_mad;
|
|
Packit |
13e616 |
cl_list_item_t *p_item;
|
|
Packit |
13e616 |
cl_list_obj_t *p_obj;
|
|
Packit |
13e616 |
uint32_t space_left = p_sar->data_len + p_sar->hdr_sz;
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
CL_ASSERT(p_sar);
|
|
Packit |
13e616 |
CL_ASSERT(FALSE == cl_is_qlist_empty(p_bufs));
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
/* attach header */
|
|
Packit |
13e616 |
p_mad = p_sar->p_arbt_mad;
|
|
Packit |
13e616 |
p_item = cl_qlist_head(p_bufs);
|
|
Packit |
13e616 |
p_obj = PARENT_STRUCT(p_item, cl_list_obj_t, list_item);
|
|
Packit |
13e616 |
buf_tmp = cl_qlist_obj(p_obj);
|
|
Packit |
13e616 |
memcpy(p_mad, buf_tmp, p_sar->hdr_sz);
|
|
Packit |
13e616 |
p_mad = (char *)p_mad + p_sar->hdr_sz;
|
|
Packit |
13e616 |
space_left -= p_sar->hdr_sz;
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
/* reassemble data */
|
|
Packit |
13e616 |
while (FALSE == cl_is_qlist_empty(p_bufs)) {
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
p_item = cl_qlist_remove_head(p_bufs);
|
|
Packit |
13e616 |
p_obj = PARENT_STRUCT(p_item, cl_list_obj_t, list_item);
|
|
Packit |
13e616 |
buf_tmp = cl_qlist_obj(p_obj);
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
if (FALSE == cl_is_qlist_empty(p_bufs)) {
|
|
Packit |
13e616 |
memcpy((char *)p_mad, (char *)buf_tmp + p_sar->hdr_sz,
|
|
Packit |
13e616 |
p_sar->data_sz);
|
|
Packit |
13e616 |
p_mad = (char *)p_mad + p_sar->data_sz;
|
|
Packit |
13e616 |
space_left -= p_sar->data_sz;
|
|
Packit |
13e616 |
} else {
|
|
Packit |
13e616 |
/* the last mad on the list */
|
|
Packit |
13e616 |
memcpy((char *)p_mad, (char *)buf_tmp + p_sar->hdr_sz,
|
|
Packit |
13e616 |
space_left);
|
|
Packit |
13e616 |
p_mad = (char *)p_mad + space_left;
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
free(buf_tmp);
|
|
Packit |
13e616 |
free(p_obj);
|
|
Packit |
13e616 |
}
|
|
Packit |
13e616 |
|
|
Packit |
13e616 |
return IB_SUCCESS;
|
|
Packit |
13e616 |
}
|