blob: eb4cd96763bd3cb1c72b1631ed70f0e3a8f4f76f [file] [log] [blame]
Thomas Chou7bb1b9b2010-04-20 12:49:52 +08001/*
2 * Altera 10/100/1000 triple speed ethernet mac driver
3 *
4 * Copyright (C) 2008 Altera Corporation.
5 * Copyright (C) 2010 Thomas Chou <thomas@wytron.com.tw>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 */
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080011#include <common.h>
Simon Glass63334482019-11-14 12:57:39 -070012#include <cpu_func.h>
Thomas Chouec06dd82015-10-22 15:29:11 +080013#include <dm.h>
14#include <errno.h>
15#include <fdt_support.h>
Simon Glass0f2af882020-05-10 11:40:05 -060016#include <log.h>
Thomas Chouec06dd82015-10-22 15:29:11 +080017#include <memalign.h>
18#include <miiphy.h>
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080019#include <net.h>
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080020#include <asm/cache.h>
Simon Glass3ba929a2020-10-30 21:38:53 -060021#include <asm/global_data.h>
Masahiro Yamada6373a172020-02-14 16:40:19 +090022#include <linux/dma-mapping.h>
Thomas Chouec06dd82015-10-22 15:29:11 +080023#include <asm/io.h>
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080024#include "altera_tse.h"
25
Thomas Chouec06dd82015-10-22 15:29:11 +080026DECLARE_GLOBAL_DATA_PTR;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080027
Thomas Chouec06dd82015-10-22 15:29:11 +080028static inline void alt_sgdma_construct_descriptor(
29 struct alt_sgdma_descriptor *desc,
30 struct alt_sgdma_descriptor *next,
31 void *read_addr,
32 void *write_addr,
Thomas Chou455e9532015-11-06 09:36:26 +080033 u16 length_or_eop,
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080034 int generate_eop,
35 int read_fixed,
Thomas Chouec06dd82015-10-22 15:29:11 +080036 int write_fixed_or_sop)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080037{
Thomas Chou455e9532015-11-06 09:36:26 +080038 u8 val;
Thomas Chouec06dd82015-10-22 15:29:11 +080039
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080040 /*
41 * Mark the "next" descriptor as "not" owned by hardware. This prevents
Thomas Chouec06dd82015-10-22 15:29:11 +080042 * The SGDMA controller from continuing to process the chain.
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080043 */
Thomas Chouec06dd82015-10-22 15:29:11 +080044 next->descriptor_control = next->descriptor_control &
45 ~ALT_SGDMA_DESCRIPTOR_CONTROL_OWNED_BY_HW_MSK;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080046
Thomas Chouec06dd82015-10-22 15:29:11 +080047 memset(desc, 0, sizeof(struct alt_sgdma_descriptor));
48 desc->source = virt_to_phys(read_addr);
49 desc->destination = virt_to_phys(write_addr);
50 desc->next = virt_to_phys(next);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080051 desc->bytes_to_transfer = length_or_eop;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080052
53 /*
54 * Set the descriptor control block as follows:
55 * - Set "owned by hardware" bit
56 * - Optionally set "generate EOP" bit
57 * - Optionally set the "read from fixed address" bit
58 * - Optionally set the "write to fixed address bit (which serves
59 * serves as a "generate SOP" control bit in memory-to-stream mode).
60 * - Set the 4-bit atlantic channel, if specified
61 *
62 * Note this step is performed after all other descriptor information
63 * has been filled out so that, if the controller already happens to be
64 * pointing at this descriptor, it will not run (via the "owned by
65 * hardware" bit) until all other descriptor has been set up.
66 */
Thomas Chouec06dd82015-10-22 15:29:11 +080067 val = ALT_SGDMA_DESCRIPTOR_CONTROL_OWNED_BY_HW_MSK;
68 if (generate_eop)
69 val |= ALT_SGDMA_DESCRIPTOR_CONTROL_GENERATE_EOP_MSK;
70 if (read_fixed)
71 val |= ALT_SGDMA_DESCRIPTOR_CONTROL_READ_FIXED_ADDRESS_MSK;
72 if (write_fixed_or_sop)
73 val |= ALT_SGDMA_DESCRIPTOR_CONTROL_WRITE_FIXED_ADDRESS_MSK;
74 desc->descriptor_control = val;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080075}
76
Thomas Chouec06dd82015-10-22 15:29:11 +080077static int alt_sgdma_wait_transfer(struct alt_sgdma_registers *regs)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080078{
Thomas Chouec06dd82015-10-22 15:29:11 +080079 int status;
80 ulong ctime;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080081
Thomas Chouec06dd82015-10-22 15:29:11 +080082 /* Wait for the descriptor (chain) to complete */
83 ctime = get_timer(0);
84 while (1) {
85 status = readl(&regs->status);
86 if (!(status & ALT_SGDMA_STATUS_BUSY_MSK))
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080087 break;
Thomas Chouec06dd82015-10-22 15:29:11 +080088 if (get_timer(ctime) > ALT_TSE_SGDMA_BUSY_TIMEOUT) {
89 status = -ETIMEDOUT;
90 debug("sgdma timeout\n");
91 break;
92 }
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080093 }
94
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080095 /* Clear Run */
Thomas Chouec06dd82015-10-22 15:29:11 +080096 writel(0, &regs->control);
97 /* Clear status */
98 writel(0xff, &regs->status);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +080099
Thomas Chouec06dd82015-10-22 15:29:11 +0800100 return status;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800101}
102
Thomas Chouec06dd82015-10-22 15:29:11 +0800103static int alt_sgdma_start_transfer(struct alt_sgdma_registers *regs,
104 struct alt_sgdma_descriptor *desc)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800105{
Thomas Chou455e9532015-11-06 09:36:26 +0800106 u32 val;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800107
108 /* Point the controller at the descriptor */
Thomas Chouec06dd82015-10-22 15:29:11 +0800109 writel(virt_to_phys(desc), &regs->next_descriptor_pointer);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800110
111 /*
112 * Set up SGDMA controller to:
113 * - Disable interrupt generation
114 * - Run once a valid descriptor is written to controller
115 * - Stop on an error with any particular descriptor
116 */
Thomas Chouec06dd82015-10-22 15:29:11 +0800117 val = ALT_SGDMA_CONTROL_RUN_MSK | ALT_SGDMA_CONTROL_STOP_DMA_ER_MSK;
118 writel(val, &regs->control);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800119
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800120 return 0;
121}
122
Thomas Chouec06dd82015-10-22 15:29:11 +0800123static void tse_adjust_link(struct altera_tse_priv *priv,
124 struct phy_device *phydev)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800125{
Thomas Chouec06dd82015-10-22 15:29:11 +0800126 struct alt_tse_mac *mac_dev = priv->mac_dev;
Thomas Chou455e9532015-11-06 09:36:26 +0800127 u32 refvar;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800128
Thomas Chouec06dd82015-10-22 15:29:11 +0800129 if (!phydev->link) {
130 debug("%s: No link.\n", phydev->dev->name);
131 return;
132 }
133
134 refvar = readl(&mac_dev->command_config);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800135
Thomas Chouec06dd82015-10-22 15:29:11 +0800136 if (phydev->duplex)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800137 refvar |= ALTERA_TSE_CMD_HD_ENA_MSK;
138 else
139 refvar &= ~ALTERA_TSE_CMD_HD_ENA_MSK;
140
Thomas Chouec06dd82015-10-22 15:29:11 +0800141 switch (phydev->speed) {
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800142 case 1000:
143 refvar |= ALTERA_TSE_CMD_ETH_SPEED_MSK;
144 refvar &= ~ALTERA_TSE_CMD_ENA_10_MSK;
145 break;
146 case 100:
147 refvar &= ~ALTERA_TSE_CMD_ETH_SPEED_MSK;
148 refvar &= ~ALTERA_TSE_CMD_ENA_10_MSK;
149 break;
150 case 10:
151 refvar &= ~ALTERA_TSE_CMD_ETH_SPEED_MSK;
152 refvar |= ALTERA_TSE_CMD_ENA_10_MSK;
153 break;
154 }
Thomas Chouec06dd82015-10-22 15:29:11 +0800155 writel(refvar, &mac_dev->command_config);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800156}
157
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800158static int altera_tse_send_sgdma(struct udevice *dev, void *packet, int length)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800159{
Thomas Chouec06dd82015-10-22 15:29:11 +0800160 struct altera_tse_priv *priv = dev_get_priv(dev);
161 struct alt_sgdma_descriptor *tx_desc = priv->tx_desc;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800162
Thomas Chouec06dd82015-10-22 15:29:11 +0800163 alt_sgdma_construct_descriptor(
164 tx_desc,
165 tx_desc + 1,
166 packet, /* read addr */
167 NULL, /* write addr */
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800168 length, /* length or EOP ,will change for each tx */
Thomas Chouec06dd82015-10-22 15:29:11 +0800169 1, /* gen eop */
170 0, /* read fixed */
171 1 /* write fixed or sop */
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800172 );
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800173
174 /* send the packet */
Thomas Chouec06dd82015-10-22 15:29:11 +0800175 alt_sgdma_start_transfer(priv->sgdma_tx, tx_desc);
176 alt_sgdma_wait_transfer(priv->sgdma_tx);
177 debug("sent %d bytes\n", tx_desc->actual_bytes_transferred);
178
179 return tx_desc->actual_bytes_transferred;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800180}
181
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800182static int altera_tse_recv_sgdma(struct udevice *dev, int flags,
183 uchar **packetp)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800184{
Thomas Chouec06dd82015-10-22 15:29:11 +0800185 struct altera_tse_priv *priv = dev_get_priv(dev);
186 struct alt_sgdma_descriptor *rx_desc = priv->rx_desc;
187 int packet_length;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800188
Thomas Chouec06dd82015-10-22 15:29:11 +0800189 if (rx_desc->descriptor_status &
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800190 ALT_SGDMA_DESCRIPTOR_STATUS_TERMINATED_BY_EOP_MSK) {
Thomas Choub917dee2015-11-09 08:00:00 +0800191 alt_sgdma_wait_transfer(priv->sgdma_rx);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800192 packet_length = rx_desc->actual_bytes_transferred;
Thomas Chouec06dd82015-10-22 15:29:11 +0800193 debug("recv %d bytes\n", packet_length);
194 *packetp = priv->rx_buf;
Joachim Foerster384a8192011-10-17 05:24:46 +0000195
196 return packet_length;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800197 }
198
Thomas Chouec06dd82015-10-22 15:29:11 +0800199 return -EAGAIN;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800200}
201
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800202static int altera_tse_free_pkt_sgdma(struct udevice *dev, uchar *packet,
203 int length)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800204{
Thomas Chouec06dd82015-10-22 15:29:11 +0800205 struct altera_tse_priv *priv = dev_get_priv(dev);
206 struct alt_sgdma_descriptor *rx_desc = priv->rx_desc;
Thomas Chouec06dd82015-10-22 15:29:11 +0800207
Thomas Chouec06dd82015-10-22 15:29:11 +0800208 alt_sgdma_construct_descriptor(
209 rx_desc,
210 rx_desc + 1,
211 NULL, /* read addr */
212 priv->rx_buf, /* write addr */
213 0, /* length or EOP */
214 0, /* gen eop */
215 0, /* read fixed */
216 0 /* write fixed or sop */
217 );
218
219 /* setup the sgdma */
220 alt_sgdma_start_transfer(priv->sgdma_rx, rx_desc);
221 debug("recv setup\n");
222
223 return 0;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800224}
225
Thomas Chou67bd52f2015-11-08 10:57:05 +0800226static void altera_tse_stop_mac(struct altera_tse_priv *priv)
227{
228 struct alt_tse_mac *mac_dev = priv->mac_dev;
229 u32 status;
230 ulong ctime;
231
232 /* reset the mac */
233 writel(ALTERA_TSE_CMD_SW_RESET_MSK, &mac_dev->command_config);
234 ctime = get_timer(0);
235 while (1) {
236 status = readl(&mac_dev->command_config);
237 if (!(status & ALTERA_TSE_CMD_SW_RESET_MSK))
238 break;
239 if (get_timer(ctime) > ALT_TSE_SW_RESET_TIMEOUT) {
240 debug("Reset mac timeout\n");
241 break;
242 }
243 }
244}
245
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800246static void altera_tse_stop_sgdma(struct udevice *dev)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800247{
Thomas Chouec06dd82015-10-22 15:29:11 +0800248 struct altera_tse_priv *priv = dev_get_priv(dev);
Thomas Chouec06dd82015-10-22 15:29:11 +0800249 struct alt_sgdma_registers *rx_sgdma = priv->sgdma_rx;
250 struct alt_sgdma_registers *tx_sgdma = priv->sgdma_tx;
251 struct alt_sgdma_descriptor *rx_desc = priv->rx_desc;
Thomas Chouec06dd82015-10-22 15:29:11 +0800252 int ret;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800253
254 /* clear rx desc & wait for sgdma to complete */
255 rx_desc->descriptor_control = 0;
Thomas Chouec06dd82015-10-22 15:29:11 +0800256 writel(0, &rx_sgdma->control);
257 ret = alt_sgdma_wait_transfer(rx_sgdma);
258 if (ret == -ETIMEDOUT)
259 writel(ALT_SGDMA_CONTROL_SOFTWARERESET_MSK,
260 &rx_sgdma->control);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800261
Thomas Chouec06dd82015-10-22 15:29:11 +0800262 writel(0, &tx_sgdma->control);
263 ret = alt_sgdma_wait_transfer(tx_sgdma);
264 if (ret == -ETIMEDOUT)
265 writel(ALT_SGDMA_CONTROL_SOFTWARERESET_MSK,
266 &tx_sgdma->control);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800267}
268
Thomas Chou9c0a2012015-11-09 14:36:29 +0800269static void msgdma_reset(struct msgdma_csr *csr)
270{
271 u32 status;
272 ulong ctime;
273
274 /* Reset mSGDMA */
275 writel(MSGDMA_CSR_STAT_MASK, &csr->status);
276 writel(MSGDMA_CSR_CTL_RESET, &csr->control);
277 ctime = get_timer(0);
278 while (1) {
279 status = readl(&csr->status);
280 if (!(status & MSGDMA_CSR_STAT_RESETTING))
281 break;
282 if (get_timer(ctime) > ALT_TSE_SW_RESET_TIMEOUT) {
283 debug("Reset msgdma timeout\n");
284 break;
285 }
286 }
287 /* Clear status */
288 writel(MSGDMA_CSR_STAT_MASK, &csr->status);
289}
290
291static u32 msgdma_wait(struct msgdma_csr *csr)
292{
293 u32 status;
294 ulong ctime;
295
296 /* Wait for the descriptor to complete */
297 ctime = get_timer(0);
298 while (1) {
299 status = readl(&csr->status);
300 if (!(status & MSGDMA_CSR_STAT_BUSY))
301 break;
302 if (get_timer(ctime) > ALT_TSE_SGDMA_BUSY_TIMEOUT) {
303 debug("sgdma timeout\n");
304 break;
305 }
306 }
307 /* Clear status */
308 writel(MSGDMA_CSR_STAT_MASK, &csr->status);
309
310 return status;
311}
312
313static int altera_tse_send_msgdma(struct udevice *dev, void *packet,
314 int length)
315{
316 struct altera_tse_priv *priv = dev_get_priv(dev);
317 struct msgdma_extended_desc *desc = priv->tx_desc;
318 u32 tx_buf = virt_to_phys(packet);
319 u32 status;
320
321 writel(tx_buf, &desc->read_addr_lo);
322 writel(0, &desc->read_addr_hi);
323 writel(0, &desc->write_addr_lo);
324 writel(0, &desc->write_addr_hi);
325 writel(length, &desc->len);
326 writel(0, &desc->burst_seq_num);
327 writel(MSGDMA_DESC_TX_STRIDE, &desc->stride);
328 writel(MSGDMA_DESC_CTL_TX_SINGLE, &desc->control);
329 status = msgdma_wait(priv->sgdma_tx);
330 debug("sent %d bytes, status %08x\n", length, status);
331
332 return 0;
333}
334
335static int altera_tse_recv_msgdma(struct udevice *dev, int flags,
336 uchar **packetp)
337{
338 struct altera_tse_priv *priv = dev_get_priv(dev);
339 struct msgdma_csr *csr = priv->sgdma_rx;
340 struct msgdma_response *resp = priv->rx_resp;
341 u32 level, length, status;
342
343 level = readl(&csr->resp_fill_level);
344 if (level & 0xffff) {
345 length = readl(&resp->bytes_transferred);
346 status = readl(&resp->status);
347 debug("recv %d bytes, status %08x\n", length, status);
348 *packetp = priv->rx_buf;
349
350 return length;
351 }
352
353 return -EAGAIN;
354}
355
356static int altera_tse_free_pkt_msgdma(struct udevice *dev, uchar *packet,
357 int length)
358{
359 struct altera_tse_priv *priv = dev_get_priv(dev);
360 struct msgdma_extended_desc *desc = priv->rx_desc;
361 u32 rx_buf = virt_to_phys(priv->rx_buf);
362
363 writel(0, &desc->read_addr_lo);
364 writel(0, &desc->read_addr_hi);
365 writel(rx_buf, &desc->write_addr_lo);
366 writel(0, &desc->write_addr_hi);
367 writel(PKTSIZE_ALIGN, &desc->len);
368 writel(0, &desc->burst_seq_num);
369 writel(MSGDMA_DESC_RX_STRIDE, &desc->stride);
370 writel(MSGDMA_DESC_CTL_RX_SINGLE, &desc->control);
371 debug("recv setup\n");
372
373 return 0;
374}
375
376static void altera_tse_stop_msgdma(struct udevice *dev)
377{
378 struct altera_tse_priv *priv = dev_get_priv(dev);
379
380 msgdma_reset(priv->sgdma_rx);
381 msgdma_reset(priv->sgdma_tx);
382}
383
Thomas Chouec06dd82015-10-22 15:29:11 +0800384static int tse_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800385{
Thomas Chouec06dd82015-10-22 15:29:11 +0800386 struct altera_tse_priv *priv = bus->priv;
387 struct alt_tse_mac *mac_dev = priv->mac_dev;
Thomas Chou455e9532015-11-06 09:36:26 +0800388 u32 value;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800389
390 /* set mdio address */
Thomas Chouec06dd82015-10-22 15:29:11 +0800391 writel(addr, &mac_dev->mdio_phy1_addr);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800392 /* get the data */
Thomas Chouec06dd82015-10-22 15:29:11 +0800393 value = readl(&mac_dev->mdio_phy1[reg]);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800394
Thomas Chouec06dd82015-10-22 15:29:11 +0800395 return value & 0xffff;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800396}
397
Thomas Chouec06dd82015-10-22 15:29:11 +0800398static int tse_mdio_write(struct mii_dev *bus, int addr, int devad, int reg,
399 u16 val)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800400{
Thomas Chouec06dd82015-10-22 15:29:11 +0800401 struct altera_tse_priv *priv = bus->priv;
402 struct alt_tse_mac *mac_dev = priv->mac_dev;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800403
404 /* set mdio address */
Thomas Chouec06dd82015-10-22 15:29:11 +0800405 writel(addr, &mac_dev->mdio_phy1_addr);
406 /* set the data */
407 writel(val, &mac_dev->mdio_phy1[reg]);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800408
409 return 0;
410}
411
Thomas Chouec06dd82015-10-22 15:29:11 +0800412static int tse_mdio_init(const char *name, struct altera_tse_priv *priv)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800413{
Thomas Chouec06dd82015-10-22 15:29:11 +0800414 struct mii_dev *bus = mdio_alloc();
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800415
Thomas Chouec06dd82015-10-22 15:29:11 +0800416 if (!bus) {
417 printf("Failed to allocate MDIO bus\n");
418 return -ENOMEM;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800419 }
420
Thomas Chouec06dd82015-10-22 15:29:11 +0800421 bus->read = tse_mdio_read;
422 bus->write = tse_mdio_write;
Ben Whitten34fd6c92015-12-30 13:05:58 +0000423 snprintf(bus->name, sizeof(bus->name), "%s", name);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800424
Thomas Chouec06dd82015-10-22 15:29:11 +0800425 bus->priv = (void *)priv;
Joachim Foerster7ce99292011-10-25 22:39:57 +0000426
Thomas Chouec06dd82015-10-22 15:29:11 +0800427 return mdio_register(bus);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800428}
429
Thomas Chouec06dd82015-10-22 15:29:11 +0800430static int tse_phy_init(struct altera_tse_priv *priv, void *dev)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800431{
Thomas Chouec06dd82015-10-22 15:29:11 +0800432 struct phy_device *phydev;
433 unsigned int mask = 0xffffffff;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800434
Thomas Chouec06dd82015-10-22 15:29:11 +0800435 if (priv->phyaddr)
436 mask = 1 << priv->phyaddr;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800437
Thomas Chouec06dd82015-10-22 15:29:11 +0800438 phydev = phy_find_by_mask(priv->bus, mask, priv->interface);
439 if (!phydev)
440 return -ENODEV;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800441
Thomas Chouec06dd82015-10-22 15:29:11 +0800442 phy_connect_dev(phydev, dev);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800443
Thomas Chouec06dd82015-10-22 15:29:11 +0800444 phydev->supported &= PHY_GBIT_FEATURES;
445 phydev->advertising = phydev->supported;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800446
Thomas Chouec06dd82015-10-22 15:29:11 +0800447 priv->phydev = phydev;
448 phy_config(phydev);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800449
Thomas Chouec06dd82015-10-22 15:29:11 +0800450 return 0;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800451}
452
Thomas Chouec06dd82015-10-22 15:29:11 +0800453static int altera_tse_write_hwaddr(struct udevice *dev)
Thomas Chou53d01502010-04-27 20:15:10 +0800454{
Thomas Chouec06dd82015-10-22 15:29:11 +0800455 struct altera_tse_priv *priv = dev_get_priv(dev);
456 struct alt_tse_mac *mac_dev = priv->mac_dev;
Simon Glassfa20e932020-12-03 16:55:20 -0700457 struct eth_pdata *pdata = dev_get_plat(dev);
Thomas Chouec06dd82015-10-22 15:29:11 +0800458 u8 *hwaddr = pdata->enetaddr;
Thomas Chou455e9532015-11-06 09:36:26 +0800459 u32 mac_lo, mac_hi;
Thomas Chou53d01502010-04-27 20:15:10 +0800460
Thomas Chouec06dd82015-10-22 15:29:11 +0800461 mac_lo = (hwaddr[3] << 24) | (hwaddr[2] << 16) |
462 (hwaddr[1] << 8) | hwaddr[0];
463 mac_hi = (hwaddr[5] << 8) | hwaddr[4];
464 debug("Set MAC address to 0x%04x%08x\n", mac_hi, mac_lo);
Thomas Chou53d01502010-04-27 20:15:10 +0800465
Thomas Chouec06dd82015-10-22 15:29:11 +0800466 writel(mac_lo, &mac_dev->mac_addr_0);
467 writel(mac_hi, &mac_dev->mac_addr_1);
468 writel(mac_lo, &mac_dev->supp_mac_addr_0_0);
469 writel(mac_hi, &mac_dev->supp_mac_addr_0_1);
470 writel(mac_lo, &mac_dev->supp_mac_addr_1_0);
471 writel(mac_hi, &mac_dev->supp_mac_addr_1_1);
472 writel(mac_lo, &mac_dev->supp_mac_addr_2_0);
473 writel(mac_hi, &mac_dev->supp_mac_addr_2_1);
474 writel(mac_lo, &mac_dev->supp_mac_addr_3_0);
475 writel(mac_hi, &mac_dev->supp_mac_addr_3_1);
Thomas Chou53d01502010-04-27 20:15:10 +0800476
Thomas Chou53d01502010-04-27 20:15:10 +0800477 return 0;
478}
479
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800480static int altera_tse_send(struct udevice *dev, void *packet, int length)
481{
482 struct altera_tse_priv *priv = dev_get_priv(dev);
483 unsigned long tx_buf = (unsigned long)packet;
484
485 flush_dcache_range(tx_buf, tx_buf + length);
486
487 return priv->ops->send(dev, packet, length);
488}
489
490static int altera_tse_recv(struct udevice *dev, int flags, uchar **packetp)
491{
492 struct altera_tse_priv *priv = dev_get_priv(dev);
493
494 return priv->ops->recv(dev, flags, packetp);
495}
496
497static int altera_tse_free_pkt(struct udevice *dev, uchar *packet,
498 int length)
499{
500 struct altera_tse_priv *priv = dev_get_priv(dev);
501 unsigned long rx_buf = (unsigned long)priv->rx_buf;
502
503 invalidate_dcache_range(rx_buf, rx_buf + PKTSIZE_ALIGN);
504
505 return priv->ops->free_pkt(dev, packet, length);
506}
507
508static void altera_tse_stop(struct udevice *dev)
509{
510 struct altera_tse_priv *priv = dev_get_priv(dev);
511
512 priv->ops->stop(dev);
513 altera_tse_stop_mac(priv);
514}
515
Thomas Chouec06dd82015-10-22 15:29:11 +0800516static int altera_tse_start(struct udevice *dev)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800517{
Thomas Chouec06dd82015-10-22 15:29:11 +0800518 struct altera_tse_priv *priv = dev_get_priv(dev);
519 struct alt_tse_mac *mac_dev = priv->mac_dev;
Thomas Chou455e9532015-11-06 09:36:26 +0800520 u32 val;
Thomas Chouec06dd82015-10-22 15:29:11 +0800521 int ret;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800522
523 /* need to create sgdma */
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800524 debug("Configuring rx desc\n");
Thomas Chouec06dd82015-10-22 15:29:11 +0800525 altera_tse_free_pkt(dev, priv->rx_buf, PKTSIZE_ALIGN);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800526 /* start TSE */
527 debug("Configuring TSE Mac\n");
528 /* Initialize MAC registers */
Thomas Chouec06dd82015-10-22 15:29:11 +0800529 writel(PKTSIZE_ALIGN, &mac_dev->max_frame_length);
530 writel(priv->rx_fifo_depth - 16, &mac_dev->rx_sel_empty_threshold);
531 writel(0, &mac_dev->rx_sel_full_threshold);
532 writel(priv->tx_fifo_depth - 16, &mac_dev->tx_sel_empty_threshold);
533 writel(0, &mac_dev->tx_sel_full_threshold);
534 writel(8, &mac_dev->rx_almost_empty_threshold);
535 writel(8, &mac_dev->rx_almost_full_threshold);
536 writel(8, &mac_dev->tx_almost_empty_threshold);
537 writel(3, &mac_dev->tx_almost_full_threshold);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800538
539 /* NO Shift */
Thomas Chouec06dd82015-10-22 15:29:11 +0800540 writel(0, &mac_dev->rx_cmd_stat);
541 writel(0, &mac_dev->tx_cmd_stat);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800542
543 /* enable MAC */
Thomas Chouec06dd82015-10-22 15:29:11 +0800544 val = ALTERA_TSE_CMD_TX_ENA_MSK | ALTERA_TSE_CMD_RX_ENA_MSK;
545 writel(val, &mac_dev->command_config);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800546
Thomas Chouec06dd82015-10-22 15:29:11 +0800547 /* Start up the PHY */
548 ret = phy_startup(priv->phydev);
549 if (ret) {
550 debug("Could not initialize PHY %s\n",
551 priv->phydev->dev->name);
552 return ret;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800553 }
554
Thomas Chouec06dd82015-10-22 15:29:11 +0800555 tse_adjust_link(priv, priv->phydev);
556
557 if (!priv->phydev->link)
558 return -EIO;
559
560 return 0;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800561}
562
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800563static const struct tse_ops tse_sgdma_ops = {
564 .send = altera_tse_send_sgdma,
565 .recv = altera_tse_recv_sgdma,
566 .free_pkt = altera_tse_free_pkt_sgdma,
567 .stop = altera_tse_stop_sgdma,
568};
569
Thomas Chou9c0a2012015-11-09 14:36:29 +0800570static const struct tse_ops tse_msgdma_ops = {
571 .send = altera_tse_send_msgdma,
572 .recv = altera_tse_recv_msgdma,
573 .free_pkt = altera_tse_free_pkt_msgdma,
574 .stop = altera_tse_stop_msgdma,
575};
576
Thomas Chouec06dd82015-10-22 15:29:11 +0800577static int altera_tse_probe(struct udevice *dev)
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800578{
Simon Glassfa20e932020-12-03 16:55:20 -0700579 struct eth_pdata *pdata = dev_get_plat(dev);
Thomas Chouec06dd82015-10-22 15:29:11 +0800580 struct altera_tse_priv *priv = dev_get_priv(dev);
Thomas Choudde1ffb2015-11-06 09:37:17 +0800581 void *blob = (void *)gd->fdt_blob;
Simon Glassdd79d6e2017-01-17 16:52:55 -0700582 int node = dev_of_offset(dev);
Thomas Chouec06dd82015-10-22 15:29:11 +0800583 const char *list, *end;
584 const fdt32_t *cell;
585 void *base, *desc_mem = NULL;
586 unsigned long addr, size;
Thomas Choudde1ffb2015-11-06 09:37:17 +0800587 int parent, addrc, sizec;
Thomas Chouec06dd82015-10-22 15:29:11 +0800588 int len, idx;
589 int ret;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800590
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800591 priv->dma_type = dev_get_driver_data(dev);
592 if (priv->dma_type == ALT_SGDMA)
593 priv->ops = &tse_sgdma_ops;
Thomas Chou9c0a2012015-11-09 14:36:29 +0800594 else
595 priv->ops = &tse_msgdma_ops;
Thomas Chouec06dd82015-10-22 15:29:11 +0800596 /*
Thomas Choudde1ffb2015-11-06 09:37:17 +0800597 * decode regs. there are multiple reg tuples, and they need to
598 * match with reg-names.
Thomas Chouec06dd82015-10-22 15:29:11 +0800599 */
Thomas Choudde1ffb2015-11-06 09:37:17 +0800600 parent = fdt_parent_offset(blob, node);
Simon Glassbb7c01e2017-05-18 20:09:26 -0600601 fdt_support_default_count_cells(blob, parent, &addrc, &sizec);
Thomas Chouec06dd82015-10-22 15:29:11 +0800602 list = fdt_getprop(blob, node, "reg-names", &len);
603 if (!list)
604 return -ENOENT;
605 end = list + len;
606 cell = fdt_getprop(blob, node, "reg", &len);
607 if (!cell)
608 return -ENOENT;
609 idx = 0;
610 while (list < end) {
611 addr = fdt_translate_address((void *)blob,
612 node, cell + idx);
Thomas Choudde1ffb2015-11-06 09:37:17 +0800613 size = fdt_addr_to_cpu(cell[idx + addrc]);
Thomas Choufb468332015-11-14 11:21:16 +0800614 base = map_physmem(addr, size, MAP_NOCACHE);
Thomas Chouec06dd82015-10-22 15:29:11 +0800615 len = strlen(list);
616 if (strcmp(list, "control_port") == 0)
617 priv->mac_dev = base;
618 else if (strcmp(list, "rx_csr") == 0)
619 priv->sgdma_rx = base;
Thomas Chou9c0a2012015-11-09 14:36:29 +0800620 else if (strcmp(list, "rx_desc") == 0)
621 priv->rx_desc = base;
622 else if (strcmp(list, "rx_resp") == 0)
623 priv->rx_resp = base;
Thomas Chouec06dd82015-10-22 15:29:11 +0800624 else if (strcmp(list, "tx_csr") == 0)
625 priv->sgdma_tx = base;
Thomas Chou9c0a2012015-11-09 14:36:29 +0800626 else if (strcmp(list, "tx_desc") == 0)
627 priv->tx_desc = base;
Thomas Chouec06dd82015-10-22 15:29:11 +0800628 else if (strcmp(list, "s1") == 0)
629 desc_mem = base;
Thomas Choudde1ffb2015-11-06 09:37:17 +0800630 idx += addrc + sizec;
Thomas Chouec06dd82015-10-22 15:29:11 +0800631 list += (len + 1);
632 }
633 /* decode fifo depth */
634 priv->rx_fifo_depth = fdtdec_get_int(blob, node,
635 "rx-fifo-depth", 0);
636 priv->tx_fifo_depth = fdtdec_get_int(blob, node,
637 "tx-fifo-depth", 0);
638 /* decode phy */
639 addr = fdtdec_get_int(blob, node,
640 "phy-handle", 0);
641 addr = fdt_node_offset_by_phandle(blob, addr);
642 priv->phyaddr = fdtdec_get_int(blob, addr,
643 "reg", 0);
644 /* init desc */
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800645 if (priv->dma_type == ALT_SGDMA) {
646 len = sizeof(struct alt_sgdma_descriptor) * 4;
647 if (!desc_mem) {
648 desc_mem = dma_alloc_coherent(len, &addr);
649 if (!desc_mem)
650 return -ENOMEM;
651 }
652 memset(desc_mem, 0, len);
653 priv->tx_desc = desc_mem;
654 priv->rx_desc = priv->tx_desc +
655 2 * sizeof(struct alt_sgdma_descriptor);
Thomas Chouec06dd82015-10-22 15:29:11 +0800656 }
Thomas Chouec06dd82015-10-22 15:29:11 +0800657 /* allocate recv packet buffer */
658 priv->rx_buf = malloc_cache_aligned(PKTSIZE_ALIGN);
659 if (!priv->rx_buf)
660 return -ENOMEM;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800661
Thomas Chouec06dd82015-10-22 15:29:11 +0800662 /* stop controller */
663 debug("Reset TSE & SGDMAs\n");
664 altera_tse_stop(dev);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800665
Thomas Chouec06dd82015-10-22 15:29:11 +0800666 /* start the phy */
667 priv->interface = pdata->phy_interface;
668 tse_mdio_init(dev->name, priv);
669 priv->bus = miiphy_get_dev_by_name(dev->name);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800670
Thomas Chouec06dd82015-10-22 15:29:11 +0800671 ret = tse_phy_init(priv, dev);
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800672
Thomas Chouec06dd82015-10-22 15:29:11 +0800673 return ret;
674}
Joachim Foerstercb0ddaf2011-10-17 05:24:44 +0000675
Simon Glassaad29ae2020-12-03 16:55:21 -0700676static int altera_tse_of_to_plat(struct udevice *dev)
Thomas Chouec06dd82015-10-22 15:29:11 +0800677{
Simon Glassfa20e932020-12-03 16:55:20 -0700678 struct eth_pdata *pdata = dev_get_plat(dev);
Thomas Chouec06dd82015-10-22 15:29:11 +0800679 const char *phy_mode;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800680
Thomas Chouec06dd82015-10-22 15:29:11 +0800681 pdata->phy_interface = -1;
Simon Glassdd79d6e2017-01-17 16:52:55 -0700682 phy_mode = fdt_getprop(gd->fdt_blob, dev_of_offset(dev), "phy-mode",
683 NULL);
Thomas Chouec06dd82015-10-22 15:29:11 +0800684 if (phy_mode)
685 pdata->phy_interface = phy_get_interface_by_name(phy_mode);
686 if (pdata->phy_interface == -1) {
687 debug("%s: Invalid PHY interface '%s'\n", __func__, phy_mode);
688 return -EINVAL;
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800689 }
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800690
Thomas Chouec06dd82015-10-22 15:29:11 +0800691 return 0;
692}
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800693
Thomas Chouec06dd82015-10-22 15:29:11 +0800694static const struct eth_ops altera_tse_ops = {
695 .start = altera_tse_start,
696 .send = altera_tse_send,
697 .recv = altera_tse_recv,
698 .free_pkt = altera_tse_free_pkt,
699 .stop = altera_tse_stop,
700 .write_hwaddr = altera_tse_write_hwaddr,
701};
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800702
Thomas Chouec06dd82015-10-22 15:29:11 +0800703static const struct udevice_id altera_tse_ids[] = {
Thomas Chou9c0a2012015-11-09 14:36:29 +0800704 { .compatible = "altr,tse-msgdma-1.0", .data = ALT_MSGDMA },
Thomas Chou9f9d66a2015-11-09 11:02:15 +0800705 { .compatible = "altr,tse-1.0", .data = ALT_SGDMA },
706 {}
Thomas Chouec06dd82015-10-22 15:29:11 +0800707};
Thomas Chou7bb1b9b2010-04-20 12:49:52 +0800708
Thomas Chouec06dd82015-10-22 15:29:11 +0800709U_BOOT_DRIVER(altera_tse) = {
710 .name = "altera_tse",
711 .id = UCLASS_ETH,
712 .of_match = altera_tse_ids,
713 .ops = &altera_tse_ops,
Simon Glassaad29ae2020-12-03 16:55:21 -0700714 .of_to_plat = altera_tse_of_to_plat,
Simon Glass71fa5b42020-12-03 16:55:18 -0700715 .plat_auto = sizeof(struct eth_pdata),
Simon Glass8a2b47f2020-12-03 16:55:17 -0700716 .priv_auto = sizeof(struct altera_tse_priv),
Thomas Chouec06dd82015-10-22 15:29:11 +0800717 .probe = altera_tse_probe,
718};