Subversion Repositories HelenOS-historic

Rev

Rev 687 | Rev 756 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (C) 2005 Jakub Jermar
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  *
  9.  * - Redistributions of source code must retain the above copyright
  10.  *   notice, this list of conditions and the following disclaimer.
  11.  * - Redistributions in binary form must reproduce the above copyright
  12.  *   notice, this list of conditions and the following disclaimer in the
  13.  *   documentation and/or other materials provided with the distribution.
  14.  * - The name of the author may not be used to endorse or promote products
  15.  *   derived from this software without specific prior written permission.
  16.  *
  17.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  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.
  27.  */
  28.  
  29. #include <genarch/acpi/acpi.h>
  30. #include <genarch/acpi/madt.h>
  31. #include <arch/bios/bios.h>
  32. #include <mm/as.h>
  33. #include <mm/page.h>
  34. #include <print.h>
  35.  
  36. #define RSDP_SIGNATURE      "RSD PTR "
  37. #define RSDP_REVISION_OFFS  15
  38.  
  39. struct acpi_rsdp *acpi_rsdp = NULL;
  40. struct acpi_rsdt *acpi_rsdt = NULL;
  41. struct acpi_xsdt *acpi_xsdt = NULL;
  42.  
  43. struct acpi_signature_map signature_map[] = {
  44.     { (__u8 *)"APIC", (void *) &acpi_madt, "Multiple APIC Description Table" }
  45. };
  46.  
  47. static int rsdp_check(__u8 *rsdp) {
  48.     struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp;
  49.     __u8 sum = 0;
  50.     int i;
  51.    
  52.     for (i=0; i<20; i++)
  53.         sum += rsdp[i];
  54.        
  55.     if (sum)   
  56.         return 0; /* bad checksum */
  57.  
  58.     if (r->revision == 0)
  59.         return 1; /* ACPI 1.0 */
  60.        
  61.     for (; i<r->length; i++)
  62.         sum += rsdp[i];
  63.        
  64.     return !sum;
  65.    
  66. }
  67.  
  68. int acpi_sdt_check(__u8 *sdt)
  69. {
  70.     struct acpi_sdt_header *h = (struct acpi_sdt_header *) sdt;
  71.     __u8 sum = 0;
  72.     int i;
  73.  
  74.     for (i=0; i<h->length; i++)
  75.         sum += sdt[i];
  76.        
  77.     return !sum;
  78. }
  79.  
  80. static void map_sdt(struct acpi_sdt_header *sdt)
  81. {
  82.     page_mapping_insert(AS_KERNEL, (__address) sdt, (__address) sdt, PAGE_NOT_CACHEABLE, 0);
  83.     map_structure((__address) sdt, sdt->length);
  84. }
  85.  
  86. static void configure_via_rsdt(void)
  87. {
  88.     int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u32);
  89.    
  90.     for (i=0; i<cnt; i++) {
  91.         for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
  92.             struct acpi_sdt_header *h = (struct acpi_sdt_header *) (__native) acpi_rsdt->entry[i];
  93.        
  94.             map_sdt(h);
  95.             if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
  96.                 if (!acpi_sdt_check((__u8 *) h))
  97.                     goto next;
  98.                 *signature_map[j].sdt_ptr = h;
  99.                 printf("%P: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
  100.             }
  101.         }
  102. next:
  103.         ;
  104.     }
  105. }
  106.  
  107. static void configure_via_xsdt(void)
  108. {
  109.     int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u64);
  110.    
  111.     for (i=0; i<cnt; i++) {
  112.         for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
  113.             struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((__address) acpi_rsdt->entry[i]);
  114.  
  115.             map_sdt(h);
  116.             if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
  117.                 if (!acpi_sdt_check((__u8 *) h))
  118.                     goto next;
  119.                 *signature_map[j].sdt_ptr = h;
  120.                 printf("%P: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
  121.             }
  122.         }
  123. next:
  124.         ;
  125.     }
  126.  
  127. }
  128.  
  129. void acpi_init(void)
  130. {
  131.     __u8 *addr[2] = { NULL, (__u8 *) PA2KA(0xe0000) };
  132.     int i, j, length[2] = { 1024, 128*1024 };
  133.     __u64 *sig = (__u64 *) RSDP_SIGNATURE;
  134.  
  135.     /*
  136.      * Find Root System Description Pointer
  137.      * 1. search first 1K of EBDA
  138.      * 2. search 128K starting at 0xe0000
  139.      */
  140.  
  141.     addr[0] = (__u8 *) PA2KA(ebda);
  142.     for (i = (ebda ? 0 : 1); i < 2; i++) {
  143.         for (j = 0; j < length[i]; j += 16) {
  144.             if (*((__u64 *) &addr[i][j]) == *sig && rsdp_check(&addr[i][j])) {
  145.                 acpi_rsdp = (struct acpi_rsdp *) &addr[i][j];
  146.                 goto rsdp_found;
  147.             }
  148.         }
  149.     }
  150.  
  151.     return;
  152.  
  153. rsdp_found:
  154.     printf("%P: ACPI Root System Description Pointer\n", acpi_rsdp);
  155.  
  156.     acpi_rsdt = (struct acpi_rsdt *) (__native) acpi_rsdp->rsdt_address;
  157.     if (acpi_rsdp->revision) acpi_xsdt = (struct acpi_xsdt *) ((__address) acpi_rsdp->xsdt_address);
  158.  
  159.     if (acpi_rsdt) map_sdt((struct acpi_sdt_header *) acpi_rsdt);
  160.     if (acpi_xsdt) map_sdt((struct acpi_sdt_header *) acpi_xsdt);  
  161.  
  162.     if (acpi_rsdt && !acpi_sdt_check((__u8 *) acpi_rsdt)) {
  163.         printf("RSDT: %s\n", "bad checksum");
  164.         return;
  165.     }
  166.     if (acpi_xsdt && !acpi_sdt_check((__u8 *) acpi_xsdt)) {
  167.         printf("XSDT: %s\n", "bad checksum");
  168.         return;
  169.     }
  170.  
  171.     if (acpi_xsdt) configure_via_xsdt();
  172.     else if (acpi_rsdt) configure_via_rsdt();
  173.  
  174. }
  175.  
  176.