src/arch/i386/boot/acpigen.c

   1 /*
   2  * This file is part of the coreboot project.
   3  *
   4  * Copyright (C) 2009 Rudolf Marek <r.marek@assembler.cz>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License v2 as published by
   8  * the Free Software Foundation.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  18  */
  19
  20 /* how many nesting we support */
  21 #define ACPIGEN_LENSTACK_SIZE 10
  22
  23 /* if you need to change this, change the acpigen_write_f and
  24    acpigen_patch_len */
  25
  26 #define ACPIGEN_MAXLEN 0xfff
  27
  28 #include <string.h>
  29 #include <arch/acpigen.h>
  30 #include <console/console.h>
  31
  32 static char *gencurrent;
  33
  34 char *len_stack[ACPIGEN_LENSTACK_SIZE];
  35 int ltop = 0;
  36
  37 static int acpigen_write_len_f()
  38 {
  39         ASSERT(ltop < (ACPIGEN_LENSTACK_SIZE - 1))
  40         len_stack[ltop++] = gencurrent;
  41         acpigen_emit_byte(0);
  42         acpigen_emit_byte(0);
  43         return 2;
  44 }
  45
  46 void acpigen_patch_len(int len)
  47 {
  48         ASSERT(len <= ACPIGEN_MAXLEN)
  49         ASSERT(ltop > 0)
  50         char *p = len_stack[--ltop];
  51         /* generate store length for 0xfff max */
  52         p[0] = (0x40 | (len & 0xf));
  53         p[1] = (len >> 4 & 0xff);
  54
  55 }
  56
  57 void acpigen_set_current(char *curr) {
  58     gencurrent = curr;
  59 }
  60
  61 char *acpigen_get_current(void) {
  62     return gencurrent;
  63 }
  64
  65 int acpigen_emit_byte(unsigned char b)
  66 {
  67         (*gencurrent++) = b;
  68         return 1;
  69 }
  70
  71 int acpigen_write_package(int nr_el)
  72 {
  73         int len;
  74         /* package op */
  75         acpigen_emit_byte(0x12);
  76         len = acpigen_write_len_f();
  77         acpigen_emit_byte(nr_el);
  78         return len + 2;
  79 }
  80
  81 int acpigen_write_byte(unsigned int data)
  82 {
  83         /* byte op */
  84         acpigen_emit_byte(0xa);
  85         acpigen_emit_byte(data & 0xff);
  86         return 2;
  87 }
  88
  89 int acpigen_write_dword(unsigned int data)
  90 {
  91         /* dword op */
  92         acpigen_emit_byte(0xc);
  93         acpigen_emit_byte(data & 0xff);
  94         acpigen_emit_byte((data >> 8) & 0xff);
  95         acpigen_emit_byte((data >> 16) & 0xff);
  96         acpigen_emit_byte((data >> 24) & 0xff);
  97         return 5;
  98 }
  99
 100 int acpigen_write_name_byte(char *name, uint8_t val) {
 101         int len;
 102         len = acpigen_write_name(name);
 103         len += acpigen_write_byte(val);
 104         return len;
 105 }
 106
 107 int acpigen_write_name_dword(char *name, uint32_t val) {
 108         int len;
 109         len = acpigen_write_name(name);
 110         len += acpigen_write_dword(val);
 111         return len;
 112 }
 113
 114 int acpigen_emit_stream(char *data, int size) {
 115         int i;
 116         for (i = 0; i < size; i++) {
 117                 acpigen_emit_byte(data[i]);
 118         }
 119         return size;
 120 }
 121
 122 int acpigen_write_name(char *name)
 123 {
 124         int len = strlen(name);
 125         /* name op */
 126         acpigen_emit_byte(0x8);
 127         acpigen_emit_stream(name, len);
 128         return len + 1;
 129 }
 130
 131 int acpigen_write_scope(char *name)
 132 {
 133         int len;
 134         /* scope op */
 135         acpigen_emit_byte(0x10);
 136         len = acpigen_write_len_f();
 137         return len + acpigen_emit_stream(name, strlen(name)) + 1;
 138 }