Small bug somehow slipped there. The method body length is incorrectly computed.
[coreboot.git] / 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_qword(uint64_t data)
101 {
102         /* qword op */
103         acpigen_emit_byte(0xe);
104         acpigen_emit_byte(data & 0xff);
105         acpigen_emit_byte((data >> 8) & 0xff);
106         acpigen_emit_byte((data >> 16) & 0xff);
107         acpigen_emit_byte((data >> 24) & 0xff);
108         acpigen_emit_byte((data >> 32) & 0xff);
109         acpigen_emit_byte((data >> 40) & 0xff);
110         acpigen_emit_byte((data >> 48) & 0xff);
111         acpigen_emit_byte((data >> 56) & 0xff);
112         return 9;
113 }
114
115 int acpigen_write_name_byte(char *name, uint8_t val) {
116         int len;
117         len = acpigen_write_name(name);
118         len += acpigen_write_byte(val);
119         return len;
120 }
121
122 int acpigen_write_name_dword(char *name, uint32_t val) {
123         int len;
124         len = acpigen_write_name(name);
125         len += acpigen_write_dword(val);
126         return len;
127 }
128
129 int acpigen_write_name_qword(char *name, uint64_t val) {
130         int len;
131         len = acpigen_write_name(name);
132         len += acpigen_write_qword(val);
133         return len;
134 }
135
136 int acpigen_emit_stream(char *data, int size) {
137         int i;
138         for (i = 0; i < size; i++) {
139                 acpigen_emit_byte(data[i]);
140         }
141         return size;
142 }
143
144 int acpigen_write_name(char *name)
145 {
146         int len = strlen(name);
147         /* name op */
148         acpigen_emit_byte(0x8);
149         acpigen_emit_stream(name, len);
150         return len + 1;
151 }
152
153 int acpigen_write_scope(char *name)
154 {
155         int len;
156         /* scope op */
157         acpigen_emit_byte(0x10);
158         len = acpigen_write_len_f();
159         return len + acpigen_emit_stream(name, strlen(name)) + 1;
160 }
161
162 int acpigen_write_processor(u8 cpuindex, u32 pblock_addr, u8 pblock_len)
163 {
164 /*
165         Processor (\_PR.CPUcpuindex, cpuindex, pblock_addr, pblock_len)
166         {
167 */
168         char pscope[16];
169         int  len;
170         /* processor op */
171         acpigen_emit_byte(0x5b);
172         acpigen_emit_byte(0x83);
173         len = acpigen_write_len_f();
174
175         sprintf(pscope, "\\._PR_CPU%x", (unsigned int) cpuindex);
176         len += acpigen_emit_stream(pscope, strlen(pscope));
177         acpigen_emit_byte(cpuindex);
178         acpigen_emit_byte(pblock_addr & 0xff);
179         acpigen_emit_byte((pblock_addr >> 8) & 0xff);
180         acpigen_emit_byte((pblock_addr >> 16) & 0xff);
181         acpigen_emit_byte((pblock_addr >> 24) & 0xff);
182         acpigen_emit_byte(pblock_len);
183         return 6  + 2 + len;
184 }
185
186 int acpigen_write_empty_PCT(void)
187 {
188 /*
189     Name (_PCT, Package (0x02)
190     {
191         ResourceTemplate ()
192         {
193             Register (FFixedHW,
194                 0x00,               // Bit Width
195                 0x00,               // Bit Offset
196                 0x0000000000000000, // Address
197                 ,)
198         },
199
200         ResourceTemplate ()
201         {
202             Register (FFixedHW,
203                 0x00,               // Bit Width
204                 0x00,               // Bit Offset
205                 0x0000000000000000, // Address
206                 ,)
207         }
208     })
209 */
210         static char stream[] = {
211                 0x08, 0x5F, 0x50, 0x43, 0x54, 0x12, 0x2C,       /* 00000030    "0._PCT.," */
212                 0x02, 0x11, 0x14, 0x0A, 0x11, 0x82, 0x0C, 0x00, /* 00000038    "........" */
213                 0x7F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 00000040    "........" */
214                 0x00, 0x00, 0x00, 0x00, 0x79, 0x00, 0x11, 0x14, /* 00000048    "....y..." */
215                 0x0A, 0x11, 0x82, 0x0C, 0x00, 0x7F, 0x00, 0x00, /* 00000050    "........" */
216                 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 00000058    "........" */
217                 0x00, 0x79, 0x00
218         };
219         return acpigen_emit_stream(stream, ARRAY_SIZE(stream));
220 }
221
222 /* generates a func with max supported P states */
223 int acpigen_write_PPC(u8 nr)
224 {
225 /*
226     Method (_PPC, 0, NotSerialized)
227     {
228         Return (nr)
229     }
230 */
231         int len;
232         /* method op */
233         acpigen_emit_byte(0x14);
234         len = acpigen_write_len_f();
235         len += acpigen_emit_stream("_PPC", 4);
236         /* no fnarg */
237         acpigen_emit_byte(0x00);
238         /* return */
239         acpigen_emit_byte(0xa4);
240         /* arg */
241         len += acpigen_write_byte(nr);
242         /* add all single bytes */
243         len += 3;
244         acpigen_patch_len(len - 1);
245         return len;
246 }
247
248 int acpigen_write_PSS_package(u32 coreFreq, u32 power, u32 transLat, u32 busmLat,
249                         u32 control, u32 status)
250 {
251         int len;
252         len = acpigen_write_package(6);
253         len += acpigen_write_dword(coreFreq);
254         len += acpigen_write_dword(power);
255         len += acpigen_write_dword(transLat);
256         len += acpigen_write_dword(busmLat);
257         len += acpigen_write_dword(control);
258         len += acpigen_write_dword(status);
259         //pkglen without the len opcode
260         acpigen_patch_len(len - 1);
261         return len;
262 }