drivers/net/ethernet/freescale/fman/fman_sp.c

   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
  36 void 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 }
  83 EXPORT_SYMBOL(fman_sp_set_buf_pools_in_asc_order_of_buf_sizes);
  84
  85 int 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 }
 168 EXPORT_SYMBOL(fman_sp_build_buffer_struct);
 169