]>
Commit | Line | Data |
---|---|---|
dc488f88 SF |
1 | /* |
2 | * QEMU rocker switch emulation - front-panel ports | |
3 | * | |
4 | * Copyright (c) 2014 Scott Feldman <sfeldma@gmail.com> | |
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 as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | */ | |
16 | ||
17 | #include "net/clients.h" | |
18 | ||
19 | #include "rocker.h" | |
20 | #include "rocker_hw.h" | |
21 | #include "rocker_fp.h" | |
22 | #include "rocker_world.h" | |
23 | ||
24 | enum duplex { | |
25 | DUPLEX_HALF = 0, | |
26 | DUPLEX_FULL | |
27 | }; | |
28 | ||
29 | struct fp_port { | |
30 | Rocker *r; | |
31 | World *world; | |
32 | unsigned int index; | |
33 | char *name; | |
34 | uint32_t pport; | |
35 | bool enabled; | |
36 | uint32_t speed; | |
37 | uint8_t duplex; | |
38 | uint8_t autoneg; | |
39 | uint8_t learning; | |
40 | NICState *nic; | |
41 | NICConf conf; | |
42 | }; | |
43 | ||
77349536 DA |
44 | char *fp_port_get_name(FpPort *port) |
45 | { | |
46 | return port->name; | |
47 | } | |
48 | ||
dc488f88 SF |
49 | bool fp_port_get_link_up(FpPort *port) |
50 | { | |
51 | return !qemu_get_queue(port->nic)->link_down; | |
52 | } | |
53 | ||
fafa4d50 SF |
54 | void fp_port_get_info(FpPort *port, RockerPortList *info) |
55 | { | |
56 | info->value->name = g_strdup(port->name); | |
57 | info->value->enabled = port->enabled; | |
58 | info->value->link_up = fp_port_get_link_up(port); | |
59 | info->value->speed = port->speed; | |
60 | info->value->duplex = port->duplex; | |
61 | info->value->autoneg = port->autoneg; | |
62 | } | |
63 | ||
dc488f88 SF |
64 | void fp_port_get_macaddr(FpPort *port, MACAddr *macaddr) |
65 | { | |
66 | memcpy(macaddr->a, port->conf.macaddr.a, sizeof(macaddr->a)); | |
67 | } | |
68 | ||
69 | void fp_port_set_macaddr(FpPort *port, MACAddr *macaddr) | |
70 | { | |
71 | /* XXX TODO implement and test setting mac addr | |
72 | * XXX memcpy(port->conf.macaddr.a, macaddr.a, sizeof(port->conf.macaddr.a)); | |
73 | */ | |
74 | } | |
75 | ||
76 | uint8_t fp_port_get_learning(FpPort *port) | |
77 | { | |
78 | return port->learning; | |
79 | } | |
80 | ||
81 | void fp_port_set_learning(FpPort *port, uint8_t learning) | |
82 | { | |
83 | port->learning = learning; | |
84 | } | |
85 | ||
86 | int fp_port_get_settings(FpPort *port, uint32_t *speed, | |
87 | uint8_t *duplex, uint8_t *autoneg) | |
88 | { | |
89 | *speed = port->speed; | |
90 | *duplex = port->duplex; | |
91 | *autoneg = port->autoneg; | |
92 | ||
93 | return ROCKER_OK; | |
94 | } | |
95 | ||
96 | int fp_port_set_settings(FpPort *port, uint32_t speed, | |
97 | uint8_t duplex, uint8_t autoneg) | |
98 | { | |
99 | /* XXX validate inputs */ | |
100 | ||
101 | port->speed = speed; | |
102 | port->duplex = duplex; | |
103 | port->autoneg = autoneg; | |
104 | ||
105 | return ROCKER_OK; | |
106 | } | |
107 | ||
108 | bool fp_port_from_pport(uint32_t pport, uint32_t *port) | |
109 | { | |
110 | if (pport < 1 || pport > ROCKER_FP_PORTS_MAX) { | |
111 | return false; | |
112 | } | |
113 | *port = pport - 1; | |
114 | return true; | |
115 | } | |
116 | ||
117 | int fp_port_eg(FpPort *port, const struct iovec *iov, int iovcnt) | |
118 | { | |
119 | NetClientState *nc = qemu_get_queue(port->nic); | |
120 | ||
121 | if (port->enabled) { | |
122 | qemu_sendv_packet(nc, iov, iovcnt); | |
123 | } | |
124 | ||
125 | return ROCKER_OK; | |
126 | } | |
127 | ||
128 | static int fp_port_can_receive(NetClientState *nc) | |
129 | { | |
130 | FpPort *port = qemu_get_nic_opaque(nc); | |
131 | ||
132 | return port->enabled; | |
133 | } | |
134 | ||
135 | static ssize_t fp_port_receive_iov(NetClientState *nc, const struct iovec *iov, | |
136 | int iovcnt) | |
137 | { | |
138 | FpPort *port = qemu_get_nic_opaque(nc); | |
139 | ||
140 | return world_ingress(port->world, port->pport, iov, iovcnt); | |
141 | } | |
142 | ||
143 | static ssize_t fp_port_receive(NetClientState *nc, const uint8_t *buf, | |
144 | size_t size) | |
145 | { | |
146 | const struct iovec iov = { | |
147 | .iov_base = (uint8_t *)buf, | |
148 | .iov_len = size | |
149 | }; | |
150 | ||
151 | return fp_port_receive_iov(nc, &iov, 1); | |
152 | } | |
153 | ||
154 | static void fp_port_cleanup(NetClientState *nc) | |
155 | { | |
156 | } | |
157 | ||
158 | static void fp_port_set_link_status(NetClientState *nc) | |
159 | { | |
160 | FpPort *port = qemu_get_nic_opaque(nc); | |
161 | ||
162 | rocker_event_link_changed(port->r, port->pport, !nc->link_down); | |
163 | } | |
164 | ||
165 | static NetClientInfo fp_port_info = { | |
166 | .type = NET_CLIENT_OPTIONS_KIND_NIC, | |
167 | .size = sizeof(NICState), | |
168 | .can_receive = fp_port_can_receive, | |
169 | .receive = fp_port_receive, | |
170 | .receive_iov = fp_port_receive_iov, | |
171 | .cleanup = fp_port_cleanup, | |
172 | .link_status_changed = fp_port_set_link_status, | |
173 | }; | |
174 | ||
175 | World *fp_port_get_world(FpPort *port) | |
176 | { | |
177 | return port->world; | |
178 | } | |
179 | ||
180 | void fp_port_set_world(FpPort *port, World *world) | |
181 | { | |
182 | DPRINTF("port %d setting world \"%s\"\n", port->index, world_name(world)); | |
183 | port->world = world; | |
184 | } | |
185 | ||
186 | bool fp_port_enabled(FpPort *port) | |
187 | { | |
188 | return port->enabled; | |
189 | } | |
190 | ||
5ff1547b SF |
191 | static void fp_port_set_link(FpPort *port, bool up) |
192 | { | |
193 | NetClientState *nc = qemu_get_queue(port->nic); | |
194 | ||
195 | if (up == nc->link_down) { | |
196 | nc->link_down = !up; | |
197 | nc->info->link_status_changed(nc); | |
198 | } | |
199 | } | |
200 | ||
dc488f88 SF |
201 | void fp_port_enable(FpPort *port) |
202 | { | |
5ff1547b | 203 | fp_port_set_link(port, true); |
dc488f88 SF |
204 | port->enabled = true; |
205 | DPRINTF("port %d enabled\n", port->index); | |
206 | } | |
207 | ||
208 | void fp_port_disable(FpPort *port) | |
209 | { | |
210 | port->enabled = false; | |
5ff1547b | 211 | fp_port_set_link(port, false); |
dc488f88 SF |
212 | DPRINTF("port %d disabled\n", port->index); |
213 | } | |
214 | ||
215 | FpPort *fp_port_alloc(Rocker *r, char *sw_name, | |
216 | MACAddr *start_mac, unsigned int index, | |
217 | NICPeers *peers) | |
218 | { | |
219 | FpPort *port = g_malloc0(sizeof(FpPort)); | |
220 | ||
221 | if (!port) { | |
222 | return NULL; | |
223 | } | |
224 | ||
225 | port->r = r; | |
226 | port->index = index; | |
227 | port->pport = index + 1; | |
228 | ||
229 | /* front-panel switch port names are 1-based */ | |
230 | ||
77349536 | 231 | port->name = g_strdup_printf("%sp%d", sw_name, port->pport); |
dc488f88 SF |
232 | |
233 | memcpy(port->conf.macaddr.a, start_mac, sizeof(port->conf.macaddr.a)); | |
234 | port->conf.macaddr.a[5] += index; | |
235 | port->conf.bootindex = -1; | |
236 | port->conf.peers = *peers; | |
237 | ||
238 | port->nic = qemu_new_nic(&fp_port_info, &port->conf, | |
239 | sw_name, NULL, port); | |
240 | qemu_format_nic_info_str(qemu_get_queue(port->nic), | |
241 | port->conf.macaddr.a); | |
242 | ||
243 | fp_port_reset(port); | |
244 | ||
245 | return port; | |
246 | } | |
247 | ||
248 | void fp_port_free(FpPort *port) | |
249 | { | |
250 | qemu_del_nic(port->nic); | |
251 | g_free(port->name); | |
252 | g_free(port); | |
253 | } | |
254 | ||
255 | void fp_port_reset(FpPort *port) | |
256 | { | |
257 | fp_port_disable(port); | |
258 | port->speed = 10000; /* 10Gbps */ | |
259 | port->duplex = DUPLEX_FULL; | |
260 | port->autoneg = 0; | |
261 | } |