1 1.10 palle /* $NetBSD: ldc.c,v 1.10 2025/02/06 19:24:37 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.10 palle printf("ldc_send_ack() err %d tx_state %lu\n", err, (long unsigned int)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.10 palle printf("ldc_send_rts() err %d tx_state %lu\n", err, (long unsigned int)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.10 palle printf("ldc_send_rtr() err %d state %lu\n", err, (long unsigned int)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.10 palle printf("ldc_send_rdx() err %d state %lu\n", err, (long unsigned int)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.10 palle printf("ldc_send_unrealiable() err %d state %lu\n", err, (long unsigned int)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