/*
 * Copyright (c) Company 2018-2019. All rights reserved.
 * Description: GMAC mdio driver
 */
#include "mdio.h"
#include "util.h"
#include "gmac.h"

static int wait_mdio_ready(const struct gmac_netdev_local *ld)
{
	int timeout_us = 1000;

	while (--timeout_us && !test_mdio_ready(ld))
		udelay(1);

	return timeout_us;
}

int gmac_mdio_read(struct mii_bus *bus, int phy, int reg)
{
	struct gmac_netdev_local *ld = NULL;
	int timeout = 1000;
	int val;

	if (bus == NULL)
		return -ETIMEDOUT;

	ld = bus->priv;
	if (ld == NULL)
		return -ETIMEDOUT;

	if (!wait_mdio_ready(ld))
		return -ETIMEDOUT;

	mdio_start_phyread(ld, (unsigned int)phy, (unsigned int)reg);

	while (!wait_mdio_ready(ld) && timeout-- > 0)
		udelay(1);

	if (timeout <= 0 || !test_mdio_read_data_done(ld))
		return -ETIMEDOUT;

	val = mdio_get_phyread_val(ld);

	gmac_trace(2, "mdio read phy:%x, reg:%x = %x\n", phy, reg, val); /* trace level 2 */

	return val;
}

int gmac_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val)
{
	struct gmac_netdev_local *ld = NULL;

	if (bus == NULL)
		return -ETIMEDOUT;

	ld = bus->priv;
	if (ld == NULL)
		return -ETIMEDOUT;

	if (!wait_mdio_ready(ld))
		return -ETIMEDOUT;

	gmac_trace(2, "mdio write phy:%x, reg:%x = %x\n", phy, reg, val); /* trace level 2 */

	mdio_set_phywrite_val(ld, val);
	mdio_phywrite(ld, (u32)phy, (u32)reg);

	return 0;
}