IntelFrameworkModulePkg: Modify CpuIoDxe to support new IoLib library
[mirror_edk2.git] / IntelFrameworkModulePkg / Universal / CpuIoDxe / CpuIo.c
CommitLineData
806bf4f2 1/** @file\r
2 Uses the services of the I/O Library to produce the CPU I/O Protocol\r
3\r
3d78c020 4Copyright (c) 2004 - 2012, Intel Corporation. All rights reserved.<BR>\r
afb84b5f
LD
5Copyright (c) 2017, AMD Incorporated. All rights reserved.<BR>\r
6\r
180a5a35 7This program and the accompanying materials \r
806bf4f2 8are licensed and made available under the terms and conditions of the BSD License \r
9which accompanies this distribution. The full text of the license may be found at \r
10http://opensource.org/licenses/bsd-license.php \r
11 \r
12THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, \r
13WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. \r
14\r
15**/\r
16\r
55a503bc 17#include "CpuIo.h"\r
806bf4f2 18\r
19//\r
20// Handle for the CPU I/O Protocol\r
21//\r
22EFI_HANDLE mHandle = NULL;\r
23\r
24//\r
25// CPU I/O Protocol inatance\r
26//\r
27EFI_CPU_IO_PROTOCOL mCpuIo = {\r
28 {\r
29 CpuMemoryServiceRead,\r
30 CpuMemoryServiceWrite\r
31 },\r
32 {\r
33 CpuIoServiceRead,\r
34 CpuIoServiceWrite\r
35 }\r
36};\r
37\r
38//\r
39// Lookup table for increment values based on transfer widths\r
40//\r
41UINT8 mInStride[] = {\r
42 1, // EfiCpuIoWidthUint8\r
43 2, // EfiCpuIoWidthUint16\r
44 4, // EfiCpuIoWidthUint32\r
45 8, // EfiCpuIoWidthUint64\r
46 0, // EfiCpuIoWidthFifoUint8\r
47 0, // EfiCpuIoWidthFifoUint16\r
48 0, // EfiCpuIoWidthFifoUint32\r
49 0, // EfiCpuIoWidthFifoUint64\r
50 1, // EfiCpuIoWidthFillUint8\r
51 2, // EfiCpuIoWidthFillUint16\r
52 4, // EfiCpuIoWidthFillUint32\r
53 8 // EfiCpuIoWidthFillUint64\r
54};\r
55\r
56//\r
57// Lookup table for increment values based on transfer widths\r
58//\r
59UINT8 mOutStride[] = {\r
60 1, // EfiCpuIoWidthUint8\r
61 2, // EfiCpuIoWidthUint16\r
62 4, // EfiCpuIoWidthUint32\r
63 8, // EfiCpuIoWidthUint64\r
64 1, // EfiCpuIoWidthFifoUint8\r
65 2, // EfiCpuIoWidthFifoUint16\r
66 4, // EfiCpuIoWidthFifoUint32\r
67 8, // EfiCpuIoWidthFifoUint64\r
68 0, // EfiCpuIoWidthFillUint8\r
69 0, // EfiCpuIoWidthFillUint16\r
70 0, // EfiCpuIoWidthFillUint32\r
71 0 // EfiCpuIoWidthFillUint64\r
72};\r
73\r
74/**\r
75 Check parameters to a CPU I/O Protocol service request.\r
76\r
7a7f916a 77 The I/O operations are carried out exactly as requested. The caller is responsible \r
78 for satisfying any alignment and I/O width restrictions that a PI System on a \r
79 platform might require. For example on some platforms, width requests of \r
80 EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will \r
81 be handled by the driver.\r
82 \r
83 @param[in] MmioOperation TRUE for an MMIO operation, FALSE for I/O Port operation.\r
84 @param[in] Width Signifies the width of the I/O or Memory operation.\r
85 @param[in] Address The base address of the I/O operation. \r
86 @param[in] Count The number of I/O operations to perform. The number of \r
87 bytes moved is Width size * Count, starting at Address.\r
88 @param[in] Buffer For read operations, the destination buffer to store the results.\r
89 For write operations, the source buffer from which to write data.\r
90\r
91 @retval EFI_SUCCESS The parameters for this request pass the checks.\r
92 @retval EFI_INVALID_PARAMETER Width is invalid for this PI system.\r
93 @retval EFI_INVALID_PARAMETER Buffer is NULL.\r
94 @retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.\r
95 @retval EFI_UNSUPPORTED The address range specified by Address, Width, \r
96 and Count is not valid for this PI system.\r
806bf4f2 97\r
98**/\r
99EFI_STATUS\r
100CpuIoCheckParameter (\r
101 IN BOOLEAN MmioOperation,\r
102 IN EFI_CPU_IO_PROTOCOL_WIDTH Width,\r
103 IN UINT64 Address,\r
104 IN UINTN Count,\r
105 IN VOID *Buffer\r
106 )\r
107{\r
108 UINT64 MaxCount;\r
109 UINT64 Limit;\r
7a7f916a 110\r
806bf4f2 111 //\r
112 // Check to see if Buffer is NULL\r
113 //\r
114 if (Buffer == NULL) {\r
115 return EFI_INVALID_PARAMETER;\r
116 }\r
117\r
118 //\r
119 // Check to see if Width is in the valid range\r
120 //\r
3d78c020 121 if ((UINT32)Width >= EfiCpuIoWidthMaximum) {\r
806bf4f2 122 return EFI_INVALID_PARAMETER;\r
123 }\r
124\r
125 //\r
126 // For FIFO type, the target address won't increase during the access,\r
127 // so treat Count as 1\r
128 //\r
129 if (Width >= EfiCpuIoWidthFifoUint8 && Width <= EfiCpuIoWidthFifoUint64) {\r
130 Count = 1;\r
131 }\r
132\r
133 //\r
134 // Check to see if Width is in the valid range for I/O Port operations\r
135 //\r
6b9ddb42 136 Width = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);\r
806bf4f2 137 if (!MmioOperation && (Width == EfiCpuIoWidthUint64)) {\r
138 return EFI_INVALID_PARAMETER;\r
139 }\r
140 \r
7a7f916a 141 //\r
6b9ddb42 142 // Check to see if Address is aligned\r
7a7f916a 143 //\r
144 if ((Address & (UINT64)(mInStride[Width] - 1)) != 0) {\r
145 return EFI_UNSUPPORTED;\r
146 }\r
147\r
806bf4f2 148 //\r
149 // Check to see if any address associated with this transfer exceeds the maximum \r
150 // allowed address. The maximum address implied by the parameters passed in is\r
151 // Address + Size * Count. If the following condition is met, then the transfer\r
152 // is not supported.\r
153 //\r
154 // Address + Size * Count > (MmioOperation ? MAX_ADDRESS : MAX_IO_PORT_ADDRESS) + 1\r
155 //\r
156 // Since MAX_ADDRESS can be the maximum integer value supported by the CPU and Count \r
157 // can also be the maximum integer value supported by the CPU, this range\r
6b9ddb42 158 // check must be adjusted to avoid all overflow conditions.\r
806bf4f2 159 // \r
6b9ddb42 160 // The following form of the range check is equivalent but assumes that \r
806bf4f2 161 // MAX_ADDRESS and MAX_IO_PORT_ADDRESS are of the form (2^n - 1).\r
162 //\r
163 Limit = (MmioOperation ? MAX_ADDRESS : MAX_IO_PORT_ADDRESS);\r
164 if (Count == 0) {\r
165 if (Address > Limit) {\r
166 return EFI_UNSUPPORTED;\r
167 }\r
168 } else { \r
169 MaxCount = RShiftU64 (Limit, Width);\r
170 if (MaxCount < (Count - 1)) {\r
171 return EFI_UNSUPPORTED;\r
172 }\r
173 if (Address > LShiftU64 (MaxCount - Count + 1, Width)) {\r
174 return EFI_UNSUPPORTED;\r
175 }\r
176 }\r
7a7f916a 177\r
806bf4f2 178 //\r
6b9ddb42 179 // Check to see if Buffer is aligned\r
20f6ac14 180 // (IA-32 allows UINT64 and INT64 data types to be 32-bit aligned.)\r
806bf4f2 181 //\r
20f6ac14 182 if (((UINTN)Buffer & ((MIN (sizeof (UINTN), mInStride[Width]) - 1))) != 0) {\r
806bf4f2 183 return EFI_UNSUPPORTED;\r
184 }\r
185\r
186 return EFI_SUCCESS;\r
187}\r
188\r
189/**\r
190 Reads memory-mapped registers.\r
191\r
7a7f916a 192 The I/O operations are carried out exactly as requested. The caller is responsible \r
193 for satisfying any alignment and I/O width restrictions that a PI System on a \r
194 platform might require. For example on some platforms, width requests of \r
195 EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will \r
196 be handled by the driver.\r
197 \r
198 If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32, \r
199 or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for \r
200 each of the Count operations that is performed.\r
201 \r
202 If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16, \r
203 EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is \r
204 incremented for each of the Count operations that is performed. The read or \r
205 write operation is performed Count times on the same Address.\r
206 \r
207 If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16, \r
208 EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is \r
209 incremented for each of the Count operations that is performed. The read or \r
210 write operation is performed Count times from the first element of Buffer.\r
211 \r
212 @param[in] This A pointer to the EFI_CPU_IO_PROTOCOL instance.\r
213 @param[in] Width Signifies the width of the I/O or Memory operation.\r
214 @param[in] Address The base address of the I/O operation. \r
215 @param[in] Count The number of I/O operations to perform. The number of \r
216 bytes moved is Width size * Count, starting at Address.\r
217 @param[out] Buffer For read operations, the destination buffer to store the results.\r
218 For write operations, the source buffer from which to write data.\r
219\r
220 @retval EFI_SUCCESS The data was read from or written to the PI system.\r
221 @retval EFI_INVALID_PARAMETER Width is invalid for this PI system.\r
222 @retval EFI_INVALID_PARAMETER Buffer is NULL.\r
223 @retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.\r
224 @retval EFI_UNSUPPORTED The address range specified by Address, Width, \r
225 and Count is not valid for this PI system.\r
806bf4f2 226\r
227**/\r
228EFI_STATUS\r
229EFIAPI\r
230CpuMemoryServiceRead (\r
231 IN EFI_CPU_IO_PROTOCOL *This,\r
232 IN EFI_CPU_IO_PROTOCOL_WIDTH Width,\r
233 IN UINT64 Address,\r
234 IN UINTN Count,\r
235 OUT VOID *Buffer\r
236 )\r
237{\r
238 EFI_STATUS Status;\r
239 UINT8 InStride;\r
240 UINT8 OutStride;\r
241 EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;\r
242 UINT8 *Uint8Buffer;\r
243\r
244 Status = CpuIoCheckParameter (TRUE, Width, Address, Count, Buffer);\r
245 if (EFI_ERROR (Status)) {\r
246 return Status;\r
247 }\r
248\r
249 //\r
250 // Select loop based on the width of the transfer\r
251 //\r
252 InStride = mInStride[Width];\r
253 OutStride = mOutStride[Width];\r
6b9ddb42 254 OperationWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);\r
806bf4f2 255 for (Uint8Buffer = Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {\r
256 if (OperationWidth == EfiCpuIoWidthUint8) {\r
257 *Uint8Buffer = MmioRead8 ((UINTN)Address);\r
258 } else if (OperationWidth == EfiCpuIoWidthUint16) {\r
259 *((UINT16 *)Uint8Buffer) = MmioRead16 ((UINTN)Address);\r
260 } else if (OperationWidth == EfiCpuIoWidthUint32) {\r
261 *((UINT32 *)Uint8Buffer) = MmioRead32 ((UINTN)Address);\r
262 } else if (OperationWidth == EfiCpuIoWidthUint64) {\r
263 *((UINT64 *)Uint8Buffer) = MmioRead64 ((UINTN)Address);\r
264 }\r
265 }\r
266 return EFI_SUCCESS;\r
267}\r
268\r
269/**\r
270 Writes memory-mapped registers.\r
271\r
7a7f916a 272 The I/O operations are carried out exactly as requested. The caller is responsible \r
273 for satisfying any alignment and I/O width restrictions that a PI System on a \r
274 platform might require. For example on some platforms, width requests of \r
275 EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will \r
276 be handled by the driver.\r
277 \r
278 If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32, \r
279 or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for \r
280 each of the Count operations that is performed.\r
281 \r
282 If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16, \r
283 EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is \r
284 incremented for each of the Count operations that is performed. The read or \r
285 write operation is performed Count times on the same Address.\r
286 \r
287 If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16, \r
288 EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is \r
289 incremented for each of the Count operations that is performed. The read or \r
290 write operation is performed Count times from the first element of Buffer.\r
291 \r
292 @param[in] This A pointer to the EFI_CPU_IO_PROTOCOL instance.\r
293 @param[in] Width Signifies the width of the I/O or Memory operation.\r
294 @param[in] Address The base address of the I/O operation. \r
295 @param[in] Count The number of I/O operations to perform. The number of \r
296 bytes moved is Width size * Count, starting at Address.\r
297 @param[in] Buffer For read operations, the destination buffer to store the results.\r
298 For write operations, the source buffer from which to write data.\r
299\r
300 @retval EFI_SUCCESS The data was read from or written to the PI system.\r
301 @retval EFI_INVALID_PARAMETER Width is invalid for this PI system.\r
302 @retval EFI_INVALID_PARAMETER Buffer is NULL.\r
303 @retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.\r
304 @retval EFI_UNSUPPORTED The address range specified by Address, Width, \r
305 and Count is not valid for this PI system.\r
806bf4f2 306\r
307**/\r
308EFI_STATUS\r
309EFIAPI\r
310CpuMemoryServiceWrite (\r
311 IN EFI_CPU_IO_PROTOCOL *This,\r
312 IN EFI_CPU_IO_PROTOCOL_WIDTH Width,\r
313 IN UINT64 Address,\r
314 IN UINTN Count,\r
315 IN VOID *Buffer\r
316 )\r
317{\r
318 EFI_STATUS Status;\r
319 UINT8 InStride;\r
320 UINT8 OutStride;\r
321 EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;\r
322 UINT8 *Uint8Buffer;\r
323\r
324 Status = CpuIoCheckParameter (TRUE, Width, Address, Count, Buffer);\r
325 if (EFI_ERROR (Status)) {\r
326 return Status;\r
327 }\r
328\r
329 //\r
330 // Select loop based on the width of the transfer\r
331 //\r
332 InStride = mInStride[Width];\r
333 OutStride = mOutStride[Width];\r
6b9ddb42 334 OperationWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);\r
806bf4f2 335 for (Uint8Buffer = Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {\r
336 if (OperationWidth == EfiCpuIoWidthUint8) {\r
337 MmioWrite8 ((UINTN)Address, *Uint8Buffer);\r
338 } else if (OperationWidth == EfiCpuIoWidthUint16) {\r
339 MmioWrite16 ((UINTN)Address, *((UINT16 *)Uint8Buffer));\r
340 } else if (OperationWidth == EfiCpuIoWidthUint32) {\r
341 MmioWrite32 ((UINTN)Address, *((UINT32 *)Uint8Buffer));\r
342 } else if (OperationWidth == EfiCpuIoWidthUint64) {\r
343 MmioWrite64 ((UINTN)Address, *((UINT64 *)Uint8Buffer));\r
344 }\r
345 }\r
346 return EFI_SUCCESS;\r
347}\r
348\r
349/**\r
350 Reads I/O registers.\r
351\r
7a7f916a 352 The I/O operations are carried out exactly as requested. The caller is responsible \r
353 for satisfying any alignment and I/O width restrictions that a PI System on a \r
354 platform might require. For example on some platforms, width requests of \r
355 EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will \r
356 be handled by the driver.\r
357 \r
358 If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32, \r
359 or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for \r
360 each of the Count operations that is performed.\r
361 \r
362 If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16, \r
363 EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is \r
364 incremented for each of the Count operations that is performed. The read or \r
365 write operation is performed Count times on the same Address.\r
366 \r
367 If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16, \r
368 EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is \r
369 incremented for each of the Count operations that is performed. The read or \r
370 write operation is performed Count times from the first element of Buffer.\r
371 \r
372 @param[in] This A pointer to the EFI_CPU_IO_PROTOCOL instance.\r
373 @param[in] Width Signifies the width of the I/O or Memory operation.\r
374 @param[in] Address The base address of the I/O operation. \r
375 @param[in] Count The number of I/O operations to perform. The number of \r
376 bytes moved is Width size * Count, starting at Address.\r
377 @param[out] Buffer For read operations, the destination buffer to store the results.\r
378 For write operations, the source buffer from which to write data.\r
379\r
380 @retval EFI_SUCCESS The data was read from or written to the PI system.\r
381 @retval EFI_INVALID_PARAMETER Width is invalid for this PI system.\r
382 @retval EFI_INVALID_PARAMETER Buffer is NULL.\r
383 @retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.\r
384 @retval EFI_UNSUPPORTED The address range specified by Address, Width, \r
385 and Count is not valid for this PI system.\r
806bf4f2 386\r
387**/\r
388EFI_STATUS\r
389EFIAPI\r
390CpuIoServiceRead (\r
391 IN EFI_CPU_IO_PROTOCOL *This,\r
392 IN EFI_CPU_IO_PROTOCOL_WIDTH Width,\r
393 IN UINT64 Address,\r
394 IN UINTN Count,\r
395 OUT VOID *Buffer\r
396 )\r
397{\r
398 EFI_STATUS Status;\r
399 UINT8 InStride;\r
400 UINT8 OutStride;\r
401 EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;\r
402 UINT8 *Uint8Buffer;\r
403\r
404 Status = CpuIoCheckParameter (FALSE, Width, Address, Count, Buffer);\r
405 if (EFI_ERROR (Status)) {\r
406 return Status;\r
407 }\r
408\r
409 //\r
410 // Select loop based on the width of the transfer\r
411 //\r
412 InStride = mInStride[Width];\r
413 OutStride = mOutStride[Width];\r
6b9ddb42 414 OperationWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);\r
afb84b5f
LD
415\r
416 //\r
417 // Fifo operations supported for (mInStride[Width] == 0)\r
418 //\r
419 if (InStride == 0) {\r
420 switch (OperationWidth) {\r
421 case EfiCpuIoWidthUint8:\r
422 IoReadFifo8 ((UINTN)Address, Count, Buffer);\r
423 return EFI_SUCCESS;\r
424 case EfiCpuIoWidthUint16:\r
425 IoReadFifo16 ((UINTN)Address, Count, Buffer);\r
426 return EFI_SUCCESS;\r
427 case EfiCpuIoWidthUint32:\r
428 IoReadFifo32 ((UINTN)Address, Count, Buffer);\r
429 return EFI_SUCCESS;\r
430 default:\r
431 //\r
432 // The CpuIoCheckParameter call above will ensure that this\r
433 // path is not taken.\r
434 //\r
435 ASSERT (FALSE);\r
436 break;\r
437 }\r
438 }\r
439\r
806bf4f2 440 for (Uint8Buffer = Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {\r
441 if (OperationWidth == EfiCpuIoWidthUint8) {\r
442 *Uint8Buffer = IoRead8 ((UINTN)Address);\r
443 } else if (OperationWidth == EfiCpuIoWidthUint16) {\r
444 *((UINT16 *)Uint8Buffer) = IoRead16 ((UINTN)Address);\r
445 } else if (OperationWidth == EfiCpuIoWidthUint32) {\r
446 *((UINT32 *)Uint8Buffer) = IoRead32 ((UINTN)Address);\r
447 }\r
448 }\r
449\r
450 return EFI_SUCCESS;\r
451}\r
452\r
453/**\r
454 Write I/O registers.\r
455\r
7a7f916a 456 The I/O operations are carried out exactly as requested. The caller is responsible \r
457 for satisfying any alignment and I/O width restrictions that a PI System on a \r
458 platform might require. For example on some platforms, width requests of \r
459 EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will \r
460 be handled by the driver.\r
461 \r
462 If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32, \r
463 or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for \r
464 each of the Count operations that is performed.\r
465 \r
466 If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16, \r
467 EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is \r
468 incremented for each of the Count operations that is performed. The read or \r
469 write operation is performed Count times on the same Address.\r
470 \r
471 If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16, \r
472 EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is \r
473 incremented for each of the Count operations that is performed. The read or \r
474 write operation is performed Count times from the first element of Buffer.\r
475 \r
476 @param[in] This A pointer to the EFI_CPU_IO_PROTOCOL instance.\r
477 @param[in] Width Signifies the width of the I/O or Memory operation.\r
478 @param[in] Address The base address of the I/O operation. \r
479 @param[in] Count The number of I/O operations to perform. The number of \r
480 bytes moved is Width size * Count, starting at Address.\r
481 @param[in] Buffer For read operations, the destination buffer to store the results.\r
482 For write operations, the source buffer from which to write data.\r
483\r
484 @retval EFI_SUCCESS The data was read from or written to the PI system.\r
485 @retval EFI_INVALID_PARAMETER Width is invalid for this PI system.\r
486 @retval EFI_INVALID_PARAMETER Buffer is NULL.\r
487 @retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.\r
488 @retval EFI_UNSUPPORTED The address range specified by Address, Width, \r
489 and Count is not valid for this PI system.\r
490 \r
806bf4f2 491**/\r
492EFI_STATUS\r
493EFIAPI\r
494CpuIoServiceWrite (\r
495 IN EFI_CPU_IO_PROTOCOL *This,\r
496 IN EFI_CPU_IO_PROTOCOL_WIDTH Width,\r
497 IN UINT64 Address,\r
498 IN UINTN Count,\r
499 IN VOID *Buffer\r
500 )\r
501{\r
502 EFI_STATUS Status;\r
503 UINT8 InStride;\r
504 UINT8 OutStride;\r
505 EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;\r
506 UINT8 *Uint8Buffer;\r
507\r
508 //\r
509 // Make sure the parameters are valid\r
510 //\r
511 Status = CpuIoCheckParameter (FALSE, Width, Address, Count, Buffer);\r
512 if (EFI_ERROR (Status)) {\r
513 return Status;\r
514 }\r
515\r
516 //\r
517 // Select loop based on the width of the transfer\r
518 //\r
519 InStride = mInStride[Width];\r
520 OutStride = mOutStride[Width];\r
6b9ddb42 521 OperationWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);\r
afb84b5f
LD
522\r
523 //\r
524 // Fifo operations supported for (mInStride[Width] == 0)\r
525 //\r
526 if (InStride == 0) {\r
527 switch (OperationWidth) {\r
528 case EfiCpuIoWidthUint8:\r
529 IoWriteFifo8 ((UINTN)Address, Count, Buffer);\r
530 return EFI_SUCCESS;\r
531 case EfiCpuIoWidthUint16:\r
532 IoWriteFifo16 ((UINTN)Address, Count, Buffer);\r
533 return EFI_SUCCESS;\r
534 case EfiCpuIoWidthUint32:\r
535 IoWriteFifo32 ((UINTN)Address, Count, Buffer);\r
536 return EFI_SUCCESS;\r
537 default:\r
538 //\r
539 // The CpuIoCheckParameter call above will ensure that this\r
540 // path is not taken.\r
541 //\r
542 ASSERT (FALSE);\r
543 break;\r
544 }\r
545 }\r
546\r
806bf4f2 547 for (Uint8Buffer = (UINT8 *)Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {\r
548 if (OperationWidth == EfiCpuIoWidthUint8) {\r
549 IoWrite8 ((UINTN)Address, *Uint8Buffer);\r
550 } else if (OperationWidth == EfiCpuIoWidthUint16) {\r
551 IoWrite16 ((UINTN)Address, *((UINT16 *)Uint8Buffer));\r
552 } else if (OperationWidth == EfiCpuIoWidthUint32) {\r
553 IoWrite32 ((UINTN)Address, *((UINT32 *)Uint8Buffer));\r
554 }\r
555 }\r
556 \r
557 return EFI_SUCCESS;\r
558}\r
559\r
560/**\r
561 The user Entry Point for module CpuIo. The user code starts with this function.\r
562\r
563 @param[in] ImageHandle The firmware allocated handle for the EFI image. \r
564 @param[in] SystemTable A pointer to the EFI System Table.\r
565 \r
566 @retval EFI_SUCCESS The entry point is executed successfully.\r
567 @retval other Some error occurs when executing this entry point.\r
568\r
569**/\r
570EFI_STATUS\r
571EFIAPI\r
572CpuIoInitialize (\r
573 IN EFI_HANDLE ImageHandle,\r
574 IN EFI_SYSTEM_TABLE *SystemTable\r
575 )\r
576{\r
577 EFI_STATUS Status;\r
578\r
579 ASSERT_PROTOCOL_ALREADY_INSTALLED (NULL, &gEfiCpuIoProtocolGuid);\r
580 Status = gBS->InstallMultipleProtocolInterfaces (\r
581 &mHandle,\r
582 &gEfiCpuIoProtocolGuid, &mCpuIo,\r
583 NULL\r
584 );\r
585 ASSERT_EFI_ERROR (Status);\r
586\r
587 return Status;\r
588}\r