vnet.c revision 1.4 1 1.4 palle /* $NetBSD: vnet.c,v 1.4 2021/03/13 20:21:37 palle Exp $ */
2 1.1 palle /* $OpenBSD: vnet.c,v 1.62 2020/07/10 13:26:36 patrick Exp $ */
3 1.1 palle /*
4 1.1 palle * Copyright (c) 2009, 2015 Mark Kettenis
5 1.1 palle *
6 1.1 palle * Permission to use, copy, modify, and distribute this software for any
7 1.1 palle * purpose with or without fee is hereby granted, provided that the above
8 1.1 palle * copyright notice and this permission notice appear in all copies.
9 1.1 palle *
10 1.1 palle * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 1.1 palle * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 1.1 palle * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 1.1 palle * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 1.1 palle * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 1.1 palle * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 1.1 palle * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 1.1 palle */
18 1.1 palle
19 1.1 palle #if 0
20 1.1 palle FIXME openbsd
21 1.1 palle #include "bpfilter.h"
22 1.1 palle #endif
23 1.1 palle
24 1.1 palle #include <sys/kmem.h>
25 1.1 palle #include <sys/param.h>
26 1.1 palle #include <sys/atomic.h>
27 1.1 palle #include <sys/device.h>
28 1.1 palle #include <sys/malloc.h>
29 1.1 palle #include <sys/pool.h>
30 1.1 palle #include <sys/mbuf.h>
31 1.1 palle #include <sys/socket.h>
32 1.1 palle #include <sys/sockio.h>
33 1.1 palle #include <sys/systm.h>
34 1.1 palle #if 0
35 1.1 palle FIXME openbsd
36 1.1 palle #include <sys/timeout.h>
37 1.3 palle #else
38 1.3 palle #include <sys/callout.h>
39 1.1 palle #endif
40 1.1 palle
41 1.1 palle #include <machine/autoconf.h>
42 1.1 palle #include <machine/hypervisor.h>
43 1.1 palle #include <machine/openfirm.h>
44 1.1 palle
45 1.1 palle #include <net/if.h>
46 1.1 palle #include <net/if_media.h>
47 1.1 palle
48 1.1 palle #include <netinet/in.h>
49 1.1 palle #include <net/if_ether.h>
50 1.1 palle
51 1.1 palle #if NBPFILTER > 0
52 1.1 palle #include <net/bpf.h>
53 1.1 palle #endif
54 1.1 palle
55 1.1 palle #include <uvm/uvm_extern.h>
56 1.1 palle
57 1.1 palle #include <sparc64/dev/cbusvar.h>
58 1.1 palle #include <sparc64/dev/ldcvar.h>
59 1.1 palle #include <sparc64/dev/viovar.h>
60 1.1 palle
61 1.3 palle #if 1
62 1.3 palle #define VNET_DEBUG
63 1.3 palle #endif
64 1.1 palle #ifdef VNET_DEBUG
65 1.1 palle #define DPRINTF(x) printf x
66 1.1 palle #else
67 1.1 palle #define DPRINTF(x)
68 1.1 palle #endif
69 1.1 palle
70 1.1 palle #define VNET_TX_ENTRIES 32
71 1.1 palle #define VNET_RX_ENTRIES 32
72 1.1 palle
73 1.1 palle struct vnet_attr_info {
74 1.1 palle struct vio_msg_tag tag;
75 1.1 palle uint8_t xfer_mode;
76 1.1 palle uint8_t addr_type;
77 1.1 palle uint16_t ack_freq;
78 1.1 palle uint32_t _reserved1;
79 1.1 palle uint64_t addr;
80 1.1 palle uint64_t mtu;
81 1.1 palle uint64_t _reserved2[3];
82 1.1 palle };
83 1.1 palle
84 1.1 palle /* Address types. */
85 1.1 palle #define VNET_ADDR_ETHERMAC 0x01
86 1.1 palle
87 1.1 palle /* Sub-Type envelopes. */
88 1.1 palle #define VNET_MCAST_INFO 0x0101
89 1.1 palle
90 1.1 palle #define VNET_NUM_MCAST 7
91 1.1 palle
92 1.1 palle struct vnet_mcast_info {
93 1.1 palle struct vio_msg_tag tag;
94 1.1 palle uint8_t set;
95 1.1 palle uint8_t count;
96 1.1 palle uint8_t mcast_addr[VNET_NUM_MCAST][ETHER_ADDR_LEN];
97 1.1 palle uint32_t _reserved;
98 1.1 palle };
99 1.1 palle
100 1.1 palle struct vnet_desc {
101 1.1 palle struct vio_dring_hdr hdr;
102 1.1 palle uint32_t nbytes;
103 1.1 palle uint32_t ncookies;
104 1.1 palle struct ldc_cookie cookie[2];
105 1.1 palle };
106 1.1 palle
107 1.1 palle struct vnet_desc_msg {
108 1.1 palle struct vio_msg_tag tag;
109 1.1 palle uint64_t seq_no;
110 1.1 palle uint64_t desc_handle;
111 1.1 palle uint32_t nbytes;
112 1.1 palle uint32_t ncookies;
113 1.1 palle struct ldc_cookie cookie[1];
114 1.1 palle };
115 1.1 palle
116 1.1 palle struct vnet_dring {
117 1.1 palle bus_dmamap_t vd_map;
118 1.1 palle bus_dma_segment_t vd_seg;
119 1.1 palle struct vnet_desc *vd_desc;
120 1.1 palle int vd_nentries;
121 1.1 palle };
122 1.1 palle
123 1.1 palle struct vnet_dring *vnet_dring_alloc(bus_dma_tag_t, int);
124 1.1 palle void vnet_dring_free(bus_dma_tag_t, struct vnet_dring *);
125 1.1 palle
126 1.1 palle /*
127 1.1 palle * For now, we only support vNet 1.0.
128 1.1 palle */
129 1.1 palle #define VNET_MAJOR 1
130 1.1 palle #define VNET_MINOR 0
131 1.1 palle
132 1.1 palle /*
133 1.1 palle * The vNet protocol wants the IP header to be 64-bit aligned, so
134 1.1 palle * define out own variant of ETHER_ALIGN.
135 1.1 palle */
136 1.1 palle #define VNET_ETHER_ALIGN 6
137 1.1 palle
138 1.1 palle struct vnet_soft_desc {
139 1.1 palle int vsd_map_idx;
140 1.1 palle #if 0
141 1.1 palle FIXME openbsd
142 1.1 palle caddr_t vsd_buf;
143 1.1 palle #else
144 1.1 palle unsigned char *vsd_buf;
145 1.1 palle #endif
146 1.1 palle };
147 1.1 palle
148 1.1 palle struct vnet_softc {
149 1.1 palle struct device sc_dv;
150 1.1 palle bus_space_tag_t sc_bustag;
151 1.1 palle bus_dma_tag_t sc_dmatag;
152 1.1 palle
153 1.1 palle uint64_t sc_tx_ino;
154 1.1 palle uint64_t sc_rx_ino;
155 1.1 palle void *sc_tx_ih;
156 1.1 palle void *sc_rx_ih;
157 1.1 palle
158 1.1 palle struct ldc_conn sc_lc;
159 1.1 palle
160 1.1 palle uint16_t sc_vio_state;
161 1.1 palle #define VIO_SND_VER_INFO 0x0001
162 1.1 palle #define VIO_ACK_VER_INFO 0x0002
163 1.1 palle #define VIO_RCV_VER_INFO 0x0004
164 1.1 palle #define VIO_SND_ATTR_INFO 0x0008
165 1.1 palle #define VIO_ACK_ATTR_INFO 0x0010
166 1.1 palle #define VIO_RCV_ATTR_INFO 0x0020
167 1.1 palle #define VIO_SND_DRING_REG 0x0040
168 1.1 palle #define VIO_ACK_DRING_REG 0x0080
169 1.1 palle #define VIO_RCV_DRING_REG 0x0100
170 1.1 palle #define VIO_SND_RDX 0x0200
171 1.1 palle #define VIO_ACK_RDX 0x0400
172 1.1 palle #define VIO_RCV_RDX 0x0800
173 1.1 palle
174 1.1 palle #if 0
175 1.1 palle FIXME openbsd
176 1.1 palle struct timeout sc_handshake_to;
177 1.3 palle #else
178 1.3 palle struct callout sc_handshake_co;
179 1.1 palle #endif
180 1.1 palle
181 1.1 palle uint8_t sc_xfer_mode;
182 1.1 palle
183 1.1 palle uint32_t sc_local_sid;
184 1.1 palle uint64_t sc_dring_ident;
185 1.1 palle uint64_t sc_seq_no;
186 1.1 palle
187 1.1 palle u_int sc_tx_prod;
188 1.1 palle u_int sc_tx_cons;
189 1.1 palle
190 1.1 palle u_int sc_peer_state;
191 1.1 palle
192 1.1 palle struct ldc_map *sc_lm;
193 1.1 palle struct vnet_dring *sc_vd;
194 1.1 palle struct vnet_soft_desc *sc_vsd;
195 1.1 palle #define VNET_NUM_SOFT_DESC 128
196 1.1 palle
197 1.1 palle size_t sc_peer_desc_size;
198 1.1 palle struct ldc_cookie sc_peer_dring_cookie;
199 1.1 palle int sc_peer_dring_nentries;
200 1.1 palle
201 1.1 palle struct pool sc_pool;
202 1.1 palle
203 1.1 palle struct ethercom sc_ethercom;
204 1.1 palle struct ifmedia sc_media;
205 1.1 palle u_int8_t sc_macaddr[ETHER_ADDR_LEN];
206 1.1 palle };
207 1.1 palle
208 1.1 palle int vnet_match (device_t, cfdata_t, void *);
209 1.1 palle void vnet_attach (device_t, device_t, void *);
210 1.1 palle
211 1.1 palle CFATTACH_DECL_NEW(vnet, sizeof(struct vnet_softc),
212 1.1 palle vnet_match, vnet_attach, NULL, NULL);
213 1.1 palle
214 1.1 palle int vnet_tx_intr(void *);
215 1.1 palle int vnet_rx_intr(void *);
216 1.1 palle void vnet_handshake(void *);
217 1.1 palle
218 1.1 palle void vio_rx_data(struct ldc_conn *, struct ldc_pkt *);
219 1.1 palle void vnet_rx_vio_ctrl(struct vnet_softc *, struct vio_msg *);
220 1.1 palle void vnet_rx_vio_ver_info(struct vnet_softc *, struct vio_msg_tag *);
221 1.1 palle void vnet_rx_vio_attr_info(struct vnet_softc *, struct vio_msg_tag *);
222 1.1 palle void vnet_rx_vio_dring_reg(struct vnet_softc *, struct vio_msg_tag *);
223 1.1 palle void vnet_rx_vio_rdx(struct vnet_softc *sc, struct vio_msg_tag *);
224 1.4 palle void vnet_rx_vio_mcast_info(struct vnet_softc *sc, struct vio_msg_tag *);
225 1.1 palle void vnet_rx_vio_data(struct vnet_softc *sc, struct vio_msg *);
226 1.1 palle void vnet_rx_vio_desc_data(struct vnet_softc *sc, struct vio_msg_tag *);
227 1.1 palle void vnet_rx_vio_dring_data(struct vnet_softc *sc, struct vio_msg_tag *);
228 1.1 palle
229 1.1 palle void vnet_ldc_reset(struct ldc_conn *);
230 1.1 palle void vnet_ldc_start(struct ldc_conn *);
231 1.1 palle
232 1.1 palle void vnet_sendmsg(struct vnet_softc *, void *, size_t);
233 1.1 palle void vnet_send_ver_info(struct vnet_softc *, uint16_t, uint16_t);
234 1.1 palle void vnet_send_attr_info(struct vnet_softc *);
235 1.1 palle void vnet_send_dring_reg(struct vnet_softc *);
236 1.1 palle void vio_send_rdx(struct vnet_softc *);
237 1.1 palle void vnet_send_dring_data(struct vnet_softc *, uint32_t);
238 1.1 palle
239 1.1 palle void vnet_start(struct ifnet *);
240 1.1 palle void vnet_start_desc(struct ifnet *);
241 1.3 palle int vnet_ioctl(struct ifnet *, u_long, void *);
242 1.1 palle void vnet_watchdog(struct ifnet *);
243 1.1 palle
244 1.1 palle int vnet_media_change(struct ifnet *);
245 1.1 palle void vnet_media_status(struct ifnet *, struct ifmediareq *);
246 1.1 palle
247 1.1 palle void vnet_link_state(struct vnet_softc *sc);
248 1.1 palle
249 1.1 palle void vnet_setmulti(struct vnet_softc *, int);
250 1.1 palle
251 1.3 palle int vnet_init(struct ifnet *);
252 1.3 palle void vnet_stop(struct ifnet *, int);
253 1.1 palle
254 1.1 palle int vnet_match(device_t parent, cfdata_t match, void *aux)
255 1.1 palle {
256 1.1 palle
257 1.1 palle struct cbus_attach_args *ca = aux;
258 1.3 palle
259 1.1 palle if (strcmp(ca->ca_name, "network") == 0)
260 1.1 palle return (1);
261 1.1 palle
262 1.1 palle return (0);
263 1.1 palle }
264 1.1 palle
265 1.1 palle void
266 1.1 palle vnet_attach(struct device *parent, struct device *self, void *aux)
267 1.1 palle {
268 1.1 palle struct vnet_softc *sc = device_private(self);
269 1.1 palle struct cbus_attach_args *ca = aux;
270 1.1 palle struct ldc_conn *lc;
271 1.1 palle struct ifnet *ifp;
272 1.1 palle
273 1.1 palle sc->sc_bustag = ca->ca_bustag;
274 1.1 palle sc->sc_dmatag = ca->ca_dmatag;
275 1.1 palle sc->sc_tx_ino = ca->ca_tx_ino;
276 1.1 palle sc->sc_rx_ino = ca->ca_rx_ino;
277 1.1 palle
278 1.2 palle printf(": ivec 0x%" PRIx64 ", 0x%" PRIx64, sc->sc_tx_ino, sc->sc_rx_ino);
279 1.1 palle
280 1.1 palle /*
281 1.1 palle * Un-configure queues before registering interrupt handlers,
282 1.1 palle * such that we dont get any stale LDC packets or events.
283 1.1 palle */
284 1.1 palle hv_ldc_tx_qconf(ca->ca_id, 0, 0);
285 1.1 palle hv_ldc_rx_qconf(ca->ca_id, 0, 0);
286 1.1 palle
287 1.1 palle #if 0
288 1.1 palle FIXME openbsd
289 1.1 palle sc->sc_tx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_tx_ino,
290 1.1 palle IPL_NET, BUS_INTR_ESTABLISH_MPSAFE, vnet_tx_intr,
291 1.1 palle sc, sc->sc_dv.dv_xname);
292 1.1 palle sc->sc_rx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_rx_ino,
293 1.1 palle IPL_NET, BUS_INTR_ESTABLISH_MPSAFE, vnet_rx_intr,
294 1.1 palle sc, sc->sc_dv.dv_xname);
295 1.1 palle if (sc->sc_tx_ih == NULL || sc->sc_rx_ih == NULL) {
296 1.1 palle printf(", can't establish interrupt\n");
297 1.1 palle return;
298 1.1 palle }
299 1.1 palle #else
300 1.1 palle sc->sc_tx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_tx_ino,
301 1.1 palle IPL_NET, vnet_tx_intr, sc);
302 1.1 palle sc->sc_rx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_rx_ino,
303 1.1 palle IPL_NET, vnet_rx_intr, sc);
304 1.1 palle if (sc->sc_tx_ih == NULL || sc->sc_rx_ih == NULL) {
305 1.1 palle printf(", can't establish interrupts\n");
306 1.1 palle return;
307 1.1 palle }
308 1.1 palle #endif
309 1.1 palle
310 1.1 palle lc = &sc->sc_lc;
311 1.1 palle lc->lc_id = ca->ca_id;
312 1.1 palle lc->lc_sc = sc;
313 1.1 palle lc->lc_reset = vnet_ldc_reset;
314 1.1 palle lc->lc_start = vnet_ldc_start;
315 1.1 palle lc->lc_rx_data = vio_rx_data;
316 1.1 palle
317 1.1 palle #if 0
318 1.1 palle FIXME openbsd
319 1.1 palle timeout_set(&sc->sc_handshake_to, vnet_handshake, sc);
320 1.3 palle #else
321 1.3 palle callout_init(&sc->sc_handshake_co, 0);
322 1.3 palle /* netbsd callout do silmilar function...*/
323 1.1 palle #endif
324 1.1 palle sc->sc_peer_state = VIO_DP_STOPPED;
325 1.1 palle
326 1.1 palle #if OPENBSD_BUSDMA
327 1.1 palle lc->lc_txq = ldc_queue_alloc(sc->sc_dmatag, VNET_TX_ENTRIES);
328 1.1 palle if (lc->lc_txq == NULL) {
329 1.1 palle printf(", can't allocate tx queue\n");
330 1.1 palle return;
331 1.1 palle }
332 1.1 palle
333 1.1 palle lc->lc_rxq = ldc_queue_alloc(sc->sc_dmatag, VNET_RX_ENTRIES);
334 1.1 palle if (lc->lc_rxq == NULL) {
335 1.1 palle printf(", can't allocate rx queue\n");
336 1.1 palle goto free_txqueue;
337 1.1 palle }
338 1.1 palle #else
339 1.1 palle lc->lc_txq = ldc_queue_alloc(VNET_TX_ENTRIES);
340 1.1 palle if (lc->lc_txq == NULL) {
341 1.1 palle printf(", can't allocate tx queue\n");
342 1.1 palle return;
343 1.1 palle }
344 1.1 palle
345 1.1 palle lc->lc_rxq = ldc_queue_alloc(VNET_RX_ENTRIES);
346 1.1 palle if (lc->lc_rxq == NULL) {
347 1.1 palle printf(", can't allocate rx queue\n");
348 1.1 palle goto free_txqueue;
349 1.1 palle }
350 1.1 palle #endif
351 1.1 palle
352 1.1 palle if (OF_getprop(ca->ca_node, "local-mac-address",
353 1.1 palle sc->sc_macaddr, ETHER_ADDR_LEN) > 0) {
354 1.1 palle printf(", address %s", ether_sprintf(sc->sc_macaddr));
355 1.1 palle } else {
356 1.1 palle printf(", cannot retrieve local mac address\n");
357 1.1 palle return;
358 1.1 palle }
359 1.1 palle
360 1.1 palle /*
361 1.1 palle * Each interface gets its own pool.
362 1.1 palle */
363 1.1 palle #if 0
364 1.1 palle FIXME openbsd
365 1.1 palle pool_init(&sc->sc_pool, 2048, 0, IPL_NET, 0, sc->sc_dv.dv_xname, NULL);
366 1.1 palle #else
367 1.1 palle pool_init(&sc->sc_pool, 2048, 0, 0, 0, sc->sc_dv.dv_xname, NULL, IPL_NET);
368 1.1 palle #endif
369 1.1 palle
370 1.1 palle ifp = &sc->sc_ethercom.ec_if;
371 1.1 palle ifp->if_softc = sc;
372 1.1 palle ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
373 1.3 palle #if 0
374 1.1 palle ifp->if_link_state = LINK_STATE_DOWN;
375 1.3 palle #endif
376 1.3 palle ifp->if_init = vnet_init;
377 1.1 palle ifp->if_ioctl = vnet_ioctl;
378 1.1 palle ifp->if_start = vnet_start;
379 1.3 palle ifp->if_stop = vnet_stop;
380 1.1 palle ifp->if_watchdog = vnet_watchdog;
381 1.1 palle strlcpy(ifp->if_xname, device_xname(self), IFNAMSIZ);
382 1.1 palle #if 0
383 1.1 palle FIXME openbsd
384 1.1 palle ifq_set_maxlen(&ifp->if_snd, 31); /* XXX */
385 1.1 palle #else
386 1.1 palle IFQ_SET_MAXLEN(&ifp->if_snd, 31); /* XXX */
387 1.1 palle #endif
388 1.1 palle
389 1.1 palle ifmedia_init(&sc->sc_media, 0, vnet_media_change, vnet_media_status);
390 1.1 palle ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_AUTO, 0, NULL);
391 1.1 palle ifmedia_set(&sc->sc_media, IFM_ETHER | IFM_AUTO);
392 1.1 palle
393 1.3 palle #if 0
394 1.1 palle int error = if_initialize(ifp);
395 1.1 palle if (error != 0) {
396 1.1 palle printf(", if_initialize() failed\n");
397 1.1 palle return;
398 1.1 palle }
399 1.1 palle ether_ifattach(ifp, sc->sc_macaddr);
400 1.1 palle if_register(ifp);
401 1.3 palle #else
402 1.3 palle if_attach(ifp);
403 1.3 palle ether_ifattach(ifp, sc->sc_macaddr);
404 1.3 palle #endif
405 1.1 palle printf("\n");
406 1.1 palle return;
407 1.1 palle free_txqueue:
408 1.1 palle #if OPENBSD_BUSDMA
409 1.1 palle ldc_queue_free(sc->sc_dmatag, lc->lc_txq);
410 1.1 palle #else
411 1.1 palle ldc_queue_free(lc->lc_txq);
412 1.1 palle #endif
413 1.1 palle }
414 1.1 palle
415 1.1 palle int
416 1.1 palle vnet_tx_intr(void *arg)
417 1.1 palle {
418 1.1 palle DPRINTF(("%s: entry\n", __func__));
419 1.1 palle
420 1.1 palle struct vnet_softc *sc = arg;
421 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
422 1.1 palle uint64_t tx_head, tx_tail, tx_state;
423 1.1 palle
424 1.1 palle hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
425 1.1 palle if (tx_state != lc->lc_tx_state) {
426 1.1 palle switch (tx_state) {
427 1.1 palle case LDC_CHANNEL_DOWN:
428 1.1 palle DPRINTF(("%s: Tx link down\n", __func__));
429 1.1 palle break;
430 1.1 palle case LDC_CHANNEL_UP:
431 1.1 palle DPRINTF(("%s: Tx link up\n", __func__));
432 1.1 palle break;
433 1.1 palle case LDC_CHANNEL_RESET:
434 1.1 palle DPRINTF(("%s: Tx link reset\n", __func__));
435 1.1 palle break;
436 1.1 palle }
437 1.1 palle lc->lc_tx_state = tx_state;
438 1.1 palle }
439 1.1 palle
440 1.1 palle DPRINTF(("%s: exit\n", __func__));
441 1.1 palle return (1);
442 1.1 palle }
443 1.1 palle
444 1.1 palle int
445 1.1 palle vnet_rx_intr(void *arg)
446 1.1 palle {
447 1.3 palle #if 0
448 1.1 palle DPRINTF(("%s: entry\n", __func__));
449 1.3 palle #endif
450 1.1 palle
451 1.1 palle struct vnet_softc *sc = arg;
452 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
453 1.1 palle uint64_t rx_head, rx_tail, rx_state;
454 1.1 palle struct ldc_pkt *lp;
455 1.1 palle int err;
456 1.1 palle
457 1.1 palle err = hv_ldc_rx_get_state(lc->lc_id, &rx_head, &rx_tail, &rx_state);
458 1.3 palle if (err == H_EINVAL) {
459 1.3 palle printf("hv_ldc_rx_get_state failed\n");
460 1.1 palle return (0);
461 1.3 palle }
462 1.1 palle if (err != H_EOK) {
463 1.1 palle printf("hv_ldc_rx_get_state %d\n", err);
464 1.1 palle return (0);
465 1.1 palle }
466 1.3 palle #if 0
467 1.3 palle DPRINTF(("%s: rx_state %" PRId64 " head %" PRId64 " tail %" PRId64 "\n",
468 1.3 palle __func__, rx_state, rx_head, rx_tail));
469 1.3 palle #endif
470 1.1 palle
471 1.1 palle if (rx_state != lc->lc_rx_state) {
472 1.3 palle #if 0
473 1.3 palle DPRINTF(("%s: rx_state %" PRId64 " != lc__rx_state %" PRId64 "\n",
474 1.3 palle __func__, rx_state, lc->lc_rx_state));
475 1.3 palle #endif
476 1.1 palle switch (rx_state) {
477 1.1 palle case LDC_CHANNEL_DOWN:
478 1.1 palle lc->lc_tx_seqid = 0;
479 1.1 palle lc->lc_state = 0;
480 1.1 palle lc->lc_reset(lc);
481 1.1 palle if (rx_head == rx_tail)
482 1.1 palle break;
483 1.1 palle /* Discard and ack pending I/O. */
484 1.3 palle DPRINTF(("setting rx qhead to %" PRId64 "\n", rx_tail));
485 1.1 palle err = hv_ldc_rx_set_qhead(lc->lc_id, rx_tail);
486 1.1 palle if (err == H_EOK)
487 1.1 palle break;
488 1.1 palle printf("%s: hv_ldc_rx_set_qhead %d\n", __func__, err);
489 1.1 palle break;
490 1.1 palle case LDC_CHANNEL_UP:
491 1.3 palle #if 0
492 1.1 palle DPRINTF(("%s: Rx link up\n", __func__));
493 1.3 palle #endif
494 1.1 palle #if 0
495 1.1 palle FIXME openbsd
496 1.1 palle timeout_add_msec(&sc->sc_handshake_to, 500);
497 1.3 palle #else
498 1.3 palle callout_reset(&sc->sc_handshake_co, hz / 2, vnet_handshake, sc);
499 1.1 palle #endif
500 1.1 palle break;
501 1.1 palle case LDC_CHANNEL_RESET:
502 1.1 palle DPRINTF(("%s: Rx link reset\n", __func__));
503 1.1 palle lc->lc_tx_seqid = 0;
504 1.1 palle lc->lc_state = 0;
505 1.1 palle lc->lc_reset(lc);
506 1.1 palle #if 0
507 1.1 palle FIXME openbsd
508 1.1 palle timeout_add_msec(&sc->sc_handshake_to, 500);
509 1.3 palle #else
510 1.3 palle callout_reset(&sc->sc_handshake_co, hz / 2, vnet_handshake, sc);
511 1.1 palle #endif
512 1.3 palle if (rx_head == rx_tail) {
513 1.3 palle #if 0
514 1.3 palle DPRINTF(("%s: rx_head == rx_head\n", __func__));
515 1.3 palle #endif
516 1.1 palle break;
517 1.3 palle }
518 1.1 palle /* Discard and ack pending I/O. */
519 1.3 palle DPRINTF(("setting rx qhead to %" PRId64 "\n", rx_tail));
520 1.1 palle err = hv_ldc_rx_set_qhead(lc->lc_id, rx_tail);
521 1.1 palle if (err == H_EOK)
522 1.1 palle break;
523 1.1 palle printf("%s: hv_ldc_rx_set_qhead %d\n", __func__, err);
524 1.1 palle break;
525 1.3 palle default:
526 1.3 palle DPRINTF(("%s: unhandled rx_state %" PRIx64 "\n", __func__, rx_state));
527 1.3 palle break;
528 1.1 palle }
529 1.1 palle lc->lc_rx_state = rx_state;
530 1.3 palle #if 0
531 1.3 palle DPRINTF(("%s: setting rx_state %" PRId64 " = lc__rx_state %" PRId64 "\n",
532 1.3 palle __func__, rx_state, lc->lc_rx_state));
533 1.3 palle #endif
534 1.1 palle return (1);
535 1.3 palle } else {
536 1.3 palle #if 0
537 1.3 palle DPRINTF(("%s: rx_state %" PRId64 " == lc__rx_state %" PRId64 "\n",
538 1.3 palle __func__, rx_state, lc->lc_rx_state));
539 1.3 palle #endif
540 1.1 palle }
541 1.1 palle
542 1.1 palle if (rx_head == rx_tail)
543 1.3 palle {
544 1.3 palle DPRINTF(("%s: head eq tail\n", __func__));
545 1.1 palle return (0);
546 1.3 palle }
547 1.2 palle lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_rxq->lq_va + rx_head);
548 1.3 palle #if 0
549 1.3 palle DPRINTF(("%s: lp->type %" PRId8 "\n", __func__, lp->type));
550 1.3 palle DPRINTF(("%s: lp->stype %" PRId8 "\n", __func__, lp->stype));
551 1.3 palle DPRINTF(("%s: lp->ctrl %" PRId8 "\n", __func__, lp->ctrl));
552 1.3 palle DPRINTF(("%s: lp->env %" PRId8 "\n", __func__, lp->env));
553 1.3 palle DPRINTF(("%s: lp->seqid %" PRId32 "\n", __func__, lp->seqid));
554 1.3 palle DPRINTF(("%s: lp->major %" PRId16 "\n", __func__, lp->major));
555 1.3 palle DPRINTF(("%s: lp->minor %" PRId16 "\n", __func__, lp->minor));
556 1.3 palle #endif
557 1.1 palle switch (lp->type) {
558 1.1 palle case LDC_CTRL:
559 1.3 palle #if 0
560 1.3 palle DPRINTF(("%s: LDC_CTRL\n", __func__));
561 1.3 palle #endif
562 1.1 palle ldc_rx_ctrl(lc, lp);
563 1.1 palle break;
564 1.1 palle
565 1.1 palle case LDC_DATA:
566 1.3 palle #if 0
567 1.3 palle DPRINTF(("%s: LDC_DATA\n", __func__));
568 1.3 palle #endif
569 1.1 palle ldc_rx_data(lc, lp);
570 1.1 palle break;
571 1.1 palle
572 1.1 palle default:
573 1.3 palle DPRINTF(("%s: unhandled type %0x02/%0x02/%0x02\n",
574 1.3 palle __func__, lp->type, lp->stype, lp->ctrl));
575 1.3 palle Debugger();
576 1.1 palle ldc_reset(lc);
577 1.1 palle break;
578 1.1 palle }
579 1.1 palle
580 1.1 palle if (lc->lc_state == 0)
581 1.1 palle return (1);
582 1.1 palle
583 1.1 palle rx_head += sizeof(*lp);
584 1.1 palle rx_head &= ((lc->lc_rxq->lq_nentries * sizeof(*lp)) - 1);
585 1.1 palle err = hv_ldc_rx_set_qhead(lc->lc_id, rx_head);
586 1.1 palle if (err != H_EOK)
587 1.1 palle printf("%s: hv_ldc_rx_set_qhead %d\n", __func__, err);
588 1.3 palle #if 0
589 1.1 palle DPRINTF(("%s: exit\n", __func__));
590 1.3 palle #endif
591 1.1 palle return (1);
592 1.1 palle }
593 1.1 palle
594 1.1 palle void
595 1.1 palle vnet_handshake(void *arg)
596 1.1 palle {
597 1.3 palle DPRINTF(("%s: entry\n", __func__));
598 1.3 palle
599 1.1 palle struct vnet_softc *sc = arg;
600 1.1 palle
601 1.1 palle ldc_send_vers(&sc->sc_lc);
602 1.1 palle }
603 1.1 palle
604 1.1 palle void
605 1.1 palle vio_rx_data(struct ldc_conn *lc, struct ldc_pkt *lp)
606 1.1 palle {
607 1.3 palle #if 0
608 1.3 palle DPRINTF(("%s: entry\n", __func__));
609 1.3 palle #endif
610 1.3 palle
611 1.1 palle struct vio_msg *vm = (struct vio_msg *)lp;
612 1.1 palle
613 1.1 palle switch (vm->type) {
614 1.1 palle case VIO_TYPE_CTRL:
615 1.1 palle if ((lp->env & LDC_FRAG_START) == 0 &&
616 1.3 palle (lp->env & LDC_FRAG_STOP) == 0) {
617 1.3 palle DPRINTF(("%s: FRAG_START==0 and FRAG_STOP==0\n", __func__));
618 1.1 palle return;
619 1.3 palle }
620 1.1 palle vnet_rx_vio_ctrl(lc->lc_sc, vm);
621 1.1 palle break;
622 1.1 palle
623 1.1 palle case VIO_TYPE_DATA:
624 1.3 palle if((lp->env & LDC_FRAG_START) == 0) {
625 1.3 palle DPRINTF(("%s: FRAG_START==0\n", __func__));
626 1.1 palle return;
627 1.3 palle }
628 1.1 palle vnet_rx_vio_data(lc->lc_sc, vm);
629 1.1 palle break;
630 1.1 palle
631 1.1 palle default:
632 1.1 palle DPRINTF(("Unhandled packet type 0x%02x\n", vm->type));
633 1.1 palle ldc_reset(lc);
634 1.1 palle break;
635 1.1 palle }
636 1.1 palle }
637 1.1 palle
638 1.1 palle void
639 1.1 palle vnet_rx_vio_ctrl(struct vnet_softc *sc, struct vio_msg *vm)
640 1.1 palle {
641 1.3 palle #if 0
642 1.3 palle DPRINTF(("%s: entry\n", __func__));
643 1.3 palle #endif
644 1.1 palle struct vio_msg_tag *tag = (struct vio_msg_tag *)&vm->type;
645 1.1 palle
646 1.1 palle switch (tag->stype_env) {
647 1.1 palle case VIO_VER_INFO:
648 1.1 palle vnet_rx_vio_ver_info(sc, tag);
649 1.1 palle break;
650 1.1 palle case VIO_ATTR_INFO:
651 1.1 palle vnet_rx_vio_attr_info(sc, tag);
652 1.1 palle break;
653 1.1 palle case VIO_DRING_REG:
654 1.1 palle vnet_rx_vio_dring_reg(sc, tag);
655 1.1 palle break;
656 1.1 palle case VIO_RDX:
657 1.1 palle vnet_rx_vio_rdx(sc, tag);
658 1.1 palle break;
659 1.4 palle case VNET_MCAST_INFO:
660 1.4 palle vnet_rx_vio_mcast_info(sc, tag);
661 1.4 palle break;
662 1.1 palle default:
663 1.3 palle printf("%s: CTRL/0x%02x/0x%04x FIXME\n",
664 1.3 palle __func__, tag->stype, tag->stype_env);
665 1.4 palle #if 0
666 1.4 palle Debugger();
667 1.4 palle #endif
668 1.1 palle break;
669 1.1 palle }
670 1.1 palle }
671 1.1 palle
672 1.1 palle void
673 1.1 palle vnet_rx_vio_ver_info(struct vnet_softc *sc, struct vio_msg_tag *tag)
674 1.1 palle {
675 1.3 palle #if 0
676 1.3 palle DPRINTF(("%s: entry\n", __func__));
677 1.3 palle #endif
678 1.1 palle struct vio_ver_info *vi = (struct vio_ver_info *)tag;
679 1.1 palle
680 1.1 palle switch (vi->tag.stype) {
681 1.1 palle case VIO_SUBTYPE_INFO:
682 1.3 palle #if 0
683 1.1 palle DPRINTF(("CTRL/INFO/VER_INFO\n"));
684 1.3 palle #endif
685 1.1 palle
686 1.1 palle /* Make sure we're talking to a virtual network device. */
687 1.1 palle if (vi->dev_class != VDEV_NETWORK &&
688 1.1 palle vi->dev_class != VDEV_NETWORK_SWITCH) {
689 1.3 palle DPRINTF(("Class is not network or network switch\n"));
690 1.1 palle /* Huh, we're not talking to a network device? */
691 1.1 palle printf("Not a network device\n");
692 1.1 palle vi->tag.stype = VIO_SUBTYPE_NACK;
693 1.1 palle vnet_sendmsg(sc, vi, sizeof(*vi));
694 1.1 palle return;
695 1.1 palle }
696 1.1 palle
697 1.1 palle if (vi->major != VNET_MAJOR) {
698 1.3 palle DPRINTF(("Major mismatch %" PRId8 " vs %" PRId8 "\n",
699 1.3 palle vi->major, VNET_MAJOR));
700 1.1 palle vi->tag.stype = VIO_SUBTYPE_NACK;
701 1.1 palle vi->major = VNET_MAJOR;
702 1.1 palle vi->minor = VNET_MINOR;
703 1.1 palle vnet_sendmsg(sc, vi, sizeof(*vi));
704 1.1 palle return;
705 1.1 palle }
706 1.1 palle
707 1.1 palle vi->tag.stype = VIO_SUBTYPE_ACK;
708 1.1 palle vi->tag.sid = sc->sc_local_sid;
709 1.1 palle vi->minor = VNET_MINOR;
710 1.1 palle vnet_sendmsg(sc, vi, sizeof(*vi));
711 1.1 palle sc->sc_vio_state |= VIO_RCV_VER_INFO;
712 1.1 palle break;
713 1.1 palle
714 1.1 palle case VIO_SUBTYPE_ACK:
715 1.3 palle #if 0
716 1.1 palle DPRINTF(("CTRL/ACK/VER_INFO\n"));
717 1.3 palle #endif
718 1.1 palle if (!ISSET(sc->sc_vio_state, VIO_SND_VER_INFO)) {
719 1.1 palle ldc_reset(&sc->sc_lc);
720 1.1 palle break;
721 1.1 palle }
722 1.1 palle sc->sc_vio_state |= VIO_ACK_VER_INFO;
723 1.1 palle break;
724 1.1 palle
725 1.1 palle default:
726 1.1 palle DPRINTF(("CTRL/0x%02x/VER_INFO\n", vi->tag.stype));
727 1.1 palle break;
728 1.1 palle }
729 1.1 palle
730 1.1 palle if (ISSET(sc->sc_vio_state, VIO_RCV_VER_INFO) &&
731 1.1 palle ISSET(sc->sc_vio_state, VIO_ACK_VER_INFO))
732 1.1 palle vnet_send_attr_info(sc);
733 1.1 palle }
734 1.1 palle
735 1.1 palle void
736 1.1 palle vnet_rx_vio_attr_info(struct vnet_softc *sc, struct vio_msg_tag *tag)
737 1.1 palle {
738 1.3 palle #if 0
739 1.3 palle DPRINTF(("%s: entry\n", __func__));
740 1.3 palle #endif
741 1.1 palle struct vnet_attr_info *ai = (struct vnet_attr_info *)tag;
742 1.1 palle
743 1.1 palle switch (ai->tag.stype) {
744 1.1 palle case VIO_SUBTYPE_INFO:
745 1.3 palle #if 0
746 1.1 palle DPRINTF(("CTRL/INFO/ATTR_INFO\n"));
747 1.3 palle #endif
748 1.1 palle sc->sc_xfer_mode = ai->xfer_mode;
749 1.4 palle #if 0
750 1.3 palle DPRINTF(("sc_xfer_mode %d\n", sc->sc_xfer_mode));
751 1.4 palle #endif
752 1.1 palle
753 1.1 palle ai->tag.stype = VIO_SUBTYPE_ACK;
754 1.1 palle ai->tag.sid = sc->sc_local_sid;
755 1.1 palle vnet_sendmsg(sc, ai, sizeof(*ai));
756 1.1 palle sc->sc_vio_state |= VIO_RCV_ATTR_INFO;
757 1.1 palle break;
758 1.1 palle
759 1.1 palle case VIO_SUBTYPE_ACK:
760 1.3 palle #if 0
761 1.1 palle DPRINTF(("CTRL/ACK/ATTR_INFO\n"));
762 1.3 palle #endif
763 1.1 palle if (!ISSET(sc->sc_vio_state, VIO_SND_ATTR_INFO)) {
764 1.1 palle ldc_reset(&sc->sc_lc);
765 1.1 palle break;
766 1.1 palle }
767 1.1 palle sc->sc_vio_state |= VIO_ACK_ATTR_INFO;
768 1.1 palle break;
769 1.1 palle
770 1.1 palle default:
771 1.1 palle DPRINTF(("CTRL/0x%02x/ATTR_INFO\n", ai->tag.stype));
772 1.1 palle break;
773 1.1 palle }
774 1.1 palle
775 1.1 palle if (ISSET(sc->sc_vio_state, VIO_RCV_ATTR_INFO) &&
776 1.1 palle ISSET(sc->sc_vio_state, VIO_ACK_ATTR_INFO)) {
777 1.1 palle if (sc->sc_xfer_mode == VIO_DRING_MODE)
778 1.1 palle vnet_send_dring_reg(sc);
779 1.1 palle else
780 1.1 palle vio_send_rdx(sc);
781 1.1 palle }
782 1.1 palle }
783 1.1 palle
784 1.1 palle void
785 1.1 palle vnet_rx_vio_dring_reg(struct vnet_softc *sc, struct vio_msg_tag *tag)
786 1.1 palle {
787 1.3 palle #if 0
788 1.3 palle DPRINTF(("%s: entry\n", __func__));
789 1.3 palle #endif
790 1.1 palle struct vio_dring_reg *dr = (struct vio_dring_reg *)tag;
791 1.1 palle
792 1.1 palle switch (dr->tag.stype) {
793 1.1 palle case VIO_SUBTYPE_INFO:
794 1.3 palle #if 0
795 1.1 palle DPRINTF(("CTRL/INFO/DRING_REG\n"));
796 1.3 palle #endif
797 1.1 palle
798 1.1 palle sc->sc_peer_dring_nentries = dr->num_descriptors;
799 1.1 palle sc->sc_peer_desc_size = dr->descriptor_size;
800 1.1 palle sc->sc_peer_dring_cookie = dr->cookie[0];
801 1.1 palle
802 1.1 palle dr->tag.stype = VIO_SUBTYPE_ACK;
803 1.1 palle dr->tag.sid = sc->sc_local_sid;
804 1.1 palle vnet_sendmsg(sc, dr, sizeof(*dr));
805 1.1 palle sc->sc_vio_state |= VIO_RCV_DRING_REG;
806 1.1 palle break;
807 1.1 palle
808 1.1 palle case VIO_SUBTYPE_ACK:
809 1.3 palle #if 0
810 1.1 palle DPRINTF(("CTRL/ACK/DRING_REG\n"));
811 1.3 palle #endif
812 1.1 palle if (!ISSET(sc->sc_vio_state, VIO_SND_DRING_REG)) {
813 1.1 palle ldc_reset(&sc->sc_lc);
814 1.1 palle break;
815 1.1 palle }
816 1.1 palle
817 1.1 palle sc->sc_dring_ident = dr->dring_ident;
818 1.1 palle sc->sc_seq_no = 1;
819 1.1 palle
820 1.1 palle sc->sc_vio_state |= VIO_ACK_DRING_REG;
821 1.1 palle break;
822 1.1 palle
823 1.1 palle default:
824 1.1 palle DPRINTF(("CTRL/0x%02x/DRING_REG\n", dr->tag.stype));
825 1.1 palle break;
826 1.1 palle }
827 1.1 palle
828 1.1 palle if (ISSET(sc->sc_vio_state, VIO_RCV_DRING_REG) &&
829 1.1 palle ISSET(sc->sc_vio_state, VIO_ACK_DRING_REG))
830 1.1 palle vio_send_rdx(sc);
831 1.1 palle }
832 1.1 palle
833 1.1 palle void
834 1.1 palle vnet_rx_vio_rdx(struct vnet_softc *sc, struct vio_msg_tag *tag)
835 1.1 palle {
836 1.1 palle #if 0
837 1.3 palle DPRINTF(("%s: entry\n", __func__));
838 1.3 palle #endif
839 1.3 palle #if 0
840 1.1 palle FIXME openbsd
841 1.1 palle struct ifnet *ifp = &sc->sc_ac.ac_if;
842 1.1 palle #else
843 1.1 palle struct ifnet *ifp = &sc->sc_ethercom.ec_if;
844 1.1 palle #endif
845 1.1 palle
846 1.1 palle switch(tag->stype) {
847 1.1 palle case VIO_SUBTYPE_INFO:
848 1.3 palle #if 0
849 1.1 palle DPRINTF(("CTRL/INFO/RDX\n"));
850 1.3 palle #endif
851 1.1 palle
852 1.1 palle tag->stype = VIO_SUBTYPE_ACK;
853 1.1 palle tag->sid = sc->sc_local_sid;
854 1.1 palle vnet_sendmsg(sc, tag, sizeof(*tag));
855 1.1 palle sc->sc_vio_state |= VIO_RCV_RDX;
856 1.1 palle break;
857 1.1 palle
858 1.1 palle case VIO_SUBTYPE_ACK:
859 1.3 palle #if 0
860 1.1 palle DPRINTF(("CTRL/ACK/RDX\n"));
861 1.3 palle #endif
862 1.1 palle if (!ISSET(sc->sc_vio_state, VIO_SND_RDX)) {
863 1.1 palle ldc_reset(&sc->sc_lc);
864 1.1 palle break;
865 1.1 palle }
866 1.1 palle sc->sc_vio_state |= VIO_ACK_RDX;
867 1.1 palle break;
868 1.1 palle
869 1.1 palle default:
870 1.1 palle DPRINTF(("CTRL/0x%02x/RDX (VIO)\n", tag->stype));
871 1.1 palle break;
872 1.1 palle }
873 1.1 palle
874 1.1 palle if (ISSET(sc->sc_vio_state, VIO_RCV_RDX) &&
875 1.1 palle ISSET(sc->sc_vio_state, VIO_ACK_RDX)) {
876 1.1 palle /* Link is up! */
877 1.1 palle vnet_link_state(sc);
878 1.1 palle
879 1.1 palle /* Configure multicast now that we can. */
880 1.1 palle vnet_setmulti(sc, 1);
881 1.1 palle
882 1.1 palle #if 0
883 1.1 palle FIXME openbsd
884 1.1 palle KERNEL_LOCK();
885 1.1 palle #else
886 1.1 palle KERNEL_LOCK(1, curlwp);
887 1.1 palle #endif
888 1.1 palle #if 0
889 1.1 palle FIXME openbsd
890 1.1 palle ifq_clr_oactive(&ifp->if_snd);
891 1.1 palle #else
892 1.1 palle ifp->if_flags &= ~IFF_OACTIVE;
893 1.1 palle #endif
894 1.1 palle vnet_start(ifp);
895 1.1 palle #if 0
896 1.1 palle FIXME openbsd
897 1.1 palle KERNEL_UNLOCK();
898 1.1 palle #else
899 1.1 palle KERNEL_UNLOCK_ONE(curlwp);
900 1.1 palle #endif
901 1.1 palle }
902 1.1 palle }
903 1.1 palle
904 1.1 palle void
905 1.4 palle vnet_rx_vio_mcast_info(struct vnet_softc *sc, struct vio_msg_tag *tag)
906 1.4 palle {
907 1.4 palle #if 0
908 1.4 palle DPRINTF(("%s: entry\n", __func__));
909 1.4 palle #endif
910 1.4 palle
911 1.4 palle switch(tag->stype) {
912 1.4 palle
913 1.4 palle case VIO_SUBTYPE_INFO:
914 1.4 palle #if 0
915 1.4 palle DPRINTF(("CTRL/INFO/MCAST_INFO\n"));
916 1.4 palle #endif
917 1.4 palle break;
918 1.4 palle
919 1.4 palle case VIO_SUBTYPE_ACK:
920 1.4 palle #if 0
921 1.4 palle DPRINTF(("CTRL/ACK/MCAST_INFO\n"));
922 1.4 palle #endif
923 1.4 palle break;
924 1.4 palle
925 1.4 palle case VIO_SUBTYPE_NACK:
926 1.4 palle #if 0
927 1.4 palle DPRINTF(("CTRL/NACK/MCAST_INFO\n"));
928 1.4 palle #endif
929 1.4 palle break;
930 1.4 palle
931 1.4 palle default:
932 1.4 palle printf("%s: CTRL/0x%02x/0x%04x\n",
933 1.4 palle __func__, tag->stype, tag->stype_env);
934 1.4 palle break;
935 1.4 palle }
936 1.4 palle }
937 1.4 palle
938 1.4 palle void
939 1.1 palle vnet_rx_vio_data(struct vnet_softc *sc, struct vio_msg *vm)
940 1.1 palle {
941 1.3 palle #if 0
942 1.3 palle DPRINTF(("%s: entry\n", __func__));
943 1.3 palle #endif
944 1.1 palle struct vio_msg_tag *tag = (struct vio_msg_tag *)&vm->type;
945 1.1 palle
946 1.1 palle if (!ISSET(sc->sc_vio_state, VIO_RCV_RDX) ||
947 1.1 palle !ISSET(sc->sc_vio_state, VIO_ACK_RDX)) {
948 1.1 palle DPRINTF(("Spurious DATA/0x%02x/0x%04x\n", tag->stype,
949 1.1 palle tag->stype_env));
950 1.1 palle return;
951 1.1 palle }
952 1.1 palle
953 1.1 palle switch(tag->stype_env) {
954 1.1 palle case VIO_DESC_DATA:
955 1.1 palle vnet_rx_vio_desc_data(sc, tag);
956 1.1 palle break;
957 1.1 palle
958 1.1 palle case VIO_DRING_DATA:
959 1.1 palle vnet_rx_vio_dring_data(sc, tag);
960 1.1 palle break;
961 1.1 palle
962 1.1 palle default:
963 1.1 palle DPRINTF(("DATA/0x%02x/0x%04x\n", tag->stype, tag->stype_env));
964 1.1 palle break;
965 1.1 palle }
966 1.1 palle }
967 1.1 palle
968 1.1 palle void
969 1.1 palle vnet_rx_vio_desc_data(struct vnet_softc *sc, struct vio_msg_tag *tag)
970 1.1 palle {
971 1.3 palle
972 1.3 palle DPRINTF(("%s: entry\n", __func__));
973 1.3 palle
974 1.1 palle struct vnet_desc_msg *dm = (struct vnet_desc_msg *)tag;
975 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
976 1.1 palle struct ldc_map *map = sc->sc_lm;
977 1.1 palle #if 0
978 1.1 palle FIXME openbsd
979 1.1 palle struct ifnet *ifp = &sc->sc_ac.ac_if;
980 1.1 palle #else
981 1.1 palle struct ifnet *ifp = &sc->sc_ethercom.ec_if;
982 1.1 palle #endif
983 1.1 palle #if 0
984 1.1 palle FIXME openbsd
985 1.1 palle struct mbuf_list ml = MBUF_LIST_INITIALIZER();
986 1.1 palle #endif
987 1.1 palle struct mbuf *m;
988 1.1 palle unsigned char *buf;
989 1.1 palle paddr_t pa;
990 1.1 palle psize_t nbytes;
991 1.1 palle u_int cons;
992 1.1 palle int err;
993 1.1 palle
994 1.1 palle switch(tag->stype) {
995 1.1 palle case VIO_SUBTYPE_INFO:
996 1.1 palle buf = pool_get(&sc->sc_pool, PR_NOWAIT|PR_ZERO);
997 1.1 palle if (buf == NULL) {
998 1.1 palle #if 0
999 1.1 palle FIXME openbsd
1000 1.1 palle ifp->if_ierrors++;
1001 1.1 palle #else
1002 1.1 palle if_statinc(ifp, if_ierrors);
1003 1.1 palle #endif
1004 1.1 palle goto skip;
1005 1.1 palle }
1006 1.1 palle nbytes = roundup(dm->nbytes, 8);
1007 1.1 palle
1008 1.1 palle if (dm->nbytes > (ETHER_MAX_LEN - ETHER_CRC_LEN)) {
1009 1.1 palle #if 0
1010 1.1 palle FIXME openbsd
1011 1.1 palle ifp->if_ierrors++;
1012 1.1 palle #else
1013 1.1 palle if_statinc(ifp, if_ierrors);
1014 1.1 palle #endif
1015 1.1 palle goto skip;
1016 1.1 palle }
1017 1.1 palle
1018 1.1 palle pmap_extract(pmap_kernel(), (vaddr_t)buf, &pa);
1019 1.1 palle err = hv_ldc_copy(lc->lc_id, LDC_COPY_IN,
1020 1.1 palle dm->cookie[0].addr, pa, nbytes, &nbytes);
1021 1.1 palle if (err != H_EOK) {
1022 1.1 palle pool_put(&sc->sc_pool, buf);
1023 1.1 palle #if 0
1024 1.1 palle FIXME openbsd
1025 1.1 palle ifp->if_ierrors++;
1026 1.1 palle #else
1027 1.1 palle if_statinc(ifp, if_ierrors);
1028 1.1 palle #endif
1029 1.1 palle goto skip;
1030 1.1 palle }
1031 1.1 palle
1032 1.1 palle /* Stupid OBP doesn't align properly. */
1033 1.1 palle #if 0
1034 1.1 palle FIXME openbsd
1035 1.1 palle m = m_devget(buf, dm->nbytes, ETHER_ALIGN);
1036 1.1 palle #else
1037 1.1 palle m = m_devget(buf, dm->nbytes, 0, ifp);
1038 1.1 palle #endif
1039 1.1 palle pool_put(&sc->sc_pool, buf);
1040 1.1 palle if (m == NULL) {
1041 1.1 palle #if 0
1042 1.1 palle FIXME openbsd
1043 1.1 palle ifp->if_ierrors++;
1044 1.1 palle #else
1045 1.1 palle if_statinc(ifp, if_ierrors);
1046 1.1 palle #endif
1047 1.1 palle goto skip;
1048 1.1 palle }
1049 1.1 palle
1050 1.1 palle /* Pass it on. */
1051 1.1 palle #if 0
1052 1.1 palle FIXME openbsd
1053 1.1 palle ml_enqueue(&ml, m);
1054 1.1 palle if_input(ifp, &ml);
1055 1.1 palle #else
1056 1.1 palle if_percpuq_enqueue(ifp->if_percpuq, m);
1057 1.1 palle #endif
1058 1.1 palle skip:
1059 1.1 palle dm->tag.stype = VIO_SUBTYPE_ACK;
1060 1.1 palle dm->tag.sid = sc->sc_local_sid;
1061 1.1 palle vnet_sendmsg(sc, dm, sizeof(*dm));
1062 1.1 palle break;
1063 1.1 palle
1064 1.1 palle case VIO_SUBTYPE_ACK:
1065 1.1 palle DPRINTF(("DATA/ACK/DESC_DATA\n"));
1066 1.1 palle
1067 1.1 palle if (dm->desc_handle != sc->sc_tx_cons) {
1068 1.1 palle printf("out of order\n");
1069 1.1 palle return;
1070 1.1 palle }
1071 1.1 palle
1072 1.1 palle cons = sc->sc_tx_cons & (sc->sc_vd->vd_nentries - 1);
1073 1.1 palle
1074 1.1 palle map->lm_slot[sc->sc_vsd[cons].vsd_map_idx].entry = 0;
1075 1.1 palle #if 0
1076 1.1 palle FIXME openbsd
1077 1.1 palle atomic_dec_int(&map->lm_count);
1078 1.1 palle #else
1079 1.1 palle map->lm_count--;
1080 1.1 palle #endif
1081 1.1 palle
1082 1.1 palle pool_put(&sc->sc_pool, sc->sc_vsd[cons].vsd_buf);
1083 1.1 palle sc->sc_vsd[cons].vsd_buf = NULL;
1084 1.1 palle
1085 1.1 palle sc->sc_tx_cons++;
1086 1.1 palle break;
1087 1.1 palle
1088 1.1 palle case VIO_SUBTYPE_NACK:
1089 1.1 palle DPRINTF(("DATA/NACK/DESC_DATA\n"));
1090 1.1 palle break;
1091 1.1 palle
1092 1.1 palle default:
1093 1.1 palle DPRINTF(("DATA/0x%02x/DESC_DATA\n", tag->stype));
1094 1.1 palle break;
1095 1.1 palle }
1096 1.1 palle }
1097 1.1 palle
1098 1.1 palle void
1099 1.1 palle vnet_rx_vio_dring_data(struct vnet_softc *sc, struct vio_msg_tag *tag)
1100 1.1 palle {
1101 1.3 palle #if 0
1102 1.3 palle DPRINTF(("%s: entry\n", __func__));
1103 1.3 palle #endif
1104 1.3 palle
1105 1.1 palle struct vio_dring_msg *dm = (struct vio_dring_msg *)tag;
1106 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
1107 1.1 palle #if 0
1108 1.1 palle FIXME openbsd
1109 1.1 palle struct ifnet *ifp = &sc->sc_ac.ac_if;
1110 1.1 palle #else
1111 1.1 palle struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1112 1.1 palle #endif
1113 1.3 palle #if 1
1114 1.1 palle struct mbuf *m = NULL;
1115 1.3 palle #endif
1116 1.1 palle paddr_t pa;
1117 1.1 palle psize_t nbytes;
1118 1.1 palle int err;
1119 1.1 palle
1120 1.1 palle switch(tag->stype) {
1121 1.1 palle case VIO_SUBTYPE_INFO:
1122 1.1 palle {
1123 1.4 palle #if 0
1124 1.3 palle DPRINTF(("%s: VIO_SUBTYPE_INFO\n", __func__));
1125 1.3 palle #endif
1126 1.1 palle struct vnet_desc desc;
1127 1.1 palle uint64_t cookie;
1128 1.1 palle paddr_t desc_pa;
1129 1.1 palle int idx, ack_end_idx = -1;
1130 1.1 palle #if 0
1131 1.1 palle FIXME openbsd
1132 1.1 palle struct mbuf_list ml = MBUF_LIST_INITIALIZER();
1133 1.1 palle #endif
1134 1.1 palle
1135 1.1 palle idx = dm->start_idx;
1136 1.1 palle for (;;) {
1137 1.1 palle cookie = sc->sc_peer_dring_cookie.addr;
1138 1.1 palle cookie += idx * sc->sc_peer_desc_size;
1139 1.1 palle nbytes = sc->sc_peer_desc_size;
1140 1.1 palle pmap_extract(pmap_kernel(), (vaddr_t)&desc, &desc_pa);
1141 1.1 palle err = hv_ldc_copy(lc->lc_id, LDC_COPY_IN, cookie,
1142 1.1 palle desc_pa, nbytes, &nbytes);
1143 1.1 palle if (err != H_EOK) {
1144 1.1 palle printf("hv_ldc_copy_in %d\n", err);
1145 1.1 palle break;
1146 1.1 palle }
1147 1.1 palle
1148 1.1 palle if (desc.hdr.dstate != VIO_DESC_READY)
1149 1.1 palle break;
1150 1.1 palle
1151 1.1 palle if (desc.nbytes > (ETHER_MAX_LEN - ETHER_CRC_LEN)) {
1152 1.1 palle #if 0
1153 1.1 palle FIXME openbsd
1154 1.1 palle ifp->if_ierrors++;
1155 1.1 palle #else
1156 1.1 palle if_statinc(ifp, if_ierrors);
1157 1.1 palle #endif
1158 1.1 palle goto skip;
1159 1.1 palle }
1160 1.1 palle #if 0
1161 1.1 palle FIXME openbsd
1162 1.1 palle m = MCLGETI(NULL, M_DONTWAIT, NULL, desc.nbytes);
1163 1.1 palle if (!m)
1164 1.1 palle break;
1165 1.1 palle #else
1166 1.3 palle #if 1
1167 1.3 palle #if 0
1168 1.3 palle DPRINTF(("%s: before MGETHDR\n", __func__));
1169 1.3 palle #endif
1170 1.3 palle MGETHDR(m, M_DONTWAIT, MT_DATA);
1171 1.3 palle #if 0
1172 1.3 palle DPRINTF(("%s: after MGETHDR\n", __func__));
1173 1.3 palle #endif
1174 1.3 palle if (m == NULL) {
1175 1.3 palle DPRINTF(("%s: MGETHDR failed\n", __func__));
1176 1.3 palle if_statinc(ifp, if_ierrors);
1177 1.3 palle goto skip;
1178 1.3 palle }
1179 1.3 palle #if 0
1180 1.3 palle DPRINTF(("%s: before MCLGET\n", __func__));
1181 1.3 palle #endif
1182 1.3 palle MCLGET(m, M_DONTWAIT);
1183 1.1 palle if ((m->m_flags & M_EXT) == 0)
1184 1.1 palle break;
1185 1.3 palle #if 0
1186 1.3 palle DPRINTF(("%s: after MCLGET\n", __func__));
1187 1.3 palle #endif
1188 1.3 palle #endif
1189 1.3 palle #endif
1190 1.3 palle #if 1
1191 1.1 palle m->m_len = m->m_pkthdr.len = desc.nbytes;
1192 1.3 palle #endif
1193 1.1 palle nbytes = roundup(desc.nbytes + VNET_ETHER_ALIGN, 8);
1194 1.4 palle #if 0
1195 1.4 palle DPRINTF(("%s: RX frame size %" PRId16 "\n",
1196 1.4 palle __func__, (int)nbytes));
1197 1.3 palle uint8_t buf[ETHER_MAX_LEN];
1198 1.3 palle pmap_extract(pmap_kernel(), (vaddr_t)buf, &pa);
1199 1.3 palle err = hv_ldc_copy(lc->lc_id, LDC_COPY_IN,
1200 1.3 palle desc.cookie[0].addr, pa, nbytes, &nbytes);
1201 1.3 palle if (err != H_EOK) {
1202 1.3 palle //m_freem(m);
1203 1.3 palle goto skip;
1204 1.3 palle }
1205 1.3 palle for (int i = 0; i < desc.nbytes; i++) {
1206 1.3 palle if (i % 16 == 0) {
1207 1.4 palle DPRINTF(("\n"));
1208 1.3 palle }
1209 1.4 palle DPRINTF(("%02x ", buf[i]));
1210 1.3 palle }
1211 1.4 palle DPRINTF(("\n"));
1212 1.4 palle DPRINTF(("\n"));
1213 1.3 palle #endif
1214 1.3 palle #if 1
1215 1.1 palle pmap_extract(pmap_kernel(), (vaddr_t)m->m_data, &pa);
1216 1.1 palle err = hv_ldc_copy(lc->lc_id, LDC_COPY_IN,
1217 1.1 palle desc.cookie[0].addr, pa, nbytes, &nbytes);
1218 1.1 palle if (err != H_EOK) {
1219 1.1 palle m_freem(m);
1220 1.1 palle goto skip;
1221 1.1 palle }
1222 1.1 palle m->m_data += VNET_ETHER_ALIGN;
1223 1.4 palle m_set_rcvif(m, ifp);
1224 1.1 palle
1225 1.1 palle #if 0
1226 1.1 palle FIXME openbsd
1227 1.1 palle ml_enqueue(&ml, m);
1228 1.3 palle #else
1229 1.3 palle #if 0
1230 1.3 palle DPRINTF(("%s: before if_percpuq_enqueue\n", __func__));
1231 1.3 palle #endif
1232 1.1 palle if_percpuq_enqueue(ifp->if_percpuq, m);
1233 1.3 palle #if 0
1234 1.3 palle DPRINTF(("%s: after if_percpuq_enqueue\n", __func__));
1235 1.3 palle #endif
1236 1.1 palle #endif
1237 1.3 palle #endif
1238 1.1 palle
1239 1.1 palle skip:
1240 1.1 palle desc.hdr.dstate = VIO_DESC_DONE;
1241 1.1 palle nbytes = sc->sc_peer_desc_size;
1242 1.1 palle err = hv_ldc_copy(lc->lc_id, LDC_COPY_OUT, cookie,
1243 1.1 palle desc_pa, nbytes, &nbytes);
1244 1.1 palle if (err != H_EOK)
1245 1.1 palle printf("hv_ldc_copy_out %d\n", err);
1246 1.1 palle
1247 1.1 palle ack_end_idx = idx;
1248 1.1 palle if (++idx == sc->sc_peer_dring_nentries)
1249 1.1 palle idx = 0;
1250 1.1 palle }
1251 1.1 palle #if 0
1252 1.1 palle FIXME openbd
1253 1.1 palle if_input(ifp, &ml);
1254 1.1 palle #else
1255 1.3 palle // FIXME??? printf("vnet_rx_vio_dring_data() ignoring if_input - FIXME\n");
1256 1.1 palle #endif
1257 1.1 palle
1258 1.1 palle if (ack_end_idx == -1) {
1259 1.1 palle dm->tag.stype = VIO_SUBTYPE_NACK;
1260 1.1 palle } else {
1261 1.1 palle dm->tag.stype = VIO_SUBTYPE_ACK;
1262 1.1 palle dm->end_idx = ack_end_idx;
1263 1.1 palle }
1264 1.1 palle dm->tag.sid = sc->sc_local_sid;
1265 1.1 palle dm->proc_state = VIO_DP_STOPPED;
1266 1.1 palle vnet_sendmsg(sc, dm, sizeof(*dm));
1267 1.1 palle break;
1268 1.1 palle }
1269 1.1 palle
1270 1.1 palle case VIO_SUBTYPE_ACK:
1271 1.1 palle {
1272 1.4 palle #if 0
1273 1.3 palle DPRINTF(("%s: VIO_SUBTYPE_ACK\n", __func__));
1274 1.3 palle #endif
1275 1.1 palle struct ldc_map *map = sc->sc_lm;
1276 1.1 palle u_int cons, count;
1277 1.1 palle
1278 1.1 palle sc->sc_peer_state = dm->proc_state;
1279 1.1 palle
1280 1.1 palle cons = sc->sc_tx_cons & (sc->sc_vd->vd_nentries - 1);
1281 1.1 palle while (sc->sc_vd->vd_desc[cons].hdr.dstate == VIO_DESC_DONE) {
1282 1.1 palle map->lm_slot[sc->sc_vsd[cons].vsd_map_idx].entry = 0;
1283 1.1 palle #if 0
1284 1.1 palle FIXME openbsd
1285 1.1 palle atomic_dec_int(&map->lm_count);
1286 1.1 palle #else
1287 1.1 palle map->lm_count--;
1288 1.1 palle #endif
1289 1.1 palle
1290 1.1 palle pool_put(&sc->sc_pool, sc->sc_vsd[cons].vsd_buf);
1291 1.1 palle sc->sc_vsd[cons].vsd_buf = NULL;
1292 1.1 palle
1293 1.1 palle sc->sc_vd->vd_desc[cons].hdr.dstate = VIO_DESC_FREE;
1294 1.1 palle sc->sc_tx_cons++;
1295 1.1 palle cons = sc->sc_tx_cons & (sc->sc_vd->vd_nentries - 1);
1296 1.1 palle }
1297 1.1 palle
1298 1.1 palle count = sc->sc_tx_prod - sc->sc_tx_cons;
1299 1.1 palle if (count > 0 && sc->sc_peer_state != VIO_DP_ACTIVE)
1300 1.1 palle vnet_send_dring_data(sc, cons);
1301 1.1 palle
1302 1.1 palle #if 0
1303 1.1 palle FIXME openbsd
1304 1.1 palle KERNEL_LOCK();
1305 1.1 palle #else
1306 1.1 palle KERNEL_LOCK(1, curlwp);
1307 1.1 palle #endif
1308 1.1 palle if (count < (sc->sc_vd->vd_nentries - 1))
1309 1.1 palle #if 0
1310 1.1 palle FIXME openbsd
1311 1.1 palle ifq_clr_oactive(&ifp->if_snd);
1312 1.1 palle #else
1313 1.1 palle ifp->if_flags &= ~IFF_OACTIVE;
1314 1.1 palle #endif
1315 1.1 palle if (count == 0)
1316 1.1 palle ifp->if_timer = 0;
1317 1.1 palle
1318 1.1 palle vnet_start(ifp);
1319 1.1 palle #if 0
1320 1.1 palle FIXME openbsd
1321 1.1 palle KERNEL_UNLOCK();
1322 1.1 palle #else
1323 1.1 palle KERNEL_UNLOCK_ONE(curlwp);
1324 1.1 palle #endif
1325 1.1 palle break;
1326 1.1 palle }
1327 1.1 palle
1328 1.1 palle case VIO_SUBTYPE_NACK:
1329 1.1 palle DPRINTF(("DATA/NACK/DRING_DATA\n"));
1330 1.1 palle sc->sc_peer_state = VIO_DP_STOPPED;
1331 1.1 palle break;
1332 1.1 palle
1333 1.1 palle default:
1334 1.1 palle DPRINTF(("DATA/0x%02x/DRING_DATA\n", tag->stype));
1335 1.1 palle break;
1336 1.1 palle }
1337 1.1 palle }
1338 1.1 palle
1339 1.1 palle void
1340 1.1 palle vnet_ldc_reset(struct ldc_conn *lc)
1341 1.1 palle {
1342 1.3 palle
1343 1.3 palle DPRINTF(("%s: entry\n", __func__));
1344 1.3 palle
1345 1.1 palle struct vnet_softc *sc = lc->lc_sc;
1346 1.1 palle int i;
1347 1.1 palle #if 0
1348 1.1 palle FIXME openbsd
1349 1.1 palle timeout_del(&sc->sc_handshake_to);
1350 1.3 palle #else
1351 1.3 palle callout_stop(&sc->sc_handshake_co);
1352 1.1 palle #endif
1353 1.1 palle sc->sc_tx_prod = sc->sc_tx_cons = 0;
1354 1.1 palle sc->sc_peer_state = VIO_DP_STOPPED;
1355 1.1 palle sc->sc_vio_state = 0;
1356 1.1 palle vnet_link_state(sc);
1357 1.1 palle
1358 1.1 palle sc->sc_lm->lm_next = 1;
1359 1.1 palle sc->sc_lm->lm_count = 1;
1360 1.1 palle for (i = 1; i < sc->sc_lm->lm_nentries; i++)
1361 1.1 palle sc->sc_lm->lm_slot[i].entry = 0;
1362 1.1 palle
1363 1.1 palle for (i = 0; i < sc->sc_vd->vd_nentries; i++) {
1364 1.1 palle if (sc->sc_vsd[i].vsd_buf) {
1365 1.1 palle pool_put(&sc->sc_pool, sc->sc_vsd[i].vsd_buf);
1366 1.1 palle sc->sc_vsd[i].vsd_buf = NULL;
1367 1.1 palle }
1368 1.1 palle sc->sc_vd->vd_desc[i].hdr.dstate = VIO_DESC_FREE;
1369 1.1 palle }
1370 1.1 palle }
1371 1.1 palle
1372 1.1 palle void
1373 1.1 palle vnet_ldc_start(struct ldc_conn *lc)
1374 1.1 palle {
1375 1.3 palle #if 0
1376 1.3 palle DPRINTF(("%s: entry\n", __func__));
1377 1.3 palle #endif
1378 1.3 palle
1379 1.1 palle struct vnet_softc *sc = lc->lc_sc;
1380 1.1 palle #if 0
1381 1.1 palle FIXME openbsd
1382 1.1 palle timeout_del(&sc->sc_handshake_to);
1383 1.3 palle #else
1384 1.3 palle callout_stop(&sc->sc_handshake_co);
1385 1.1 palle #endif
1386 1.1 palle vnet_send_ver_info(sc, VNET_MAJOR, VNET_MINOR);
1387 1.1 palle }
1388 1.1 palle
1389 1.1 palle void
1390 1.1 palle vnet_sendmsg(struct vnet_softc *sc, void *msg, size_t len)
1391 1.1 palle {
1392 1.3 palle #if 0
1393 1.3 palle DPRINTF(("%s: entry\n", __func__));
1394 1.3 palle #endif
1395 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
1396 1.1 palle int err;
1397 1.1 palle
1398 1.1 palle err = ldc_send_unreliable(lc, msg, len);
1399 1.1 palle if (err)
1400 1.1 palle printf("%s: ldc_send_unreliable: %d\n", __func__, err);
1401 1.1 palle }
1402 1.1 palle
1403 1.1 palle void
1404 1.1 palle vnet_send_ver_info(struct vnet_softc *sc, uint16_t major, uint16_t minor)
1405 1.1 palle {
1406 1.3 palle #if 0
1407 1.3 palle DPRINTF(("%s: entry\n", __func__));
1408 1.3 palle #endif
1409 1.1 palle struct vio_ver_info vi;
1410 1.1 palle
1411 1.1 palle bzero(&vi, sizeof(vi));
1412 1.1 palle vi.tag.type = VIO_TYPE_CTRL;
1413 1.1 palle vi.tag.stype = VIO_SUBTYPE_INFO;
1414 1.1 palle vi.tag.stype_env = VIO_VER_INFO;
1415 1.1 palle vi.tag.sid = sc->sc_local_sid;
1416 1.1 palle vi.major = major;
1417 1.1 palle vi.minor = minor;
1418 1.1 palle vi.dev_class = VDEV_NETWORK;
1419 1.1 palle vnet_sendmsg(sc, &vi, sizeof(vi));
1420 1.1 palle
1421 1.1 palle sc->sc_vio_state |= VIO_SND_VER_INFO;
1422 1.1 palle }
1423 1.1 palle
1424 1.1 palle void
1425 1.1 palle vnet_send_attr_info(struct vnet_softc *sc)
1426 1.1 palle {
1427 1.3 palle #if 0
1428 1.3 palle DPRINTF(("%s: entry\n", __func__));
1429 1.3 palle #endif
1430 1.1 palle struct vnet_attr_info ai;
1431 1.1 palle int i;
1432 1.1 palle
1433 1.1 palle bzero(&ai, sizeof(ai));
1434 1.1 palle ai.tag.type = VIO_TYPE_CTRL;
1435 1.1 palle ai.tag.stype = VIO_SUBTYPE_INFO;
1436 1.1 palle ai.tag.stype_env = VIO_ATTR_INFO;
1437 1.1 palle ai.tag.sid = sc->sc_local_sid;
1438 1.1 palle ai.xfer_mode = VIO_DRING_MODE;
1439 1.1 palle ai.addr_type = VNET_ADDR_ETHERMAC;
1440 1.1 palle ai.ack_freq = 0;
1441 1.1 palle ai.addr = 0;
1442 1.1 palle for (i = 0; i < ETHER_ADDR_LEN; i++) {
1443 1.1 palle ai.addr <<= 8;
1444 1.1 palle ai.addr |= sc->sc_macaddr[i];
1445 1.1 palle }
1446 1.1 palle ai.mtu = ETHER_MAX_LEN - ETHER_CRC_LEN;
1447 1.4 palle #if 0
1448 1.4 palle DPRINTF(("%s: ai.addr %" PRIx64 "\n",
1449 1.4 palle __func__, ai.addr));
1450 1.4 palle DPRINTF(("%s: ai.mtu %" PRId64 "\n",
1451 1.4 palle __func__, ai.mtu));
1452 1.4 palle #endif
1453 1.1 palle vnet_sendmsg(sc, &ai, sizeof(ai));
1454 1.1 palle
1455 1.1 palle sc->sc_vio_state |= VIO_SND_ATTR_INFO;
1456 1.1 palle }
1457 1.1 palle
1458 1.1 palle void
1459 1.1 palle vnet_send_dring_reg(struct vnet_softc *sc)
1460 1.1 palle {
1461 1.4 palle #if 0
1462 1.3 palle DPRINTF(("%s: entry\n", __func__));
1463 1.3 palle #endif
1464 1.3 palle
1465 1.1 palle struct vio_dring_reg dr;
1466 1.1 palle
1467 1.1 palle bzero(&dr, sizeof(dr));
1468 1.1 palle dr.tag.type = VIO_TYPE_CTRL;
1469 1.1 palle dr.tag.stype = VIO_SUBTYPE_INFO;
1470 1.1 palle dr.tag.stype_env = VIO_DRING_REG;
1471 1.1 palle dr.tag.sid = sc->sc_local_sid;
1472 1.1 palle dr.dring_ident = 0;
1473 1.1 palle dr.num_descriptors = sc->sc_vd->vd_nentries;
1474 1.1 palle dr.descriptor_size = sizeof(struct vnet_desc);
1475 1.1 palle dr.options = VIO_TX_RING;
1476 1.1 palle dr.ncookies = 1;
1477 1.1 palle dr.cookie[0].addr = 0;
1478 1.1 palle dr.cookie[0].size = PAGE_SIZE;
1479 1.1 palle vnet_sendmsg(sc, &dr, sizeof(dr));
1480 1.1 palle
1481 1.1 palle sc->sc_vio_state |= VIO_SND_DRING_REG;
1482 1.1 palle };
1483 1.1 palle
1484 1.1 palle void
1485 1.1 palle vio_send_rdx(struct vnet_softc *sc)
1486 1.1 palle {
1487 1.4 palle #if 0
1488 1.3 palle DPRINTF(("%s: entry\n", __func__));
1489 1.3 palle #endif
1490 1.1 palle struct vio_msg_tag tag;
1491 1.1 palle
1492 1.1 palle tag.type = VIO_TYPE_CTRL;
1493 1.1 palle tag.stype = VIO_SUBTYPE_INFO;
1494 1.1 palle tag.stype_env = VIO_RDX;
1495 1.1 palle tag.sid = sc->sc_local_sid;
1496 1.1 palle vnet_sendmsg(sc, &tag, sizeof(tag));
1497 1.1 palle
1498 1.1 palle sc->sc_vio_state |= VIO_SND_RDX;
1499 1.1 palle }
1500 1.1 palle
1501 1.1 palle void
1502 1.1 palle vnet_send_dring_data(struct vnet_softc *sc, uint32_t start_idx)
1503 1.1 palle {
1504 1.3 palle #if 0
1505 1.3 palle DPRINTF(("%s: entry\n", __func__));
1506 1.3 palle #endif
1507 1.1 palle struct vio_dring_msg dm;
1508 1.1 palle u_int peer_state;
1509 1.1 palle
1510 1.1 palle peer_state = atomic_swap_uint(&sc->sc_peer_state, VIO_DP_ACTIVE);
1511 1.4 palle if (peer_state == VIO_DP_ACTIVE) {
1512 1.4 palle DPRINTF(("%s: peer_state == VIO_DP_ACTIVE\n", __func__));
1513 1.1 palle return;
1514 1.4 palle }
1515 1.1 palle
1516 1.1 palle bzero(&dm, sizeof(dm));
1517 1.1 palle dm.tag.type = VIO_TYPE_DATA;
1518 1.1 palle dm.tag.stype = VIO_SUBTYPE_INFO;
1519 1.1 palle dm.tag.stype_env = VIO_DRING_DATA;
1520 1.1 palle dm.tag.sid = sc->sc_local_sid;
1521 1.1 palle dm.seq_no = sc->sc_seq_no++;
1522 1.4 palle #if 0
1523 1.4 palle DPRINTF(("%s: dm.seq_no %" PRId64 "\n",
1524 1.4 palle __func__, dm.seq_no));
1525 1.4 palle #endif
1526 1.1 palle dm.dring_ident = sc->sc_dring_ident;
1527 1.1 palle dm.start_idx = start_idx;
1528 1.1 palle dm.end_idx = -1;
1529 1.1 palle vnet_sendmsg(sc, &dm, sizeof(dm));
1530 1.4 palle #if 0
1531 1.4 palle DPRINTF(("%s: exit\n", __func__));
1532 1.4 palle #endif
1533 1.1 palle }
1534 1.1 palle
1535 1.1 palle void
1536 1.1 palle vnet_start(struct ifnet *ifp)
1537 1.1 palle {
1538 1.3 palle #if 0
1539 1.3 palle DPRINTF(("%s: entry\n", __func__));
1540 1.3 palle #endif
1541 1.1 palle struct vnet_softc *sc = ifp->if_softc;
1542 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
1543 1.1 palle struct ldc_map *map = sc->sc_lm;
1544 1.1 palle struct mbuf *m;
1545 1.1 palle paddr_t pa;
1546 1.1 palle unsigned char *buf;
1547 1.1 palle uint64_t tx_head, tx_tail, tx_state;
1548 1.1 palle u_int start, prod, count;
1549 1.1 palle int err;
1550 1.1 palle #if 0
1551 1.1 palle FIXME openbsd
1552 1.1 palle if (!(ifp->if_flags & IFF_RUNNING) || ifq_is_oactive(&ifp->if_snd))
1553 1.3 palle return;
1554 1.1 palle #else
1555 1.3 palle if (!(ifp->if_flags & IFF_RUNNING))
1556 1.3 palle {
1557 1.3 palle DPRINTF(("%s: not in RUNNING state\n", __func__));
1558 1.3 palle return;
1559 1.3 palle }
1560 1.3 palle if (ifp->if_flags & IFF_OACTIVE)
1561 1.3 palle {
1562 1.3 palle DPRINTF(("%s: already active\n", __func__));
1563 1.3 palle return;
1564 1.3 palle }
1565 1.1 palle #endif
1566 1.1 palle
1567 1.1 palle #if 0
1568 1.1 palle FIXME openbsd
1569 1.1 palle if (ifq_empty(&ifp->if_snd))
1570 1.1 palle #else
1571 1.1 palle if (IFQ_IS_EMPTY(&ifp->if_snd))
1572 1.3 palle #endif
1573 1.3 palle {
1574 1.3 palle #if 0
1575 1.3 palle DPRINTF(("%s: queue is empty\n", __func__));
1576 1.3 palle #endif
1577 1.1 palle return;
1578 1.4 palle } else {
1579 1.4 palle #if 0
1580 1.4 palle DPRINTF(("%s: queue size %d\n", __func__, ifp->if_snd.ifq_len));
1581 1.4 palle #endif
1582 1.3 palle }
1583 1.1 palle
1584 1.1 palle /*
1585 1.1 palle * We cannot transmit packets until a VIO connection has been
1586 1.1 palle * established.
1587 1.1 palle */
1588 1.1 palle if (!ISSET(sc->sc_vio_state, VIO_RCV_RDX) ||
1589 1.1 palle !ISSET(sc->sc_vio_state, VIO_ACK_RDX))
1590 1.3 palle {
1591 1.4 palle #if 0
1592 1.3 palle DPRINTF(("%s: vio connection not established yet\n", __func__));
1593 1.3 palle #endif
1594 1.1 palle return;
1595 1.3 palle }
1596 1.1 palle
1597 1.1 palle /*
1598 1.1 palle * Make sure there is room in the LDC transmit queue to send a
1599 1.1 palle * DRING_DATA message.
1600 1.1 palle */
1601 1.1 palle err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
1602 1.3 palle if (err != H_EOK) {
1603 1.3 palle DPRINTF(("%s: no room in ldc transmit queue\n", __func__));
1604 1.1 palle return;
1605 1.3 palle }
1606 1.1 palle tx_tail += sizeof(struct ldc_pkt);
1607 1.1 palle tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(struct ldc_pkt)) - 1);
1608 1.1 palle if (tx_tail == tx_head) {
1609 1.1 palle #if 0
1610 1.1 palle FIXME openbsd
1611 1.1 palle ifq_set_oactive(&ifp->if_snd);
1612 1.1 palle #else
1613 1.1 palle ifp->if_flags |= IFF_OACTIVE;
1614 1.3 palle #endif
1615 1.3 palle {
1616 1.3 palle DPRINTF(("%s: tail equals head\n", __func__));
1617 1.3 palle return;
1618 1.3 palle }
1619 1.1 palle }
1620 1.1 palle
1621 1.1 palle if (sc->sc_xfer_mode == VIO_DESC_MODE) {
1622 1.3 palle DPRINTF(("%s: vio_desc_mode\n", __func__));
1623 1.1 palle vnet_start_desc(ifp);
1624 1.1 palle return;
1625 1.1 palle }
1626 1.1 palle
1627 1.1 palle start = prod = sc->sc_tx_prod & (sc->sc_vd->vd_nentries - 1);
1628 1.1 palle while (sc->sc_vd->vd_desc[prod].hdr.dstate == VIO_DESC_FREE) {
1629 1.1 palle count = sc->sc_tx_prod - sc->sc_tx_cons;
1630 1.4 palle #if 0
1631 1.4 palle DPRINTF(("%s: count %d\n", __func__, count));
1632 1.4 palle #endif
1633 1.1 palle if (count >= (sc->sc_vd->vd_nentries - 1) ||
1634 1.1 palle map->lm_count >= map->lm_nentries) {
1635 1.4 palle DPRINTF(("%s: count issue\n", __func__));
1636 1.1 palle #if 0
1637 1.1 palle FIXME openbsd
1638 1.1 palle ifq_set_oactive(&ifp->if_snd);
1639 1.1 palle #else
1640 1.1 palle ifp->if_flags |= IFF_OACTIVE;
1641 1.1 palle #endif
1642 1.1 palle break;
1643 1.1 palle }
1644 1.1 palle
1645 1.1 palle buf = pool_get(&sc->sc_pool, PR_NOWAIT|PR_ZERO);
1646 1.1 palle if (buf == NULL) {
1647 1.4 palle DPRINTF(("%s: buff is NULL\n", __func__));
1648 1.1 palle #if 0
1649 1.1 palle FIXME openbsd
1650 1.1 palle ifq_set_oactive(&ifp->if_snd);
1651 1.1 palle #else
1652 1.1 palle ifp->if_flags |= IFF_OACTIVE;
1653 1.1 palle #endif
1654 1.1 palle break;
1655 1.1 palle }
1656 1.1 palle #if 0
1657 1.1 palle FIXME openbsd
1658 1.1 palle m = ifq_dequeue(&ifp->if_snd);
1659 1.1 palle #else
1660 1.1 palle IFQ_DEQUEUE(&ifp->if_snd, m);
1661 1.1 palle #endif
1662 1.1 palle if (m == NULL) {
1663 1.4 palle #if 0
1664 1.4 palle DPRINTF(("%s: m is NULL\n", __func__));
1665 1.4 palle #endif
1666 1.1 palle pool_put(&sc->sc_pool, buf);
1667 1.1 palle break;
1668 1.4 palle } else {
1669 1.4 palle #if 0
1670 1.4 palle DPRINTF(("%s: m is not NULL\n", __func__));
1671 1.4 palle #endif
1672 1.1 palle }
1673 1.1 palle
1674 1.4 palle #if 1
1675 1.1 palle m_copydata(m, 0, m->m_pkthdr.len, buf + VNET_ETHER_ALIGN);
1676 1.4 palle #if 0
1677 1.4 palle DPRINTF(("%s: TX frame size %" PRId16 "\n",
1678 1.4 palle __func__, m->m_pkthdr.len));
1679 1.4 palle for (int i = 0; i < m->m_pkthdr.len; i++) {
1680 1.4 palle if (i % 16 == 0) {
1681 1.4 palle DPRINTF(("\n"));
1682 1.4 palle }
1683 1.4 palle DPRINTF(("%02x ", buf[VNET_ETHER_ALIGN+i]));
1684 1.4 palle }
1685 1.4 palle DPRINTF(("\n"));
1686 1.4 palle #endif
1687 1.4 palle #else
1688 1.4 palle m_copydata(m, 0, m->m_pkthdr.len, buf);
1689 1.4 palle DPRINTF(("%s: TX frame size %" PRId16 "\n",
1690 1.4 palle __func__, m->m_pkthdr.len));
1691 1.4 palle for (int i = 0; i < m->m_pkthdr.len; i++) {
1692 1.4 palle if (i % 16 == 0) {
1693 1.4 palle DPRINTF(("\n"));
1694 1.4 palle }
1695 1.4 palle DPRINTF(("%02x ", buf[i]));
1696 1.4 palle }
1697 1.4 palle DPRINTF(("\n"));
1698 1.4 palle #endif
1699 1.1 palle #if NBPFILTER > 0
1700 1.1 palle /*
1701 1.1 palle * If BPF is listening on this interface, let it see the
1702 1.1 palle * packet before we commit it to the wire.
1703 1.1 palle */
1704 1.1 palle if (ifp->if_bpf)
1705 1.4 palle {
1706 1.4 palle DPRINTF(("%s: before bpf\n", __func__));
1707 1.1 palle bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_OUT);
1708 1.4 palle DPRINTF(("%s: after bpf\n", __func__));
1709 1.4 palle }
1710 1.1 palle #endif
1711 1.1 palle
1712 1.1 palle pmap_extract(pmap_kernel(), (vaddr_t)buf, &pa);
1713 1.1 palle KASSERT((pa & ~PAGE_MASK) == (pa & LDC_MTE_RA_MASK));
1714 1.1 palle while (map->lm_slot[map->lm_next].entry != 0) {
1715 1.1 palle map->lm_next++;
1716 1.1 palle map->lm_next &= (map->lm_nentries - 1);
1717 1.1 palle }
1718 1.1 palle map->lm_slot[map->lm_next].entry = (pa & LDC_MTE_RA_MASK);
1719 1.1 palle map->lm_slot[map->lm_next].entry |= LDC_MTE_CPR;
1720 1.1 palle #if 0
1721 1.1 palle FIXME openbsd
1722 1.1 palle atomic_inc_int(&map->lm_count);
1723 1.1 palle #else
1724 1.1 palle map->lm_count++;
1725 1.1 palle #endif
1726 1.1 palle #if 0
1727 1.1 palle FIXME openbsd
1728 1.1 palle sc->sc_vd->vd_desc[prod].nbytes = max(m->m_pkthdr.len, 60);
1729 1.1 palle #else
1730 1.1 palle sc->sc_vd->vd_desc[prod].nbytes = MAX(m->m_pkthdr.len, 60);
1731 1.1 palle #endif
1732 1.1 palle sc->sc_vd->vd_desc[prod].ncookies = 1;
1733 1.1 palle sc->sc_vd->vd_desc[prod].cookie[0].addr =
1734 1.1 palle map->lm_next << PAGE_SHIFT | (pa & PAGE_MASK);
1735 1.1 palle sc->sc_vd->vd_desc[prod].cookie[0].size = 2048;
1736 1.1 palle membar_producer();
1737 1.1 palle sc->sc_vd->vd_desc[prod].hdr.dstate = VIO_DESC_READY;
1738 1.1 palle
1739 1.1 palle sc->sc_vsd[prod].vsd_map_idx = map->lm_next;
1740 1.1 palle sc->sc_vsd[prod].vsd_buf = buf;
1741 1.1 palle
1742 1.1 palle sc->sc_tx_prod++;
1743 1.1 palle prod = sc->sc_tx_prod & (sc->sc_vd->vd_nentries - 1);
1744 1.1 palle
1745 1.1 palle m_freem(m);
1746 1.1 palle }
1747 1.1 palle
1748 1.1 palle membar_producer();
1749 1.1 palle
1750 1.1 palle if (start != prod && sc->sc_peer_state != VIO_DP_ACTIVE) {
1751 1.4 palle #if 0
1752 1.4 palle DPRINTF(("%s: before vnet_send_dring_data()\n", __func__));
1753 1.4 palle #endif
1754 1.1 palle vnet_send_dring_data(sc, start);
1755 1.1 palle ifp->if_timer = 5;
1756 1.4 palle } else {
1757 1.4 palle DPRINTF(("%s: no vnet_send_dring_data()\n", __func__));
1758 1.1 palle }
1759 1.4 palle
1760 1.4 palle #if 0
1761 1.3 palle DPRINTF(("%s: exit\n", __func__));
1762 1.3 palle #endif
1763 1.1 palle }
1764 1.1 palle
1765 1.1 palle void
1766 1.1 palle vnet_start_desc(struct ifnet *ifp)
1767 1.1 palle {
1768 1.3 palle
1769 1.3 palle DPRINTF(("%s: entry\n", __func__));
1770 1.3 palle
1771 1.1 palle struct vnet_softc *sc = ifp->if_softc;
1772 1.1 palle struct ldc_map *map = sc->sc_lm;
1773 1.1 palle struct vnet_desc_msg dm;
1774 1.1 palle struct mbuf *m;
1775 1.1 palle paddr_t pa;
1776 1.1 palle unsigned char *buf;
1777 1.1 palle u_int prod, count;
1778 1.1 palle
1779 1.1 palle for (;;) {
1780 1.1 palle count = sc->sc_tx_prod - sc->sc_tx_cons;
1781 1.1 palle if (count >= (sc->sc_vd->vd_nentries - 1) ||
1782 1.1 palle map->lm_count >= map->lm_nentries) {
1783 1.1 palle #if 0
1784 1.1 palle FIXME openbsd
1785 1.1 palle ifq_set_oactive(&ifp->if_snd);
1786 1.1 palle #else
1787 1.1 palle ifp->if_flags |= IFF_OACTIVE;
1788 1.1 palle #endif
1789 1.1 palle return;
1790 1.1 palle }
1791 1.1 palle
1792 1.1 palle buf = pool_get(&sc->sc_pool, PR_NOWAIT|PR_ZERO);
1793 1.1 palle if (buf == NULL) {
1794 1.1 palle #if 0
1795 1.1 palle FIXME openbsd
1796 1.1 palle ifq_set_oactive(&ifp->if_snd);
1797 1.1 palle #else
1798 1.1 palle ifp->if_flags |= IFF_OACTIVE;
1799 1.1 palle #endif
1800 1.1 palle return;
1801 1.1 palle }
1802 1.1 palle
1803 1.1 palle #if 0
1804 1.1 palle FIXME openbsd
1805 1.1 palle m = ifq_dequeue(&ifp->if_snd);
1806 1.1 palle #else
1807 1.1 palle IFQ_DEQUEUE(&ifp->if_snd, m);
1808 1.1 palle #endif
1809 1.1 palle
1810 1.1 palle if (m == NULL) {
1811 1.1 palle pool_put(&sc->sc_pool, buf);
1812 1.1 palle return;
1813 1.1 palle }
1814 1.1 palle
1815 1.1 palle m_copydata(m, 0, m->m_pkthdr.len, buf);
1816 1.1 palle
1817 1.1 palle #if NBPFILTER > 0
1818 1.1 palle /*
1819 1.1 palle * If BPF is listening on this interface, let it see the
1820 1.1 palle * packet before we commit it to the wire.
1821 1.1 palle */
1822 1.1 palle if (ifp->if_bpf)
1823 1.1 palle bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_OUT);
1824 1.1 palle #endif
1825 1.1 palle
1826 1.1 palle pmap_extract(pmap_kernel(), (vaddr_t)buf, &pa);
1827 1.1 palle KASSERT((pa & ~PAGE_MASK) == (pa & LDC_MTE_RA_MASK));
1828 1.1 palle while (map->lm_slot[map->lm_next].entry != 0) {
1829 1.1 palle map->lm_next++;
1830 1.1 palle map->lm_next &= (map->lm_nentries - 1);
1831 1.1 palle }
1832 1.1 palle map->lm_slot[map->lm_next].entry = (pa & LDC_MTE_RA_MASK);
1833 1.1 palle map->lm_slot[map->lm_next].entry |= LDC_MTE_CPR;
1834 1.1 palle #if 0
1835 1.1 palle FIXME openbsd
1836 1.1 palle atomic_inc_int(&map->lm_count);
1837 1.1 palle #else
1838 1.1 palle map->lm_count++;
1839 1.1 palle #endif
1840 1.1 palle
1841 1.1 palle prod = sc->sc_tx_prod & (sc->sc_vd->vd_nentries - 1);
1842 1.1 palle sc->sc_vsd[prod].vsd_map_idx = map->lm_next;
1843 1.1 palle sc->sc_vsd[prod].vsd_buf = buf;
1844 1.1 palle
1845 1.1 palle bzero(&dm, sizeof(dm));
1846 1.1 palle dm.tag.type = VIO_TYPE_DATA;
1847 1.1 palle dm.tag.stype = VIO_SUBTYPE_INFO;
1848 1.1 palle dm.tag.stype_env = VIO_DESC_DATA;
1849 1.1 palle dm.tag.sid = sc->sc_local_sid;
1850 1.1 palle dm.seq_no = sc->sc_seq_no++;
1851 1.1 palle dm.desc_handle = sc->sc_tx_prod;
1852 1.1 palle #if 0
1853 1.1 palle FIXME openbsd
1854 1.1 palle dm.nbytes = max(m->m_pkthdr.len, 60);
1855 1.1 palle #else
1856 1.1 palle dm.nbytes = MAX(m->m_pkthdr.len, 60);
1857 1.1 palle #endif
1858 1.1 palle dm.ncookies = 1;
1859 1.1 palle dm.cookie[0].addr =
1860 1.1 palle map->lm_next << PAGE_SHIFT | (pa & PAGE_MASK);
1861 1.1 palle dm.cookie[0].size = 2048;
1862 1.1 palle vnet_sendmsg(sc, &dm, sizeof(dm));
1863 1.1 palle
1864 1.1 palle sc->sc_tx_prod++;
1865 1.1 palle sc->sc_tx_prod &= (sc->sc_vd->vd_nentries - 1);
1866 1.1 palle
1867 1.1 palle m_freem(m);
1868 1.1 palle }
1869 1.1 palle }
1870 1.1 palle
1871 1.1 palle int
1872 1.1 palle vnet_ioctl(struct ifnet *ifp, u_long cmd, void* data)
1873 1.1 palle {
1874 1.3 palle #if 0
1875 1.3 palle DPRINTF(("%s: entry\n", __func__));
1876 1.3 palle #endif
1877 1.1 palle struct vnet_softc *sc = ifp->if_softc;
1878 1.1 palle struct ifreq *ifr = (struct ifreq *)data;
1879 1.1 palle int s, error = 0;
1880 1.1 palle
1881 1.1 palle s = splnet();
1882 1.1 palle
1883 1.1 palle switch (cmd) {
1884 1.1 palle
1885 1.1 palle case SIOCSIFADDR:
1886 1.1 palle ifp->if_flags |= IFF_UP;
1887 1.1 palle /* FALLTHROUGH */
1888 1.1 palle case SIOCSIFFLAGS:
1889 1.1 palle if (ifp->if_flags & IFF_UP) {
1890 1.1 palle if ((ifp->if_flags & IFF_RUNNING) == 0)
1891 1.1 palle vnet_init(ifp);
1892 1.1 palle } else {
1893 1.1 palle if (ifp->if_flags & IFF_RUNNING)
1894 1.3 palle vnet_stop(ifp, 0);
1895 1.1 palle }
1896 1.1 palle break;
1897 1.1 palle
1898 1.1 palle case SIOCGIFMEDIA:
1899 1.1 palle case SIOCSIFMEDIA:
1900 1.1 palle error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
1901 1.1 palle break;
1902 1.1 palle
1903 1.1 palle case SIOCADDMULTI:
1904 1.1 palle case SIOCDELMULTI:
1905 1.1 palle /*
1906 1.1 palle * XXX Removing all multicast addresses and adding
1907 1.1 palle * most of them back, is somewhat retarded.
1908 1.1 palle */
1909 1.1 palle vnet_setmulti(sc, 0);
1910 1.1 palle error = ether_ioctl(ifp, cmd, data);
1911 1.1 palle vnet_setmulti(sc, 1);
1912 1.1 palle if (error == ENETRESET)
1913 1.1 palle error = 0;
1914 1.1 palle break;
1915 1.1 palle
1916 1.1 palle default:
1917 1.1 palle error = ether_ioctl(ifp, cmd, data);
1918 1.1 palle }
1919 1.1 palle
1920 1.1 palle splx(s);
1921 1.1 palle
1922 1.1 palle return (error);
1923 1.1 palle }
1924 1.1 palle
1925 1.1 palle void
1926 1.1 palle vnet_watchdog(struct ifnet *ifp)
1927 1.1 palle {
1928 1.3 palle
1929 1.3 palle DPRINTF(("%s: entry\n", __func__));
1930 1.3 palle
1931 1.1 palle struct vnet_softc *sc = ifp->if_softc;
1932 1.1 palle
1933 1.1 palle printf("%s: watchdog timeout\n", sc->sc_dv.dv_xname);
1934 1.1 palle }
1935 1.1 palle
1936 1.1 palle int
1937 1.1 palle vnet_media_change(struct ifnet *ifp)
1938 1.1 palle {
1939 1.4 palle #if 0
1940 1.3 palle DPRINTF(("%s: entry\n", __func__));
1941 1.4 palle #endif
1942 1.3 palle
1943 1.1 palle return (0);
1944 1.1 palle }
1945 1.1 palle
1946 1.1 palle void
1947 1.1 palle vnet_media_status(struct ifnet *ifp, struct ifmediareq *imr)
1948 1.1 palle {
1949 1.4 palle #if 0
1950 1.3 palle DPRINTF(("%s: entry\n", __func__));
1951 1.4 palle #endif
1952 1.3 palle
1953 1.1 palle imr->ifm_active = IFM_ETHER | IFM_AUTO;
1954 1.1 palle imr->ifm_status = IFM_AVALID;
1955 1.1 palle #if 0
1956 1.1 palle FIXME openbsd
1957 1.1 palle if (LINK_STATE_IS_UP(ifp->if_link_state) &&
1958 1.1 palle #else
1959 1.1 palle if (ifp->if_link_state == LINK_STATE_UP &&
1960 1.1 palle #endif
1961 1.1 palle ifp->if_flags & IFF_UP)
1962 1.1 palle imr->ifm_status |= IFM_ACTIVE;
1963 1.1 palle }
1964 1.1 palle
1965 1.1 palle void
1966 1.1 palle vnet_link_state(struct vnet_softc *sc)
1967 1.1 palle {
1968 1.1 palle #if 0
1969 1.3 palle DPRINTF(("%s: entry\n", __func__));
1970 1.3 palle #endif
1971 1.3 palle
1972 1.3 palle #if 0
1973 1.1 palle FIXME openbsd
1974 1.1 palle struct ifnet *ifp = &sc->sc_ac.ac_if;
1975 1.1 palle #else
1976 1.1 palle struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1977 1.1 palle #endif
1978 1.1 palle int link_state = LINK_STATE_DOWN;
1979 1.1 palle
1980 1.1 palle #if 0
1981 1.1 palle FIXME openbsd
1982 1.1 palle KERNEL_LOCK();
1983 1.1 palle #else
1984 1.1 palle KERNEL_LOCK(1, curlwp);
1985 1.1 palle #endif
1986 1.1 palle if (ISSET(sc->sc_vio_state, VIO_RCV_RDX) &&
1987 1.1 palle ISSET(sc->sc_vio_state, VIO_ACK_RDX))
1988 1.1 palle #if 0
1989 1.1 palle FIXME openbsd
1990 1.1 palle link_state = LINK_STATE_FULL_DUPLEX;
1991 1.1 palle #else
1992 1.1 palle link_state = LINK_STATE_UP;
1993 1.1 palle #endif
1994 1.1 palle if (ifp->if_link_state != link_state) {
1995 1.1 palle #if 0
1996 1.1 palle FIXME openbsd
1997 1.1 palle ifp->if_link_state = link_state;
1998 1.1 palle if_link_state_change(ifp);
1999 1.1 palle #else
2000 1.1 palle if_link_state_change(ifp, link_state);
2001 1.1 palle #endif
2002 1.1 palle }
2003 1.1 palle #if 0
2004 1.1 palle FIXME openbsd
2005 1.1 palle KERNEL_UNLOCK();
2006 1.1 palle #else
2007 1.1 palle KERNEL_UNLOCK_ONE(curlwp);
2008 1.1 palle #endif
2009 1.1 palle }
2010 1.1 palle
2011 1.1 palle void
2012 1.1 palle vnet_setmulti(struct vnet_softc *sc, int set)
2013 1.1 palle {
2014 1.3 palle #if 0
2015 1.3 palle DPRINTF(("%s: entry\n", __func__));
2016 1.3 palle #endif
2017 1.1 palle struct ethercom *ec = &sc->sc_ethercom;
2018 1.1 palle struct ether_multi *enm;
2019 1.1 palle struct ether_multistep step;
2020 1.1 palle struct vnet_mcast_info mi;
2021 1.1 palle int count = 0;
2022 1.1 palle
2023 1.1 palle if (!ISSET(sc->sc_vio_state, VIO_RCV_RDX) ||
2024 1.1 palle !ISSET(sc->sc_vio_state, VIO_ACK_RDX))
2025 1.1 palle return;
2026 1.1 palle
2027 1.1 palle bzero(&mi, sizeof(mi));
2028 1.1 palle mi.tag.type = VIO_TYPE_CTRL;
2029 1.1 palle mi.tag.stype = VIO_SUBTYPE_INFO;
2030 1.1 palle mi.tag.stype_env = VNET_MCAST_INFO;
2031 1.1 palle mi.tag.sid = sc->sc_local_sid;
2032 1.1 palle mi.set = set ? 1 : 0;
2033 1.1 palle #if 0
2034 1.1 palle FIXME openbsd
2035 1.1 palle KERNEL_LOCK();
2036 1.1 palle #else
2037 1.1 palle KERNEL_LOCK(1, curlwp);
2038 1.1 palle #endif
2039 1.1 palle ETHER_FIRST_MULTI(step, ec, enm);
2040 1.1 palle while (enm != NULL) {
2041 1.1 palle /* XXX What about multicast ranges? */
2042 1.1 palle bcopy(enm->enm_addrlo, mi.mcast_addr[count], ETHER_ADDR_LEN);
2043 1.1 palle ETHER_NEXT_MULTI(step, enm);
2044 1.1 palle
2045 1.1 palle count++;
2046 1.1 palle if (count < VNET_NUM_MCAST)
2047 1.1 palle continue;
2048 1.1 palle
2049 1.1 palle mi.count = VNET_NUM_MCAST;
2050 1.1 palle vnet_sendmsg(sc, &mi, sizeof(mi));
2051 1.1 palle count = 0;
2052 1.1 palle }
2053 1.1 palle
2054 1.1 palle if (count > 0) {
2055 1.1 palle mi.count = count;
2056 1.1 palle vnet_sendmsg(sc, &mi, sizeof(mi));
2057 1.1 palle }
2058 1.1 palle #if 0
2059 1.1 palle FIXME openbsd
2060 1.1 palle KERNEL_UNLOCK();
2061 1.1 palle #else
2062 1.1 palle KERNEL_UNLOCK_ONE(curlwp);
2063 1.1 palle #endif
2064 1.1 palle }
2065 1.1 palle
2066 1.1 palle
2067 1.3 palle int
2068 1.1 palle vnet_init(struct ifnet *ifp)
2069 1.1 palle {
2070 1.3 palle #if 0
2071 1.3 palle DPRINTF(("%s: entry\n", __func__));
2072 1.3 palle #endif
2073 1.3 palle
2074 1.1 palle struct vnet_softc *sc = ifp->if_softc;
2075 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
2076 1.1 palle int err;
2077 1.1 palle vaddr_t va;
2078 1.1 palle paddr_t pa;
2079 1.1 palle #if OPENBSD_BUSDMA
2080 1.1 palle sc->sc_lm = ldc_map_alloc(sc->sc_dmatag, 2048);
2081 1.1 palle #else
2082 1.1 palle sc->sc_lm = ldc_map_alloc(2048);
2083 1.1 palle #endif
2084 1.1 palle if (sc->sc_lm == NULL)
2085 1.3 palle return ENOMEM;
2086 1.1 palle
2087 1.1 palle #if OPENBSD_BUSDMA
2088 1.1 palle err = hv_ldc_set_map_table(lc->lc_id,
2089 1.1 palle sc->sc_lm->lm_map->dm_segs[0].ds_addr, sc->sc_lm->lm_nentries);
2090 1.1 palle #else
2091 1.1 palle va = (vaddr_t)sc->sc_lm->lm_slot;
2092 1.1 palle pa = 0;
2093 1.1 palle if (pmap_extract(pmap_kernel(), va, &pa) == FALSE)
2094 1.1 palle panic("pmap_extract failed %lx\n", va);
2095 1.1 palle err = hv_ldc_set_map_table(lc->lc_id, pa, 2048);
2096 1.1 palle #endif
2097 1.1 palle if (err != H_EOK) {
2098 1.1 palle printf("hv_ldc_set_map_table %d\n", err);
2099 1.3 palle return EINVAL;
2100 1.1 palle }
2101 1.1 palle
2102 1.1 palle sc->sc_vd = vnet_dring_alloc(sc->sc_dmatag, VNET_NUM_SOFT_DESC);
2103 1.1 palle if (sc->sc_vd == NULL)
2104 1.3 palle return ENOMEM;
2105 1.1 palle sc->sc_vsd = malloc(VNET_NUM_SOFT_DESC * sizeof(*sc->sc_vsd), M_DEVBUF,
2106 1.1 palle M_NOWAIT|M_ZERO);
2107 1.1 palle if (sc->sc_vsd == NULL)
2108 1.3 palle return ENOMEM;
2109 1.1 palle
2110 1.3 palle #if OPENBSD_BUSDMA
2111 1.1 palle sc->sc_lm->lm_slot[0].entry = sc->sc_vd->vd_map->dm_segs[0].ds_addr;
2112 1.3 palle #else
2113 1.3 palle va = (vaddr_t)sc->sc_vd->vd_desc;
2114 1.3 palle pa = 0;
2115 1.3 palle if (pmap_extract(pmap_kernel(), va, &pa) == FALSE)
2116 1.3 palle panic("pmap_extract failed %lx\n", va);
2117 1.3 palle sc->sc_lm->lm_slot[0].entry = pa;
2118 1.3 palle #endif
2119 1.1 palle sc->sc_lm->lm_slot[0].entry &= LDC_MTE_RA_MASK;
2120 1.1 palle sc->sc_lm->lm_slot[0].entry |= LDC_MTE_CPR | LDC_MTE_CPW;
2121 1.1 palle sc->sc_lm->lm_next = 1;
2122 1.1 palle sc->sc_lm->lm_count = 1;
2123 1.3 palle
2124 1.3 palle va = lc->lc_txq->lq_va;
2125 1.3 palle pa = 0;
2126 1.3 palle if (pmap_extract(pmap_kernel(), va, &pa) == FALSE)
2127 1.3 palle panic("pmap_extract failed %lx\n", va);
2128 1.1 palle #if OPENBSD_BUSDMA
2129 1.1 palle err = hv_ldc_tx_qconf(lc->lc_id,
2130 1.1 palle lc->lc_txq->lq_map->dm_segs[0].ds_addr, lc->lc_txq->lq_nentries);
2131 1.1 palle #else
2132 1.1 palle err = hv_ldc_tx_qconf(lc->lc_id, pa, lc->lc_txq->lq_nentries);
2133 1.1 palle #endif
2134 1.1 palle if (err != H_EOK)
2135 1.1 palle printf("hv_ldc_tx_qconf %d\n", err);
2136 1.3 palle
2137 1.3 palle va = (vaddr_t)lc->lc_rxq->lq_va;
2138 1.3 palle pa = 0;
2139 1.3 palle if (pmap_extract(pmap_kernel(), va, &pa) == FALSE)
2140 1.3 palle panic("pmap_extract failed %lx\n", va);
2141 1.1 palle
2142 1.1 palle #if OPENBSD_BUSDMA
2143 1.1 palle err = hv_ldc_rx_qconf(lc->lc_id,
2144 1.1 palle lc->lc_rxq->lq_map->dm_segs[0].ds_addr, lc->lc_rxq->lq_nentries);
2145 1.1 palle #else
2146 1.1 palle err = hv_ldc_rx_qconf(lc->lc_id, pa, lc->lc_rxq->lq_nentries);
2147 1.1 palle #endif
2148 1.1 palle if (err != H_EOK)
2149 1.1 palle printf("hv_ldc_rx_qconf %d\n", err);
2150 1.1 palle
2151 1.1 palle cbus_intr_setenabled(sc->sc_bustag, sc->sc_tx_ino, INTR_ENABLED);
2152 1.1 palle cbus_intr_setenabled(sc->sc_bustag, sc->sc_rx_ino, INTR_ENABLED);
2153 1.1 palle
2154 1.1 palle ldc_send_vers(lc);
2155 1.1 palle
2156 1.1 palle ifp->if_flags |= IFF_RUNNING;
2157 1.3 palle
2158 1.3 palle #if 0
2159 1.3 palle DPRINTF(("%s: exit\n", __func__));
2160 1.3 palle #endif
2161 1.3 palle return 0;
2162 1.1 palle }
2163 1.1 palle
2164 1.1 palle void
2165 1.3 palle vnet_stop(struct ifnet *ifp, int disable)
2166 1.1 palle
2167 1.1 palle {
2168 1.3 palle
2169 1.3 palle DPRINTF(("%s: entry\n", __func__));
2170 1.3 palle
2171 1.1 palle struct vnet_softc *sc = ifp->if_softc;
2172 1.1 palle struct ldc_conn *lc = &sc->sc_lc;
2173 1.1 palle
2174 1.3 palle /* FIXME */
2175 1.3 palle printf("vnet_stop() disable %d\n", disable);
2176 1.3 palle
2177 1.1 palle ifp->if_flags &= ~IFF_RUNNING;
2178 1.1 palle #if 0
2179 1.1 palle FIXME openbsd
2180 1.1 palle ifq_clr_oactive(&ifp->if_snd);
2181 1.1 palle #else
2182 1.1 palle ifp->if_flags &= ~IFF_OACTIVE;
2183 1.1 palle #endif
2184 1.1 palle ifp->if_timer = 0;
2185 1.1 palle
2186 1.1 palle cbus_intr_setenabled(sc->sc_bustag, sc->sc_tx_ino, INTR_DISABLED);
2187 1.1 palle cbus_intr_setenabled(sc->sc_bustag, sc->sc_rx_ino, INTR_DISABLED);
2188 1.1 palle
2189 1.1 palle #if 0
2190 1.1 palle FIXME openbsd
2191 1.1 palle intr_barrier(sc->sc_tx_ih);
2192 1.1 palle intr_barrier(sc->sc_rx_ih);
2193 1.1 palle #else
2194 1.1 palle printf("vnet_stop() intr_barrier() FIXME\n");
2195 1.1 palle #endif
2196 1.1 palle
2197 1.1 palle hv_ldc_tx_qconf(lc->lc_id, 0, 0);
2198 1.1 palle hv_ldc_rx_qconf(lc->lc_id, 0, 0);
2199 1.1 palle lc->lc_tx_seqid = 0;
2200 1.1 palle lc->lc_state = 0;
2201 1.1 palle lc->lc_tx_state = lc->lc_rx_state = LDC_CHANNEL_DOWN;
2202 1.1 palle vnet_ldc_reset(lc);
2203 1.1 palle
2204 1.1 palle #if 0
2205 1.1 palle FIXME openbsd
2206 1.1 palle free(sc->sc_vsd, M_DEVBUF, VNET_NUM_SOFT_DESC * sizeof(*sc->sc_vsd));
2207 1.1 palle #else
2208 1.1 palle free(sc->sc_vsd, M_DEVBUF);
2209 1.1 palle #endif
2210 1.1 palle
2211 1.1 palle vnet_dring_free(sc->sc_dmatag, sc->sc_vd);
2212 1.1 palle
2213 1.1 palle hv_ldc_set_map_table(lc->lc_id, 0, 0);
2214 1.1 palle #if OPENBSD_BUSDMA
2215 1.1 palle ldc_map_free(sc->sc_dmatag, sc->sc_lm);
2216 1.1 palle #else
2217 1.1 palle ldc_map_free(sc->sc_lm);
2218 1.1 palle #endif
2219 1.1 palle }
2220 1.1 palle
2221 1.1 palle struct vnet_dring *
2222 1.1 palle vnet_dring_alloc(bus_dma_tag_t t, int nentries)
2223 1.1 palle {
2224 1.3 palle #if 0
2225 1.3 palle DPRINTF(("%s: entry\n", __func__));
2226 1.3 palle #endif
2227 1.3 palle
2228 1.1 palle struct vnet_dring *vd;
2229 1.1 palle bus_size_t size;
2230 1.1 palle vaddr_t va;
2231 1.1 palle #if OPENBSD_BUSDMA
2232 1.1 palle int nsegs;
2233 1.1 palle #endif
2234 1.1 palle int i;
2235 1.1 palle
2236 1.1 palle vd = kmem_zalloc(sizeof(struct vnet_dring), KM_SLEEP);
2237 1.1 palle if (vd == NULL)
2238 1.1 palle return NULL;
2239 1.1 palle
2240 1.1 palle size = roundup(nentries * sizeof(struct vnet_desc), PAGE_SIZE);
2241 1.1 palle
2242 1.1 palle #if OPENBSD_BUSDMA
2243 1.1 palle if (bus_dmamap_create(t, size, 1, size, 0,
2244 1.1 palle BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &vd->vd_map) != 0)
2245 1.1 palle return (NULL);
2246 1.1 palle
2247 1.1 palle if (bus_dmamem_alloc(t, size, PAGE_SIZE, 0, &vd->vd_seg, 1,
2248 1.1 palle &nsegs, BUS_DMA_NOWAIT) != 0)
2249 1.1 palle goto destroy;
2250 1.1 palle
2251 1.1 palle if (bus_dmamem_map(t, &vd->vd_seg, 1, size, &va,
2252 1.1 palle BUS_DMA_NOWAIT) != 0)
2253 1.1 palle goto free;
2254 1.1 palle
2255 1.1 palle if (bus_dmamap_load(t, vd->vd_map, va, size, NULL,
2256 1.1 palle BUS_DMA_NOWAIT) != 0)
2257 1.1 palle goto unmap;
2258 1.1 palle #else
2259 1.1 palle va = (vaddr_t)kmem_zalloc(size, KM_SLEEP);
2260 1.1 palle #endif
2261 1.1 palle vd->vd_desc = (struct vnet_desc *)va;
2262 1.1 palle vd->vd_nentries = nentries;
2263 1.1 palle bzero(vd->vd_desc, nentries * sizeof(struct vnet_desc));
2264 1.1 palle for (i = 0; i < vd->vd_nentries; i++)
2265 1.1 palle vd->vd_desc[i].hdr.dstate = VIO_DESC_FREE;
2266 1.1 palle return (vd);
2267 1.1 palle
2268 1.1 palle #if OPENBSD_BUSDMA
2269 1.1 palle unmap:
2270 1.1 palle bus_dmamem_unmap(t, va, size);
2271 1.1 palle free:
2272 1.1 palle bus_dmamem_free(t, &vd->vd_seg, 1);
2273 1.1 palle destroy:
2274 1.1 palle bus_dmamap_destroy(t, vd->vd_map);
2275 1.1 palle #endif
2276 1.1 palle return (NULL);
2277 1.1 palle }
2278 1.1 palle
2279 1.1 palle void
2280 1.1 palle vnet_dring_free(bus_dma_tag_t t, struct vnet_dring *vd)
2281 1.1 palle {
2282 1.3 palle
2283 1.3 palle DPRINTF(("%s: entry\n", __func__));
2284 1.3 palle
2285 1.1 palle bus_size_t size;
2286 1.1 palle
2287 1.1 palle size = vd->vd_nentries * sizeof(struct vnet_desc);
2288 1.1 palle size = roundup(size, PAGE_SIZE);
2289 1.1 palle
2290 1.1 palle #if OPENBSD_BUSDMA
2291 1.1 palle bus_dmamap_unload(t, vd->vd_map);
2292 1.1 palle bus_dmamem_unmap(t, (caddr_t)vd->vd_desc, size);
2293 1.1 palle bus_dmamem_free(t, &vd->vd_seg, 1);
2294 1.1 palle bus_dmamap_destroy(t, vd->vd_map);
2295 1.1 palle #else
2296 1.1 palle kmem_free(vd->vd_desc, size);
2297 1.1 palle #endif
2298 1.1 palle kmem_free(vd, size);
2299 1.1 palle }
2300 1.1 palle
2301