source: bootcd/isolinux/syslinux-6.03/com32/gpllib/acpi/madt.c

/* ----------------------------------------------------------------------- *
 *
 *   Copyright 2009-2011 Erwan Velu - All Rights Reserved
 *
 *   Permission is hereby granted, free of charge, to any person
 *   obtaining a copy of this software and associated documentation
 *   files (the "Software"), to deal in the Software without
 *   restriction, including without limitation the rights to use,
 *   copy, modify, merge, publish, distribute, sublicense, and/or
 *   sell copies of the Software, and to permit persons to whom
 *   the Software is furnished to do so, subject to the following
 *   conditions:
 *
 *   The above copyright notice and this permission notice shall
 *   be included in all copies or substantial portions of the Software.
 *
 *   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 *   EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
 *   OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 *   NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
 *   HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
 *   WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 *   FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 *   OTHER DEALINGS IN THE SOFTWARE.
 *
 * -----------------------------------------------------------------------
*/

#include <stdio.h>
#include <string.h>
#include <memory.h>
#include <dprintf.h>
#include <stdlib.h>
#include "acpi/acpi.h"

/* Parse the apic structures */
static uint8_t *add_apic_structure(s_acpi * acpi, uint8_t * q)
{
    uint8_t type = *q;
    q++;
    uint8_t length = *q;
    q++;
    s_processor_local_apic *sla;
    s_io_apic *sio;
    s_interrupt_source_override *siso;
    s_nmi *snmi;
    s_local_apic_nmi *slan;
    s_local_apic_address_override *slaao;
    s_io_sapic *siosapic;
    s_local_sapic *sls;
    s_madt *madt = &acpi->madt;

    switch (type) {
    case PROCESSOR_LOCAL_APIC:
        sla = &madt->processor_local_apic[madt->processor_local_apic_count];
        sla->type = type;
        sla->length = length;
        cp_struct(&sla->acpi_id);
        cp_struct(&sla->apic_id);
        cp_struct(&sla->flags);
        madt->processor_local_apic_count++;
        break;
    case IO_APIC:
        sio = &madt->io_apic[madt->io_apic_count];
        sio->type = type;
        sio->length = length;
        cp_struct(&sio->io_apic_id);
        cp_struct(&sio->reserved);
        cp_struct(&sio->io_apic_address);
        cp_struct(&sio->global_system_interrupt_base);
        madt->io_apic_count++;
        break;
    case INTERRUPT_SOURCE_OVERRIDE:
        siso =
            &madt->interrupt_source_override[madt->
                                             interrupt_source_override_count];
        siso->type = type;
        siso->length = length;
        siso->bus = *q;
        q++;
        siso->source = *q;
        q++;
        cp_struct(&siso->global_system_interrupt);
        cp_struct(&siso->flags);
        madt->interrupt_source_override_count++;
        break;
    case NMI:
        snmi = &madt->nmi[madt->nmi_count];
        snmi->type = type;
        snmi->length = length;
        cp_struct(&snmi->flags);
        cp_struct(&snmi->global_system_interrupt);
        madt->nmi_count++;
        break;
    case LOCAL_APIC_NMI_STRUCTURE:
        slan = &madt->local_apic_nmi[madt->local_apic_nmi_count];
        slan->type = type;
        slan->length = length;
        cp_struct(&slan->acpi_processor_id);
        cp_struct(&slan->flags);
        cp_struct(&slan->local_apic_lint);
        madt->local_apic_nmi_count++;
        break;
    case LOCAL_APIC_ADDRESS_OVERRIDE_STRUCTURE:
        slaao =
            &madt->local_apic_address_override[madt->
                                               local_apic_address_override_count];
        slaao->type = type;
        slaao->length = length;
        cp_struct(&slaao->reserved);
        cp_struct(&slaao->local_apic_address);
        madt->local_apic_address_override_count++;
        break;
    case IO_SAPIC:
        siosapic = &madt->io_sapic[madt->io_sapic_count];
        siosapic->type = type;
        siosapic->length = length;
        cp_struct(&siosapic->io_apic_id);
        cp_struct(&siosapic->reserved);
        cp_struct(&siosapic->global_system_interrupt_base);
        cp_struct(&siosapic->io_sapic_address);
        madt->io_sapic_count++;
        break;
    case LOCAL_SAPIC:
        sls = &madt->local_sapic[madt->local_sapic_count];
        sls->type = type;
        sls->length = length;
        cp_struct(&sls->acpi_processor_id);
        cp_struct(&sls->local_sapic_id);
        cp_struct(&sls->local_sapic_eid);
        cp_struct(sls->reserved);
        cp_struct(&sls->flags);
        cp_struct(&sls->acpi_processor_uid_value);
        if ((sls->acpi_processor_uid_string =
             malloc(length - ACPI_PROCESSOR_UID_STRING_OFFSET)) != NULL) {
            memcpy(sls->acpi_processor_uid_string, q,
                   length - ACPI_PROCESSOR_UID_STRING_OFFSET);
            q += length - ACPI_PROCESSOR_UID_STRING_OFFSET;
        }
        madt->local_sapic_count++;
        break;
    default:
        printf("Unkown APIC structure type %u, size=%u \n", type, length);
        q += length - 2;
        break;
    }
    return q;
}

void parse_madt(s_acpi * acpi)
{
    /* Let's seach for FADT table */
    uint8_t *q, *max_address;
    s_madt *m = &acpi->madt;

    /* Fixing table name */
    memcpy(m->header.signature, APIC, sizeof(APIC));

    /* Copying remaining structs */
    q = (uint8_t *)m->address;
    q += ACPI_HEADER_SIZE;
    
    max_address = (uint8_t *)m->address;
    max_address += m->header.length;

    cp_struct(&m->local_apic_address);
    cp_struct(&m->flags);

    while (q <  max_address) {
        q = add_apic_structure(acpi, q);
    }
}