ibm_emac.c - platform/external/ethtool - Gitiles

 /*
  *  Copyright (c) 2004, 2005 Zultys Technologies
  *  Eugene Surovegin <eugene.surovegin@zultys.com> or <ebs@ebshome.net>
  */
 #include <stdio.h>
 #include <stdint.h>
 #include <stddef.h>

 #include "internal.h"

 /* Ethtool get_regs complex data.
  * we want to get not just EMAC registers, but also MAL, ZMII, RGMII, TAH
  * when available.
  *
  * Returned BLOB consists of the ibm_emac_ethtool_regs_hdr,
  * MAL registers, EMAC registers and optional ZMII, RGMII, TAH registers.
  * Each register component is preceded with emac_ethtool_regs_subhdr.
  * Order of the optional headers follows their relative bit posititions
  * in emac_ethtool_regs_hdr.components
  */
 #define EMAC_ETHTOOL_REGS_ZMII		0x00000001
 #define EMAC_ETHTOOL_REGS_RGMII		0x00000002
 #define EMAC_ETHTOOL_REGS_TAH		0x00000004

 #define EMAC_VERSION			3
 #define EMAC4_VERSION			4
 #define EMAC4SYNC_VERSION		5

 struct emac_ethtool_regs_hdr {
 	u32 components;
 };

 struct emac_ethtool_regs_subhdr {
 	u32 version;
 	u32 index;
 };

 struct emac_regs {
 	/* Common registers across all EMAC implementations. */
 	u32 mr0;			/* Special 	*/
 	u32 mr1;			/* Reset 	*/
 	u32 tmr0;			/* Special 	*/
 	u32 tmr1;			/* Special 	*/
 	u32 rmr;			/* Reset 	*/
 	u32 isr;			/* Always 	*/
 	u32 iser;			/* Reset 	*/
 	u32 iahr;			/* Reset, R, T 	*/
 	u32 ialr;			/* Reset, R, T 	*/
 	u32 vtpid;			/* Reset, R, T 	*/
 	u32 vtci;			/* Reset, R, T 	*/
 	u32 ptr;			/* Reset,    T 	*/
 	union {
 		/* Registers unique to EMAC4 implementations */
 		struct {
 			u32 iaht1;	/* Reset, R	*/
 			u32 iaht2;	/* Reset, R	*/
 			u32 iaht3;	/* Reset, R	*/
 			u32 iaht4;	/* Reset, R	*/
 			u32 gaht1;	/* Reset, R	*/
 			u32 gaht2;	/* Reset, R	*/
 			u32 gaht3;	/* Reset, R	*/
 			u32 gaht4;	/* Reset, R	*/
 		} emac4;
 		/* Registers unique to EMAC4SYNC implementations */
 		struct {
 			u32 mahr;	/* Reset, R, T  */
 			u32 malr;	/* Reset, R, T  */
 			u32 mmahr;	/* Reset, R, T  */
 			u32 mmalr;	/* Reset, R, T  */
 			u32 rsvd0[4];
 		} emac4sync;
 	} u0;
 	/* Common registers across all EMAC implementations. */
 	u32 lsah;
 	u32 lsal;
 	u32 ipgvr;			/* Reset,    T 	*/
 	u32 stacr;			/* Special 	*/
 	u32 trtr;			/* Special 	*/
 	u32 rwmr;			/* Reset 	*/
 	u32 octx;
 	u32 ocrx;
 	union {
 		/* Registers unique to EMAC4 implementations */
 		struct {
 			u32 ipcr;
 		} emac4;
 		/* Registers unique to EMAC4SYNC implementations */
 		struct {
 			u32 rsvd1;
 			u32 revid;
 			u32 rsvd2[2];
 			u32 iaht1;	/* Reset, R     */
 			u32 iaht2;	/* Reset, R     */
 			u32 iaht3;	/* Reset, R     */
 			u32 iaht4;	/* Reset, R     */
 			u32 iaht5;	/* Reset, R     */
 			u32 iaht6;	/* Reset, R     */
 			u32 iaht7;	/* Reset, R     */
 			u32 iaht8;	/* Reset, R     */
 			u32 gaht1;	/* Reset, R     */
 			u32 gaht2;	/* Reset, R     */
 			u32 gaht3;	/* Reset, R     */
 			u32 gaht4;	/* Reset, R     */
 			u32 gaht5;	/* Reset, R     */
 			u32 gaht6;	/* Reset, R     */
 			u32 gaht7;	/* Reset, R     */
 			u32 gaht8;	/* Reset, R     */
 			u32 tpc;	/* Reset, T     */
 		} emac4sync;
 	} u1;
 };

 struct mal_regs {
 	u32 tx_count;
 	u32 rx_count;

 	u32 cfg;
 	u32 esr;
 	u32 ier;
 	u32 tx_casr;
 	u32 tx_carr;
 	u32 tx_eobisr;
 	u32 tx_deir;
 	u32 rx_casr;
 	u32 rx_carr;
 	u32 rx_eobisr;
 	u32 rx_deir;
 	u32 tx_ctpr[32];
 	u32 rx_ctpr[32];
 	u32 rcbs[32];
 };

 struct zmii_regs {
 	u32 fer;
 	u32 ssr;
 	u32 smiisr;
 };

 struct rgmii_regs {
 	u32 fer;
 	u32 ssr;
 };

 struct tah_regs {
 	u32 revid;
 	u32 pad[3];
 	u32 mr;
 	u32 ssr0;
 	u32 ssr1;
 	u32 ssr2;
 	u32 ssr3;
 	u32 ssr4;
 	u32 ssr5;
 	u32 tsr;
 };

 static void *print_emac_regs(void *buf)
 {
 	struct emac_ethtool_regs_subhdr *hdr = buf;
 	struct emac_regs *p = (struct emac_regs *)(hdr + 1);
 	void *res = p + 1;

 	if (!((hdr->version == EMAC_VERSION) ||
 		(hdr->version == EMAC4_VERSION) ||
 		(hdr->version == EMAC4SYNC_VERSION)))
 	{
 		printf("This driver version doesn't support information\n"
 			" output for EMAC area, please update it or use older\n"
 			" ethtool version\n");
 		return res;
 	}

 	printf("EMAC%d Registers\n", hdr->index);
 	printf("-----------------\n");
 	printf("MR0   = 0x%08x MR1  = 0x%08x RMR = 0x%08x\n"
 	       "ISR   = 0x%08x ISER = 0x%08x\n"
 	       "TMR0  = 0x%08x TMR1 = 0x%08x\n"
 	       "TRTR  = 0x%08x RWMR = 0x%08x\n"
 	       "IAR   = %04x%08x\n"
 	       "LSA   = %04x%08x\n"
 	       "VTPID = 0x%04x VTCI = 0x%04x\n"
 	       "IPGVR = 0x%04x STACR = 0x%08x\n"
 	       "OCTX  = 0x%08x OCRX = 0x%08x\n",
 	       p->mr0, p->mr1, p->rmr,
 	       p->isr, p->iser,
 	       p->tmr0, p->tmr1,
 	       p->trtr, p->rwmr,
 	       p->iahr, p->ialr,
 	       p->lsah, p->lsal,
 	       p->vtpid, p->vtci,
 	       p->ipgvr, p->stacr, p->octx, p->ocrx);

 	if (hdr->version == EMAC4SYNC_VERSION) {
 		printf("MAHR  = 0x%08x MALR  = 0x%08x MMAHR = 0x%08x\n"
 			"MMALR  = 0x%08x REVID  = 0x%08x\n",
 			p->u0.emac4sync.mahr, p->u0.emac4sync.malr,
 			p->u0.emac4sync.mmahr, p->u0.emac4sync.mmalr,
 			p->u1.emac4sync.revid);

 		printf("IAHT  = 0x%04x 0x%04x 0x%04x 0x%04x\n",
 			p->u1.emac4sync.iaht1, p->u1.emac4sync.iaht2,
 			p->u1.emac4sync.iaht3, p->u1.emac4sync.iaht4);
 		printf("        0x%04x 0x%04x 0x%04x 0x%04x\n",
 			p->u1.emac4sync.iaht5, p->u1.emac4sync.iaht6,
 			p->u1.emac4sync.iaht7, p->u1.emac4sync.iaht8);


 		printf("GAHT  = 0x%04x 0x%04x 0x%04x 0x%04x\n",
 			p->u1.emac4sync.gaht1, p->u1.emac4sync.gaht2,
 			p->u1.emac4sync.gaht3, p->u1.emac4sync.gaht4);
 		printf("        0x%04x 0x%04x 0x%04x 0x%04x\n\n",
 			p->u1.emac4sync.gaht5, p->u1.emac4sync.gaht6,
 			p->u1.emac4sync.gaht7, p->u1.emac4sync.gaht8);

 	} else if (hdr->version == EMAC4_VERSION) {
 		printf("IAHT  = 0x%04x 0x%04x 0x%04x 0x%04x\n",
 			p->u0.emac4.iaht1, p->u0.emac4.iaht2,
 			p->u0.emac4.iaht3, p->u0.emac4.iaht4);

 		printf("GAHT  = 0x%04x 0x%04x 0x%04x 0x%04x\n",
 			p->u0.emac4.gaht1, p->u0.emac4.gaht2,
 			p->u0.emac4.gaht3, p->u0.emac4.gaht4);

 		printf(" IPCR = 0x%08x\n\n", p->u1.emac4.ipcr);
 	} else if (hdr->version == EMAC_VERSION) {
 		printf("IAHT  = 0x%04x 0x%04x 0x%04x 0x%04x\n",
 			p->u0.emac4.iaht1, p->u0.emac4.iaht2,
 			p->u0.emac4.iaht3, p->u0.emac4.iaht4);

 		printf("GAHT  = 0x%04x 0x%04x 0x%04x 0x%04x\n",
 			p->u0.emac4.gaht1, p->u0.emac4.gaht2,
 			p->u0.emac4.gaht3, p->u0.emac4.gaht4);
 	}
 	return res;
 }

 static void *print_mal_regs(void *buf)
 {
 	struct emac_ethtool_regs_subhdr *hdr = buf;
 	struct mal_regs *p = (struct mal_regs *)(hdr + 1);
 	int i;

 	printf("MAL%d Registers\n", hdr->index);
 	printf("-----------------\n");
 	printf("CFG = 0x%08x ESR = 0x%08x IER = 0x%08x\n"
 	       "TX|CASR = 0x%08x CARR = 0x%08x EOBISR = 0x%08x DEIR = 0x%08x\n"
 	       "RX|CASR = 0x%08x CARR = 0x%08x EOBISR = 0x%08x DEIR = 0x%08x\n",
 	       p->cfg, p->esr, p->ier,
 	       p->tx_casr, p->tx_carr, p->tx_eobisr, p->tx_deir,
 	       p->rx_casr, p->rx_carr, p->rx_eobisr, p->rx_deir);

 	printf("TX|");
 	for (i = 0; i < p->tx_count; ++i) {
 		if (i && !(i % 4))
 			printf("\n   ");
 		printf("CTP%d = 0x%08x ", i, p->tx_ctpr[i]);
 	}
 	printf("\nRX|");
 	for (i = 0; i < p->rx_count; ++i) {
 		if (i && !(i % 4))
 			printf("\n   ");
 		printf("CTP%d = 0x%08x ", i, p->rx_ctpr[i]);
 	}
 	printf("\n   ");
 	for (i = 0; i < p->rx_count; ++i) {
 		u32 r = p->rcbs[i];
 		if (i && !(i % 3))
 			printf("\n   ");
 		printf("RCBS%d = 0x%08x (%d) ", i, r, r * 16);
 	}
 	printf("\n\n");
 	return p + 1;
 }

 static void *print_zmii_regs(void *buf)
 {
 	struct emac_ethtool_regs_subhdr *hdr = buf;
 	struct zmii_regs *p = (struct zmii_regs *)(hdr + 1);

 	printf("ZMII%d Registers\n", hdr->index);
 	printf("-----------------\n");
 	printf("FER    = %08x SSR = %08x\n"
 	       "SMIISR = %08x\n\n", p->fer, p->ssr, p->smiisr);

 	return p + 1;
 }

 static void *print_rgmii_regs(void *buf)
 {
 	struct emac_ethtool_regs_subhdr *hdr = buf;
 	struct rgmii_regs *p = (struct rgmii_regs *)(hdr + 1);

 	printf("RGMII%d Registers\n", hdr->index);
 	printf("-----------------\n");
 	printf("FER    = %08x SSR = %08x\n\n", p->fer, p->ssr);

 	return p + 1;
 }

 static void *print_tah_regs(void *buf)
 {
 	struct emac_ethtool_regs_subhdr *hdr = buf;
 	struct tah_regs *p = (struct tah_regs *)(hdr + 1);

 	printf("TAH%d Registers\n", hdr->index);
 	printf("-----------------\n");

 	printf("REVID = %08x MR = %08x TSR = %08x\n"
 	       "SSR0  = %08x SSR1 = %08x SSR2 = %08x\n"
 	       "SSR3  = %08x SSR4 = %08x SSR5 = %08x\n\n",
 	       p->revid, p->mr, p->tsr,
 	       p->ssr0, p->ssr1, p->ssr2, p->ssr3, p->ssr4, p->ssr5);

 	return p + 1;
 }

 int ibm_emac_dump_regs(struct ethtool_drvinfo *info, struct ethtool_regs *regs)
 {
 	struct emac_ethtool_regs_hdr *hdr =
 	    (struct emac_ethtool_regs_hdr *)regs->data;
 	void *buf = hdr + 1;

 	buf = print_mal_regs(buf);
 	buf = print_emac_regs(buf);
 	if (hdr->components & EMAC_ETHTOOL_REGS_ZMII)
 		buf = print_zmii_regs(buf);
 	if (hdr->components & EMAC_ETHTOOL_REGS_RGMII)
 		buf = print_rgmii_regs(buf);
 	if (hdr->components & EMAC_ETHTOOL_REGS_TAH)
 		print_tah_regs(buf);

 	return 0;
 }
	/*
	* Copyright (c) 2004, 2005 Zultys Technologies
	* Eugene Surovegin <eugene.surovegin@zultys.com> or <ebs@ebshome.net>
	*/
	#include <stdio.h>
	#include <stdint.h>
	#include <stddef.h>

	#include "internal.h"

	/* Ethtool get_regs complex data.
	* we want to get not just EMAC registers, but also MAL, ZMII, RGMII, TAH
	* when available.
	*
	* Returned BLOB consists of the ibm_emac_ethtool_regs_hdr,
	* MAL registers, EMAC registers and optional ZMII, RGMII, TAH registers.
	* Each register component is preceded with emac_ethtool_regs_subhdr.
	* Order of the optional headers follows their relative bit posititions
	* in emac_ethtool_regs_hdr.components
	*/
	#define EMAC_ETHTOOL_REGS_ZMII 0x00000001
	#define EMAC_ETHTOOL_REGS_RGMII 0x00000002
	#define EMAC_ETHTOOL_REGS_TAH 0x00000004

	#define EMAC_VERSION 3
	#define EMAC4_VERSION 4
	#define EMAC4SYNC_VERSION 5

	struct emac_ethtool_regs_hdr {
	u32 components;
	};

	struct emac_ethtool_regs_subhdr {
	u32 version;
	u32 index;
	};

	struct emac_regs {
	/* Common registers across all EMAC implementations. */
	u32 mr0; /* Special */
	u32 mr1; /* Reset */
	u32 tmr0; /* Special */
	u32 tmr1; /* Special */
	u32 rmr; /* Reset */
	u32 isr; /* Always */
	u32 iser; /* Reset */
	u32 iahr; /* Reset, R, T */
	u32 ialr; /* Reset, R, T */
	u32 vtpid; /* Reset, R, T */
	u32 vtci; /* Reset, R, T */
	u32 ptr; /* Reset, T */
	union {
	/* Registers unique to EMAC4 implementations */
	struct {
	u32 iaht1; /* Reset, R */
	u32 iaht2; /* Reset, R */
	u32 iaht3; /* Reset, R */
	u32 iaht4; /* Reset, R */
	u32 gaht1; /* Reset, R */
	u32 gaht2; /* Reset, R */
	u32 gaht3; /* Reset, R */
	u32 gaht4; /* Reset, R */
	} emac4;
	/* Registers unique to EMAC4SYNC implementations */
	struct {
	u32 mahr; /* Reset, R, T */
	u32 malr; /* Reset, R, T */
	u32 mmahr; /* Reset, R, T */
	u32 mmalr; /* Reset, R, T */
	u32 rsvd0[4];
	} emac4sync;
	} u0;
	/* Common registers across all EMAC implementations. */
	u32 lsah;
	u32 lsal;
	u32 ipgvr; /* Reset, T */
	u32 stacr; /* Special */
	u32 trtr; /* Special */
	u32 rwmr; /* Reset */
	u32 octx;
	u32 ocrx;
	union {
	/* Registers unique to EMAC4 implementations */
	struct {
	u32 ipcr;
	} emac4;
	/* Registers unique to EMAC4SYNC implementations */
	struct {
	u32 rsvd1;
	u32 revid;
	u32 rsvd2[2];
	u32 iaht1; /* Reset, R */
	u32 iaht2; /* Reset, R */
	u32 iaht3; /* Reset, R */
	u32 iaht4; /* Reset, R */
	u32 iaht5; /* Reset, R */
	u32 iaht6; /* Reset, R */
	u32 iaht7; /* Reset, R */
	u32 iaht8; /* Reset, R */
	u32 gaht1; /* Reset, R */
	u32 gaht2; /* Reset, R */
	u32 gaht3; /* Reset, R */
	u32 gaht4; /* Reset, R */
	u32 gaht5; /* Reset, R */
	u32 gaht6; /* Reset, R */
	u32 gaht7; /* Reset, R */
	u32 gaht8; /* Reset, R */
	u32 tpc; /* Reset, T */
	} emac4sync;
	} u1;
	};

	struct mal_regs {
	u32 tx_count;
	u32 rx_count;

	u32 cfg;
	u32 esr;
	u32 ier;
	u32 tx_casr;
	u32 tx_carr;
	u32 tx_eobisr;
	u32 tx_deir;
	u32 rx_casr;
	u32 rx_carr;
	u32 rx_eobisr;
	u32 rx_deir;
	u32 tx_ctpr[32];
	u32 rx_ctpr[32];
	u32 rcbs[32];
	};

	struct zmii_regs {
	u32 fer;
	u32 ssr;
	u32 smiisr;
	};

	struct rgmii_regs {
	u32 fer;
	u32 ssr;
	};

	struct tah_regs {
	u32 revid;
	u32 pad[3];
	u32 mr;
	u32 ssr0;
	u32 ssr1;
	u32 ssr2;
	u32 ssr3;
	u32 ssr4;
	u32 ssr5;
	u32 tsr;
	};

	static void print_emac_regs(void buf)
	{
	struct emac_ethtool_regs_subhdr *hdr = buf;
	struct emac_regs p = (struct emac_regs )(hdr + 1);
	void *res = p + 1;

	if (!((hdr->version == EMAC_VERSION) \|\|
	(hdr->version == EMAC4_VERSION) \|\|
	(hdr->version == EMAC4SYNC_VERSION)))
	{
	printf("This driver version doesn't support information\n"
	" output for EMAC area, please update it or use older\n"
	" ethtool version\n");
	return res;
	}

	printf("EMAC%d Registers\n", hdr->index);
	printf("-----------------\n");
	printf("MR0 = 0x%08x MR1 = 0x%08x RMR = 0x%08x\n"
	"ISR = 0x%08x ISER = 0x%08x\n"
	"TMR0 = 0x%08x TMR1 = 0x%08x\n"
	"TRTR = 0x%08x RWMR = 0x%08x\n"
	"IAR = %04x%08x\n"
	"LSA = %04x%08x\n"
	"VTPID = 0x%04x VTCI = 0x%04x\n"
	"IPGVR = 0x%04x STACR = 0x%08x\n"
	"OCTX = 0x%08x OCRX = 0x%08x\n",
	p->mr0, p->mr1, p->rmr,
	p->isr, p->iser,
	p->tmr0, p->tmr1,
	p->trtr, p->rwmr,
	p->iahr, p->ialr,
	p->lsah, p->lsal,
	p->vtpid, p->vtci,
	p->ipgvr, p->stacr, p->octx, p->ocrx);

	if (hdr->version == EMAC4SYNC_VERSION) {
	printf("MAHR = 0x%08x MALR = 0x%08x MMAHR = 0x%08x\n"
	"MMALR = 0x%08x REVID = 0x%08x\n",
	p->u0.emac4sync.mahr, p->u0.emac4sync.malr,
	p->u0.emac4sync.mmahr, p->u0.emac4sync.mmalr,
	p->u1.emac4sync.revid);

	printf("IAHT = 0x%04x 0x%04x 0x%04x 0x%04x\n",
	p->u1.emac4sync.iaht1, p->u1.emac4sync.iaht2,
	p->u1.emac4sync.iaht3, p->u1.emac4sync.iaht4);
	printf(" 0x%04x 0x%04x 0x%04x 0x%04x\n",
	p->u1.emac4sync.iaht5, p->u1.emac4sync.iaht6,
	p->u1.emac4sync.iaht7, p->u1.emac4sync.iaht8);


	printf("GAHT = 0x%04x 0x%04x 0x%04x 0x%04x\n",
	p->u1.emac4sync.gaht1, p->u1.emac4sync.gaht2,
	p->u1.emac4sync.gaht3, p->u1.emac4sync.gaht4);
	printf(" 0x%04x 0x%04x 0x%04x 0x%04x\n\n",
	p->u1.emac4sync.gaht5, p->u1.emac4sync.gaht6,
	p->u1.emac4sync.gaht7, p->u1.emac4sync.gaht8);

	} else if (hdr->version == EMAC4_VERSION) {
	printf("IAHT = 0x%04x 0x%04x 0x%04x 0x%04x\n",
	p->u0.emac4.iaht1, p->u0.emac4.iaht2,
	p->u0.emac4.iaht3, p->u0.emac4.iaht4);

	printf("GAHT = 0x%04x 0x%04x 0x%04x 0x%04x\n",
	p->u0.emac4.gaht1, p->u0.emac4.gaht2,
	p->u0.emac4.gaht3, p->u0.emac4.gaht4);

	printf(" IPCR = 0x%08x\n\n", p->u1.emac4.ipcr);
	} else if (hdr->version == EMAC_VERSION) {
	printf("IAHT = 0x%04x 0x%04x 0x%04x 0x%04x\n",
	p->u0.emac4.iaht1, p->u0.emac4.iaht2,
	p->u0.emac4.iaht3, p->u0.emac4.iaht4);

	printf("GAHT = 0x%04x 0x%04x 0x%04x 0x%04x\n",
	p->u0.emac4.gaht1, p->u0.emac4.gaht2,
	p->u0.emac4.gaht3, p->u0.emac4.gaht4);
	}
	return res;
	}

	static void print_mal_regs(void buf)
	{
	struct emac_ethtool_regs_subhdr *hdr = buf;
	struct mal_regs p = (struct mal_regs )(hdr + 1);
	int i;

	printf("MAL%d Registers\n", hdr->index);
	printf("-----------------\n");
	printf("CFG = 0x%08x ESR = 0x%08x IER = 0x%08x\n"
	"TX\|CASR = 0x%08x CARR = 0x%08x EOBISR = 0x%08x DEIR = 0x%08x\n"
	"RX\|CASR = 0x%08x CARR = 0x%08x EOBISR = 0x%08x DEIR = 0x%08x\n",
	p->cfg, p->esr, p->ier,
	p->tx_casr, p->tx_carr, p->tx_eobisr, p->tx_deir,
	p->rx_casr, p->rx_carr, p->rx_eobisr, p->rx_deir);

	printf("TX\|");
	for (i = 0; i < p->tx_count; ++i) {
	if (i && !(i % 4))
	printf("\n ");
	printf("CTP%d = 0x%08x ", i, p->tx_ctpr[i]);
	}
	printf("\nRX\|");
	for (i = 0; i < p->rx_count; ++i) {
	if (i && !(i % 4))
	printf("\n ");
	printf("CTP%d = 0x%08x ", i, p->rx_ctpr[i]);
	}
	printf("\n ");
	for (i = 0; i < p->rx_count; ++i) {
	u32 r = p->rcbs[i];
	if (i && !(i % 3))
	printf("\n ");
	printf("RCBS%d = 0x%08x (%d) ", i, r, r * 16);
	}
	printf("\n\n");
	return p + 1;
	}

	static void print_zmii_regs(void buf)
	{
	struct emac_ethtool_regs_subhdr *hdr = buf;
	struct zmii_regs p = (struct zmii_regs )(hdr + 1);

	printf("ZMII%d Registers\n", hdr->index);
	printf("-----------------\n");
	printf("FER = %08x SSR = %08x\n"
	"SMIISR = %08x\n\n", p->fer, p->ssr, p->smiisr);

	return p + 1;
	}

	static void print_rgmii_regs(void buf)
	{
	struct emac_ethtool_regs_subhdr *hdr = buf;
	struct rgmii_regs p = (struct rgmii_regs )(hdr + 1);

	printf("RGMII%d Registers\n", hdr->index);
	printf("-----------------\n");
	printf("FER = %08x SSR = %08x\n\n", p->fer, p->ssr);

	return p + 1;
	}

	static void print_tah_regs(void buf)
	{
	struct emac_ethtool_regs_subhdr *hdr = buf;
	struct tah_regs p = (struct tah_regs )(hdr + 1);

	printf("TAH%d Registers\n", hdr->index);
	printf("-----------------\n");

	printf("REVID = %08x MR = %08x TSR = %08x\n"
	"SSR0 = %08x SSR1 = %08x SSR2 = %08x\n"
	"SSR3 = %08x SSR4 = %08x SSR5 = %08x\n\n",
	p->revid, p->mr, p->tsr,
	p->ssr0, p->ssr1, p->ssr2, p->ssr3, p->ssr4, p->ssr5);

	return p + 1;
	}

	int ibm_emac_dump_regs(struct ethtool_drvinfo info, struct ethtool_regs regs)
	{
	struct emac_ethtool_regs_hdr *hdr =
	(struct emac_ethtool_regs_hdr *)regs->data;
	void *buf = hdr + 1;

	buf = print_mal_regs(buf);
	buf = print_emac_regs(buf);
	if (hdr->components & EMAC_ETHTOOL_REGS_ZMII)
	buf = print_zmii_regs(buf);
	if (hdr->components & EMAC_ETHTOOL_REGS_RGMII)
	buf = print_rgmii_regs(buf);
	if (hdr->components & EMAC_ETHTOOL_REGS_TAH)
	print_tah_regs(buf);

	return 0;
	}