mirror of
https://github.com/danbulant/Cosmos
synced 2026-05-21 05:18:38 +00:00
Merge pull request #671 from valentinbreiz/ACPI
ACPI Implementation (Restart, Shutdown)
This commit is contained in:
jp2masa
GitHub
commit
7f3f647197
4 changed files with 369 additions and 4 deletions
317
source/Cosmos.Core/ACPI.cs
Normal file
317
source/Cosmos.Core/ACPI.cs
Normal file
|
|
@ -0,0 +1,317 @@
|
|||
using Cosmos.Core.Common;
|
||||
using Cosmos.Debug.Kernel;
|
||||
using System;
|
||||
using System.Runtime.InteropServices;
|
||||
|
||||
namespace Cosmos.Core
|
||||
{
|
||||
public unsafe class ACPI
|
||||
{
|
||||
|
||||
public static readonly Debugger mDebugger = new Debugger("System", "Global");
|
||||
|
||||
//RSD Table
|
||||
[StructLayout(LayoutKind.Sequential, Pack = 1)]
|
||||
public unsafe struct RSDPtr
|
||||
{
|
||||
public fixed byte Signature[8];
|
||||
public byte CheckSum;
|
||||
public fixed byte OemID[6];
|
||||
public byte Revision;
|
||||
public int RsdtAddress;
|
||||
};
|
||||
|
||||
// New Port I/O
|
||||
private static IOPort smiIO, pm1aIO, pm1bIO;
|
||||
|
||||
// ACPI variables
|
||||
private static int* SMI_CMD;
|
||||
private static byte ACPI_ENABLE;
|
||||
private static byte ACPI_DISABLE;
|
||||
private static int* PM1a_CNT;
|
||||
private static int* PM1b_CNT;
|
||||
private static short SLP_TYPa;
|
||||
private static short SLP_TYPb;
|
||||
private static short SLP_EN;
|
||||
private static short SCI_EN;
|
||||
private static byte PM1_CNT_LEN;
|
||||
|
||||
//ACPI Check Header
|
||||
static int acpiCheckHeader(byte* ptr, string sig)
|
||||
{
|
||||
return Compare(sig, ptr);
|
||||
}
|
||||
|
||||
// FACP
|
||||
private static byte* Facp = null;
|
||||
[StructLayout(LayoutKind.Sequential, Pack = 1)]
|
||||
struct FACP
|
||||
{
|
||||
public fixed byte Signature[4];
|
||||
public int Length;
|
||||
|
||||
public fixed byte unneded1[40 - 8];
|
||||
public int* DSDT;
|
||||
public fixed byte unneded2[48 - 44];
|
||||
public int* SMI_CMD;
|
||||
public byte ACPI_ENABLE;
|
||||
public byte ACPI_DISABLE;
|
||||
public fixed byte unneded3[64 - 54];
|
||||
public int* PM1a_CNT_BLK;
|
||||
public int* PM1b_CNT_BLK;
|
||||
public fixed byte unneded4[89 - 72];
|
||||
public byte PM1_CNT_LEN;
|
||||
};
|
||||
|
||||
//Compare
|
||||
static int Compare(string c1, byte* c2)
|
||||
{
|
||||
for (int i = 0; i < c1.Length; i++)
|
||||
{
|
||||
if (c1[i] != c2[i]) { return -1; }
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
//Check RSD
|
||||
static bool Check_RSD(uint address)
|
||||
{
|
||||
byte sum = 0;
|
||||
byte* check = (byte*)address;
|
||||
|
||||
for (int i = 0; i < 20; i++)
|
||||
sum += *(check++);
|
||||
|
||||
return (sum == 0);
|
||||
}
|
||||
|
||||
//Acpi Initialization :P
|
||||
public static void Start(bool initialize = true, bool enable = true)
|
||||
{
|
||||
if (initialize)
|
||||
Init();
|
||||
|
||||
if (enable)
|
||||
Enable();
|
||||
}
|
||||
|
||||
// Shutdown
|
||||
public static void Shutdown()
|
||||
{
|
||||
Console.Clear();
|
||||
if (PM1a_CNT == null)
|
||||
Init();
|
||||
|
||||
pm1aIO.Word = (ushort)(SLP_TYPa | SLP_EN);
|
||||
|
||||
if (PM1b_CNT != null)
|
||||
pm1bIO.Word = (ushort)(SLP_TYPb | SLP_EN);
|
||||
|
||||
Global.CPU.Halt();
|
||||
}
|
||||
|
||||
// Reboot
|
||||
public static void Reboot()
|
||||
{
|
||||
Console.Clear();
|
||||
IOPort port = new IOPort(0x64);
|
||||
byte good = 0x02;
|
||||
|
||||
while ((good & 0x02) != 0)
|
||||
good = port.Byte;
|
||||
|
||||
port.Byte = 0xFE;
|
||||
|
||||
// Halt CPU
|
||||
Global.CPU.Halt();
|
||||
}
|
||||
|
||||
// Initializazion
|
||||
private static bool Init()
|
||||
{
|
||||
byte* ptr = (byte*)RSDPAddress();
|
||||
int addr = 0;
|
||||
|
||||
for (int i = 19; i >= 16; i--)
|
||||
{
|
||||
addr += (*(ptr + i));
|
||||
addr = (i == 16) ? addr : addr << 8;
|
||||
}
|
||||
|
||||
ptr = (byte*)addr;
|
||||
ptr += 4; addr = 0;
|
||||
|
||||
for (int i = 3; i >= 0; i--)
|
||||
{
|
||||
addr += (*(ptr + i));
|
||||
addr = (i == 0) ? addr : addr << 8;
|
||||
}
|
||||
|
||||
int length = addr;
|
||||
ptr -= 4;
|
||||
|
||||
if (ptr != null && acpiCheckHeader(ptr, "RSDT") == 0)
|
||||
{
|
||||
addr = 0;
|
||||
int entrys = length;
|
||||
entrys = (entrys - 36) / 4;
|
||||
ptr += 36;
|
||||
byte* yeuse;
|
||||
|
||||
while (0 < entrys--)
|
||||
{
|
||||
for (int i = 3; i >= 0; i--)
|
||||
{
|
||||
addr += (*(ptr + i));
|
||||
addr = (i == 0) ? addr : addr << 8;
|
||||
}
|
||||
|
||||
yeuse = (byte*)addr;
|
||||
Facp = yeuse;
|
||||
|
||||
if (acpiCheckHeader((byte*)facpget(0), "DSDT") == 0)
|
||||
{
|
||||
byte* S5Addr = (byte*)facpget(0) + 36;
|
||||
int dsdtLength = *(facpget(0) + 1) - 36;
|
||||
|
||||
while (0 < dsdtLength--)
|
||||
{
|
||||
if (Compare("_S5_", S5Addr) == 0)
|
||||
break;
|
||||
S5Addr++;
|
||||
}
|
||||
|
||||
if (dsdtLength > 0)
|
||||
{
|
||||
if ((*(S5Addr - 1) == 0x08 || (*(S5Addr - 2) == 0x08 && *(S5Addr - 1) == '\\')) && *(S5Addr + 4) == 0x12)
|
||||
{
|
||||
S5Addr += 5;
|
||||
S5Addr += ((*S5Addr & 0xC0) >> 6) + 2;
|
||||
if (*S5Addr == 0x0A)
|
||||
S5Addr++;
|
||||
SLP_TYPa = (short)(*(S5Addr) << 10);
|
||||
S5Addr++;
|
||||
if (*S5Addr == 0x0A)
|
||||
S5Addr++;
|
||||
SLP_TYPb = (short)(*(S5Addr) << 10);
|
||||
SMI_CMD = facpget(1);
|
||||
ACPI_ENABLE = facpbget(0);
|
||||
ACPI_DISABLE = facpbget(1);
|
||||
PM1a_CNT = facpget(2);
|
||||
PM1b_CNT = facpget(3);
|
||||
PM1_CNT_LEN = facpbget(3);
|
||||
SLP_EN = 1 << 13;
|
||||
SCI_EN = 1;
|
||||
|
||||
smiIO = new IOPort((ushort)SMI_CMD);
|
||||
pm1aIO = new IOPort((ushort)PM1a_CNT);
|
||||
pm1bIO = new IOPort((ushort)PM1b_CNT);
|
||||
|
||||
return true;
|
||||
}
|
||||
}
|
||||
}
|
||||
ptr += 4;
|
||||
}
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
// Enable ACPI
|
||||
public static void Enable()
|
||||
{
|
||||
Init();
|
||||
smiIO = new IOPort(ACPI_ENABLE);
|
||||
}
|
||||
|
||||
// Disable ACPI
|
||||
public static void Disable()
|
||||
{
|
||||
smiIO = new IOPort(ACPI_DISABLE);
|
||||
}
|
||||
|
||||
// Retrieve the RSDP address
|
||||
private static unsafe uint RSDPAddress()
|
||||
{
|
||||
for (uint addr = 0xE0000; addr < 0x100000; addr += 4)
|
||||
if (Compare("RSD PTR ", (byte*)addr) == 0)
|
||||
if (Check_RSD(addr))
|
||||
return addr;
|
||||
|
||||
uint ebda_address = *((uint*)0x040E);
|
||||
ebda_address = (ebda_address * 0x10) & 0x000fffff;
|
||||
|
||||
for (uint addr = ebda_address; addr < ebda_address + 1024; addr += 4)
|
||||
if (Compare("RSD PTR ", (byte*)addr) == 0)
|
||||
return addr;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
// RSDT Table
|
||||
private static uint* acpiCheckRSDPtr(uint* ptr)
|
||||
{
|
||||
string sig = "RSD PTR ";
|
||||
RSDPtr* rsdp = (RSDPtr*)ptr;
|
||||
|
||||
byte* bptr;
|
||||
byte check = 0;
|
||||
int i;
|
||||
|
||||
if (Compare(sig, (byte*)rsdp) == 0)
|
||||
{
|
||||
bptr = (byte*)ptr;
|
||||
|
||||
for (i = 0; i < 20; i++)
|
||||
{
|
||||
check += *bptr;
|
||||
bptr++;
|
||||
}
|
||||
|
||||
if (check == 0)
|
||||
{
|
||||
Compare("RSDT", (byte*)rsdp->RsdtAddress);
|
||||
|
||||
if (rsdp->RsdtAddress != 0)
|
||||
return (uint*)rsdp->RsdtAddress;
|
||||
}
|
||||
}
|
||||
|
||||
return null;
|
||||
}
|
||||
|
||||
// FACP Table
|
||||
private static byte facpbget(int number)
|
||||
{
|
||||
switch (number)
|
||||
{
|
||||
case 0:
|
||||
return *(Facp + 52);
|
||||
case 1:
|
||||
return *(Facp + 53);
|
||||
case 2:
|
||||
return *(Facp + 89);
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
private static int* facpget(int number)
|
||||
{
|
||||
switch (number)
|
||||
{
|
||||
case 0:
|
||||
return (int*)*((int*)(Facp + 40));
|
||||
case 1:
|
||||
return (int*)*((int*)(Facp + 48));
|
||||
case 2:
|
||||
return (int*)*((int*)(Facp + 64));
|
||||
case 3:
|
||||
return (int*)*((int*)(Facp + 68));
|
||||
default:
|
||||
return null;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
@ -105,6 +105,8 @@ namespace Cosmos.HAL
|
|||
InitStaticDevices();
|
||||
mDebugger.Send("PCI Devices");
|
||||
InitPciDevices();
|
||||
mDebugger.Send("ACPI Init");
|
||||
StartACPI();
|
||||
mDebugger.Send("Done initializing Cosmos.HAL.Global");
|
||||
|
||||
mDebugger.Send("ATA Primary Master");
|
||||
|
|
@ -130,11 +132,16 @@ namespace Cosmos.HAL
|
|||
// system level and not accessible from Core. Need to think about this
|
||||
// for the future.
|
||||
Console.WriteLine("Finding PCI Devices");
|
||||
Console.WriteLine();
|
||||
|
||||
PCI.Setup();
|
||||
}
|
||||
|
||||
public static void StartACPI()
|
||||
{
|
||||
Console.WriteLine("Starting ACPI");
|
||||
Core.ACPI.Start();
|
||||
}
|
||||
|
||||
public static void EnableInterrupts()
|
||||
{
|
||||
CPU.EnableInterrupts();
|
||||
|
|
|
|||
|
|
@ -9,9 +9,34 @@ namespace Cosmos.HAL
|
|||
{
|
||||
public class Power
|
||||
{
|
||||
public static void Reboot()
|
||||
//Reboot with CPU
|
||||
public static void CPUReboot()
|
||||
{
|
||||
Core.Global.CPU.Reboot();
|
||||
}
|
||||
|
||||
//Reboot with ACPI
|
||||
public static void Reboot()
|
||||
{
|
||||
ACPI.Reboot();
|
||||
}
|
||||
|
||||
//Shutdown with ACPI
|
||||
public static void Shutdown()
|
||||
{
|
||||
ACPI.Shutdown();
|
||||
}
|
||||
|
||||
//Enable ACPI
|
||||
public static void ACPIEnable()
|
||||
{
|
||||
ACPI.Enable();
|
||||
}
|
||||
|
||||
//Disable ACPI
|
||||
public static void ACPIDisable()
|
||||
{
|
||||
ACPI.Disable();
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
@ -8,9 +8,25 @@ namespace Cosmos.System
|
|||
{
|
||||
public class Power
|
||||
{
|
||||
public static void CPUReboot()
|
||||
{
|
||||
HAL.Power.CPUReboot();
|
||||
}
|
||||
public static void Reboot()
|
||||
{
|
||||
HAL.Power.Reboot();
|
||||
}
|
||||
public static void Shutdown()
|
||||
{
|
||||
HAL.Power.Shutdown();
|
||||
}
|
||||
public static void ACPIEnable()
|
||||
{
|
||||
HAL.Power.ACPIEnable();
|
||||
}
|
||||
public static void ACPIDisable()
|
||||
{
|
||||
HAL.Power.ACPIDisable();
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
Loading…
Reference in a new issue