public void InterpretResources(ACPIObject resources, List <File.Property> props)
{
/* The value of _CRS should be a Buffer, i.e. an array of type byte[] */
if (resources.Type != ACPIObject.DataType.Buffer)
{
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: WARNING: " +
"_CRS output is not of type Package, but rather of type " +
resources.Type.ToString());
return;
}
byte[] rs = resources.Data as byte[];
if (rs == null)
{
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: WARNING: " +
"_CRS output data is not of type byte[]");
return;
}
int idx = 0;
while (idx < rs.Length)
{
byte tag = rs[idx];
if ((tag & 0x80) == 0)
{
/* Small resource */
int len = tag & 0x7;
int type = (tag >> 3) & 0xf;
//System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small resource: type: " + type.ToString() + ", len: " + len.ToString());
switch (type)
{
case 0:
case 1:
case 2:
case 3:
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small reserved item");
throw new NotSupportedException();
case 4:
//System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small irq format item");
{
uint irq_mask_1 = rs[idx + 1];
uint irq_mask_2 = rs[idx + 2];
uint flags = 0x1; // active high edge triggered
if (len == 3)
{
flags = rs[idx + 3];
}
bool sharable = ((flags & 0x10) != 0);
bool active_low = ((flags & 0x08) != 0);
bool level_trigger = ((flags & 0x1) == 0);
for (int i = 0; i < 8; i++)
{
if ((irq_mask_1 & 0x1) != 0)
{
ACPIInterrupt irq = AllocateIRQ(i, sharable, active_low, level_trigger);
if (irq != null)
{
props.Add(new File.Property {
Name = "interrupt", Value = irq
});
}
}
irq_mask_1 >>= 1;
}
for (int i = 0; i < 8; i++)
{
if ((irq_mask_2 & 0x1) != 0)
{
ACPIInterrupt irq = AllocateIRQ(i + 8, sharable, active_low, level_trigger);
if (irq != null)
{
props.Add(new File.Property {
Name = "interrupt", Value = irq
});
}
}
irq_mask_2 >>= 1;
}
}
break;
case 5:
//System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small dma format item");
{
uint dma_mask = rs[idx + 1];
for (int i = 0; i < 8; i++)
{
if ((dma_mask & 0x1) != 0)
{
props.Add(new File.Property {
Name = "dma", Value = i
});
}
dma_mask >>= 1;
}
}
break;
case 6:
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small start dependent functions item");
throw new NotImplementedException();
case 7:
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small end dependent functions item");
throw new NotImplementedException();
case 8:
//System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small io port descriptor item");
{
uint io_base = rs[idx + 2];
io_base |= (uint)rs[idx + 3] << 8;
uint io_len = rs[idx + 7];
props.Add(new File.Property {
Name = "io", Value = ios.AllocFixed(io_base, io_len, true)
});
}
break;
case 9:
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small fixed location io port descriptor item");
throw new NotImplementedException();
case 0xa:
case 0xb:
case 0xc:
case 0xd:
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small reserved item");
throw new NotSupportedException();
case 0xe:
System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: small vendor defined descriptor item");
throw new NotImplementedException();
}
if (type == 0xf)
{
break;
}
idx++;
idx += len;
}
else
{
uint type = tag & 0x7fU;
uint len = rs[idx + 1];
len |= (uint)rs[idx + 2] << 8;
//System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: large resource: type: " + type.ToString() + ", len: " + len.ToString());
switch (type)
{
case 0x6:
{
ulong min = BitConverter.ToUInt32(rs, idx + 4);
ulong length = BitConverter.ToUInt32(rs, idx + 8);
props.Add(new File.Property {
Name = "pmem", Value = pmems.AllocFixed(min, length, true)
});
}
break;
case 0x7:
case 0x8:
case 0xa:
{
int res_type = rs[idx + 3];
int gen_flags = rs[idx + 4];
int spec_flags = rs[idx + 5];
ulong gran = 0;
ulong min = 0;
ulong max = 0;
ulong tran = 0;
ulong length = 0;
switch (type)
{
case 0x7:
gran = BitConverter.ToUInt32(rs, idx + 6);
min = BitConverter.ToUInt32(rs, idx + 10);
max = BitConverter.ToUInt32(rs, idx + 14);
tran = BitConverter.ToUInt32(rs, idx + 18);
length = BitConverter.ToUInt32(rs, idx + 22);
break;
case 0x8:
gran = BitConverter.ToUInt16(rs, idx + 6);
min = BitConverter.ToUInt16(rs, idx + 8);
max = BitConverter.ToUInt16(rs, idx + 10);
tran = BitConverter.ToUInt16(rs, idx + 12);
length = BitConverter.ToUInt16(rs, idx + 14);
break;
case 0xa:
gran = BitConverter.ToUInt64(rs, idx + 6);
min = BitConverter.ToUInt64(rs, idx + 14);
max = BitConverter.ToUInt64(rs, idx + 22);
tran = BitConverter.ToUInt64(rs, idx + 30);
length = BitConverter.ToUInt64(rs, idx + 38);
break;
}
/*System.Diagnostics.Debugger.Log(0, "acpipc", "InterpretResources: large resource: res_type: " +
* res_type.ToString("X8") + ", gen_flags: " + gen_flags.ToString("X8") +
* ", spec_flags: " + spec_flags.ToString("X8") +
* ", gran: " + gran.ToString("X16") +
* ", min: " + min.ToString("X16") +
* ", max: " + max.ToString("X16") +
* ", tran: " + tran.ToString("X16") +
* ", length: " + length.ToString("X16"));*/
switch (res_type)
{
case 0:
props.Add(new File.Property {
Name = "pmem", Value = pmems.AllocFixed(min, length, true)
});
break;
case 1:
props.Add(new File.Property {
Name = "io", Value = ios.AllocFixed((uint)min, (uint)length, true)
});
break;
}
}
break;
default:
throw new NotImplementedException("large descriptor type " + type.ToString());
}
idx += 3;
idx += (int)len;
}
}
}
public override bool InitServer()
{
/* Interpret the resources we have */
foreach (tysos.lib.File.Property p in props)
{
if (p.Name.StartsWith("table_"))
{
System.Diagnostics.Debugger.Log(0, null, "adding table\n");
tables.Add(Table.InterpretTable(p.Value as tysos.VirtualMemoryResource64, this));
}
if (p.Name == "interrupts")
{
cpu_interrupts.AddRange(p.Value as IEnumerable <tysos.Resources.InterruptLine>);
}
}
vmems.Init(props);
pmems.Init(props);
ios.Init(props);
System.Diagnostics.Debugger.Log(0, null, "finished parsing resources\n");
/* Execute drivers for any IOAPICs we've found */
List <tysos.ServerObject> ioapics = new List <tysos.ServerObject>();
foreach (var table in tables)
{
if (table is APIC)
{
APIC apic = table as APIC;
foreach (APICStructure apicstruct in apic.APICs)
{
if (apicstruct is IOAPICStructure)
{
IOAPICStructure ias = apicstruct as IOAPICStructure;
List <File.Property> ias_props = new List <File.Property>();
ias_props.Add(new File.Property {
Name = "pmem", Value = pmems.AllocFixed(ias.IOAPICAddress, 0x1000)
});
ias_props.Add(new File.Property {
Name = "vmem", Value = vmems.Alloc(0x1000)
});
ias_props.Add(new File.Property {
Name = "gsibase", Value = ias.GSIBase
});
ias_props.Add(new File.Property {
Name = "ioapicid", Value = ias.IOAPICID
});
ias_props.Add(new File.Property {
Name = "interrupts", Value = cpu_interrupts
});
string a_name = "ioapic_" + ias.IOAPICID.ToString();
children.Add(a_name, ias_props);
System.Diagnostics.Debugger.Log(0, "acpipc", "Starting IOAPIC driver for " + a_name);
ioapic.ioapic ioapic = new ioapic.ioapic(ias_props.ToArray());
tysos.Process p_ioapic = tysos.Process.CreateProcess(a_name,
new System.Threading.ThreadStart(ioapic.MessageLoop),
new object[] { ioapic });
p_ioapic.Start();
gsi_providers.Add(ioapic);
}
else if (apicstruct is InterruptSourceOverrideStructure)
{
isos.Add(apicstruct as InterruptSourceOverrideStructure);
}
else if (apicstruct is LocalAPICStructure)
{
lapics.Add(apicstruct as LocalAPICStructure);
}
}
}
}
/* Generate interrupt resources for the standard ISA IRQs */
for (int i = 0; i < 16; i++)
{
isa_irqs[i] = GenerateISAIRQ(i);
}
/* Dump VBox ACPI interface */
/*var vbox_idx = ios.AllocFixed(0x4048, 4);
* var vbox_dat = ios.AllocFixed(0x404c, 4);
* for(uint i = 0; i < 26; i++)
* {
* vbox_idx.Write(vbox_idx.Addr64, 4, i * 4);
* var val = vbox_dat.Read(vbox_dat.Addr64, 4);
* System.Diagnostics.Debugger.Log(0, "acpipc", "VBoxACPI: " + i.ToString() + ": " + val.ToString("X8"));
* }*/
/* Now allocate space for the DSDT */
if (p_dsdt_addr == 0)
{
throw new Exception("DSDT not found");
}
ulong dsdt_offset = p_dsdt_addr & 0xfffUL;
tysos.PhysicalMemoryResource64 p_dsdt = pmems.AllocFixed(p_dsdt_addr, dsdt_len);
tysos.VirtualMemoryResource64 v_dsdt = vmems.Alloc(dsdt_len + dsdt_offset, 0x1000);
System.Diagnostics.Debugger.Log(0, null, "Mapping first page of DSDT from " + p_dsdt.Addr64.ToString("X16") + " (requested " +
p_dsdt_addr.ToString("X16") + ") to vmem " + v_dsdt.Addr64.ToString("X16") + ", length: " + v_dsdt.Length64.ToString("X"));
p_dsdt.Map(v_dsdt);
if ((p_dsdt_addr & 0xfffUL) != 0UL)
{
v_dsdt = v_dsdt.Split(v_dsdt.Addr64 + (p_dsdt_addr & 0xfffUL), dsdt_len) as tysos.VirtualMemoryResource64;
}
dsdt_len = v_dsdt.Read(v_dsdt.Addr64 + 4, 4);
System.Diagnostics.Debugger.Log(0, "acpipc", "DSDT table length " + dsdt_len.ToString("X16"));
p_dsdt = pmems.AllocFixed(p_dsdt_addr, dsdt_len, true);
v_dsdt = vmems.Alloc(dsdt_len + dsdt_offset, 0x1000);
p_dsdt.Map(v_dsdt);
if ((p_dsdt_addr & 0xfffUL) != 0UL)
{
v_dsdt = v_dsdt.Split(v_dsdt.Addr64 + (p_dsdt_addr & 0xfffUL), dsdt_len) as tysos.VirtualMemoryResource64;
}
System.Diagnostics.Debugger.Log(0, "acpipc", "DSDT region: " + v_dsdt.Addr64.ToString("X16") +
" - " + (v_dsdt.Addr64 + v_dsdt.Length64).ToString("X16"));
/* Execute the DSDT followed by SSDTs */
mi = new MachineInterface(this);
n = new Aml.Namespace(mi);
System.Diagnostics.Debugger.Log(0, "acpipc", "Executing DSDT");
Aml.DefBlockHeader h = new Aml.DefBlockHeader();
int idx = 0;
byte[] aml = v_dsdt.ToArray();
n.ParseDefBlockHeader(aml, ref idx, h);
System.Diagnostics.Debugger.Log(0, "acpipc", "DSDT OEM: " + h.OemID + ", TableID: " + h.OemTableID);
if (h.OemID.Equals("VBOX "))
{
System.Diagnostics.Debugger.Log(0, "acpipc", "VirtualBox BIOS detected");
mi.is_vbox = true;
}
System.Diagnostics.Debugger.Log(0, "acpipc", "DefBlockHeader parsed");
Aml.Namespace.State s = new Aml.Namespace.State
{
Args = new Dictionary <int, Aml.ACPIObject>(new tysos.Program.MyGenericEqualityComparer <int>()),
Locals = new Dictionary <int, Aml.ACPIObject>(new tysos.Program.MyGenericEqualityComparer <int>()),
Scope = Aml.ACPIName.RootName
};
n.ParseTermList(aml, ref idx, -1, s);
System.Diagnostics.Debugger.Log(0, "acpipc", "DSDT parsed");
foreach (tysos.VirtualMemoryResource64 v_ssdt in ssdts)
{
System.Diagnostics.Debugger.Log(0, "acpipc", "Executing SSDT");
idx = 0;
byte[] ssdt_aml = v_ssdt.ToArray();
Aml.DefBlockHeader h_ssdt = new Aml.DefBlockHeader();
n.ParseDefBlockHeader(ssdt_aml, ref idx, h_ssdt);
System.Diagnostics.Debugger.Log(0, "acpipc", "DefBlockHeader parsed");
s = new Aml.Namespace.State
{
Args = new Dictionary <int, Aml.ACPIObject>(new tysos.Program.MyGenericEqualityComparer <int>()),
Locals = new Dictionary <int, Aml.ACPIObject>(new tysos.Program.MyGenericEqualityComparer <int>()),
Scope = Aml.ACPIName.RootName
};
n.ParseTermList(ssdt_aml, ref idx, -1, s);
System.Diagnostics.Debugger.Log(0, "acpipc", "SSDT parsed");
}
/* Initialize the namespace
*
* To do this we:
* 1) initialize the main namespace (\_SB_._INI)
* 2) run each device's _STA method.
* - if _STA & 0x1 = 0,
* - if _STA & 0x8 = 0 remove device and children from namespace
* - else remove device (but still enumerate children)
* - else, run _INI on device
* 3) tell ACPI we are using IOAPIC (\_PIC(1))
*/
EvaluateObject("\\_SB_._INI");
/* We do the initialization this way to ensure we always initialize
* root objects before children. By definition parent objects have
* shorter names than children, therefore we do all devices of length 1,
* then 2 etc until all have been covered.
*
* If we find a non-functional device (bit 3 not set), we at that stage
* find all children of it and mark them as already initialized (so that
* they are not parsed in the loop)
*/
int num_to_parse = n.Devices.Count;
List <string> dev_names = new List <string>(n.Devices.Keys);
int depth = 1;
while (num_to_parse > 0)
{
for (int i = 0; i < dev_names.Count; i++)
{
ACPIName dev_name = dev_names[i];
if (dev_name == null)
{
continue;
}
if (dev_name.ElementCount != depth)
{
continue;
}
ACPIObject dev_obj = n.FindObject(dev_name);
if (dev_obj.Initialized)
{
continue;
}
System.Diagnostics.Debugger.Log(0, "acpipc", "Executing " + dev_name + "._STA");
// Run _STA on the device
int sta_val = 0;
var sta = n.EvaluateTo(dev_name + "._STA", mi, ACPIObject.DataType.Integer);
if (sta == null)
{
sta_val = 0xf;
}
else
{
sta_val = (int)sta.IntegerData;
}
dev_obj.Present = ((sta_val & 0x1) != 0);
dev_obj.Functioning = ((sta_val & 0x8) != 0);
if (dev_obj.Present == false && dev_obj.Functioning == false)
{
// Do not run _INI, do not examine device children
System.Diagnostics.Debugger.Log(0, "acpipc", "Device is not present or functioning. Disabling children");
for (int j = 0; j < dev_names.Count; j++)
{
ACPIName subdev_name = dev_names[j];
if (subdev_name == null)
{
continue;
}
if (subdev_name.ElementCount <= dev_name.ElementCount)
{
continue;
}
bool is_subdev = true;
for (int k = 0; k < dev_name.ElementCount; k++)
{
if (subdev_name.NameElement(k).Equals(dev_name.NameElement(k)) == false)
{
is_subdev = false;
break;
}
}
if (is_subdev)
{
System.Diagnostics.Debugger.Log(0, "acpipc", "Disabling child " + subdev_name);
num_to_parse--;
dev_names[j] = null;
}
}
}
else if (dev_obj.Present)
{
// Run _INI, examine children
System.Diagnostics.Debugger.Log(0, "acpipc", "Executing " + dev_name + "._INI");
n.Evaluate(dev_name + "._INI", mi);
dev_obj.Initialized = true;
}
num_to_parse--;
}
depth++;
}
System.Diagnostics.Debugger.Log(0, "acpipc", "Executing \\_PIC");
EvaluateObject("\\_PIC", new ACPIObject[] { 1 });
/* Generate a list of PCI Interrupt Links - we pass these as resources
* to PCI devices */
foreach (KeyValuePair <string, Aml.ACPIObject> kvp in n.Devices)
{
if (kvp.Value.Initialized == false)
{
continue;
}
var hid = n.EvaluateTo(kvp.Key + "._HID", mi, ACPIObject.DataType.Integer);
if (hid == null)
{
continue;
}
if (hid.IntegerData == 0x0f0cd041U)
{
lnks.Add(kvp.Key);
}
}
/* Now extract a list of devices that have a _HID object.
* These are the only ones ACPI needs to enumerate, all others are
* enumerated by the respective bus enumerator */
foreach (KeyValuePair <string, Aml.ACPIObject> kvp in n.Devices)
{
List <string> hid_strs = new List <string>();
Aml.ACPIObject hid = n.FindObject(kvp.Key + "._HID", false);
if (hid == null)
{
continue;
}
if (kvp.Value.Initialized == false)
{
continue;
}
s = new Aml.Namespace.State
{
Args = new Dictionary <int, Aml.ACPIObject>(new tysos.Program.MyGenericEqualityComparer <int>()),
Locals = new Dictionary <int, Aml.ACPIObject>(new tysos.Program.MyGenericEqualityComparer <int>()),
Scope = hid.Name
};
Aml.ACPIObject hid_ret = hid.Evaluate(mi, s, n);
string hid_str = "";
switch (hid_ret.Type)
{
case Aml.ACPIObject.DataType.Integer:
hid_str = hid_ret.IntegerData.ToString("X8");
break;
case Aml.ACPIObject.DataType.String:
hid_str = (string)hid_ret.Data;
break;
default:
hid_str = hid_ret.Type.ToString() + ": " + hid_ret.Data.ToString();
break;
}
hid_strs.Add(hid_str);
/* Also add all compatible IDs */
Aml.ACPIObject cid = n.Evaluate(kvp.Key + "._CID", mi);
if (cid != null)
{
switch (cid.Type)
{
case ACPIObject.DataType.Integer:
hid_strs.Add(cid.IntegerData.ToString("X8"));
break;
case ACPIObject.DataType.String:
hid_strs.Add(cid.Data as string);
break;
case ACPIObject.DataType.Package:
var pd = cid.Data as Aml.ACPIObject[];
foreach (var icid in pd)
{
switch (icid.Type)
{
case ACPIObject.DataType.Integer:
hid_strs.Add(icid.IntegerData.ToString("X8"));
break;
case ACPIObject.DataType.String:
hid_strs.Add(icid.Data as string);
break;
default:
hid_strs.Add(icid.Type.ToString() + ": " + icid.Data.ToString());
break;
}
}
break;
default:
hid_strs.Add(cid.Type.ToString() + ": " + cid.Data.ToString());
break;
}
}
AddDevice(hid_strs, kvp.Key, kvp.Value, n, mi);
}
foreach (KeyValuePair <string, Aml.ACPIObject> kvp in n.Processors)
{
AddDevice("cpu", kvp.Key, kvp.Value, n, mi);
}
/* Take command of hardware resources */
if (fadt != null)
{
/* Say that we handle fixed power and sleep button events */
fadt.PM1_EN.Write((1UL << 8) | (1UL << 9));
System.Diagnostics.Debugger.Log(0, null, "FADT: " +
"PM1a_EVT_BLK: " + fadt.PM1a_EVT_BLK.ToString() +
", PM1a_CNT_BLK: " + fadt.PM1a_CNT_BLK.ToString() +
", PM1b_EVT_BLK: " + fadt.PM1b_EVT_BLK.ToString() +
", PM1b_CNT_BLK: " + fadt.PM1b_CNT_BLK.ToString() +
", PM2_CNT_BLK: " + fadt.PM2_CNT_BLK.ToString() +
", PM_TMR_BLK: " + fadt.PM_TMR_BLK.ToString() +
", GPE0_BLK: " + fadt.GPE0_BLK.ToString() +
", GPE1_BLK: " + fadt.GPE1_BLK.ToString());
var sci = isa_irqs[fadt.SCI_INT];
if (sci != null)
{
System.Diagnostics.Debugger.Log(0, null, "SCI_INT mapped to " + sci.ToString());
sci.RegisterHandler(new tysos.Resources.InterruptLine.InterruptHandler(SCIInt));
}
/* Set ACPI mode */
var smi_cmd = ios.AllocFixed(fadt.SMI_CMD, 1, true);
if (smi_cmd != null)
{
if ((fadt.PM1_CNT.Read() & 0x1) != 0)
{
System.Diagnostics.Debugger.Log(0, null, "Already in ACPI mode");
}
else
{
System.Diagnostics.Debugger.Log(0, null, "Setting ACPI mode");
smi_cmd.Write(smi_cmd.Addr64, 1, fadt.ACPI_ENABLE);
while ((fadt.PM1_CNT.Read() & 0x1) == 0)
{
;
}
System.Diagnostics.Debugger.Log(0, null, "Set ACPI mode");
}
}
}
root.Add(new File.Property {
Name = "class", Value = "bus"
});
Tags.Add("class");
return(true);
}