Loading...
1// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0-or-later
2/*
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_pools
10 *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 information
18 * to an ordered local array
19 */
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 poolId
25 * for direct access
26 */
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 ahead
39 * to make room for this poolId
40 */
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 for
46 * the new size
47 */
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 options
82 * 1. prsResult/timestamp/hashResult selection (in fact 8 options,
83 * but for simplicity we'll
84 * 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 is
112 * requested or not, IC will be copied from TS
113 */
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 else
125 /* No Internal Context passing, STartMargin is
126 * immediately after private_info
127 */
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
1/*
2 * Copyright 2008 - 2015 Freescale Semiconductor Inc.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above copyright
9 * notice, this list of conditions and the following disclaimer in the
10 * documentation and/or other materials provided with the distribution.
11 * * Neither the name of Freescale Semiconductor nor the
12 * names of its contributors may be used to endorse or promote products
13 * derived from this software without specific prior written permission.
14 *
15 *
16 * ALTERNATIVELY, this software may be distributed under the terms of the
17 * GNU General Public License ("GPL") as published by the Free Software
18 * Foundation, either version 2 of that License or (at your option) any
19 * later version.
20 *
21 * THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY
22 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
23 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
24 * DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY
25 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
28 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
30 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 */
32
33#include "fman_sp.h"
34#include "fman.h"
35
36void fman_sp_set_buf_pools_in_asc_order_of_buf_sizes(struct fman_ext_pools
37 *fm_ext_pools,
38 u8 *ordered_array,
39 u16 *sizes_array)
40{
41 u16 buf_size = 0;
42 int i = 0, j = 0, k = 0;
43
44 /* First we copy the external buffers pools information
45 * to an ordered local array
46 */
47 for (i = 0; i < fm_ext_pools->num_of_pools_used; i++) {
48 /* get pool size */
49 buf_size = fm_ext_pools->ext_buf_pool[i].size;
50
51 /* keep sizes in an array according to poolId
52 * for direct access
53 */
54 sizes_array[fm_ext_pools->ext_buf_pool[i].id] = buf_size;
55
56 /* save poolId in an ordered array according to size */
57 for (j = 0; j <= i; j++) {
58 /* this is the next free place in the array */
59 if (j == i)
60 ordered_array[i] =
61 fm_ext_pools->ext_buf_pool[i].id;
62 else {
63 /* find the right place for this poolId */
64 if (buf_size < sizes_array[ordered_array[j]]) {
65 /* move the pool_ids one place ahead
66 * to make room for this poolId
67 */
68 for (k = i; k > j; k--)
69 ordered_array[k] =
70 ordered_array[k - 1];
71
72 /* now k==j, this is the place for
73 * the new size
74 */
75 ordered_array[k] =
76 fm_ext_pools->ext_buf_pool[i].id;
77 break;
78 }
79 }
80 }
81 }
82}
83EXPORT_SYMBOL(fman_sp_set_buf_pools_in_asc_order_of_buf_sizes);
84
85int fman_sp_build_buffer_struct(struct fman_sp_int_context_data_copy *
86 int_context_data_copy,
87 struct fman_buffer_prefix_content *
88 buffer_prefix_content,
89 struct fman_sp_buf_margins *buf_margins,
90 struct fman_sp_buffer_offsets *buffer_offsets,
91 u8 *internal_buf_offset)
92{
93 u32 tmp;
94
95 /* Align start of internal context data to 16 byte */
96 int_context_data_copy->ext_buf_offset = (u16)
97 ((buffer_prefix_content->priv_data_size & (OFFSET_UNITS - 1)) ?
98 ((buffer_prefix_content->priv_data_size + OFFSET_UNITS) &
99 ~(u16)(OFFSET_UNITS - 1)) :
100 buffer_prefix_content->priv_data_size);
101
102 /* Translate margin and int_context params to FM parameters */
103 /* Initialize with illegal value. Later we'll set legal values. */
104 buffer_offsets->prs_result_offset = (u32)ILLEGAL_BASE;
105 buffer_offsets->time_stamp_offset = (u32)ILLEGAL_BASE;
106 buffer_offsets->hash_result_offset = (u32)ILLEGAL_BASE;
107
108 /* Internally the driver supports 4 options
109 * 1. prsResult/timestamp/hashResult selection (in fact 8 options,
110 * but for simplicity we'll
111 * relate to it as 1).
112 * 2. All IC context (from AD) not including debug.
113 */
114
115 /* This case covers the options under 1 */
116 /* Copy size must be in 16-byte granularity. */
117 int_context_data_copy->size =
118 (u16)((buffer_prefix_content->pass_prs_result ? 32 : 0) +
119 ((buffer_prefix_content->pass_time_stamp ||
120 buffer_prefix_content->pass_hash_result) ? 16 : 0));
121
122 /* Align start of internal context data to 16 byte */
123 int_context_data_copy->int_context_offset =
124 (u8)(buffer_prefix_content->pass_prs_result ? 32 :
125 ((buffer_prefix_content->pass_time_stamp ||
126 buffer_prefix_content->pass_hash_result) ? 64 : 0));
127
128 if (buffer_prefix_content->pass_prs_result)
129 buffer_offsets->prs_result_offset =
130 int_context_data_copy->ext_buf_offset;
131 if (buffer_prefix_content->pass_time_stamp)
132 buffer_offsets->time_stamp_offset =
133 buffer_prefix_content->pass_prs_result ?
134 (int_context_data_copy->ext_buf_offset +
135 sizeof(struct fman_prs_result)) :
136 int_context_data_copy->ext_buf_offset;
137 if (buffer_prefix_content->pass_hash_result)
138 /* If PR is not requested, whether TS is
139 * requested or not, IC will be copied from TS
140 */
141 buffer_offsets->hash_result_offset =
142 buffer_prefix_content->pass_prs_result ?
143 (int_context_data_copy->ext_buf_offset +
144 sizeof(struct fman_prs_result) + 8) :
145 int_context_data_copy->ext_buf_offset + 8;
146
147 if (int_context_data_copy->size)
148 buf_margins->start_margins =
149 (u16)(int_context_data_copy->ext_buf_offset +
150 int_context_data_copy->size);
151 else
152 /* No Internal Context passing, STartMargin is
153 * immediately after private_info
154 */
155 buf_margins->start_margins =
156 buffer_prefix_content->priv_data_size;
157
158 /* align data start */
159 tmp = (u32)(buf_margins->start_margins %
160 buffer_prefix_content->data_align);
161 if (tmp)
162 buf_margins->start_margins +=
163 (buffer_prefix_content->data_align - tmp);
164 buffer_offsets->data_offset = buf_margins->start_margins;
165
166 return 0;
167}
168EXPORT_SYMBOL(fman_sp_build_buffer_struct);
169