143 lines · c
1// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0-or-later2/*3 * Copyright 2008 - 2015 Freescale Semiconductor Inc.4 */5 6#include "fman_sp.h"7#include "fman.h"8 9void fman_sp_set_buf_pools_in_asc_order_of_buf_sizes(struct fman_ext_pools10 *fm_ext_pools,11 u8 *ordered_array,12 u16 *sizes_array)13{14 u16 buf_size = 0;15 int i = 0, j = 0, k = 0;16 17 /* First we copy the external buffers pools information18 * to an ordered local array19 */20 for (i = 0; i < fm_ext_pools->num_of_pools_used; i++) {21 /* get pool size */22 buf_size = fm_ext_pools->ext_buf_pool[i].size;23 24 /* keep sizes in an array according to poolId25 * for direct access26 */27 sizes_array[fm_ext_pools->ext_buf_pool[i].id] = buf_size;28 29 /* save poolId in an ordered array according to size */30 for (j = 0; j <= i; j++) {31 /* this is the next free place in the array */32 if (j == i)33 ordered_array[i] =34 fm_ext_pools->ext_buf_pool[i].id;35 else {36 /* find the right place for this poolId */37 if (buf_size < sizes_array[ordered_array[j]]) {38 /* move the pool_ids one place ahead39 * to make room for this poolId40 */41 for (k = i; k > j; k--)42 ordered_array[k] =43 ordered_array[k - 1];44 45 /* now k==j, this is the place for46 * the new size47 */48 ordered_array[k] =49 fm_ext_pools->ext_buf_pool[i].id;50 break;51 }52 }53 }54 }55}56EXPORT_SYMBOL(fman_sp_set_buf_pools_in_asc_order_of_buf_sizes);57 58int fman_sp_build_buffer_struct(struct fman_sp_int_context_data_copy *59 int_context_data_copy,60 struct fman_buffer_prefix_content *61 buffer_prefix_content,62 struct fman_sp_buf_margins *buf_margins,63 struct fman_sp_buffer_offsets *buffer_offsets,64 u8 *internal_buf_offset)65{66 u32 tmp;67 68 /* Align start of internal context data to 16 byte */69 int_context_data_copy->ext_buf_offset = (u16)70 ((buffer_prefix_content->priv_data_size & (OFFSET_UNITS - 1)) ?71 ((buffer_prefix_content->priv_data_size + OFFSET_UNITS) &72 ~(u16)(OFFSET_UNITS - 1)) :73 buffer_prefix_content->priv_data_size);74 75 /* Translate margin and int_context params to FM parameters */76 /* Initialize with illegal value. Later we'll set legal values. */77 buffer_offsets->prs_result_offset = (u32)ILLEGAL_BASE;78 buffer_offsets->time_stamp_offset = (u32)ILLEGAL_BASE;79 buffer_offsets->hash_result_offset = (u32)ILLEGAL_BASE;80 81 /* Internally the driver supports 4 options82 * 1. prsResult/timestamp/hashResult selection (in fact 8 options,83 * but for simplicity we'll84 * relate to it as 1).85 * 2. All IC context (from AD) not including debug.86 */87 88 /* This case covers the options under 1 */89 /* Copy size must be in 16-byte granularity. */90 int_context_data_copy->size =91 (u16)((buffer_prefix_content->pass_prs_result ? 32 : 0) +92 ((buffer_prefix_content->pass_time_stamp ||93 buffer_prefix_content->pass_hash_result) ? 16 : 0));94 95 /* Align start of internal context data to 16 byte */96 int_context_data_copy->int_context_offset =97 (u8)(buffer_prefix_content->pass_prs_result ? 32 :98 ((buffer_prefix_content->pass_time_stamp ||99 buffer_prefix_content->pass_hash_result) ? 64 : 0));100 101 if (buffer_prefix_content->pass_prs_result)102 buffer_offsets->prs_result_offset =103 int_context_data_copy->ext_buf_offset;104 if (buffer_prefix_content->pass_time_stamp)105 buffer_offsets->time_stamp_offset =106 buffer_prefix_content->pass_prs_result ?107 (int_context_data_copy->ext_buf_offset +108 sizeof(struct fman_prs_result)) :109 int_context_data_copy->ext_buf_offset;110 if (buffer_prefix_content->pass_hash_result)111 /* If PR is not requested, whether TS is112 * requested or not, IC will be copied from TS113 */114 buffer_offsets->hash_result_offset =115 buffer_prefix_content->pass_prs_result ?116 (int_context_data_copy->ext_buf_offset +117 sizeof(struct fman_prs_result) + 8) :118 int_context_data_copy->ext_buf_offset + 8;119 120 if (int_context_data_copy->size)121 buf_margins->start_margins =122 (u16)(int_context_data_copy->ext_buf_offset +123 int_context_data_copy->size);124 else125 /* No Internal Context passing, STartMargin is126 * immediately after private_info127 */128 buf_margins->start_margins =129 buffer_prefix_content->priv_data_size;130 131 /* align data start */132 tmp = (u32)(buf_margins->start_margins %133 buffer_prefix_content->data_align);134 if (tmp)135 buf_margins->start_margins +=136 (buffer_prefix_content->data_align - tmp);137 buffer_offsets->data_offset = buf_margins->start_margins;138 139 return 0;140}141EXPORT_SYMBOL(fman_sp_build_buffer_struct);142 143