1 /*
2 * QEMU LSI SAS1068 Host Bus Adapter emulation - configuration pages
3 *
4 * Copyright (c) 2016 Red Hat, Inc.
5 *
6 * Author: Paolo Bonzini
7 *
8 * This library is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU Lesser General Public
10 * License as published by the Free Software Foundation; either
11 * version 2.1 of the License, or (at your option) any later version.
12 *
13 * This library is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * Lesser General Public License for more details.
17 */
18 #include "qemu/osdep.h"
19 #include "hw/pci/pci.h"
20 #include "hw/scsi/scsi.h"
21
22 #include "mptsas.h"
23 #include "mpi.h"
24 #include "trace.h"
25
26 /* Generic functions for marshaling and unmarshaling. */
27
28 #define repl1(x) x
29 #define repl2(x) x x
30 #define repl3(x) x x x
31 #define repl4(x) x x x x
32 #define repl5(x) x x x x x
33 #define repl6(x) x x x x x x
34 #define repl7(x) x x x x x x x
35 #define repl8(x) x x x x x x x x
36
37 #define repl(n, x) glue(repl, n)(x)
38
39 typedef union PackValue {
40 uint64_t ll;
41 char *str;
42 } PackValue;
43
vfill(uint8_t * data,size_t size,const char * fmt,va_list ap)44 static size_t vfill(uint8_t *data, size_t size, const char *fmt, va_list ap)
45 {
46 size_t ofs;
47 PackValue val;
48 const char *p;
49
50 ofs = 0;
51 p = fmt;
52 while (*p) {
53 memset(&val, 0, sizeof(val));
54 switch (*p) {
55 case '*':
56 p++;
57 break;
58 case 'b':
59 case 'w':
60 case 'l':
61 val.ll = va_arg(ap, int);
62 break;
63 case 'q':
64 val.ll = va_arg(ap, int64_t);
65 break;
66 case 's':
67 val.str = va_arg(ap, void *);
68 break;
69 }
70 switch (*p++) {
71 case 'b':
72 if (data) {
73 stb_p(data + ofs, val.ll);
74 }
75 ofs++;
76 break;
77 case 'w':
78 if (data) {
79 stw_le_p(data + ofs, val.ll);
80 }
81 ofs += 2;
82 break;
83 case 'l':
84 if (data) {
85 stl_le_p(data + ofs, val.ll);
86 }
87 ofs += 4;
88 break;
89 case 'q':
90 if (data) {
91 stq_le_p(data + ofs, val.ll);
92 }
93 ofs += 8;
94 break;
95 case 's':
96 {
97 int cnt = atoi(p);
98 if (data) {
99 if (val.str) {
100 strncpy((void *)data + ofs, val.str, cnt);
101 } else {
102 memset((void *)data + ofs, 0, cnt);
103 }
104 }
105 ofs += cnt;
106 break;
107 }
108 }
109 }
110
111 return ofs;
112 }
113
vpack(uint8_t ** p_data,const char * fmt,va_list ap1)114 static size_t vpack(uint8_t **p_data, const char *fmt, va_list ap1)
115 {
116 size_t size = 0;
117 uint8_t *data = NULL;
118
119 if (p_data) {
120 va_list ap2;
121
122 va_copy(ap2, ap1);
123 size = vfill(NULL, 0, fmt, ap2);
124 *p_data = data = g_malloc(size);
125 va_end(ap2);
126 }
127 return vfill(data, size, fmt, ap1);
128 }
129
fill(uint8_t * data,size_t size,const char * fmt,...)130 static size_t fill(uint8_t *data, size_t size, const char *fmt, ...)
131 {
132 va_list ap;
133 size_t ret;
134
135 va_start(ap, fmt);
136 ret = vfill(data, size, fmt, ap);
137 va_end(ap);
138
139 return ret;
140 }
141
142 /* Functions to build the page header and fill in the length, always used
143 * through the macros.
144 */
145
146 #define MPTSAS_CONFIG_PACK(number, type, version, fmt, ...) \
147 mptsas_config_pack(data, "b*bbb" fmt, version, number, type, \
148 ## __VA_ARGS__)
149
mptsas_config_pack(uint8_t ** data,const char * fmt,...)150 static size_t mptsas_config_pack(uint8_t **data, const char *fmt, ...)
151 {
152 va_list ap;
153 size_t ret;
154
155 va_start(ap, fmt);
156 ret = vpack(data, fmt, ap);
157 va_end(ap);
158
159 if (data) {
160 assert(ret / 4 < 256 && (ret % 4) == 0);
161 stb_p(*data + 1, ret / 4);
162 }
163 return ret;
164 }
165
166 #define MPTSAS_CONFIG_PACK_EXT(number, type, version, fmt, ...) \
167 mptsas_config_pack_ext(data, "b*bbb*wb*b" fmt, version, number, \
168 MPI_CONFIG_PAGETYPE_EXTENDED, type, ## __VA_ARGS__)
169
mptsas_config_pack_ext(uint8_t ** data,const char * fmt,...)170 static size_t mptsas_config_pack_ext(uint8_t **data, const char *fmt, ...)
171 {
172 va_list ap;
173 size_t ret;
174
175 va_start(ap, fmt);
176 ret = vpack(data, fmt, ap);
177 va_end(ap);
178
179 if (data) {
180 assert(ret < 65536 && (ret % 4) == 0);
181 stw_le_p(*data + 4, ret / 4);
182 }
183 return ret;
184 }
185
186 /* Manufacturing pages */
187
188 static
mptsas_config_manufacturing_0(MPTSASState * s,uint8_t ** data,int address)189 size_t mptsas_config_manufacturing_0(MPTSASState *s, uint8_t **data, int address)
190 {
191 return MPTSAS_CONFIG_PACK(0, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
192 "s16s8s16s16s16",
193 "QEMU MPT Fusion",
194 "2.5",
195 "QEMU MPT Fusion",
196 "QEMU",
197 "0000111122223333");
198 }
199
200 static
mptsas_config_manufacturing_1(MPTSASState * s,uint8_t ** data,int address)201 size_t mptsas_config_manufacturing_1(MPTSASState *s, uint8_t **data, int address)
202 {
203 /* VPD - all zeros */
204 return MPTSAS_CONFIG_PACK(1, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
205 "*s256");
206 }
207
208 static
mptsas_config_manufacturing_2(MPTSASState * s,uint8_t ** data,int address)209 size_t mptsas_config_manufacturing_2(MPTSASState *s, uint8_t **data, int address)
210 {
211 PCIDeviceClass *pcic = PCI_DEVICE_GET_CLASS(s);
212 return MPTSAS_CONFIG_PACK(2, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
213 "wb*b*l",
214 pcic->device_id, pcic->revision);
215 }
216
217 static
mptsas_config_manufacturing_3(MPTSASState * s,uint8_t ** data,int address)218 size_t mptsas_config_manufacturing_3(MPTSASState *s, uint8_t **data, int address)
219 {
220 PCIDeviceClass *pcic = PCI_DEVICE_GET_CLASS(s);
221 return MPTSAS_CONFIG_PACK(3, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
222 "wb*b*l",
223 pcic->device_id, pcic->revision);
224 }
225
226 static
mptsas_config_manufacturing_4(MPTSASState * s,uint8_t ** data,int address)227 size_t mptsas_config_manufacturing_4(MPTSASState *s, uint8_t **data, int address)
228 {
229 /* All zeros */
230 return MPTSAS_CONFIG_PACK(4, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x05,
231 "*l*b*b*b*b*b*b*w*s56*l*l*l*l*l*l"
232 "*b*b*w*b*b*w*l*l");
233 }
234
235 static
mptsas_config_manufacturing_5(MPTSASState * s,uint8_t ** data,int address)236 size_t mptsas_config_manufacturing_5(MPTSASState *s, uint8_t **data, int address)
237 {
238 return MPTSAS_CONFIG_PACK(5, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x02,
239 "q*b*b*w*l*l", s->sas_addr);
240 }
241
242 static
mptsas_config_manufacturing_6(MPTSASState * s,uint8_t ** data,int address)243 size_t mptsas_config_manufacturing_6(MPTSASState *s, uint8_t **data, int address)
244 {
245 return MPTSAS_CONFIG_PACK(6, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
246 "*l");
247 }
248
249 static
mptsas_config_manufacturing_7(MPTSASState * s,uint8_t ** data,int address)250 size_t mptsas_config_manufacturing_7(MPTSASState *s, uint8_t **data, int address)
251 {
252 return MPTSAS_CONFIG_PACK(7, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
253 "*l*l*l*s16*b*b*w", MPTSAS_NUM_PORTS);
254 }
255
256 static
mptsas_config_manufacturing_8(MPTSASState * s,uint8_t ** data,int address)257 size_t mptsas_config_manufacturing_8(MPTSASState *s, uint8_t **data, int address)
258 {
259 return MPTSAS_CONFIG_PACK(8, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
260 "*l");
261 }
262
263 static
mptsas_config_manufacturing_9(MPTSASState * s,uint8_t ** data,int address)264 size_t mptsas_config_manufacturing_9(MPTSASState *s, uint8_t **data, int address)
265 {
266 return MPTSAS_CONFIG_PACK(9, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
267 "*l");
268 }
269
270 static
mptsas_config_manufacturing_10(MPTSASState * s,uint8_t ** data,int address)271 size_t mptsas_config_manufacturing_10(MPTSASState *s, uint8_t **data, int address)
272 {
273 return MPTSAS_CONFIG_PACK(10, MPI_CONFIG_PAGETYPE_MANUFACTURING, 0x00,
274 "*l");
275 }
276
277 /* I/O unit pages */
278
279 static
mptsas_config_io_unit_0(MPTSASState * s,uint8_t ** data,int address)280 size_t mptsas_config_io_unit_0(MPTSASState *s, uint8_t **data, int address)
281 {
282 PCIDevice *pci = PCI_DEVICE(s);
283 uint64_t unique_value = 0x53504D554D4551LL; /* "QEMUMPTx" */
284
285 unique_value |= (uint64_t)pci->devfn << 56;
286 return MPTSAS_CONFIG_PACK(0, MPI_CONFIG_PAGETYPE_IO_UNIT, 0x00,
287 "q", unique_value);
288 }
289
290 static
mptsas_config_io_unit_1(MPTSASState * s,uint8_t ** data,int address)291 size_t mptsas_config_io_unit_1(MPTSASState *s, uint8_t **data, int address)
292 {
293 return MPTSAS_CONFIG_PACK(1, MPI_CONFIG_PAGETYPE_IO_UNIT, 0x02, "l",
294 0x41 /* single function, RAID disabled */ );
295 }
296
297 static
mptsas_config_io_unit_2(MPTSASState * s,uint8_t ** data,int address)298 size_t mptsas_config_io_unit_2(MPTSASState *s, uint8_t **data, int address)
299 {
300 PCIDevice *pci = PCI_DEVICE(s);
301 uint8_t devfn = pci->devfn;
302 return MPTSAS_CONFIG_PACK(2, MPI_CONFIG_PAGETYPE_IO_UNIT, 0x02,
303 "llbbw*b*b*w*b*b*w*b*b*w*l",
304 0, 0x100, 0 /* pci bus? */, devfn, 0);
305 }
306
307 static
mptsas_config_io_unit_3(MPTSASState * s,uint8_t ** data,int address)308 size_t mptsas_config_io_unit_3(MPTSASState *s, uint8_t **data, int address)
309 {
310 return MPTSAS_CONFIG_PACK(3, MPI_CONFIG_PAGETYPE_IO_UNIT, 0x01,
311 "*b*b*w*l");
312 }
313
314 static
mptsas_config_io_unit_4(MPTSASState * s,uint8_t ** data,int address)315 size_t mptsas_config_io_unit_4(MPTSASState *s, uint8_t **data, int address)
316 {
317 return MPTSAS_CONFIG_PACK(4, MPI_CONFIG_PAGETYPE_IO_UNIT, 0x00, "*l*l*q");
318 }
319
320 /* I/O controller pages */
321
322 static
mptsas_config_ioc_0(MPTSASState * s,uint8_t ** data,int address)323 size_t mptsas_config_ioc_0(MPTSASState *s, uint8_t **data, int address)
324 {
325 PCIDeviceClass *pcic = PCI_DEVICE_GET_CLASS(s);
326
327 return MPTSAS_CONFIG_PACK(0, MPI_CONFIG_PAGETYPE_IOC, 0x01,
328 "*l*lwwb*b*b*blww",
329 pcic->vendor_id, pcic->device_id, pcic->revision,
330 pcic->class_id, pcic->subsystem_vendor_id,
331 pcic->subsystem_id);
332 }
333
334 static
mptsas_config_ioc_1(MPTSASState * s,uint8_t ** data,int address)335 size_t mptsas_config_ioc_1(MPTSASState *s, uint8_t **data, int address)
336 {
337 return MPTSAS_CONFIG_PACK(1, MPI_CONFIG_PAGETYPE_IOC, 0x03,
338 "*l*l*b*b*b*b");
339 }
340
341 static
mptsas_config_ioc_2(MPTSASState * s,uint8_t ** data,int address)342 size_t mptsas_config_ioc_2(MPTSASState *s, uint8_t **data, int address)
343 {
344 return MPTSAS_CONFIG_PACK(2, MPI_CONFIG_PAGETYPE_IOC, 0x04,
345 "*l*b*b*b*b");
346 }
347
348 static
mptsas_config_ioc_3(MPTSASState * s,uint8_t ** data,int address)349 size_t mptsas_config_ioc_3(MPTSASState *s, uint8_t **data, int address)
350 {
351 return MPTSAS_CONFIG_PACK(3, MPI_CONFIG_PAGETYPE_IOC, 0x00,
352 "*b*b*w");
353 }
354
355 static
mptsas_config_ioc_4(MPTSASState * s,uint8_t ** data,int address)356 size_t mptsas_config_ioc_4(MPTSASState *s, uint8_t **data, int address)
357 {
358 return MPTSAS_CONFIG_PACK(4, MPI_CONFIG_PAGETYPE_IOC, 0x00,
359 "*b*b*w");
360 }
361
362 static
mptsas_config_ioc_5(MPTSASState * s,uint8_t ** data,int address)363 size_t mptsas_config_ioc_5(MPTSASState *s, uint8_t **data, int address)
364 {
365 return MPTSAS_CONFIG_PACK(5, MPI_CONFIG_PAGETYPE_IOC, 0x00,
366 "*l*b*b*w");
367 }
368
369 static
mptsas_config_ioc_6(MPTSASState * s,uint8_t ** data,int address)370 size_t mptsas_config_ioc_6(MPTSASState *s, uint8_t **data, int address)
371 {
372 return MPTSAS_CONFIG_PACK(6, MPI_CONFIG_PAGETYPE_IOC, 0x01,
373 "*l*b*b*b*b*b*b*b*b*b*b*w*l*l*l*l*b*b*w"
374 "*w*w*w*w*l*l*l");
375 }
376
377 /* SAS I/O unit pages (extended) */
378
379 #define MPTSAS_CONFIG_SAS_IO_UNIT_0_SIZE 16
380
381 #define MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION 0x02
382 #define MPI_SAS_IOUNIT0_RATE_1_5 0x08
383 #define MPI_SAS_IOUNIT0_RATE_3_0 0x09
384
385 #define MPI_SAS_DEVICE_INFO_NO_DEVICE 0x00000000
386 #define MPI_SAS_DEVICE_INFO_END_DEVICE 0x00000001
387 #define MPI_SAS_DEVICE_INFO_SSP_TARGET 0x00000400
388
389 #define MPI_SAS_DEVICE0_ASTATUS_NO_ERRORS 0x00
390
391 #define MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT 0x0001
392 #define MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED 0x0002
393 #define MPI_SAS_DEVICE0_FLAGS_MAPPING_PERSISTENT 0x0004
394
395
396
mptsas_phy_get_device(MPTSASState * s,int i,int * phy_handle,int * dev_handle)397 static SCSIDevice *mptsas_phy_get_device(MPTSASState *s, int i,
398 int *phy_handle, int *dev_handle)
399 {
400 SCSIDevice *d = scsi_device_find(&s->bus, 0, i, 0);
401
402 if (phy_handle) {
403 *phy_handle = i + 1;
404 }
405 if (dev_handle) {
406 *dev_handle = d ? i + 1 + MPTSAS_NUM_PORTS : 0;
407 }
408 return d;
409 }
410
411 static
mptsas_config_sas_io_unit_0(MPTSASState * s,uint8_t ** data,int address)412 size_t mptsas_config_sas_io_unit_0(MPTSASState *s, uint8_t **data, int address)
413 {
414 size_t size = MPTSAS_CONFIG_PACK_EXT(0, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT, 0x04,
415 "*w*wb*b*w"
416 repl(MPTSAS_NUM_PORTS, "*s16"),
417 MPTSAS_NUM_PORTS);
418
419 if (data) {
420 size_t ofs = size - MPTSAS_NUM_PORTS * MPTSAS_CONFIG_SAS_IO_UNIT_0_SIZE;
421 int i;
422
423 for (i = 0; i < MPTSAS_NUM_PORTS; i++) {
424 int phy_handle, dev_handle;
425 SCSIDevice *dev = mptsas_phy_get_device(s, i, &phy_handle, &dev_handle);
426
427 fill(*data + ofs, MPTSAS_CONFIG_SAS_IO_UNIT_0_SIZE,
428 "bbbblwwl", i, 0, 0,
429 (dev
430 ? MPI_SAS_IOUNIT0_RATE_3_0
431 : MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION),
432 (dev
433 ? MPI_SAS_DEVICE_INFO_END_DEVICE | MPI_SAS_DEVICE_INFO_SSP_TARGET
434 : MPI_SAS_DEVICE_INFO_NO_DEVICE),
435 dev_handle,
436 dev_handle,
437 0);
438 ofs += MPTSAS_CONFIG_SAS_IO_UNIT_0_SIZE;
439 }
440 assert(ofs == size);
441 }
442 return size;
443 }
444
445 #define MPTSAS_CONFIG_SAS_IO_UNIT_1_SIZE 12
446
447 static
mptsas_config_sas_io_unit_1(MPTSASState * s,uint8_t ** data,int address)448 size_t mptsas_config_sas_io_unit_1(MPTSASState *s, uint8_t **data, int address)
449 {
450 size_t size = MPTSAS_CONFIG_PACK_EXT(1, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT, 0x07,
451 "*w*w*w*wb*b*b*b"
452 repl(MPTSAS_NUM_PORTS, "*s12"),
453 MPTSAS_NUM_PORTS);
454
455 if (data) {
456 size_t ofs = size - MPTSAS_NUM_PORTS * MPTSAS_CONFIG_SAS_IO_UNIT_1_SIZE;
457 int i;
458
459 for (i = 0; i < MPTSAS_NUM_PORTS; i++) {
460 SCSIDevice *dev = mptsas_phy_get_device(s, i, NULL, NULL);
461 fill(*data + ofs, MPTSAS_CONFIG_SAS_IO_UNIT_1_SIZE,
462 "bbbblww", i, 0, 0,
463 (MPI_SAS_IOUNIT0_RATE_3_0 << 4) | MPI_SAS_IOUNIT0_RATE_1_5,
464 (dev
465 ? MPI_SAS_DEVICE_INFO_END_DEVICE | MPI_SAS_DEVICE_INFO_SSP_TARGET
466 : MPI_SAS_DEVICE_INFO_NO_DEVICE),
467 0, 0);
468 ofs += MPTSAS_CONFIG_SAS_IO_UNIT_1_SIZE;
469 }
470 assert(ofs == size);
471 }
472 return size;
473 }
474
475 static
mptsas_config_sas_io_unit_2(MPTSASState * s,uint8_t ** data,int address)476 size_t mptsas_config_sas_io_unit_2(MPTSASState *s, uint8_t **data, int address)
477 {
478 return MPTSAS_CONFIG_PACK_EXT(2, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT, 0x06,
479 "*b*b*w*w*w*b*b*w");
480 }
481
482 static
mptsas_config_sas_io_unit_3(MPTSASState * s,uint8_t ** data,int address)483 size_t mptsas_config_sas_io_unit_3(MPTSASState *s, uint8_t **data, int address)
484 {
485 return MPTSAS_CONFIG_PACK_EXT(3, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT, 0x06,
486 "*l*l*l*l*l*l*l*l*l");
487 }
488
489 /* SAS PHY pages (extended) */
490
mptsas_phy_addr_get(MPTSASState * s,int address)491 static int mptsas_phy_addr_get(MPTSASState *s, int address)
492 {
493 int i;
494 if ((address >> MPI_SAS_PHY_PGAD_FORM_SHIFT) == 0) {
495 i = address & 255;
496 } else if ((address >> MPI_SAS_PHY_PGAD_FORM_SHIFT) == 1) {
497 i = address & 65535;
498 } else {
499 return -EINVAL;
500 }
501
502 if (i >= MPTSAS_NUM_PORTS) {
503 return -EINVAL;
504 }
505
506 return i;
507 }
508
509 static
mptsas_config_phy_0(MPTSASState * s,uint8_t ** data,int address)510 size_t mptsas_config_phy_0(MPTSASState *s, uint8_t **data, int address)
511 {
512 int phy_handle = -1;
513 int dev_handle = -1;
514 int i = mptsas_phy_addr_get(s, address);
515 SCSIDevice *dev;
516
517 if (i < 0) {
518 trace_mptsas_config_sas_phy(s, address, i, phy_handle, dev_handle, 0);
519 return i;
520 }
521
522 dev = mptsas_phy_get_device(s, i, &phy_handle, &dev_handle);
523 trace_mptsas_config_sas_phy(s, address, i, phy_handle, dev_handle, 0);
524
525 return MPTSAS_CONFIG_PACK_EXT(0, MPI_CONFIG_EXTPAGETYPE_SAS_PHY, 0x01,
526 "w*wqwb*blbb*b*b*l",
527 dev_handle, s->sas_addr, dev_handle, i,
528 (dev
529 ? MPI_SAS_DEVICE_INFO_END_DEVICE /* | MPI_SAS_DEVICE_INFO_SSP_TARGET?? */
530 : MPI_SAS_DEVICE_INFO_NO_DEVICE),
531 (MPI_SAS_IOUNIT0_RATE_3_0 << 4) | MPI_SAS_IOUNIT0_RATE_1_5,
532 (MPI_SAS_IOUNIT0_RATE_3_0 << 4) | MPI_SAS_IOUNIT0_RATE_1_5);
533 }
534
535 static
mptsas_config_phy_1(MPTSASState * s,uint8_t ** data,int address)536 size_t mptsas_config_phy_1(MPTSASState *s, uint8_t **data, int address)
537 {
538 int phy_handle = -1;
539 int dev_handle = -1;
540 int i = mptsas_phy_addr_get(s, address);
541
542 if (i < 0) {
543 trace_mptsas_config_sas_phy(s, address, i, phy_handle, dev_handle, 1);
544 return i;
545 }
546
547 (void) mptsas_phy_get_device(s, i, &phy_handle, &dev_handle);
548 trace_mptsas_config_sas_phy(s, address, i, phy_handle, dev_handle, 1);
549
550 return MPTSAS_CONFIG_PACK_EXT(1, MPI_CONFIG_EXTPAGETYPE_SAS_PHY, 0x01,
551 "*l*l*l*l*l");
552 }
553
554 /* SAS device pages (extended) */
555
mptsas_device_addr_get(MPTSASState * s,int address)556 static int mptsas_device_addr_get(MPTSASState *s, int address)
557 {
558 uint32_t handle, i;
559 uint32_t form = address >> MPI_SAS_PHY_PGAD_FORM_SHIFT;
560 if (form == MPI_SAS_DEVICE_PGAD_FORM_GET_NEXT_HANDLE) {
561 handle = address & MPI_SAS_DEVICE_PGAD_GNH_HANDLE_MASK;
562 do {
563 if (handle == 65535) {
564 handle = MPTSAS_NUM_PORTS + 1;
565 } else {
566 ++handle;
567 }
568 i = handle - 1 - MPTSAS_NUM_PORTS;
569 } while (i < MPTSAS_NUM_PORTS && !scsi_device_find(&s->bus, 0, i, 0));
570
571 } else if (form == MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID) {
572 if (address & MPI_SAS_DEVICE_PGAD_BT_BUS_MASK) {
573 return -EINVAL;
574 }
575 i = address & MPI_SAS_DEVICE_PGAD_BT_TID_MASK;
576
577 } else if (form == MPI_SAS_DEVICE_PGAD_FORM_HANDLE) {
578 handle = address & MPI_SAS_DEVICE_PGAD_H_HANDLE_MASK;
579 i = handle - 1 - MPTSAS_NUM_PORTS;
580
581 } else {
582 return -EINVAL;
583 }
584
585 if (i >= MPTSAS_NUM_PORTS) {
586 return -EINVAL;
587 }
588
589 return i;
590 }
591
592 static
mptsas_config_sas_device_0(MPTSASState * s,uint8_t ** data,int address)593 size_t mptsas_config_sas_device_0(MPTSASState *s, uint8_t **data, int address)
594 {
595 int phy_handle = -1;
596 int dev_handle = -1;
597 int i = mptsas_device_addr_get(s, address);
598 SCSIDevice *dev = mptsas_phy_get_device(s, i, &phy_handle, &dev_handle);
599
600 trace_mptsas_config_sas_device(s, address, i, phy_handle, dev_handle, 0);
601 if (!dev) {
602 return -ENOENT;
603 }
604
605 return MPTSAS_CONFIG_PACK_EXT(0, MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE, 0x05,
606 "*w*wqwbbwbblwb*b",
607 dev->wwn, phy_handle, i,
608 MPI_SAS_DEVICE0_ASTATUS_NO_ERRORS,
609 dev_handle, i, 0,
610 MPI_SAS_DEVICE_INFO_END_DEVICE | MPI_SAS_DEVICE_INFO_SSP_TARGET,
611 (MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT |
612 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED |
613 MPI_SAS_DEVICE0_FLAGS_MAPPING_PERSISTENT), i);
614 }
615
616 static
mptsas_config_sas_device_1(MPTSASState * s,uint8_t ** data,int address)617 size_t mptsas_config_sas_device_1(MPTSASState *s, uint8_t **data, int address)
618 {
619 int phy_handle = -1;
620 int dev_handle = -1;
621 int i = mptsas_device_addr_get(s, address);
622 SCSIDevice *dev = mptsas_phy_get_device(s, i, &phy_handle, &dev_handle);
623
624 trace_mptsas_config_sas_device(s, address, i, phy_handle, dev_handle, 1);
625 if (!dev) {
626 return -ENOENT;
627 }
628
629 return MPTSAS_CONFIG_PACK_EXT(1, MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE, 0x00,
630 "*lq*lwbb*s20",
631 dev->wwn, dev_handle, i, 0);
632 }
633
634 static
mptsas_config_sas_device_2(MPTSASState * s,uint8_t ** data,int address)635 size_t mptsas_config_sas_device_2(MPTSASState *s, uint8_t **data, int address)
636 {
637 int phy_handle = -1;
638 int dev_handle = -1;
639 int i = mptsas_device_addr_get(s, address);
640 SCSIDevice *dev = mptsas_phy_get_device(s, i, &phy_handle, &dev_handle);
641
642 trace_mptsas_config_sas_device(s, address, i, phy_handle, dev_handle, 2);
643 if (!dev) {
644 return -ENOENT;
645 }
646
647 return MPTSAS_CONFIG_PACK_EXT(2, MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE, 0x01,
648 "ql", dev->wwn, 0);
649 }
650
651 typedef struct MPTSASConfigPage {
652 uint8_t number;
653 uint8_t type;
654 size_t (*mpt_config_build)(MPTSASState *s, uint8_t **data, int address);
655 } MPTSASConfigPage;
656
657 static const MPTSASConfigPage mptsas_config_pages[] = {
658 {
659 0, MPI_CONFIG_PAGETYPE_MANUFACTURING,
660 mptsas_config_manufacturing_0,
661 }, {
662 1, MPI_CONFIG_PAGETYPE_MANUFACTURING,
663 mptsas_config_manufacturing_1,
664 }, {
665 2, MPI_CONFIG_PAGETYPE_MANUFACTURING,
666 mptsas_config_manufacturing_2,
667 }, {
668 3, MPI_CONFIG_PAGETYPE_MANUFACTURING,
669 mptsas_config_manufacturing_3,
670 }, {
671 4, MPI_CONFIG_PAGETYPE_MANUFACTURING,
672 mptsas_config_manufacturing_4,
673 }, {
674 5, MPI_CONFIG_PAGETYPE_MANUFACTURING,
675 mptsas_config_manufacturing_5,
676 }, {
677 6, MPI_CONFIG_PAGETYPE_MANUFACTURING,
678 mptsas_config_manufacturing_6,
679 }, {
680 7, MPI_CONFIG_PAGETYPE_MANUFACTURING,
681 mptsas_config_manufacturing_7,
682 }, {
683 8, MPI_CONFIG_PAGETYPE_MANUFACTURING,
684 mptsas_config_manufacturing_8,
685 }, {
686 9, MPI_CONFIG_PAGETYPE_MANUFACTURING,
687 mptsas_config_manufacturing_9,
688 }, {
689 10, MPI_CONFIG_PAGETYPE_MANUFACTURING,
690 mptsas_config_manufacturing_10,
691 }, {
692 0, MPI_CONFIG_PAGETYPE_IO_UNIT,
693 mptsas_config_io_unit_0,
694 }, {
695 1, MPI_CONFIG_PAGETYPE_IO_UNIT,
696 mptsas_config_io_unit_1,
697 }, {
698 2, MPI_CONFIG_PAGETYPE_IO_UNIT,
699 mptsas_config_io_unit_2,
700 }, {
701 3, MPI_CONFIG_PAGETYPE_IO_UNIT,
702 mptsas_config_io_unit_3,
703 }, {
704 4, MPI_CONFIG_PAGETYPE_IO_UNIT,
705 mptsas_config_io_unit_4,
706 }, {
707 0, MPI_CONFIG_PAGETYPE_IOC,
708 mptsas_config_ioc_0,
709 }, {
710 1, MPI_CONFIG_PAGETYPE_IOC,
711 mptsas_config_ioc_1,
712 }, {
713 2, MPI_CONFIG_PAGETYPE_IOC,
714 mptsas_config_ioc_2,
715 }, {
716 3, MPI_CONFIG_PAGETYPE_IOC,
717 mptsas_config_ioc_3,
718 }, {
719 4, MPI_CONFIG_PAGETYPE_IOC,
720 mptsas_config_ioc_4,
721 }, {
722 5, MPI_CONFIG_PAGETYPE_IOC,
723 mptsas_config_ioc_5,
724 }, {
725 6, MPI_CONFIG_PAGETYPE_IOC,
726 mptsas_config_ioc_6,
727 }, {
728 0, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT,
729 mptsas_config_sas_io_unit_0,
730 }, {
731 1, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT,
732 mptsas_config_sas_io_unit_1,
733 }, {
734 2, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT,
735 mptsas_config_sas_io_unit_2,
736 }, {
737 3, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT,
738 mptsas_config_sas_io_unit_3,
739 }, {
740 0, MPI_CONFIG_EXTPAGETYPE_SAS_PHY,
741 mptsas_config_phy_0,
742 }, {
743 1, MPI_CONFIG_EXTPAGETYPE_SAS_PHY,
744 mptsas_config_phy_1,
745 }, {
746 0, MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE,
747 mptsas_config_sas_device_0,
748 }, {
749 1, MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE,
750 mptsas_config_sas_device_1,
751 }, {
752 2, MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE,
753 mptsas_config_sas_device_2,
754 }
755 };
756
mptsas_find_config_page(int type,int number)757 static const MPTSASConfigPage *mptsas_find_config_page(int type, int number)
758 {
759 const MPTSASConfigPage *page;
760 int i;
761
762 for (i = 0; i < ARRAY_SIZE(mptsas_config_pages); i++) {
763 page = &mptsas_config_pages[i];
764 if (page->type == type && page->number == number) {
765 return page;
766 }
767 }
768
769 return NULL;
770 }
771
mptsas_process_config(MPTSASState * s,MPIMsgConfig * req)772 void mptsas_process_config(MPTSASState *s, MPIMsgConfig *req)
773 {
774 PCIDevice *pci = PCI_DEVICE(s);
775
776 MPIMsgConfigReply reply;
777 const MPTSASConfigPage *page;
778 size_t length;
779 uint8_t type;
780 uint8_t *data = NULL;
781 uint32_t flags_and_length;
782 uint32_t dmalen;
783 uint64_t pa;
784
785 mptsas_fix_config_endianness(req);
786
787 QEMU_BUILD_BUG_ON(sizeof(s->doorbell_msg) < sizeof(*req));
788 QEMU_BUILD_BUG_ON(sizeof(s->doorbell_reply) < sizeof(reply));
789
790 /* Copy common bits from the request into the reply. */
791 memset(&reply, 0, sizeof(reply));
792 reply.Action = req->Action;
793 reply.Function = req->Function;
794 reply.MsgContext = req->MsgContext;
795 reply.MsgLength = sizeof(reply) / 4;
796 reply.PageType = req->PageType;
797 reply.PageNumber = req->PageNumber;
798 reply.PageLength = req->PageLength;
799 reply.PageVersion = req->PageVersion;
800
801 type = req->PageType & MPI_CONFIG_PAGETYPE_MASK;
802 if (type == MPI_CONFIG_PAGETYPE_EXTENDED) {
803 type = req->ExtPageType;
804 if (type <= MPI_CONFIG_PAGETYPE_MASK) {
805 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_TYPE;
806 goto out;
807 }
808
809 reply.ExtPageType = req->ExtPageType;
810 }
811
812 page = mptsas_find_config_page(type, req->PageNumber);
813
814 switch(req->Action) {
815 case MPI_CONFIG_ACTION_PAGE_DEFAULT:
816 case MPI_CONFIG_ACTION_PAGE_HEADER:
817 case MPI_CONFIG_ACTION_PAGE_READ_NVRAM:
818 case MPI_CONFIG_ACTION_PAGE_READ_CURRENT:
819 case MPI_CONFIG_ACTION_PAGE_READ_DEFAULT:
820 case MPI_CONFIG_ACTION_PAGE_WRITE_CURRENT:
821 case MPI_CONFIG_ACTION_PAGE_WRITE_NVRAM:
822 break;
823
824 default:
825 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_ACTION;
826 goto out;
827 }
828
829 if (!page) {
830 page = mptsas_find_config_page(type, 1);
831 if (page) {
832 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_PAGE;
833 } else {
834 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_TYPE;
835 }
836 goto out;
837 }
838
839 if (req->Action == MPI_CONFIG_ACTION_PAGE_DEFAULT ||
840 req->Action == MPI_CONFIG_ACTION_PAGE_HEADER) {
841 length = page->mpt_config_build(s, NULL, req->PageAddress);
842 if ((ssize_t)length < 0) {
843 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_PAGE;
844 goto out;
845 } else {
846 goto done;
847 }
848 }
849
850 if (req->Action == MPI_CONFIG_ACTION_PAGE_WRITE_CURRENT ||
851 req->Action == MPI_CONFIG_ACTION_PAGE_WRITE_NVRAM) {
852 length = page->mpt_config_build(s, NULL, req->PageAddress);
853 if ((ssize_t)length < 0) {
854 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_PAGE;
855 } else {
856 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_CANT_COMMIT;
857 }
858 goto out;
859 }
860
861 flags_and_length = req->PageBufferSGE.FlagsLength;
862 dmalen = flags_and_length & MPI_SGE_LENGTH_MASK;
863 if (dmalen == 0) {
864 length = page->mpt_config_build(s, NULL, req->PageAddress);
865 if ((ssize_t)length < 0) {
866 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_PAGE;
867 goto out;
868 } else {
869 goto done;
870 }
871 }
872
873 if (flags_and_length & MPI_SGE_FLAGS_64_BIT_ADDRESSING) {
874 pa = req->PageBufferSGE.u.Address64;
875 } else {
876 pa = req->PageBufferSGE.u.Address32;
877 }
878
879 /* Only read actions left. */
880 length = page->mpt_config_build(s, &data, req->PageAddress);
881 if ((ssize_t)length < 0) {
882 reply.IOCStatus = MPI_IOCSTATUS_CONFIG_INVALID_PAGE;
883 goto out;
884 } else {
885 assert(data[2] == page->number);
886 pci_dma_write(pci, pa, data, MIN(length, dmalen));
887 goto done;
888 }
889
890 abort();
891
892 done:
893 if (type > MPI_CONFIG_PAGETYPE_MASK) {
894 reply.ExtPageLength = length / 4;
895 reply.ExtPageType = req->ExtPageType;
896 } else {
897 reply.PageLength = length / 4;
898 }
899
900 out:
901 mptsas_fix_config_reply_endianness(&reply);
902 mptsas_reply(s, (MPIDefaultReply *)&reply);
903 g_free(data);
904 }
905