drivers/net/phy/fixed.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Fixed-Link phy
   4  *
   5  * Copyright 2017 Bernecker & Rainer Industrieelektronik GmbH
   6  */
   7
   8 #include <config.h>
   9 #include <common.h>
  10 #include <malloc.h>
  11 #include <phy.h>
  12 #include <dm.h>
  13 #include <fdt_support.h>
  14 #include <asm/global_data.h>
  15
  16 DECLARE_GLOBAL_DATA_PTR;
  17
  18 static int fixedphy_probe(struct phy_device *phydev)
  19 {
  20         /* fixed-link phy must not be reset by core phy code */
  21         phydev->flags |= PHY_FLAG_BROKEN_RESET;
  22
  23         return 0;
  24 }
  25
  26 static int fixedphy_config(struct phy_device *phydev)
  27 {
  28         ofnode node = phy_get_ofnode(phydev);
  29         struct fixed_link *priv;
  30         bool old_binding = false;
  31         u32 old_val[5];
  32         u32 val;
  33
  34         if (!ofnode_valid(node))
  35                 return -EINVAL;
  36
  37         /* check for mandatory properties within fixed-link node */
  38         val = ofnode_read_u32_default(node, "speed", 0);
  39
  40         if (!val) {
  41                 /* try old binding */
  42                 old_binding = true;
  43                 if (ofnode_read_u32_array(node, "fixed-link", old_val,
  44                                           ARRAY_SIZE(old_val))) {
  45                         printf("ERROR: no/invalid <fixed-link> property!\n");
  46                         return -ENOENT;
  47                 }
  48                 val = old_val[2];
  49         }
  50
  51         if (val != SPEED_10 && val != SPEED_100 && val != SPEED_1000 &&
  52             val != SPEED_2500 && val != SPEED_10000) {
  53                 printf("ERROR: no/invalid speed given in fixed-link node!\n");
  54                 return -EINVAL;
  55         }
  56
  57         priv = malloc(sizeof(*priv));
  58         if (!priv)
  59                 return -ENOMEM;
  60         memset(priv, 0, sizeof(*priv));
  61
  62         phydev->priv = priv;
  63
  64         priv->link_speed = val;
  65         if (!old_binding) {
  66                 priv->duplex = ofnode_read_bool(node, "full-duplex");
  67                 priv->pause = ofnode_read_bool(node, "pause");
  68                 priv->asym_pause = ofnode_read_bool(node, "asym-pause");
  69         } else {
  70                 priv->duplex = old_val[1];
  71                 priv->pause = old_val[3];
  72                 priv->asym_pause = old_val[4];
  73         }
  74
  75         return 0;
  76 }
  77
  78 static int fixedphy_startup(struct phy_device *phydev)
  79 {
  80         struct fixed_link *priv = phydev->priv;
  81
  82         phydev->asym_pause = priv->asym_pause;
  83         phydev->pause = priv->pause;
  84         phydev->duplex = priv->duplex;
  85         phydev->speed = priv->link_speed;
  86         phydev->link = 1;
  87
  88         return 0;
  89 }
  90
  91 static int fixedphy_shutdown(struct phy_device *phydev)
  92 {
  93         return 0;
  94 }
  95
  96 static struct phy_driver fixedphy_driver = {
  97         .uid            = PHY_FIXED_ID,
  98         .mask           = 0xffffffff,
  99         .name           = "Fixed PHY",
 100         .features       = PHY_GBIT_FEATURES | SUPPORTED_MII,
 101         .probe          = fixedphy_probe,
 102         .config         = fixedphy_config,
 103         .startup        = fixedphy_startup,
 104         .shutdown       = fixedphy_shutdown,
 105 };
 106
 107 int phy_fixed_init(void)
 108 {
 109         phy_register(&fixedphy_driver);
 110         return 0;
 111 }