1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include "qemu/osdep.h"
26
27#include <sys/socket.h>
28#include <netinet/in.h>
29#include <netinet/ip.h>
30#include <netinet/tcp.h>
31
32
33#include "libqtest-single.h"
34
35#define IPMI_IRQ 5
36
37#define IPMI_BT_BASE 0xe4
38
39#define IPMI_BT_CTLREG_CLR_WR_PTR 0
40#define IPMI_BT_CTLREG_CLR_RD_PTR 1
41#define IPMI_BT_CTLREG_H2B_ATN 2
42#define IPMI_BT_CTLREG_B2H_ATN 3
43#define IPMI_BT_CTLREG_SMS_ATN 4
44#define IPMI_BT_CTLREG_H_BUSY 6
45#define IPMI_BT_CTLREG_B_BUSY 7
46
47#define IPMI_BT_CTLREG_GET(b) ((bt_get_ctrlreg() >> (b)) & 1)
48#define IPMI_BT_CTLREG_GET_H2B_ATN() IPMI_BT_CTLREG_GET(IPMI_BT_CTLREG_H2B_ATN)
49#define IPMI_BT_CTLREG_GET_B2H_ATN() IPMI_BT_CTLREG_GET(IPMI_BT_CTLREG_B2H_ATN)
50#define IPMI_BT_CTLREG_GET_SMS_ATN() IPMI_BT_CTLREG_GET(IPMI_BT_CTLREG_SMS_ATN)
51#define IPMI_BT_CTLREG_GET_H_BUSY() IPMI_BT_CTLREG_GET(IPMI_BT_CTLREG_H_BUSY)
52#define IPMI_BT_CTLREG_GET_B_BUSY() IPMI_BT_CTLREG_GET(IPMI_BT_CTLREG_B_BUSY)
53
54#define IPMI_BT_CTLREG_SET(b) bt_write_ctrlreg(1 << (b))
55#define IPMI_BT_CTLREG_SET_CLR_WR_PTR() IPMI_BT_CTLREG_SET( \
56 IPMI_BT_CTLREG_CLR_WR_PTR)
57#define IPMI_BT_CTLREG_SET_CLR_RD_PTR() IPMI_BT_CTLREG_SET( \
58 IPMI_BT_CTLREG_CLR_RD_PTR)
59#define IPMI_BT_CTLREG_SET_H2B_ATN() IPMI_BT_CTLREG_SET(IPMI_BT_CTLREG_H2B_ATN)
60#define IPMI_BT_CTLREG_SET_B2H_ATN() IPMI_BT_CTLREG_SET(IPMI_BT_CTLREG_B2H_ATN)
61#define IPMI_BT_CTLREG_SET_SMS_ATN() IPMI_BT_CTLREG_SET(IPMI_BT_CTLREG_SMS_ATN)
62#define IPMI_BT_CTLREG_SET_H_BUSY() IPMI_BT_CTLREG_SET(IPMI_BT_CTLREG_H_BUSY)
63
64static int bt_ints_enabled;
65
66static uint8_t bt_get_ctrlreg(void)
67{
68 return inb(IPMI_BT_BASE);
69}
70
71static void bt_write_ctrlreg(uint8_t val)
72{
73 outb(IPMI_BT_BASE, val);
74}
75
76static uint8_t bt_get_buf(void)
77{
78 return inb(IPMI_BT_BASE + 1);
79}
80
81static void bt_write_buf(uint8_t val)
82{
83 outb(IPMI_BT_BASE + 1, val);
84}
85
86static uint8_t bt_get_irqreg(void)
87{
88 return inb(IPMI_BT_BASE + 2);
89}
90
91static void bt_write_irqreg(uint8_t val)
92{
93 outb(IPMI_BT_BASE + 2, val);
94}
95
96static void bt_wait_b_busy(void)
97{
98 unsigned int count = 1000;
99 while (IPMI_BT_CTLREG_GET_B_BUSY() != 0) {
100 --count;
101 g_assert(count != 0);
102 usleep(100);
103 }
104}
105
106static void bt_wait_b2h_atn(void)
107{
108 unsigned int count = 1000;
109 while (IPMI_BT_CTLREG_GET_B2H_ATN() == 0) {
110 --count;
111 g_assert(count != 0);
112 usleep(100);
113 }
114}
115
116
117static int emu_lfd;
118static int emu_fd;
119static in_port_t emu_port;
120static uint8_t inbuf[100];
121static unsigned int inbuf_len;
122static unsigned int inbuf_pos;
123static int last_was_aa;
124
125static void read_emu_data(void)
126{
127 fd_set readfds;
128 int rv;
129 struct timeval tv;
130
131 FD_ZERO(&readfds);
132 FD_SET(emu_fd, &readfds);
133 tv.tv_sec = 10;
134 tv.tv_usec = 0;
135 rv = select(emu_fd + 1, &readfds, NULL, NULL, &tv);
136 if (rv == -1) {
137 perror("select");
138 }
139 g_assert(rv == 1);
140 rv = read(emu_fd, inbuf, sizeof(inbuf));
141 if (rv == -1) {
142 perror("read");
143 }
144 g_assert(rv > 0);
145 inbuf_len = rv;
146 inbuf_pos = 0;
147}
148
149static void write_emu_msg(uint8_t *msg, unsigned int len)
150{
151 int rv;
152
153#ifdef DEBUG_TEST
154 {
155 unsigned int i;
156 printf("sending:");
157 for (i = 0; i < len; i++) {
158 printf(" %2.2x", msg[i]);
159 }
160 printf("\n");
161 }
162#endif
163 rv = write(emu_fd, msg, len);
164 g_assert(rv == len);
165}
166
167static void get_emu_msg(uint8_t *msg, unsigned int *len)
168{
169 unsigned int outpos = 0;
170
171 for (;;) {
172 while (inbuf_pos < inbuf_len) {
173 uint8_t ch = inbuf[inbuf_pos++];
174
175 g_assert(outpos < *len);
176 if (last_was_aa) {
177 assert(ch & 0x10);
178 msg[outpos++] = ch & ~0x10;
179 last_was_aa = 0;
180 } else if (ch == 0xaa) {
181 last_was_aa = 1;
182 } else {
183 msg[outpos++] = ch;
184 if ((ch == 0xa0) || (ch == 0xa1)) {
185
186 *len = outpos;
187 goto done;
188 }
189 }
190 }
191 read_emu_data();
192 }
193 done:
194#ifdef DEBUG_TEST
195 {
196 unsigned int i;
197 printf("Msg:");
198 for (i = 0; i < outpos; i++) {
199 printf(" %2.2x", msg[i]);
200 }
201 printf("\n");
202 }
203#endif
204 return;
205}
206
207static uint8_t
208ipmb_checksum(const unsigned char *data, int size, unsigned char start)
209{
210 unsigned char csum = start;
211
212 for (; size > 0; size--, data++) {
213 csum += *data;
214 }
215 return csum;
216}
217
218static uint8_t get_dev_id_cmd[] = { 0x18, 0x01 };
219static uint8_t get_dev_id_rsp[] = { 0x1c, 0x01, 0x00, 0x20, 0x00, 0x00, 0x00,
220 0x02, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00 };
221
222static uint8_t set_bmc_globals_cmd[] = { 0x18, 0x2e, 0x0f };
223static uint8_t set_bmc_globals_rsp[] = { 0x1c, 0x2e, 0x00 };
224static uint8_t enable_irq_cmd[] = { 0x05, 0xa1 };
225
226static void emu_msg_handler(void)
227{
228 uint8_t msg[100];
229 unsigned int msg_len = sizeof(msg);
230
231 get_emu_msg(msg, &msg_len);
232 g_assert(msg_len >= 5);
233 g_assert(msg[msg_len - 1] == 0xa0);
234 msg_len--;
235 g_assert(ipmb_checksum(msg, msg_len, 0) == 0);
236 msg_len--;
237 if ((msg[1] == get_dev_id_cmd[0]) && (msg[2] == get_dev_id_cmd[1])) {
238 memcpy(msg + 1, get_dev_id_rsp, sizeof(get_dev_id_rsp));
239 msg_len = sizeof(get_dev_id_rsp) + 1;
240 msg[msg_len] = -ipmb_checksum(msg, msg_len, 0);
241 msg_len++;
242 msg[msg_len++] = 0xa0;
243 write_emu_msg(msg, msg_len);
244 } else if ((msg[1] == set_bmc_globals_cmd[0]) &&
245 (msg[2] == set_bmc_globals_cmd[1])) {
246 write_emu_msg(enable_irq_cmd, sizeof(enable_irq_cmd));
247 memcpy(msg + 1, set_bmc_globals_rsp, sizeof(set_bmc_globals_rsp));
248 msg_len = sizeof(set_bmc_globals_rsp) + 1;
249 msg[msg_len] = -ipmb_checksum(msg, msg_len, 0);
250 msg_len++;
251 msg[msg_len++] = 0xa0;
252 write_emu_msg(msg, msg_len);
253 } else {
254 g_assert(0);
255 }
256}
257
258static void bt_cmd(uint8_t *cmd, unsigned int cmd_len,
259 uint8_t *rsp, unsigned int *rsp_len)
260{
261 unsigned int i, len, j = 0;
262 uint8_t seq = 5;
263
264
265 g_assert(bt_get_ctrlreg() == 0);
266
267 bt_wait_b_busy();
268 IPMI_BT_CTLREG_SET_CLR_WR_PTR();
269 bt_write_buf(cmd_len + 1);
270 bt_write_buf(cmd[0]);
271 bt_write_buf(seq);
272 for (i = 1; i < cmd_len; i++) {
273 bt_write_buf(cmd[i]);
274 }
275 IPMI_BT_CTLREG_SET_H2B_ATN();
276
277 emu_msg_handler();
278
279 bt_wait_b2h_atn();
280 if (bt_ints_enabled) {
281 g_assert((bt_get_irqreg() & 0x02) == 0x02);
282 g_assert(get_irq(IPMI_IRQ));
283 bt_write_irqreg(0x03);
284 } else {
285 g_assert(!get_irq(IPMI_IRQ));
286 }
287 IPMI_BT_CTLREG_SET_H_BUSY();
288 IPMI_BT_CTLREG_SET_B2H_ATN();
289 IPMI_BT_CTLREG_SET_CLR_RD_PTR();
290 len = bt_get_buf();
291 g_assert(len >= 4);
292 rsp[0] = bt_get_buf();
293 assert(bt_get_buf() == seq);
294 len--;
295 for (j = 1; j < len; j++) {
296 rsp[j] = bt_get_buf();
297 }
298 IPMI_BT_CTLREG_SET_H_BUSY();
299 *rsp_len = j;
300}
301
302
303
304
305
306static void test_connect(void)
307{
308 fd_set readfds;
309 int rv;
310 int val;
311 struct timeval tv;
312 uint8_t msg[100];
313 unsigned int msglen;
314 static uint8_t exp1[] = { 0xff, 0x01, 0xa1 };
315 static uint8_t exp2[] = { 0x08, 0x3f, 0xa1 };
316
317 FD_ZERO(&readfds);
318 FD_SET(emu_lfd, &readfds);
319 tv.tv_sec = 10;
320 tv.tv_usec = 0;
321 rv = select(emu_lfd + 1, &readfds, NULL, NULL, &tv);
322 g_assert(rv == 1);
323 emu_fd = accept(emu_lfd, NULL, 0);
324 if (emu_fd < 0) {
325 perror("accept");
326 }
327 g_assert(emu_fd >= 0);
328
329 val = 1;
330 rv = setsockopt(emu_fd, IPPROTO_TCP, TCP_NODELAY, &val, sizeof(val));
331 g_assert(rv != -1);
332
333
334 write_emu_msg(exp1, sizeof(exp1));
335
336
337 msglen = sizeof(msg);
338 get_emu_msg(msg, &msglen);
339 g_assert(msglen == sizeof(exp1));
340 g_assert(memcmp(msg, exp1, msglen) == 0);
341 msglen = sizeof(msg);
342 get_emu_msg(msg, &msglen);
343 g_assert(msglen == sizeof(exp2));
344 g_assert(memcmp(msg, exp2, msglen) == 0);
345}
346
347
348
349
350static void test_bt_base(void)
351{
352 uint8_t rsp[20];
353 unsigned int rsplen = sizeof(rsp);
354
355 bt_cmd(get_dev_id_cmd, sizeof(get_dev_id_cmd), rsp, &rsplen);
356 g_assert(rsplen == sizeof(get_dev_id_rsp));
357 g_assert(memcmp(get_dev_id_rsp, rsp, rsplen) == 0);
358}
359
360
361
362
363static void test_enable_irq(void)
364{
365 uint8_t rsp[20];
366 unsigned int rsplen = sizeof(rsp);
367
368 bt_cmd(set_bmc_globals_cmd, sizeof(set_bmc_globals_cmd), rsp, &rsplen);
369 g_assert(rsplen == sizeof(set_bmc_globals_rsp));
370 g_assert(memcmp(set_bmc_globals_rsp, rsp, rsplen) == 0);
371 bt_write_irqreg(0x01);
372 bt_ints_enabled = 1;
373}
374
375
376
377
378static void open_socket(void)
379{
380 struct sockaddr_in myaddr = {};
381 socklen_t addrlen;
382
383 myaddr.sin_family = AF_INET;
384 myaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
385 myaddr.sin_port = 0;
386 emu_lfd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
387 if (emu_lfd == -1) {
388 perror("socket");
389 exit(1);
390 }
391 if (bind(emu_lfd, (struct sockaddr *) &myaddr, sizeof(myaddr)) == -1) {
392 perror("bind");
393 exit(1);
394 }
395 addrlen = sizeof(myaddr);
396 if (getsockname(emu_lfd, (struct sockaddr *) &myaddr , &addrlen) == -1) {
397 perror("getsockname");
398 exit(1);
399 }
400 emu_port = ntohs(myaddr.sin_port);
401 assert(listen(emu_lfd, 1) != -1);
402}
403
404int main(int argc, char **argv)
405{
406 int ret;
407
408 open_socket();
409
410
411 g_test_init(&argc, &argv, NULL);
412
413 global_qtest = qtest_initf(
414 " -chardev socket,id=ipmi0,host=localhost,port=%d,reconnect=10"
415 " -device ipmi-bmc-extern,chardev=ipmi0,id=bmc0"
416 " -device isa-ipmi-bt,bmc=bmc0", emu_port);
417 qtest_irq_intercept_in(global_qtest, "ioapic");
418 qtest_add_func("/ipmi/extern/connect", test_connect);
419 qtest_add_func("/ipmi/extern/bt_base", test_bt_base);
420 qtest_add_func("/ipmi/extern/bt_enable_irq", test_enable_irq);
421 qtest_add_func("/ipmi/extern/bt_base_irq", test_bt_base);
422 ret = g_test_run();
423 qtest_quit(global_qtest);
424
425 return ret;
426}
427
