From nobody Fri May 9 10:05:25 2025 Delivered-To: importer@patchew.org Authentication-Results: mx.zohomail.com; dkim=pass; spf=pass (zohomail.com: domain of gnu.org designates 209.51.188.17 as permitted sender) smtp.mailfrom=qemu-devel-bounces+importer=patchew.org@nongnu.org; dmarc=pass(p=none dis=none) header.from=linaro.org ARC-Seal: i=1; a=rsa-sha256; t=1644330408; cv=none; d=zohomail.com; s=zohoarc; b=FIlwduflxktA6yTT+0dMKByjPh0Q5R0XiY4UhGXuJX9dPsuaaxx8kuNwLc65nE5PxhXqVTw4DzNO2M9DqYP9BJhIi4ij+GJXgtF3VewIltrDDHwI6vomhb+FzCl13ZXLd1d3nTlRuBh+hi45e4plI0NaVyib+P0BlWazFbWAbpw= ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=zohomail.com; s=zohoarc; t=1644330408; h=Content-Transfer-Encoding:Date:From:In-Reply-To:List-Subscribe:List-Post:List-Id:List-Archive:List-Help:List-Unsubscribe:MIME-Version:Message-ID:References:Sender:Subject:To; bh=I6ofd2+RFe7Q0zIenoAENpu2K6I00G1x9Fk14iiIxg0=; b=aTRkdfdi/OGl8mDUuEp6/9iuVXBDltOedvV6aCAAIaiGI/qtQ9wF3O/LSDArC1MZYsxDiI8SPDJkiu5WVd15m5JaZ4YbTKSDssMT2H7jvt4rkV+b1gp8uMwGaXTXAFVWEp0Aily2WjabW7lrFPnvPuCCyafChXzbTgrnlulwSlE= ARC-Authentication-Results: i=1; mx.zohomail.com; dkim=pass; spf=pass (zohomail.com: domain of gnu.org designates 209.51.188.17 as permitted sender) smtp.mailfrom=qemu-devel-bounces+importer=patchew.org@nongnu.org; dmarc=pass header.from=<peter.maydell@linaro.org> (p=none dis=none) Return-Path: <qemu-devel-bounces+importer=patchew.org@nongnu.org> Received: from lists.gnu.org (lists.gnu.org [209.51.188.17]) by mx.zohomail.com with SMTPS id 1644330408824858.8199067908944; Tue, 8 Feb 2022 06:26:48 -0800 (PST) Received: from localhost ([::1]:54560 helo=lists1p.gnu.org) by lists.gnu.org with esmtp (Exim 4.90_1) (envelope-from <qemu-devel-bounces+importer=patchew.org@nongnu.org>) id 1nHRSB-0000OO-E7 for importer@patchew.org; Tue, 08 Feb 2022 09:26:47 -0500 Received: from eggs.gnu.org ([209.51.188.92]:34966) by lists.gnu.org with esmtps (TLS1.2:ECDHE_RSA_AES_256_GCM_SHA384:256) (Exim 4.90_1) (envelope-from <peter.maydell@linaro.org>) id 1nHOr1-0000y7-Uq for qemu-devel@nongnu.org; Tue, 08 Feb 2022 06:40:16 -0500 Received: from [2a00:1450:4864:20::42c] (port=39800 helo=mail-wr1-x42c.google.com) by eggs.gnu.org with esmtps (TLS1.2:ECDHE_RSA_AES_128_GCM_SHA256:128) (Exim 4.90_1) (envelope-from <peter.maydell@linaro.org>) id 1nHOqu-0002A8-FA for qemu-devel@nongnu.org; Tue, 08 Feb 2022 06:40:15 -0500 Received: by mail-wr1-x42c.google.com with SMTP id d27so1899422wrc.6 for <qemu-devel@nongnu.org>; Tue, 08 Feb 2022 03:40:08 -0800 (PST) Received: from orth.archaic.org.uk (orth.archaic.org.uk. [2001:8b0:1d0::2]) by smtp.gmail.com with ESMTPSA id r11sm4245199wrt.28.2022.02.08.03.40.06 for <qemu-devel@nongnu.org> (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 08 Feb 2022 03:40:06 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:subject:date:message-id:in-reply-to:references:mime-version :content-transfer-encoding; bh=I6ofd2+RFe7Q0zIenoAENpu2K6I00G1x9Fk14iiIxg0=; b=ID6sJXt+adJpITWPJjcZXLg3PagQTwDfw2optpPuTfR77eXog//kXncLFIg9JHnIA/ BijTEPXssedr2nkMyD5y6zYVwlSYwzcWAExxPuEqldMI72uqx3J7uIvTKtMDiVb/f3a2 HgGEk0a1vRSjq2EoY7d775X8mETPLUeu0Tz30tRLGms66K8nsruzK8lZsgxMj1p+hkvA l3v/3zr7pmVOzCrBKeBjHgQyE4wTBzd3+4WFjLalHJ8ftV/CVaXMkEP5A89U5HkgyYof 9s2ovKRGmvTPsmkPczqtIWtegQrfLA09DdJemTTZ3chnFlSw3v5dRuD6HjddEisaQ6h3 hRnw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=x-gm-message-state:from:to:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=I6ofd2+RFe7Q0zIenoAENpu2K6I00G1x9Fk14iiIxg0=; b=ZBG87mmh29PL7INpcrlrRQLuxatzIyZRXb+eG9xE/BosfxGp2ss9zTwcBcA0eg6eGu /JlNHaWD2pCCGjGZhJWmfKmb6Cq3kJNJjrrxEyTQ0fmQlZuIyKfI6DxMjOdVv6bosV6k +aZxJN+Ih4wv1epbH+z37yrT9F3reYbjGEI4mxt+eBwNewtbRhTWPsnQZCzGSibQDk/y m8/uCj9g4ic7q5rqaEMjCLxiSvyNGw4j+YvyLnp15AZzv+1sgq2rSSp1WQ+vjZMHI7oa vY75DQJWgC2yPiS3UOIDYDdwdMUM7chqizVCz2MfhgTYjv2u3Yu1MZK+l/GS4MjVfI9u FaMw== X-Gm-Message-State: AOAM532PMH2GNVjVwdpvERPdUz4vmu66h2EJw5N2BwoK+EiJYHQWYEIH /oIiCE4pF3zbaw+tvLs6XqQlEOAc0DQhmQ== X-Google-Smtp-Source: ABdhPJyqyuM6oNa5LOjFi/ySpB6OFPTjEDhT9TReIJz/4AGnOGLYDwj79fGkvvqeaqPnpix8/fImLA== X-Received: by 2002:a5d:49c1:: with SMTP id t1mr3233368wrs.359.1644320407004; Tue, 08 Feb 2022 03:40:07 -0800 (PST) From: Peter Maydell <peter.maydell@linaro.org> To: qemu-devel@nongnu.org Subject: [PULL 26/39] hw/intc/arm_gicv3_its: Use address_space_map() to access command queue packets Date: Tue, 8 Feb 2022 11:39:35 +0000 Message-Id: <20220208113948.3217356-27-peter.maydell@linaro.org> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20220208113948.3217356-1-peter.maydell@linaro.org> References: <20220208113948.3217356-1-peter.maydell@linaro.org> MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable X-Host-Lookup-Failed: Reverse DNS lookup failed for 2a00:1450:4864:20::42c (failed) Received-SPF: pass (zohomail.com: domain of gnu.org designates 209.51.188.17 as permitted sender) client-ip=209.51.188.17; envelope-from=qemu-devel-bounces+importer=patchew.org@nongnu.org; helo=lists.gnu.org; Received-SPF: pass client-ip=2a00:1450:4864:20::42c; envelope-from=peter.maydell@linaro.org; helo=mail-wr1-x42c.google.com X-Spam_score_int: -12 X-Spam_score: -1.3 X-Spam_bar: - X-Spam_report: (-1.3 / 5.0 requ) BAYES_00=-1.9, DKIM_SIGNED=0.1, DKIM_VALID=-0.1, DKIM_VALID_AU=-0.1, DKIM_VALID_EF=-0.1, PDS_HP_HELO_NORDNS=0.001, RCVD_IN_DNSWL_NONE=-0.0001, RDNS_NONE=0.793, SPF_HELO_NONE=0.001, SPF_PASS=-0.001, T_SCC_BODY_TEXT_LINE=-0.01 autolearn=no autolearn_force=no X-Spam_action: no action X-BeenThere: qemu-devel@nongnu.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: <qemu-devel.nongnu.org> List-Unsubscribe: <https://lists.nongnu.org/mailman/options/qemu-devel>, <mailto:qemu-devel-request@nongnu.org?subject=unsubscribe> List-Archive: <https://lists.nongnu.org/archive/html/qemu-devel> List-Post: <mailto:qemu-devel@nongnu.org> List-Help: <mailto:qemu-devel-request@nongnu.org?subject=help> List-Subscribe: <https://lists.nongnu.org/mailman/listinfo/qemu-devel>, <mailto:qemu-devel-request@nongnu.org?subject=subscribe> Errors-To: qemu-devel-bounces+importer=patchew.org@nongnu.org Sender: "Qemu-devel" <qemu-devel-bounces+importer=patchew.org@nongnu.org> X-ZohoMail-DKIM: pass (identity @linaro.org) X-ZM-MESSAGEID: 1644330411478100001 Content-Type: text/plain; charset="utf-8" Currently the ITS accesses each 8-byte doubleword in a 4-doubleword command packet with a separate address_space_ldq_le() call. This is awkward because the individual command processing functions have ended up with code to handle "load more doublewords out of the packet", which is both unwieldy and also a potential source of bugs because it's not obvious when looking at a line that pulls a field out of the 'value' variable which of the 4 doublewords that variable currently holds. Switch to using address_space_map() to map the whole command packet at once and fish the four doublewords out of it. Then each process_* function can start with a few lines of code that extract the fields it cares about. This requires us to split out the guts of process_its_cmd() into a new do_process_its_cmd(), because we were previously overloading the value and offset arguments as a backdoor way to directly pass the devid and eventid from a write to GITS_TRANSLATER. The new do_process_its_cmd() takes those arguments directly, and process_its_cmd() is just a wrapper that does the "read fields from command packet" part. Signed-off-by: Peter Maydell <peter.maydell@linaro.org> Reviewed-by: Richard Henderson <richard.henderson@linaro.org> Message-id: 20220201193207.2771604-2-peter.maydell@linaro.org --- hw/intc/gicv3_internal.h | 4 +- hw/intc/arm_gicv3_its.c | 208 +++++++++++---------------------------- 2 files changed, 62 insertions(+), 150 deletions(-) diff --git a/hw/intc/gicv3_internal.h b/hw/intc/gicv3_internal.h index b1af26df9f4..60c8617e4e4 100644 --- a/hw/intc/gicv3_internal.h +++ b/hw/intc/gicv3_internal.h @@ -309,8 +309,8 @@ FIELD(GITS_TYPER, CIL, 36, 1) #define LPI_CTE_ENABLED TABLE_ENTRY_VALID_MASK #define LPI_PRIORITY_MASK 0xfc =20 -#define GITS_CMDQ_ENTRY_SIZE 32 -#define NUM_BYTES_IN_DW 8 +#define GITS_CMDQ_ENTRY_WORDS 4 +#define GITS_CMDQ_ENTRY_SIZE (GITS_CMDQ_ENTRY_WORDS * sizeof(uint64_t)) =20 #define CMD_MASK 0xff =20 diff --git a/hw/intc/arm_gicv3_its.c b/hw/intc/arm_gicv3_its.c index 51d9be4ae6f..b74753fb8fe 100644 --- a/hw/intc/arm_gicv3_its.c +++ b/hw/intc/arm_gicv3_its.c @@ -224,11 +224,9 @@ static uint64_t get_dte(GICv3ITSState *s, uint32_t dev= id, MemTxResult *res) * 3. handling of ITS CLEAR command * 4. handling of ITS DISCARD command */ -static ItsCmdResult process_its_cmd(GICv3ITSState *s, uint64_t value, - uint32_t offset, ItsCmdType cmd) +static ItsCmdResult do_process_its_cmd(GICv3ITSState *s, uint32_t devid, + uint32_t eventid, ItsCmdType cmd) { - AddressSpace *as =3D &s->gicv3->dma_as; - uint32_t devid, eventid; MemTxResult res =3D MEMTX_OK; bool dte_valid; uint64_t dte =3D 0; @@ -240,22 +238,6 @@ static ItsCmdResult process_its_cmd(GICv3ITSState *s, = uint64_t value, bool cte_valid =3D false; uint64_t rdbase; =20 - if (cmd =3D=3D NONE) { - devid =3D offset; - } else { - devid =3D ((value & DEVID_MASK) >> DEVID_SHIFT); - - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - } - - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - - eventid =3D (value & EVENTID_MASK); - if (devid >=3D s->dt.num_entries) { qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid command attributes: devid %d>=3D%d", @@ -342,11 +324,19 @@ static ItsCmdResult process_its_cmd(GICv3ITSState *s,= uint64_t value, } return CMD_CONTINUE; } - -static ItsCmdResult process_mapti(GICv3ITSState *s, uint64_t value, - uint32_t offset, bool ignore_pInt) +static ItsCmdResult process_its_cmd(GICv3ITSState *s, const uint64_t *cmdp= kt, + ItsCmdType cmd) +{ + uint32_t devid, eventid; + + devid =3D (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT; + eventid =3D cmdpkt[1] & EVENTID_MASK; + return do_process_its_cmd(s, devid, eventid, cmd); +} + +static ItsCmdResult process_mapti(GICv3ITSState *s, const uint64_t *cmdpkt, + bool ignore_pInt) { - AddressSpace *as =3D &s->gicv3->dma_as; uint32_t devid, eventid; uint32_t pIntid =3D 0; uint64_t num_eventids; @@ -357,32 +347,16 @@ static ItsCmdResult process_mapti(GICv3ITSState *s, u= int64_t value, uint64_t dte =3D 0; IteEntry ite =3D {}; =20 - devid =3D ((value & DEVID_MASK) >> DEVID_SHIFT); - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - - eventid =3D (value & EVENTID_MASK); + devid =3D (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT; + eventid =3D cmdpkt[1] & EVENTID_MASK; =20 if (ignore_pInt) { pIntid =3D eventid; } else { - pIntid =3D ((value & pINTID_MASK) >> pINTID_SHIFT); + pIntid =3D (cmdpkt[1] & pINTID_MASK) >> pINTID_SHIFT; } =20 - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - - icid =3D value & ICID_MASK; + icid =3D cmdpkt[2] & ICID_MASK; =20 if (devid >=3D s->dt.num_entries) { qemu_log_mask(LOG_GUEST_ERROR, @@ -459,31 +433,18 @@ static bool update_cte(GICv3ITSState *s, uint16_t ici= d, bool valid, return res =3D=3D MEMTX_OK; } =20 -static ItsCmdResult process_mapc(GICv3ITSState *s, uint32_t offset) +static ItsCmdResult process_mapc(GICv3ITSState *s, const uint64_t *cmdpkt) { - AddressSpace *as =3D &s->gicv3->dma_as; uint16_t icid; uint64_t rdbase; bool valid; - MemTxResult res =3D MEMTX_OK; - uint64_t value; =20 - offset +=3D NUM_BYTES_IN_DW; - offset +=3D NUM_BYTES_IN_DW; + icid =3D cmdpkt[2] & ICID_MASK; =20 - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - - icid =3D value & ICID_MASK; - - rdbase =3D (value & R_MAPC_RDBASE_MASK) >> R_MAPC_RDBASE_SHIFT; + rdbase =3D (cmdpkt[2] & R_MAPC_RDBASE_MASK) >> R_MAPC_RDBASE_SHIFT; rdbase &=3D RDBASE_PROCNUM_MASK; =20 - valid =3D (value & CMD_FIELD_VALID_MASK); + valid =3D cmdpkt[2] & CMD_FIELD_VALID_MASK; =20 if ((icid >=3D s->ct.num_entries) || (rdbase >=3D s->gicv3->num_cpu)) { qemu_log_mask(LOG_GUEST_ERROR, @@ -532,39 +493,17 @@ static bool update_dte(GICv3ITSState *s, uint32_t dev= id, bool valid, return res =3D=3D MEMTX_OK; } =20 -static ItsCmdResult process_mapd(GICv3ITSState *s, uint64_t value, - uint32_t offset) +static ItsCmdResult process_mapd(GICv3ITSState *s, const uint64_t *cmdpkt) { - AddressSpace *as =3D &s->gicv3->dma_as; uint32_t devid; uint8_t size; uint64_t itt_addr; bool valid; - MemTxResult res =3D MEMTX_OK; =20 - devid =3D ((value & DEVID_MASK) >> DEVID_SHIFT); - - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - - size =3D (value & SIZE_MASK); - - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - - itt_addr =3D (value & ITTADDR_MASK) >> ITTADDR_SHIFT; - - valid =3D (value & CMD_FIELD_VALID_MASK); + devid =3D (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT; + size =3D cmdpkt[1] & SIZE_MASK; + itt_addr =3D (cmdpkt[2] & ITTADDR_MASK) >> ITTADDR_SHIFT; + valid =3D cmdpkt[2] & CMD_FIELD_VALID_MASK; =20 if ((devid >=3D s->dt.num_entries) || (size > FIELD_EX64(s->typer, GITS_TYPER, IDBITS))) { @@ -582,23 +521,13 @@ static ItsCmdResult process_mapd(GICv3ITSState *s, ui= nt64_t value, return update_dte(s, devid, valid, size, itt_addr) ? CMD_CONTINUE : CM= D_STALL; } =20 -static ItsCmdResult process_movall(GICv3ITSState *s, uint64_t value, - uint32_t offset) +static ItsCmdResult process_movall(GICv3ITSState *s, const uint64_t *cmdpk= t) { - AddressSpace *as =3D &s->gicv3->dma_as; - MemTxResult res =3D MEMTX_OK; uint64_t rd1, rd2; =20 - /* No fields in dwords 0 or 1 */ - offset +=3D NUM_BYTES_IN_DW; - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } + rd1 =3D FIELD_EX64(cmdpkt[2], MOVALL_2, RDBASE1); + rd2 =3D FIELD_EX64(cmdpkt[3], MOVALL_3, RDBASE2); =20 - rd1 =3D FIELD_EX64(value, MOVALL_2, RDBASE1); if (rd1 >=3D s->gicv3->num_cpu) { qemu_log_mask(LOG_GUEST_ERROR, "%s: RDBASE1 %" PRId64 @@ -606,15 +535,6 @@ static ItsCmdResult process_movall(GICv3ITSState *s, u= int64_t value, __func__, rd1, s->gicv3->num_cpu); return CMD_CONTINUE; } - - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - - rd2 =3D FIELD_EX64(value, MOVALL_3, RDBASE2); if (rd2 >=3D s->gicv3->num_cpu) { qemu_log_mask(LOG_GUEST_ERROR, "%s: RDBASE2 %" PRId64 @@ -634,10 +554,8 @@ static ItsCmdResult process_movall(GICv3ITSState *s, u= int64_t value, return CMD_CONTINUE; } =20 -static ItsCmdResult process_movi(GICv3ITSState *s, uint64_t value, - uint32_t offset) +static ItsCmdResult process_movi(GICv3ITSState *s, const uint64_t *cmdpkt) { - AddressSpace *as =3D &s->gicv3->dma_as; MemTxResult res =3D MEMTX_OK; uint32_t devid, eventid, intid; uint16_t old_icid, new_icid; @@ -648,23 +566,9 @@ static ItsCmdResult process_movi(GICv3ITSState *s, uin= t64_t value, uint64_t num_eventids; IteEntry ite =3D {}; =20 - devid =3D FIELD_EX64(value, MOVI_0, DEVICEID); - - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - eventid =3D FIELD_EX64(value, MOVI_1, EVENTID); - - offset +=3D NUM_BYTES_IN_DW; - value =3D address_space_ldq_le(as, s->cq.base_addr + offset, - MEMTXATTRS_UNSPECIFIED, &res); - if (res !=3D MEMTX_OK) { - return CMD_STALL; - } - new_icid =3D FIELD_EX64(value, MOVI_2, ICID); + devid =3D FIELD_EX64(cmdpkt[0], MOVI_0, DEVICEID); + eventid =3D FIELD_EX64(cmdpkt[1], MOVI_1, EVENTID); + new_icid =3D FIELD_EX64(cmdpkt[2], MOVI_2, ICID); =20 if (devid >=3D s->dt.num_entries) { qemu_log_mask(LOG_GUEST_ERROR, @@ -786,9 +690,7 @@ static void process_cmdq(GICv3ITSState *s) uint32_t wr_offset =3D 0; uint32_t rd_offset =3D 0; uint32_t cq_offset =3D 0; - uint64_t data; AddressSpace *as =3D &s->gicv3->dma_as; - MemTxResult res =3D MEMTX_OK; uint8_t cmd; int i; =20 @@ -816,28 +718,40 @@ static void process_cmdq(GICv3ITSState *s) =20 while (wr_offset !=3D rd_offset) { ItsCmdResult result =3D CMD_CONTINUE; + void *hostmem; + hwaddr buflen; + uint64_t cmdpkt[GITS_CMDQ_ENTRY_WORDS]; =20 cq_offset =3D (rd_offset * GITS_CMDQ_ENTRY_SIZE); - data =3D address_space_ldq_le(as, s->cq.base_addr + cq_offset, - MEMTXATTRS_UNSPECIFIED, &res); - if (res !=3D MEMTX_OK) { + + buflen =3D GITS_CMDQ_ENTRY_SIZE; + hostmem =3D address_space_map(as, s->cq.base_addr + cq_offset, + &buflen, false, MEMTXATTRS_UNSPECIFIED= ); + if (!hostmem || buflen !=3D GITS_CMDQ_ENTRY_SIZE) { + if (hostmem) { + address_space_unmap(as, hostmem, buflen, false, 0); + } s->creadr =3D FIELD_DP64(s->creadr, GITS_CREADR, STALLED, 1); qemu_log_mask(LOG_GUEST_ERROR, "%s: could not read command at 0x%" PRIx64 "\n", __func__, s->cq.base_addr + cq_offset); break; } + for (i =3D 0; i < ARRAY_SIZE(cmdpkt); i++) { + cmdpkt[i] =3D ldq_le_p(hostmem + i * sizeof(uint64_t)); + } + address_space_unmap(as, hostmem, buflen, false, 0); =20 - cmd =3D (data & CMD_MASK); + cmd =3D cmdpkt[0] & CMD_MASK; =20 trace_gicv3_its_process_command(rd_offset, cmd); =20 switch (cmd) { case GITS_CMD_INT: - result =3D process_its_cmd(s, data, cq_offset, INTERRUPT); + result =3D process_its_cmd(s, cmdpkt, INTERRUPT); break; case GITS_CMD_CLEAR: - result =3D process_its_cmd(s, data, cq_offset, CLEAR); + result =3D process_its_cmd(s, cmdpkt, CLEAR); break; case GITS_CMD_SYNC: /* @@ -848,19 +762,19 @@ static void process_cmdq(GICv3ITSState *s) */ break; case GITS_CMD_MAPD: - result =3D process_mapd(s, data, cq_offset); + result =3D process_mapd(s, cmdpkt); break; case GITS_CMD_MAPC: - result =3D process_mapc(s, cq_offset); + result =3D process_mapc(s, cmdpkt); break; case GITS_CMD_MAPTI: - result =3D process_mapti(s, data, cq_offset, false); + result =3D process_mapti(s, cmdpkt, false); break; case GITS_CMD_MAPI: - result =3D process_mapti(s, data, cq_offset, true); + result =3D process_mapti(s, cmdpkt, true); break; case GITS_CMD_DISCARD: - result =3D process_its_cmd(s, data, cq_offset, DISCARD); + result =3D process_its_cmd(s, cmdpkt, DISCARD); break; case GITS_CMD_INV: case GITS_CMD_INVALL: @@ -875,10 +789,10 @@ static void process_cmdq(GICv3ITSState *s) } break; case GITS_CMD_MOVI: - result =3D process_movi(s, data, cq_offset); + result =3D process_movi(s, cmdpkt); break; case GITS_CMD_MOVALL: - result =3D process_movall(s, data, cq_offset); + result =3D process_movall(s, cmdpkt); break; default: break; @@ -1032,15 +946,13 @@ static MemTxResult gicv3_its_translation_write(void = *opaque, hwaddr offset, { GICv3ITSState *s =3D (GICv3ITSState *)opaque; bool result =3D true; - uint32_t devid =3D 0; =20 trace_gicv3_its_translation_write(offset, data, size, attrs.requester_= id); =20 switch (offset) { case GITS_TRANSLATER: if (s->ctlr & R_GITS_CTLR_ENABLED_MASK) { - devid =3D attrs.requester_id; - result =3D process_its_cmd(s, data, devid, NONE); + result =3D do_process_its_cmd(s, attrs.requester_id, data, NON= E); } break; default: --=20 2.25.1