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
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
|
/** SerDes.c
Provides SoC specific SerDes interface
Copyright 2020 NXP
SPDX-License-Identifier: BSD-2-Clause-Patent
**/
#include <Library/DebugLib.h>
#include <Library/SerDesHelperLib.h>
/**
Function to get SerDes Lane protocol corresponding to
SerDes protocol.
@param SerDes SerDes number.
@param SerDesProtocol SerDes protocol number.
@param Lane SerDes Lane number.
@param SerDesMaxProtocol Max SerDes protocol number.
@param Config SerDes Configuration.
@return SerDes Lane protocol.
**/
UINT32
GetSerDesProtocol (
IN INTN SerDes,
IN INTN SerDesProtocol,
IN INTN Lane,
IN UINT32 SerDesMaxProtocol,
IN SERDES_CONFIG *Config
)
{
while (Config->Protocol) {
if (Config->Protocol == SerDesProtocol) {
return Config->SerDesLane[Lane];
}
Config++;
}
return SerDesMaxProtocol;
}
/**
Function to validate input SerDes protocol.
@param SerDes SerDes number.
@param SerDesProtocol SerDes protocol number.
@param SerDesNumLanes Number of SerDes Lanes.
@param Config SerDes Configuration.
@return EFI_NOT_FOUND SerDes Protocol not a valid protocol.
@return EFI_SUCCESS SerDes Protocol is a valid protocol.
**/
EFI_STATUS
IsSerDesProtocolValid (
IN INTN SerDes,
IN UINT32 SerDesProtocol,
IN UINT8 SerDesNumLanes,
IN SERDES_CONFIG *Config
)
{
UINT8 Count;
while (Config->Protocol) {
if (Config->Protocol == SerDesProtocol) {
DEBUG ((DEBUG_INFO, "Protocol: 0x%x Matched with the one in Table\n", SerDesProtocol));
break;
}
Config++;
}
if (!Config->Protocol) {
return EFI_NOT_FOUND;
}
for (Count = 0; Count < SerDesNumLanes; Count++) {
if (Config->SerDesLane[Count] != 0) {
return EFI_SUCCESS;
}
}
return EFI_NOT_FOUND;
}
/**
Get Lane protocol on provided SerDes Lane and execute callback function.
@param SerDes SerDes number.
@param SerDesProtocol SerDes protocol number.
@param SerDesNumLanes Number of SerDes Lanes.
@param SerDesMaxProtocol Max SerDes protocol number.
@param Config SerDes Configuration.
@param SerDesLaneProbeCallback Pointer Callback function to be called for Lane protocol
@param Arg Pointer to Arguments to be passed to callback function.
**/
VOID
SerDesInstanceProbeLanes (
IN UINT32 SerDes,
IN UINT32 SerDesProtocol,
IN UINT8 SerDesNumLanes,
IN UINT32 SerDesMaxProtocol,
IN SERDES_CONFIG *Config,
IN SERDES_PROBE_LANES_CALLBACK SerDesLaneProbeCallback,
IN VOID *Arg
)
{
INT8 Lane;
UINT32 LaneProtocol;
// Invoke callback for all lanes in the SerDes instance:
for (Lane = 0; Lane < SerDesNumLanes; Lane++) {
LaneProtocol = GetSerDesProtocol (SerDes, SerDesProtocol, Lane, SerDesMaxProtocol, Config);
ASSERT (LaneProtocol < SerDesMaxProtocol);
if (LaneProtocol != 0x0) {
SerDesLaneProbeCallback (LaneProtocol, Arg);
}
}
}
/**
Function to fill SerDes map information.
@param SerDes SerDes number.
@param SerDesProtocol SerDes protocol number.
@param SerDesNumLanes Number of SerDes Lanes.
@param SerDesMaxProtocol Max SerDes protocol number.
@param Config SerDes Configuration.
@param SerDesProtocolMap Output SerDes protocol map of enabled devices.
**/
EFI_STATUS
GetSerDesMap (
IN UINT32 SerDes,
IN UINT32 SerDesProtocol,
IN UINT8 SerDesNumLanes,
IN UINT32 SerDesMaxProtocol,
IN SERDES_CONFIG *Config,
OUT UINT64 *SerDesProtocolMap
)
{
INTN Lane;
EFI_STATUS Status;
UINT32 LaneProtocol;
Status = IsSerDesProtocolValid (SerDes, SerDesProtocol, SerDesNumLanes, Config);
if (EFI_ERROR (Status)) {
DEBUG ((DEBUG_ERROR, "%a: SERDES%d[PRTCL] = 0x%x is not valid, Status = %r \n",
__func__, SerDes + 1, SerDesProtocol, Status));
return Status;
}
for (Lane = 0; Lane < SerDesNumLanes; Lane++) {
LaneProtocol = GetSerDesProtocol (SerDes, SerDesProtocol, Lane, SerDesMaxProtocol, Config);
if (LaneProtocol >= SerDesMaxProtocol) {
DEBUG ((DEBUG_ERROR, "Unknown SerDes lane protocol %d\n", LaneProtocol));
return EFI_NO_MAPPING;
}
*SerDesProtocolMap |= (BIT0 << (LaneProtocol));
}
return EFI_SUCCESS;
}
|
