[people/ms/u-boot.git] / drivers / net / pic32_mdio.c

/*
 * pic32_mdio.c: PIC32 MDIO/MII driver, part of pic32_eth.c.
 *
 * Copyright 2015 Microchip Inc.
 *	Purna Chandra Mandal <purna.mandal@microchip.com>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */
#include <common.h>
#include <phy.h>
#include <miiphy.h>
#include <errno.h>
#include <wait_bit.h>
#include <asm/io.h>
#include "pic32_eth.h"

static int pic32_mdio_write(struct mii_dev *bus,
			    int addr, int dev_addr,
			    int reg, u16 value)
{
	u32 v;
	struct pic32_mii_regs *mii_regs = bus->priv;

	/* Wait for the previous operation to finish */
	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
			  false, CONFIG_SYS_HZ, true);

	/* Put phyaddr and regaddr into MIIMADD */
	v = (addr << MIIMADD_PHYADDR_SHIFT) | (reg & MIIMADD_REGADDR);
	writel(v, &mii_regs->madr.raw);

	/* Initiate a write command */
	writel(value, &mii_regs->mwtd.raw);

	/* Wait 30 clock cycles for busy flag to be set */
	udelay(12);

	/* Wait for write to complete */
	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
			  false, CONFIG_SYS_HZ, true);

	return 0;
}

static int pic32_mdio_read(struct mii_dev *bus, int addr, int devaddr, int reg)
{
	u32 v;
	struct pic32_mii_regs *mii_regs = bus->priv;

	/* Wait for the previous operation to finish */
	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
			  false, CONFIG_SYS_HZ, true);

	/* Put phyaddr and regaddr into MIIMADD */
	v = (addr << MIIMADD_PHYADDR_SHIFT) | (reg & MIIMADD_REGADDR);
	writel(v, &mii_regs->madr.raw);

	/* Initiate a read command */
	writel(MIIMCMD_READ, &mii_regs->mcmd.raw);

	/* Wait 30 clock cycles for busy flag to be set */
	udelay(12);

	/* Wait for read to complete */
	wait_for_bit_le32(&mii_regs->mind.raw,
			  MIIMIND_NOTVALID | MIIMIND_BUSY,
			  false, CONFIG_SYS_HZ, false);

	/* Clear the command register */
	writel(0, &mii_regs->mcmd.raw);

	/* Grab the value read from the PHY */
	v = readl(&mii_regs->mrdd.raw);
	return v;
}

static int pic32_mdio_reset(struct mii_dev *bus)
{
	struct pic32_mii_regs *mii_regs = bus->priv;

	/* Reset MII (due to new addresses) */
	writel(MIIMCFG_RSTMGMT, &mii_regs->mcfg.raw);

	/* Wait for the operation to finish */
	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
		     false, CONFIG_SYS_HZ, true);

	/* Clear reset bit */
	writel(0, &mii_regs->mcfg);

	/* Wait for the operation to finish */
	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
			  false, CONFIG_SYS_HZ, true);

	/* Set the MII Management Clock (MDC) - no faster than 2.5 MHz */
	writel(MIIMCFG_CLKSEL_DIV40, &mii_regs->mcfg.raw);

	/* Wait for the operation to finish */
	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
			  false, CONFIG_SYS_HZ, true);
	return 0;
}

int pic32_mdio_init(const char *name, ulong ioaddr)
{
	struct mii_dev *bus;

	bus = mdio_alloc();
	if (!bus) {
		printf("Failed to allocate PIC32-MDIO bus\n");
		return -ENOMEM;
	}

	bus->read = pic32_mdio_read;
	bus->write = pic32_mdio_write;
	bus->reset = pic32_mdio_reset;
	strncpy(bus->name, name, sizeof(bus->name));
	bus->priv = (void *)ioaddr;

	return mdio_register(bus);
}
Commit	Line	Data
23e7578c PCM	1	/*
	2	* pic32_mdio.c: PIC32 MDIO/MII driver, part of pic32_eth.c.
	3	*
	4	* Copyright 2015 Microchip Inc.
	5	* Purna Chandra Mandal <purna.mandal@microchip.com>
	6	*
	7	* SPDX-License-Identifier: GPL-2.0+
	8	*/
	9	#include <common.h>
	10	#include <phy.h>
	11	#include <miiphy.h>
	12	#include <errno.h>
	13	#include <wait_bit.h>
	14	#include <asm/io.h>
	15	#include "pic32_eth.h"
	16
	17	static int pic32_mdio_write(struct mii_dev *bus,
	18	int addr, int dev_addr,
	19	int reg, u16 value)
	20	{
	21	u32 v;
	22	struct pic32_mii_regs *mii_regs = bus->priv;
	23
	24	/* Wait for the previous operation to finish */
48263504 ÁFR	25	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
48263504 ÁFR	26	false, CONFIG_SYS_HZ, true);
23e7578c PCM	27
	28	/* Put phyaddr and regaddr into MIIMADD */
	29	v = (addr << MIIMADD_PHYADDR_SHIFT) \| (reg & MIIMADD_REGADDR);
	30	writel(v, &mii_regs->madr.raw);
	31
	32	/* Initiate a write command */
	33	writel(value, &mii_regs->mwtd.raw);
	34
	35	/* Wait 30 clock cycles for busy flag to be set */
	36	udelay(12);
	37
	38	/* Wait for write to complete */
48263504 ÁFR	39	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
48263504 ÁFR	40	false, CONFIG_SYS_HZ, true);
23e7578c PCM	41
	42	return 0;
	43	}
	44
	45	static int pic32_mdio_read(struct mii_dev *bus, int addr, int devaddr, int reg)
	46	{
	47	u32 v;
	48	struct pic32_mii_regs *mii_regs = bus->priv;
	49
	50	/* Wait for the previous operation to finish */
48263504 ÁFR	51	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
48263504 ÁFR	52	false, CONFIG_SYS_HZ, true);
23e7578c PCM	53
	54	/* Put phyaddr and regaddr into MIIMADD */
	55	v = (addr << MIIMADD_PHYADDR_SHIFT) \| (reg & MIIMADD_REGADDR);
	56	writel(v, &mii_regs->madr.raw);
	57
	58	/* Initiate a read command */
	59	writel(MIIMCMD_READ, &mii_regs->mcmd.raw);
	60
	61	/* Wait 30 clock cycles for busy flag to be set */
	62	udelay(12);
	63
	64	/* Wait for read to complete */
48263504 ÁFR	65	wait_for_bit_le32(&mii_regs->mind.raw,
	66	MIIMIND_NOTVALID \| MIIMIND_BUSY,
	67	false, CONFIG_SYS_HZ, false);
23e7578c PCM	68
	69	/* Clear the command register */
	70	writel(0, &mii_regs->mcmd.raw);
	71
	72	/* Grab the value read from the PHY */
	73	v = readl(&mii_regs->mrdd.raw);
	74	return v;
	75	}
	76
	77	static int pic32_mdio_reset(struct mii_dev *bus)
	78	{
	79	struct pic32_mii_regs *mii_regs = bus->priv;
	80
	81	/* Reset MII (due to new addresses) */
	82	writel(MIIMCFG_RSTMGMT, &mii_regs->mcfg.raw);
	83
	84	/* Wait for the operation to finish */
48263504	85	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
23e7578c PCM	86	false, CONFIG_SYS_HZ, true);
	87
	88	/* Clear reset bit */
	89	writel(0, &mii_regs->mcfg);
	90
	91	/* Wait for the operation to finish */
48263504 ÁFR	92	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
48263504 ÁFR	93	false, CONFIG_SYS_HZ, true);
23e7578c PCM	94
	95	/* Set the MII Management Clock (MDC) - no faster than 2.5 MHz */
	96	writel(MIIMCFG_CLKSEL_DIV40, &mii_regs->mcfg.raw);
	97
	98	/* Wait for the operation to finish */
48263504 ÁFR	99	wait_for_bit_le32(&mii_regs->mind.raw, MIIMIND_BUSY,
48263504 ÁFR	100	false, CONFIG_SYS_HZ, true);
23e7578c PCM	101	return 0;
	102	}
	103
	104	int pic32_mdio_init(const char *name, ulong ioaddr)
	105	{
	106	struct mii_dev *bus;
	107
	108	bus = mdio_alloc();
	109	if (!bus) {
	110	printf("Failed to allocate PIC32-MDIO bus\n");
	111	return -ENOMEM;
	112	}
	113
	114	bus->read = pic32_mdio_read;
	115	bus->write = pic32_mdio_write;
	116	bus->reset = pic32_mdio_reset;
	117	strncpy(bus->name, name, sizeof(bus->name));
	118	bus->priv = (void *)ioaddr;
	119
	120	return mdio_register(bus);
	121	}