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