xref: /rk3399_rockchip-uboot/drivers/net/phy/miiphybb.c (revision 2ef98d33166e5c22a61eba29c20e236b72f1e8a2)
155195773SJean-Christophe PLAGNIOL-VILLARD /*
24ba31ab3SLuigi 'Comio' Mantellini  * (C) Copyright 2009 Industrie Dial Face S.p.A.
34ba31ab3SLuigi 'Comio' Mantellini  * Luigi 'Comio' Mantellini <luigi.mantellini@idf-hit.com>
44ba31ab3SLuigi 'Comio' Mantellini  *
555195773SJean-Christophe PLAGNIOL-VILLARD  * (C) Copyright 2001
655195773SJean-Christophe PLAGNIOL-VILLARD  * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com.
755195773SJean-Christophe PLAGNIOL-VILLARD  *
81a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
955195773SJean-Christophe PLAGNIOL-VILLARD  */
1055195773SJean-Christophe PLAGNIOL-VILLARD 
1155195773SJean-Christophe PLAGNIOL-VILLARD /*
1255195773SJean-Christophe PLAGNIOL-VILLARD  * This provides a bit-banged interface to the ethernet MII management
1355195773SJean-Christophe PLAGNIOL-VILLARD  * channel.
1455195773SJean-Christophe PLAGNIOL-VILLARD  */
1555195773SJean-Christophe PLAGNIOL-VILLARD 
1655195773SJean-Christophe PLAGNIOL-VILLARD #include <common.h>
1755195773SJean-Christophe PLAGNIOL-VILLARD #include <ioports.h>
1855195773SJean-Christophe PLAGNIOL-VILLARD #include <ppc_asm.tmpl>
194ba31ab3SLuigi 'Comio' Mantellini #include <miiphy.h>
204ba31ab3SLuigi 'Comio' Mantellini 
214ba31ab3SLuigi 'Comio' Mantellini #define BB_MII_RELOCATE(v,off) (v += (v?off:0))
224ba31ab3SLuigi 'Comio' Mantellini 
234ba31ab3SLuigi 'Comio' Mantellini DECLARE_GLOBAL_DATA_PTR;
244ba31ab3SLuigi 'Comio' Mantellini 
254ba31ab3SLuigi 'Comio' Mantellini #ifndef CONFIG_BITBANGMII_MULTI
264ba31ab3SLuigi 'Comio' Mantellini 
274ba31ab3SLuigi 'Comio' Mantellini /*
284ba31ab3SLuigi 'Comio' Mantellini  * If CONFIG_BITBANGMII_MULTI is not defined we use a
294ba31ab3SLuigi 'Comio' Mantellini  * compatibility layer with the previous miiphybb implementation
304ba31ab3SLuigi 'Comio' Mantellini  * based on macros usage.
314ba31ab3SLuigi 'Comio' Mantellini  *
324ba31ab3SLuigi 'Comio' Mantellini  */
bb_mii_init_wrap(struct bb_miiphy_bus * bus)334ba31ab3SLuigi 'Comio' Mantellini static int bb_mii_init_wrap(struct bb_miiphy_bus *bus)
344ba31ab3SLuigi 'Comio' Mantellini {
354ba31ab3SLuigi 'Comio' Mantellini #ifdef MII_INIT
364ba31ab3SLuigi 'Comio' Mantellini 	MII_INIT;
374ba31ab3SLuigi 'Comio' Mantellini #endif
384ba31ab3SLuigi 'Comio' Mantellini 	return 0;
394ba31ab3SLuigi 'Comio' Mantellini }
404ba31ab3SLuigi 'Comio' Mantellini 
bb_mdio_active_wrap(struct bb_miiphy_bus * bus)414ba31ab3SLuigi 'Comio' Mantellini static int bb_mdio_active_wrap(struct bb_miiphy_bus *bus)
424ba31ab3SLuigi 'Comio' Mantellini {
434ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
444ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
454ba31ab3SLuigi 'Comio' Mantellini #endif
464ba31ab3SLuigi 'Comio' Mantellini 	MDIO_ACTIVE;
474ba31ab3SLuigi 'Comio' Mantellini 	return 0;
484ba31ab3SLuigi 'Comio' Mantellini }
494ba31ab3SLuigi 'Comio' Mantellini 
bb_mdio_tristate_wrap(struct bb_miiphy_bus * bus)504ba31ab3SLuigi 'Comio' Mantellini static int bb_mdio_tristate_wrap(struct bb_miiphy_bus *bus)
514ba31ab3SLuigi 'Comio' Mantellini {
524ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
534ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
544ba31ab3SLuigi 'Comio' Mantellini #endif
554ba31ab3SLuigi 'Comio' Mantellini 	MDIO_TRISTATE;
564ba31ab3SLuigi 'Comio' Mantellini 	return 0;
574ba31ab3SLuigi 'Comio' Mantellini }
584ba31ab3SLuigi 'Comio' Mantellini 
bb_set_mdio_wrap(struct bb_miiphy_bus * bus,int v)594ba31ab3SLuigi 'Comio' Mantellini static int bb_set_mdio_wrap(struct bb_miiphy_bus *bus, int v)
604ba31ab3SLuigi 'Comio' Mantellini {
614ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
624ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
634ba31ab3SLuigi 'Comio' Mantellini #endif
644ba31ab3SLuigi 'Comio' Mantellini 	MDIO(v);
654ba31ab3SLuigi 'Comio' Mantellini 	return 0;
664ba31ab3SLuigi 'Comio' Mantellini }
674ba31ab3SLuigi 'Comio' Mantellini 
bb_get_mdio_wrap(struct bb_miiphy_bus * bus,int * v)684ba31ab3SLuigi 'Comio' Mantellini static int bb_get_mdio_wrap(struct bb_miiphy_bus *bus, int *v)
694ba31ab3SLuigi 'Comio' Mantellini {
704ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
714ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
724ba31ab3SLuigi 'Comio' Mantellini #endif
734ba31ab3SLuigi 'Comio' Mantellini 	*v = MDIO_READ;
744ba31ab3SLuigi 'Comio' Mantellini 	return 0;
754ba31ab3SLuigi 'Comio' Mantellini }
764ba31ab3SLuigi 'Comio' Mantellini 
bb_set_mdc_wrap(struct bb_miiphy_bus * bus,int v)774ba31ab3SLuigi 'Comio' Mantellini static int bb_set_mdc_wrap(struct bb_miiphy_bus *bus, int v)
784ba31ab3SLuigi 'Comio' Mantellini {
794ba31ab3SLuigi 'Comio' Mantellini #ifdef MDC_DECLARE
804ba31ab3SLuigi 'Comio' Mantellini 	MDC_DECLARE;
814ba31ab3SLuigi 'Comio' Mantellini #endif
824ba31ab3SLuigi 'Comio' Mantellini 	MDC(v);
834ba31ab3SLuigi 'Comio' Mantellini 	return 0;
844ba31ab3SLuigi 'Comio' Mantellini }
854ba31ab3SLuigi 'Comio' Mantellini 
bb_delay_wrap(struct bb_miiphy_bus * bus)864ba31ab3SLuigi 'Comio' Mantellini static int bb_delay_wrap(struct bb_miiphy_bus *bus)
874ba31ab3SLuigi 'Comio' Mantellini {
884ba31ab3SLuigi 'Comio' Mantellini 	MIIDELAY;
894ba31ab3SLuigi 'Comio' Mantellini 	return 0;
904ba31ab3SLuigi 'Comio' Mantellini }
914ba31ab3SLuigi 'Comio' Mantellini 
924ba31ab3SLuigi 'Comio' Mantellini struct bb_miiphy_bus bb_miiphy_buses[] = {
934ba31ab3SLuigi 'Comio' Mantellini 	{
944ba31ab3SLuigi 'Comio' Mantellini 		.name = BB_MII_DEVNAME,
954ba31ab3SLuigi 'Comio' Mantellini 		.init = bb_mii_init_wrap,
964ba31ab3SLuigi 'Comio' Mantellini 		.mdio_active = bb_mdio_active_wrap,
974ba31ab3SLuigi 'Comio' Mantellini 		.mdio_tristate = bb_mdio_tristate_wrap,
984ba31ab3SLuigi 'Comio' Mantellini 		.set_mdio = bb_set_mdio_wrap,
994ba31ab3SLuigi 'Comio' Mantellini 		.get_mdio = bb_get_mdio_wrap,
1004ba31ab3SLuigi 'Comio' Mantellini 		.set_mdc = bb_set_mdc_wrap,
1014ba31ab3SLuigi 'Comio' Mantellini 		.delay = bb_delay_wrap,
1024ba31ab3SLuigi 'Comio' Mantellini 	}
1034ba31ab3SLuigi 'Comio' Mantellini };
1044ba31ab3SLuigi 'Comio' Mantellini 
1054ba31ab3SLuigi 'Comio' Mantellini int bb_miiphy_buses_num = sizeof(bb_miiphy_buses) /
1064ba31ab3SLuigi 'Comio' Mantellini 			  sizeof(bb_miiphy_buses[0]);
1074ba31ab3SLuigi 'Comio' Mantellini #endif
1084ba31ab3SLuigi 'Comio' Mantellini 
bb_miiphy_init(void)1094ba31ab3SLuigi 'Comio' Mantellini void bb_miiphy_init(void)
1104ba31ab3SLuigi 'Comio' Mantellini {
1114ba31ab3SLuigi 'Comio' Mantellini 	int i;
1124ba31ab3SLuigi 'Comio' Mantellini 
1134ba31ab3SLuigi 'Comio' Mantellini 	for (i = 0; i < bb_miiphy_buses_num; i++) {
1142e5167ccSWolfgang Denk #if defined(CONFIG_NEEDS_MANUAL_RELOC)
1154ba31ab3SLuigi 'Comio' Mantellini 		/* Relocate the hook pointers*/
1164ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].init, gd->reloc_off);
1174ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].mdio_active, gd->reloc_off);
1184ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].mdio_tristate, gd->reloc_off);
1194ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].set_mdio, gd->reloc_off);
1204ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].get_mdio, gd->reloc_off);
1214ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].set_mdc, gd->reloc_off);
1224ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].delay, gd->reloc_off);
1234ba31ab3SLuigi 'Comio' Mantellini #endif
1244ba31ab3SLuigi 'Comio' Mantellini 		if (bb_miiphy_buses[i].init != NULL) {
1254ba31ab3SLuigi 'Comio' Mantellini 			bb_miiphy_buses[i].init(&bb_miiphy_buses[i]);
1264ba31ab3SLuigi 'Comio' Mantellini 		}
1274ba31ab3SLuigi 'Comio' Mantellini 	}
1284ba31ab3SLuigi 'Comio' Mantellini }
1294ba31ab3SLuigi 'Comio' Mantellini 
bb_miiphy_getbus(const char * devname)130d7fb9bcfSBen Warren static inline struct bb_miiphy_bus *bb_miiphy_getbus(const char *devname)
1314ba31ab3SLuigi 'Comio' Mantellini {
1324ba31ab3SLuigi 'Comio' Mantellini #ifdef CONFIG_BITBANGMII_MULTI
1334ba31ab3SLuigi 'Comio' Mantellini 	int i;
1344ba31ab3SLuigi 'Comio' Mantellini 
1354ba31ab3SLuigi 'Comio' Mantellini 	/* Search the correct bus */
1364ba31ab3SLuigi 'Comio' Mantellini 	for (i = 0; i < bb_miiphy_buses_num; i++) {
1374ba31ab3SLuigi 'Comio' Mantellini 		if (!strcmp(bb_miiphy_buses[i].name, devname)) {
1384ba31ab3SLuigi 'Comio' Mantellini 			return &bb_miiphy_buses[i];
1394ba31ab3SLuigi 'Comio' Mantellini 		}
1404ba31ab3SLuigi 'Comio' Mantellini 	}
1414ba31ab3SLuigi 'Comio' Mantellini 	return NULL;
1424ba31ab3SLuigi 'Comio' Mantellini #else
1434ba31ab3SLuigi 'Comio' Mantellini 	/* We have just one bitbanging bus */
1444ba31ab3SLuigi 'Comio' Mantellini 	return &bb_miiphy_buses[0];
1454ba31ab3SLuigi 'Comio' Mantellini #endif
1464ba31ab3SLuigi 'Comio' Mantellini }
14755195773SJean-Christophe PLAGNIOL-VILLARD 
14855195773SJean-Christophe PLAGNIOL-VILLARD /*****************************************************************************
14955195773SJean-Christophe PLAGNIOL-VILLARD  *
15055195773SJean-Christophe PLAGNIOL-VILLARD  * Utility to send the preamble, address, and register (common to read
15155195773SJean-Christophe PLAGNIOL-VILLARD  * and write).
15255195773SJean-Christophe PLAGNIOL-VILLARD  */
miiphy_pre(struct bb_miiphy_bus * bus,char read,unsigned char addr,unsigned char reg)1534ba31ab3SLuigi 'Comio' Mantellini static void miiphy_pre(struct bb_miiphy_bus *bus, char read,
1544ba31ab3SLuigi 'Comio' Mantellini 		       unsigned char addr, unsigned char reg)
15555195773SJean-Christophe PLAGNIOL-VILLARD {
1564ba31ab3SLuigi 'Comio' Mantellini 	int j;
15755195773SJean-Christophe PLAGNIOL-VILLARD 
15855195773SJean-Christophe PLAGNIOL-VILLARD 	/*
15955195773SJean-Christophe PLAGNIOL-VILLARD 	 * Send a 32 bit preamble ('1's) with an extra '1' bit for good measure.
16055195773SJean-Christophe PLAGNIOL-VILLARD 	 * The IEEE spec says this is a PHY optional requirement.  The AMD
16155195773SJean-Christophe PLAGNIOL-VILLARD 	 * 79C874 requires one after power up and one after a MII communications
16255195773SJean-Christophe PLAGNIOL-VILLARD 	 * error.  This means that we are doing more preambles than we need,
16355195773SJean-Christophe PLAGNIOL-VILLARD 	 * but it is safer and will be much more robust.
16455195773SJean-Christophe PLAGNIOL-VILLARD 	 */
16555195773SJean-Christophe PLAGNIOL-VILLARD 
1664ba31ab3SLuigi 'Comio' Mantellini 	bus->mdio_active(bus);
1674ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 1);
16855195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 32; j++) {
1694ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
1704ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
1714ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
1724ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
17355195773SJean-Christophe PLAGNIOL-VILLARD 	}
17455195773SJean-Christophe PLAGNIOL-VILLARD 
17555195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the start bit (01) and the read opcode (10) or write (10) */
1764ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1774ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 0);
1784ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1794ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1804ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1814ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1824ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 1);
1834ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1844ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1854ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1864ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1874ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, read);
1884ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1894ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1904ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1914ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1924ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, !read);
1934ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1944ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1954ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
19655195773SJean-Christophe PLAGNIOL-VILLARD 
19755195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the PHY address */
19855195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 5; j++) {
1994ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
20055195773SJean-Christophe PLAGNIOL-VILLARD 		if ((addr & 0x10) == 0) {
2014ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 0);
20255195773SJean-Christophe PLAGNIOL-VILLARD 		} else {
2034ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 1);
20455195773SJean-Christophe PLAGNIOL-VILLARD 		}
2054ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
2064ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
2074ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
20855195773SJean-Christophe PLAGNIOL-VILLARD 		addr <<= 1;
20955195773SJean-Christophe PLAGNIOL-VILLARD 	}
21055195773SJean-Christophe PLAGNIOL-VILLARD 
21155195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the register address */
21255195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 5; j++) {
2134ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
21455195773SJean-Christophe PLAGNIOL-VILLARD 		if ((reg & 0x10) == 0) {
2154ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 0);
21655195773SJean-Christophe PLAGNIOL-VILLARD 		} else {
2174ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 1);
21855195773SJean-Christophe PLAGNIOL-VILLARD 		}
2194ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
2204ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
2214ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
22255195773SJean-Christophe PLAGNIOL-VILLARD 		reg <<= 1;
22355195773SJean-Christophe PLAGNIOL-VILLARD 	}
22455195773SJean-Christophe PLAGNIOL-VILLARD }
22555195773SJean-Christophe PLAGNIOL-VILLARD 
22655195773SJean-Christophe PLAGNIOL-VILLARD /*****************************************************************************
22755195773SJean-Christophe PLAGNIOL-VILLARD  *
22855195773SJean-Christophe PLAGNIOL-VILLARD  * Read a MII PHY register.
22955195773SJean-Christophe PLAGNIOL-VILLARD  *
23055195773SJean-Christophe PLAGNIOL-VILLARD  * Returns:
23155195773SJean-Christophe PLAGNIOL-VILLARD  *   0 on success
23255195773SJean-Christophe PLAGNIOL-VILLARD  */
bb_miiphy_read(struct mii_dev * miidev,int addr,int devad,int reg)233*dfcc496eSJoe Hershberger int bb_miiphy_read(struct mii_dev *miidev, int addr, int devad, int reg)
23455195773SJean-Christophe PLAGNIOL-VILLARD {
23555195773SJean-Christophe PLAGNIOL-VILLARD 	short rdreg; /* register working value */
2364ba31ab3SLuigi 'Comio' Mantellini 	int v;
23755195773SJean-Christophe PLAGNIOL-VILLARD 	int j; /* counter */
2384ba31ab3SLuigi 'Comio' Mantellini 	struct bb_miiphy_bus *bus;
2394ba31ab3SLuigi 'Comio' Mantellini 
240*dfcc496eSJoe Hershberger 	bus = bb_miiphy_getbus(miidev->name);
2414ba31ab3SLuigi 'Comio' Mantellini 	if (bus == NULL) {
2424ba31ab3SLuigi 'Comio' Mantellini 		return -1;
2434ba31ab3SLuigi 'Comio' Mantellini 	}
24455195773SJean-Christophe PLAGNIOL-VILLARD 
2454ba31ab3SLuigi 'Comio' Mantellini 	miiphy_pre (bus, 1, addr, reg);
24655195773SJean-Christophe PLAGNIOL-VILLARD 
24755195773SJean-Christophe PLAGNIOL-VILLARD 	/* tri-state our MDIO I/O pin so we can read */
2484ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
2494ba31ab3SLuigi 'Comio' Mantellini 	bus->mdio_tristate(bus);
2504ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
2514ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
2524ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
25355195773SJean-Christophe PLAGNIOL-VILLARD 
25455195773SJean-Christophe PLAGNIOL-VILLARD 	/* check the turnaround bit: the PHY should be driving it to zero */
2554ba31ab3SLuigi 'Comio' Mantellini 	bus->get_mdio(bus, &v);
2564ba31ab3SLuigi 'Comio' Mantellini 	if (v != 0) {
25755195773SJean-Christophe PLAGNIOL-VILLARD 		/* puts ("PHY didn't drive TA low\n"); */
25855195773SJean-Christophe PLAGNIOL-VILLARD 		for (j = 0; j < 32; j++) {
2594ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdc(bus, 0);
2604ba31ab3SLuigi 'Comio' Mantellini 			bus->delay(bus);
2614ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdc(bus, 1);
2624ba31ab3SLuigi 'Comio' Mantellini 			bus->delay(bus);
26355195773SJean-Christophe PLAGNIOL-VILLARD 		}
264*dfcc496eSJoe Hershberger 		/* There is no PHY, return */
2654ba31ab3SLuigi 'Comio' Mantellini 		return -1;
26655195773SJean-Christophe PLAGNIOL-VILLARD 	}
26755195773SJean-Christophe PLAGNIOL-VILLARD 
2684ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
2694ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
27055195773SJean-Christophe PLAGNIOL-VILLARD 
27155195773SJean-Christophe PLAGNIOL-VILLARD 	/* read 16 bits of register data, MSB first */
27255195773SJean-Christophe PLAGNIOL-VILLARD 	rdreg = 0;
27355195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 16; j++) {
2744ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
2754ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
27655195773SJean-Christophe PLAGNIOL-VILLARD 		rdreg <<= 1;
2774ba31ab3SLuigi 'Comio' Mantellini 		bus->get_mdio(bus, &v);
2784ba31ab3SLuigi 'Comio' Mantellini 		rdreg |= (v & 0x1);
2794ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
2804ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
28155195773SJean-Christophe PLAGNIOL-VILLARD 	}
28255195773SJean-Christophe PLAGNIOL-VILLARD 
2834ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
2844ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
2854ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
2864ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
2874ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
2884ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
28955195773SJean-Christophe PLAGNIOL-VILLARD 
29055195773SJean-Christophe PLAGNIOL-VILLARD #ifdef DEBUG
291*dfcc496eSJoe Hershberger 	printf("miiphy_read(0x%x) @ 0x%x = 0x%04x\n", reg, addr, rdreg);
29255195773SJean-Christophe PLAGNIOL-VILLARD #endif
29355195773SJean-Christophe PLAGNIOL-VILLARD 
294*dfcc496eSJoe Hershberger 	return rdreg;
29555195773SJean-Christophe PLAGNIOL-VILLARD }
29655195773SJean-Christophe PLAGNIOL-VILLARD 
29755195773SJean-Christophe PLAGNIOL-VILLARD 
29855195773SJean-Christophe PLAGNIOL-VILLARD /*****************************************************************************
29955195773SJean-Christophe PLAGNIOL-VILLARD  *
30055195773SJean-Christophe PLAGNIOL-VILLARD  * Write a MII PHY register.
30155195773SJean-Christophe PLAGNIOL-VILLARD  *
30255195773SJean-Christophe PLAGNIOL-VILLARD  * Returns:
30355195773SJean-Christophe PLAGNIOL-VILLARD  *   0 on success
30455195773SJean-Christophe PLAGNIOL-VILLARD  */
bb_miiphy_write(struct mii_dev * miidev,int addr,int devad,int reg,u16 value)305*dfcc496eSJoe Hershberger int bb_miiphy_write(struct mii_dev *miidev, int addr, int devad, int reg,
306*dfcc496eSJoe Hershberger 		    u16 value)
30755195773SJean-Christophe PLAGNIOL-VILLARD {
3084ba31ab3SLuigi 'Comio' Mantellini 	struct bb_miiphy_bus *bus;
30955195773SJean-Christophe PLAGNIOL-VILLARD 	int j;			/* counter */
31055195773SJean-Christophe PLAGNIOL-VILLARD 
311*dfcc496eSJoe Hershberger 	bus = bb_miiphy_getbus(miidev->name);
3124ba31ab3SLuigi 'Comio' Mantellini 	if (bus == NULL) {
3134ba31ab3SLuigi 'Comio' Mantellini 		/* Bus not found! */
3144ba31ab3SLuigi 'Comio' Mantellini 		return -1;
3154ba31ab3SLuigi 'Comio' Mantellini 	}
3164ba31ab3SLuigi 'Comio' Mantellini 
3174ba31ab3SLuigi 'Comio' Mantellini 	miiphy_pre (bus, 0, addr, reg);
31855195773SJean-Christophe PLAGNIOL-VILLARD 
31955195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the turnaround (10) */
3204ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
3214ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 1);
3224ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3234ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
3244ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3254ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
3264ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 0);
3274ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3284ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
3294ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
33055195773SJean-Christophe PLAGNIOL-VILLARD 
33155195773SJean-Christophe PLAGNIOL-VILLARD 	/* write 16 bits of register data, MSB first */
33255195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 16; j++) {
3334ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
33455195773SJean-Christophe PLAGNIOL-VILLARD 		if ((value & 0x00008000) == 0) {
3354ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 0);
33655195773SJean-Christophe PLAGNIOL-VILLARD 		} else {
3374ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 1);
33855195773SJean-Christophe PLAGNIOL-VILLARD 		}
3394ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
3404ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
3414ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
34255195773SJean-Christophe PLAGNIOL-VILLARD 		value <<= 1;
34355195773SJean-Christophe PLAGNIOL-VILLARD 	}
34455195773SJean-Christophe PLAGNIOL-VILLARD 
34555195773SJean-Christophe PLAGNIOL-VILLARD 	/*
34655195773SJean-Christophe PLAGNIOL-VILLARD 	 * Tri-state the MDIO line.
34755195773SJean-Christophe PLAGNIOL-VILLARD 	 */
3484ba31ab3SLuigi 'Comio' Mantellini 	bus->mdio_tristate(bus);
3494ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
3504ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3514ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
3524ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
35355195773SJean-Christophe PLAGNIOL-VILLARD 
35455195773SJean-Christophe PLAGNIOL-VILLARD 	return 0;
35555195773SJean-Christophe PLAGNIOL-VILLARD }
356