MdePkg/IoLib: Filter/trace port IO/MMIO access

[mirror_edk2.git] / MdePkg / Library / BaseIoLibIntrinsic / IoLibGcc.c

diff --git a/MdePkg/Library/BaseIoLibIntrinsic/IoLibGcc.c b/MdePkg/Library/BaseIoLibIntrinsic/IoLibGcc.c
index b3a1a2025663ba970a9362a2da3624ed330cb487..ecf9ed61911f978c9695a8a2e646f87ad7fc9ad3 100644 (file)
--- a/MdePkg/Library/BaseIoLibIntrinsic/IoLibGcc.c
+++ b/MdePkg/Library/BaseIoLibIntrinsic/IoLibGcc.c
@@ -10,7 +10,7 @@
   We don't advocate putting compiler specifics in libraries or drivers but there\r
   is no other way to make this work.\r
 \r
-  Copyright (c) 2006 - 2018, Intel Corporation. All rights reserved.<BR>\r
+  Copyright (c) 2006 - 2021, Intel Corporation. All rights reserved.<BR>\r
   SPDX-License-Identifier: BSD-2-Clause-Patent\r
 \r
 **/\r
@@ -39,8 +39,14 @@ IoRead8 (
   )\r
 {\r
   UINT8   Data;\r
+  BOOLEAN Flag;\r
+\r
+  Flag = FilterBeforeIoRead (FilterWidth8, Port, &Data);\r
+  if (Flag) {\r
+    __asm__ __volatile__ ("inb %w1,%b0" : "=a" (Data) : "d" ((UINT16)Port));\r
+  }\r
+  FilterAfterIoRead (FilterWidth8, Port, &Data);\r
 \r
-  __asm__ __volatile__ ("inb %w1,%b0" : "=a" (Data) : "d" ((UINT16)Port));\r
   return Data;\r
 }\r
 \r
@@ -66,7 +72,14 @@ IoWrite8 (
   IN      UINT8                     Value\r
   )\r
 {\r
-  __asm__ __volatile__ ("outb %b0,%w1" : : "a" (Value), "d" ((UINT16)Port));\r
+  BOOLEAN Flag;\r
+\r
+  Flag = FilterBeforeIoWrite (FilterWidth8, Port, &Value);\r
+  if (Flag) {\r
+    __asm__ __volatile__ ("outb %b0,%w1" : : "a" (Value), "d" ((UINT16)Port));\r
+  }\r
+  FilterAfterIoWrite (FilterWidth8, Port, &Value);\r
+\r
   return Value;;\r
 }\r
 \r
@@ -92,9 +105,16 @@ IoRead16 (
   )\r
 {\r
   UINT16   Data;\r
+  BOOLEAN  Flag;\r
 \r
   ASSERT ((Port & 1) == 0);\r
-  __asm__ __volatile__ ("inw %w1,%w0" : "=a" (Data) : "d" ((UINT16)Port));\r
+\r
+  Flag = FilterBeforeIoRead (FilterWidth16, Port, &Data);\r
+  if (Flag) {\r
+     __asm__ __volatile__ ("inw %w1,%w0" : "=a" (Data) : "d" ((UINT16)Port));\r
+  }\r
+  FilterAfterIoRead (FilterWidth16, Port, &Data);\r
+\r
   return Data;\r
 }\r
 \r
@@ -121,8 +141,17 @@ IoWrite16 (
   IN      UINT16                    Value\r
   )\r
 {\r
+\r
+  BOOLEAN Flag;\r
+\r
   ASSERT ((Port & 1) == 0);\r
-  __asm__ __volatile__ ("outw %w0,%w1" : : "a" (Value), "d" ((UINT16)Port));\r
+\r
+  Flag = FilterBeforeIoWrite (FilterWidth16, Port, &Value);\r
+  if (Flag) {\r
+    __asm__ __volatile__ ("outw %w0,%w1" : : "a" (Value), "d" ((UINT16)Port));\r
+  }\r
+  FilterAfterIoWrite (FilterWidth16, Port, &Value);\r
+\r
   return Value;;\r
 }\r
 \r
@@ -148,9 +177,16 @@ IoRead32 (
   )\r
 {\r
   UINT32   Data;\r
+  BOOLEAN  Flag;\r
 \r
   ASSERT ((Port & 3) == 0);\r
-  __asm__ __volatile__ ("inl %w1,%0" : "=a" (Data) : "d" ((UINT16)Port));\r
+\r
+  Flag = FilterBeforeIoRead (FilterWidth32, Port, &Data);\r
+  if (Flag) {\r
+    __asm__ __volatile__ ("inl %w1,%0" : "=a" (Data) : "d" ((UINT16)Port));\r
+  }\r
+  FilterAfterIoRead (FilterWidth32, Port, &Data);\r
+\r
   return Data;\r
 }\r
 \r
@@ -177,8 +213,16 @@ IoWrite32 (
   IN      UINT32                    Value\r
   )\r
 {\r
+  BOOLEAN  Flag;\r
+\r
   ASSERT ((Port & 3) == 0);\r
-  __asm__ __volatile__ ("outl %0,%w1" : : "a" (Value), "d" ((UINT16)Port));\r
+\r
+  Flag = FilterBeforeIoWrite (FilterWidth32, Port, &Value);\r
+  if (Flag) {\r
+    __asm__ __volatile__ ("outl %0,%w1" : : "a" (Value), "d" ((UINT16)Port));\r
+  }\r
+  FilterAfterIoWrite (FilterWidth32, Port, &Value);\r
+\r
   return Value;\r
 }\r
 \r