xref: /openbmc/u-boot/drivers/net/phy/miiphybb.c (revision 83d290c56fab2d38cd1ab4c4cc7099559c1d5046)
1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
255195773SJean-Christophe PLAGNIOL-VILLARD /*
34ba31ab3SLuigi 'Comio' Mantellini  * (C) Copyright 2009 Industrie Dial Face S.p.A.
44ba31ab3SLuigi 'Comio' Mantellini  * Luigi 'Comio' Mantellini <luigi.mantellini@idf-hit.com>
54ba31ab3SLuigi 'Comio' Mantellini  *
655195773SJean-Christophe PLAGNIOL-VILLARD  * (C) Copyright 2001
755195773SJean-Christophe PLAGNIOL-VILLARD  * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com.
855195773SJean-Christophe PLAGNIOL-VILLARD  */
955195773SJean-Christophe PLAGNIOL-VILLARD 
1055195773SJean-Christophe PLAGNIOL-VILLARD /*
1155195773SJean-Christophe PLAGNIOL-VILLARD  * This provides a bit-banged interface to the ethernet MII management
1255195773SJean-Christophe PLAGNIOL-VILLARD  * channel.
1355195773SJean-Christophe PLAGNIOL-VILLARD  */
1455195773SJean-Christophe PLAGNIOL-VILLARD 
1555195773SJean-Christophe PLAGNIOL-VILLARD #include <common.h>
1655195773SJean-Christophe PLAGNIOL-VILLARD #include <ioports.h>
1755195773SJean-Christophe PLAGNIOL-VILLARD #include <ppc_asm.tmpl>
184ba31ab3SLuigi 'Comio' Mantellini #include <miiphy.h>
194ba31ab3SLuigi 'Comio' Mantellini 
204ba31ab3SLuigi 'Comio' Mantellini #define BB_MII_RELOCATE(v,off) (v += (v?off:0))
214ba31ab3SLuigi 'Comio' Mantellini 
224ba31ab3SLuigi 'Comio' Mantellini DECLARE_GLOBAL_DATA_PTR;
234ba31ab3SLuigi 'Comio' Mantellini 
244ba31ab3SLuigi 'Comio' Mantellini #ifndef CONFIG_BITBANGMII_MULTI
254ba31ab3SLuigi 'Comio' Mantellini 
264ba31ab3SLuigi 'Comio' Mantellini /*
274ba31ab3SLuigi 'Comio' Mantellini  * If CONFIG_BITBANGMII_MULTI is not defined we use a
284ba31ab3SLuigi 'Comio' Mantellini  * compatibility layer with the previous miiphybb implementation
294ba31ab3SLuigi 'Comio' Mantellini  * based on macros usage.
304ba31ab3SLuigi 'Comio' Mantellini  *
314ba31ab3SLuigi 'Comio' Mantellini  */
bb_mii_init_wrap(struct bb_miiphy_bus * bus)324ba31ab3SLuigi 'Comio' Mantellini static int bb_mii_init_wrap(struct bb_miiphy_bus *bus)
334ba31ab3SLuigi 'Comio' Mantellini {
344ba31ab3SLuigi 'Comio' Mantellini #ifdef MII_INIT
354ba31ab3SLuigi 'Comio' Mantellini 	MII_INIT;
364ba31ab3SLuigi 'Comio' Mantellini #endif
374ba31ab3SLuigi 'Comio' Mantellini 	return 0;
384ba31ab3SLuigi 'Comio' Mantellini }
394ba31ab3SLuigi 'Comio' Mantellini 
bb_mdio_active_wrap(struct bb_miiphy_bus * bus)404ba31ab3SLuigi 'Comio' Mantellini static int bb_mdio_active_wrap(struct bb_miiphy_bus *bus)
414ba31ab3SLuigi 'Comio' Mantellini {
424ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
434ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
444ba31ab3SLuigi 'Comio' Mantellini #endif
454ba31ab3SLuigi 'Comio' Mantellini 	MDIO_ACTIVE;
464ba31ab3SLuigi 'Comio' Mantellini 	return 0;
474ba31ab3SLuigi 'Comio' Mantellini }
484ba31ab3SLuigi 'Comio' Mantellini 
bb_mdio_tristate_wrap(struct bb_miiphy_bus * bus)494ba31ab3SLuigi 'Comio' Mantellini static int bb_mdio_tristate_wrap(struct bb_miiphy_bus *bus)
504ba31ab3SLuigi 'Comio' Mantellini {
514ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
524ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
534ba31ab3SLuigi 'Comio' Mantellini #endif
544ba31ab3SLuigi 'Comio' Mantellini 	MDIO_TRISTATE;
554ba31ab3SLuigi 'Comio' Mantellini 	return 0;
564ba31ab3SLuigi 'Comio' Mantellini }
574ba31ab3SLuigi 'Comio' Mantellini 
bb_set_mdio_wrap(struct bb_miiphy_bus * bus,int v)584ba31ab3SLuigi 'Comio' Mantellini static int bb_set_mdio_wrap(struct bb_miiphy_bus *bus, int v)
594ba31ab3SLuigi 'Comio' Mantellini {
604ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
614ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
624ba31ab3SLuigi 'Comio' Mantellini #endif
634ba31ab3SLuigi 'Comio' Mantellini 	MDIO(v);
644ba31ab3SLuigi 'Comio' Mantellini 	return 0;
654ba31ab3SLuigi 'Comio' Mantellini }
664ba31ab3SLuigi 'Comio' Mantellini 
bb_get_mdio_wrap(struct bb_miiphy_bus * bus,int * v)674ba31ab3SLuigi 'Comio' Mantellini static int bb_get_mdio_wrap(struct bb_miiphy_bus *bus, int *v)
684ba31ab3SLuigi 'Comio' Mantellini {
694ba31ab3SLuigi 'Comio' Mantellini #ifdef MDIO_DECLARE
704ba31ab3SLuigi 'Comio' Mantellini 	MDIO_DECLARE;
714ba31ab3SLuigi 'Comio' Mantellini #endif
724ba31ab3SLuigi 'Comio' Mantellini 	*v = MDIO_READ;
734ba31ab3SLuigi 'Comio' Mantellini 	return 0;
744ba31ab3SLuigi 'Comio' Mantellini }
754ba31ab3SLuigi 'Comio' Mantellini 
bb_set_mdc_wrap(struct bb_miiphy_bus * bus,int v)764ba31ab3SLuigi 'Comio' Mantellini static int bb_set_mdc_wrap(struct bb_miiphy_bus *bus, int v)
774ba31ab3SLuigi 'Comio' Mantellini {
784ba31ab3SLuigi 'Comio' Mantellini #ifdef MDC_DECLARE
794ba31ab3SLuigi 'Comio' Mantellini 	MDC_DECLARE;
804ba31ab3SLuigi 'Comio' Mantellini #endif
814ba31ab3SLuigi 'Comio' Mantellini 	MDC(v);
824ba31ab3SLuigi 'Comio' Mantellini 	return 0;
834ba31ab3SLuigi 'Comio' Mantellini }
844ba31ab3SLuigi 'Comio' Mantellini 
bb_delay_wrap(struct bb_miiphy_bus * bus)854ba31ab3SLuigi 'Comio' Mantellini static int bb_delay_wrap(struct bb_miiphy_bus *bus)
864ba31ab3SLuigi 'Comio' Mantellini {
874ba31ab3SLuigi 'Comio' Mantellini 	MIIDELAY;
884ba31ab3SLuigi 'Comio' Mantellini 	return 0;
894ba31ab3SLuigi 'Comio' Mantellini }
904ba31ab3SLuigi 'Comio' Mantellini 
914ba31ab3SLuigi 'Comio' Mantellini struct bb_miiphy_bus bb_miiphy_buses[] = {
924ba31ab3SLuigi 'Comio' Mantellini 	{
934ba31ab3SLuigi 'Comio' Mantellini 		.name = BB_MII_DEVNAME,
944ba31ab3SLuigi 'Comio' Mantellini 		.init = bb_mii_init_wrap,
954ba31ab3SLuigi 'Comio' Mantellini 		.mdio_active = bb_mdio_active_wrap,
964ba31ab3SLuigi 'Comio' Mantellini 		.mdio_tristate = bb_mdio_tristate_wrap,
974ba31ab3SLuigi 'Comio' Mantellini 		.set_mdio = bb_set_mdio_wrap,
984ba31ab3SLuigi 'Comio' Mantellini 		.get_mdio = bb_get_mdio_wrap,
994ba31ab3SLuigi 'Comio' Mantellini 		.set_mdc = bb_set_mdc_wrap,
1004ba31ab3SLuigi 'Comio' Mantellini 		.delay = bb_delay_wrap,
1014ba31ab3SLuigi 'Comio' Mantellini 	}
1024ba31ab3SLuigi 'Comio' Mantellini };
1034ba31ab3SLuigi 'Comio' Mantellini 
1044ba31ab3SLuigi 'Comio' Mantellini int bb_miiphy_buses_num = sizeof(bb_miiphy_buses) /
1054ba31ab3SLuigi 'Comio' Mantellini 			  sizeof(bb_miiphy_buses[0]);
1064ba31ab3SLuigi 'Comio' Mantellini #endif
1074ba31ab3SLuigi 'Comio' Mantellini 
bb_miiphy_init(void)1084ba31ab3SLuigi 'Comio' Mantellini void bb_miiphy_init(void)
1094ba31ab3SLuigi 'Comio' Mantellini {
1104ba31ab3SLuigi 'Comio' Mantellini 	int i;
1114ba31ab3SLuigi 'Comio' Mantellini 
1124ba31ab3SLuigi 'Comio' Mantellini 	for (i = 0; i < bb_miiphy_buses_num; i++) {
1132e5167ccSWolfgang Denk #if defined(CONFIG_NEEDS_MANUAL_RELOC)
1144ba31ab3SLuigi 'Comio' Mantellini 		/* Relocate the hook pointers*/
1154ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].init, gd->reloc_off);
1164ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].mdio_active, gd->reloc_off);
1174ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].mdio_tristate, gd->reloc_off);
1184ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].set_mdio, gd->reloc_off);
1194ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].get_mdio, gd->reloc_off);
1204ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].set_mdc, gd->reloc_off);
1214ba31ab3SLuigi 'Comio' Mantellini 		BB_MII_RELOCATE(bb_miiphy_buses[i].delay, gd->reloc_off);
1224ba31ab3SLuigi 'Comio' Mantellini #endif
1234ba31ab3SLuigi 'Comio' Mantellini 		if (bb_miiphy_buses[i].init != NULL) {
1244ba31ab3SLuigi 'Comio' Mantellini 			bb_miiphy_buses[i].init(&bb_miiphy_buses[i]);
1254ba31ab3SLuigi 'Comio' Mantellini 		}
1264ba31ab3SLuigi 'Comio' Mantellini 	}
1274ba31ab3SLuigi 'Comio' Mantellini }
1284ba31ab3SLuigi 'Comio' Mantellini 
bb_miiphy_getbus(const char * devname)129d7fb9bcfSBen Warren static inline struct bb_miiphy_bus *bb_miiphy_getbus(const char *devname)
1304ba31ab3SLuigi 'Comio' Mantellini {
1314ba31ab3SLuigi 'Comio' Mantellini #ifdef CONFIG_BITBANGMII_MULTI
1324ba31ab3SLuigi 'Comio' Mantellini 	int i;
1334ba31ab3SLuigi 'Comio' Mantellini 
1344ba31ab3SLuigi 'Comio' Mantellini 	/* Search the correct bus */
1354ba31ab3SLuigi 'Comio' Mantellini 	for (i = 0; i < bb_miiphy_buses_num; i++) {
1364ba31ab3SLuigi 'Comio' Mantellini 		if (!strcmp(bb_miiphy_buses[i].name, devname)) {
1374ba31ab3SLuigi 'Comio' Mantellini 			return &bb_miiphy_buses[i];
1384ba31ab3SLuigi 'Comio' Mantellini 		}
1394ba31ab3SLuigi 'Comio' Mantellini 	}
1404ba31ab3SLuigi 'Comio' Mantellini 	return NULL;
1414ba31ab3SLuigi 'Comio' Mantellini #else
1424ba31ab3SLuigi 'Comio' Mantellini 	/* We have just one bitbanging bus */
1434ba31ab3SLuigi 'Comio' Mantellini 	return &bb_miiphy_buses[0];
1444ba31ab3SLuigi 'Comio' Mantellini #endif
1454ba31ab3SLuigi 'Comio' Mantellini }
14655195773SJean-Christophe PLAGNIOL-VILLARD 
14755195773SJean-Christophe PLAGNIOL-VILLARD /*****************************************************************************
14855195773SJean-Christophe PLAGNIOL-VILLARD  *
14955195773SJean-Christophe PLAGNIOL-VILLARD  * Utility to send the preamble, address, and register (common to read
15055195773SJean-Christophe PLAGNIOL-VILLARD  * and write).
15155195773SJean-Christophe PLAGNIOL-VILLARD  */
miiphy_pre(struct bb_miiphy_bus * bus,char read,unsigned char addr,unsigned char reg)1524ba31ab3SLuigi 'Comio' Mantellini static void miiphy_pre(struct bb_miiphy_bus *bus, char read,
1534ba31ab3SLuigi 'Comio' Mantellini 		       unsigned char addr, unsigned char reg)
15455195773SJean-Christophe PLAGNIOL-VILLARD {
1554ba31ab3SLuigi 'Comio' Mantellini 	int j;
15655195773SJean-Christophe PLAGNIOL-VILLARD 
15755195773SJean-Christophe PLAGNIOL-VILLARD 	/*
15855195773SJean-Christophe PLAGNIOL-VILLARD 	 * Send a 32 bit preamble ('1's) with an extra '1' bit for good measure.
15955195773SJean-Christophe PLAGNIOL-VILLARD 	 * The IEEE spec says this is a PHY optional requirement.  The AMD
16055195773SJean-Christophe PLAGNIOL-VILLARD 	 * 79C874 requires one after power up and one after a MII communications
16155195773SJean-Christophe PLAGNIOL-VILLARD 	 * error.  This means that we are doing more preambles than we need,
16255195773SJean-Christophe PLAGNIOL-VILLARD 	 * but it is safer and will be much more robust.
16355195773SJean-Christophe PLAGNIOL-VILLARD 	 */
16455195773SJean-Christophe PLAGNIOL-VILLARD 
1654ba31ab3SLuigi 'Comio' Mantellini 	bus->mdio_active(bus);
1664ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 1);
16755195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 32; j++) {
1684ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
1694ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
1704ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
1714ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
17255195773SJean-Christophe PLAGNIOL-VILLARD 	}
17355195773SJean-Christophe PLAGNIOL-VILLARD 
17455195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the start bit (01) and the read opcode (10) or write (10) */
1754ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1764ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 0);
1774ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1784ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1794ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1804ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1814ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 1);
1824ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1834ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1844ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1854ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1864ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, read);
1874ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1884ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1894ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1904ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
1914ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, !read);
1924ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
1934ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
1944ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
19555195773SJean-Christophe PLAGNIOL-VILLARD 
19655195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the PHY address */
19755195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 5; j++) {
1984ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
19955195773SJean-Christophe PLAGNIOL-VILLARD 		if ((addr & 0x10) == 0) {
2004ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 0);
20155195773SJean-Christophe PLAGNIOL-VILLARD 		} else {
2024ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 1);
20355195773SJean-Christophe PLAGNIOL-VILLARD 		}
2044ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
2054ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
2064ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
20755195773SJean-Christophe PLAGNIOL-VILLARD 		addr <<= 1;
20855195773SJean-Christophe PLAGNIOL-VILLARD 	}
20955195773SJean-Christophe PLAGNIOL-VILLARD 
21055195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the register address */
21155195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 5; j++) {
2124ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
21355195773SJean-Christophe PLAGNIOL-VILLARD 		if ((reg & 0x10) == 0) {
2144ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 0);
21555195773SJean-Christophe PLAGNIOL-VILLARD 		} else {
2164ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 1);
21755195773SJean-Christophe PLAGNIOL-VILLARD 		}
2184ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
2194ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
2204ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
22155195773SJean-Christophe PLAGNIOL-VILLARD 		reg <<= 1;
22255195773SJean-Christophe PLAGNIOL-VILLARD 	}
22355195773SJean-Christophe PLAGNIOL-VILLARD }
22455195773SJean-Christophe PLAGNIOL-VILLARD 
22555195773SJean-Christophe PLAGNIOL-VILLARD /*****************************************************************************
22655195773SJean-Christophe PLAGNIOL-VILLARD  *
22755195773SJean-Christophe PLAGNIOL-VILLARD  * Read a MII PHY register.
22855195773SJean-Christophe PLAGNIOL-VILLARD  *
22955195773SJean-Christophe PLAGNIOL-VILLARD  * Returns:
23055195773SJean-Christophe PLAGNIOL-VILLARD  *   0 on success
23155195773SJean-Christophe PLAGNIOL-VILLARD  */
bb_miiphy_read(struct mii_dev * miidev,int addr,int devad,int reg)232dfcc496eSJoe Hershberger int bb_miiphy_read(struct mii_dev *miidev, int addr, int devad, int reg)
23355195773SJean-Christophe PLAGNIOL-VILLARD {
23433bab104SChris Brandt 	unsigned short rdreg; /* register working value */
2354ba31ab3SLuigi 'Comio' Mantellini 	int v;
23655195773SJean-Christophe PLAGNIOL-VILLARD 	int j; /* counter */
2374ba31ab3SLuigi 'Comio' Mantellini 	struct bb_miiphy_bus *bus;
2384ba31ab3SLuigi 'Comio' Mantellini 
239dfcc496eSJoe Hershberger 	bus = bb_miiphy_getbus(miidev->name);
2404ba31ab3SLuigi 'Comio' Mantellini 	if (bus == NULL) {
2414ba31ab3SLuigi 'Comio' Mantellini 		return -1;
2424ba31ab3SLuigi 'Comio' Mantellini 	}
24355195773SJean-Christophe PLAGNIOL-VILLARD 
2444ba31ab3SLuigi 'Comio' Mantellini 	miiphy_pre (bus, 1, addr, reg);
24555195773SJean-Christophe PLAGNIOL-VILLARD 
24655195773SJean-Christophe PLAGNIOL-VILLARD 	/* tri-state our MDIO I/O pin so we can read */
2474ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
2484ba31ab3SLuigi 'Comio' Mantellini 	bus->mdio_tristate(bus);
2494ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
2504ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
2514ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
25255195773SJean-Christophe PLAGNIOL-VILLARD 
25355195773SJean-Christophe PLAGNIOL-VILLARD 	/* check the turnaround bit: the PHY should be driving it to zero */
2544ba31ab3SLuigi 'Comio' Mantellini 	bus->get_mdio(bus, &v);
2554ba31ab3SLuigi 'Comio' Mantellini 	if (v != 0) {
25655195773SJean-Christophe PLAGNIOL-VILLARD 		/* puts ("PHY didn't drive TA low\n"); */
25755195773SJean-Christophe PLAGNIOL-VILLARD 		for (j = 0; j < 32; j++) {
2584ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdc(bus, 0);
2594ba31ab3SLuigi 'Comio' Mantellini 			bus->delay(bus);
2604ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdc(bus, 1);
2614ba31ab3SLuigi 'Comio' Mantellini 			bus->delay(bus);
26255195773SJean-Christophe PLAGNIOL-VILLARD 		}
263dfcc496eSJoe Hershberger 		/* There is no PHY, return */
2644ba31ab3SLuigi 'Comio' Mantellini 		return -1;
26555195773SJean-Christophe PLAGNIOL-VILLARD 	}
26655195773SJean-Christophe PLAGNIOL-VILLARD 
2674ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
2684ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
26955195773SJean-Christophe PLAGNIOL-VILLARD 
27055195773SJean-Christophe PLAGNIOL-VILLARD 	/* read 16 bits of register data, MSB first */
27155195773SJean-Christophe PLAGNIOL-VILLARD 	rdreg = 0;
27255195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 16; j++) {
2734ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
2744ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
27555195773SJean-Christophe PLAGNIOL-VILLARD 		rdreg <<= 1;
2764ba31ab3SLuigi 'Comio' Mantellini 		bus->get_mdio(bus, &v);
2774ba31ab3SLuigi 'Comio' Mantellini 		rdreg |= (v & 0x1);
2784ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
2794ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
28055195773SJean-Christophe PLAGNIOL-VILLARD 	}
28155195773SJean-Christophe PLAGNIOL-VILLARD 
2824ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
2834ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
2844ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
2854ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
2864ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
2874ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
28855195773SJean-Christophe PLAGNIOL-VILLARD 
28955195773SJean-Christophe PLAGNIOL-VILLARD #ifdef DEBUG
290dfcc496eSJoe Hershberger 	printf("miiphy_read(0x%x) @ 0x%x = 0x%04x\n", reg, addr, rdreg);
29155195773SJean-Christophe PLAGNIOL-VILLARD #endif
29255195773SJean-Christophe PLAGNIOL-VILLARD 
293dfcc496eSJoe Hershberger 	return rdreg;
29455195773SJean-Christophe PLAGNIOL-VILLARD }
29555195773SJean-Christophe PLAGNIOL-VILLARD 
29655195773SJean-Christophe PLAGNIOL-VILLARD 
29755195773SJean-Christophe PLAGNIOL-VILLARD /*****************************************************************************
29855195773SJean-Christophe PLAGNIOL-VILLARD  *
29955195773SJean-Christophe PLAGNIOL-VILLARD  * Write a MII PHY register.
30055195773SJean-Christophe PLAGNIOL-VILLARD  *
30155195773SJean-Christophe PLAGNIOL-VILLARD  * Returns:
30255195773SJean-Christophe PLAGNIOL-VILLARD  *   0 on success
30355195773SJean-Christophe PLAGNIOL-VILLARD  */
bb_miiphy_write(struct mii_dev * miidev,int addr,int devad,int reg,u16 value)304dfcc496eSJoe Hershberger int bb_miiphy_write(struct mii_dev *miidev, int addr, int devad, int reg,
305dfcc496eSJoe Hershberger 		    u16 value)
30655195773SJean-Christophe PLAGNIOL-VILLARD {
3074ba31ab3SLuigi 'Comio' Mantellini 	struct bb_miiphy_bus *bus;
30855195773SJean-Christophe PLAGNIOL-VILLARD 	int j;			/* counter */
30955195773SJean-Christophe PLAGNIOL-VILLARD 
310dfcc496eSJoe Hershberger 	bus = bb_miiphy_getbus(miidev->name);
3114ba31ab3SLuigi 'Comio' Mantellini 	if (bus == NULL) {
3124ba31ab3SLuigi 'Comio' Mantellini 		/* Bus not found! */
3134ba31ab3SLuigi 'Comio' Mantellini 		return -1;
3144ba31ab3SLuigi 'Comio' Mantellini 	}
3154ba31ab3SLuigi 'Comio' Mantellini 
3164ba31ab3SLuigi 'Comio' Mantellini 	miiphy_pre (bus, 0, addr, reg);
31755195773SJean-Christophe PLAGNIOL-VILLARD 
31855195773SJean-Christophe PLAGNIOL-VILLARD 	/* send the turnaround (10) */
3194ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
3204ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 1);
3214ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3224ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
3234ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3244ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
3254ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdio(bus, 0);
3264ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3274ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
3284ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
32955195773SJean-Christophe PLAGNIOL-VILLARD 
33055195773SJean-Christophe PLAGNIOL-VILLARD 	/* write 16 bits of register data, MSB first */
33155195773SJean-Christophe PLAGNIOL-VILLARD 	for (j = 0; j < 16; j++) {
3324ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 0);
33355195773SJean-Christophe PLAGNIOL-VILLARD 		if ((value & 0x00008000) == 0) {
3344ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 0);
33555195773SJean-Christophe PLAGNIOL-VILLARD 		} else {
3364ba31ab3SLuigi 'Comio' Mantellini 			bus->set_mdio(bus, 1);
33755195773SJean-Christophe PLAGNIOL-VILLARD 		}
3384ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
3394ba31ab3SLuigi 'Comio' Mantellini 		bus->set_mdc(bus, 1);
3404ba31ab3SLuigi 'Comio' Mantellini 		bus->delay(bus);
34155195773SJean-Christophe PLAGNIOL-VILLARD 		value <<= 1;
34255195773SJean-Christophe PLAGNIOL-VILLARD 	}
34355195773SJean-Christophe PLAGNIOL-VILLARD 
34455195773SJean-Christophe PLAGNIOL-VILLARD 	/*
34555195773SJean-Christophe PLAGNIOL-VILLARD 	 * Tri-state the MDIO line.
34655195773SJean-Christophe PLAGNIOL-VILLARD 	 */
3474ba31ab3SLuigi 'Comio' Mantellini 	bus->mdio_tristate(bus);
3484ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 0);
3494ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
3504ba31ab3SLuigi 'Comio' Mantellini 	bus->set_mdc(bus, 1);
3514ba31ab3SLuigi 'Comio' Mantellini 	bus->delay(bus);
35255195773SJean-Christophe PLAGNIOL-VILLARD 
35355195773SJean-Christophe PLAGNIOL-VILLARD 	return 0;
35455195773SJean-Christophe PLAGNIOL-VILLARD }
355