Subversion Repositories HelenOS-historic

Rev

Rev 32 | Rev 34 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 32 Rev 33
Line 25... Line 25...
25 
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 25 
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 26 
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 
 */
 27 
 */
28 
 
 28 
 
29 
#include <arch/acpi/acpi.h>
 29 
#include <arch/acpi/acpi.h>
- 
 
 30 
#include <arch/acpi/madt.h>
30 
#include <arch/bios/bios.h>
 31 
#include <arch/bios/bios.h>
31 
 
 32 
 
- 
 
 33 
#include <mm/page.h>
- 
 
 34 
 
32 
#define RSDP_SIGNATURE      "RSD PTR "
 35 
#define RSDP_SIGNATURE      "RSD PTR "
33 
#define RSDP_REVISION_OFFS  15
 36 
#define RSDP_REVISION_OFFS  15
34 
 
 37 
 
35 
struct acpi_rsdp *acpi_rsdp = NULL;
 38 
struct acpi_rsdp *acpi_rsdp = NULL;
- 
 
 39 
struct acpi_rsdt *acpi_rsdt = NULL;
- 
 
 40 
struct acpi_xsdt *acpi_xsdt = NULL;
- 
 
 41 
 
- 
 
 42 
struct acpi_signature_map signature_map[] = {
- 
 
 43 
    { "APIC", (struct acpi_sdt_header **) &acpi_madt, "Multiple APIC Description Table" }
- 
 
 44 
};
36 
 
 45 
 
37 
int rsdp_check(__u8 *rsdp) {
 46 
int rsdp_check(__u8 *rsdp) {
38 
    struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp;
 47 
    struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp;
39 
    __u8 sum = 0;
 48 
    __u8 sum = 0;
40 
    int i;
 49 
    int i;
Line 53... Line 62...
53 
       
 62 
       
54 
    return !sum;
 63 
    return !sum;
55 
   
 64 
   
56 
}
 65 
}
57 
 
 66 
 
- 
 
 67 
int acpi_sdt_check(__u8 *sdt)
- 
 
 68 
{
- 
 
 69 
    struct acpi_sdt_header *h = (struct acpi_sdt_header *) sdt;
- 
 
 70 
    __u8 sum = 0;
- 
 
 71 
    int i;
- 
 
 72 
 
- 
 
 73 
    for (i=0; i<h->length; i++)
- 
 
 74 
        sum += sdt[i];
- 
 
 75 
       
- 
 
 76 
    return !sum;
- 
 
 77 
}
- 
 
 78 
 
- 
 
 79 
void map_sdt(struct acpi_sdt_header *sdt)
- 
 
 80 
{
- 
 
 81 
    map_page_to_frame((__address) sdt, (__address) sdt, PAGE_NOT_CACHEABLE, 0);
- 
 
 82 
}
- 
 
 83 
 
58 
void acpi_init(void)
 84 
void acpi_init(void)
59 
{
 85 
{
60 
        __u8 *addr[2] = { NULL, (__u8 *) 0xe0000 };
 86 
        __u8 *addr[2] = { NULL, (__u8 *) 0xe0000 };
61 
        int i, j, length[2] = { 1024, 128*1024 };
 87 
        int i, j, length[2] = { 1024, 128*1024 };
62 
    __u64 *sig = (__u64 *) RSDP_SIGNATURE;
 88 
    __u64 *sig = (__u64 *) RSDP_SIGNATURE;
Line 78... Line 104...
78 
        }
 104 
        }
79 
 
 105 
 
80 
        return;
 106 
        return;
81 
 
 107 
 
82 
rsdp_found:
 108 
rsdp_found:
83 
        printf("%L: ACPI Root System Description Pointer\n", acpi_rsdp);       
 109 
        printf("%L: ACPI Root System Description Pointer\n", acpi_rsdp);
- 
 
 110 
   
- 
 
 111 
    acpi_rsdt = (struct acpi_rsdt *) acpi_rsdp->rsdt_address;
- 
 
 112 
    if (acpi_rsdp->revision) acpi_xsdt = (struct acpi_xsdt *) ((__address) acpi_rsdp->xsdt_address);
- 
 
 113 
 
- 
 
 114 
    if (acpi_rsdt) map_sdt((struct acpi_sdt_header *) acpi_rsdt);
- 
 
 115 
    if (acpi_xsdt) map_sdt((struct acpi_sdt_header *) acpi_xsdt);  
- 
 
 116 
 
- 
 
 117 
    if (acpi_rsdt && !acpi_sdt_check((__u8 *) acpi_rsdt)) {
- 
 
 118 
        printf("RSDT: %s\n", "bad checksum");
- 
 
 119 
        return;
- 
 
 120 
    }
- 
 
 121 
    if (acpi_xsdt && !acpi_sdt_check((__u8 *) acpi_xsdt)) {
- 
 
 122 
        printf("XSDT: %s\n", "bad checksum");
- 
 
 123 
        return;
- 
 
 124 
    }
- 
 
 125 
 
- 
 
 126 
    if (acpi_xsdt) configure_via_xsdt();
- 
 
 127 
    else if (acpi_rsdt) configure_via_rsdt();
- 
 
 128 
 
- 
 
 129 
}
- 
 
 130 
 
- 
 
 131 
void configure_via_rsdt(void)
- 
 
 132 
{
- 
 
 133 
    int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u32);
- 
 
 134 
   
- 
 
 135 
    for (i=0; i<cnt; i++) {
- 
 
 136 
        for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
- 
 
 137 
            struct acpi_sdt_header *h = (struct acpi_sdt_header *) acpi_rsdt->entry[i];
- 
 
 138 
       
- 
 
 139 
                map_sdt(h);
- 
 
 140 
            if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
- 
 
 141 
                if (!acpi_sdt_check((__u8 *) h))
- 
 
 142 
                    goto next;
- 
 
 143 
                *signature_map[j].sdt_ptr = h;
- 
 
 144 
                printf("%L: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
- 
 
 145 
            }
- 
 
 146 
        }
- 
 
 147 
next:
- 
 
 148 
        ;
- 
 
 149 
    }
- 
 
 150 
}
- 
 
 151 
 
- 
 
 152 
void configure_via_xsdt(void)
- 
 
 153 
{
- 
 
 154 
    int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u64);
- 
 
 155 
   
- 
 
 156 
    for (i=0; i<cnt; i++) {
- 
 
 157 
        for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
- 
 
 158 
            struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((__address) acpi_rsdt->entry[i]);
- 
 
 159 
 
- 
 
 160 
            map_sdt(h);
- 
 
 161 
            if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
- 
 
 162 
                if (!acpi_sdt_check((__u8 *) h))
- 
 
 163 
                    goto next;
- 
 
 164 
                *signature_map[j].sdt_ptr = h;
- 
 
 165 
                printf("%L: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
- 
 
 166 
            }
- 
 
 167 
        }
- 
 
 168 
next:
- 
 
 169 
        ;
- 
 
 170 
    }
- 
 
 171 
 
84 
}
 172 
}