Home | History | Annotate | Line # | Download | only in dev
      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