Fork us on GitHub Follow us on Facebook Follow us on Twitter

Changeset 793cf029 in mainline


Ignore:
Timestamp:
2010-06-29T15:38:52Z (12 years ago)
Author:
Martin Decky <martin@…>
Branches:
lfn, master, serial
Children:
263bda2, f56e897f
Parents:
c5da138
Message:

ACPI code cleanup

File:
1 edited

Legend:

Unmodified
Added
Removed
  • kernel/genarch/src/acpi/acpi.c

    rc5da138 r793cf029  
    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 *r = (struct acpi_rsdp *) rsdp;
     66static 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
     86int acpi_sdt_check(uint8_t *sdt)
     87{
     88        struct acpi_sdt_header *hdr = (struct acpi_sdt_header *) sdt;
    6889        uint8_t sum = 0;
    6990        unsigned int i;
    7091       
    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                
     92        for (i = 0; i < hdr->length; i++)
     93                sum = (uint8_t) (sum + sdt[i]);
     94       
    8395        return !sum;
    84        
    85 }
    86 
    87 int 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++)
    94                 sum = (uint8_t) (sum + sdt[i]);
    95                
    96         return !sum;
    9796}
    9897
     
    10099{
    101100        page_table_lock(AS_KERNEL, true);
    102         page_mapping_insert(AS_KERNEL, (uintptr_t) sdt, (uintptr_t) sdt, PAGE_NOT_CACHEABLE | PAGE_WRITE);
     101        page_mapping_insert(AS_KERNEL, (uintptr_t) sdt, (uintptr_t) sdt,
     102            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         unsigned int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint32_t);
     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);
    110113       
    111114        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 *) (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);
     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);
    121128                        }
    122129                }
    123 next:
    124                 ;
    125130        }
    126131}
     
    128133static void configure_via_xsdt(void)
    129134{
    130         unsigned int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint64_t);
     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);
    131139       
    132140        for (i = 0; i < cnt; i++) {
    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_xsdt->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);
     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);
    142154                        }
    143155                }
    144 next:
    145                 ;
    146         }
    147 
     156        }
    148157}
    149158
     
    151160{
    152161        uint8_t *addr[2] = { NULL, (uint8_t *) PA2KA(0xe0000) };
    153         int i, j, length[2] = { 1024, 128*1024 };
     162        unsigned int i;
     163        unsigned int j;
     164        unsigned int length[2] = { 1024, 128 * 1024 };
    154165        uint64_t *sig = (uint64_t *) RSDP_SIGNATURE;
    155 
     166       
    156167        /*
    157168         * Find Root System Description Pointer
     
    159170         * 2. search 128K starting at 0xe0000
    160171         */
    161 
     172       
    162173        addr[0] = (uint8_t *) PA2KA(ebda);
    163174        for (i = (ebda ? 0 : 1); i < 2; i++) {
    164175                for (j = 0; j < length[i]; j += 16) {
    165                         if (*((uint64_t *) &addr[i][j]) == *sig && rsdp_check(&addr[i][j])) {
     176                        if ((*((uint64_t *) &addr[i][j]) == *sig)
     177                            && (rsdp_check(&addr[i][j]))) {
    166178                                acpi_rsdp = (struct acpi_rsdp *) &addr[i][j];
    167179                                goto rsdp_found;
     
    169181                }
    170182        }
    171 
     183       
    172184        return;
    173 
     185       
    174186rsdp_found:
    175         LOG("%p: ACPI Root System Description Pointer\n", acpi_rsdp);
    176 
    177         acpi_rsdt = (struct acpi_rsdt *) (unative_t) acpi_rsdp->rsdt_address;
     187        LOG("%p: ACPI Root System Description Pointer", acpi_rsdp);
     188       
     189        acpi_rsdt = (struct acpi_rsdt *) ((uintptr_t) acpi_rsdp->rsdt_address);
    178190        if (acpi_rsdp->revision)
    179191                acpi_xsdt = (struct acpi_xsdt *) ((uintptr_t) acpi_rsdp->xsdt_address);
    180 
     192       
    181193        if (acpi_rsdt)
    182194                map_sdt((struct acpi_sdt_header *) acpi_rsdt);
     195       
    183196        if (acpi_xsdt)
    184197                map_sdt((struct acpi_sdt_header *) acpi_xsdt);
    185 
    186         if (acpi_rsdt && !acpi_sdt_check((uint8_t *) acpi_rsdt)) {
     198       
     199        if ((acpi_rsdt) && (!acpi_sdt_check((uint8_t *) acpi_rsdt))) {
    187200                printf("RSDT: bad checksum\n");
    188201                return;
    189202        }
    190         if (acpi_xsdt && !acpi_sdt_check((uint8_t *) acpi_xsdt)) {
     203       
     204        if ((acpi_xsdt) && (!acpi_sdt_check((uint8_t *) acpi_xsdt))) {
    191205                printf("XSDT: bad checksum\n");
    192206                return;
    193207        }
    194 
     208       
    195209        if (acpi_xsdt)
    196210                configure_via_xsdt();
    197211        else if (acpi_rsdt)
    198212                configure_via_rsdt();
    199 
    200213}
    201214
Note: See TracChangeset for help on using the changeset viewer.