Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed

  • kernel/genarch/src/acpi/acpi.c

    r793cf029 re3ce39b  
    3333/**
    3434 * @file
    35  * @brief Advanced Configuration and Power Interface (ACPI) initialization.
    36  */
    37 
     35 * @brief       Advanced Configuration and Power Interface (ACPI) initialization.
     36 */
     37 
    3838#include <genarch/acpi/acpi.h>
    3939#include <genarch/acpi/madt.h>
    … …  
    4343#include <print.h>
    4444
    45 #define RSDP_SIGNATURE      "RSD PTR "
    46 #define RSDP_REVISION_OFFS  15
     45#define RSDP_SIGNATURE          "RSD PTR "
     46#define RSDP_REVISION_OFFS      15
    4747
    4848#define CMP_SIGNATURE(left, right) \
    … …  
    6464};
    6565
    66 static int rsdp_check(uint8_t *_rsdp) {
    67         struct acpi_rsdp *rsdp = (struct acpi_rsdp *) _rsdp;
    68         uint8_t sum = 0;
    69         uint32_t i;
    70        
    71         for (i = 0; i < 20; i++)
    72                 sum = (uint8_t) (sum + _rsdp[i]);
    73        
    74         if (sum)
    75                 return 0; /* bad checksum */
    76        
    77         if (rsdp->revision == 0)
    78                 return 1; /* ACPI 1.0 */
    79        
    80         for (; i < rsdp->length; i++)
    81                 sum = (uint8_t) (sum + _rsdp[i]);
    82        
    83         return !sum;
    84 }
    85 
    86 int acpi_sdt_check(uint8_t *sdt)
    87 {
    88         struct acpi_sdt_header *hdr = (struct acpi_sdt_header *) sdt;
     66static int rsdp_check(uint8_t *rsdp) {
     67        struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp;
    8968        uint8_t sum = 0;
    9069        unsigned int i;
    9170       
    92         for (i = 0; i < hdr->length; i++)
     71        for (i = 0; i < 20; i++)
     72                sum = (uint8_t) (sum + rsdp[i]);
     73               
     74        if (sum)       
     75                return 0; /* bad checksum */
     76
     77        if (r->revision == 0)
     78                return 1; /* ACPI 1.0 */
     79               
     80        for (; i < r->length; i++)
     81                sum = (uint8_t) (sum + rsdp[i]);
     82               
     83        return !sum;
     84       
     85}
     86
     87int acpi_sdt_check(uint8_t *sdt)
     88{
     89        struct acpi_sdt_header *h = (struct acpi_sdt_header *) sdt;
     90        uint8_t sum = 0;
     91        unsigned int i;
     92
     93        for (i = 0; i < h->length; i++)
    9394                sum = (uint8_t) (sum + sdt[i]);
    94        
     95               
    9596        return !sum;
    9697}
    … …  
    99100{
    100101        page_table_lock(AS_KERNEL, true);
    101         page_mapping_insert(AS_KERNEL, (uintptr_t) sdt, (uintptr_t) sdt,
    102             PAGE_NOT_CACHEABLE | PAGE_WRITE);
     102        page_mapping_insert(AS_KERNEL, (uintptr_t) sdt, (uintptr_t) sdt, PAGE_NOT_CACHEABLE | PAGE_WRITE);
    103103        map_structure((uintptr_t) sdt, sdt->length);
    104104        page_table_unlock(AS_KERNEL, true);
    … …  
    107107static void configure_via_rsdt(void)
    108108{
    109         size_t i;
    110         size_t j;
    111         size_t cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header))
    112             / sizeof(uint32_t);
     109        unsigned int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint32_t);
    113110       
    114111        for (i = 0; i < cnt; i++) {
    115                 for (j = 0; j < sizeof(signature_map)
    116                     / sizeof(struct acpi_signature_map); j++) {
    117                         struct acpi_sdt_header *hdr =
    118                             (struct acpi_sdt_header *) (unative_t) acpi_rsdt->entry[i];
    119                        
    120                         map_sdt(hdr);
    121                         if (CMP_SIGNATURE(hdr->signature, signature_map[j].signature)) {
    122                                 if (!acpi_sdt_check((uint8_t *) hdr))
    123                                         break;
    124                                
    125                                 *signature_map[j].sdt_ptr = hdr;
    126                                 LOG("%p: ACPI %s", *signature_map[j].sdt_ptr,
    127                                     signature_map[j].description);
     112                for (j = 0; j < sizeof(signature_map) / sizeof(struct acpi_signature_map); j++) {
     113                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) (unative_t) acpi_rsdt->entry[i];
     114               
     115                        map_sdt(h);
     116                        if (CMP_SIGNATURE(h->signature, signature_map[j].signature)) {
     117                                if (!acpi_sdt_check((uint8_t *) h))
     118                                        goto next;
     119                                *signature_map[j].sdt_ptr = h;
     120                                LOG("%p: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
    128121                        }
    129122                }
     123next:
     124                ;
    130125        }
    131126}
    … …  
    133128static void configure_via_xsdt(void)
    134129{
    135         size_t i;
    136         size_t j;
    137         size_t cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header))
    138             / sizeof(uint64_t);
     130        unsigned int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint64_t);
    139131       
    140132        for (i = 0; i < cnt; i++) {
    141                 for (j = 0; j < sizeof(signature_map)
    142                     / sizeof(struct acpi_signature_map); j++) {
    143                         struct acpi_sdt_header *hdr =
    144                             (struct acpi_sdt_header *) ((uintptr_t) acpi_xsdt->entry[i]);
    145                        
    146                         map_sdt(hdr);
    147                         if (CMP_SIGNATURE(hdr->signature, signature_map[j].signature)) {
    148                                 if (!acpi_sdt_check((uint8_t *) hdr))
    149                                         break;
    150                                
    151                                 *signature_map[j].sdt_ptr = hdr;
    152                                 LOG("%p: ACPI %s", *signature_map[j].sdt_ptr,
    153                                     signature_map[j].description);
     133                for (j = 0; j < sizeof(signature_map) / sizeof(struct acpi_signature_map); j++) {
     134                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((uintptr_t) acpi_rsdt->entry[i]);
     135
     136                        map_sdt(h);
     137                        if (CMP_SIGNATURE(h->signature, signature_map[j].signature)) {
     138                                if (!acpi_sdt_check((uint8_t *) h))
     139                                        goto next;
     140                                *signature_map[j].sdt_ptr = h;
     141                                LOG("%p: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
    154142                        }
    155143                }
    156         }
     144next:
     145                ;
     146        }
     147
    157148}
    158149
    … …  
    160151{
    161152        uint8_t *addr[2] = { NULL, (uint8_t *) PA2KA(0xe0000) };
    162         unsigned int i;
    163         unsigned int j;
    164         unsigned int length[2] = { 1024, 128 * 1024 };
     153        int i, j, length[2] = { 1024, 128*1024 };
    165154        uint64_t *sig = (uint64_t *) RSDP_SIGNATURE;
    166        
     155
    167156        /*
    168157         * Find Root System Description Pointer
    … …  
    170159         * 2. search 128K starting at 0xe0000
    171160         */
    172        
     161
    173162        addr[0] = (uint8_t *) PA2KA(ebda);
    174163        for (i = (ebda ? 0 : 1); i < 2; i++) {
    175164                for (j = 0; j < length[i]; j += 16) {
    176                         if ((*((uint64_t *) &addr[i][j]) == *sig)
    177                             && (rsdp_check(&addr[i][j]))) {
     165                        if (*((uint64_t *) &addr[i][j]) == *sig && rsdp_check(&addr[i][j])) {
    178166                                acpi_rsdp = (struct acpi_rsdp *) &addr[i][j];
    179167                                goto rsdp_found;
    … …  
    181169                }
    182170        }
    183        
     171
    184172        return;
    185        
     173
    186174rsdp_found:
    187         LOG("%p: ACPI Root System Description Pointer", acpi_rsdp);
    188        
    189         acpi_rsdt = (struct acpi_rsdt *) ((uintptr_t) acpi_rsdp->rsdt_address);
     175        LOG("%p: ACPI Root System Description Pointer\n", acpi_rsdp);
     176
     177        acpi_rsdt = (struct acpi_rsdt *) (unative_t) acpi_rsdp->rsdt_address;
    190178        if (acpi_rsdp->revision)
    191179                acpi_xsdt = (struct acpi_xsdt *) ((uintptr_t) acpi_rsdp->xsdt_address);
    192        
     180
    193181        if (acpi_rsdt)
    194182                map_sdt((struct acpi_sdt_header *) acpi_rsdt);
    195        
    196183        if (acpi_xsdt)
    197184                map_sdt((struct acpi_sdt_header *) acpi_xsdt);
    198        
    199         if ((acpi_rsdt) && (!acpi_sdt_check((uint8_t *) acpi_rsdt))) {
     185
     186        if (acpi_rsdt && !acpi_sdt_check((uint8_t *) acpi_rsdt)) {
    200187                printf("RSDT: bad checksum\n");
    201188                return;
    202189        }
    203        
    204         if ((acpi_xsdt) && (!acpi_sdt_check((uint8_t *) acpi_xsdt))) {
     190        if (acpi_xsdt && !acpi_sdt_check((uint8_t *) acpi_xsdt)) {
    205191                printf("XSDT: bad checksum\n");
    206192                return;
    207193        }
    208        
     194
    209195        if (acpi_xsdt)
    210196                configure_via_xsdt();
    211197        else if (acpi_rsdt)
    212198                configure_via_rsdt();
     199
    213200}
    214201
Note: See TracChangeset for help on using the changeset viewer.