diff options
-rw-r--r-- | sys/arch/sparc64/dev/ldc.c | 23 | ||||
-rw-r--r-- | sys/arch/sparc64/dev/ldcvar.h | 13 |
2 files changed, 33 insertions, 3 deletions
diff --git a/sys/arch/sparc64/dev/ldc.c b/sys/arch/sparc64/dev/ldc.c index 13799d5d818..5b172acdbb8 100644 --- a/sys/arch/sparc64/dev/ldc.c +++ b/sys/arch/sparc64/dev/ldc.c @@ -1,4 +1,4 @@ -/* $OpenBSD: ldc.c,v 1.6 2009/05/12 22:31:45 kettenis Exp $ */ +/* $OpenBSD: ldc.c,v 1.7 2009/12/26 21:21:10 kettenis Exp $ */ /* * Copyright (c) 2009 Mark Kettenis * @@ -72,6 +72,7 @@ ldc_rx_ctrl_vers(struct ldc_conn *lc, struct ldc_pkt *lp) { switch (lp->stype) { case LDC_INFO: + DPRINTF(("CTRL/INFO/VERS\n")); if (lp->major == LDC_VERSION_MAJOR && lp->minor == LDC_VERSION_MINOR) ldc_send_ack(lc); @@ -203,6 +204,8 @@ ldc_rx_ctrl_rdx(struct ldc_conn *lc, struct ldc_pkt *lp) void ldc_rx_data(struct ldc_conn *lc, struct ldc_pkt *lp) { + size_t len; + if (lp->stype != LDC_INFO) { DPRINTF(("DATA/0x%02x\n", lp->stype)); ldc_reset(lc); @@ -216,7 +219,23 @@ ldc_rx_data(struct ldc_conn *lc, struct ldc_pkt *lp) return; } - lc->lc_rx_data(lc, lp); + if (lp->env & LDC_FRAG_START) { + lc->lc_len = (lp->env & LDC_LEN_MASK) + 8; + KASSERT(lc->lc_len <= sizeof(lc->lc_msg)); + memcpy((uint8_t *)lc->lc_msg, lp, lc->lc_len); + } else { + len = (lp->env & LDC_LEN_MASK); + if (lc->lc_len + len > sizeof(lc->lc_msg)) { + DPRINTF(("Buffer overrun\n")); + ldc_reset(lc); + return; + } + memcpy(((uint8_t *)lc->lc_msg) + lc->lc_len, &lp->major, len); + lc->lc_len += len; + } + + if (lp->env & LDC_FRAG_STOP) + lc->lc_rx_data(lc, (struct ldc_pkt *)lc->lc_msg); } void diff --git a/sys/arch/sparc64/dev/ldcvar.h b/sys/arch/sparc64/dev/ldcvar.h index 832823a2375..bf7a9ed7f11 100644 --- a/sys/arch/sparc64/dev/ldcvar.h +++ b/sys/arch/sparc64/dev/ldcvar.h @@ -1,4 +1,4 @@ -/* $OpenBSD: ldcvar.h,v 1.3 2009/05/12 21:52:30 kettenis Exp $ */ +/* $OpenBSD: ldcvar.h,v 1.4 2009/12/26 21:21:10 kettenis Exp $ */ /* * Copyright (c) 2009 Mark Kettenis * @@ -36,6 +36,8 @@ void ldc_queue_free(bus_dma_tag_t, struct ldc_queue *); #define LDC_VERSION_MAJOR 1 #define LDC_VERSION_MINOR 0 +#define LDC_PKT_PAYLOAD 56 + struct ldc_pkt { uint8_t type; uint8_t stype; @@ -74,6 +76,12 @@ struct ldc_pkt { #define LDC_FRAG_START 0x40 #define LDC_FRAG_STOP 0x80 +/* + * XXX Get rid of the +8 once we no longer need to store the header of + * the first packet. + */ +#define LDC_MSG_MAX (128 + 8) + struct ldc_conn { uint64_t lc_id; @@ -90,6 +98,9 @@ struct ldc_conn { #define LDC_SND_RTR 4 #define LDC_SND_RDX 5 + uint64_t lc_msg[LDC_MSG_MAX / 8]; + size_t lc_len; + void *lc_sc; void (*lc_reset)(struct ldc_conn *); void (*lc_start)(struct ldc_conn *); |