uboot-phytec

// SPDX-License-Identifier: GPL-2.0+

/*

 * (C) Copyright 2009

 * Marvell Semiconductor <www.marvell.com>

 * Written-by: Prafulla Wadaskar <prafulla@marvell.com>

 *

 * (C) Copyright 2003

 * Ingo Assmus <ingo.assmus@keymile.com>

 *

 * based on - Driver for MV64360X ethernet ports

 * Copyright (C) 2002 rabeeh@galileo.co.il

 */

​

#include <common.h>

#include <net.h>

#include <malloc.h>

#include <miiphy.h>

#include <asm/io.h>

#include <linux/errno.h>

#include <asm/types.h>

#include <asm/system.h>

#include <asm/byteorder.h>

#include <asm/arch/cpu.h>

​

#if defined(CONFIG_KIRKWOOD)

#include <asm/arch/soc.h>

#elif defined(CONFIG_ORION5X)

#include <asm/arch/orion5x.h>

#endif

​

#include "mvgbe.h"

​

DECLARE_GLOBAL_DATA_PTR;

​

#ifndef CONFIG_MVGBE_PORTS

# define CONFIG_MVGBE_PORTS {0, 0}

#endif

​

#define MV_PHY_ADR_REQUEST 0xee

#define MVGBE_SMI_REG (((struct mvgbe_registers *)MVGBE0_BASE)->smi)

​

#if defined(CONFIG_PHYLIB) || defined(CONFIG_MII) || defined(CONFIG_CMD_MII)

/*

 * smi_reg_read - miiphy_read callback function.

 *

 * Returns 16bit phy register value, or 0xffff on error

 */

static int smi_reg_read(struct mii_dev *bus, int phy_adr, int devad,

            int reg_ofs)

{

    u16 data = 0;

    struct eth_device *dev = eth_get_dev_by_name(bus->name);

    struct mvgbe_device *dmvgbe = to_mvgbe(dev);

    struct mvgbe_registers *regs = dmvgbe->regs;

    u32 smi_reg;

    u32 timeout;

​

    /* Phyadr read request */

    if (phy_adr == MV_PHY_ADR_REQUEST &&

            reg_ofs == MV_PHY_ADR_REQUEST) {

        /* */

        data = (u16) (MVGBE_REG_RD(regs->phyadr) & PHYADR_MASK);

        return data;

    }

    /* check parameters */

    if (phy_adr > PHYADR_MASK) {

        printf("Err..(%s) Invalid PHY address %d\n",

            __func__, phy_adr);

        return -EFAULT;

    }

    if (reg_ofs > PHYREG_MASK) {

        printf("Err..(%s) Invalid register offset %d\n",

            __func__, reg_ofs);

        return -EFAULT;

    }

​

    timeout = MVGBE_PHY_SMI_TIMEOUT;

    /* wait till the SMI is not busy */

    do {

        /* read smi register */

        smi_reg = MVGBE_REG_RD(MVGBE_SMI_REG);

        if (timeout-- == 0) {

            printf("Err..(%s) SMI busy timeout\n", __func__);

            return -EFAULT;

        }

    } while (smi_reg & MVGBE_PHY_SMI_BUSY_MASK);

​

    /* fill the phy address and regiser offset and read opcode */

    smi_reg = (phy_adr << MVGBE_PHY_SMI_DEV_ADDR_OFFS)

        | (reg_ofs << MVGBE_SMI_REG_ADDR_OFFS)

        | MVGBE_PHY_SMI_OPCODE_READ;

​