Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 1 | /******************************************************************************* |
| 2 | Specialised functions for managing Ring mode |
| 3 | |
| 4 | Copyright(C) 2011 STMicroelectronics Ltd |
| 5 | |
| 6 | It defines all the functions used to handle the normal/enhanced |
| 7 | descriptors in case of the DMA is configured to work in chained or |
| 8 | in ring mode. |
| 9 | |
| 10 | This program is free software; you can redistribute it and/or modify it |
| 11 | under the terms and conditions of the GNU General Public License, |
| 12 | version 2, as published by the Free Software Foundation. |
| 13 | |
| 14 | This program is distributed in the hope it will be useful, but WITHOUT |
| 15 | ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 16 | FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 17 | more details. |
| 18 | |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 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 "stmmac.h" |
| 26 | |
Giuseppe CAVALLARO | 362b37b | 2014-08-27 11:27:00 +0200 | [diff] [blame] | 27 | static int stmmac_jumbo_frm(void *p, struct sk_buff *skb, int csum) |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 28 | { |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 29 | struct stmmac_tx_queue *tx_q = (struct stmmac_tx_queue *)p; |
LABBE Corentin | 5bacd77 | 2017-03-29 07:05:40 +0200 | [diff] [blame] | 30 | unsigned int nopaged_len = skb_headlen(skb); |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 31 | struct stmmac_priv *priv = tx_q->priv_data; |
| 32 | unsigned int entry = tx_q->cur_tx; |
LABBE Corentin | 5bacd77 | 2017-03-29 07:05:40 +0200 | [diff] [blame] | 33 | unsigned int bmax, len, des2; |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 34 | struct dma_desc *desc; |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 35 | |
Byungho An | 21ff019 | 2013-08-08 15:30:26 +0900 | [diff] [blame] | 36 | if (priv->extend_desc) |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 37 | desc = (struct dma_desc *)(tx_q->dma_etx + entry); |
Byungho An | 21ff019 | 2013-08-08 15:30:26 +0900 | [diff] [blame] | 38 | else |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 39 | desc = tx_q->dma_tx + entry; |
Byungho An | 21ff019 | 2013-08-08 15:30:26 +0900 | [diff] [blame] | 40 | |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 41 | if (priv->plat->enh_desc) |
| 42 | bmax = BUF_SIZE_8KiB; |
| 43 | else |
| 44 | bmax = BUF_SIZE_2KiB; |
| 45 | |
| 46 | len = nopaged_len - bmax; |
| 47 | |
| 48 | if (nopaged_len > BUF_SIZE_8KiB) { |
| 49 | |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 50 | des2 = dma_map_single(priv->device, skb->data, bmax, |
| 51 | DMA_TO_DEVICE); |
| 52 | desc->des2 = cpu_to_le32(des2); |
| 53 | if (dma_mapping_error(priv->device, des2)) |
Giuseppe CAVALLARO | 362b37b | 2014-08-27 11:27:00 +0200 | [diff] [blame] | 54 | return -1; |
| 55 | |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 56 | tx_q->tx_skbuff_dma[entry].buf = des2; |
| 57 | tx_q->tx_skbuff_dma[entry].len = bmax; |
| 58 | tx_q->tx_skbuff_dma[entry].is_jumbo = true; |
Giuseppe Cavallaro | 553e2ab | 2016-02-29 14:27:31 +0100 | [diff] [blame] | 59 | |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 60 | desc->des3 = cpu_to_le32(des2 + BUF_SIZE_4KiB); |
Giuseppe CAVALLARO | 4a7d666 | 2013-03-26 04:43:05 +0000 | [diff] [blame] | 61 | priv->hw->desc->prepare_tx_desc(desc, 1, bmax, csum, |
Giuseppe Cavallaro | be434d5 | 2016-02-29 14:27:35 +0100 | [diff] [blame] | 62 | STMMAC_RING_MODE, 0, false); |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 63 | tx_q->tx_skbuff[entry] = NULL; |
Giuseppe Cavallaro | e3ad57c | 2016-02-29 14:27:30 +0100 | [diff] [blame] | 64 | entry = STMMAC_GET_ENTRY(entry, DMA_TX_SIZE); |
Byungho An | 21ff019 | 2013-08-08 15:30:26 +0900 | [diff] [blame] | 65 | |
| 66 | if (priv->extend_desc) |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 67 | desc = (struct dma_desc *)(tx_q->dma_etx + entry); |
Byungho An | 21ff019 | 2013-08-08 15:30:26 +0900 | [diff] [blame] | 68 | else |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 69 | desc = tx_q->dma_tx + entry; |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 70 | |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 71 | des2 = dma_map_single(priv->device, skb->data + bmax, len, |
| 72 | DMA_TO_DEVICE); |
| 73 | desc->des2 = cpu_to_le32(des2); |
| 74 | if (dma_mapping_error(priv->device, des2)) |
Giuseppe CAVALLARO | 362b37b | 2014-08-27 11:27:00 +0200 | [diff] [blame] | 75 | return -1; |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 76 | tx_q->tx_skbuff_dma[entry].buf = des2; |
| 77 | tx_q->tx_skbuff_dma[entry].len = len; |
| 78 | tx_q->tx_skbuff_dma[entry].is_jumbo = true; |
Giuseppe Cavallaro | 553e2ab | 2016-02-29 14:27:31 +0100 | [diff] [blame] | 79 | |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 80 | desc->des3 = cpu_to_le32(des2 + BUF_SIZE_4KiB); |
Giuseppe CAVALLARO | 4a7d666 | 2013-03-26 04:43:05 +0000 | [diff] [blame] | 81 | priv->hw->desc->prepare_tx_desc(desc, 0, len, csum, |
Giuseppe Cavallaro | be434d5 | 2016-02-29 14:27:35 +0100 | [diff] [blame] | 82 | STMMAC_RING_MODE, 1, true); |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 83 | } else { |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 84 | des2 = dma_map_single(priv->device, skb->data, |
| 85 | nopaged_len, DMA_TO_DEVICE); |
| 86 | desc->des2 = cpu_to_le32(des2); |
| 87 | if (dma_mapping_error(priv->device, des2)) |
Giuseppe CAVALLARO | 362b37b | 2014-08-27 11:27:00 +0200 | [diff] [blame] | 88 | return -1; |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 89 | tx_q->tx_skbuff_dma[entry].buf = des2; |
| 90 | tx_q->tx_skbuff_dma[entry].len = nopaged_len; |
| 91 | tx_q->tx_skbuff_dma[entry].is_jumbo = true; |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 92 | desc->des3 = cpu_to_le32(des2 + BUF_SIZE_4KiB); |
Giuseppe CAVALLARO | 4a7d666 | 2013-03-26 04:43:05 +0000 | [diff] [blame] | 93 | priv->hw->desc->prepare_tx_desc(desc, 1, nopaged_len, csum, |
Giuseppe Cavallaro | be434d5 | 2016-02-29 14:27:35 +0100 | [diff] [blame] | 94 | STMMAC_RING_MODE, 0, true); |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 95 | } |
| 96 | |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 97 | tx_q->cur_tx = entry; |
Giuseppe Cavallaro | e3ad57c | 2016-02-29 14:27:30 +0100 | [diff] [blame] | 98 | |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 99 | return entry; |
| 100 | } |
| 101 | |
| 102 | static unsigned int stmmac_is_jumbo_frm(int len, int enh_desc) |
| 103 | { |
| 104 | unsigned int ret = 0; |
| 105 | |
| 106 | if (len >= BUF_SIZE_4KiB) |
| 107 | ret = 1; |
| 108 | |
| 109 | return ret; |
| 110 | } |
| 111 | |
Rayagond Kokatanur | 891434b | 2013-03-26 04:43:10 +0000 | [diff] [blame] | 112 | static void stmmac_refill_desc3(void *priv_ptr, struct dma_desc *p) |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 113 | { |
Rayagond Kokatanur | 891434b | 2013-03-26 04:43:10 +0000 | [diff] [blame] | 114 | struct stmmac_priv *priv = (struct stmmac_priv *)priv_ptr; |
| 115 | |
Giuseppe CAVALLARO | 29896a6 | 2014-03-10 13:40:33 +0100 | [diff] [blame] | 116 | /* Fill DES3 in case of RING mode */ |
| 117 | if (priv->dma_buf_sz >= BUF_SIZE_8KiB) |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 118 | p->des3 = cpu_to_le32(le32_to_cpu(p->des2) + BUF_SIZE_8KiB); |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 119 | } |
| 120 | |
Giuseppe CAVALLARO | 4a7d666 | 2013-03-26 04:43:05 +0000 | [diff] [blame] | 121 | /* In ring mode we need to fill the desc3 because it is used as buffer */ |
| 122 | static void stmmac_init_desc3(struct dma_desc *p) |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 123 | { |
Michael Weiser | f8be0d7 | 2016-11-14 18:58:05 +0100 | [diff] [blame] | 124 | p->des3 = cpu_to_le32(le32_to_cpu(p->des2) + BUF_SIZE_8KiB); |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 125 | } |
| 126 | |
Rayagond Kokatanur | 891434b | 2013-03-26 04:43:10 +0000 | [diff] [blame] | 127 | static void stmmac_clean_desc3(void *priv_ptr, struct dma_desc *p) |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 128 | { |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 129 | struct stmmac_tx_queue *tx_q = (struct stmmac_tx_queue *)priv_ptr; |
| 130 | struct stmmac_priv *priv = tx_q->priv_data; |
| 131 | unsigned int entry = tx_q->dirty_tx; |
Giuseppe Cavallaro | 9695136 | 2016-02-29 14:27:33 +0100 | [diff] [blame] | 132 | |
| 133 | /* des3 is only used for jumbo frames tx or time stamping */ |
Joao Pinto | ce73678 | 2017-04-06 09:49:10 +0100 | [diff] [blame^] | 134 | if (unlikely(tx_q->tx_skbuff_dma[entry].is_jumbo || |
| 135 | (tx_q->tx_skbuff_dma[entry].last_segment && |
Giuseppe Cavallaro | 9695136 | 2016-02-29 14:27:33 +0100 | [diff] [blame] | 136 | !priv->extend_desc && priv->hwts_tx_en))) |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 137 | p->des3 = 0; |
| 138 | } |
| 139 | |
| 140 | static int stmmac_set_16kib_bfsize(int mtu) |
| 141 | { |
| 142 | int ret = 0; |
| 143 | if (unlikely(mtu >= BUF_SIZE_8KiB)) |
| 144 | ret = BUF_SIZE_16KiB; |
| 145 | return ret; |
| 146 | } |
| 147 | |
Giuseppe CAVALLARO | 29896a6 | 2014-03-10 13:40:33 +0100 | [diff] [blame] | 148 | const struct stmmac_mode_ops ring_mode_ops = { |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 149 | .is_jumbo_frm = stmmac_is_jumbo_frm, |
| 150 | .jumbo_frm = stmmac_jumbo_frm, |
| 151 | .refill_desc3 = stmmac_refill_desc3, |
| 152 | .init_desc3 = stmmac_init_desc3, |
Giuseppe CAVALLARO | 286a837 | 2011-10-18 00:01:24 +0000 | [diff] [blame] | 153 | .clean_desc3 = stmmac_clean_desc3, |
| 154 | .set_16kib_bfsize = stmmac_set_16kib_bfsize, |
| 155 | }; |