From e0bac2387b373316337b177fe8aa9851b0d5e870 Mon Sep 17 00:00:00 2001
From: Alexey Gavrilov <rebovas@yahoo.com>
Date: Tue, 26 Mar 2024 13:51:05 +0700
Subject: Implement MADT table

---
 drivers/acpi/Acpi.cpp | 81 +++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 81 insertions(+)
 create mode 100644 drivers/acpi/Acpi.cpp

(limited to 'drivers/acpi/Acpi.cpp')

diff --git a/drivers/acpi/Acpi.cpp b/drivers/acpi/Acpi.cpp
new file mode 100644
index 0000000..207c9bb
--- /dev/null
+++ b/drivers/acpi/Acpi.cpp
@@ -0,0 +1,81 @@
+#include "Acpi.h"
+
+
+const char *Rsdp::signatureString = "RSD PTR ";
+const uint8 Rsdp::validFieldRevision = 2;
+const memAddr Rsdp::romAreaStart = 0xe0000;
+const memAddr Rsdp::romAreaEnd = 0xfffff;
+const memAddr Rsdp::ebdaAreaStart = 0x80000;
+const memAddr Rsdp::ebdaAreaEnd = 0x803ff;
+const uint8 Rsdp::checksunFieldSize = 20;
+const uint8 Entry::size = 4;
+const uint8 sizeWithoutIcs = 44;
+
+Rsdt *Rsdp::getRsdt() const
+{
+    Rsdt *rsdtPtr = (Rsdt *)(rsdtAddress);
+    if(rsdtPtr == nullptr or checksumCheck()) return nullptr;
+    else return rsdtPtr;
+};
+
+Xsdt *Rsdp::getXsdt() const
+{
+    Xsdt *xsdtPtr = (Xsdt *)(xsdtAddress);
+    if(xsdtPtr == nullptr or checksumCheck()) return nullptr;
+    else return xsdtPtr;
+};
+
+
+const uint32 DescHeader::getLength() const
+{
+    return length;
+};
+
+const Entry *Rsdt::getEntry(uint8 index) const
+{
+    uint32 entriesAmount = (header.getLength() - sizeof(DescHeader)) / Entry::size;
+
+    if(index >= entriesAmount 
+        or header.checksumCheck()) return nullptr;
+    else return ((const Entry **)&entries)[index];
+};
+
+uint8 Rsdp::checksumCheck() const
+{
+    uint8 check = 0;
+    for(uint32 offset = 0; offset < checksunFieldSize; offset++)
+    {
+        check += *(uint8 *)((memAddr)this + offset);
+    }
+    return check;
+};
+
+uint8 DescHeader::checksumCheck() const
+{
+    uint8 check = 0;
+    for(uint32 offset = 0; offset < length; offset++)
+    {
+        check += *(uint8 *)((memAddr)this + offset);
+    }
+    return check;
+};
+
+const Ics *Madt::getIcs(uint8 index) const
+{
+    uint32 icsBytesRemain = header.getLength() - ::sizeWithoutIcs;
+    uint16 indexAmass = 0;
+    const Ics *icsPtr = (Ics *)(&icsBegin);
+
+    while(icsBytesRemain > 0)
+    {
+        if(indexAmass == index) return icsPtr;
+        else
+        {
+            icsBytesRemain -= icsPtr->getLength();
+            indexAmass++;
+            icsPtr = (Ics *)((memAddr)icsPtr + icsPtr->getLength());
+        }
+    }
+
+    return nullptr;
+};
-- 
cgit v1.2.3