mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
169 lines
6.1 KiB
169 lines
6.1 KiB
/* |
|
* Copyright 2008 - 2015 Freescale Semiconductor Inc. |
|
* |
|
* 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. |
|
* * Neither the name of Freescale Semiconductor nor the |
|
* names of its contributors may be used to endorse or promote products |
|
* derived from this software without specific prior written permission. |
|
* |
|
* |
|
* ALTERNATIVELY, this software may be distributed under the terms of the |
|
* GNU General Public License ("GPL") as published by the Free Software |
|
* Foundation, either version 2 of that License or (at your option) any |
|
* later version. |
|
* |
|
* THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY |
|
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
|
* DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY |
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND |
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
|
*/ |
|
|
|
#include "fman_sp.h" |
|
#include "fman.h" |
|
|
|
void fman_sp_set_buf_pools_in_asc_order_of_buf_sizes(struct fman_ext_pools |
|
*fm_ext_pools, |
|
u8 *ordered_array, |
|
u16 *sizes_array) |
|
{ |
|
u16 buf_size = 0; |
|
int i = 0, j = 0, k = 0; |
|
|
|
/* First we copy the external buffers pools information |
|
* to an ordered local array |
|
*/ |
|
for (i = 0; i < fm_ext_pools->num_of_pools_used; i++) { |
|
/* get pool size */ |
|
buf_size = fm_ext_pools->ext_buf_pool[i].size; |
|
|
|
/* keep sizes in an array according to poolId |
|
* for direct access |
|
*/ |
|
sizes_array[fm_ext_pools->ext_buf_pool[i].id] = buf_size; |
|
|
|
/* save poolId in an ordered array according to size */ |
|
for (j = 0; j <= i; j++) { |
|
/* this is the next free place in the array */ |
|
if (j == i) |
|
ordered_array[i] = |
|
fm_ext_pools->ext_buf_pool[i].id; |
|
else { |
|
/* find the right place for this poolId */ |
|
if (buf_size < sizes_array[ordered_array[j]]) { |
|
/* move the pool_ids one place ahead |
|
* to make room for this poolId |
|
*/ |
|
for (k = i; k > j; k--) |
|
ordered_array[k] = |
|
ordered_array[k - 1]; |
|
|
|
/* now k==j, this is the place for |
|
* the new size |
|
*/ |
|
ordered_array[k] = |
|
fm_ext_pools->ext_buf_pool[i].id; |
|
break; |
|
} |
|
} |
|
} |
|
} |
|
} |
|
EXPORT_SYMBOL(fman_sp_set_buf_pools_in_asc_order_of_buf_sizes); |
|
|
|
int fman_sp_build_buffer_struct(struct fman_sp_int_context_data_copy * |
|
int_context_data_copy, |
|
struct fman_buffer_prefix_content * |
|
buffer_prefix_content, |
|
struct fman_sp_buf_margins *buf_margins, |
|
struct fman_sp_buffer_offsets *buffer_offsets, |
|
u8 *internal_buf_offset) |
|
{ |
|
u32 tmp; |
|
|
|
/* Align start of internal context data to 16 byte */ |
|
int_context_data_copy->ext_buf_offset = (u16) |
|
((buffer_prefix_content->priv_data_size & (OFFSET_UNITS - 1)) ? |
|
((buffer_prefix_content->priv_data_size + OFFSET_UNITS) & |
|
~(u16)(OFFSET_UNITS - 1)) : |
|
buffer_prefix_content->priv_data_size); |
|
|
|
/* Translate margin and int_context params to FM parameters */ |
|
/* Initialize with illegal value. Later we'll set legal values. */ |
|
buffer_offsets->prs_result_offset = (u32)ILLEGAL_BASE; |
|
buffer_offsets->time_stamp_offset = (u32)ILLEGAL_BASE; |
|
buffer_offsets->hash_result_offset = (u32)ILLEGAL_BASE; |
|
|
|
/* Internally the driver supports 4 options |
|
* 1. prsResult/timestamp/hashResult selection (in fact 8 options, |
|
* but for simplicity we'll |
|
* relate to it as 1). |
|
* 2. All IC context (from AD) not including debug. |
|
*/ |
|
|
|
/* This case covers the options under 1 */ |
|
/* Copy size must be in 16-byte granularity. */ |
|
int_context_data_copy->size = |
|
(u16)((buffer_prefix_content->pass_prs_result ? 32 : 0) + |
|
((buffer_prefix_content->pass_time_stamp || |
|
buffer_prefix_content->pass_hash_result) ? 16 : 0)); |
|
|
|
/* Align start of internal context data to 16 byte */ |
|
int_context_data_copy->int_context_offset = |
|
(u8)(buffer_prefix_content->pass_prs_result ? 32 : |
|
((buffer_prefix_content->pass_time_stamp || |
|
buffer_prefix_content->pass_hash_result) ? 64 : 0)); |
|
|
|
if (buffer_prefix_content->pass_prs_result) |
|
buffer_offsets->prs_result_offset = |
|
int_context_data_copy->ext_buf_offset; |
|
if (buffer_prefix_content->pass_time_stamp) |
|
buffer_offsets->time_stamp_offset = |
|
buffer_prefix_content->pass_prs_result ? |
|
(int_context_data_copy->ext_buf_offset + |
|
sizeof(struct fman_prs_result)) : |
|
int_context_data_copy->ext_buf_offset; |
|
if (buffer_prefix_content->pass_hash_result) |
|
/* If PR is not requested, whether TS is |
|
* requested or not, IC will be copied from TS |
|
*/ |
|
buffer_offsets->hash_result_offset = |
|
buffer_prefix_content->pass_prs_result ? |
|
(int_context_data_copy->ext_buf_offset + |
|
sizeof(struct fman_prs_result) + 8) : |
|
int_context_data_copy->ext_buf_offset + 8; |
|
|
|
if (int_context_data_copy->size) |
|
buf_margins->start_margins = |
|
(u16)(int_context_data_copy->ext_buf_offset + |
|
int_context_data_copy->size); |
|
else |
|
/* No Internal Context passing, STartMargin is |
|
* immediately after private_info |
|
*/ |
|
buf_margins->start_margins = |
|
buffer_prefix_content->priv_data_size; |
|
|
|
/* align data start */ |
|
tmp = (u32)(buf_margins->start_margins % |
|
buffer_prefix_content->data_align); |
|
if (tmp) |
|
buf_margins->start_margins += |
|
(buffer_prefix_content->data_align - tmp); |
|
buffer_offsets->data_offset = buf_margins->start_margins; |
|
|
|
return 0; |
|
} |
|
EXPORT_SYMBOL(fman_sp_build_buffer_struct); |
|
|
|
|