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