drivers/net/ethernet/stmicro/stmmac/norm_desc.c

   1 /*******************************************************************************
   2   This contains the functions to handle the normal descriptors.
   3
   4   Copyright (C) 2007-2009  STMicroelectronics Ltd
   5
   6   This program is free software; you can redistribute it and/or modify it
   7   under the terms and conditions of the GNU General Public License,
   8   version 2, as published by the Free Software Foundation.
   9
  10   This program is distributed in the hope it will be useful, but WITHOUT
  11   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  13   more details.
  14
  15   You should have received a copy of the GNU General Public License along with
  16   this program; if not, write to the Free Software Foundation, Inc.,
  17   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  18
  19   The full GNU General Public License is included in this distribution in
  20   the file called "COPYING".
  21
  22   Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
  23 *******************************************************************************/
  24
  25 #include <linux/stmmac.h>
  26 #include "common.h"
  27 #include "descs_com.h"
  28
  29 static int ndesc_get_tx_status(void *data, struct stmmac_extra_stats *x,
  30                                struct dma_desc *p, void __iomem *ioaddr)
  31 {
  32         int ret = 0;
  33         struct net_device_stats *stats = (struct net_device_stats *)data;
  34
  35         if (unlikely(p->des01.tx.error_summary)) {
  36                 if (unlikely(p->des01.tx.underflow_error)) {
  37                         x->tx_underflow++;
  38                         stats->tx_fifo_errors++;
  39                 }
  40                 if (unlikely(p->des01.tx.no_carrier)) {
  41                         x->tx_carrier++;
  42                         stats->tx_carrier_errors++;
  43                 }
  44                 if (unlikely(p->des01.tx.loss_carrier)) {
  45                         x->tx_losscarrier++;
  46                         stats->tx_carrier_errors++;
  47                 }
  48                 if (unlikely((p->des01.tx.excessive_deferral) ||
  49                              (p->des01.tx.excessive_collisions) ||
  50                              (p->des01.tx.late_collision)))
  51                         stats->collisions += p->des01.tx.collision_count;
  52                 ret = -1;
  53         }
  54
  55         if (p->des01.etx.vlan_frame)
  56                 x->tx_vlan++;
  57
  58         if (unlikely(p->des01.tx.deferred))
  59                 x->tx_deferred++;
  60
  61         return ret;
  62 }
  63
  64 static int ndesc_get_tx_len(struct dma_desc *p)
  65 {
  66         return p->des01.tx.buffer1_size;
  67 }
  68
  69 /* This function verifies if each incoming frame has some errors
  70  * and, if required, updates the multicast statistics.
  71  * In case of success, it returns good_frame because the GMAC device
  72  * is supposed to be able to compute the csum in HW. */
  73 static int ndesc_get_rx_status(void *data, struct stmmac_extra_stats *x,
  74                                struct dma_desc *p)
  75 {
  76         int ret = good_frame;
  77         struct net_device_stats *stats = (struct net_device_stats *)data;
  78
  79         if (unlikely(p->des01.rx.last_descriptor == 0)) {
  80                 pr_warn("%s: Oversized frame spanned multiple buffers\n",
  81                         __func__);
  82                 stats->rx_length_errors++;
  83                 return discard_frame;
  84         }
  85
  86         if (unlikely(p->des01.rx.error_summary)) {
  87                 if (unlikely(p->des01.rx.descriptor_error))
  88                         x->rx_desc++;
  89                 if (unlikely(p->des01.rx.sa_filter_fail))
  90                         x->sa_filter_fail++;
  91                 if (unlikely(p->des01.rx.overflow_error))
  92                         x->overflow_error++;
  93                 if (unlikely(p->des01.rx.ipc_csum_error))
  94                         x->ipc_csum_error++;
  95                 if (unlikely(p->des01.rx.collision)) {
  96                         x->rx_collision++;
  97                         stats->collisions++;
  98                 }
  99                 if (unlikely(p->des01.rx.crc_error)) {
 100                         x->rx_crc++;
 101                         stats->rx_crc_errors++;
 102                 }
 103                 ret = discard_frame;
 104         }
 105         if (unlikely(p->des01.rx.dribbling))
 106                 x->dribbling_bit++;
 107
 108         if (unlikely(p->des01.rx.length_error)) {
 109                 x->rx_length++;
 110                 ret = discard_frame;
 111         }
 112         if (unlikely(p->des01.rx.mii_error)) {
 113                 x->rx_mii++;
 114                 ret = discard_frame;
 115         }
 116 #ifdef STMMAC_VLAN_TAG_USED
 117         if (p->des01.rx.vlan_tag)
 118                 x->vlan_tag++;
 119 #endif
 120         return ret;
 121 }
 122
 123 static void ndesc_init_rx_desc(struct dma_desc *p, int disable_rx_ic, int mode,
 124                                int end)
 125 {
 126         p->des01.rx.own = 1;
 127         p->des01.rx.buffer1_size = BUF_SIZE_2KiB - 1;
 128
 129         if (mode == STMMAC_CHAIN_MODE)
 130                 ndesc_rx_set_on_chain(p, end);
 131         else
 132                 ndesc_rx_set_on_ring(p, end);
 133
 134         if (disable_rx_ic)
 135                 p->des01.rx.disable_ic = 1;
 136 }
 137
 138 static void ndesc_init_tx_desc(struct dma_desc *p, int mode, int end)
 139 {
 140         p->des01.tx.own = 0;
 141         if (mode == STMMAC_CHAIN_MODE)
 142                 ndesc_tx_set_on_chain(p, end);
 143         else
 144                 ndesc_tx_set_on_ring(p, end);
 145 }
 146
 147 static int ndesc_get_tx_owner(struct dma_desc *p)
 148 {
 149         return p->des01.tx.own;
 150 }
 151
 152 static int ndesc_get_rx_owner(struct dma_desc *p)
 153 {
 154         return p->des01.rx.own;
 155 }
 156
 157 static void ndesc_set_tx_owner(struct dma_desc *p)
 158 {
 159         p->des01.tx.own = 1;
 160 }
 161
 162 static void ndesc_set_rx_owner(struct dma_desc *p)
 163 {
 164         p->des01.rx.own = 1;
 165 }
 166
 167 static int ndesc_get_tx_ls(struct dma_desc *p)
 168 {
 169         return p->des01.tx.last_segment;
 170 }
 171
 172 static void ndesc_release_tx_desc(struct dma_desc *p, int mode)
 173 {
 174         int ter = p->des01.tx.end_ring;
 175
 176         memset(p, 0, offsetof(struct dma_desc, des2));
 177         if (mode == STMMAC_CHAIN_MODE)
 178                 ndesc_end_tx_desc_on_chain(p, ter);
 179         else
 180                 ndesc_end_tx_desc_on_ring(p, ter);
 181 }
 182
 183 static void ndesc_prepare_tx_desc(struct dma_desc *p, int is_fs, int len,
 184                                   int csum_flag, int mode)
 185 {
 186         p->des01.tx.first_segment = is_fs;
 187         if (mode == STMMAC_CHAIN_MODE)
 188                 norm_set_tx_desc_len_on_chain(p, len);
 189         else
 190                 norm_set_tx_desc_len_on_ring(p, len);
 191
 192         if (likely(csum_flag))
 193                 p->des01.tx.checksum_insertion = cic_full;
 194 }
 195
 196 static void ndesc_clear_tx_ic(struct dma_desc *p)
 197 {
 198         p->des01.tx.interrupt = 0;
 199 }
 200
 201 static void ndesc_close_tx_desc(struct dma_desc *p)
 202 {
 203         p->des01.tx.last_segment = 1;
 204         p->des01.tx.interrupt = 1;
 205 }
 206
 207 static int ndesc_get_rx_frame_len(struct dma_desc *p, int rx_coe_type)
 208 {
 209         /* The type-1 checksum offload engines append the checksum at
 210          * the end of frame and the two bytes of checksum are added in
 211          * the length.
 212          * Adjust for that in the framelen for type-1 checksum offload
 213          * engines. */
 214         if (rx_coe_type == STMMAC_RX_COE_TYPE1)
 215                 return p->des01.rx.frame_length - 2;
 216         else
 217                 return p->des01.rx.frame_length;
 218 }
 219
 220 static void ndesc_enable_tx_timestamp(struct dma_desc *p)
 221 {
 222         p->des01.tx.time_stamp_enable = 1;
 223 }
 224
 225 static int ndesc_get_tx_timestamp_status(struct dma_desc *p)
 226 {
 227         return p->des01.tx.time_stamp_status;
 228 }
 229
 230 static u64 ndesc_get_timestamp(void *desc, u32 ats)
 231 {
 232         struct dma_desc *p = (struct dma_desc *)desc;
 233         u64 ns;
 234
 235         ns = p->des2;
 236         /* convert high/sec time stamp value to nanosecond */
 237         ns += p->des3 * 1000000000ULL;
 238
 239         return ns;
 240 }
 241
 242 static int ndesc_get_rx_timestamp_status(void *desc, u32 ats)
 243 {
 244         struct dma_desc *p = (struct dma_desc *)desc;
 245
 246         if ((p->des2 == 0xffffffff) && (p->des3 == 0xffffffff))
 247                 /* timestamp is corrupted, hence don't store it */
 248                 return 0;
 249         else
 250                 return 1;
 251 }
 252
 253 const struct stmmac_desc_ops ndesc_ops = {
 254         .tx_status = ndesc_get_tx_status,
 255         .rx_status = ndesc_get_rx_status,
 256         .get_tx_len = ndesc_get_tx_len,
 257         .init_rx_desc = ndesc_init_rx_desc,
 258         .init_tx_desc = ndesc_init_tx_desc,
 259         .get_tx_owner = ndesc_get_tx_owner,
 260         .get_rx_owner = ndesc_get_rx_owner,
 261         .release_tx_desc = ndesc_release_tx_desc,
 262         .prepare_tx_desc = ndesc_prepare_tx_desc,
 263         .clear_tx_ic = ndesc_clear_tx_ic,
 264         .close_tx_desc = ndesc_close_tx_desc,
 265         .get_tx_ls = ndesc_get_tx_ls,
 266         .set_tx_owner = ndesc_set_tx_owner,
 267         .set_rx_owner = ndesc_set_rx_owner,
 268         .get_rx_frame_len = ndesc_get_rx_frame_len,
 269         .enable_tx_timestamp = ndesc_enable_tx_timestamp,
 270         .get_tx_timestamp_status = ndesc_get_tx_timestamp_status,
 271         .get_timestamp = ndesc_get_timestamp,
 272         .get_rx_timestamp_status = ndesc_get_rx_timestamp_status,
 273 };