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
fixedphy_probe(struct phy_device * phydev)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
fixedphy_config(struct phy_device * phydev)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
fixedphy_startup(struct phy_device * phydev)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
fixedphy_shutdown(struct phy_device * phydev)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
phy_fixed_init(void)107 int phy_fixed_init(void)
108 {
109 phy_register(&fixedphy_driver);
110 return 0;
111 }
112