spapr: Workaround for broken radix guests
[qemu.git] / slirp / ncsi.c
1 /*
2 * NC-SI (Network Controller Sideband Interface) "echo" model
3 *
4 * Copyright (C) 2016 IBM Corp.
5 *
6 * This code is licensed under the GPL version 2 or later. See the
7 * COPYING file in the top-level directory.
8 */
9 #include "qemu/osdep.h"
10 #include "slirp.h"
11
12 #include "ncsi-pkt.h"
13
14 /* Get Capabilities */
15 static int ncsi_rsp_handler_gc(struct ncsi_rsp_pkt_hdr *rnh)
16 {
17 struct ncsi_rsp_gc_pkt *rsp = (struct ncsi_rsp_gc_pkt *) rnh;
18
19 rsp->cap = htonl(~0);
20 rsp->bc_cap = htonl(~0);
21 rsp->mc_cap = htonl(~0);
22 rsp->buf_cap = htonl(~0);
23 rsp->aen_cap = htonl(~0);
24 rsp->vlan_mode = 0xff;
25 rsp->uc_cnt = 2;
26 return 0;
27 }
28
29 /* Get Link status */
30 static int ncsi_rsp_handler_gls(struct ncsi_rsp_pkt_hdr *rnh)
31 {
32 struct ncsi_rsp_gls_pkt *rsp = (struct ncsi_rsp_gls_pkt *) rnh;
33
34 rsp->status = htonl(0x1);
35 return 0;
36 }
37
38 static const struct ncsi_rsp_handler {
39 unsigned char type;
40 int payload;
41 int (*handler)(struct ncsi_rsp_pkt_hdr *rnh);
42 } ncsi_rsp_handlers[] = {
43 { NCSI_PKT_RSP_CIS, 4, NULL },
44 { NCSI_PKT_RSP_SP, 4, NULL },
45 { NCSI_PKT_RSP_DP, 4, NULL },
46 { NCSI_PKT_RSP_EC, 4, NULL },
47 { NCSI_PKT_RSP_DC, 4, NULL },
48 { NCSI_PKT_RSP_RC, 4, NULL },
49 { NCSI_PKT_RSP_ECNT, 4, NULL },
50 { NCSI_PKT_RSP_DCNT, 4, NULL },
51 { NCSI_PKT_RSP_AE, 4, NULL },
52 { NCSI_PKT_RSP_SL, 4, NULL },
53 { NCSI_PKT_RSP_GLS, 16, ncsi_rsp_handler_gls },
54 { NCSI_PKT_RSP_SVF, 4, NULL },
55 { NCSI_PKT_RSP_EV, 4, NULL },
56 { NCSI_PKT_RSP_DV, 4, NULL },
57 { NCSI_PKT_RSP_SMA, 4, NULL },
58 { NCSI_PKT_RSP_EBF, 4, NULL },
59 { NCSI_PKT_RSP_DBF, 4, NULL },
60 { NCSI_PKT_RSP_EGMF, 4, NULL },
61 { NCSI_PKT_RSP_DGMF, 4, NULL },
62 { NCSI_PKT_RSP_SNFC, 4, NULL },
63 { NCSI_PKT_RSP_GVI, 36, NULL },
64 { NCSI_PKT_RSP_GC, 32, ncsi_rsp_handler_gc },
65 { NCSI_PKT_RSP_GP, -1, NULL },
66 { NCSI_PKT_RSP_GCPS, 172, NULL },
67 { NCSI_PKT_RSP_GNS, 172, NULL },
68 { NCSI_PKT_RSP_GNPTS, 172, NULL },
69 { NCSI_PKT_RSP_GPS, 8, NULL },
70 { NCSI_PKT_RSP_OEM, 0, NULL },
71 { NCSI_PKT_RSP_PLDM, 0, NULL },
72 { NCSI_PKT_RSP_GPUUID, 20, NULL }
73 };
74
75 /*
76 * packet format : ncsi header + payload + checksum
77 */
78 #define NCSI_MAX_PAYLOAD 172
79 #define NCSI_MAX_LEN (sizeof(struct ncsi_pkt_hdr) + NCSI_MAX_PAYLOAD + 4)
80
81 void ncsi_input(Slirp *slirp, const uint8_t *pkt, int pkt_len)
82 {
83 struct ncsi_pkt_hdr *nh = (struct ncsi_pkt_hdr *)(pkt + ETH_HLEN);
84 uint8_t ncsi_reply[ETH_HLEN + NCSI_MAX_LEN];
85 struct ethhdr *reh = (struct ethhdr *)ncsi_reply;
86 struct ncsi_rsp_pkt_hdr *rnh = (struct ncsi_rsp_pkt_hdr *)
87 (ncsi_reply + ETH_HLEN);
88 const struct ncsi_rsp_handler *handler = NULL;
89 int i;
90
91 memset(ncsi_reply, 0, sizeof(ncsi_reply));
92
93 memset(reh->h_dest, 0xff, ETH_ALEN);
94 memset(reh->h_source, 0xff, ETH_ALEN);
95 reh->h_proto = htons(ETH_P_NCSI);
96
97 for (i = 0; i < ARRAY_SIZE(ncsi_rsp_handlers); i++) {
98 if (ncsi_rsp_handlers[i].type == nh->type + 0x80) {
99 handler = &ncsi_rsp_handlers[i];
100 break;
101 }
102 }
103
104 rnh->common.mc_id = nh->mc_id;
105 rnh->common.revision = NCSI_PKT_REVISION;
106 rnh->common.id = nh->id;
107 rnh->common.type = nh->type + 0x80;
108 rnh->common.channel = nh->channel;
109
110 if (handler) {
111 rnh->common.length = htons(handler->payload);
112 rnh->code = htons(NCSI_PKT_RSP_C_COMPLETED);
113 rnh->reason = htons(NCSI_PKT_RSP_R_NO_ERROR);
114
115 if (handler->handler) {
116 /* TODO: handle errors */
117 handler->handler(rnh);
118 }
119 } else {
120 rnh->common.length = 0;
121 rnh->code = htons(NCSI_PKT_RSP_C_UNAVAILABLE);
122 rnh->reason = htons(NCSI_PKT_RSP_R_UNKNOWN);
123 }
124
125 /* TODO: add a checksum at the end of the frame but the specs
126 * allows it to be zero */
127
128 slirp_output(slirp->opaque, ncsi_reply, ETH_HLEN + sizeof(*nh) +
129 (handler ? handler->payload : 0) + 4);
130 }