Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed

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

    r793cf029 r1075ac6  
    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}
    … …  
    9899static void map_sdt(struct acpi_sdt_header *sdt)
    99100{
    100         page_table_lock(AS_KERNEL, true);
    101         page_mapping_insert(AS_KERNEL, (uintptr_t) sdt, (uintptr_t) sdt,
    102             PAGE_NOT_CACHEABLE | PAGE_WRITE);
     101        page_mapping_insert(AS_KERNEL, (uintptr_t) sdt, (uintptr_t) sdt, PAGE_NOT_CACHEABLE | PAGE_WRITE);
    103102        map_structure((uintptr_t) sdt, sdt->length);
    104         page_table_unlock(AS_KERNEL, true);
    105103}
    106104
    107105static void configure_via_rsdt(void)
    108106{
    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);
     107        unsigned int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint32_t);
    113108       
    114109        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);
     110                for (j = 0; j < sizeof(signature_map) / sizeof(struct acpi_signature_map); j++) {
     111                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) (unative_t) acpi_rsdt->entry[i];
     112               
     113                        map_sdt(h);
     114                        if (CMP_SIGNATURE(h->signature, signature_map[j].signature)) {
     115                                if (!acpi_sdt_check((uint8_t *) h))
     116                                        goto next;
     117                                *signature_map[j].sdt_ptr = h;
     118                                LOG("%p: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
    128119                        }
    129120                }
     121next:
     122                ;
    130123        }
    131124}
    … …  
    133126static void configure_via_xsdt(void)
    134127{
    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);
     128        unsigned int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint64_t);
    139129       
    140130        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);
     131                for (j = 0; j < sizeof(signature_map) / sizeof(struct acpi_signature_map); j++) {
     132                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((uintptr_t) acpi_rsdt->entry[i]);
     133
     134                        map_sdt(h);
     135                        if (CMP_SIGNATURE(h->signature, signature_map[j].signature)) {
     136                                if (!acpi_sdt_check((uint8_t *) h))
     137                                        goto next;
     138                                *signature_map[j].sdt_ptr = h;
     139                                LOG("%p: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
    154140                        }
    155141                }
    156         }
     142next:
     143                ;
     144        }
     145
    157146}
    158147
    … …  
    160149{
    161150        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 };
     151        int i, j, length[2] = { 1024, 128*1024 };
    165152        uint64_t *sig = (uint64_t *) RSDP_SIGNATURE;
    166        
     153
    167154        /*
    168155         * Find Root System Description Pointer
    … …  
    170157         * 2. search 128K starting at 0xe0000
    171158         */
    172        
     159
    173160        addr[0] = (uint8_t *) PA2KA(ebda);
    174161        for (i = (ebda ? 0 : 1); i < 2; i++) {
    175162                for (j = 0; j < length[i]; j += 16) {
    176                         if ((*((uint64_t *) &addr[i][j]) == *sig)
    177                             && (rsdp_check(&addr[i][j]))) {
     163                        if (*((uint64_t *) &addr[i][j]) == *sig && rsdp_check(&addr[i][j])) {
    178164                                acpi_rsdp = (struct acpi_rsdp *) &addr[i][j];
    179165                                goto rsdp_found;
    … …  
    181167                }
    182168        }
    183        
     169
    184170        return;
    185        
     171
    186172rsdp_found:
    187         LOG("%p: ACPI Root System Description Pointer", acpi_rsdp);
    188        
    189         acpi_rsdt = (struct acpi_rsdt *) ((uintptr_t) acpi_rsdp->rsdt_address);
     173        LOG("%p: ACPI Root System Description Pointer\n", acpi_rsdp);
     174
     175        acpi_rsdt = (struct acpi_rsdt *) (unative_t) acpi_rsdp->rsdt_address;
    190176        if (acpi_rsdp->revision)
    191177                acpi_xsdt = (struct acpi_xsdt *) ((uintptr_t) acpi_rsdp->xsdt_address);
    192        
     178
    193179        if (acpi_rsdt)
    194180                map_sdt((struct acpi_sdt_header *) acpi_rsdt);
    195        
    196181        if (acpi_xsdt)
    197182                map_sdt((struct acpi_sdt_header *) acpi_xsdt);
    198        
    199         if ((acpi_rsdt) && (!acpi_sdt_check((uint8_t *) acpi_rsdt))) {
     183
     184        if (acpi_rsdt && !acpi_sdt_check((uint8_t *) acpi_rsdt)) {
    200185                printf("RSDT: bad checksum\n");
    201186                return;
    202187        }
    203        
    204         if ((acpi_xsdt) && (!acpi_sdt_check((uint8_t *) acpi_xsdt))) {
     188        if (acpi_xsdt && !acpi_sdt_check((uint8_t *) acpi_xsdt)) {
    205189                printf("XSDT: bad checksum\n");
    206190                return;
    207191        }
    208        
     192
    209193        if (acpi_xsdt)
    210194                configure_via_xsdt();
    211195        else if (acpi_rsdt)
    212196                configure_via_rsdt();
     197
    213198}
    214199
Note: See TracChangeset for help on using the changeset viewer.