brintos

brintos / linux-shallow public Read only

0
0
Text · 2.4 KiB · 3883434 Raw
99 lines · c
1// SPDX-License-Identifier: GPL-2.0+2/*3 * Driver for the Renesas PHY uPD60620.4 *5 * Copyright (C) 2015 Softing Industrial Automation GmbH6 */7 8#include <linux/kernel.h>9#include <linux/module.h>10#include <linux/phy.h>11 12#define UPD60620_PHY_ID    0xb824282413 14/* Extended Registers and values */15/* PHY Special Control/Status    */16#define PHY_PHYSCR         0x1F      /* PHY.31 */17#define PHY_PHYSCR_10MB    0x0004    /* PHY speed = 10mb */18#define PHY_PHYSCR_100MB   0x0008    /* PHY speed = 100mb */19#define PHY_PHYSCR_DUPLEX  0x0010    /* PHY Duplex */20 21/* PHY Special Modes */22#define PHY_SPM            0x12      /* PHY.18 */23 24/* Init PHY */25 26static int upd60620_config_init(struct phy_device *phydev)27{28	/* Enable support for passive HUBs (could be a strap option) */29	/* PHYMODE: All speeds, HD in parallel detect */30	return phy_write(phydev, PHY_SPM, 0x0180 | phydev->mdio.addr);31}32 33/* Get PHY status from common registers */34 35static int upd60620_read_status(struct phy_device *phydev)36{37	int phy_state;38 39	/* Read negotiated state */40	phy_state = phy_read(phydev, MII_BMSR);41	if (phy_state < 0)42		return phy_state;43 44	phydev->link = 0;45	linkmode_zero(phydev->lp_advertising);46	phydev->pause = 0;47	phydev->asym_pause = 0;48 49	if (phy_state & (BMSR_ANEGCOMPLETE | BMSR_LSTATUS)) {50		phy_state = phy_read(phydev, PHY_PHYSCR);51		if (phy_state < 0)52			return phy_state;53 54		if (phy_state & (PHY_PHYSCR_10MB | PHY_PHYSCR_100MB)) {55			phydev->link = 1;56			phydev->speed = SPEED_10;57			phydev->duplex = DUPLEX_HALF;58 59			if (phy_state & PHY_PHYSCR_100MB)60				phydev->speed = SPEED_100;61			if (phy_state & PHY_PHYSCR_DUPLEX)62				phydev->duplex = DUPLEX_FULL;63 64			phy_state = phy_read(phydev, MII_LPA);65			if (phy_state < 0)66				return phy_state;67 68			mii_lpa_to_linkmode_lpa_t(phydev->lp_advertising,69						  phy_state);70 71			phy_resolve_aneg_pause(phydev);72		}73	}74	return 0;75}76 77MODULE_DESCRIPTION("Renesas uPD60620 PHY driver");78MODULE_AUTHOR("Bernd Edlinger <bernd.edlinger@hotmail.de>");79MODULE_LICENSE("GPL");80 81static struct phy_driver upd60620_driver[1] = { {82	.phy_id         = UPD60620_PHY_ID,83	.phy_id_mask    = 0xfffffffe,84	.name           = "Renesas uPD60620",85	/* PHY_BASIC_FEATURES */86	.flags          = 0,87	.config_init    = upd60620_config_init,88	.read_status    = upd60620_read_status,89} };90 91module_phy_driver(upd60620_driver);92 93static struct mdio_device_id __maybe_unused upd60620_tbl[] = {94	{ UPD60620_PHY_ID, 0xfffffffe },95	{ }96};97 98MODULE_DEVICE_TABLE(mdio, upd60620_tbl);99