From 06924da0a63696484e40c3a45b7491a81ca23625 Mon Sep 17 00:00:00 2001 From: mglocker Date: Thu, 4 Jan 2024 12:22:35 +0000 Subject: [PATCH] Pass SCSI command directly to the UFS command descriptor instead of decoding/encoding it. Suggested and OK kettenis@ --- sys/dev/ic/ufshci.c | 36 +++++++++++------------------------- 1 file changed, 11 insertions(+), 25 deletions(-) diff --git a/sys/dev/ic/ufshci.c b/sys/dev/ic/ufshci.c index 14cb889fc37..84968c3d161 100644 --- a/sys/dev/ic/ufshci.c +++ b/sys/dev/ic/ufshci.c @@ -1,4 +1,4 @@ -/* $OpenBSD: ufshci.c,v 1.3 2023/04/05 17:23:30 mglocker Exp $ */ +/* $OpenBSD: ufshci.c,v 1.4 2024/01/04 12:22:35 mglocker Exp $ */ /* * Copyright (c) 2022 Marcus Glocker @@ -76,9 +76,11 @@ int ufshci_utr_cmd_capacity16(struct ufshci_softc *, int ufshci_utr_cmd_capacity(struct ufshci_softc *, struct ufshci_ccb *, int, int); int ufshci_utr_cmd_read(struct ufshci_softc *, - struct ufshci_ccb *, int, int, uint32_t, uint16_t); + struct ufshci_ccb *, int, int, + struct scsi_generic *); int ufshci_utr_cmd_write(struct ufshci_softc *, - struct ufshci_ccb *, int, int, uint32_t, uint16_t); + struct ufshci_ccb *, int, int, + struct scsi_generic *); int ufshci_utr_cmd_sync(struct ufshci_softc *, struct ufshci_ccb *, int, uint32_t, uint16_t); int ufshci_xfer_complete(struct ufshci_softc *); @@ -1067,7 +1069,7 @@ ufshci_utr_cmd_capacity(struct ufshci_softc *sc, struct ufshci_ccb *ccb, int ufshci_utr_cmd_read(struct ufshci_softc *sc, struct ufshci_ccb *ccb, - int rsp_size, int flags, uint32_t lba, uint16_t blocks) + int rsp_size, int flags, struct scsi_generic *scsi_cmd) { int slot, off, len, i; uint64_t dva; @@ -1112,14 +1114,8 @@ ufshci_utr_cmd_read(struct ufshci_softc *sc, struct ufshci_ccb *ccb, ucd->cmd.expected_xfer_len = htobe32(rsp_size); - ucd->cmd.cdb[0] = READ_10; /* 0x28 */ + memcpy(ucd->cmd.cdb, scsi_cmd, sizeof(ucd->cmd.cdb)); //ucd->cmd.cdb[1] = (1 << 3); /* FUA: Force Unit Access */ - ucd->cmd.cdb[2] = (lba >> 24) & 0xff; - ucd->cmd.cdb[3] = (lba >> 16) & 0xff; - ucd->cmd.cdb[4] = (lba >> 8) & 0xff; - ucd->cmd.cdb[5] = (lba >> 0) & 0xff; - ucd->cmd.cdb[7] = (blocks >> 8) & 0xff; - ucd->cmd.cdb[8] = (blocks >> 0) & 0xff; /* 7.2.1 Basic Steps when Building a UTP Transfer Request: 2g) */ /* Already done with above memset */ @@ -1181,7 +1177,7 @@ ufshci_utr_cmd_read(struct ufshci_softc *sc, struct ufshci_ccb *ccb, int ufshci_utr_cmd_write(struct ufshci_softc *sc, struct ufshci_ccb *ccb, - int rsp_size, int flags, uint32_t lba, uint16_t blocks) + int rsp_size, int flags, struct scsi_generic *scsi_cmd) { int slot, off, len, i; uint64_t dva; @@ -1226,14 +1222,8 @@ ufshci_utr_cmd_write(struct ufshci_softc *sc, struct ufshci_ccb *ccb, ucd->cmd.expected_xfer_len = htobe32(rsp_size); - ucd->cmd.cdb[0] = WRITE_10; /* 0x2a */ + memcpy(ucd->cmd.cdb, scsi_cmd, sizeof(ucd->cmd.cdb)); ucd->cmd.cdb[1] = (1 << 3); /* FUA: Force Unit Access */ - ucd->cmd.cdb[2] = (lba >> 24) & 0xff; - ucd->cmd.cdb[3] = (lba >> 16) & 0xff; - ucd->cmd.cdb[4] = (lba >> 8) & 0xff; - ucd->cmd.cdb[5] = (lba >> 0) & 0xff; - ucd->cmd.cdb[7] = (blocks >> 8) & 0xff; - ucd->cmd.cdb[8] = (blocks >> 0) & 0xff; /* 7.2.1 Basic Steps when Building a UTP Transfer Request: 2g) */ /* Already done with above memset */ @@ -1859,15 +1849,11 @@ ufshci_scsi_io(struct scsi_xfer *xs, int dir) struct ufshci_softc *sc = link->bus->sb_adapter_softc; struct ufshci_ccb *ccb = xs->io; bus_dmamap_t dmap = ccb->ccb_dmamap; - uint64_t lba; - uint32_t blocks; int error; if ((xs->flags & (SCSI_DATA_IN | SCSI_DATA_OUT)) != dir) goto error1; - scsi_cmd_rw_decode(&xs->cmd, &lba, &blocks); - DPRINTF("%s: %s, lba=%llu, blocks=%u, datalen=%d (%s)\n", __func__, ISSET(xs->flags, SCSI_DATA_IN) ? "READ" : "WRITE", @@ -1890,10 +1876,10 @@ ufshci_scsi_io(struct scsi_xfer *xs, int dir) if (dir == SCSI_DATA_IN) { ccb->ccb_slot = ufshci_utr_cmd_read(sc, ccb, xs->datalen, - xs->flags, (uint32_t)lba, (uint16_t)blocks); + xs->flags, &xs->cmd); } else { ccb->ccb_slot = ufshci_utr_cmd_write(sc, ccb, xs->datalen, - xs->flags, (uint32_t)lba, (uint16_t)blocks); + xs->flags, &xs->cmd); } if (ccb->ccb_slot == -1) -- 2.20.1