ldc.c revision 1.9 1 1.9 palle /* $NetBSD: ldc.c,v 1.9 2025/02/05 20:46:26 palle Exp $ */
2 1.1 palle /* $OpenBSD: ldc.c,v 1.12 2015/03/21 18:02:58 kettenis Exp $ */
3 1.1 palle /*
4 1.1 palle * Copyright (c) 2009 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 #include <sys/kmem.h>
20 1.1 palle #include <sys/param.h>
21 1.1 palle #include <sys/systm.h>
22 1.1 palle
23 1.1 palle #include <sys/bus.h>
24 1.1 palle #include <machine/hypervisor.h>
25 1.1 palle
26 1.1 palle #include <uvm/uvm_extern.h>
27 1.1 palle
28 1.1 palle #include <sparc64/dev/ldcvar.h>
29 1.1 palle
30 1.1 palle #ifdef LDC_DEBUG
31 1.1 palle #define DPRINTF(x) printf x
32 1.1 palle #else
33 1.1 palle #define DPRINTF(x)
34 1.1 palle #endif
35 1.1 palle
36 1.1 palle void ldc_rx_ctrl_vers(struct ldc_conn *, struct ldc_pkt *);
37 1.1 palle void ldc_rx_ctrl_rtr(struct ldc_conn *, struct ldc_pkt *);
38 1.1 palle void ldc_rx_ctrl_rts(struct ldc_conn *, struct ldc_pkt *);
39 1.1 palle void ldc_rx_ctrl_rdx(struct ldc_conn *, struct ldc_pkt *);
40 1.1 palle
41 1.9 palle int ldc_send_ack(struct ldc_conn *);
42 1.9 palle int ldc_send_rtr(struct ldc_conn *);
43 1.9 palle int ldc_send_rts(struct ldc_conn *);
44 1.9 palle int ldc_send_rdx(struct ldc_conn *);
45 1.1 palle
46 1.1 palle void
47 1.1 palle ldc_rx_ctrl(struct ldc_conn *lc, struct ldc_pkt *lp)
48 1.1 palle {
49 1.1 palle switch (lp->ctrl) {
50 1.1 palle case LDC_VERS:
51 1.1 palle ldc_rx_ctrl_vers(lc, lp);
52 1.1 palle break;
53 1.1 palle
54 1.1 palle case LDC_RTS:
55 1.1 palle ldc_rx_ctrl_rts(lc, lp);
56 1.1 palle break;
57 1.1 palle
58 1.1 palle case LDC_RTR:
59 1.1 palle ldc_rx_ctrl_rtr(lc, lp);
60 1.1 palle break;
61 1.1 palle
62 1.1 palle case LDC_RDX:
63 1.1 palle ldc_rx_ctrl_rdx(lc, lp);
64 1.1 palle break;
65 1.1 palle
66 1.1 palle default:
67 1.1 palle DPRINTF(("CTRL/0x%02x/0x%02x\n", lp->stype, lp->ctrl));
68 1.1 palle ldc_reset(lc);
69 1.1 palle break;
70 1.1 palle }
71 1.1 palle }
72 1.1 palle
73 1.1 palle void
74 1.1 palle ldc_rx_ctrl_vers(struct ldc_conn *lc, struct ldc_pkt *lp)
75 1.1 palle {
76 1.1 palle switch (lp->stype) {
77 1.1 palle case LDC_INFO:
78 1.7 palle DPRINTF(("CTRL/INFO/VERS major %d minor %d\n", lp->major, lp->minor));
79 1.1 palle if (lp->major == LDC_VERSION_MAJOR &&
80 1.1 palle lp->minor == LDC_VERSION_MINOR)
81 1.1 palle ldc_send_ack(lc);
82 1.1 palle else {
83 1.1 palle /* XXX do nothing for now. */
84 1.7 palle DPRINTF(("CTRL/INFO/VERS unsupported major/minor\n"));
85 1.1 palle }
86 1.1 palle break;
87 1.1 palle
88 1.1 palle case LDC_ACK:
89 1.7 palle DPRINTF(("CTRL/ACK/VERS\n"));
90 1.1 palle if (lc->lc_state != LDC_SND_VERS) {
91 1.7 palle DPRINTF(("Spurious CTRL/ACK/VERS: state %d major %d minor %d (ignored)\n",
92 1.7 palle lc->lc_state, lp->major, lp->minor));
93 1.7 palle }
94 1.7 palle else {
95 1.7 palle ldc_send_rts(lc);
96 1.1 palle }
97 1.1 palle break;
98 1.1 palle
99 1.1 palle case LDC_NACK:
100 1.1 palle DPRINTF(("CTRL/NACK/VERS\n"));
101 1.1 palle ldc_reset(lc);
102 1.1 palle break;
103 1.1 palle
104 1.1 palle default:
105 1.1 palle DPRINTF(("CTRL/0x%02x/VERS\n", lp->stype));
106 1.1 palle ldc_reset(lc);
107 1.1 palle break;
108 1.1 palle }
109 1.1 palle }
110 1.1 palle
111 1.1 palle void
112 1.1 palle ldc_rx_ctrl_rts(struct ldc_conn *lc, struct ldc_pkt *lp)
113 1.1 palle {
114 1.1 palle switch (lp->stype) {
115 1.1 palle case LDC_INFO:
116 1.1 palle if (lc->lc_state != LDC_RCV_VERS) {
117 1.1 palle DPRINTF(("Spurious CTRL/INFO/RTS: state %d\n",
118 1.1 palle lc->lc_state));
119 1.1 palle ldc_reset(lc);
120 1.1 palle return;
121 1.1 palle }
122 1.1 palle DPRINTF(("CTRL/INFO/RTS\n"));
123 1.1 palle ldc_send_rtr(lc);
124 1.1 palle break;
125 1.1 palle
126 1.1 palle case LDC_ACK:
127 1.1 palle DPRINTF(("CTRL/ACK/RTS\n"));
128 1.1 palle ldc_reset(lc);
129 1.1 palle break;
130 1.1 palle
131 1.1 palle case LDC_NACK:
132 1.1 palle DPRINTF(("CTRL/NACK/RTS\n"));
133 1.1 palle ldc_reset(lc);
134 1.1 palle break;
135 1.1 palle
136 1.1 palle default:
137 1.1 palle DPRINTF(("CTRL/0x%02x/RTS\n", lp->stype));
138 1.1 palle ldc_reset(lc);
139 1.1 palle break;
140 1.1 palle }
141 1.1 palle }
142 1.1 palle
143 1.1 palle void
144 1.1 palle ldc_rx_ctrl_rtr(struct ldc_conn *lc, struct ldc_pkt *lp)
145 1.1 palle {
146 1.1 palle switch (lp->stype) {
147 1.1 palle case LDC_INFO:
148 1.1 palle if (lc->lc_state != LDC_SND_RTS) {
149 1.1 palle DPRINTF(("Spurious CTRL/INFO/RTR: state %d\n",
150 1.1 palle lc->lc_state));
151 1.1 palle ldc_reset(lc);
152 1.1 palle return;
153 1.1 palle }
154 1.1 palle DPRINTF(("CTRL/INFO/RTR\n"));
155 1.1 palle ldc_send_rdx(lc);
156 1.1 palle lc->lc_start(lc);
157 1.1 palle break;
158 1.1 palle
159 1.1 palle case LDC_ACK:
160 1.1 palle DPRINTF(("CTRL/ACK/RTR\n"));
161 1.1 palle ldc_reset(lc);
162 1.1 palle break;
163 1.1 palle
164 1.1 palle case LDC_NACK:
165 1.1 palle DPRINTF(("CTRL/NACK/RTR\n"));
166 1.1 palle ldc_reset(lc);
167 1.1 palle break;
168 1.1 palle
169 1.1 palle default:
170 1.1 palle DPRINTF(("CTRL/0x%02x/RTR\n", lp->stype));
171 1.1 palle ldc_reset(lc);
172 1.1 palle break;
173 1.1 palle }
174 1.1 palle }
175 1.1 palle
176 1.1 palle void
177 1.1 palle ldc_rx_ctrl_rdx(struct ldc_conn *lc, struct ldc_pkt *lp)
178 1.1 palle {
179 1.1 palle switch (lp->stype) {
180 1.1 palle case LDC_INFO:
181 1.1 palle if (lc->lc_state != LDC_SND_RTR) {
182 1.1 palle DPRINTF(("Spurious CTRL/INFO/RTR: state %d\n",
183 1.1 palle lc->lc_state));
184 1.1 palle ldc_reset(lc);
185 1.1 palle return;
186 1.1 palle }
187 1.1 palle DPRINTF(("CTRL/INFO/RDX\n"));
188 1.1 palle lc->lc_start(lc);
189 1.1 palle break;
190 1.1 palle
191 1.1 palle case LDC_ACK:
192 1.1 palle DPRINTF(("CTRL/ACK/RDX\n"));
193 1.1 palle ldc_reset(lc);
194 1.1 palle break;
195 1.1 palle
196 1.1 palle case LDC_NACK:
197 1.1 palle DPRINTF(("CTRL/NACK/RDX\n"));
198 1.1 palle ldc_reset(lc);
199 1.1 palle break;
200 1.1 palle
201 1.1 palle default:
202 1.1 palle DPRINTF(("CTRL/0x%02x/RDX\n", lp->stype));
203 1.1 palle ldc_reset(lc);
204 1.1 palle break;
205 1.1 palle }
206 1.1 palle }
207 1.1 palle
208 1.1 palle void
209 1.1 palle ldc_rx_data(struct ldc_conn *lc, struct ldc_pkt *lp)
210 1.1 palle {
211 1.1 palle size_t len;
212 1.1 palle
213 1.1 palle if (lp->stype != LDC_INFO) {
214 1.1 palle DPRINTF(("DATA/0x%02x\n", lp->stype));
215 1.1 palle ldc_reset(lc);
216 1.1 palle return;
217 1.1 palle }
218 1.1 palle
219 1.1 palle if (lc->lc_state != LDC_SND_RTR &&
220 1.1 palle lc->lc_state != LDC_SND_RDX) {
221 1.1 palle DPRINTF(("Spurious DATA/INFO: state %d\n", lc->lc_state));
222 1.1 palle ldc_reset(lc);
223 1.1 palle return;
224 1.1 palle }
225 1.1 palle
226 1.1 palle if (lp->env & LDC_FRAG_START) {
227 1.1 palle lc->lc_len = (lp->env & LDC_LEN_MASK) + 8;
228 1.1 palle KASSERT(lc->lc_len <= sizeof(lc->lc_msg));
229 1.1 palle memcpy((uint8_t *)lc->lc_msg, lp, lc->lc_len);
230 1.1 palle } else {
231 1.1 palle len = (lp->env & LDC_LEN_MASK);
232 1.1 palle if (lc->lc_len + len > sizeof(lc->lc_msg)) {
233 1.1 palle DPRINTF(("Buffer overrun\n"));
234 1.1 palle ldc_reset(lc);
235 1.1 palle return;
236 1.1 palle }
237 1.1 palle memcpy(((uint8_t *)lc->lc_msg) + lc->lc_len, &lp->major, len);
238 1.1 palle lc->lc_len += len;
239 1.1 palle }
240 1.1 palle
241 1.1 palle if (lp->env & LDC_FRAG_STOP)
242 1.1 palle lc->lc_rx_data(lc, (struct ldc_pkt *)lc->lc_msg);
243 1.1 palle }
244 1.1 palle
245 1.9 palle int
246 1.1 palle ldc_send_vers(struct ldc_conn *lc)
247 1.1 palle {
248 1.1 palle struct ldc_pkt *lp;
249 1.1 palle uint64_t tx_head, tx_tail, tx_state;
250 1.1 palle int err;
251 1.1 palle
252 1.1 palle mutex_enter(&lc->lc_txq->lq_mtx);
253 1.1 palle err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
254 1.1 palle if (err != H_EOK || tx_state != LDC_CHANNEL_UP) {
255 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
256 1.9 palle return EIO;
257 1.1 palle }
258 1.1 palle
259 1.2 nakayama lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_txq->lq_va + tx_tail);
260 1.1 palle bzero(lp, sizeof(struct ldc_pkt));
261 1.1 palle lp->type = LDC_CTRL;
262 1.1 palle lp->stype = LDC_INFO;
263 1.1 palle lp->ctrl = LDC_VERS;
264 1.9 palle lp->major = LDC_VERSION_MAJOR;
265 1.9 palle lp->minor = LDC_VERSION_MINOR;
266 1.7 palle DPRINTF(("ldc_send_vers() major %d minor %d\n", lp->major, lp->minor));
267 1.1 palle
268 1.1 palle tx_tail += sizeof(*lp);
269 1.1 palle tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(*lp)) - 1);
270 1.1 palle err = hv_ldc_tx_set_qtail(lc->lc_id, tx_tail);
271 1.1 palle if (err != H_EOK) {
272 1.1 palle printf("%s: hv_ldc_tx_set_qtail: %d\n", __func__, err);
273 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
274 1.9 palle return EIO;
275 1.1 palle }
276 1.1 palle
277 1.1 palle lc->lc_state = LDC_SND_VERS;
278 1.7 palle DPRINTF(("ldc_send_vers() setting lc->lc_state to %d\n", lc->lc_state));
279 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
280 1.9 palle return 0;
281 1.1 palle }
282 1.1 palle
283 1.9 palle int
284 1.1 palle ldc_send_ack(struct ldc_conn *lc)
285 1.1 palle {
286 1.1 palle struct ldc_pkt *lp;
287 1.1 palle uint64_t tx_head, tx_tail, tx_state;
288 1.1 palle int err;
289 1.1 palle
290 1.1 palle mutex_enter(&lc->lc_txq->lq_mtx);
291 1.1 palle err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
292 1.1 palle if (err != H_EOK || tx_state != LDC_CHANNEL_UP) {
293 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
294 1.9 palle printf("ldc_send_ack() err %d tx_state %lu\n", err, tx_state);
295 1.9 palle return EIO;
296 1.1 palle }
297 1.1 palle
298 1.2 nakayama lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_txq->lq_va + tx_tail);
299 1.1 palle bzero(lp, sizeof(struct ldc_pkt));
300 1.1 palle lp->type = LDC_CTRL;
301 1.1 palle lp->stype = LDC_ACK;
302 1.1 palle lp->ctrl = LDC_VERS;
303 1.1 palle lp->major = 1;
304 1.1 palle lp->minor = 0;
305 1.1 palle
306 1.1 palle tx_tail += sizeof(*lp);
307 1.1 palle tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(*lp)) - 1);
308 1.1 palle err = hv_ldc_tx_set_qtail(lc->lc_id, tx_tail);
309 1.1 palle if (err != H_EOK) {
310 1.1 palle printf("%s: hv_ldc_tx_set_qtail: %d\n", __func__, err);
311 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
312 1.9 palle return EIO;
313 1.1 palle }
314 1.1 palle
315 1.1 palle lc->lc_state = LDC_RCV_VERS;
316 1.7 palle DPRINTF(("ldc_send_ack() setting lc->lc_state to %d\n", lc->lc_state));
317 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
318 1.9 palle return 0;
319 1.1 palle }
320 1.1 palle
321 1.9 palle int
322 1.1 palle ldc_send_rts(struct ldc_conn *lc)
323 1.1 palle {
324 1.1 palle struct ldc_pkt *lp;
325 1.1 palle uint64_t tx_head, tx_tail, tx_state;
326 1.1 palle int err;
327 1.1 palle
328 1.1 palle mutex_enter(&lc->lc_txq->lq_mtx);
329 1.1 palle err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
330 1.1 palle if (err != H_EOK || tx_state != LDC_CHANNEL_UP) {
331 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
332 1.9 palle printf("ldc_send_rts() err %d tx_state %lu\n", err, tx_state);
333 1.9 palle return EIO;
334 1.1 palle }
335 1.1 palle
336 1.2 nakayama lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_txq->lq_va + tx_tail);
337 1.1 palle bzero(lp, sizeof(struct ldc_pkt));
338 1.1 palle lp->type = LDC_CTRL;
339 1.1 palle lp->stype = LDC_INFO;
340 1.1 palle lp->ctrl = LDC_RTS;
341 1.1 palle lp->env = LDC_MODE_UNRELIABLE;
342 1.1 palle lp->seqid = lc->lc_tx_seqid++;
343 1.1 palle
344 1.1 palle tx_tail += sizeof(*lp);
345 1.1 palle tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(*lp)) - 1);
346 1.1 palle err = hv_ldc_tx_set_qtail(lc->lc_id, tx_tail);
347 1.1 palle if (err != H_EOK) {
348 1.1 palle printf("%s: hv_ldc_tx_set_qtail: %d\n", __func__, err);
349 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
350 1.9 palle return EIO;
351 1.1 palle }
352 1.1 palle
353 1.1 palle lc->lc_state = LDC_SND_RTS;
354 1.7 palle DPRINTF(("ldc_send_rts() setting lc->lc_state to %d\n", lc->lc_state));
355 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
356 1.9 palle return 0;
357 1.1 palle }
358 1.1 palle
359 1.9 palle int
360 1.1 palle ldc_send_rtr(struct ldc_conn *lc)
361 1.1 palle {
362 1.1 palle struct ldc_pkt *lp;
363 1.1 palle uint64_t tx_head, tx_tail, tx_state;
364 1.1 palle int err;
365 1.1 palle
366 1.1 palle mutex_enter(&lc->lc_txq->lq_mtx);
367 1.1 palle err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
368 1.1 palle if (err != H_EOK || tx_state != LDC_CHANNEL_UP) {
369 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
370 1.9 palle printf("ldc_send_rtr() err %d state %lu\n", err, tx_state);
371 1.9 palle return EIO;
372 1.1 palle }
373 1.1 palle
374 1.2 nakayama lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_txq->lq_va + tx_tail);
375 1.1 palle bzero(lp, sizeof(struct ldc_pkt));
376 1.1 palle lp->type = LDC_CTRL;
377 1.1 palle lp->stype = LDC_INFO;
378 1.1 palle lp->ctrl = LDC_RTR;
379 1.1 palle lp->env = LDC_MODE_UNRELIABLE;
380 1.1 palle lp->seqid = lc->lc_tx_seqid++;
381 1.1 palle
382 1.1 palle tx_tail += sizeof(*lp);
383 1.1 palle tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(*lp)) - 1);
384 1.1 palle err = hv_ldc_tx_set_qtail(lc->lc_id, tx_tail);
385 1.1 palle if (err != H_EOK) {
386 1.1 palle printf("%s: hv_ldc_tx_set_qtail: %d\n", __func__, err);
387 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
388 1.9 palle return EIO;
389 1.1 palle }
390 1.1 palle
391 1.1 palle lc->lc_state = LDC_SND_RTR;
392 1.7 palle DPRINTF(("ldc_send_rtr() setting lc->lc_state to %d\n", lc->lc_state));
393 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
394 1.9 palle return 0;
395 1.1 palle }
396 1.1 palle
397 1.9 palle int
398 1.1 palle ldc_send_rdx(struct ldc_conn *lc)
399 1.1 palle {
400 1.1 palle struct ldc_pkt *lp;
401 1.1 palle uint64_t tx_head, tx_tail, tx_state;
402 1.1 palle int err;
403 1.1 palle
404 1.1 palle mutex_enter(&lc->lc_txq->lq_mtx);
405 1.1 palle err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
406 1.1 palle if (err != H_EOK || tx_state != LDC_CHANNEL_UP) {
407 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
408 1.9 palle printf("ldc_send_rdx() err %d state %lu\n", err, tx_state);
409 1.9 palle return EIO;
410 1.1 palle }
411 1.1 palle
412 1.2 nakayama lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_txq->lq_va + tx_tail);
413 1.1 palle bzero(lp, sizeof(struct ldc_pkt));
414 1.1 palle lp->type = LDC_CTRL;
415 1.1 palle lp->stype = LDC_INFO;
416 1.1 palle lp->ctrl = LDC_RDX;
417 1.1 palle lp->env = LDC_MODE_UNRELIABLE;
418 1.1 palle lp->seqid = lc->lc_tx_seqid++;
419 1.1 palle
420 1.1 palle tx_tail += sizeof(*lp);
421 1.1 palle tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(*lp)) - 1);
422 1.1 palle err = hv_ldc_tx_set_qtail(lc->lc_id, tx_tail);
423 1.1 palle if (err != H_EOK) {
424 1.1 palle printf("%s: hv_ldc_tx_set_qtail: %d\n", __func__, err);
425 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
426 1.9 palle return EIO;
427 1.1 palle }
428 1.1 palle
429 1.1 palle lc->lc_state = LDC_SND_RDX;
430 1.7 palle DPRINTF(("ldc_send_rdx() setting lc->lc_state to %d\n", lc->lc_state));
431 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
432 1.9 palle return 0;
433 1.1 palle }
434 1.1 palle
435 1.1 palle int
436 1.1 palle ldc_send_unreliable(struct ldc_conn *lc, void *msg, size_t len)
437 1.1 palle {
438 1.1 palle struct ldc_pkt *lp;
439 1.1 palle uint64_t tx_head, tx_tail, tx_state;
440 1.1 palle uint64_t tx_avail;
441 1.1 palle uint8_t *p = msg;
442 1.1 palle int err;
443 1.1 palle
444 1.1 palle mutex_enter(&lc->lc_txq->lq_mtx);
445 1.1 palle err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
446 1.1 palle if (err != H_EOK || tx_state != LDC_CHANNEL_UP) {
447 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
448 1.9 palle printf("ldc_send_unrealiable() err %d state %lu\n", err, tx_state);
449 1.1 palle return (EIO);
450 1.1 palle }
451 1.1 palle
452 1.1 palle tx_avail = (tx_head - tx_tail) / sizeof(*lp) +
453 1.1 palle lc->lc_txq->lq_nentries - 1;
454 1.1 palle tx_avail %= lc->lc_txq->lq_nentries;
455 1.1 palle if (len > tx_avail * LDC_PKT_PAYLOAD) {
456 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
457 1.1 palle return (EWOULDBLOCK);
458 1.1 palle }
459 1.1 palle
460 1.1 palle while (len > 0) {
461 1.2 nakayama lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_txq->lq_va + tx_tail);
462 1.1 palle bzero(lp, sizeof(struct ldc_pkt));
463 1.1 palle lp->type = LDC_DATA;
464 1.1 palle lp->stype = LDC_INFO;
465 1.4 riastrad lp->env = uimin(len, LDC_PKT_PAYLOAD);
466 1.1 palle if (p == msg)
467 1.1 palle lp->env |= LDC_FRAG_START;
468 1.1 palle if (len <= LDC_PKT_PAYLOAD)
469 1.1 palle lp->env |= LDC_FRAG_STOP;
470 1.1 palle lp->seqid = lc->lc_tx_seqid++;
471 1.4 riastrad bcopy(p, &lp->major, uimin(len, LDC_PKT_PAYLOAD));
472 1.1 palle
473 1.1 palle tx_tail += sizeof(*lp);
474 1.1 palle tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(*lp)) - 1);
475 1.1 palle err = hv_ldc_tx_set_qtail(lc->lc_id, tx_tail);
476 1.1 palle if (err != H_EOK) {
477 1.1 palle printf("%s: hv_ldc_tx_set_qtail: %d\n", __func__, err);
478 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
479 1.1 palle return (EIO);
480 1.1 palle }
481 1.4 riastrad p += uimin(len, LDC_PKT_PAYLOAD);
482 1.4 riastrad len -= uimin(len, LDC_PKT_PAYLOAD);
483 1.1 palle }
484 1.1 palle
485 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
486 1.1 palle return (0);
487 1.1 palle }
488 1.1 palle
489 1.1 palle void
490 1.1 palle ldc_reset(struct ldc_conn *lc)
491 1.1 palle {
492 1.1 palle int err;
493 1.1 palle vaddr_t va;
494 1.1 palle paddr_t pa;
495 1.1 palle
496 1.1 palle DPRINTF(("Resetting connection\n"));
497 1.1 palle
498 1.1 palle mutex_enter(&lc->lc_txq->lq_mtx);
499 1.1 palle
500 1.1 palle #if OPENBSD_BUSDMA
501 1.1 palle err = hv_ldc_tx_qconf(lc->lc_id,
502 1.1 palle lc->lc_txq->lq_map->dm_segs[0].ds_addr, lc->lc_txq->lq_nentries);
503 1.1 palle #else
504 1.1 palle va = lc->lc_txq->lq_va;
505 1.1 palle pa = 0;
506 1.1 palle if (pmap_extract(pmap_kernel(), va, &pa) == FALSE)
507 1.1 palle panic("pmap_extract failed %lx\n", va);
508 1.1 palle err = hv_ldc_tx_qconf(lc->lc_id, pa, lc->lc_txq->lq_nentries);
509 1.1 palle #endif
510 1.1 palle if (err != H_EOK)
511 1.1 palle printf("%s: hv_ldc_tx_qconf %d\n", __func__, err);
512 1.1 palle
513 1.1 palle #if OPENBSD_BUSDMA
514 1.1 palle err = hv_ldc_rx_qconf(lc->lc_id,
515 1.1 palle lc->lc_rxq->lq_map->dm_segs[0].ds_addr, lc->lc_rxq->lq_nentries);
516 1.1 palle #else
517 1.1 palle va = lc->lc_rxq->lq_va;
518 1.1 palle pa = 0;
519 1.1 palle if (pmap_extract(pmap_kernel(), va, &pa) == FALSE)
520 1.1 palle panic("pmap_extract failed %lx\n", va);
521 1.1 palle err = hv_ldc_tx_qconf(lc->lc_id, pa, lc->lc_rxq->lq_nentries);
522 1.1 palle #endif
523 1.1 palle if (err != H_EOK)
524 1.1 palle printf("%s: hv_ldc_rx_qconf %d\n", __func__, err);
525 1.1 palle
526 1.1 palle lc->lc_tx_seqid = 0;
527 1.1 palle lc->lc_state = 0;
528 1.1 palle lc->lc_tx_state = lc->lc_rx_state = LDC_CHANNEL_DOWN;
529 1.1 palle mutex_exit(&lc->lc_txq->lq_mtx);
530 1.1 palle
531 1.1 palle lc->lc_reset(lc);
532 1.1 palle }
533 1.1 palle #if OPENBSD_BUSDMA
534 1.1 palle struct ldc_queue *
535 1.1 palle ldc_queue_alloc(bus_dma_tag_t t, int nentries)
536 1.1 palle #else
537 1.1 palle struct ldc_queue *
538 1.1 palle ldc_queue_alloc(int nentries)
539 1.1 palle #endif
540 1.1 palle {
541 1.1 palle struct ldc_queue *lq;
542 1.1 palle bus_size_t size;
543 1.1 palle vaddr_t va = 0;
544 1.1 palle #if OPENBSD_BUSDMA
545 1.1 palle int nsegs;
546 1.1 palle #endif
547 1.1 palle
548 1.5 chs lq = kmem_zalloc(sizeof(struct ldc_queue), KM_SLEEP);
549 1.1 palle
550 1.1 palle mutex_init(&lq->lq_mtx, MUTEX_DEFAULT, IPL_TTY);
551 1.1 palle
552 1.1 palle size = roundup(nentries * sizeof(struct ldc_pkt), PAGE_SIZE);
553 1.1 palle #if OPENBSD_BUSDMA
554 1.1 palle if (bus_dmamap_create(t, size, 1, size, 0,
555 1.1 palle BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &lq->lq_map) != 0)
556 1.1 palle return (NULL);
557 1.1 palle
558 1.1 palle if (bus_dmamem_alloc(t, size, PAGE_SIZE, 0, &lq->lq_seg, 1,
559 1.1 palle &nsegs, BUS_DMA_NOWAIT) != 0)
560 1.1 palle goto destroy;
561 1.1 palle
562 1.1 palle if (bus_dmamem_map(t, &lq->lq_seg, 1, size, (void *)&va,
563 1.1 palle BUS_DMA_NOWAIT) != 0)
564 1.1 palle goto free;
565 1.1 palle
566 1.1 palle if (bus_dmamap_load(t, lq->lq_map, (void*)va, size, NULL,
567 1.1 palle BUS_DMA_NOWAIT) != 0)
568 1.1 palle goto unmap;
569 1.1 palle #else
570 1.5 chs va = (vaddr_t)kmem_zalloc(size, KM_SLEEP);
571 1.1 palle #endif
572 1.1 palle lq->lq_va = (vaddr_t)va;
573 1.1 palle lq->lq_nentries = nentries;
574 1.1 palle return (lq);
575 1.1 palle #if OPENBSD_BUSDMA
576 1.1 palle unmap:
577 1.1 palle bus_dmamem_unmap(t, (void*)va, size);
578 1.1 palle free:
579 1.1 palle bus_dmamem_free(t, &lq->lq_seg, 1);
580 1.1 palle destroy:
581 1.1 palle bus_dmamap_destroy(t, lq->lq_map);
582 1.1 palle #endif
583 1.1 palle return (NULL);
584 1.1 palle }
585 1.1 palle
586 1.1 palle void
587 1.1 palle #if OPENBSD_BUSDMA
588 1.1 palle ldc_queue_free(bus_dma_tag_t t, struct ldc_queue *lq)
589 1.1 palle #else
590 1.1 palle ldc_queue_free(struct ldc_queue *lq)
591 1.1 palle #endif
592 1.1 palle {
593 1.1 palle bus_size_t size;
594 1.1 palle
595 1.1 palle size = roundup(lq->lq_nentries * sizeof(struct ldc_pkt), PAGE_SIZE);
596 1.1 palle
597 1.1 palle #if OPENBSD_BUSDMA
598 1.1 palle bus_dmamap_unload(t, lq->lq_map);
599 1.1 palle bus_dmamem_unmap(t, &lq->lq_va, size);
600 1.1 palle bus_dmamem_free(t, &lq->lq_seg, 1);
601 1.1 palle bus_dmamap_destroy(t, lq->lq_map);
602 1.1 palle #else
603 1.1 palle kmem_free((void *)lq->lq_va, size);
604 1.1 palle #endif
605 1.1 palle kmem_free(lq, size);
606 1.1 palle }
607 1.1 palle
608 1.1 palle #if OPENBSD_BUSDMA
609 1.1 palle struct ldc_map *
610 1.1 palle ldc_map_alloc(bus_dma_tag_t t, int nentries)
611 1.1 palle #else
612 1.1 palle struct ldc_map *
613 1.1 palle ldc_map_alloc(int nentries)
614 1.1 palle #endif
615 1.1 palle {
616 1.1 palle struct ldc_map *lm;
617 1.1 palle bus_size_t size;
618 1.1 palle vaddr_t va = 0;
619 1.1 palle
620 1.1 palle #if OPENBSD_BUSDMA
621 1.1 palle int nsegs;
622 1.1 palle #endif
623 1.6 chs lm = kmem_zalloc(sizeof(struct ldc_map), KM_SLEEP);
624 1.1 palle size = roundup(nentries * sizeof(struct ldc_map_slot), PAGE_SIZE);
625 1.1 palle
626 1.1 palle #if OPENBSD_BUSDMA
627 1.1 palle if (bus_dmamap_create(t, size, 1, size, 0,
628 1.1 palle BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &lm->lm_map) != 0) {
629 1.1 palle DPRINTF(("ldc_map_alloc() - bus_dmamap_create() failed\n"));
630 1.1 palle return (NULL);
631 1.1 palle }
632 1.1 palle
633 1.1 palle if (bus_dmamem_alloc(t, size, PAGE_SIZE, 0, &lm->lm_seg, 1,
634 1.1 palle &nsegs, BUS_DMA_NOWAIT) != 0) {
635 1.1 palle DPRINTF(("ldc_map_alloc() - bus_dmamem_alloc() failed\n"));
636 1.1 palle goto destroy;
637 1.1 palle }
638 1.1 palle
639 1.1 palle if (bus_dmamem_map(t, &lm->lm_seg, 1, size, (void *)&va,
640 1.1 palle BUS_DMA_NOWAIT) != 0) {
641 1.1 palle DPRINTF(("ldc_map_alloc() - bus_dmamem_map() failed\n"));
642 1.1 palle goto free;
643 1.1 palle }
644 1.1 palle if (bus_dmamap_load(t, lm->lm_map, (void*)va, size, NULL,
645 1.1 palle BUS_DMA_NOWAIT) != 0) {
646 1.1 palle DPRINTF(("ldc_map_alloc() - bus_dmamap_load() failed\n"));
647 1.1 palle goto unmap;
648 1.1 palle }
649 1.1 palle #else
650 1.6 chs va = (vaddr_t)kmem_zalloc(size, KM_SLEEP);
651 1.1 palle #endif
652 1.1 palle lm->lm_slot = (struct ldc_map_slot *)va;
653 1.1 palle lm->lm_nentries = nentries;
654 1.1 palle bzero(lm->lm_slot, nentries * sizeof(struct ldc_map_slot));
655 1.1 palle return (lm);
656 1.1 palle
657 1.1 palle #if OPENBSD_BUSDMA
658 1.1 palle unmap:
659 1.1 palle bus_dmamem_unmap(t, (void*)va, size);
660 1.1 palle free:
661 1.1 palle bus_dmamem_free(t, &lm->lm_seg, 1);
662 1.1 palle destroy:
663 1.1 palle bus_dmamap_destroy(t, lm->lm_map);
664 1.1 palle #endif
665 1.1 palle return (NULL);
666 1.1 palle }
667 1.1 palle
668 1.1 palle #if OPENBSD_BUSDMA
669 1.1 palle void
670 1.1 palle ldc_map_free(bus_dma_tag_t t, struct ldc_map *lm)
671 1.1 palle #else
672 1.1 palle void
673 1.1 palle ldc_map_free(struct ldc_map *lm)
674 1.1 palle #endif
675 1.1 palle {
676 1.1 palle bus_size_t size;
677 1.1 palle
678 1.1 palle size = lm->lm_nentries * sizeof(struct ldc_map_slot);
679 1.1 palle size = roundup(size, PAGE_SIZE);
680 1.1 palle
681 1.1 palle #if OPENBSD_BUSDMA
682 1.1 palle bus_dmamap_unload(t, lm->lm_map);
683 1.1 palle bus_dmamem_unmap(t, lm->lm_slot, size);
684 1.1 palle bus_dmamem_free(t, &lm->lm_seg, 1);
685 1.1 palle bus_dmamap_destroy(t, lm->lm_map);
686 1.1 palle #else
687 1.1 palle kmem_free(lm->lm_slot, size);
688 1.1 palle #endif
689 1.1 palle kmem_free(lm, size);
690 1.1 palle }
691