xref: /openbmc/u-boot/drivers/net/sh_eth.c (revision c4f80f50)
1 /*
2  * sh_eth.c - Driver for Renesas ethernet controler.
3  *
4  * Copyright (C) 2008, 2011 Renesas Solutions Corp.
5  * Copyright (c) 2008, 2011 Nobuhiro Iwamatsu
6  * Copyright (c) 2007 Carlos Munoz <carlos@kenati.com>
7  * Copyright (C) 2013  Renesas Electronics Corporation
8  *
9  * SPDX-License-Identifier:	GPL-2.0+
10  */
11 
12 #include <config.h>
13 #include <common.h>
14 #include <malloc.h>
15 #include <net.h>
16 #include <netdev.h>
17 #include <miiphy.h>
18 #include <asm/errno.h>
19 #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
29 
30 #if defined(CONFIG_SH_ETHER_CACHE_WRITEBACK) && !defined(CONFIG_SYS_DCACHE_OFF)
31 #define flush_cache_wback(addr, len)    \
32 		flush_dcache_range((u32)addr, (u32)(addr + len - 1))
33 #else
34 #define flush_cache_wback(...)
35 #endif
36 
37 #if defined(CONFIG_SH_ETHER_CACHE_INVALIDATE) && defined(CONFIG_ARM)
38 #define invalidate_cache(addr, len)		\
39 	{	\
40 		u32 line_size = CONFIG_SH_ETHER_ALIGNE_SIZE;	\
41 		u32 start, end;	\
42 		\
43 		start = (u32)addr;	\
44 		end = start + len;	\
45 		start &= ~(line_size - 1);	\
46 		end = ((end + line_size - 1) & ~(line_size - 1));	\
47 		\
48 		invalidate_dcache_range(start, end);	\
49 	}
50 #else
51 #define invalidate_cache(...)
52 #endif
53 
54 #define TIMEOUT_CNT 1000
55 
56 int sh_eth_send(struct eth_device *dev, void *packet, int len)
57 {
58 	struct sh_eth_dev *eth = dev->priv;
59 	int port = eth->port, ret = 0, timeout;
60 	struct sh_eth_info *port_info = &eth->port_info[port];
61 
62 	if (!packet || len > 0xffff) {
63 		printf(SHETHER_NAME ": %s: Invalid argument\n", __func__);
64 		ret = -EINVAL;
65 		goto err;
66 	}
67 
68 	/* packet must be a 4 byte boundary */
69 	if ((int)packet & 3) {
70 		printf(SHETHER_NAME ": %s: packet not 4 byte alligned\n"
71 				, __func__);
72 		ret = -EFAULT;
73 		goto err;
74 	}
75 
76 	/* Update tx descriptor */
77 	flush_cache_wback(packet, len);
78 	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 
86 	/* Restart the transmitter if disabled */
87 	if (!(sh_eth_read(eth, EDTRR) & EDTRR_TRNS))
88 		sh_eth_write(eth, EDTRR_TRNS, EDTRR);
89 
90 	/* Wait until packet is transmitted */
91 	timeout = TIMEOUT_CNT;
92 	do {
93 		invalidate_cache(port_info->tx_desc_cur,
94 				 sizeof(struct tx_desc_s));
95 		udelay(100);
96 	} while (port_info->tx_desc_cur->td0 & TD_TACT && timeout--);
97 
98 	if (timeout < 0) {
99 		printf(SHETHER_NAME ": transmit timeout\n");
100 		ret = -ETIMEDOUT;
101 		goto err;
102 	}
103 
104 	port_info->tx_desc_cur++;
105 	if (port_info->tx_desc_cur >= port_info->tx_desc_base + NUM_TX_DESC)
106 		port_info->tx_desc_cur = port_info->tx_desc_base;
107 
108 err:
109 	return ret;
110 }
111 
112 int sh_eth_recv(struct eth_device *dev)
113 {
114 	struct sh_eth_dev *eth = dev->priv;
115 	int port = eth->port, len = 0;
116 	struct sh_eth_info *port_info = &eth->port_info[port];
117 	uchar *packet;
118 
119 	/* Check if the rx descriptor is ready */
120 	invalidate_cache(port_info->rx_desc_cur, sizeof(struct rx_desc_s));
121 	if (!(port_info->rx_desc_cur->rd0 & RD_RACT)) {
122 		/* Check for errors */
123 		if (!(port_info->rx_desc_cur->rd0 & RD_RFE)) {
124 			len = port_info->rx_desc_cur->rd1 & 0xffff;
125 			packet = (uchar *)
126 				ADDR_TO_P2(port_info->rx_desc_cur->rd2);
127 			invalidate_cache(packet, len);
128 			NetReceive(packet, len);
129 		}
130 
131 		/* Make current descriptor available again */
132 		if (port_info->rx_desc_cur->rd0 & RD_RDLE)
133 			port_info->rx_desc_cur->rd0 = RD_RACT | RD_RDLE;
134 		else
135 			port_info->rx_desc_cur->rd0 = RD_RACT;
136 		/* Point to the next descriptor */
137 		port_info->rx_desc_cur++;
138 		if (port_info->rx_desc_cur >=
139 		    port_info->rx_desc_base + NUM_RX_DESC)
140 			port_info->rx_desc_cur = port_info->rx_desc_base;
141 	}
142 
143 	/* Restart the receiver if disabled */
144 	if (!(sh_eth_read(eth, EDRRR) & EDRRR_R))
145 		sh_eth_write(eth, EDRRR_R, EDRRR);
146 
147 	return len;
148 }
149 
150 static int sh_eth_reset(struct sh_eth_dev *eth)
151 {
152 #if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
153 	int ret = 0, i;
154 
155 	/* Start e-dmac transmitter and receiver */
156 	sh_eth_write(eth, EDSR_ENALL, EDSR);
157 
158 	/* Perform a software reset and wait for it to complete */
159 	sh_eth_write(eth, EDMR_SRST, EDMR);
160 	for (i = 0; i < TIMEOUT_CNT; i++) {
161 		if (!(sh_eth_read(eth, EDMR) & EDMR_SRST))
162 			break;
163 		udelay(1000);
164 	}
165 
166 	if (i == TIMEOUT_CNT) {
167 		printf(SHETHER_NAME  ": Software reset timeout\n");
168 		ret = -EIO;
169 	}
170 
171 	return ret;
172 #else
173 	sh_eth_write(eth, sh_eth_read(eth, EDMR) | EDMR_SRST, EDMR);
174 	udelay(3000);
175 	sh_eth_write(eth, sh_eth_read(eth, EDMR) & ~EDMR_SRST, EDMR);
176 
177 	return 0;
178 #endif
179 }
180 
181 static int sh_eth_tx_desc_init(struct sh_eth_dev *eth)
182 {
183 	int port = eth->port, i, ret = 0;
184 	u32 tmp_addr;
185 	struct sh_eth_info *port_info = &eth->port_info[port];
186 	struct tx_desc_s *cur_tx_desc;
187 
188 	/*
189 	 * Allocate tx descriptors. They must be TX_DESC_SIZE bytes aligned
190 	 */
191 	port_info->tx_desc_malloc = malloc(NUM_TX_DESC *
192 						 sizeof(struct tx_desc_s) +
193 						 TX_DESC_SIZE - 1);
194 	if (!port_info->tx_desc_malloc) {
195 		printf(SHETHER_NAME ": malloc failed\n");
196 		ret = -ENOMEM;
197 		goto err;
198 	}
199 
200 	tmp_addr = (u32) (((int)port_info->tx_desc_malloc + TX_DESC_SIZE - 1) &
201 			  ~(TX_DESC_SIZE - 1));
202 	flush_cache_wback(tmp_addr, NUM_TX_DESC * sizeof(struct tx_desc_s));
203 	/* Make sure we use a P2 address (non-cacheable) */
204 	port_info->tx_desc_base = (struct tx_desc_s *)ADDR_TO_P2(tmp_addr);
205 	port_info->tx_desc_cur = port_info->tx_desc_base;
206 
207 	/* Initialize all descriptors */
208 	for (cur_tx_desc = port_info->tx_desc_base, i = 0; i < NUM_TX_DESC;
209 	     cur_tx_desc++, i++) {
210 		cur_tx_desc->td0 = 0x00;
211 		cur_tx_desc->td1 = 0x00;
212 		cur_tx_desc->td2 = 0x00;
213 	}
214 
215 	/* Mark the end of the descriptors */
216 	cur_tx_desc--;
217 	cur_tx_desc->td0 |= TD_TDLE;
218 
219 	/* Point the controller to the tx descriptor list. Must use physical
220 	   addresses */
221 	sh_eth_write(eth, ADDR_TO_PHY(port_info->tx_desc_base), TDLAR);
222 #if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
223 	sh_eth_write(eth, ADDR_TO_PHY(port_info->tx_desc_base), TDFAR);
224 	sh_eth_write(eth, ADDR_TO_PHY(cur_tx_desc), TDFXR);
225 	sh_eth_write(eth, 0x01, TDFFR);/* Last discriptor bit */
226 #endif
227 
228 err:
229 	return ret;
230 }
231 
232 static int sh_eth_rx_desc_init(struct sh_eth_dev *eth)
233 {
234 	int port = eth->port, i , ret = 0;
235 	struct sh_eth_info *port_info = &eth->port_info[port];
236 	struct rx_desc_s *cur_rx_desc;
237 	u32 tmp_addr;
238 	u8 *rx_buf;
239 
240 	/*
241 	 * Allocate rx descriptors. They must be RX_DESC_SIZE bytes aligned
242 	 */
243 	port_info->rx_desc_malloc = malloc(NUM_RX_DESC *
244 						 sizeof(struct rx_desc_s) +
245 						 RX_DESC_SIZE - 1);
246 	if (!port_info->rx_desc_malloc) {
247 		printf(SHETHER_NAME ": malloc failed\n");
248 		ret = -ENOMEM;
249 		goto err;
250 	}
251 
252 	tmp_addr = (u32) (((int)port_info->rx_desc_malloc + RX_DESC_SIZE - 1) &
253 			  ~(RX_DESC_SIZE - 1));
254 	flush_cache_wback(tmp_addr, NUM_RX_DESC * sizeof(struct rx_desc_s));
255 	/* Make sure we use a P2 address (non-cacheable) */
256 	port_info->rx_desc_base = (struct rx_desc_s *)ADDR_TO_P2(tmp_addr);
257 
258 	port_info->rx_desc_cur = port_info->rx_desc_base;
259 
260 	/*
261 	 * Allocate rx data buffers. They must be 32 bytes aligned  and in
262 	 * P2 area
263 	 */
264 	port_info->rx_buf_malloc = malloc(
265 		NUM_RX_DESC * MAX_BUF_SIZE + RX_BUF_ALIGNE_SIZE - 1);
266 	if (!port_info->rx_buf_malloc) {
267 		printf(SHETHER_NAME ": malloc failed\n");
268 		ret = -ENOMEM;
269 		goto err_buf_malloc;
270 	}
271 
272 	tmp_addr = (u32)(((int)port_info->rx_buf_malloc
273 			  + (RX_BUF_ALIGNE_SIZE - 1)) &
274 			  ~(RX_BUF_ALIGNE_SIZE - 1));
275 	port_info->rx_buf_base = (u8 *)ADDR_TO_P2(tmp_addr);
276 
277 	/* Initialize all descriptors */
278 	for (cur_rx_desc = port_info->rx_desc_base,
279 	     rx_buf = port_info->rx_buf_base, i = 0;
280 	     i < NUM_RX_DESC; cur_rx_desc++, rx_buf += MAX_BUF_SIZE, i++) {
281 		cur_rx_desc->rd0 = RD_RACT;
282 		cur_rx_desc->rd1 = MAX_BUF_SIZE << 16;
283 		cur_rx_desc->rd2 = (u32) ADDR_TO_PHY(rx_buf);
284 	}
285 
286 	/* Mark the end of the descriptors */
287 	cur_rx_desc--;
288 	cur_rx_desc->rd0 |= RD_RDLE;
289 
290 	/* Point the controller to the rx descriptor list */
291 	sh_eth_write(eth, ADDR_TO_PHY(port_info->rx_desc_base), RDLAR);
292 #if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
293 	sh_eth_write(eth, ADDR_TO_PHY(port_info->rx_desc_base), RDFAR);
294 	sh_eth_write(eth, ADDR_TO_PHY(cur_rx_desc), RDFXR);
295 	sh_eth_write(eth, RDFFR_RDLF, RDFFR);
296 #endif
297 
298 	return ret;
299 
300 err_buf_malloc:
301 	free(port_info->rx_desc_malloc);
302 	port_info->rx_desc_malloc = NULL;
303 
304 err:
305 	return ret;
306 }
307 
308 static void sh_eth_tx_desc_free(struct sh_eth_dev *eth)
309 {
310 	int port = eth->port;
311 	struct sh_eth_info *port_info = &eth->port_info[port];
312 
313 	if (port_info->tx_desc_malloc) {
314 		free(port_info->tx_desc_malloc);
315 		port_info->tx_desc_malloc = NULL;
316 	}
317 }
318 
319 static void sh_eth_rx_desc_free(struct sh_eth_dev *eth)
320 {
321 	int port = eth->port;
322 	struct sh_eth_info *port_info = &eth->port_info[port];
323 
324 	if (port_info->rx_desc_malloc) {
325 		free(port_info->rx_desc_malloc);
326 		port_info->rx_desc_malloc = NULL;
327 	}
328 
329 	if (port_info->rx_buf_malloc) {
330 		free(port_info->rx_buf_malloc);
331 		port_info->rx_buf_malloc = NULL;
332 	}
333 }
334 
335 static int sh_eth_desc_init(struct sh_eth_dev *eth)
336 {
337 	int ret = 0;
338 
339 	ret = sh_eth_tx_desc_init(eth);
340 	if (ret)
341 		goto err_tx_init;
342 
343 	ret = sh_eth_rx_desc_init(eth);
344 	if (ret)
345 		goto err_rx_init;
346 
347 	return ret;
348 err_rx_init:
349 	sh_eth_tx_desc_free(eth);
350 
351 err_tx_init:
352 	return ret;
353 }
354 
355 static int sh_eth_phy_config(struct sh_eth_dev *eth)
356 {
357 	int port = eth->port, ret = 0;
358 	struct sh_eth_info *port_info = &eth->port_info[port];
359 	struct eth_device *dev = port_info->dev;
360 	struct phy_device *phydev;
361 
362 	phydev = phy_connect(
363 			miiphy_get_dev_by_name(dev->name),
364 			port_info->phy_addr, dev, CONFIG_SH_ETHER_PHY_MODE);
365 	port_info->phydev = phydev;
366 	phy_config(phydev);
367 
368 	return ret;
369 }
370 
371 static int sh_eth_config(struct sh_eth_dev *eth, bd_t *bd)
372 {
373 	int port = eth->port, ret = 0;
374 	u32 val;
375 	struct sh_eth_info *port_info = &eth->port_info[port];
376 	struct eth_device *dev = port_info->dev;
377 	struct phy_device *phy;
378 
379 	/* Configure e-dmac registers */
380 	sh_eth_write(eth, (sh_eth_read(eth, EDMR) & ~EMDR_DESC_R) |
381 			(EMDR_DESC | EDMR_EL), EDMR);
382 
383 	sh_eth_write(eth, 0, EESIPR);
384 	sh_eth_write(eth, 0, TRSCER);
385 	sh_eth_write(eth, 0, TFTR);
386 	sh_eth_write(eth, (FIFO_SIZE_T | FIFO_SIZE_R), FDR);
387 	sh_eth_write(eth, RMCR_RST, RMCR);
388 #if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
389 	sh_eth_write(eth, 0, RPADIR);
390 #endif
391 	sh_eth_write(eth, (FIFO_F_D_RFF | FIFO_F_D_RFD), FCFTR);
392 
393 	/* Configure e-mac registers */
394 	sh_eth_write(eth, 0, ECSIPR);
395 
396 	/* Set Mac address */
397 	val = dev->enetaddr[0] << 24 | dev->enetaddr[1] << 16 |
398 	    dev->enetaddr[2] << 8 | dev->enetaddr[3];
399 	sh_eth_write(eth, val, MAHR);
400 
401 	val = dev->enetaddr[4] << 8 | dev->enetaddr[5];
402 	sh_eth_write(eth, val, MALR);
403 
404 	sh_eth_write(eth, RFLR_RFL_MIN, RFLR);
405 #if defined(SH_ETH_TYPE_GETHER)
406 	sh_eth_write(eth, 0, PIPR);
407 #endif
408 #if defined(SH_ETH_TYPE_GETHER) || defined(SH_ETH_TYPE_RZ)
409 	sh_eth_write(eth, APR_AP, APR);
410 	sh_eth_write(eth, MPR_MP, MPR);
411 	sh_eth_write(eth, TPAUSER_TPAUSE, TPAUSER);
412 #endif
413 
414 #if defined(CONFIG_CPU_SH7734) || defined(CONFIG_R8A7740)
415 	sh_eth_write(eth, CONFIG_SH_ETHER_SH7734_MII, RMII_MII);
416 #elif defined(CONFIG_R8A7790) || defined(CONFIG_R8A7791)
417 	sh_eth_write(eth, sh_eth_read(eth, RMIIMR) | 0x1, RMIIMR);
418 #endif
419 	/* Configure phy */
420 	ret = sh_eth_phy_config(eth);
421 	if (ret) {
422 		printf(SHETHER_NAME ": phy config timeout\n");
423 		goto err_phy_cfg;
424 	}
425 	phy = port_info->phydev;
426 	ret = phy_startup(phy);
427 	if (ret) {
428 		printf(SHETHER_NAME ": phy startup failure\n");
429 		return ret;
430 	}
431 
432 	val = 0;
433 
434 	/* Set the transfer speed */
435 	if (phy->speed == 100) {
436 		printf(SHETHER_NAME ": 100Base/");
437 #if defined(SH_ETH_TYPE_GETHER)
438 		sh_eth_write(eth, GECMR_100B, GECMR);
439 #elif defined(CONFIG_CPU_SH7757) || defined(CONFIG_CPU_SH7752)
440 		sh_eth_write(eth, 1, RTRATE);
441 #elif defined(CONFIG_CPU_SH7724) || defined(CONFIG_R8A7790) || \
442 		defined(CONFIG_R8A7791)
443 		val = ECMR_RTM;
444 #endif
445 	} else if (phy->speed == 10) {
446 		printf(SHETHER_NAME ": 10Base/");
447 #if defined(SH_ETH_TYPE_GETHER)
448 		sh_eth_write(eth, GECMR_10B, GECMR);
449 #elif defined(CONFIG_CPU_SH7757) || defined(CONFIG_CPU_SH7752)
450 		sh_eth_write(eth, 0, RTRATE);
451 #endif
452 	}
453 #if defined(SH_ETH_TYPE_GETHER)
454 	else if (phy->speed == 1000) {
455 		printf(SHETHER_NAME ": 1000Base/");
456 		sh_eth_write(eth, GECMR_1000B, GECMR);
457 	}
458 #endif
459 
460 	/* Check if full duplex mode is supported by the phy */
461 	if (phy->duplex) {
462 		printf("Full\n");
463 		sh_eth_write(eth, val | (ECMR_CHG_DM|ECMR_RE|ECMR_TE|ECMR_DM),
464 			     ECMR);
465 	} else {
466 		printf("Half\n");
467 		sh_eth_write(eth, val | (ECMR_CHG_DM|ECMR_RE|ECMR_TE), ECMR);
468 	}
469 
470 	return ret;
471 
472 err_phy_cfg:
473 	return ret;
474 }
475 
476 static void sh_eth_start(struct sh_eth_dev *eth)
477 {
478 	/*
479 	 * Enable the e-dmac receiver only. The transmitter will be enabled when
480 	 * we have something to transmit
481 	 */
482 	sh_eth_write(eth, EDRRR_R, EDRRR);
483 }
484 
485 static void sh_eth_stop(struct sh_eth_dev *eth)
486 {
487 	sh_eth_write(eth, ~EDRRR_R, EDRRR);
488 }
489 
490 int sh_eth_init(struct eth_device *dev, bd_t *bd)
491 {
492 	int ret = 0;
493 	struct sh_eth_dev *eth = dev->priv;
494 
495 	ret = sh_eth_reset(eth);
496 	if (ret)
497 		goto err;
498 
499 	ret = sh_eth_desc_init(eth);
500 	if (ret)
501 		goto err;
502 
503 	ret = sh_eth_config(eth, bd);
504 	if (ret)
505 		goto err_config;
506 
507 	sh_eth_start(eth);
508 
509 	return ret;
510 
511 err_config:
512 	sh_eth_tx_desc_free(eth);
513 	sh_eth_rx_desc_free(eth);
514 
515 err:
516 	return ret;
517 }
518 
519 void sh_eth_halt(struct eth_device *dev)
520 {
521 	struct sh_eth_dev *eth = dev->priv;
522 	sh_eth_stop(eth);
523 }
524 
525 int sh_eth_initialize(bd_t *bd)
526 {
527 	int ret = 0;
528 	struct sh_eth_dev *eth = NULL;
529 	struct eth_device *dev = NULL;
530 
531 	eth = (struct sh_eth_dev *)malloc(sizeof(struct sh_eth_dev));
532 	if (!eth) {
533 		printf(SHETHER_NAME ": %s: malloc failed\n", __func__);
534 		ret = -ENOMEM;
535 		goto err;
536 	}
537 
538 	dev = (struct eth_device *)malloc(sizeof(struct eth_device));
539 	if (!dev) {
540 		printf(SHETHER_NAME ": %s: malloc failed\n", __func__);
541 		ret = -ENOMEM;
542 		goto err;
543 	}
544 	memset(dev, 0, sizeof(struct eth_device));
545 	memset(eth, 0, sizeof(struct sh_eth_dev));
546 
547 	eth->port = CONFIG_SH_ETHER_USE_PORT;
548 	eth->port_info[eth->port].phy_addr = CONFIG_SH_ETHER_PHY_ADDR;
549 
550 	dev->priv = (void *)eth;
551 	dev->iobase = 0;
552 	dev->init = sh_eth_init;
553 	dev->halt = sh_eth_halt;
554 	dev->send = sh_eth_send;
555 	dev->recv = sh_eth_recv;
556 	eth->port_info[eth->port].dev = dev;
557 
558 	sprintf(dev->name, SHETHER_NAME);
559 
560 	/* Register Device to EtherNet subsystem  */
561 	eth_register(dev);
562 
563 	bb_miiphy_buses[0].priv = eth;
564 	miiphy_register(dev->name, bb_miiphy_read, bb_miiphy_write);
565 
566 	if (!eth_getenv_enetaddr("ethaddr", dev->enetaddr))
567 		puts("Please set MAC address\n");
568 
569 	return ret;
570 
571 err:
572 	if (dev)
573 		free(dev);
574 
575 	if (eth)
576 		free(eth);
577 
578 	printf(SHETHER_NAME ": Failed\n");
579 	return ret;
580 }
581 
582 /******* for bb_miiphy *******/
583 static int sh_eth_bb_init(struct bb_miiphy_bus *bus)
584 {
585 	return 0;
586 }
587 
588 static int sh_eth_bb_mdio_active(struct bb_miiphy_bus *bus)
589 {
590 	struct sh_eth_dev *eth = bus->priv;
591 
592 	sh_eth_write(eth, sh_eth_read(eth, PIR) | PIR_MMD, PIR);
593 
594 	return 0;
595 }
596 
597 static int sh_eth_bb_mdio_tristate(struct bb_miiphy_bus *bus)
598 {
599 	struct sh_eth_dev *eth = bus->priv;
600 
601 	sh_eth_write(eth, sh_eth_read(eth, PIR) & ~PIR_MMD, PIR);
602 
603 	return 0;
604 }
605 
606 static int sh_eth_bb_set_mdio(struct bb_miiphy_bus *bus, int v)
607 {
608 	struct sh_eth_dev *eth = bus->priv;
609 
610 	if (v)
611 		sh_eth_write(eth, sh_eth_read(eth, PIR) | PIR_MDO, PIR);
612 	else
613 		sh_eth_write(eth, sh_eth_read(eth, PIR) & ~PIR_MDO, PIR);
614 
615 	return 0;
616 }
617 
618 static int sh_eth_bb_get_mdio(struct bb_miiphy_bus *bus, int *v)
619 {
620 	struct sh_eth_dev *eth = bus->priv;
621 
622 	*v = (sh_eth_read(eth, PIR) & PIR_MDI) >> 3;
623 
624 	return 0;
625 }
626 
627 static int sh_eth_bb_set_mdc(struct bb_miiphy_bus *bus, int v)
628 {
629 	struct sh_eth_dev *eth = bus->priv;
630 
631 	if (v)
632 		sh_eth_write(eth, sh_eth_read(eth, PIR) | PIR_MDC, PIR);
633 	else
634 		sh_eth_write(eth, sh_eth_read(eth, PIR) & ~PIR_MDC, PIR);
635 
636 	return 0;
637 }
638 
639 static int sh_eth_bb_delay(struct bb_miiphy_bus *bus)
640 {
641 	udelay(10);
642 
643 	return 0;
644 }
645 
646 struct bb_miiphy_bus bb_miiphy_buses[] = {
647 	{
648 		.name		= "sh_eth",
649 		.init		= sh_eth_bb_init,
650 		.mdio_active	= sh_eth_bb_mdio_active,
651 		.mdio_tristate	= sh_eth_bb_mdio_tristate,
652 		.set_mdio	= sh_eth_bb_set_mdio,
653 		.get_mdio	= sh_eth_bb_get_mdio,
654 		.set_mdc	= sh_eth_bb_set_mdc,
655 		.delay		= sh_eth_bb_delay,
656 	}
657 };
658 int bb_miiphy_buses_num = ARRAY_SIZE(bb_miiphy_buses);
659