Home | History | Annotate | Line # | Download | only in dev
ldc.c revision 1.8.2.1
      1  1.8.2.1  perseant /*	$NetBSD: ldc.c,v 1.8.2.1 2025/08/02 05:56:09 perseant 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.8.2.1  perseant int	ldc_send_ack(struct ldc_conn *);
     42  1.8.2.1  perseant int	ldc_send_rtr(struct ldc_conn *);
     43  1.8.2.1  perseant int	ldc_send_rts(struct ldc_conn *);
     44  1.8.2.1  perseant 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.8.2.1  perseant 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.8.2.1  perseant 		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.8.2.1  perseant 	lp->major = LDC_VERSION_MAJOR;
    265  1.8.2.1  perseant 	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.8.2.1  perseant 		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.8.2.1  perseant 	return 0;
    281      1.1     palle }
    282      1.1     palle 
    283  1.8.2.1  perseant 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.8.2.1  perseant 		printf("ldc_send_ack() err %d tx_state %lu\n", err, (long unsigned int)tx_state);
    295  1.8.2.1  perseant 		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.8.2.1  perseant 		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.8.2.1  perseant 	return 0;
    319      1.1     palle }
    320      1.1     palle 
    321  1.8.2.1  perseant 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.8.2.1  perseant 		printf("ldc_send_rts() err %d tx_state %lu\n", err, (long unsigned int)tx_state);
    333  1.8.2.1  perseant 		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.8.2.1  perseant 		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.8.2.1  perseant 	return 0;
    357      1.1     palle }
    358      1.1     palle 
    359  1.8.2.1  perseant 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.8.2.1  perseant 		printf("ldc_send_rtr() err %d state %lu\n", err, (long unsigned int)tx_state);
    371  1.8.2.1  perseant 		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.8.2.1  perseant 		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.8.2.1  perseant 	return 0;
    395      1.1     palle }
    396      1.1     palle 
    397  1.8.2.1  perseant 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.8.2.1  perseant 		printf("ldc_send_rdx() err %d state %lu\n", err, (long unsigned int)tx_state);
    409  1.8.2.1  perseant 		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.8.2.1  perseant 		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.8.2.1  perseant 	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.8.2.1  perseant 		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