blob: 99eab4c68838e755c8ec15a1921753cfc2dc913c [file] [log] [blame]
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +09001/*
Robert P. J. Day8c60f922016-05-04 04:47:31 -04002 * sh_eth.c - Driver for Renesas ethernet controller.
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +09003 *
Nobuhiro Iwamatsu9dfac0a2011-11-14 16:56:59 +09004 * Copyright (C) 2008, 2011 Renesas Solutions Corp.
Nobuhiro Iwamatsu5ba66ad2014-11-04 09:15:48 +09005 * Copyright (c) 2008, 2011, 2014 2014 Nobuhiro Iwamatsu
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +09006 * Copyright (c) 2007 Carlos Munoz <carlos@kenati.com>
Nobuhiro Iwamatsu5ba66ad2014-11-04 09:15:48 +09007 * Copyright (C) 2013, 2014 Renesas Electronics Corporation
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +09008 *
Wolfgang Denkd79de1d2013-07-08 09:37:19 +02009 * SPDX-License-Identifier: GPL-2.0+
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090010 */
11
12#include <config.h>
13#include <common.h>
14#include <malloc.h>
15#include <net.h>
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +090016#include <netdev.h>
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +090017#include <miiphy.h>
Masahiro Yamada56a931c2016-09-21 11:28:55 +090018#include <linux/errno.h>
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090019#include <asm/io.h>
20
21#include "sh_eth.h"
22
23#ifndef CONFIG_SH_ETHER_USE_PORT
24# error "Please define CONFIG_SH_ETHER_USE_PORT"
25#endif
26#ifndef CONFIG_SH_ETHER_PHY_ADDR
27# error "Please define CONFIG_SH_ETHER_PHY_ADDR"
28#endif
Nobuhiro Iwamatsu6bff09d2013-08-22 13:22:01 +090029
Nobuhiro Iwamatsuee74c702013-08-22 13:22:03 +090030#if defined(CONFIG_SH_ETHER_CACHE_WRITEBACK) && !defined(CONFIG_SYS_DCACHE_OFF)
31#define flush_cache_wback(addr, len) \
Nobuhiro Iwamatsu425a3a52017-12-01 13:56:08 +090032 flush_dcache_range((u32)addr, \
33 (u32)(addr + ALIGN(len, CONFIG_SH_ETHER_ALIGNE_SIZE)))
Yoshihiro Shimoda281aa052011-01-27 10:06:08 +090034#else
35#define flush_cache_wback(...)
36#endif
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090037
Nobuhiro Iwamatsuee74c702013-08-22 13:22:03 +090038#if defined(CONFIG_SH_ETHER_CACHE_INVALIDATE) && defined(CONFIG_ARM)
39#define invalidate_cache(addr, len) \
40 { \
41 u32 line_size = CONFIG_SH_ETHER_ALIGNE_SIZE; \
42 u32 start, end; \
43 \
44 start = (u32)addr; \
45 end = start + len; \
46 start &= ~(line_size - 1); \
47 end = ((end + line_size - 1) & ~(line_size - 1)); \
48 \
49 invalidate_dcache_range(start, end); \
50 }
51#else
52#define invalidate_cache(...)
53#endif
54
Nobuhiro Iwamatsu71f507c2012-01-11 10:23:51 +090055#define TIMEOUT_CNT 1000
56
Marek Vasut044eb2d2018-01-21 14:27:51 +010057static int sh_eth_send_common(struct sh_eth_dev *eth, void *packet, int len)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090058{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +090059 int port = eth->port, ret = 0, timeout;
60 struct sh_eth_info *port_info = &eth->port_info[port];
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090061
62 if (!packet || len > 0xffff) {
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +090063 printf(SHETHER_NAME ": %s: Invalid argument\n", __func__);
64 ret = -EINVAL;
65 goto err;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090066 }
67
68 /* packet must be a 4 byte boundary */
Nobuhiro Iwamatsu58802902012-02-02 21:28:49 +000069 if ((int)packet & 3) {
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +090070 printf(SHETHER_NAME ": %s: packet not 4 byte aligned\n"
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +090071 , __func__);
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +090072 ret = -EFAULT;
73 goto err;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090074 }
75
76 /* Update tx descriptor */
Yoshihiro Shimoda281aa052011-01-27 10:06:08 +090077 flush_cache_wback(packet, len);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090078 port_info->tx_desc_cur->td2 = ADDR_TO_PHY(packet);
79 port_info->tx_desc_cur->td1 = len << 16;
80 /* Must preserve the end of descriptor list indication */
81 if (port_info->tx_desc_cur->td0 & TD_TDLE)
82 port_info->tx_desc_cur->td0 = TD_TACT | TD_TFP | TD_TDLE;
83 else
84 port_info->tx_desc_cur->td0 = TD_TACT | TD_TFP;
85
Nobuhiro Iwamatsu5ba66ad2014-11-04 09:15:48 +090086 flush_cache_wback(port_info->tx_desc_cur, sizeof(struct tx_desc_s));
87
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090088 /* Restart the transmitter if disabled */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +090089 if (!(sh_eth_read(port_info, EDTRR) & EDTRR_TRNS))
90 sh_eth_write(port_info, EDTRR_TRNS, EDTRR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090091
92 /* Wait until packet is transmitted */
Nobuhiro Iwamatsu71f507c2012-01-11 10:23:51 +090093 timeout = TIMEOUT_CNT;
Nobuhiro Iwamatsuee74c702013-08-22 13:22:03 +090094 do {
95 invalidate_cache(port_info->tx_desc_cur,
96 sizeof(struct tx_desc_s));
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090097 udelay(100);
Nobuhiro Iwamatsuee74c702013-08-22 13:22:03 +090098 } while (port_info->tx_desc_cur->td0 & TD_TACT && timeout--);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +090099
100 if (timeout < 0) {
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900101 printf(SHETHER_NAME ": transmit timeout\n");
102 ret = -ETIMEDOUT;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900103 goto err;
104 }
105
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900106 port_info->tx_desc_cur++;
107 if (port_info->tx_desc_cur >= port_info->tx_desc_base + NUM_TX_DESC)
108 port_info->tx_desc_cur = port_info->tx_desc_base;
109
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900110err:
111 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900112}
113
Marek Vasut044eb2d2018-01-21 14:27:51 +0100114static int sh_eth_send_legacy(struct eth_device *dev, void *packet, int len)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900115{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900116 struct sh_eth_dev *eth = dev->priv;
Marek Vasut044eb2d2018-01-21 14:27:51 +0100117
118 return sh_eth_send_common(eth, packet, len);
119}
120
Marek Vasut48de90d2018-01-21 15:39:50 +0100121static int sh_eth_recv_start(struct sh_eth_dev *eth)
Marek Vasut044eb2d2018-01-21 14:27:51 +0100122{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900123 int port = eth->port, len = 0;
124 struct sh_eth_info *port_info = &eth->port_info[port];
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900125
126 /* Check if the rx descriptor is ready */
Nobuhiro Iwamatsuee74c702013-08-22 13:22:03 +0900127 invalidate_cache(port_info->rx_desc_cur, sizeof(struct rx_desc_s));
Marek Vasut48de90d2018-01-21 15:39:50 +0100128 if (port_info->rx_desc_cur->rd0 & RD_RACT)
129 return -EINVAL;
130
131 /* Check for errors */
132 if (port_info->rx_desc_cur->rd0 & RD_RFE)
133 return -EINVAL;
134
135 len = port_info->rx_desc_cur->rd1 & 0xffff;
136
137 return len;
138}
139
140static void sh_eth_recv_finish(struct sh_eth_dev *eth)
141{
142 struct sh_eth_info *port_info = &eth->port_info[eth->port];
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900143
Marek Vasut48de90d2018-01-21 15:39:50 +0100144 /* Make current descriptor available again */
145 if (port_info->rx_desc_cur->rd0 & RD_RDLE)
146 port_info->rx_desc_cur->rd0 = RD_RACT | RD_RDLE;
147 else
148 port_info->rx_desc_cur->rd0 = RD_RACT;
Nobuhiro Iwamatsu5ba66ad2014-11-04 09:15:48 +0900149
Marek Vasut48de90d2018-01-21 15:39:50 +0100150 flush_cache_wback(port_info->rx_desc_cur,
151 sizeof(struct rx_desc_s));
152
153 /* Point to the next descriptor */
154 port_info->rx_desc_cur++;
155 if (port_info->rx_desc_cur >=
156 port_info->rx_desc_base + NUM_RX_DESC)
157 port_info->rx_desc_cur = port_info->rx_desc_base;
158}
159
160static int sh_eth_recv_common(struct sh_eth_dev *eth)
161{
162 int port = eth->port, len = 0;
163 struct sh_eth_info *port_info = &eth->port_info[port];
164 uchar *packet = (uchar *)ADDR_TO_P2(port_info->rx_desc_cur->rd2);
Nobuhiro Iwamatsu5ba66ad2014-11-04 09:15:48 +0900165
Marek Vasut48de90d2018-01-21 15:39:50 +0100166 len = sh_eth_recv_start(eth);
167 if (len > 0) {
168 invalidate_cache(packet, len);
169 net_process_received_packet(packet, len);
170 sh_eth_recv_finish(eth);
171 } else
172 len = 0;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900173
174 /* Restart the receiver if disabled */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900175 if (!(sh_eth_read(port_info, EDRRR) & EDRRR_R))
176 sh_eth_write(port_info, EDRRR_R, EDRRR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900177
178 return len;
179}
180
Marek Vasut044eb2d2018-01-21 14:27:51 +0100181static int sh_eth_recv_legacy(struct eth_device *dev)
182{
183 struct sh_eth_dev *eth = dev->priv;
184
185 return sh_eth_recv_common(eth);
186}
187
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900188static int sh_eth_reset(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900189{
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900190 struct sh_eth_info *port_info = &eth->port_info[eth->port];
Nobuhiro Iwamatsu46288f42014-01-23 07:52:18 +0900191#if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900192 int ret = 0, i;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900193
194 /* Start e-dmac transmitter and receiver */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900195 sh_eth_write(port_info, EDSR_ENALL, EDSR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900196
197 /* Perform a software reset and wait for it to complete */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900198 sh_eth_write(port_info, EDMR_SRST, EDMR);
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900199 for (i = 0; i < TIMEOUT_CNT; i++) {
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900200 if (!(sh_eth_read(port_info, EDMR) & EDMR_SRST))
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900201 break;
202 udelay(1000);
203 }
204
Nobuhiro Iwamatsu71f507c2012-01-11 10:23:51 +0900205 if (i == TIMEOUT_CNT) {
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900206 printf(SHETHER_NAME ": Software reset timeout\n");
207 ret = -EIO;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900208 }
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900209
210 return ret;
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900211#else
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900212 sh_eth_write(port_info, sh_eth_read(port_info, EDMR) | EDMR_SRST, EDMR);
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900213 udelay(3000);
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900214 sh_eth_write(port_info,
215 sh_eth_read(port_info, EDMR) & ~EDMR_SRST, EDMR);
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900216
217 return 0;
218#endif
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900219}
220
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900221static int sh_eth_tx_desc_init(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900222{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900223 int port = eth->port, i, ret = 0;
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900224 u32 alloc_desc_size = NUM_TX_DESC * sizeof(struct tx_desc_s);
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900225 struct sh_eth_info *port_info = &eth->port_info[port];
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900226 struct tx_desc_s *cur_tx_desc;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900227
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900228 /*
Nobuhiro Iwamatsuc24b3eb2014-11-04 09:15:46 +0900229 * Allocate rx descriptors. They must be aligned to size of struct
230 * tx_desc_s.
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900231 */
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900232 port_info->tx_desc_alloc =
233 memalign(sizeof(struct tx_desc_s), alloc_desc_size);
234 if (!port_info->tx_desc_alloc) {
235 printf(SHETHER_NAME ": memalign failed\n");
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900236 ret = -ENOMEM;
237 goto err;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900238 }
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900239
Nobuhiro Iwamatsu425a3a52017-12-01 13:56:08 +0900240 flush_cache_wback(port_info->tx_desc_alloc, alloc_desc_size);
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900241
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900242 /* Make sure we use a P2 address (non-cacheable) */
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900243 port_info->tx_desc_base =
244 (struct tx_desc_s *)ADDR_TO_P2((u32)port_info->tx_desc_alloc);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900245 port_info->tx_desc_cur = port_info->tx_desc_base;
246
247 /* Initialize all descriptors */
248 for (cur_tx_desc = port_info->tx_desc_base, i = 0; i < NUM_TX_DESC;
249 cur_tx_desc++, i++) {
250 cur_tx_desc->td0 = 0x00;
251 cur_tx_desc->td1 = 0x00;
252 cur_tx_desc->td2 = 0x00;
253 }
254
255 /* Mark the end of the descriptors */
256 cur_tx_desc--;
257 cur_tx_desc->td0 |= TD_TDLE;
258
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900259 /*
260 * Point the controller to the tx descriptor list. Must use physical
261 * addresses
262 */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900263 sh_eth_write(port_info, ADDR_TO_PHY(port_info->tx_desc_base), TDLAR);
Nobuhiro Iwamatsu46288f42014-01-23 07:52:18 +0900264#if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900265 sh_eth_write(port_info, ADDR_TO_PHY(port_info->tx_desc_base), TDFAR);
266 sh_eth_write(port_info, ADDR_TO_PHY(cur_tx_desc), TDFXR);
267 sh_eth_write(port_info, 0x01, TDFFR);/* Last discriptor bit */
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900268#endif
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900269
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900270err:
271 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900272}
273
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900274static int sh_eth_rx_desc_init(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900275{
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900276 int port = eth->port, i, ret = 0;
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900277 u32 alloc_desc_size = NUM_RX_DESC * sizeof(struct rx_desc_s);
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900278 struct sh_eth_info *port_info = &eth->port_info[port];
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900279 struct rx_desc_s *cur_rx_desc;
280 u8 *rx_buf;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900281
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900282 /*
Nobuhiro Iwamatsuc24b3eb2014-11-04 09:15:46 +0900283 * Allocate rx descriptors. They must be aligned to size of struct
284 * rx_desc_s.
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900285 */
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900286 port_info->rx_desc_alloc =
287 memalign(sizeof(struct rx_desc_s), alloc_desc_size);
288 if (!port_info->rx_desc_alloc) {
289 printf(SHETHER_NAME ": memalign failed\n");
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900290 ret = -ENOMEM;
291 goto err;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900292 }
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900293
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900294 flush_cache_wback(port_info->rx_desc_alloc, alloc_desc_size);
295
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900296 /* Make sure we use a P2 address (non-cacheable) */
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900297 port_info->rx_desc_base =
298 (struct rx_desc_s *)ADDR_TO_P2((u32)port_info->rx_desc_alloc);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900299
300 port_info->rx_desc_cur = port_info->rx_desc_base;
301
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900302 /*
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900303 * Allocate rx data buffers. They must be RX_BUF_ALIGNE_SIZE bytes
304 * aligned and in P2 area.
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900305 */
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900306 port_info->rx_buf_alloc =
307 memalign(RX_BUF_ALIGNE_SIZE, NUM_RX_DESC * MAX_BUF_SIZE);
308 if (!port_info->rx_buf_alloc) {
309 printf(SHETHER_NAME ": alloc failed\n");
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900310 ret = -ENOMEM;
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900311 goto err_buf_alloc;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900312 }
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900313
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900314 port_info->rx_buf_base = (u8 *)ADDR_TO_P2((u32)port_info->rx_buf_alloc);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900315
316 /* Initialize all descriptors */
317 for (cur_rx_desc = port_info->rx_desc_base,
318 rx_buf = port_info->rx_buf_base, i = 0;
319 i < NUM_RX_DESC; cur_rx_desc++, rx_buf += MAX_BUF_SIZE, i++) {
320 cur_rx_desc->rd0 = RD_RACT;
321 cur_rx_desc->rd1 = MAX_BUF_SIZE << 16;
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900322 cur_rx_desc->rd2 = (u32)ADDR_TO_PHY(rx_buf);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900323 }
324
325 /* Mark the end of the descriptors */
326 cur_rx_desc--;
327 cur_rx_desc->rd0 |= RD_RDLE;
328
329 /* Point the controller to the rx descriptor list */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900330 sh_eth_write(port_info, ADDR_TO_PHY(port_info->rx_desc_base), RDLAR);
Nobuhiro Iwamatsu46288f42014-01-23 07:52:18 +0900331#if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900332 sh_eth_write(port_info, ADDR_TO_PHY(port_info->rx_desc_base), RDFAR);
333 sh_eth_write(port_info, ADDR_TO_PHY(cur_rx_desc), RDFXR);
334 sh_eth_write(port_info, RDFFR_RDLF, RDFFR);
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900335#endif
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900336
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900337 return ret;
338
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900339err_buf_alloc:
340 free(port_info->rx_desc_alloc);
341 port_info->rx_desc_alloc = NULL;
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900342
343err:
344 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900345}
346
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900347static void sh_eth_tx_desc_free(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900348{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900349 int port = eth->port;
350 struct sh_eth_info *port_info = &eth->port_info[port];
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900351
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900352 if (port_info->tx_desc_alloc) {
353 free(port_info->tx_desc_alloc);
354 port_info->tx_desc_alloc = NULL;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900355 }
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900356}
357
358static void sh_eth_rx_desc_free(struct sh_eth_dev *eth)
359{
360 int port = eth->port;
361 struct sh_eth_info *port_info = &eth->port_info[port];
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900362
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900363 if (port_info->rx_desc_alloc) {
364 free(port_info->rx_desc_alloc);
365 port_info->rx_desc_alloc = NULL;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900366 }
367
Nobuhiro Iwamatsu1c822112014-11-04 09:15:47 +0900368 if (port_info->rx_buf_alloc) {
369 free(port_info->rx_buf_alloc);
370 port_info->rx_buf_alloc = NULL;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900371 }
372}
373
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900374static int sh_eth_desc_init(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900375{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900376 int ret = 0;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900377
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900378 ret = sh_eth_tx_desc_init(eth);
379 if (ret)
380 goto err_tx_init;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900381
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900382 ret = sh_eth_rx_desc_init(eth);
383 if (ret)
384 goto err_rx_init;
385
386 return ret;
387err_rx_init:
388 sh_eth_tx_desc_free(eth);
389
390err_tx_init:
391 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900392}
393
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900394static int sh_eth_phy_config(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900395{
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900396 int port = eth->port, ret = 0;
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900397 struct sh_eth_info *port_info = &eth->port_info[port];
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900398 struct eth_device *dev = port_info->dev;
399 struct phy_device *phydev;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900400
Nobuhiro Iwamatsu58802902012-02-02 21:28:49 +0000401 phydev = phy_connect(
402 miiphy_get_dev_by_name(dev->name),
Nobuhiro Iwamatsu475f40d2012-05-15 15:49:39 +0000403 port_info->phy_addr, dev, CONFIG_SH_ETHER_PHY_MODE);
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900404 port_info->phydev = phydev;
405 phy_config(phydev);
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900406
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900407 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900408}
409
Nobuhiro Iwamatsu65a81a42017-12-01 08:08:47 +0900410static int sh_eth_config(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900411{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900412 int port = eth->port, ret = 0;
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900413 u32 val;
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900414 struct sh_eth_info *port_info = &eth->port_info[port];
Mike Frysingera86bf132009-02-11 19:14:09 -0500415 struct eth_device *dev = port_info->dev;
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900416 struct phy_device *phy;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900417
418 /* Configure e-dmac registers */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900419 sh_eth_write(port_info, (sh_eth_read(port_info, EDMR) & ~EMDR_DESC_R) |
Nobuhiro Iwamatsu7a2142c2013-08-22 13:22:02 +0900420 (EMDR_DESC | EDMR_EL), EDMR);
421
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900422 sh_eth_write(port_info, 0, EESIPR);
423 sh_eth_write(port_info, 0, TRSCER);
424 sh_eth_write(port_info, 0, TFTR);
425 sh_eth_write(port_info, (FIFO_SIZE_T | FIFO_SIZE_R), FDR);
426 sh_eth_write(port_info, RMCR_RST, RMCR);
Nobuhiro Iwamatsu46288f42014-01-23 07:52:18 +0900427#if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900428 sh_eth_write(port_info, 0, RPADIR);
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900429#endif
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900430 sh_eth_write(port_info, (FIFO_F_D_RFF | FIFO_F_D_RFD), FCFTR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900431
432 /* Configure e-mac registers */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900433 sh_eth_write(port_info, 0, ECSIPR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900434
435 /* Set Mac address */
Mike Frysingera86bf132009-02-11 19:14:09 -0500436 val = dev->enetaddr[0] << 24 | dev->enetaddr[1] << 16 |
437 dev->enetaddr[2] << 8 | dev->enetaddr[3];
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900438 sh_eth_write(port_info, val, MAHR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900439
Mike Frysingera86bf132009-02-11 19:14:09 -0500440 val = dev->enetaddr[4] << 8 | dev->enetaddr[5];
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900441 sh_eth_write(port_info, val, MALR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900442
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900443 sh_eth_write(port_info, RFLR_RFL_MIN, RFLR);
Yoshihiro Shimoda9d553032012-06-26 16:38:06 +0000444#if defined(SH_ETH_TYPE_GETHER)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900445 sh_eth_write(port_info, 0, PIPR);
Nobuhiro Iwamatsu46288f42014-01-23 07:52:18 +0900446#endif
447#if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900448 sh_eth_write(port_info, APR_AP, APR);
449 sh_eth_write(port_info, MPR_MP, MPR);
450 sh_eth_write(port_info, TPAUSER_TPAUSE, TPAUSER);
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900451#endif
Nobuhiro Iwamatsu9dfac0a2011-11-14 16:56:59 +0900452
Nobuhiro Iwamatsu4ad2c2a2012-08-02 22:08:40 +0000453#if defined(CONFIG_CPU_SH7734) || defined(CONFIG_R8A7740)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900454 sh_eth_write(port_info, CONFIG_SH_ETHER_SH7734_MII, RMII_MII);
Marek Vasutee2f21b2018-01-22 01:42:32 +0100455#elif defined(CONFIG_RCAR_GEN2)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900456 sh_eth_write(port_info, sh_eth_read(port_info, RMIIMR) | 0x1, RMIIMR);
Nobuhiro Iwamatsu475f40d2012-05-15 15:49:39 +0000457#endif
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900458 /* Configure phy */
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900459 ret = sh_eth_phy_config(eth);
460 if (ret) {
Nobuhiro Iwamatsufc4b0a22009-06-25 16:33:04 +0900461 printf(SHETHER_NAME ": phy config timeout\n");
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900462 goto err_phy_cfg;
463 }
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900464 phy = port_info->phydev;
Timur Tabi42387462012-07-09 08:52:43 +0000465 ret = phy_startup(phy);
466 if (ret) {
467 printf(SHETHER_NAME ": phy startup failure\n");
468 return ret;
469 }
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900470
Nobuhiro Iwamatsu9dfac0a2011-11-14 16:56:59 +0900471 val = 0;
472
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900473 /* Set the transfer speed */
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900474 if (phy->speed == 100) {
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900475 printf(SHETHER_NAME ": 100Base/");
Yoshihiro Shimoda9d553032012-06-26 16:38:06 +0000476#if defined(SH_ETH_TYPE_GETHER)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900477 sh_eth_write(port_info, GECMR_100B, GECMR);
Yoshihiro Shimodad27e8c92012-11-04 15:54:30 +0000478#elif defined(CONFIG_CPU_SH7757) || defined(CONFIG_CPU_SH7752)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900479 sh_eth_write(port_info, 1, RTRATE);
Marek Vasutee2f21b2018-01-22 01:42:32 +0100480#elif defined(CONFIG_CPU_SH7724) || defined(CONFIG_RCAR_GEN2)
Nobuhiro Iwamatsu9dfac0a2011-11-14 16:56:59 +0900481 val = ECMR_RTM;
482#endif
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900483 } else if (phy->speed == 10) {
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900484 printf(SHETHER_NAME ": 10Base/");
Yoshihiro Shimoda9d553032012-06-26 16:38:06 +0000485#if defined(SH_ETH_TYPE_GETHER)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900486 sh_eth_write(port_info, GECMR_10B, GECMR);
Yoshihiro Shimodad27e8c92012-11-04 15:54:30 +0000487#elif defined(CONFIG_CPU_SH7757) || defined(CONFIG_CPU_SH7752)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900488 sh_eth_write(port_info, 0, RTRATE);
Yoshihiro Shimoda34cca922011-01-18 17:53:45 +0900489#endif
Nobuhiro Iwamatsu9dfac0a2011-11-14 16:56:59 +0900490 }
Yoshihiro Shimoda9d553032012-06-26 16:38:06 +0000491#if defined(SH_ETH_TYPE_GETHER)
Nobuhiro Iwamatsu475f40d2012-05-15 15:49:39 +0000492 else if (phy->speed == 1000) {
493 printf(SHETHER_NAME ": 1000Base/");
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900494 sh_eth_write(port_info, GECMR_1000B, GECMR);
Nobuhiro Iwamatsu475f40d2012-05-15 15:49:39 +0000495 }
496#endif
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900497
498 /* Check if full duplex mode is supported by the phy */
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900499 if (phy->duplex) {
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900500 printf("Full\n");
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900501 sh_eth_write(port_info,
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900502 val | (ECMR_CHG_DM | ECMR_RE | ECMR_TE | ECMR_DM),
Yoshihiro Shimoda4c4aa6c2012-06-26 16:38:09 +0000503 ECMR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900504 } else {
505 printf("Half\n");
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900506 sh_eth_write(port_info,
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900507 val | (ECMR_CHG_DM | ECMR_RE | ECMR_TE),
508 ECMR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900509 }
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900510
511 return ret;
512
513err_phy_cfg:
514 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900515}
516
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900517static void sh_eth_start(struct sh_eth_dev *eth)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900518{
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900519 struct sh_eth_info *port_info = &eth->port_info[eth->port];
520
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900521 /*
522 * Enable the e-dmac receiver only. The transmitter will be enabled when
523 * we have something to transmit
524 */
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900525 sh_eth_write(port_info, EDRRR_R, EDRRR);
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900526}
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900527
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900528static void sh_eth_stop(struct sh_eth_dev *eth)
529{
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900530 struct sh_eth_info *port_info = &eth->port_info[eth->port];
531
532 sh_eth_write(port_info, ~EDRRR_R, EDRRR);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900533}
534
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900535int sh_eth_init(struct eth_device *dev, bd_t *bd)
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900536{
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900537 int ret = 0;
538 struct sh_eth_dev *eth = dev->priv;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900539
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900540 ret = sh_eth_reset(eth);
541 if (ret)
542 goto err;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900543
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900544 ret = sh_eth_desc_init(eth);
545 if (ret)
546 goto err;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900547
Nobuhiro Iwamatsu65a81a42017-12-01 08:08:47 +0900548 ret = sh_eth_config(eth);
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900549 if (ret)
550 goto err_config;
551
552 sh_eth_start(eth);
553
554 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900555
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900556err_config:
557 sh_eth_tx_desc_free(eth);
558 sh_eth_rx_desc_free(eth);
559
560err:
561 return ret;
562}
563
564void sh_eth_halt(struct eth_device *dev)
565{
566 struct sh_eth_dev *eth = dev->priv;
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900567
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900568 sh_eth_stop(eth);
569}
570
571int sh_eth_initialize(bd_t *bd)
572{
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900573 int ret = 0;
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900574 struct sh_eth_dev *eth = NULL;
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900575 struct eth_device *dev = NULL;
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900576 struct mii_dev *mdiodev;
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900577
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900578 eth = (struct sh_eth_dev *)malloc(sizeof(struct sh_eth_dev));
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900579 if (!eth) {
580 printf(SHETHER_NAME ": %s: malloc failed\n", __func__);
581 ret = -ENOMEM;
582 goto err;
583 }
584
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900585 dev = (struct eth_device *)malloc(sizeof(struct eth_device));
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900586 if (!dev) {
587 printf(SHETHER_NAME ": %s: malloc failed\n", __func__);
588 ret = -ENOMEM;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900589 goto err;
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900590 }
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900591 memset(dev, 0, sizeof(struct eth_device));
592 memset(eth, 0, sizeof(struct sh_eth_dev));
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900593
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900594 eth->port = CONFIG_SH_ETHER_USE_PORT;
595 eth->port_info[eth->port].phy_addr = CONFIG_SH_ETHER_PHY_ADDR;
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900596 eth->port_info[eth->port].iobase =
597 (void __iomem *)(BASE_IO_ADDR + 0x800 * eth->port);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900598
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900599 dev->priv = (void *)eth;
600 dev->iobase = 0;
601 dev->init = sh_eth_init;
602 dev->halt = sh_eth_halt;
Marek Vasut044eb2d2018-01-21 14:27:51 +0100603 dev->send = sh_eth_send_legacy;
604 dev->recv = sh_eth_recv_legacy;
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900605 eth->port_info[eth->port].dev = dev;
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900606
Ben Whitten34fd6c92015-12-30 13:05:58 +0000607 strcpy(dev->name, SHETHER_NAME);
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900608
Nobuhiro Iwamatsu31e84df2014-01-23 07:52:19 +0900609 /* Register Device to EtherNet subsystem */
610 eth_register(dev);
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900611
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900612 bb_miiphy_buses[0].priv = eth;
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900613 mdiodev = mdio_alloc();
Joe Hershberger1fbcbed2016-08-08 11:28:38 -0500614 if (!mdiodev)
615 return -ENOMEM;
616 strncpy(mdiodev->name, dev->name, MDIO_NAME_LEN);
617 mdiodev->read = bb_miiphy_read;
618 mdiodev->write = bb_miiphy_write;
619
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900620 ret = mdio_register(mdiodev);
621 if (ret < 0)
622 return ret;
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900623
Simon Glass399a9ce2017-08-03 12:22:14 -0600624 if (!eth_env_get_enetaddr("ethaddr", dev->enetaddr))
Mike Frysingera86bf132009-02-11 19:14:09 -0500625 puts("Please set MAC address\n");
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900626
627 return ret;
628
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900629err:
Nobuhiro Iwamatsud8f5d502008-11-21 12:04:18 +0900630 if (dev)
631 free(dev);
632
633 if (eth)
634 free(eth);
635
636 printf(SHETHER_NAME ": Failed\n");
637 return ret;
Nobuhiro Iwamatsu240b7232008-06-11 21:05:00 +0900638}
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900639
640/******* for bb_miiphy *******/
641static int sh_eth_bb_init(struct bb_miiphy_bus *bus)
642{
643 return 0;
644}
645
646static int sh_eth_bb_mdio_active(struct bb_miiphy_bus *bus)
647{
648 struct sh_eth_dev *eth = bus->priv;
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900649 struct sh_eth_info *port_info = &eth->port_info[eth->port];
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900650
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900651 sh_eth_write(port_info, sh_eth_read(port_info, PIR) | PIR_MMD, PIR);
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900652
653 return 0;
654}
655
656static int sh_eth_bb_mdio_tristate(struct bb_miiphy_bus *bus)
657{
658 struct sh_eth_dev *eth = bus->priv;
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900659 struct sh_eth_info *port_info = &eth->port_info[eth->port];
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900660
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900661 sh_eth_write(port_info, sh_eth_read(port_info, PIR) & ~PIR_MMD, PIR);
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900662
663 return 0;
664}
665
666static int sh_eth_bb_set_mdio(struct bb_miiphy_bus *bus, int v)
667{
668 struct sh_eth_dev *eth = bus->priv;
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900669 struct sh_eth_info *port_info = &eth->port_info[eth->port];
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900670
671 if (v)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900672 sh_eth_write(port_info,
673 sh_eth_read(port_info, PIR) | PIR_MDO, PIR);
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900674 else
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900675 sh_eth_write(port_info,
676 sh_eth_read(port_info, PIR) & ~PIR_MDO, PIR);
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900677
678 return 0;
679}
680
681static int sh_eth_bb_get_mdio(struct bb_miiphy_bus *bus, int *v)
682{
683 struct sh_eth_dev *eth = bus->priv;
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900684 struct sh_eth_info *port_info = &eth->port_info[eth->port];
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900685
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900686 *v = (sh_eth_read(port_info, PIR) & PIR_MDI) >> 3;
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900687
688 return 0;
689}
690
691static int sh_eth_bb_set_mdc(struct bb_miiphy_bus *bus, int v)
692{
693 struct sh_eth_dev *eth = bus->priv;
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900694 struct sh_eth_info *port_info = &eth->port_info[eth->port];
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900695
696 if (v)
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900697 sh_eth_write(port_info,
698 sh_eth_read(port_info, PIR) | PIR_MDC, PIR);
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900699 else
Nobuhiro Iwamatsuec921f12017-12-01 08:10:32 +0900700 sh_eth_write(port_info,
701 sh_eth_read(port_info, PIR) & ~PIR_MDC, PIR);
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900702
703 return 0;
704}
705
706static int sh_eth_bb_delay(struct bb_miiphy_bus *bus)
707{
708 udelay(10);
709
710 return 0;
711}
712
713struct bb_miiphy_bus bb_miiphy_buses[] = {
714 {
715 .name = "sh_eth",
716 .init = sh_eth_bb_init,
717 .mdio_active = sh_eth_bb_mdio_active,
718 .mdio_tristate = sh_eth_bb_mdio_tristate,
719 .set_mdio = sh_eth_bb_set_mdio,
720 .get_mdio = sh_eth_bb_get_mdio,
721 .set_mdc = sh_eth_bb_set_mdc,
722 .delay = sh_eth_bb_delay,
723 }
724};
Nobuhiro Iwamatsuca36b0e2017-12-01 08:08:00 +0900725
Yoshihiro Shimoda677f6cd2011-10-11 18:10:14 +0900726int bb_miiphy_buses_num = ARRAY_SIZE(bb_miiphy_buses);