[PATCH] net: designware_eqs: set upper 32bit address for DMA descriptors to support 64-bit addressing

[zhengxiaojun <zheng.xiaojun@foxmail.com>]

Signed-off-by: zhengxiaojun <zheng.xiaojun@foxmail.com>
---
 drivers/net/designware_eqos.c | 29 +++++++++++++++++++----------
 1 file changed, 19 insertions(+), 10 deletions(-)

diff --git a/drivers/net/designware_eqos.c b/drivers/net/designware_eqos.c
index a6e9d8677f..332dc7eb73 100644
--- a/drivers/net/designware_eqos.c
+++ b/drivers/net/designware_eqos.c
@@ -17,6 +17,7 @@
 #include <linux/iopoll.h>
 #include <linux/time.h>
 #include <linux/sizes.h>
+#include <linux/bitfield.h>
 
 #include "designware_eqos.h"
 
@@ -416,6 +417,7 @@ static int eqos_start(struct eth_device *edev)
 	u32 val, tx_fifo_sz, rx_fifo_sz, tqs, rqs, pbl;
 	unsigned long last_rx_rf_desc;
 	unsigned long rate;
+	dma_addr_t dma_addr;
 	u32 mode_set;
 	int ret;
 	int i;
@@ -632,13 +634,15 @@ static int eqos_start(struct eth_device *edev)
 		writel(EQOS_DESC3_BUF1V | EQOS_DESC3_OWN, &rx_rf_desc->des3);
 	}
 
-	writel(0, &eqos->dma_regs->ch0_txdesc_list_haddress);
-	writel((ulong)eqos->tx_descs, &eqos->dma_regs->ch0_txdesc_list_address);
+	dma_addr = (dma_addr_t)eqos->tx_descs;
+	writel(upper_32_bits(dma_addr), &eqos->dma_regs->ch0_txdesc_list_haddress);
+	writel(lower_32_bits(dma_addr), &eqos->dma_regs->ch0_txdesc_list_address);
 	writel(EQOS_DESCRIPTORS_TX - 1,
 	       &eqos->dma_regs->ch0_txdesc_ring_length);
 
-	writel(0, &eqos->dma_regs->ch0_rxdesc_list_haddress);
-	writel((ulong)eqos->rx_descs, &eqos->dma_regs->ch0_rxdesc_list_address);
+	dma_addr = (dma_addr_t)eqos->rx_descs;
+	writel(upper_32_bits(dma_addr), &eqos->dma_regs->ch0_rxdesc_list_haddress);
+	writel(lower_32_bits(dma_addr), &eqos->dma_regs->ch0_rxdesc_list_address);
 	writel(EQOS_DESCRIPTORS_RX - 1,
 	       &eqos->dma_regs->ch0_rxdesc_ring_length);
 
@@ -720,8 +724,8 @@ static int eqos_send(struct eth_device *edev, void *packet, int length)
 	if (dma_mapping_error(edev->parent, dma))
 		return -EFAULT;
 
-	tx_desc->des0 = (unsigned long)dma;
-	tx_desc->des1 = 0;
+	tx_desc->des0 = lower_32_bits(dma);
+	tx_desc->des1 = upper_32_bits(dma);
 	tx_desc->des2 = length;
 	/*
 	 * Make sure the compiler doesn't reorder the _OWN write below, before
@@ -780,9 +784,10 @@ static void eqos_recv(struct eth_device *edev)
 
 	/* Read Format RX descriptor */
 	rx_rf_desc = &eqos->rx_descs[eqos->rx_currdescnum];
-	rx_rf_desc->des0 = dma;
-	rx_rf_desc->des1 = 0;
+	rx_rf_desc->des0 = lower_32_bits(dma);
+	rx_rf_desc->des1 = upper_32_bits(dma);
 	rx_rf_desc->des2 = 0;
+
 	/*
 	 * Make sure that if HW sees the _OWN write below, it will see all the
 	 * writes to the rest of the descriptor too.
@@ -827,7 +832,8 @@ static int eqos_init_resources(struct eqos *eqos)
 			goto err_free_rx_bufs;
 		}
 
-		rx_rf_desc->des0 = dma;
+		rx_rf_desc->des0 = lower_32_bits(dma);
+		rx_rf_desc->des1 = upper_32_bits(dma);
 		eqos->dma_rx_buf[i] = dma;
 
 		p += EQOS_MAX_PACKET_SIZE;
@@ -942,13 +948,16 @@ int eqos_probe(struct device *dev, const struct eqos_ops *ops, void *priv)
 
 void eqos_remove(struct device *dev)
 {
+	dma_addr_t	dma;
 	struct eqos *eqos = dev->priv;
 
 	eth_unregister(&eqos->netdev);
 
 	mdiobus_unregister(&eqos->miibus);
 
-	dma_free(phys_to_virt(eqos->rx_descs[0].des0));
+	dma = eqos->rx_descs[0].des1;
+	dma = (dma << 32) + eqos->rx_descs[0].des0;
+	dma_free(phys_to_virt(dma));
 	dma_free_coherent(DMA_DEVICE_BROKEN,
 			  eqos->tx_descs, 0, EQOS_DESCRIPTORS_SIZE);
 }
-- 
2.43.0