Subversion Repositories HelenOS-historic

Rev

Rev 33 | Go to most recent revision | Blame | 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 <arch/acpi/acpi.h>
  30. #include <arch/acpi/madt.h>
  31. #include <arch/bios/bios.h>
  32.  
  33. #include <mm/page.h>
  34.  
  35. #define RSDP_SIGNATURE      "RSD PTR "
  36. #define RSDP_REVISION_OFFS  15
  37.  
  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. };
  45.  
  46. int rsdp_check(__u8 *rsdp) {
  47.     struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp;
  48.     __u8 sum = 0;
  49.     int i;
  50.    
  51.     for (i=0; i<20; i++)
  52.         sum += rsdp[i];
  53.        
  54.     if (sum)   
  55.         return 0; /* bad checksum */
  56.  
  57.     if (r->revision == 0)
  58.         return 1; /* ACPI 1.0 */
  59.        
  60.     for (; i<r->length; i++)
  61.         sum += rsdp[i];
  62.        
  63.     return !sum;
  64.    
  65. }
  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.     int i, cnt, length;
  82.  
  83.     map_page_to_frame((__address) sdt, (__address) sdt, PAGE_NOT_CACHEABLE, 0);
  84.    
  85.     length = sdt->length + ((__address) sdt) - ((__address) sdt)&0xfffff000;
  86.     cnt = length/PAGE_SIZE + (length%PAGE_SIZE>0);
  87.    
  88.     for (i = 1; i < cnt; i++)
  89.         map_page_to_frame(((__address) sdt) + i*PAGE_SIZE, ((__address) sdt) + i*PAGE_SIZE, PAGE_NOT_CACHEABLE, 0);
  90. }
  91.  
  92. void acpi_init(void)
  93. {
  94.         __u8 *addr[2] = { NULL, (__u8 *) 0xe0000 };
  95.         int i, j, length[2] = { 1024, 128*1024 };
  96.     __u64 *sig = (__u64 *) RSDP_SIGNATURE;
  97.  
  98.         /*
  99.      * Find Root System Description Pointer
  100.          * 1. search first 1K of EBDA
  101.          * 2. search 128K starting at 0xe0000
  102.          */
  103.  
  104.     addr[0] = (__u8 *) ebda;
  105.     for (i = (ebda ? 0 : 1); i < 2; i++) {
  106.                 for (j = 0; j < length[i]; j += 16) {
  107.                         if (*((__u64 *) &addr[i][j]) == *sig && rsdp_check(&addr[i][j])) {
  108.                                 acpi_rsdp = (struct acpi_rsdp *) &addr[i][j];
  109.                                 goto rsdp_found;
  110.                         }
  111.                 }
  112.         }
  113.  
  114.         return;
  115.  
  116. rsdp_found:
  117.         printf("%L: ACPI Root System Description Pointer\n", acpi_rsdp);
  118.    
  119.     acpi_rsdt = (struct acpi_rsdt *) acpi_rsdp->rsdt_address;
  120.     if (acpi_rsdp->revision) acpi_xsdt = (struct acpi_xsdt *) ((__address) acpi_rsdp->xsdt_address);
  121.  
  122.     if (acpi_rsdt) map_sdt((struct acpi_sdt_header *) acpi_rsdt);
  123.     if (acpi_xsdt) map_sdt((struct acpi_sdt_header *) acpi_xsdt);  
  124.  
  125.     if (acpi_rsdt && !acpi_sdt_check((__u8 *) acpi_rsdt)) {
  126.         printf("RSDT: %s\n", "bad checksum");
  127.         return;
  128.     }
  129.     if (acpi_xsdt && !acpi_sdt_check((__u8 *) acpi_xsdt)) {
  130.         printf("XSDT: %s\n", "bad checksum");
  131.         return;
  132.     }
  133.  
  134.     if (acpi_xsdt) configure_via_xsdt();
  135.     else if (acpi_rsdt) configure_via_rsdt();
  136.  
  137. }
  138.  
  139. void configure_via_rsdt(void)
  140. {
  141.     int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u32);
  142.    
  143.     for (i=0; i<cnt; i++) {
  144.         for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
  145.             struct acpi_sdt_header *h = (struct acpi_sdt_header *) acpi_rsdt->entry[i];
  146.        
  147.                 map_sdt(h);
  148.             if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
  149.                 if (!acpi_sdt_check((__u8 *) h))
  150.                     goto next;
  151.                 *signature_map[j].sdt_ptr = h;
  152.                 printf("%L: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
  153.             }
  154.         }
  155. next:
  156.         ;
  157.     }
  158. }
  159.  
  160. void configure_via_xsdt(void)
  161. {
  162.     int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u64);
  163.    
  164.     for (i=0; i<cnt; i++) {
  165.         for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
  166.             struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((__address) acpi_rsdt->entry[i]);
  167.  
  168.             map_sdt(h);
  169.             if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
  170.                 if (!acpi_sdt_check((__u8 *) h))
  171.                     goto next;
  172.                 *signature_map[j].sdt_ptr = h;
  173.                 printf("%L: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
  174.             }
  175.         }
  176. next:
  177.         ;
  178.     }
  179.  
  180. }
  181.