xref: /openbmc/qemu/hw/nvme/ctrl.c (revision 248f9209edfd289e7d97fb323e5075ccd55cc157)
188eea45cSKlaus Jensen /*
288eea45cSKlaus Jensen  * QEMU NVM Express Controller
388eea45cSKlaus Jensen  *
488eea45cSKlaus Jensen  * Copyright (c) 2012, Intel Corporation
588eea45cSKlaus Jensen  *
688eea45cSKlaus Jensen  * Written by Keith Busch <keith.busch@intel.com>
788eea45cSKlaus Jensen  *
888eea45cSKlaus Jensen  * This code is licensed under the GNU GPL v2 or later.
988eea45cSKlaus Jensen  */
1088eea45cSKlaus Jensen 
1188eea45cSKlaus Jensen /**
1288eea45cSKlaus Jensen  * Reference Specs: http://www.nvmexpress.org, 1.4, 1.3, 1.2, 1.1, 1.0e
1388eea45cSKlaus Jensen  *
1488eea45cSKlaus Jensen  *  https://nvmexpress.org/developers/nvme-specification/
1588eea45cSKlaus Jensen  *
1688eea45cSKlaus Jensen  *
1788eea45cSKlaus Jensen  * Notes on coding style
1888eea45cSKlaus Jensen  * ---------------------
1988eea45cSKlaus Jensen  * While QEMU coding style prefers lowercase hexadecimals in constants, the
209b4b4e51SMichael Tokarev  * NVMe subsystem use this format from the NVMe specifications in the comments
2188eea45cSKlaus Jensen  * (i.e. 'h' suffix instead of '0x' prefix).
2288eea45cSKlaus Jensen  *
2388eea45cSKlaus Jensen  * Usage
2488eea45cSKlaus Jensen  * -----
2588eea45cSKlaus Jensen  * See docs/system/nvme.rst for extensive documentation.
2688eea45cSKlaus Jensen  *
2788eea45cSKlaus Jensen  * Add options:
2888eea45cSKlaus Jensen  *      -drive file=<file>,if=none,id=<drive_id>
2988eea45cSKlaus Jensen  *      -device nvme-subsys,id=<subsys_id>,nqn=<nqn_id>
3088eea45cSKlaus Jensen  *      -device nvme,serial=<serial>,id=<bus_name>, \
3188eea45cSKlaus Jensen  *              cmb_size_mb=<cmb_size_mb[optional]>, \
3288eea45cSKlaus Jensen  *              [pmrdev=<mem_backend_file_id>,] \
3388eea45cSKlaus Jensen  *              max_ioqpairs=<N[optional]>, \
3488eea45cSKlaus Jensen  *              aerl=<N[optional]>,aer_max_queued=<N[optional]>, \
3588eea45cSKlaus Jensen  *              mdts=<N[optional]>,vsl=<N[optional]>, \
3688eea45cSKlaus Jensen  *              zoned.zasl=<N[optional]>, \
37cccc2651SNiklas Cassel  *              zoned.auto_transition=<on|off[optional]>, \
3844c2c094SLukasz Maniak  *              sriov_max_vfs=<N[optional]> \
39746d42b1SŁukasz Gieryk  *              sriov_vq_flexible=<N[optional]> \
40746d42b1SŁukasz Gieryk  *              sriov_vi_flexible=<N[optional]> \
41746d42b1SŁukasz Gieryk  *              sriov_max_vi_per_vf=<N[optional]> \
42746d42b1SŁukasz Gieryk  *              sriov_max_vq_per_vf=<N[optional]> \
43ebd1568fSAlan Adamson  *              atomic.dn=<on|off[optional]>, \
44ebd1568fSAlan Adamson  *              atomic.awun<N[optional]>, \
45ebd1568fSAlan Adamson  *              atomic.awupf<N[optional]>, \
4688eea45cSKlaus Jensen  *              subsys=<subsys_id>
4788eea45cSKlaus Jensen  *      -device nvme-ns,drive=<drive_id>,bus=<bus_name>,nsid=<nsid>,\
4888eea45cSKlaus Jensen  *              zoned=<true|false[optional]>, \
497491e0e4SMinwoo Im  *              subsys=<subsys_id>,shared=<true|false[optional]>, \
507491e0e4SMinwoo Im  *              detached=<true|false[optional]>, \
517491e0e4SMinwoo Im  *              zoned.zone_size=<N[optional]>, \
527491e0e4SMinwoo Im  *              zoned.zone_capacity=<N[optional]>, \
537491e0e4SMinwoo Im  *              zoned.descr_ext_size=<N[optional]>, \
547491e0e4SMinwoo Im  *              zoned.max_active=<N[optional]>, \
557491e0e4SMinwoo Im  *              zoned.max_open=<N[optional]>, \
567491e0e4SMinwoo Im  *              zoned.cross_read=<true|false[optional]>
5788eea45cSKlaus Jensen  *
5888eea45cSKlaus Jensen  * Note cmb_size_mb denotes size of CMB in MB. CMB is assumed to be at
5988eea45cSKlaus Jensen  * offset 0 in BAR2 and supports only WDS, RDS and SQS for now. By default, the
6088eea45cSKlaus Jensen  * device will use the "v1.4 CMB scheme" - use the `legacy-cmb` parameter to
6188eea45cSKlaus Jensen  * always enable the CMBLOC and CMBSZ registers (v1.3 behavior).
6288eea45cSKlaus Jensen  *
6388eea45cSKlaus Jensen  * Enabling pmr emulation can be achieved by pointing to memory-backend-file.
6488eea45cSKlaus Jensen  * For example:
6588eea45cSKlaus Jensen  * -object memory-backend-file,id=<mem_id>,share=on,mem-path=<file_path>, \
6688eea45cSKlaus Jensen  *  size=<size> .... -device nvme,...,pmrdev=<mem_id>
6788eea45cSKlaus Jensen  *
6888eea45cSKlaus Jensen  * The PMR will use BAR 4/5 exclusively.
6988eea45cSKlaus Jensen  *
7088eea45cSKlaus Jensen  * To place controller(s) and namespace(s) to a subsystem, then provide
7188eea45cSKlaus Jensen  * nvme-subsys device as above.
7288eea45cSKlaus Jensen  *
7388eea45cSKlaus Jensen  * nvme subsystem device parameters
7488eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
7588eea45cSKlaus Jensen  * - `nqn`
7688eea45cSKlaus Jensen  *   This parameter provides the `<nqn_id>` part of the string
7788eea45cSKlaus Jensen  *   `nqn.2019-08.org.qemu:<nqn_id>` which will be reported in the SUBNQN field
7888eea45cSKlaus Jensen  *   of subsystem controllers. Note that `<nqn_id>` should be unique per
7988eea45cSKlaus Jensen  *   subsystem, but this is not enforced by QEMU. If not specified, it will
8088eea45cSKlaus Jensen  *   default to the value of the `id` parameter (`<subsys_id>`).
8188eea45cSKlaus Jensen  *
8288eea45cSKlaus Jensen  * nvme device parameters
8388eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~
8488eea45cSKlaus Jensen  * - `subsys`
8588eea45cSKlaus Jensen  *   Specifying this parameter attaches the controller to the subsystem and
8688eea45cSKlaus Jensen  *   the SUBNQN field in the controller will report the NQN of the subsystem
8788eea45cSKlaus Jensen  *   device. This also enables multi controller capability represented in
8888eea45cSKlaus Jensen  *   Identify Controller data structure in CMIC (Controller Multi-path I/O and
89a0984714SDr. David Alan Gilbert  *   Namespace Sharing Capabilities).
9088eea45cSKlaus Jensen  *
9188eea45cSKlaus Jensen  * - `aerl`
9288eea45cSKlaus Jensen  *   The Asynchronous Event Request Limit (AERL). Indicates the maximum number
9388eea45cSKlaus Jensen  *   of concurrently outstanding Asynchronous Event Request commands support
9488eea45cSKlaus Jensen  *   by the controller. This is a 0's based value.
9588eea45cSKlaus Jensen  *
9688eea45cSKlaus Jensen  * - `aer_max_queued`
9788eea45cSKlaus Jensen  *   This is the maximum number of events that the device will enqueue for
9888eea45cSKlaus Jensen  *   completion when there are no outstanding AERs. When the maximum number of
9988eea45cSKlaus Jensen  *   enqueued events are reached, subsequent events will be dropped.
10088eea45cSKlaus Jensen  *
10188eea45cSKlaus Jensen  * - `mdts`
10288eea45cSKlaus Jensen  *   Indicates the maximum data transfer size for a command that transfers data
10388eea45cSKlaus Jensen  *   between host-accessible memory and the controller. The value is specified
10488eea45cSKlaus Jensen  *   as a power of two (2^n) and is in units of the minimum memory page size
10588eea45cSKlaus Jensen  *   (CAP.MPSMIN). The default value is 7 (i.e. 512 KiB).
10688eea45cSKlaus Jensen  *
10788eea45cSKlaus Jensen  * - `vsl`
10888eea45cSKlaus Jensen  *   Indicates the maximum data size limit for the Verify command. Like `mdts`,
10988eea45cSKlaus Jensen  *   this value is specified as a power of two (2^n) and is in units of the
11088eea45cSKlaus Jensen  *   minimum memory page size (CAP.MPSMIN). The default value is 7 (i.e. 512
11188eea45cSKlaus Jensen  *   KiB).
11288eea45cSKlaus Jensen  *
11388eea45cSKlaus Jensen  * - `zoned.zasl`
11488eea45cSKlaus Jensen  *   Indicates the maximum data transfer size for the Zone Append command. Like
11588eea45cSKlaus Jensen  *   `mdts`, the value is specified as a power of two (2^n) and is in units of
11688eea45cSKlaus Jensen  *   the minimum memory page size (CAP.MPSMIN). The default value is 0 (i.e.
11788eea45cSKlaus Jensen  *   defaulting to the value of `mdts`).
11888eea45cSKlaus Jensen  *
119cccc2651SNiklas Cassel  * - `zoned.auto_transition`
120cccc2651SNiklas Cassel  *   Indicates if zones in zone state implicitly opened can be automatically
121cccc2651SNiklas Cassel  *   transitioned to zone state closed for resource management purposes.
122cccc2651SNiklas Cassel  *   Defaults to 'on'.
123cccc2651SNiklas Cassel  *
12444c2c094SLukasz Maniak  * - `sriov_max_vfs`
12544c2c094SLukasz Maniak  *   Indicates the maximum number of PCIe virtual functions supported
12644c2c094SLukasz Maniak  *   by the controller. The default value is 0. Specifying a non-zero value
12744c2c094SLukasz Maniak  *   enables reporting of both SR-IOV and ARI capabilities by the NVMe device.
12844c2c094SLukasz Maniak  *   Virtual function controllers will not report SR-IOV capability.
12944c2c094SLukasz Maniak  *
130746d42b1SŁukasz Gieryk  *   NOTE: Single Root I/O Virtualization support is experimental.
131746d42b1SŁukasz Gieryk  *   All the related parameters may be subject to change.
132746d42b1SŁukasz Gieryk  *
133746d42b1SŁukasz Gieryk  * - `sriov_vq_flexible`
134746d42b1SŁukasz Gieryk  *   Indicates the total number of flexible queue resources assignable to all
135746d42b1SŁukasz Gieryk  *   the secondary controllers. Implicitly sets the number of primary
136746d42b1SŁukasz Gieryk  *   controller's private resources to `(max_ioqpairs - sriov_vq_flexible)`.
137746d42b1SŁukasz Gieryk  *
138746d42b1SŁukasz Gieryk  * - `sriov_vi_flexible`
139746d42b1SŁukasz Gieryk  *   Indicates the total number of flexible interrupt resources assignable to
140746d42b1SŁukasz Gieryk  *   all the secondary controllers. Implicitly sets the number of primary
141746d42b1SŁukasz Gieryk  *   controller's private resources to `(msix_qsize - sriov_vi_flexible)`.
142746d42b1SŁukasz Gieryk  *
143746d42b1SŁukasz Gieryk  * - `sriov_max_vi_per_vf`
144746d42b1SŁukasz Gieryk  *   Indicates the maximum number of virtual interrupt resources assignable
145746d42b1SŁukasz Gieryk  *   to a secondary controller. The default 0 resolves to
146746d42b1SŁukasz Gieryk  *   `(sriov_vi_flexible / sriov_max_vfs)`.
147746d42b1SŁukasz Gieryk  *
148746d42b1SŁukasz Gieryk  * - `sriov_max_vq_per_vf`
149746d42b1SŁukasz Gieryk  *   Indicates the maximum number of virtual queue resources assignable to
150746d42b1SŁukasz Gieryk  *   a secondary controller. The default 0 resolves to
151746d42b1SŁukasz Gieryk  *   `(sriov_vq_flexible / sriov_max_vfs)`.
152746d42b1SŁukasz Gieryk  *
15388eea45cSKlaus Jensen  * nvme namespace device parameters
15488eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
15588eea45cSKlaus Jensen  * - `shared`
15688eea45cSKlaus Jensen  *   When the parent nvme device (as defined explicitly by the 'bus' parameter
15788eea45cSKlaus Jensen  *   or implicitly by the most recently defined NvmeBus) is linked to an
15888eea45cSKlaus Jensen  *   nvme-subsys device, the namespace will be attached to all controllers in
15988eea45cSKlaus Jensen  *   the subsystem. If set to 'off' (the default), the namespace will remain a
16088eea45cSKlaus Jensen  *   private namespace and may only be attached to a single controller at a
16188eea45cSKlaus Jensen  *   time.
16288eea45cSKlaus Jensen  *
16388eea45cSKlaus Jensen  * - `detached`
16488eea45cSKlaus Jensen  *   This parameter is only valid together with the `subsys` parameter. If left
16588eea45cSKlaus Jensen  *   at the default value (`false/off`), the namespace will be attached to all
16688eea45cSKlaus Jensen  *   controllers in the NVMe subsystem at boot-up. If set to `true/on`, the
167eeef4329SGollu Appalanaidu  *   namespace will be available in the subsystem but not attached to any
16888eea45cSKlaus Jensen  *   controllers.
16988eea45cSKlaus Jensen  *
17088eea45cSKlaus Jensen  * Setting `zoned` to true selects Zoned Command Set at the namespace.
17188eea45cSKlaus Jensen  * In this case, the following namespace properties are available to configure
17288eea45cSKlaus Jensen  * zoned operation:
17388eea45cSKlaus Jensen  *     zoned.zone_size=<zone size in bytes, default: 128MiB>
17488eea45cSKlaus Jensen  *         The number may be followed by K, M, G as in kilo-, mega- or giga-.
17588eea45cSKlaus Jensen  *
17688eea45cSKlaus Jensen  *     zoned.zone_capacity=<zone capacity in bytes, default: zone size>
17788eea45cSKlaus Jensen  *         The value 0 (default) forces zone capacity to be the same as zone
17888eea45cSKlaus Jensen  *         size. The value of this property may not exceed zone size.
17988eea45cSKlaus Jensen  *
18088eea45cSKlaus Jensen  *     zoned.descr_ext_size=<zone descriptor extension size, default 0>
18188eea45cSKlaus Jensen  *         This value needs to be specified in 64B units. If it is zero,
18288eea45cSKlaus Jensen  *         namespace(s) will not support zone descriptor extensions.
18388eea45cSKlaus Jensen  *
18488eea45cSKlaus Jensen  *     zoned.max_active=<Maximum Active Resources (zones), default: 0>
18588eea45cSKlaus Jensen  *         The default value means there is no limit to the number of
18688eea45cSKlaus Jensen  *         concurrently active zones.
18788eea45cSKlaus Jensen  *
18888eea45cSKlaus Jensen  *     zoned.max_open=<Maximum Open Resources (zones), default: 0>
18988eea45cSKlaus Jensen  *         The default value means there is no limit to the number of
19088eea45cSKlaus Jensen  *         concurrently open zones.
19188eea45cSKlaus Jensen  *
19288eea45cSKlaus Jensen  *     zoned.cross_read=<enable RAZB, default: false>
19388eea45cSKlaus Jensen  *         Setting this property to true enables Read Across Zone Boundaries.
19488eea45cSKlaus Jensen  */
19588eea45cSKlaus Jensen 
19688eea45cSKlaus Jensen #include "qemu/osdep.h"
19788eea45cSKlaus Jensen #include "qemu/cutils.h"
19888eea45cSKlaus Jensen #include "qemu/error-report.h"
19988eea45cSKlaus Jensen #include "qemu/log.h"
20088eea45cSKlaus Jensen #include "qemu/units.h"
20111871f53SŁukasz Gieryk #include "qemu/range.h"
20288eea45cSKlaus Jensen #include "qapi/error.h"
20388eea45cSKlaus Jensen #include "qapi/visitor.h"
20488eea45cSKlaus Jensen #include "sysemu/sysemu.h"
20588eea45cSKlaus Jensen #include "sysemu/block-backend.h"
20688eea45cSKlaus Jensen #include "sysemu/hostmem.h"
20788eea45cSKlaus Jensen #include "hw/pci/msix.h"
20844c2c094SLukasz Maniak #include "hw/pci/pcie_sriov.h"
2094f947b10SWilfred Mallawa #include "sysemu/spdm-socket.h"
21088eea45cSKlaus Jensen #include "migration/vmstate.h"
21188eea45cSKlaus Jensen 
21288eea45cSKlaus Jensen #include "nvme.h"
21305f7ae45SKlaus Jensen #include "dif.h"
21488eea45cSKlaus Jensen #include "trace.h"
21588eea45cSKlaus Jensen 
21688eea45cSKlaus Jensen #define NVME_MAX_IOQPAIRS 0xffff
21788eea45cSKlaus Jensen #define NVME_DB_SIZE  4
21888eea45cSKlaus Jensen #define NVME_SPEC_VER 0x00010400
21988eea45cSKlaus Jensen #define NVME_CMB_BIR 2
22088eea45cSKlaus Jensen #define NVME_PMR_BIR 4
22188eea45cSKlaus Jensen #define NVME_TEMPERATURE 0x143
22288eea45cSKlaus Jensen #define NVME_TEMPERATURE_WARNING 0x157
22388eea45cSKlaus Jensen #define NVME_TEMPERATURE_CRITICAL 0x175
22488eea45cSKlaus Jensen #define NVME_NUM_FW_SLOTS 1
22588eea45cSKlaus Jensen #define NVME_DEFAULT_MAX_ZA_SIZE (128 * KiB)
226746d42b1SŁukasz Gieryk #define NVME_VF_RES_GRANULARITY 1
22744c2c094SLukasz Maniak #define NVME_VF_OFFSET 0x1
22844c2c094SLukasz Maniak #define NVME_VF_STRIDE 1
22988eea45cSKlaus Jensen 
23088eea45cSKlaus Jensen #define NVME_GUEST_ERR(trace, fmt, ...) \
23188eea45cSKlaus Jensen     do { \
23288eea45cSKlaus Jensen         (trace_##trace)(__VA_ARGS__); \
23388eea45cSKlaus Jensen         qemu_log_mask(LOG_GUEST_ERROR, #trace \
23488eea45cSKlaus Jensen             " in %s: " fmt "\n", __func__, ## __VA_ARGS__); \
23588eea45cSKlaus Jensen     } while (0)
23688eea45cSKlaus Jensen 
23788eea45cSKlaus Jensen static const bool nvme_feature_support[NVME_FID_MAX] = {
23888eea45cSKlaus Jensen     [NVME_ARBITRATION]              = true,
23988eea45cSKlaus Jensen     [NVME_POWER_MANAGEMENT]         = true,
24088eea45cSKlaus Jensen     [NVME_TEMPERATURE_THRESHOLD]    = true,
24188eea45cSKlaus Jensen     [NVME_ERROR_RECOVERY]           = true,
24288eea45cSKlaus Jensen     [NVME_VOLATILE_WRITE_CACHE]     = true,
24388eea45cSKlaus Jensen     [NVME_NUMBER_OF_QUEUES]         = true,
24488eea45cSKlaus Jensen     [NVME_INTERRUPT_COALESCING]     = true,
24588eea45cSKlaus Jensen     [NVME_INTERRUPT_VECTOR_CONF]    = true,
24688eea45cSKlaus Jensen     [NVME_WRITE_ATOMICITY]          = true,
24788eea45cSKlaus Jensen     [NVME_ASYNCHRONOUS_EVENT_CONF]  = true,
24888eea45cSKlaus Jensen     [NVME_TIMESTAMP]                = true,
249d0c0697bSNaveen Nagar     [NVME_HOST_BEHAVIOR_SUPPORT]    = true,
25088eea45cSKlaus Jensen     [NVME_COMMAND_SET_PROFILE]      = true,
25173064edfSJesper Devantier     [NVME_FDP_MODE]                 = true,
25273064edfSJesper Devantier     [NVME_FDP_EVENTS]               = true,
25388eea45cSKlaus Jensen };
25488eea45cSKlaus Jensen 
25588eea45cSKlaus Jensen static const uint32_t nvme_feature_cap[NVME_FID_MAX] = {
25688eea45cSKlaus Jensen     [NVME_TEMPERATURE_THRESHOLD]    = NVME_FEAT_CAP_CHANGE,
25788eea45cSKlaus Jensen     [NVME_ERROR_RECOVERY]           = NVME_FEAT_CAP_CHANGE | NVME_FEAT_CAP_NS,
25888eea45cSKlaus Jensen     [NVME_VOLATILE_WRITE_CACHE]     = NVME_FEAT_CAP_CHANGE,
25988eea45cSKlaus Jensen     [NVME_NUMBER_OF_QUEUES]         = NVME_FEAT_CAP_CHANGE,
260ebd1568fSAlan Adamson     [NVME_WRITE_ATOMICITY]          = NVME_FEAT_CAP_CHANGE,
26188eea45cSKlaus Jensen     [NVME_ASYNCHRONOUS_EVENT_CONF]  = NVME_FEAT_CAP_CHANGE,
26288eea45cSKlaus Jensen     [NVME_TIMESTAMP]                = NVME_FEAT_CAP_CHANGE,
263d0c0697bSNaveen Nagar     [NVME_HOST_BEHAVIOR_SUPPORT]    = NVME_FEAT_CAP_CHANGE,
26488eea45cSKlaus Jensen     [NVME_COMMAND_SET_PROFILE]      = NVME_FEAT_CAP_CHANGE,
26573064edfSJesper Devantier     [NVME_FDP_MODE]                 = NVME_FEAT_CAP_CHANGE,
26673064edfSJesper Devantier     [NVME_FDP_EVENTS]               = NVME_FEAT_CAP_CHANGE | NVME_FEAT_CAP_NS,
26788eea45cSKlaus Jensen };
26888eea45cSKlaus Jensen 
26988eea45cSKlaus Jensen static const uint32_t nvme_cse_acs[256] = {
27088eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_SQ]        = NVME_CMD_EFF_CSUPP,
27188eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_SQ]        = NVME_CMD_EFF_CSUPP,
27288eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_LOG_PAGE]     = NVME_CMD_EFF_CSUPP,
27388eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_CQ]        = NVME_CMD_EFF_CSUPP,
27488eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_CQ]        = NVME_CMD_EFF_CSUPP,
27588eea45cSKlaus Jensen     [NVME_ADM_CMD_IDENTIFY]         = NVME_CMD_EFF_CSUPP,
27688eea45cSKlaus Jensen     [NVME_ADM_CMD_ABORT]            = NVME_CMD_EFF_CSUPP,
27788eea45cSKlaus Jensen     [NVME_ADM_CMD_SET_FEATURES]     = NVME_CMD_EFF_CSUPP,
27888eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_FEATURES]     = NVME_CMD_EFF_CSUPP,
27988eea45cSKlaus Jensen     [NVME_ADM_CMD_ASYNC_EV_REQ]     = NVME_CMD_EFF_CSUPP,
28088eea45cSKlaus Jensen     [NVME_ADM_CMD_NS_ATTACHMENT]    = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_NIC,
28111871f53SŁukasz Gieryk     [NVME_ADM_CMD_VIRT_MNGMT]       = NVME_CMD_EFF_CSUPP,
2823f7fe8deSJinhao Fan     [NVME_ADM_CMD_DBBUF_CONFIG]     = NVME_CMD_EFF_CSUPP,
28388eea45cSKlaus Jensen     [NVME_ADM_CMD_FORMAT_NVM]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
284e181d3daSGollu Appalanaidu     [NVME_ADM_CMD_DIRECTIVE_RECV]   = NVME_CMD_EFF_CSUPP,
285e181d3daSGollu Appalanaidu     [NVME_ADM_CMD_DIRECTIVE_SEND]   = NVME_CMD_EFF_CSUPP,
28688eea45cSKlaus Jensen };
28788eea45cSKlaus Jensen 
28888eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_none[256];
28988eea45cSKlaus Jensen 
29088eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_nvm[256] = {
29188eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29288eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29388eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29488eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
29588eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29688eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
29788eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29888eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
29973064edfSJesper Devantier     [NVME_CMD_IO_MGMT_RECV]         = NVME_CMD_EFF_CSUPP,
30073064edfSJesper Devantier     [NVME_CMD_IO_MGMT_SEND]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30188eea45cSKlaus Jensen };
30288eea45cSKlaus Jensen 
30388eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_zoned[256] = {
30488eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30588eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30688eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30788eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
30888eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30988eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
31088eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
31188eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
31288eea45cSKlaus Jensen     [NVME_CMD_ZONE_APPEND]          = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
31388eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_SEND]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
31488eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_RECV]       = NVME_CMD_EFF_CSUPP,
31588eea45cSKlaus Jensen };
31688eea45cSKlaus Jensen 
31788eea45cSKlaus Jensen static void nvme_process_sq(void *opaque);
31811871f53SŁukasz Gieryk static void nvme_ctrl_reset(NvmeCtrl *n, NvmeResetType rst);
31973064edfSJesper Devantier static inline uint64_t nvme_get_timestamp(const NvmeCtrl *n);
32088eea45cSKlaus Jensen 
nvme_sqid(NvmeRequest * req)32188eea45cSKlaus Jensen static uint16_t nvme_sqid(NvmeRequest *req)
32288eea45cSKlaus Jensen {
32388eea45cSKlaus Jensen     return le16_to_cpu(req->sq->sqid);
32488eea45cSKlaus Jensen }
32588eea45cSKlaus Jensen 
nvme_make_pid(NvmeNamespace * ns,uint16_t rg,uint16_t ph)32673064edfSJesper Devantier static inline uint16_t nvme_make_pid(NvmeNamespace *ns, uint16_t rg,
32773064edfSJesper Devantier                                      uint16_t ph)
32873064edfSJesper Devantier {
32973064edfSJesper Devantier     uint16_t rgif = ns->endgrp->fdp.rgif;
33073064edfSJesper Devantier 
33173064edfSJesper Devantier     if (!rgif) {
33273064edfSJesper Devantier         return ph;
33373064edfSJesper Devantier     }
33473064edfSJesper Devantier 
33573064edfSJesper Devantier     return (rg << (16 - rgif)) | ph;
33673064edfSJesper Devantier }
33773064edfSJesper Devantier 
nvme_ph_valid(NvmeNamespace * ns,uint16_t ph)33873064edfSJesper Devantier static inline bool nvme_ph_valid(NvmeNamespace *ns, uint16_t ph)
33973064edfSJesper Devantier {
34073064edfSJesper Devantier     return ph < ns->fdp.nphs;
34173064edfSJesper Devantier }
34273064edfSJesper Devantier 
nvme_rg_valid(NvmeEnduranceGroup * endgrp,uint16_t rg)34373064edfSJesper Devantier static inline bool nvme_rg_valid(NvmeEnduranceGroup *endgrp, uint16_t rg)
34473064edfSJesper Devantier {
34573064edfSJesper Devantier     return rg < endgrp->fdp.nrg;
34673064edfSJesper Devantier }
34773064edfSJesper Devantier 
nvme_pid2ph(NvmeNamespace * ns,uint16_t pid)34873064edfSJesper Devantier static inline uint16_t nvme_pid2ph(NvmeNamespace *ns, uint16_t pid)
34973064edfSJesper Devantier {
35073064edfSJesper Devantier     uint16_t rgif = ns->endgrp->fdp.rgif;
35173064edfSJesper Devantier 
35273064edfSJesper Devantier     if (!rgif) {
35373064edfSJesper Devantier         return pid;
35473064edfSJesper Devantier     }
35573064edfSJesper Devantier 
35673064edfSJesper Devantier     return pid & ((1 << (15 - rgif)) - 1);
35773064edfSJesper Devantier }
35873064edfSJesper Devantier 
nvme_pid2rg(NvmeNamespace * ns,uint16_t pid)35973064edfSJesper Devantier static inline uint16_t nvme_pid2rg(NvmeNamespace *ns, uint16_t pid)
36073064edfSJesper Devantier {
36173064edfSJesper Devantier     uint16_t rgif = ns->endgrp->fdp.rgif;
36273064edfSJesper Devantier 
36373064edfSJesper Devantier     if (!rgif) {
36473064edfSJesper Devantier         return 0;
36573064edfSJesper Devantier     }
36673064edfSJesper Devantier 
36773064edfSJesper Devantier     return pid >> (16 - rgif);
36873064edfSJesper Devantier }
36973064edfSJesper Devantier 
nvme_parse_pid(NvmeNamespace * ns,uint16_t pid,uint16_t * ph,uint16_t * rg)37073064edfSJesper Devantier static inline bool nvme_parse_pid(NvmeNamespace *ns, uint16_t pid,
37173064edfSJesper Devantier                                   uint16_t *ph, uint16_t *rg)
37273064edfSJesper Devantier {
37373064edfSJesper Devantier     *rg = nvme_pid2rg(ns, pid);
37473064edfSJesper Devantier     *ph = nvme_pid2ph(ns, pid);
37573064edfSJesper Devantier 
37673064edfSJesper Devantier     return nvme_ph_valid(ns, *ph) && nvme_rg_valid(ns->endgrp, *rg);
37773064edfSJesper Devantier }
37873064edfSJesper Devantier 
nvme_assign_zone_state(NvmeNamespace * ns,NvmeZone * zone,NvmeZoneState state)37988eea45cSKlaus Jensen static void nvme_assign_zone_state(NvmeNamespace *ns, NvmeZone *zone,
38088eea45cSKlaus Jensen                                    NvmeZoneState state)
38188eea45cSKlaus Jensen {
38288eea45cSKlaus Jensen     if (QTAILQ_IN_USE(zone, entry)) {
38388eea45cSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
38488eea45cSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
38588eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->exp_open_zones, zone, entry);
38688eea45cSKlaus Jensen             break;
38788eea45cSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
38888eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
38988eea45cSKlaus Jensen             break;
39088eea45cSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
39188eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->closed_zones, zone, entry);
39288eea45cSKlaus Jensen             break;
39388eea45cSKlaus Jensen         case NVME_ZONE_STATE_FULL:
39488eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->full_zones, zone, entry);
39588eea45cSKlaus Jensen         default:
39688eea45cSKlaus Jensen             ;
39788eea45cSKlaus Jensen         }
39888eea45cSKlaus Jensen     }
39988eea45cSKlaus Jensen 
40088eea45cSKlaus Jensen     nvme_set_zone_state(zone, state);
40188eea45cSKlaus Jensen 
40288eea45cSKlaus Jensen     switch (state) {
40388eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
40488eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->exp_open_zones, zone, entry);
40588eea45cSKlaus Jensen         break;
40688eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
40788eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->imp_open_zones, zone, entry);
40888eea45cSKlaus Jensen         break;
40988eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
41088eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->closed_zones, zone, entry);
41188eea45cSKlaus Jensen         break;
41288eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
41388eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->full_zones, zone, entry);
41488eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
41588eea45cSKlaus Jensen         break;
41688eea45cSKlaus Jensen     default:
41788eea45cSKlaus Jensen         zone->d.za = 0;
41888eea45cSKlaus Jensen     }
41988eea45cSKlaus Jensen }
42088eea45cSKlaus Jensen 
nvme_zns_check_resources(NvmeNamespace * ns,uint32_t act,uint32_t opn,uint32_t zrwa)421e321b4cdSKlaus Jensen static uint16_t nvme_zns_check_resources(NvmeNamespace *ns, uint32_t act,
422e321b4cdSKlaus Jensen                                          uint32_t opn, uint32_t zrwa)
42388eea45cSKlaus Jensen {
42488eea45cSKlaus Jensen     if (ns->params.max_active_zones != 0 &&
42588eea45cSKlaus Jensen         ns->nr_active_zones + act > ns->params.max_active_zones) {
42688eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_active_res(ns->params.max_active_zones);
42788eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_ACTIVE | NVME_DNR;
42888eea45cSKlaus Jensen     }
429e321b4cdSKlaus Jensen 
43088eea45cSKlaus Jensen     if (ns->params.max_open_zones != 0 &&
43188eea45cSKlaus Jensen         ns->nr_open_zones + opn > ns->params.max_open_zones) {
43288eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_open_res(ns->params.max_open_zones);
43388eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_OPEN | NVME_DNR;
43488eea45cSKlaus Jensen     }
43588eea45cSKlaus Jensen 
436e321b4cdSKlaus Jensen     if (zrwa > ns->zns.numzrwa) {
437e321b4cdSKlaus Jensen         return NVME_NOZRWA | NVME_DNR;
438e321b4cdSKlaus Jensen     }
439e321b4cdSKlaus Jensen 
44088eea45cSKlaus Jensen     return NVME_SUCCESS;
44188eea45cSKlaus Jensen }
44288eea45cSKlaus Jensen 
443e321b4cdSKlaus Jensen /*
444e321b4cdSKlaus Jensen  * Check if we can open a zone without exceeding open/active limits.
445e321b4cdSKlaus Jensen  * AOR stands for "Active and Open Resources" (see TP 4053 section 2.5).
446e321b4cdSKlaus Jensen  */
nvme_aor_check(NvmeNamespace * ns,uint32_t act,uint32_t opn)447e321b4cdSKlaus Jensen static uint16_t nvme_aor_check(NvmeNamespace *ns, uint32_t act, uint32_t opn)
448e321b4cdSKlaus Jensen {
449e321b4cdSKlaus Jensen     return nvme_zns_check_resources(ns, act, opn, 0);
450e321b4cdSKlaus Jensen }
451e321b4cdSKlaus Jensen 
nvme_fdp_alloc_event(NvmeCtrl * n,NvmeFdpEventBuffer * ebuf)45273064edfSJesper Devantier static NvmeFdpEvent *nvme_fdp_alloc_event(NvmeCtrl *n, NvmeFdpEventBuffer *ebuf)
45373064edfSJesper Devantier {
45473064edfSJesper Devantier     NvmeFdpEvent *ret = NULL;
45573064edfSJesper Devantier     bool is_full = ebuf->next == ebuf->start && ebuf->nelems;
45673064edfSJesper Devantier 
45773064edfSJesper Devantier     ret = &ebuf->events[ebuf->next++];
45873064edfSJesper Devantier     if (unlikely(ebuf->next == NVME_FDP_MAX_EVENTS)) {
45973064edfSJesper Devantier         ebuf->next = 0;
46073064edfSJesper Devantier     }
46173064edfSJesper Devantier     if (is_full) {
46273064edfSJesper Devantier         ebuf->start = ebuf->next;
46373064edfSJesper Devantier     } else {
46473064edfSJesper Devantier         ebuf->nelems++;
46573064edfSJesper Devantier     }
46673064edfSJesper Devantier 
46773064edfSJesper Devantier     memset(ret, 0, sizeof(NvmeFdpEvent));
46873064edfSJesper Devantier     ret->timestamp = nvme_get_timestamp(n);
46973064edfSJesper Devantier 
47073064edfSJesper Devantier     return ret;
47173064edfSJesper Devantier }
47273064edfSJesper Devantier 
log_event(NvmeRuHandle * ruh,uint8_t event_type)47373064edfSJesper Devantier static inline int log_event(NvmeRuHandle *ruh, uint8_t event_type)
47473064edfSJesper Devantier {
47573064edfSJesper Devantier     return (ruh->event_filter >> nvme_fdp_evf_shifts[event_type]) & 0x1;
47673064edfSJesper Devantier }
47773064edfSJesper Devantier 
nvme_update_ruh(NvmeCtrl * n,NvmeNamespace * ns,uint16_t pid)47873064edfSJesper Devantier static bool nvme_update_ruh(NvmeCtrl *n, NvmeNamespace *ns, uint16_t pid)
47973064edfSJesper Devantier {
48073064edfSJesper Devantier     NvmeEnduranceGroup *endgrp = ns->endgrp;
48173064edfSJesper Devantier     NvmeRuHandle *ruh;
48273064edfSJesper Devantier     NvmeReclaimUnit *ru;
48373064edfSJesper Devantier     NvmeFdpEvent *e = NULL;
48473064edfSJesper Devantier     uint16_t ph, rg, ruhid;
48573064edfSJesper Devantier 
48673064edfSJesper Devantier     if (!nvme_parse_pid(ns, pid, &ph, &rg)) {
48773064edfSJesper Devantier         return false;
48873064edfSJesper Devantier     }
48973064edfSJesper Devantier 
49073064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
49173064edfSJesper Devantier 
49273064edfSJesper Devantier     ruh = &endgrp->fdp.ruhs[ruhid];
49373064edfSJesper Devantier     ru = &ruh->rus[rg];
49473064edfSJesper Devantier 
49573064edfSJesper Devantier     if (ru->ruamw) {
49673064edfSJesper Devantier         if (log_event(ruh, FDP_EVT_RU_NOT_FULLY_WRITTEN)) {
49773064edfSJesper Devantier             e = nvme_fdp_alloc_event(n, &endgrp->fdp.host_events);
49873064edfSJesper Devantier             e->type = FDP_EVT_RU_NOT_FULLY_WRITTEN;
49973064edfSJesper Devantier             e->flags = FDPEF_PIV | FDPEF_NSIDV | FDPEF_LV;
50073064edfSJesper Devantier             e->pid = cpu_to_le16(pid);
50173064edfSJesper Devantier             e->nsid = cpu_to_le32(ns->params.nsid);
50273064edfSJesper Devantier             e->rgid = cpu_to_le16(rg);
50373064edfSJesper Devantier             e->ruhid = cpu_to_le16(ruhid);
50473064edfSJesper Devantier         }
50573064edfSJesper Devantier 
50673064edfSJesper Devantier         /* log (eventual) GC overhead of prematurely swapping the RU */
50773064edfSJesper Devantier         nvme_fdp_stat_inc(&endgrp->fdp.mbmw, nvme_l2b(ns, ru->ruamw));
50873064edfSJesper Devantier     }
50973064edfSJesper Devantier 
51073064edfSJesper Devantier     ru->ruamw = ruh->ruamw;
51173064edfSJesper Devantier 
51273064edfSJesper Devantier     return true;
51373064edfSJesper Devantier }
51473064edfSJesper Devantier 
nvme_addr_is_cmb(NvmeCtrl * n,hwaddr addr)51588eea45cSKlaus Jensen static bool nvme_addr_is_cmb(NvmeCtrl *n, hwaddr addr)
51688eea45cSKlaus Jensen {
51788eea45cSKlaus Jensen     hwaddr hi, lo;
51888eea45cSKlaus Jensen 
51988eea45cSKlaus Jensen     if (!n->cmb.cmse) {
52088eea45cSKlaus Jensen         return false;
52188eea45cSKlaus Jensen     }
52288eea45cSKlaus Jensen 
52388eea45cSKlaus Jensen     lo = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
52488eea45cSKlaus Jensen     hi = lo + int128_get64(n->cmb.mem.size);
52588eea45cSKlaus Jensen 
52688eea45cSKlaus Jensen     return addr >= lo && addr < hi;
52788eea45cSKlaus Jensen }
52888eea45cSKlaus Jensen 
nvme_addr_to_cmb(NvmeCtrl * n,hwaddr addr)52988eea45cSKlaus Jensen static inline void *nvme_addr_to_cmb(NvmeCtrl *n, hwaddr addr)
53088eea45cSKlaus Jensen {
53188eea45cSKlaus Jensen     hwaddr base = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
53288eea45cSKlaus Jensen     return &n->cmb.buf[addr - base];
53388eea45cSKlaus Jensen }
53488eea45cSKlaus Jensen 
nvme_addr_is_pmr(NvmeCtrl * n,hwaddr addr)53588eea45cSKlaus Jensen static bool nvme_addr_is_pmr(NvmeCtrl *n, hwaddr addr)
53688eea45cSKlaus Jensen {
53788eea45cSKlaus Jensen     hwaddr hi;
53888eea45cSKlaus Jensen 
53988eea45cSKlaus Jensen     if (!n->pmr.cmse) {
54088eea45cSKlaus Jensen         return false;
54188eea45cSKlaus Jensen     }
54288eea45cSKlaus Jensen 
54388eea45cSKlaus Jensen     hi = n->pmr.cba + int128_get64(n->pmr.dev->mr.size);
54488eea45cSKlaus Jensen 
54588eea45cSKlaus Jensen     return addr >= n->pmr.cba && addr < hi;
54688eea45cSKlaus Jensen }
54788eea45cSKlaus Jensen 
nvme_addr_to_pmr(NvmeCtrl * n,hwaddr addr)54888eea45cSKlaus Jensen static inline void *nvme_addr_to_pmr(NvmeCtrl *n, hwaddr addr)
54988eea45cSKlaus Jensen {
55088eea45cSKlaus Jensen     return memory_region_get_ram_ptr(&n->pmr.dev->mr) + (addr - n->pmr.cba);
55188eea45cSKlaus Jensen }
55288eea45cSKlaus Jensen 
nvme_addr_is_iomem(NvmeCtrl * n,hwaddr addr)553736b0164SKlaus Jensen static inline bool nvme_addr_is_iomem(NvmeCtrl *n, hwaddr addr)
554736b0164SKlaus Jensen {
555736b0164SKlaus Jensen     hwaddr hi, lo;
556736b0164SKlaus Jensen 
557736b0164SKlaus Jensen     /*
558736b0164SKlaus Jensen      * The purpose of this check is to guard against invalid "local" access to
559736b0164SKlaus Jensen      * the iomem (i.e. controller registers). Thus, we check against the range
560736b0164SKlaus Jensen      * covered by the 'bar0' MemoryRegion since that is currently composed of
561736b0164SKlaus Jensen      * two subregions (the NVMe "MBAR" and the MSI-X table/pba). Note, however,
562736b0164SKlaus Jensen      * that if the device model is ever changed to allow the CMB to be located
563736b0164SKlaus Jensen      * in BAR0 as well, then this must be changed.
564736b0164SKlaus Jensen      */
565736b0164SKlaus Jensen     lo = n->bar0.addr;
566736b0164SKlaus Jensen     hi = lo + int128_get64(n->bar0.size);
567736b0164SKlaus Jensen 
568736b0164SKlaus Jensen     return addr >= lo && addr < hi;
569736b0164SKlaus Jensen }
570736b0164SKlaus Jensen 
nvme_addr_read(NvmeCtrl * n,hwaddr addr,void * buf,int size)57188eea45cSKlaus Jensen static int nvme_addr_read(NvmeCtrl *n, hwaddr addr, void *buf, int size)
57288eea45cSKlaus Jensen {
57388eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
57488eea45cSKlaus Jensen     if (hi < addr) {
57588eea45cSKlaus Jensen         return 1;
57688eea45cSKlaus Jensen     }
57788eea45cSKlaus Jensen 
57888eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
57988eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_cmb(n, addr), size);
58088eea45cSKlaus Jensen         return 0;
58188eea45cSKlaus Jensen     }
58288eea45cSKlaus Jensen 
58388eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
58488eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_pmr(n, addr), size);
58588eea45cSKlaus Jensen         return 0;
58688eea45cSKlaus Jensen     }
58788eea45cSKlaus Jensen 
58848b32c28SKlaus Jensen     return pci_dma_read(PCI_DEVICE(n), addr, buf, size);
58988eea45cSKlaus Jensen }
59088eea45cSKlaus Jensen 
nvme_addr_write(NvmeCtrl * n,hwaddr addr,const void * buf,int size)591e080ce86SPhilippe Mathieu-Daudé static int nvme_addr_write(NvmeCtrl *n, hwaddr addr, const void *buf, int size)
59288eea45cSKlaus Jensen {
59388eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
59488eea45cSKlaus Jensen     if (hi < addr) {
59588eea45cSKlaus Jensen         return 1;
59688eea45cSKlaus Jensen     }
59788eea45cSKlaus Jensen 
59888eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
59988eea45cSKlaus Jensen         memcpy(nvme_addr_to_cmb(n, addr), buf, size);
60088eea45cSKlaus Jensen         return 0;
60188eea45cSKlaus Jensen     }
60288eea45cSKlaus Jensen 
60388eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
60488eea45cSKlaus Jensen         memcpy(nvme_addr_to_pmr(n, addr), buf, size);
60588eea45cSKlaus Jensen         return 0;
60688eea45cSKlaus Jensen     }
60788eea45cSKlaus Jensen 
60848b32c28SKlaus Jensen     return pci_dma_write(PCI_DEVICE(n), addr, buf, size);
60988eea45cSKlaus Jensen }
61088eea45cSKlaus Jensen 
nvme_nsid_valid(NvmeCtrl * n,uint32_t nsid)61188eea45cSKlaus Jensen static bool nvme_nsid_valid(NvmeCtrl *n, uint32_t nsid)
61288eea45cSKlaus Jensen {
61388eea45cSKlaus Jensen     return nsid &&
61488eea45cSKlaus Jensen         (nsid == NVME_NSID_BROADCAST || nsid <= NVME_MAX_NAMESPACES);
61588eea45cSKlaus Jensen }
61688eea45cSKlaus Jensen 
nvme_check_sqid(NvmeCtrl * n,uint16_t sqid)61788eea45cSKlaus Jensen static int nvme_check_sqid(NvmeCtrl *n, uint16_t sqid)
61888eea45cSKlaus Jensen {
619decc0261SŁukasz Gieryk     return sqid < n->conf_ioqpairs + 1 && n->sq[sqid] != NULL ? 0 : -1;
62088eea45cSKlaus Jensen }
62188eea45cSKlaus Jensen 
nvme_check_cqid(NvmeCtrl * n,uint16_t cqid)62288eea45cSKlaus Jensen static int nvme_check_cqid(NvmeCtrl *n, uint16_t cqid)
62388eea45cSKlaus Jensen {
624decc0261SŁukasz Gieryk     return cqid < n->conf_ioqpairs + 1 && n->cq[cqid] != NULL ? 0 : -1;
62588eea45cSKlaus Jensen }
62688eea45cSKlaus Jensen 
nvme_inc_cq_tail(NvmeCQueue * cq)62788eea45cSKlaus Jensen static void nvme_inc_cq_tail(NvmeCQueue *cq)
62888eea45cSKlaus Jensen {
62988eea45cSKlaus Jensen     cq->tail++;
63088eea45cSKlaus Jensen     if (cq->tail >= cq->size) {
63188eea45cSKlaus Jensen         cq->tail = 0;
63288eea45cSKlaus Jensen         cq->phase = !cq->phase;
63388eea45cSKlaus Jensen     }
63488eea45cSKlaus Jensen }
63588eea45cSKlaus Jensen 
nvme_inc_sq_head(NvmeSQueue * sq)63688eea45cSKlaus Jensen static void nvme_inc_sq_head(NvmeSQueue *sq)
63788eea45cSKlaus Jensen {
63888eea45cSKlaus Jensen     sq->head = (sq->head + 1) % sq->size;
63988eea45cSKlaus Jensen }
64088eea45cSKlaus Jensen 
nvme_cq_full(NvmeCQueue * cq)64188eea45cSKlaus Jensen static uint8_t nvme_cq_full(NvmeCQueue *cq)
64288eea45cSKlaus Jensen {
64388eea45cSKlaus Jensen     return (cq->tail + 1) % cq->size == cq->head;
64488eea45cSKlaus Jensen }
64588eea45cSKlaus Jensen 
nvme_sq_empty(NvmeSQueue * sq)64688eea45cSKlaus Jensen static uint8_t nvme_sq_empty(NvmeSQueue *sq)
64788eea45cSKlaus Jensen {
64888eea45cSKlaus Jensen     return sq->head == sq->tail;
64988eea45cSKlaus Jensen }
65088eea45cSKlaus Jensen 
nvme_irq_check(NvmeCtrl * n)65188eea45cSKlaus Jensen static void nvme_irq_check(NvmeCtrl *n)
65288eea45cSKlaus Jensen {
65348b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
65449e03457SKlaus Jensen     uint32_t intms = ldl_le_p(&n->bar.intms);
65549e03457SKlaus Jensen 
65648b32c28SKlaus Jensen     if (msix_enabled(pci)) {
65788eea45cSKlaus Jensen         return;
65888eea45cSKlaus Jensen     }
659e8598778SKlaus Jensen 
660e8598778SKlaus Jensen     /* vfs does not implement intx */
661e8598778SKlaus Jensen     if (pci_is_vf(pci)) {
662e8598778SKlaus Jensen         return;
663e8598778SKlaus Jensen     }
664e8598778SKlaus Jensen 
66549e03457SKlaus Jensen     if (~intms & n->irq_status) {
66648b32c28SKlaus Jensen         pci_irq_assert(pci);
66788eea45cSKlaus Jensen     } else {
66848b32c28SKlaus Jensen         pci_irq_deassert(pci);
66988eea45cSKlaus Jensen     }
67088eea45cSKlaus Jensen }
67188eea45cSKlaus Jensen 
nvme_irq_assert(NvmeCtrl * n,NvmeCQueue * cq)67288eea45cSKlaus Jensen static void nvme_irq_assert(NvmeCtrl *n, NvmeCQueue *cq)
67388eea45cSKlaus Jensen {
67448b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
67548b32c28SKlaus Jensen 
67688eea45cSKlaus Jensen     if (cq->irq_enabled) {
67748b32c28SKlaus Jensen         if (msix_enabled(pci)) {
67888eea45cSKlaus Jensen             trace_pci_nvme_irq_msix(cq->vector);
67948b32c28SKlaus Jensen             msix_notify(pci, cq->vector);
68088eea45cSKlaus Jensen         } else {
68188eea45cSKlaus Jensen             trace_pci_nvme_irq_pin();
68288eea45cSKlaus Jensen             assert(cq->vector < 32);
68388eea45cSKlaus Jensen             n->irq_status |= 1 << cq->vector;
68488eea45cSKlaus Jensen             nvme_irq_check(n);
68588eea45cSKlaus Jensen         }
68688eea45cSKlaus Jensen     } else {
68788eea45cSKlaus Jensen         trace_pci_nvme_irq_masked();
68888eea45cSKlaus Jensen     }
68988eea45cSKlaus Jensen }
69088eea45cSKlaus Jensen 
nvme_irq_deassert(NvmeCtrl * n,NvmeCQueue * cq)69188eea45cSKlaus Jensen static void nvme_irq_deassert(NvmeCtrl *n, NvmeCQueue *cq)
69288eea45cSKlaus Jensen {
69388eea45cSKlaus Jensen     if (cq->irq_enabled) {
69448b32c28SKlaus Jensen         if (msix_enabled(PCI_DEVICE(n))) {
69588eea45cSKlaus Jensen             return;
69688eea45cSKlaus Jensen         } else {
69788eea45cSKlaus Jensen             assert(cq->vector < 32);
69883d7ed5cSKlaus Jensen             if (!n->cq_pending) {
69988eea45cSKlaus Jensen                 n->irq_status &= ~(1 << cq->vector);
70083d7ed5cSKlaus Jensen             }
70188eea45cSKlaus Jensen             nvme_irq_check(n);
70288eea45cSKlaus Jensen         }
70388eea45cSKlaus Jensen     }
70488eea45cSKlaus Jensen }
70588eea45cSKlaus Jensen 
nvme_req_clear(NvmeRequest * req)70688eea45cSKlaus Jensen static void nvme_req_clear(NvmeRequest *req)
70788eea45cSKlaus Jensen {
70888eea45cSKlaus Jensen     req->ns = NULL;
70988eea45cSKlaus Jensen     req->opaque = NULL;
71088eea45cSKlaus Jensen     req->aiocb = NULL;
71188eea45cSKlaus Jensen     memset(&req->cqe, 0x0, sizeof(req->cqe));
71288eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
71388eea45cSKlaus Jensen }
71488eea45cSKlaus Jensen 
nvme_sg_init(NvmeCtrl * n,NvmeSg * sg,bool dma)71588eea45cSKlaus Jensen static inline void nvme_sg_init(NvmeCtrl *n, NvmeSg *sg, bool dma)
71688eea45cSKlaus Jensen {
71788eea45cSKlaus Jensen     if (dma) {
71848b32c28SKlaus Jensen         pci_dma_sglist_init(&sg->qsg, PCI_DEVICE(n), 0);
71988eea45cSKlaus Jensen         sg->flags = NVME_SG_DMA;
72088eea45cSKlaus Jensen     } else {
72188eea45cSKlaus Jensen         qemu_iovec_init(&sg->iov, 0);
72288eea45cSKlaus Jensen     }
72388eea45cSKlaus Jensen 
72488eea45cSKlaus Jensen     sg->flags |= NVME_SG_ALLOC;
72588eea45cSKlaus Jensen }
72688eea45cSKlaus Jensen 
nvme_sg_unmap(NvmeSg * sg)72788eea45cSKlaus Jensen static inline void nvme_sg_unmap(NvmeSg *sg)
72888eea45cSKlaus Jensen {
72988eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_ALLOC)) {
73088eea45cSKlaus Jensen         return;
73188eea45cSKlaus Jensen     }
73288eea45cSKlaus Jensen 
73388eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
73488eea45cSKlaus Jensen         qemu_sglist_destroy(&sg->qsg);
73588eea45cSKlaus Jensen     } else {
73688eea45cSKlaus Jensen         qemu_iovec_destroy(&sg->iov);
73788eea45cSKlaus Jensen     }
73888eea45cSKlaus Jensen 
73988eea45cSKlaus Jensen     memset(sg, 0x0, sizeof(*sg));
74088eea45cSKlaus Jensen }
74188eea45cSKlaus Jensen 
74288eea45cSKlaus Jensen /*
7439b4b4e51SMichael Tokarev  * When metadata is transferred as extended LBAs, the DPTR mapped into `sg`
74488eea45cSKlaus Jensen  * holds both data and metadata. This function splits the data and metadata
74588eea45cSKlaus Jensen  * into two separate QSG/IOVs.
74688eea45cSKlaus Jensen  */
nvme_sg_split(NvmeSg * sg,NvmeNamespace * ns,NvmeSg * data,NvmeSg * mdata)74788eea45cSKlaus Jensen static void nvme_sg_split(NvmeSg *sg, NvmeNamespace *ns, NvmeSg *data,
74888eea45cSKlaus Jensen                           NvmeSg *mdata)
74988eea45cSKlaus Jensen {
75088eea45cSKlaus Jensen     NvmeSg *dst = data;
75188eea45cSKlaus Jensen     uint32_t trans_len, count = ns->lbasz;
75288eea45cSKlaus Jensen     uint64_t offset = 0;
75388eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
75488eea45cSKlaus Jensen     size_t sge_len;
75588eea45cSKlaus Jensen     size_t sg_len = dma ? sg->qsg.size : sg->iov.size;
75688eea45cSKlaus Jensen     int sg_idx = 0;
75788eea45cSKlaus Jensen 
75888eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
75988eea45cSKlaus Jensen 
76088eea45cSKlaus Jensen     while (sg_len) {
76188eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
76288eea45cSKlaus Jensen 
76388eea45cSKlaus Jensen         trans_len = MIN(sg_len, count);
76488eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
76588eea45cSKlaus Jensen 
76688eea45cSKlaus Jensen         if (dst) {
76788eea45cSKlaus Jensen             if (dma) {
76888eea45cSKlaus Jensen                 qemu_sglist_add(&dst->qsg, sg->qsg.sg[sg_idx].base + offset,
76988eea45cSKlaus Jensen                                 trans_len);
77088eea45cSKlaus Jensen             } else {
77188eea45cSKlaus Jensen                 qemu_iovec_add(&dst->iov,
77288eea45cSKlaus Jensen                                sg->iov.iov[sg_idx].iov_base + offset,
77388eea45cSKlaus Jensen                                trans_len);
77488eea45cSKlaus Jensen             }
77588eea45cSKlaus Jensen         }
77688eea45cSKlaus Jensen 
77788eea45cSKlaus Jensen         sg_len -= trans_len;
77888eea45cSKlaus Jensen         count -= trans_len;
77988eea45cSKlaus Jensen         offset += trans_len;
78088eea45cSKlaus Jensen 
78188eea45cSKlaus Jensen         if (count == 0) {
78288eea45cSKlaus Jensen             dst = (dst == data) ? mdata : data;
78388eea45cSKlaus Jensen             count = (dst == data) ? ns->lbasz : ns->lbaf.ms;
78488eea45cSKlaus Jensen         }
78588eea45cSKlaus Jensen 
78688eea45cSKlaus Jensen         if (sge_len == offset) {
78788eea45cSKlaus Jensen             offset = 0;
78888eea45cSKlaus Jensen             sg_idx++;
78988eea45cSKlaus Jensen         }
79088eea45cSKlaus Jensen     }
79188eea45cSKlaus Jensen }
79288eea45cSKlaus Jensen 
nvme_map_addr_cmb(NvmeCtrl * n,QEMUIOVector * iov,hwaddr addr,size_t len)79388eea45cSKlaus Jensen static uint16_t nvme_map_addr_cmb(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
79488eea45cSKlaus Jensen                                   size_t len)
79588eea45cSKlaus Jensen {
79688eea45cSKlaus Jensen     if (!len) {
79788eea45cSKlaus Jensen         return NVME_SUCCESS;
79888eea45cSKlaus Jensen     }
79988eea45cSKlaus Jensen 
80088eea45cSKlaus Jensen     trace_pci_nvme_map_addr_cmb(addr, len);
80188eea45cSKlaus Jensen 
80288eea45cSKlaus Jensen     if (!nvme_addr_is_cmb(n, addr) || !nvme_addr_is_cmb(n, addr + len - 1)) {
80388eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
80488eea45cSKlaus Jensen     }
80588eea45cSKlaus Jensen 
80688eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_cmb(n, addr), len);
80788eea45cSKlaus Jensen 
80888eea45cSKlaus Jensen     return NVME_SUCCESS;
80988eea45cSKlaus Jensen }
81088eea45cSKlaus Jensen 
nvme_map_addr_pmr(NvmeCtrl * n,QEMUIOVector * iov,hwaddr addr,size_t len)81188eea45cSKlaus Jensen static uint16_t nvme_map_addr_pmr(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
81288eea45cSKlaus Jensen                                   size_t len)
81388eea45cSKlaus Jensen {
81488eea45cSKlaus Jensen     if (!len) {
81588eea45cSKlaus Jensen         return NVME_SUCCESS;
81688eea45cSKlaus Jensen     }
81788eea45cSKlaus Jensen 
81888eea45cSKlaus Jensen     if (!nvme_addr_is_pmr(n, addr) || !nvme_addr_is_pmr(n, addr + len - 1)) {
81988eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
82088eea45cSKlaus Jensen     }
82188eea45cSKlaus Jensen 
82288eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_pmr(n, addr), len);
82388eea45cSKlaus Jensen 
82488eea45cSKlaus Jensen     return NVME_SUCCESS;
82588eea45cSKlaus Jensen }
82688eea45cSKlaus Jensen 
nvme_map_addr(NvmeCtrl * n,NvmeSg * sg,hwaddr addr,size_t len)82788eea45cSKlaus Jensen static uint16_t nvme_map_addr(NvmeCtrl *n, NvmeSg *sg, hwaddr addr, size_t len)
82888eea45cSKlaus Jensen {
82988eea45cSKlaus Jensen     bool cmb = false, pmr = false;
83088eea45cSKlaus Jensen 
83188eea45cSKlaus Jensen     if (!len) {
83288eea45cSKlaus Jensen         return NVME_SUCCESS;
83388eea45cSKlaus Jensen     }
83488eea45cSKlaus Jensen 
83588eea45cSKlaus Jensen     trace_pci_nvme_map_addr(addr, len);
83688eea45cSKlaus Jensen 
837736b0164SKlaus Jensen     if (nvme_addr_is_iomem(n, addr)) {
838736b0164SKlaus Jensen         return NVME_DATA_TRAS_ERROR;
839736b0164SKlaus Jensen     }
840736b0164SKlaus Jensen 
84188eea45cSKlaus Jensen     if (nvme_addr_is_cmb(n, addr)) {
84288eea45cSKlaus Jensen         cmb = true;
84388eea45cSKlaus Jensen     } else if (nvme_addr_is_pmr(n, addr)) {
84488eea45cSKlaus Jensen         pmr = true;
84588eea45cSKlaus Jensen     }
84688eea45cSKlaus Jensen 
84788eea45cSKlaus Jensen     if (cmb || pmr) {
84888eea45cSKlaus Jensen         if (sg->flags & NVME_SG_DMA) {
84988eea45cSKlaus Jensen             return NVME_INVALID_USE_OF_CMB | NVME_DNR;
85088eea45cSKlaus Jensen         }
85188eea45cSKlaus Jensen 
85223421473SPadmakar Kalghatgi         if (sg->iov.niov + 1 > IOV_MAX) {
85323421473SPadmakar Kalghatgi             goto max_mappings_exceeded;
85423421473SPadmakar Kalghatgi         }
85523421473SPadmakar Kalghatgi 
85688eea45cSKlaus Jensen         if (cmb) {
85788eea45cSKlaus Jensen             return nvme_map_addr_cmb(n, &sg->iov, addr, len);
85888eea45cSKlaus Jensen         } else {
85988eea45cSKlaus Jensen             return nvme_map_addr_pmr(n, &sg->iov, addr, len);
86088eea45cSKlaus Jensen         }
86188eea45cSKlaus Jensen     }
86288eea45cSKlaus Jensen 
86388eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_DMA)) {
86488eea45cSKlaus Jensen         return NVME_INVALID_USE_OF_CMB | NVME_DNR;
86588eea45cSKlaus Jensen     }
86688eea45cSKlaus Jensen 
86723421473SPadmakar Kalghatgi     if (sg->qsg.nsg + 1 > IOV_MAX) {
86823421473SPadmakar Kalghatgi         goto max_mappings_exceeded;
86923421473SPadmakar Kalghatgi     }
87023421473SPadmakar Kalghatgi 
87188eea45cSKlaus Jensen     qemu_sglist_add(&sg->qsg, addr, len);
87288eea45cSKlaus Jensen 
87388eea45cSKlaus Jensen     return NVME_SUCCESS;
87423421473SPadmakar Kalghatgi 
87523421473SPadmakar Kalghatgi max_mappings_exceeded:
87623421473SPadmakar Kalghatgi     NVME_GUEST_ERR(pci_nvme_ub_too_many_mappings,
87723421473SPadmakar Kalghatgi                    "number of mappings exceed 1024");
87823421473SPadmakar Kalghatgi     return NVME_INTERNAL_DEV_ERROR | NVME_DNR;
87988eea45cSKlaus Jensen }
88088eea45cSKlaus Jensen 
nvme_addr_is_dma(NvmeCtrl * n,hwaddr addr)88188eea45cSKlaus Jensen static inline bool nvme_addr_is_dma(NvmeCtrl *n, hwaddr addr)
88288eea45cSKlaus Jensen {
88388eea45cSKlaus Jensen     return !(nvme_addr_is_cmb(n, addr) || nvme_addr_is_pmr(n, addr));
88488eea45cSKlaus Jensen }
88588eea45cSKlaus Jensen 
nvme_map_prp(NvmeCtrl * n,NvmeSg * sg,uint64_t prp1,uint64_t prp2,uint32_t len)88688eea45cSKlaus Jensen static uint16_t nvme_map_prp(NvmeCtrl *n, NvmeSg *sg, uint64_t prp1,
88788eea45cSKlaus Jensen                              uint64_t prp2, uint32_t len)
88888eea45cSKlaus Jensen {
88988eea45cSKlaus Jensen     hwaddr trans_len = n->page_size - (prp1 % n->page_size);
89088eea45cSKlaus Jensen     trans_len = MIN(len, trans_len);
89188eea45cSKlaus Jensen     int num_prps = (len >> n->page_bits) + 1;
89288eea45cSKlaus Jensen     uint16_t status;
89388eea45cSKlaus Jensen     int ret;
89488eea45cSKlaus Jensen 
89588eea45cSKlaus Jensen     trace_pci_nvme_map_prp(trans_len, len, prp1, prp2, num_prps);
89688eea45cSKlaus Jensen 
89788eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, prp1));
89888eea45cSKlaus Jensen 
89988eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, prp1, trans_len);
90088eea45cSKlaus Jensen     if (status) {
90188eea45cSKlaus Jensen         goto unmap;
90288eea45cSKlaus Jensen     }
90388eea45cSKlaus Jensen 
90488eea45cSKlaus Jensen     len -= trans_len;
90588eea45cSKlaus Jensen     if (len) {
90688eea45cSKlaus Jensen         if (len > n->page_size) {
907b3c82467SPeter Maydell             g_autofree uint64_t *prp_list = g_new(uint64_t, n->max_prp_ents);
90888eea45cSKlaus Jensen             uint32_t nents, prp_trans;
90988eea45cSKlaus Jensen             int i = 0;
91088eea45cSKlaus Jensen 
91188eea45cSKlaus Jensen             /*
91288eea45cSKlaus Jensen              * The first PRP list entry, pointed to by PRP2 may contain offset.
91388eea45cSKlaus Jensen              * Hence, we need to calculate the number of entries in based on
91488eea45cSKlaus Jensen              * that offset.
91588eea45cSKlaus Jensen              */
91688eea45cSKlaus Jensen             nents = (n->page_size - (prp2 & (n->page_size - 1))) >> 3;
91788eea45cSKlaus Jensen             prp_trans = MIN(n->max_prp_ents, nents) * sizeof(uint64_t);
91888eea45cSKlaus Jensen             ret = nvme_addr_read(n, prp2, (void *)prp_list, prp_trans);
91988eea45cSKlaus Jensen             if (ret) {
92088eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(prp2);
92188eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
92288eea45cSKlaus Jensen                 goto unmap;
92388eea45cSKlaus Jensen             }
92488eea45cSKlaus Jensen             while (len != 0) {
92588eea45cSKlaus Jensen                 uint64_t prp_ent = le64_to_cpu(prp_list[i]);
92688eea45cSKlaus Jensen 
92788eea45cSKlaus Jensen                 if (i == nents - 1 && len > n->page_size) {
92888eea45cSKlaus Jensen                     if (unlikely(prp_ent & (n->page_size - 1))) {
92988eea45cSKlaus Jensen                         trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
93088eea45cSKlaus Jensen                         status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
93188eea45cSKlaus Jensen                         goto unmap;
93288eea45cSKlaus Jensen                     }
93388eea45cSKlaus Jensen 
93488eea45cSKlaus Jensen                     i = 0;
93588eea45cSKlaus Jensen                     nents = (len + n->page_size - 1) >> n->page_bits;
93688eea45cSKlaus Jensen                     nents = MIN(nents, n->max_prp_ents);
93788eea45cSKlaus Jensen                     prp_trans = nents * sizeof(uint64_t);
93888eea45cSKlaus Jensen                     ret = nvme_addr_read(n, prp_ent, (void *)prp_list,
93988eea45cSKlaus Jensen                                          prp_trans);
94088eea45cSKlaus Jensen                     if (ret) {
94188eea45cSKlaus Jensen                         trace_pci_nvme_err_addr_read(prp_ent);
94288eea45cSKlaus Jensen                         status = NVME_DATA_TRAS_ERROR;
94388eea45cSKlaus Jensen                         goto unmap;
94488eea45cSKlaus Jensen                     }
94588eea45cSKlaus Jensen                     prp_ent = le64_to_cpu(prp_list[i]);
94688eea45cSKlaus Jensen                 }
94788eea45cSKlaus Jensen 
94888eea45cSKlaus Jensen                 if (unlikely(prp_ent & (n->page_size - 1))) {
94988eea45cSKlaus Jensen                     trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
95088eea45cSKlaus Jensen                     status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
95188eea45cSKlaus Jensen                     goto unmap;
95288eea45cSKlaus Jensen                 }
95388eea45cSKlaus Jensen 
95488eea45cSKlaus Jensen                 trans_len = MIN(len, n->page_size);
95588eea45cSKlaus Jensen                 status = nvme_map_addr(n, sg, prp_ent, trans_len);
95688eea45cSKlaus Jensen                 if (status) {
95788eea45cSKlaus Jensen                     goto unmap;
95888eea45cSKlaus Jensen                 }
95988eea45cSKlaus Jensen 
96088eea45cSKlaus Jensen                 len -= trans_len;
96188eea45cSKlaus Jensen                 i++;
96288eea45cSKlaus Jensen             }
96388eea45cSKlaus Jensen         } else {
96488eea45cSKlaus Jensen             if (unlikely(prp2 & (n->page_size - 1))) {
96588eea45cSKlaus Jensen                 trace_pci_nvme_err_invalid_prp2_align(prp2);
96688eea45cSKlaus Jensen                 status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
96788eea45cSKlaus Jensen                 goto unmap;
96888eea45cSKlaus Jensen             }
96988eea45cSKlaus Jensen             status = nvme_map_addr(n, sg, prp2, len);
97088eea45cSKlaus Jensen             if (status) {
97188eea45cSKlaus Jensen                 goto unmap;
97288eea45cSKlaus Jensen             }
97388eea45cSKlaus Jensen         }
97488eea45cSKlaus Jensen     }
97588eea45cSKlaus Jensen 
97688eea45cSKlaus Jensen     return NVME_SUCCESS;
97788eea45cSKlaus Jensen 
97888eea45cSKlaus Jensen unmap:
97988eea45cSKlaus Jensen     nvme_sg_unmap(sg);
98088eea45cSKlaus Jensen     return status;
98188eea45cSKlaus Jensen }
98288eea45cSKlaus Jensen 
98388eea45cSKlaus Jensen /*
98488eea45cSKlaus Jensen  * Map 'nsgld' data descriptors from 'segment'. The function will subtract the
98588eea45cSKlaus Jensen  * number of bytes mapped in len.
98688eea45cSKlaus Jensen  */
nvme_map_sgl_data(NvmeCtrl * n,NvmeSg * sg,NvmeSglDescriptor * segment,uint64_t nsgld,size_t * len,NvmeCmd * cmd)98788eea45cSKlaus Jensen static uint16_t nvme_map_sgl_data(NvmeCtrl *n, NvmeSg *sg,
98888eea45cSKlaus Jensen                                   NvmeSglDescriptor *segment, uint64_t nsgld,
98988eea45cSKlaus Jensen                                   size_t *len, NvmeCmd *cmd)
99088eea45cSKlaus Jensen {
99188eea45cSKlaus Jensen     dma_addr_t addr, trans_len;
99288eea45cSKlaus Jensen     uint32_t dlen;
99388eea45cSKlaus Jensen     uint16_t status;
99488eea45cSKlaus Jensen 
99588eea45cSKlaus Jensen     for (int i = 0; i < nsgld; i++) {
99688eea45cSKlaus Jensen         uint8_t type = NVME_SGL_TYPE(segment[i].type);
99788eea45cSKlaus Jensen 
99888eea45cSKlaus Jensen         switch (type) {
99988eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_DATA_BLOCK:
100088eea45cSKlaus Jensen             break;
100188eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
100288eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
100388eea45cSKlaus Jensen             return NVME_INVALID_NUM_SGL_DESCRS | NVME_DNR;
100488eea45cSKlaus Jensen         default:
100588eea45cSKlaus Jensen             return NVME_SGL_DESCR_TYPE_INVALID | NVME_DNR;
100688eea45cSKlaus Jensen         }
100788eea45cSKlaus Jensen 
100888eea45cSKlaus Jensen         dlen = le32_to_cpu(segment[i].len);
100988eea45cSKlaus Jensen 
101088eea45cSKlaus Jensen         if (!dlen) {
101188eea45cSKlaus Jensen             continue;
101288eea45cSKlaus Jensen         }
101388eea45cSKlaus Jensen 
101488eea45cSKlaus Jensen         if (*len == 0) {
101588eea45cSKlaus Jensen             /*
101688eea45cSKlaus Jensen              * All data has been mapped, but the SGL contains additional
101788eea45cSKlaus Jensen              * segments and/or descriptors. The controller might accept
101888eea45cSKlaus Jensen              * ignoring the rest of the SGL.
101988eea45cSKlaus Jensen              */
102088eea45cSKlaus Jensen             uint32_t sgls = le32_to_cpu(n->id_ctrl.sgls);
102188eea45cSKlaus Jensen             if (sgls & NVME_CTRL_SGLS_EXCESS_LENGTH) {
102288eea45cSKlaus Jensen                 break;
102388eea45cSKlaus Jensen             }
102488eea45cSKlaus Jensen 
102588eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_sgl_excess_length(dlen);
102688eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
102788eea45cSKlaus Jensen         }
102888eea45cSKlaus Jensen 
102988eea45cSKlaus Jensen         trans_len = MIN(*len, dlen);
103088eea45cSKlaus Jensen 
103188eea45cSKlaus Jensen         addr = le64_to_cpu(segment[i].addr);
103288eea45cSKlaus Jensen 
103388eea45cSKlaus Jensen         if (UINT64_MAX - addr < dlen) {
103488eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
103588eea45cSKlaus Jensen         }
103688eea45cSKlaus Jensen 
103788eea45cSKlaus Jensen         status = nvme_map_addr(n, sg, addr, trans_len);
103888eea45cSKlaus Jensen         if (status) {
103988eea45cSKlaus Jensen             return status;
104088eea45cSKlaus Jensen         }
104188eea45cSKlaus Jensen 
104288eea45cSKlaus Jensen         *len -= trans_len;
104388eea45cSKlaus Jensen     }
104488eea45cSKlaus Jensen 
104588eea45cSKlaus Jensen     return NVME_SUCCESS;
104688eea45cSKlaus Jensen }
104788eea45cSKlaus Jensen 
nvme_map_sgl(NvmeCtrl * n,NvmeSg * sg,NvmeSglDescriptor sgl,size_t len,NvmeCmd * cmd)104888eea45cSKlaus Jensen static uint16_t nvme_map_sgl(NvmeCtrl *n, NvmeSg *sg, NvmeSglDescriptor sgl,
104988eea45cSKlaus Jensen                              size_t len, NvmeCmd *cmd)
105088eea45cSKlaus Jensen {
105188eea45cSKlaus Jensen     /*
105288eea45cSKlaus Jensen      * Read the segment in chunks of 256 descriptors (one 4k page) to avoid
105388eea45cSKlaus Jensen      * dynamically allocating a potentially huge SGL. The spec allows the SGL
105488eea45cSKlaus Jensen      * to be larger (as in number of bytes required to describe the SGL
105588eea45cSKlaus Jensen      * descriptors and segment chain) than the command transfer size, so it is
105688eea45cSKlaus Jensen      * not bounded by MDTS.
105788eea45cSKlaus Jensen      */
1058b02c2a85SPhilippe Mathieu-Daudé #define SEG_CHUNK_SIZE 256
105988eea45cSKlaus Jensen 
106088eea45cSKlaus Jensen     NvmeSglDescriptor segment[SEG_CHUNK_SIZE], *sgld, *last_sgld;
106188eea45cSKlaus Jensen     uint64_t nsgld;
106288eea45cSKlaus Jensen     uint32_t seg_len;
106388eea45cSKlaus Jensen     uint16_t status;
106488eea45cSKlaus Jensen     hwaddr addr;
106588eea45cSKlaus Jensen     int ret;
106688eea45cSKlaus Jensen 
106788eea45cSKlaus Jensen     sgld = &sgl;
106888eea45cSKlaus Jensen     addr = le64_to_cpu(sgl.addr);
106988eea45cSKlaus Jensen 
107088eea45cSKlaus Jensen     trace_pci_nvme_map_sgl(NVME_SGL_TYPE(sgl.type), len);
107188eea45cSKlaus Jensen 
107288eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, addr));
107388eea45cSKlaus Jensen 
107488eea45cSKlaus Jensen     /*
107588eea45cSKlaus Jensen      * If the entire transfer can be described with a single data block it can
107688eea45cSKlaus Jensen      * be mapped directly.
107788eea45cSKlaus Jensen      */
107888eea45cSKlaus Jensen     if (NVME_SGL_TYPE(sgl.type) == NVME_SGL_DESCR_TYPE_DATA_BLOCK) {
107988eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, sgld, 1, &len, cmd);
108088eea45cSKlaus Jensen         if (status) {
108188eea45cSKlaus Jensen             goto unmap;
108288eea45cSKlaus Jensen         }
108388eea45cSKlaus Jensen 
108488eea45cSKlaus Jensen         goto out;
108588eea45cSKlaus Jensen     }
108688eea45cSKlaus Jensen 
108788eea45cSKlaus Jensen     for (;;) {
108888eea45cSKlaus Jensen         switch (NVME_SGL_TYPE(sgld->type)) {
108988eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
109088eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
109188eea45cSKlaus Jensen             break;
109288eea45cSKlaus Jensen         default:
109388eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
109488eea45cSKlaus Jensen         }
109588eea45cSKlaus Jensen 
109688eea45cSKlaus Jensen         seg_len = le32_to_cpu(sgld->len);
109788eea45cSKlaus Jensen 
109888eea45cSKlaus Jensen         /* check the length of the (Last) Segment descriptor */
1099b9147a3aSKlaus Jensen         if (!seg_len || seg_len & 0xf) {
110088eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
110188eea45cSKlaus Jensen         }
110288eea45cSKlaus Jensen 
110388eea45cSKlaus Jensen         if (UINT64_MAX - addr < seg_len) {
110488eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
110588eea45cSKlaus Jensen         }
110688eea45cSKlaus Jensen 
110788eea45cSKlaus Jensen         nsgld = seg_len / sizeof(NvmeSglDescriptor);
110888eea45cSKlaus Jensen 
110988eea45cSKlaus Jensen         while (nsgld > SEG_CHUNK_SIZE) {
111088eea45cSKlaus Jensen             if (nvme_addr_read(n, addr, segment, sizeof(segment))) {
111188eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(addr);
111288eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
111388eea45cSKlaus Jensen                 goto unmap;
111488eea45cSKlaus Jensen             }
111588eea45cSKlaus Jensen 
111688eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, SEG_CHUNK_SIZE,
111788eea45cSKlaus Jensen                                        &len, cmd);
111888eea45cSKlaus Jensen             if (status) {
111988eea45cSKlaus Jensen                 goto unmap;
112088eea45cSKlaus Jensen             }
112188eea45cSKlaus Jensen 
112288eea45cSKlaus Jensen             nsgld -= SEG_CHUNK_SIZE;
112388eea45cSKlaus Jensen             addr += SEG_CHUNK_SIZE * sizeof(NvmeSglDescriptor);
112488eea45cSKlaus Jensen         }
112588eea45cSKlaus Jensen 
112688eea45cSKlaus Jensen         ret = nvme_addr_read(n, addr, segment, nsgld *
112788eea45cSKlaus Jensen                              sizeof(NvmeSglDescriptor));
112888eea45cSKlaus Jensen         if (ret) {
112988eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
113088eea45cSKlaus Jensen             status = NVME_DATA_TRAS_ERROR;
113188eea45cSKlaus Jensen             goto unmap;
113288eea45cSKlaus Jensen         }
113388eea45cSKlaus Jensen 
113488eea45cSKlaus Jensen         last_sgld = &segment[nsgld - 1];
113588eea45cSKlaus Jensen 
113688eea45cSKlaus Jensen         /*
1137b9147a3aSKlaus Jensen          * If the segment ends with a Data Block, then we are done.
113888eea45cSKlaus Jensen          */
1139b9147a3aSKlaus Jensen         if (NVME_SGL_TYPE(last_sgld->type) == NVME_SGL_DESCR_TYPE_DATA_BLOCK) {
114088eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, nsgld, &len, cmd);
114188eea45cSKlaus Jensen             if (status) {
114288eea45cSKlaus Jensen                 goto unmap;
114388eea45cSKlaus Jensen             }
114488eea45cSKlaus Jensen 
114588eea45cSKlaus Jensen             goto out;
114688eea45cSKlaus Jensen         }
114788eea45cSKlaus Jensen 
114888eea45cSKlaus Jensen         /*
1149b9147a3aSKlaus Jensen          * If the last descriptor was not a Data Block, then the current
1150b9147a3aSKlaus Jensen          * segment must not be a Last Segment.
115188eea45cSKlaus Jensen          */
115288eea45cSKlaus Jensen         if (NVME_SGL_TYPE(sgld->type) == NVME_SGL_DESCR_TYPE_LAST_SEGMENT) {
115388eea45cSKlaus Jensen             status = NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
115488eea45cSKlaus Jensen             goto unmap;
115588eea45cSKlaus Jensen         }
115688eea45cSKlaus Jensen 
115788eea45cSKlaus Jensen         sgld = last_sgld;
115888eea45cSKlaus Jensen         addr = le64_to_cpu(sgld->addr);
115988eea45cSKlaus Jensen 
116088eea45cSKlaus Jensen         /*
116188eea45cSKlaus Jensen          * Do not map the last descriptor; it will be a Segment or Last Segment
116288eea45cSKlaus Jensen          * descriptor and is handled by the next iteration.
116388eea45cSKlaus Jensen          */
116488eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, segment, nsgld - 1, &len, cmd);
116588eea45cSKlaus Jensen         if (status) {
116688eea45cSKlaus Jensen             goto unmap;
116788eea45cSKlaus Jensen         }
116888eea45cSKlaus Jensen     }
116988eea45cSKlaus Jensen 
117088eea45cSKlaus Jensen out:
117188eea45cSKlaus Jensen     /* if there is any residual left in len, the SGL was too short */
117288eea45cSKlaus Jensen     if (len) {
117388eea45cSKlaus Jensen         status = NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
117488eea45cSKlaus Jensen         goto unmap;
117588eea45cSKlaus Jensen     }
117688eea45cSKlaus Jensen 
117788eea45cSKlaus Jensen     return NVME_SUCCESS;
117888eea45cSKlaus Jensen 
117988eea45cSKlaus Jensen unmap:
118088eea45cSKlaus Jensen     nvme_sg_unmap(sg);
118188eea45cSKlaus Jensen     return status;
118288eea45cSKlaus Jensen }
118388eea45cSKlaus Jensen 
nvme_map_dptr(NvmeCtrl * n,NvmeSg * sg,size_t len,NvmeCmd * cmd)118488eea45cSKlaus Jensen uint16_t nvme_map_dptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
118588eea45cSKlaus Jensen                        NvmeCmd *cmd)
118688eea45cSKlaus Jensen {
118788eea45cSKlaus Jensen     uint64_t prp1, prp2;
118888eea45cSKlaus Jensen 
118988eea45cSKlaus Jensen     switch (NVME_CMD_FLAGS_PSDT(cmd->flags)) {
119088eea45cSKlaus Jensen     case NVME_PSDT_PRP:
119188eea45cSKlaus Jensen         prp1 = le64_to_cpu(cmd->dptr.prp1);
119288eea45cSKlaus Jensen         prp2 = le64_to_cpu(cmd->dptr.prp2);
119388eea45cSKlaus Jensen 
119488eea45cSKlaus Jensen         return nvme_map_prp(n, sg, prp1, prp2, len);
119588eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_CONTIGUOUS:
119688eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_SGL:
119788eea45cSKlaus Jensen         return nvme_map_sgl(n, sg, cmd->dptr.sgl, len, cmd);
119888eea45cSKlaus Jensen     default:
119988eea45cSKlaus Jensen         return NVME_INVALID_FIELD;
120088eea45cSKlaus Jensen     }
120188eea45cSKlaus Jensen }
120288eea45cSKlaus Jensen 
nvme_map_mptr(NvmeCtrl * n,NvmeSg * sg,size_t len,NvmeCmd * cmd)120388eea45cSKlaus Jensen static uint16_t nvme_map_mptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
120488eea45cSKlaus Jensen                               NvmeCmd *cmd)
120588eea45cSKlaus Jensen {
120688eea45cSKlaus Jensen     int psdt = NVME_CMD_FLAGS_PSDT(cmd->flags);
120788eea45cSKlaus Jensen     hwaddr mptr = le64_to_cpu(cmd->mptr);
120888eea45cSKlaus Jensen     uint16_t status;
120988eea45cSKlaus Jensen 
121088eea45cSKlaus Jensen     if (psdt == NVME_PSDT_SGL_MPTR_SGL) {
121188eea45cSKlaus Jensen         NvmeSglDescriptor sgl;
121288eea45cSKlaus Jensen 
121388eea45cSKlaus Jensen         if (nvme_addr_read(n, mptr, &sgl, sizeof(sgl))) {
121488eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
121588eea45cSKlaus Jensen         }
121688eea45cSKlaus Jensen 
121788eea45cSKlaus Jensen         status = nvme_map_sgl(n, sg, sgl, len, cmd);
121888eea45cSKlaus Jensen         if (status && (status & 0x7ff) == NVME_DATA_SGL_LEN_INVALID) {
121988eea45cSKlaus Jensen             status = NVME_MD_SGL_LEN_INVALID | NVME_DNR;
122088eea45cSKlaus Jensen         }
122188eea45cSKlaus Jensen 
122288eea45cSKlaus Jensen         return status;
122388eea45cSKlaus Jensen     }
122488eea45cSKlaus Jensen 
122588eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, mptr));
122688eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, mptr, len);
122788eea45cSKlaus Jensen     if (status) {
122888eea45cSKlaus Jensen         nvme_sg_unmap(sg);
122988eea45cSKlaus Jensen     }
123088eea45cSKlaus Jensen 
123188eea45cSKlaus Jensen     return status;
123288eea45cSKlaus Jensen }
123388eea45cSKlaus Jensen 
nvme_map_data(NvmeCtrl * n,uint32_t nlb,NvmeRequest * req)123488eea45cSKlaus Jensen static uint16_t nvme_map_data(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
123588eea45cSKlaus Jensen {
123688eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
123788eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
12382a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
12392a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
124088eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
124188eea45cSKlaus Jensen     uint16_t status;
124288eea45cSKlaus Jensen 
1243ac0b34c5SKlaus Jensen     if (nvme_ns_ext(ns) &&
1244ac0b34c5SKlaus Jensen         !(pi && pract && ns->lbaf.ms == nvme_pi_tuple_size(ns))) {
124588eea45cSKlaus Jensen         NvmeSg sg;
124688eea45cSKlaus Jensen 
124788eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
124888eea45cSKlaus Jensen 
124988eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
125088eea45cSKlaus Jensen         if (status) {
125188eea45cSKlaus Jensen             return status;
125288eea45cSKlaus Jensen         }
125388eea45cSKlaus Jensen 
125488eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
125588eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, &req->sg, NULL);
125688eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
125788eea45cSKlaus Jensen 
125888eea45cSKlaus Jensen         return NVME_SUCCESS;
125988eea45cSKlaus Jensen     }
126088eea45cSKlaus Jensen 
126188eea45cSKlaus Jensen     return nvme_map_dptr(n, &req->sg, len, &req->cmd);
126288eea45cSKlaus Jensen }
126388eea45cSKlaus Jensen 
nvme_map_mdata(NvmeCtrl * n,uint32_t nlb,NvmeRequest * req)126488eea45cSKlaus Jensen static uint16_t nvme_map_mdata(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
126588eea45cSKlaus Jensen {
126688eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
126788eea45cSKlaus Jensen     size_t len = nvme_m2b(ns, nlb);
126888eea45cSKlaus Jensen     uint16_t status;
126988eea45cSKlaus Jensen 
127088eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
127188eea45cSKlaus Jensen         NvmeSg sg;
127288eea45cSKlaus Jensen 
127388eea45cSKlaus Jensen         len += nvme_l2b(ns, nlb);
127488eea45cSKlaus Jensen 
127588eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
127688eea45cSKlaus Jensen         if (status) {
127788eea45cSKlaus Jensen             return status;
127888eea45cSKlaus Jensen         }
127988eea45cSKlaus Jensen 
128088eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
128188eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, NULL, &req->sg);
128288eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
128388eea45cSKlaus Jensen 
128488eea45cSKlaus Jensen         return NVME_SUCCESS;
128588eea45cSKlaus Jensen     }
128688eea45cSKlaus Jensen 
128788eea45cSKlaus Jensen     return nvme_map_mptr(n, &req->sg, len, &req->cmd);
128888eea45cSKlaus Jensen }
128988eea45cSKlaus Jensen 
nvme_tx_interleaved(NvmeCtrl * n,NvmeSg * sg,uint8_t * ptr,uint32_t len,uint32_t bytes,int32_t skip_bytes,int64_t offset,NvmeTxDirection dir)129088eea45cSKlaus Jensen static uint16_t nvme_tx_interleaved(NvmeCtrl *n, NvmeSg *sg, uint8_t *ptr,
129188eea45cSKlaus Jensen                                     uint32_t len, uint32_t bytes,
129288eea45cSKlaus Jensen                                     int32_t skip_bytes, int64_t offset,
129388eea45cSKlaus Jensen                                     NvmeTxDirection dir)
129488eea45cSKlaus Jensen {
129588eea45cSKlaus Jensen     hwaddr addr;
129688eea45cSKlaus Jensen     uint32_t trans_len, count = bytes;
129788eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
129888eea45cSKlaus Jensen     int64_t sge_len;
129988eea45cSKlaus Jensen     int sg_idx = 0;
130088eea45cSKlaus Jensen     int ret;
130188eea45cSKlaus Jensen 
130288eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
130388eea45cSKlaus Jensen 
130488eea45cSKlaus Jensen     while (len) {
130588eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
130688eea45cSKlaus Jensen 
130788eea45cSKlaus Jensen         if (sge_len - offset < 0) {
130888eea45cSKlaus Jensen             offset -= sge_len;
130988eea45cSKlaus Jensen             sg_idx++;
131088eea45cSKlaus Jensen             continue;
131188eea45cSKlaus Jensen         }
131288eea45cSKlaus Jensen 
131388eea45cSKlaus Jensen         if (sge_len == offset) {
131488eea45cSKlaus Jensen             offset = 0;
131588eea45cSKlaus Jensen             sg_idx++;
131688eea45cSKlaus Jensen             continue;
131788eea45cSKlaus Jensen         }
131888eea45cSKlaus Jensen 
131988eea45cSKlaus Jensen         trans_len = MIN(len, count);
132088eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
132188eea45cSKlaus Jensen 
132288eea45cSKlaus Jensen         if (dma) {
132388eea45cSKlaus Jensen             addr = sg->qsg.sg[sg_idx].base + offset;
132488eea45cSKlaus Jensen         } else {
132588eea45cSKlaus Jensen             addr = (hwaddr)(uintptr_t)sg->iov.iov[sg_idx].iov_base + offset;
132688eea45cSKlaus Jensen         }
132788eea45cSKlaus Jensen 
132888eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
132988eea45cSKlaus Jensen             ret = nvme_addr_read(n, addr, ptr, trans_len);
133088eea45cSKlaus Jensen         } else {
133188eea45cSKlaus Jensen             ret = nvme_addr_write(n, addr, ptr, trans_len);
133288eea45cSKlaus Jensen         }
133388eea45cSKlaus Jensen 
133488eea45cSKlaus Jensen         if (ret) {
133588eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
133688eea45cSKlaus Jensen         }
133788eea45cSKlaus Jensen 
133888eea45cSKlaus Jensen         ptr += trans_len;
133988eea45cSKlaus Jensen         len -= trans_len;
134088eea45cSKlaus Jensen         count -= trans_len;
134188eea45cSKlaus Jensen         offset += trans_len;
134288eea45cSKlaus Jensen 
134388eea45cSKlaus Jensen         if (count == 0) {
134488eea45cSKlaus Jensen             count = bytes;
134588eea45cSKlaus Jensen             offset += skip_bytes;
134688eea45cSKlaus Jensen         }
134788eea45cSKlaus Jensen     }
134888eea45cSKlaus Jensen 
134988eea45cSKlaus Jensen     return NVME_SUCCESS;
135088eea45cSKlaus Jensen }
135188eea45cSKlaus Jensen 
nvme_tx(NvmeCtrl * n,NvmeSg * sg,void * ptr,uint32_t len,NvmeTxDirection dir)13528d3a17beSPhilippe Mathieu-Daudé static uint16_t nvme_tx(NvmeCtrl *n, NvmeSg *sg, void *ptr, uint32_t len,
135388eea45cSKlaus Jensen                         NvmeTxDirection dir)
135488eea45cSKlaus Jensen {
135588eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
135688eea45cSKlaus Jensen 
135788eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
1358392e48afSPhilippe Mathieu-Daudé         const MemTxAttrs attrs = MEMTXATTRS_UNSPECIFIED;
1359bfa30f39SPhilippe Mathieu-Daudé         dma_addr_t residual;
136088eea45cSKlaus Jensen 
136188eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
1362f02b664aSPhilippe Mathieu-Daudé             dma_buf_write(ptr, len, &residual, &sg->qsg, attrs);
136388eea45cSKlaus Jensen         } else {
1364f02b664aSPhilippe Mathieu-Daudé             dma_buf_read(ptr, len, &residual, &sg->qsg, attrs);
136588eea45cSKlaus Jensen         }
136688eea45cSKlaus Jensen 
136788eea45cSKlaus Jensen         if (unlikely(residual)) {
136888eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
136988eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
137088eea45cSKlaus Jensen         }
137188eea45cSKlaus Jensen     } else {
137288eea45cSKlaus Jensen         size_t bytes;
137388eea45cSKlaus Jensen 
137488eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
137588eea45cSKlaus Jensen             bytes = qemu_iovec_to_buf(&sg->iov, 0, ptr, len);
137688eea45cSKlaus Jensen         } else {
137788eea45cSKlaus Jensen             bytes = qemu_iovec_from_buf(&sg->iov, 0, ptr, len);
137888eea45cSKlaus Jensen         }
137988eea45cSKlaus Jensen 
138088eea45cSKlaus Jensen         if (unlikely(bytes != len)) {
138188eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
138288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
138388eea45cSKlaus Jensen         }
138488eea45cSKlaus Jensen     }
138588eea45cSKlaus Jensen 
138688eea45cSKlaus Jensen     return NVME_SUCCESS;
138788eea45cSKlaus Jensen }
138888eea45cSKlaus Jensen 
nvme_c2h(NvmeCtrl * n,void * ptr,uint32_t len,NvmeRequest * req)13898d3a17beSPhilippe Mathieu-Daudé static inline uint16_t nvme_c2h(NvmeCtrl *n, void *ptr, uint32_t len,
139088eea45cSKlaus Jensen                                 NvmeRequest *req)
139188eea45cSKlaus Jensen {
139288eea45cSKlaus Jensen     uint16_t status;
139388eea45cSKlaus Jensen 
139488eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
139588eea45cSKlaus Jensen     if (status) {
139688eea45cSKlaus Jensen         return status;
139788eea45cSKlaus Jensen     }
139888eea45cSKlaus Jensen 
139988eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_FROM_DEVICE);
140088eea45cSKlaus Jensen }
140188eea45cSKlaus Jensen 
nvme_h2c(NvmeCtrl * n,void * ptr,uint32_t len,NvmeRequest * req)14028d3a17beSPhilippe Mathieu-Daudé static inline uint16_t nvme_h2c(NvmeCtrl *n, void *ptr, uint32_t len,
140388eea45cSKlaus Jensen                                 NvmeRequest *req)
140488eea45cSKlaus Jensen {
140588eea45cSKlaus Jensen     uint16_t status;
140688eea45cSKlaus Jensen 
140788eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
140888eea45cSKlaus Jensen     if (status) {
140988eea45cSKlaus Jensen         return status;
141088eea45cSKlaus Jensen     }
141188eea45cSKlaus Jensen 
141288eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_TO_DEVICE);
141388eea45cSKlaus Jensen }
141488eea45cSKlaus Jensen 
nvme_bounce_data(NvmeCtrl * n,void * ptr,uint32_t len,NvmeTxDirection dir,NvmeRequest * req)14158d3a17beSPhilippe Mathieu-Daudé uint16_t nvme_bounce_data(NvmeCtrl *n, void *ptr, uint32_t len,
141688eea45cSKlaus Jensen                           NvmeTxDirection dir, NvmeRequest *req)
141788eea45cSKlaus Jensen {
141888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
141988eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
14202a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
14212a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
142288eea45cSKlaus Jensen 
1423ac0b34c5SKlaus Jensen     if (nvme_ns_ext(ns) &&
1424ac0b34c5SKlaus Jensen         !(pi && pract && ns->lbaf.ms == nvme_pi_tuple_size(ns))) {
142588eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbasz,
142688eea45cSKlaus Jensen                                    ns->lbaf.ms, 0, dir);
142788eea45cSKlaus Jensen     }
142888eea45cSKlaus Jensen 
142988eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
143088eea45cSKlaus Jensen }
143188eea45cSKlaus Jensen 
nvme_bounce_mdata(NvmeCtrl * n,void * ptr,uint32_t len,NvmeTxDirection dir,NvmeRequest * req)14328d3a17beSPhilippe Mathieu-Daudé uint16_t nvme_bounce_mdata(NvmeCtrl *n, void *ptr, uint32_t len,
143388eea45cSKlaus Jensen                            NvmeTxDirection dir, NvmeRequest *req)
143488eea45cSKlaus Jensen {
143588eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
143688eea45cSKlaus Jensen     uint16_t status;
143788eea45cSKlaus Jensen 
143888eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
143988eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbaf.ms,
144088eea45cSKlaus Jensen                                    ns->lbasz, ns->lbasz, dir);
144188eea45cSKlaus Jensen     }
144288eea45cSKlaus Jensen 
144388eea45cSKlaus Jensen     nvme_sg_unmap(&req->sg);
144488eea45cSKlaus Jensen 
144588eea45cSKlaus Jensen     status = nvme_map_mptr(n, &req->sg, len, &req->cmd);
144688eea45cSKlaus Jensen     if (status) {
144788eea45cSKlaus Jensen         return status;
144888eea45cSKlaus Jensen     }
144988eea45cSKlaus Jensen 
145088eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
145188eea45cSKlaus Jensen }
145288eea45cSKlaus Jensen 
nvme_blk_read(BlockBackend * blk,int64_t offset,uint32_t align,BlockCompletionFunc * cb,NvmeRequest * req)145388eea45cSKlaus Jensen static inline void nvme_blk_read(BlockBackend *blk, int64_t offset,
14549b4f0181SMateusz Kozlowski                                  uint32_t align, BlockCompletionFunc *cb,
14559b4f0181SMateusz Kozlowski                                  NvmeRequest *req)
145688eea45cSKlaus Jensen {
145788eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
145888eea45cSKlaus Jensen 
145988eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
14609b4f0181SMateusz Kozlowski         req->aiocb = dma_blk_read(blk, &req->sg.qsg, offset, align, cb, req);
146188eea45cSKlaus Jensen     } else {
146288eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &req->sg.iov, 0, cb, req);
146388eea45cSKlaus Jensen     }
146488eea45cSKlaus Jensen }
146588eea45cSKlaus Jensen 
nvme_blk_write(BlockBackend * blk,int64_t offset,uint32_t align,BlockCompletionFunc * cb,NvmeRequest * req)146688eea45cSKlaus Jensen static inline void nvme_blk_write(BlockBackend *blk, int64_t offset,
14679b4f0181SMateusz Kozlowski                                   uint32_t align, BlockCompletionFunc *cb,
14689b4f0181SMateusz Kozlowski                                   NvmeRequest *req)
146988eea45cSKlaus Jensen {
147088eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
147188eea45cSKlaus Jensen 
147288eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
14739b4f0181SMateusz Kozlowski         req->aiocb = dma_blk_write(blk, &req->sg.qsg, offset, align, cb, req);
147488eea45cSKlaus Jensen     } else {
147588eea45cSKlaus Jensen         req->aiocb = blk_aio_pwritev(blk, offset, &req->sg.iov, 0, cb, req);
147688eea45cSKlaus Jensen     }
147788eea45cSKlaus Jensen }
147888eea45cSKlaus Jensen 
nvme_update_cq_eventidx(const NvmeCQueue * cq)1479fa5db2aaSKlaus Jensen static void nvme_update_cq_eventidx(const NvmeCQueue *cq)
1480fa5db2aaSKlaus Jensen {
1481fa5db2aaSKlaus Jensen     trace_pci_nvme_update_cq_eventidx(cq->cqid, cq->head);
1482fa5db2aaSKlaus Jensen 
1483c1e244b6SKlaus Jensen     stl_le_pci_dma(PCI_DEVICE(cq->ctrl), cq->ei_addr, cq->head,
1484c1e244b6SKlaus Jensen                    MEMTXATTRS_UNSPECIFIED);
1485fa5db2aaSKlaus Jensen }
1486fa5db2aaSKlaus Jensen 
nvme_update_cq_head(NvmeCQueue * cq)14873f7fe8deSJinhao Fan static void nvme_update_cq_head(NvmeCQueue *cq)
14883f7fe8deSJinhao Fan {
1489c1e244b6SKlaus Jensen     ldl_le_pci_dma(PCI_DEVICE(cq->ctrl), cq->db_addr, &cq->head,
1490c1e244b6SKlaus Jensen                    MEMTXATTRS_UNSPECIFIED);
149147cd3539SKlaus Jensen 
149247cd3539SKlaus Jensen     trace_pci_nvme_update_cq_head(cq->cqid, cq->head);
14933f7fe8deSJinhao Fan }
14943f7fe8deSJinhao Fan 
nvme_post_cqes(void * opaque)149588eea45cSKlaus Jensen static void nvme_post_cqes(void *opaque)
149688eea45cSKlaus Jensen {
149788eea45cSKlaus Jensen     NvmeCQueue *cq = opaque;
149888eea45cSKlaus Jensen     NvmeCtrl *n = cq->ctrl;
149988eea45cSKlaus Jensen     NvmeRequest *req, *next;
150083d7ed5cSKlaus Jensen     bool pending = cq->head != cq->tail;
150188eea45cSKlaus Jensen     int ret;
150288eea45cSKlaus Jensen 
150388eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(req, &cq->req_list, entry, next) {
150488eea45cSKlaus Jensen         NvmeSQueue *sq;
150588eea45cSKlaus Jensen         hwaddr addr;
150688eea45cSKlaus Jensen 
15073f7fe8deSJinhao Fan         if (n->dbbuf_enabled) {
1508fa5db2aaSKlaus Jensen             nvme_update_cq_eventidx(cq);
15093f7fe8deSJinhao Fan             nvme_update_cq_head(cq);
15103f7fe8deSJinhao Fan         }
15113f7fe8deSJinhao Fan 
151288eea45cSKlaus Jensen         if (nvme_cq_full(cq)) {
151388eea45cSKlaus Jensen             break;
151488eea45cSKlaus Jensen         }
151588eea45cSKlaus Jensen 
151688eea45cSKlaus Jensen         sq = req->sq;
151788eea45cSKlaus Jensen         req->cqe.status = cpu_to_le16((req->status << 1) | cq->phase);
151888eea45cSKlaus Jensen         req->cqe.sq_id = cpu_to_le16(sq->sqid);
151988eea45cSKlaus Jensen         req->cqe.sq_head = cpu_to_le16(sq->head);
15206a33f2e9SKlaus Jensen         addr = cq->dma_addr + (cq->tail << NVME_CQES);
152148b32c28SKlaus Jensen         ret = pci_dma_write(PCI_DEVICE(n), addr, (void *)&req->cqe,
152288eea45cSKlaus Jensen                             sizeof(req->cqe));
152388eea45cSKlaus Jensen         if (ret) {
152488eea45cSKlaus Jensen             trace_pci_nvme_err_addr_write(addr);
152588eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
152649e03457SKlaus Jensen             stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
152788eea45cSKlaus Jensen             break;
152888eea45cSKlaus Jensen         }
15299529aa6bSKlaus Jensen 
153088eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->req_list, req, entry);
15319529aa6bSKlaus Jensen 
153288eea45cSKlaus Jensen         nvme_inc_cq_tail(cq);
153388eea45cSKlaus Jensen         nvme_sg_unmap(&req->sg);
15349529aa6bSKlaus Jensen 
15359529aa6bSKlaus Jensen         if (QTAILQ_EMPTY(&sq->req_list) && !nvme_sq_empty(sq)) {
15369529aa6bSKlaus Jensen             qemu_bh_schedule(sq->bh);
15379529aa6bSKlaus Jensen         }
15389529aa6bSKlaus Jensen 
153988eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->req_list, req, entry);
154088eea45cSKlaus Jensen     }
154188eea45cSKlaus Jensen     if (cq->tail != cq->head) {
154283d7ed5cSKlaus Jensen         if (cq->irq_enabled && !pending) {
154383d7ed5cSKlaus Jensen             n->cq_pending++;
154483d7ed5cSKlaus Jensen         }
154583d7ed5cSKlaus Jensen 
154688eea45cSKlaus Jensen         nvme_irq_assert(n, cq);
154788eea45cSKlaus Jensen     }
154888eea45cSKlaus Jensen }
154988eea45cSKlaus Jensen 
nvme_enqueue_req_completion(NvmeCQueue * cq,NvmeRequest * req)155088eea45cSKlaus Jensen static void nvme_enqueue_req_completion(NvmeCQueue *cq, NvmeRequest *req)
155188eea45cSKlaus Jensen {
155288eea45cSKlaus Jensen     assert(cq->cqid == req->sq->cqid);
155388eea45cSKlaus Jensen     trace_pci_nvme_enqueue_req_completion(nvme_cid(req), cq->cqid,
1554f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.result),
1555f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.dw1),
155688eea45cSKlaus Jensen                                           req->status);
155788eea45cSKlaus Jensen 
155888eea45cSKlaus Jensen     if (req->status) {
155988eea45cSKlaus Jensen         trace_pci_nvme_err_req_status(nvme_cid(req), nvme_nsid(req->ns),
156088eea45cSKlaus Jensen                                       req->status, req->cmd.opcode);
156188eea45cSKlaus Jensen     }
156288eea45cSKlaus Jensen 
156388eea45cSKlaus Jensen     QTAILQ_REMOVE(&req->sq->out_req_list, req, entry);
156488eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&cq->req_list, req, entry);
15652e53b0b4SJinhao Fan 
1566d38cc6fdSKlaus Jensen     qemu_bh_schedule(cq->bh);
15672e53b0b4SJinhao Fan }
156888eea45cSKlaus Jensen 
nvme_process_aers(void * opaque)156988eea45cSKlaus Jensen static void nvme_process_aers(void *opaque)
157088eea45cSKlaus Jensen {
157188eea45cSKlaus Jensen     NvmeCtrl *n = opaque;
157288eea45cSKlaus Jensen     NvmeAsyncEvent *event, *next;
157388eea45cSKlaus Jensen 
157488eea45cSKlaus Jensen     trace_pci_nvme_process_aers(n->aer_queued);
157588eea45cSKlaus Jensen 
157688eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(event, &n->aer_queue, entry, next) {
157788eea45cSKlaus Jensen         NvmeRequest *req;
157888eea45cSKlaus Jensen         NvmeAerResult *result;
157988eea45cSKlaus Jensen 
158088eea45cSKlaus Jensen         /* can't post cqe if there is nothing to complete */
158188eea45cSKlaus Jensen         if (!n->outstanding_aers) {
158288eea45cSKlaus Jensen             trace_pci_nvme_no_outstanding_aers();
158388eea45cSKlaus Jensen             break;
158488eea45cSKlaus Jensen         }
158588eea45cSKlaus Jensen 
158688eea45cSKlaus Jensen         /* ignore if masked (cqe posted, but event not cleared) */
158788eea45cSKlaus Jensen         if (n->aer_mask & (1 << event->result.event_type)) {
158888eea45cSKlaus Jensen             trace_pci_nvme_aer_masked(event->result.event_type, n->aer_mask);
158988eea45cSKlaus Jensen             continue;
159088eea45cSKlaus Jensen         }
159188eea45cSKlaus Jensen 
159288eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
159388eea45cSKlaus Jensen         n->aer_queued--;
159488eea45cSKlaus Jensen 
159588eea45cSKlaus Jensen         n->aer_mask |= 1 << event->result.event_type;
159688eea45cSKlaus Jensen         n->outstanding_aers--;
159788eea45cSKlaus Jensen 
159888eea45cSKlaus Jensen         req = n->aer_reqs[n->outstanding_aers];
159988eea45cSKlaus Jensen 
160088eea45cSKlaus Jensen         result = (NvmeAerResult *) &req->cqe.result;
160188eea45cSKlaus Jensen         result->event_type = event->result.event_type;
160288eea45cSKlaus Jensen         result->event_info = event->result.event_info;
160388eea45cSKlaus Jensen         result->log_page = event->result.log_page;
160488eea45cSKlaus Jensen         g_free(event);
160588eea45cSKlaus Jensen 
160688eea45cSKlaus Jensen         trace_pci_nvme_aer_post_cqe(result->event_type, result->event_info,
160788eea45cSKlaus Jensen                                     result->log_page);
160888eea45cSKlaus Jensen 
160988eea45cSKlaus Jensen         nvme_enqueue_req_completion(&n->admin_cq, req);
161088eea45cSKlaus Jensen     }
161188eea45cSKlaus Jensen }
161288eea45cSKlaus Jensen 
nvme_enqueue_event(NvmeCtrl * n,uint8_t event_type,uint8_t event_info,uint8_t log_page)161388eea45cSKlaus Jensen static void nvme_enqueue_event(NvmeCtrl *n, uint8_t event_type,
161488eea45cSKlaus Jensen                                uint8_t event_info, uint8_t log_page)
161588eea45cSKlaus Jensen {
161688eea45cSKlaus Jensen     NvmeAsyncEvent *event;
161788eea45cSKlaus Jensen 
161888eea45cSKlaus Jensen     trace_pci_nvme_enqueue_event(event_type, event_info, log_page);
161988eea45cSKlaus Jensen 
162088eea45cSKlaus Jensen     if (n->aer_queued == n->params.aer_max_queued) {
162188eea45cSKlaus Jensen         trace_pci_nvme_enqueue_event_noqueue(n->aer_queued);
162288eea45cSKlaus Jensen         return;
162388eea45cSKlaus Jensen     }
162488eea45cSKlaus Jensen 
162588eea45cSKlaus Jensen     event = g_new(NvmeAsyncEvent, 1);
162688eea45cSKlaus Jensen     event->result = (NvmeAerResult) {
162788eea45cSKlaus Jensen         .event_type = event_type,
162888eea45cSKlaus Jensen         .event_info = event_info,
162988eea45cSKlaus Jensen         .log_page   = log_page,
163088eea45cSKlaus Jensen     };
163188eea45cSKlaus Jensen 
163288eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&n->aer_queue, event, entry);
163388eea45cSKlaus Jensen     n->aer_queued++;
163488eea45cSKlaus Jensen 
163588eea45cSKlaus Jensen     nvme_process_aers(n);
163688eea45cSKlaus Jensen }
163788eea45cSKlaus Jensen 
nvme_smart_event(NvmeCtrl * n,uint8_t event)163888eea45cSKlaus Jensen static void nvme_smart_event(NvmeCtrl *n, uint8_t event)
163988eea45cSKlaus Jensen {
164088eea45cSKlaus Jensen     uint8_t aer_info;
164188eea45cSKlaus Jensen 
164288eea45cSKlaus Jensen     /* Ref SPEC <Asynchronous Event Information 0x2013 SMART / Health Status> */
164388eea45cSKlaus Jensen     if (!(NVME_AEC_SMART(n->features.async_config) & event)) {
164488eea45cSKlaus Jensen         return;
164588eea45cSKlaus Jensen     }
164688eea45cSKlaus Jensen 
164788eea45cSKlaus Jensen     switch (event) {
164888eea45cSKlaus Jensen     case NVME_SMART_SPARE:
164988eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_SPARE_THRESH;
165088eea45cSKlaus Jensen         break;
165188eea45cSKlaus Jensen     case NVME_SMART_TEMPERATURE:
165288eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_TEMP_THRESH;
165388eea45cSKlaus Jensen         break;
165488eea45cSKlaus Jensen     case NVME_SMART_RELIABILITY:
165588eea45cSKlaus Jensen     case NVME_SMART_MEDIA_READ_ONLY:
165688eea45cSKlaus Jensen     case NVME_SMART_FAILED_VOLATILE_MEDIA:
165788eea45cSKlaus Jensen     case NVME_SMART_PMR_UNRELIABLE:
165888eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_RELIABILITY;
165988eea45cSKlaus Jensen         break;
166088eea45cSKlaus Jensen     default:
166188eea45cSKlaus Jensen         return;
166288eea45cSKlaus Jensen     }
166388eea45cSKlaus Jensen 
166488eea45cSKlaus Jensen     nvme_enqueue_event(n, NVME_AER_TYPE_SMART, aer_info, NVME_LOG_SMART_INFO);
166588eea45cSKlaus Jensen }
166688eea45cSKlaus Jensen 
nvme_clear_events(NvmeCtrl * n,uint8_t event_type)166788eea45cSKlaus Jensen static void nvme_clear_events(NvmeCtrl *n, uint8_t event_type)
166888eea45cSKlaus Jensen {
166916eb2ea8SArun Kumar     NvmeAsyncEvent *event, *next;
167016eb2ea8SArun Kumar 
167188eea45cSKlaus Jensen     n->aer_mask &= ~(1 << event_type);
167216eb2ea8SArun Kumar 
167316eb2ea8SArun Kumar     QTAILQ_FOREACH_SAFE(event, &n->aer_queue, entry, next) {
167416eb2ea8SArun Kumar         if (event->result.event_type == event_type) {
167516eb2ea8SArun Kumar             QTAILQ_REMOVE(&n->aer_queue, event, entry);
167616eb2ea8SArun Kumar             n->aer_queued--;
167716eb2ea8SArun Kumar             g_free(event);
167816eb2ea8SArun Kumar         }
167988eea45cSKlaus Jensen     }
168088eea45cSKlaus Jensen }
168188eea45cSKlaus Jensen 
nvme_check_mdts(NvmeCtrl * n,size_t len)168288eea45cSKlaus Jensen static inline uint16_t nvme_check_mdts(NvmeCtrl *n, size_t len)
168388eea45cSKlaus Jensen {
168488eea45cSKlaus Jensen     uint8_t mdts = n->params.mdts;
168588eea45cSKlaus Jensen 
168688eea45cSKlaus Jensen     if (mdts && len > n->page_size << mdts) {
168788eea45cSKlaus Jensen         trace_pci_nvme_err_mdts(len);
168888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
168988eea45cSKlaus Jensen     }
169088eea45cSKlaus Jensen 
169188eea45cSKlaus Jensen     return NVME_SUCCESS;
169288eea45cSKlaus Jensen }
169388eea45cSKlaus Jensen 
nvme_check_bounds(NvmeNamespace * ns,uint64_t slba,uint32_t nlb)169488eea45cSKlaus Jensen static inline uint16_t nvme_check_bounds(NvmeNamespace *ns, uint64_t slba,
169588eea45cSKlaus Jensen                                          uint32_t nlb)
169688eea45cSKlaus Jensen {
169788eea45cSKlaus Jensen     uint64_t nsze = le64_to_cpu(ns->id_ns.nsze);
169888eea45cSKlaus Jensen 
169988eea45cSKlaus Jensen     if (unlikely(UINT64_MAX - slba < nlb || slba + nlb > nsze)) {
170088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb, nsze);
170188eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
170288eea45cSKlaus Jensen     }
170388eea45cSKlaus Jensen 
170488eea45cSKlaus Jensen     return NVME_SUCCESS;
170588eea45cSKlaus Jensen }
170688eea45cSKlaus Jensen 
nvme_block_status_all(NvmeNamespace * ns,uint64_t slba,uint32_t nlb,int flags)1707ff0ac2c8SKlaus Jensen static int nvme_block_status_all(NvmeNamespace *ns, uint64_t slba,
1708ff0ac2c8SKlaus Jensen                                  uint32_t nlb, int flags)
170988eea45cSKlaus Jensen {
171088eea45cSKlaus Jensen     BlockDriverState *bs = blk_bs(ns->blkconf.blk);
171188eea45cSKlaus Jensen 
171288eea45cSKlaus Jensen     int64_t pnum = 0, bytes = nvme_l2b(ns, nlb);
171388eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
171488eea45cSKlaus Jensen     int ret;
171588eea45cSKlaus Jensen 
171688eea45cSKlaus Jensen     /*
171788eea45cSKlaus Jensen      * `pnum` holds the number of bytes after offset that shares the same
171888eea45cSKlaus Jensen      * allocation status as the byte at offset. If `pnum` is different from
171988eea45cSKlaus Jensen      * `bytes`, we should check the allocation status of the next range and
172088eea45cSKlaus Jensen      * continue this until all bytes have been checked.
172188eea45cSKlaus Jensen      */
172288eea45cSKlaus Jensen     do {
172388eea45cSKlaus Jensen         bytes -= pnum;
172488eea45cSKlaus Jensen 
172588eea45cSKlaus Jensen         ret = bdrv_block_status(bs, offset, bytes, &pnum, NULL, NULL);
172688eea45cSKlaus Jensen         if (ret < 0) {
1727ff0ac2c8SKlaus Jensen             return ret;
172888eea45cSKlaus Jensen         }
172988eea45cSKlaus Jensen 
173088eea45cSKlaus Jensen 
1731ff0ac2c8SKlaus Jensen         trace_pci_nvme_block_status(offset, bytes, pnum, ret,
1732ff0ac2c8SKlaus Jensen                                     !!(ret & BDRV_BLOCK_ZERO));
173388eea45cSKlaus Jensen 
1734ff0ac2c8SKlaus Jensen         if (!(ret & flags)) {
1735ff0ac2c8SKlaus Jensen             return 1;
173688eea45cSKlaus Jensen         }
173788eea45cSKlaus Jensen 
173888eea45cSKlaus Jensen         offset += pnum;
173988eea45cSKlaus Jensen     } while (pnum != bytes);
174088eea45cSKlaus Jensen 
1741ff0ac2c8SKlaus Jensen     return 0;
1742ff0ac2c8SKlaus Jensen }
1743ff0ac2c8SKlaus Jensen 
nvme_check_dulbe(NvmeNamespace * ns,uint64_t slba,uint32_t nlb)1744ff0ac2c8SKlaus Jensen static uint16_t nvme_check_dulbe(NvmeNamespace *ns, uint64_t slba,
1745ff0ac2c8SKlaus Jensen                                  uint32_t nlb)
1746ff0ac2c8SKlaus Jensen {
1747ff0ac2c8SKlaus Jensen     int ret;
1748ff0ac2c8SKlaus Jensen     Error *err = NULL;
1749ff0ac2c8SKlaus Jensen 
1750ff0ac2c8SKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_DATA);
1751ff0ac2c8SKlaus Jensen     if (ret) {
1752ff0ac2c8SKlaus Jensen         if (ret < 0) {
1753ff0ac2c8SKlaus Jensen             error_setg_errno(&err, -ret, "unable to get block status");
1754ff0ac2c8SKlaus Jensen             error_report_err(err);
1755ff0ac2c8SKlaus Jensen 
1756ff0ac2c8SKlaus Jensen             return NVME_INTERNAL_DEV_ERROR;
1757ff0ac2c8SKlaus Jensen         }
1758ff0ac2c8SKlaus Jensen 
1759ff0ac2c8SKlaus Jensen         return NVME_DULB;
1760ff0ac2c8SKlaus Jensen     }
1761ff0ac2c8SKlaus Jensen 
176288eea45cSKlaus Jensen     return NVME_SUCCESS;
176388eea45cSKlaus Jensen }
176488eea45cSKlaus Jensen 
nvme_aio_err(NvmeRequest * req,int ret)176588eea45cSKlaus Jensen static void nvme_aio_err(NvmeRequest *req, int ret)
176688eea45cSKlaus Jensen {
176788eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
176888eea45cSKlaus Jensen     Error *local_err = NULL;
176988eea45cSKlaus Jensen 
177088eea45cSKlaus Jensen     switch (req->cmd.opcode) {
177188eea45cSKlaus Jensen     case NVME_CMD_READ:
177288eea45cSKlaus Jensen         status = NVME_UNRECOVERED_READ;
177388eea45cSKlaus Jensen         break;
177488eea45cSKlaus Jensen     case NVME_CMD_FLUSH:
177588eea45cSKlaus Jensen     case NVME_CMD_WRITE:
177688eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
177788eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
1778cab1da59SMinwoo Im     case NVME_CMD_COPY:
177988eea45cSKlaus Jensen         status = NVME_WRITE_FAULT;
178088eea45cSKlaus Jensen         break;
178188eea45cSKlaus Jensen     default:
178288eea45cSKlaus Jensen         status = NVME_INTERNAL_DEV_ERROR;
178388eea45cSKlaus Jensen         break;
178488eea45cSKlaus Jensen     }
178588eea45cSKlaus Jensen 
178675209c07SAyush Mishra     if (ret == -ECANCELED) {
178775209c07SAyush Mishra         status = NVME_CMD_ABORT_REQ;
178875209c07SAyush Mishra     }
178975209c07SAyush Mishra 
179088eea45cSKlaus Jensen     trace_pci_nvme_err_aio(nvme_cid(req), strerror(-ret), status);
179188eea45cSKlaus Jensen 
179288eea45cSKlaus Jensen     error_setg_errno(&local_err, -ret, "aio failed");
179388eea45cSKlaus Jensen     error_report_err(local_err);
179488eea45cSKlaus Jensen 
179588eea45cSKlaus Jensen     /*
179688eea45cSKlaus Jensen      * Set the command status code to the first encountered error but allow a
179788eea45cSKlaus Jensen      * subsequent Internal Device Error to trump it.
179888eea45cSKlaus Jensen      */
179988eea45cSKlaus Jensen     if (req->status && status != NVME_INTERNAL_DEV_ERROR) {
180088eea45cSKlaus Jensen         return;
180188eea45cSKlaus Jensen     }
180288eea45cSKlaus Jensen 
180388eea45cSKlaus Jensen     req->status = status;
180488eea45cSKlaus Jensen }
180588eea45cSKlaus Jensen 
nvme_zone_idx(NvmeNamespace * ns,uint64_t slba)180688eea45cSKlaus Jensen static inline uint32_t nvme_zone_idx(NvmeNamespace *ns, uint64_t slba)
180788eea45cSKlaus Jensen {
180888eea45cSKlaus Jensen     return ns->zone_size_log2 > 0 ? slba >> ns->zone_size_log2 :
180988eea45cSKlaus Jensen                                     slba / ns->zone_size;
181088eea45cSKlaus Jensen }
181188eea45cSKlaus Jensen 
nvme_get_zone_by_slba(NvmeNamespace * ns,uint64_t slba)181288eea45cSKlaus Jensen static inline NvmeZone *nvme_get_zone_by_slba(NvmeNamespace *ns, uint64_t slba)
181388eea45cSKlaus Jensen {
181488eea45cSKlaus Jensen     uint32_t zone_idx = nvme_zone_idx(ns, slba);
181588eea45cSKlaus Jensen 
1816189a8bf7SKlaus Jensen     if (zone_idx >= ns->num_zones) {
1817189a8bf7SKlaus Jensen         return NULL;
1818189a8bf7SKlaus Jensen     }
1819189a8bf7SKlaus Jensen 
182088eea45cSKlaus Jensen     return &ns->zone_array[zone_idx];
182188eea45cSKlaus Jensen }
182288eea45cSKlaus Jensen 
nvme_check_zone_state_for_write(NvmeZone * zone)182388eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_write(NvmeZone *zone)
182488eea45cSKlaus Jensen {
182588eea45cSKlaus Jensen     uint64_t zslba = zone->d.zslba;
182688eea45cSKlaus Jensen 
182788eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
182888eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
182988eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
183088eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
183188eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
183288eea45cSKlaus Jensen         return NVME_SUCCESS;
183388eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
183488eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_full(zslba);
183588eea45cSKlaus Jensen         return NVME_ZONE_FULL;
183688eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
183788eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zslba);
183888eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
183988eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
184088eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_read_only(zslba);
184188eea45cSKlaus Jensen         return NVME_ZONE_READ_ONLY;
184288eea45cSKlaus Jensen     default:
18437f2acdfbSPierrick Bouvier         g_assert_not_reached();
184488eea45cSKlaus Jensen     }
184588eea45cSKlaus Jensen 
184688eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
184788eea45cSKlaus Jensen }
184888eea45cSKlaus Jensen 
nvme_check_zone_write(NvmeNamespace * ns,NvmeZone * zone,uint64_t slba,uint32_t nlb)184988eea45cSKlaus Jensen static uint16_t nvme_check_zone_write(NvmeNamespace *ns, NvmeZone *zone,
185088eea45cSKlaus Jensen                                       uint64_t slba, uint32_t nlb)
185188eea45cSKlaus Jensen {
185288eea45cSKlaus Jensen     uint64_t zcap = nvme_zone_wr_boundary(zone);
185388eea45cSKlaus Jensen     uint16_t status;
185488eea45cSKlaus Jensen 
185588eea45cSKlaus Jensen     status = nvme_check_zone_state_for_write(zone);
185688eea45cSKlaus Jensen     if (status) {
185788eea45cSKlaus Jensen         return status;
185888eea45cSKlaus Jensen     }
185988eea45cSKlaus Jensen 
1860e321b4cdSKlaus Jensen     if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1861e321b4cdSKlaus Jensen         uint64_t ezrwa = zone->w_ptr + 2 * ns->zns.zrwas;
1862e321b4cdSKlaus Jensen 
1863e321b4cdSKlaus Jensen         if (slba < zone->w_ptr || slba + nlb > ezrwa) {
1864e321b4cdSKlaus Jensen             trace_pci_nvme_err_zone_invalid_write(slba, zone->w_ptr);
186588eea45cSKlaus Jensen             return NVME_ZONE_INVALID_WRITE;
186688eea45cSKlaus Jensen         }
1867e321b4cdSKlaus Jensen     } else {
1868e321b4cdSKlaus Jensen         if (unlikely(slba != zone->w_ptr)) {
1869e321b4cdSKlaus Jensen             trace_pci_nvme_err_write_not_at_wp(slba, zone->d.zslba,
1870e321b4cdSKlaus Jensen                                                zone->w_ptr);
1871e321b4cdSKlaus Jensen             return NVME_ZONE_INVALID_WRITE;
1872e321b4cdSKlaus Jensen         }
1873e321b4cdSKlaus Jensen     }
187488eea45cSKlaus Jensen 
187588eea45cSKlaus Jensen     if (unlikely((slba + nlb) > zcap)) {
187688eea45cSKlaus Jensen         trace_pci_nvme_err_zone_boundary(slba, nlb, zcap);
187788eea45cSKlaus Jensen         return NVME_ZONE_BOUNDARY_ERROR;
187888eea45cSKlaus Jensen     }
187988eea45cSKlaus Jensen 
188088eea45cSKlaus Jensen     return NVME_SUCCESS;
188188eea45cSKlaus Jensen }
188288eea45cSKlaus Jensen 
nvme_check_zone_state_for_read(NvmeZone * zone)188388eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_read(NvmeZone *zone)
188488eea45cSKlaus Jensen {
188588eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
188688eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
188788eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
188888eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
188988eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
189088eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
189188eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
189288eea45cSKlaus Jensen         return NVME_SUCCESS;
189388eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
189488eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zone->d.zslba);
189588eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
189688eea45cSKlaus Jensen     default:
18977f2acdfbSPierrick Bouvier         g_assert_not_reached();
189888eea45cSKlaus Jensen     }
189988eea45cSKlaus Jensen 
190088eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
190188eea45cSKlaus Jensen }
190288eea45cSKlaus Jensen 
nvme_check_zone_read(NvmeNamespace * ns,uint64_t slba,uint32_t nlb)190388eea45cSKlaus Jensen static uint16_t nvme_check_zone_read(NvmeNamespace *ns, uint64_t slba,
190488eea45cSKlaus Jensen                                      uint32_t nlb)
190588eea45cSKlaus Jensen {
1906189a8bf7SKlaus Jensen     NvmeZone *zone;
1907189a8bf7SKlaus Jensen     uint64_t bndry, end;
190888eea45cSKlaus Jensen     uint16_t status;
190988eea45cSKlaus Jensen 
1910189a8bf7SKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
1911189a8bf7SKlaus Jensen     assert(zone);
1912189a8bf7SKlaus Jensen 
1913189a8bf7SKlaus Jensen     bndry = nvme_zone_rd_boundary(ns, zone);
1914189a8bf7SKlaus Jensen     end = slba + nlb;
1915189a8bf7SKlaus Jensen 
191688eea45cSKlaus Jensen     status = nvme_check_zone_state_for_read(zone);
191788eea45cSKlaus Jensen     if (status) {
191888eea45cSKlaus Jensen         ;
191988eea45cSKlaus Jensen     } else if (unlikely(end > bndry)) {
192088eea45cSKlaus Jensen         if (!ns->params.cross_zone_read) {
192188eea45cSKlaus Jensen             status = NVME_ZONE_BOUNDARY_ERROR;
192288eea45cSKlaus Jensen         } else {
192388eea45cSKlaus Jensen             /*
192488eea45cSKlaus Jensen              * Read across zone boundary - check that all subsequent
192588eea45cSKlaus Jensen              * zones that are being read have an appropriate state.
192688eea45cSKlaus Jensen              */
192788eea45cSKlaus Jensen             do {
192888eea45cSKlaus Jensen                 zone++;
192988eea45cSKlaus Jensen                 status = nvme_check_zone_state_for_read(zone);
193088eea45cSKlaus Jensen                 if (status) {
193188eea45cSKlaus Jensen                     break;
193288eea45cSKlaus Jensen                 }
193388eea45cSKlaus Jensen             } while (end > nvme_zone_rd_boundary(ns, zone));
193488eea45cSKlaus Jensen         }
193588eea45cSKlaus Jensen     }
193688eea45cSKlaus Jensen 
193788eea45cSKlaus Jensen     return status;
193888eea45cSKlaus Jensen }
193988eea45cSKlaus Jensen 
nvme_zrm_finish(NvmeNamespace * ns,NvmeZone * zone)194088eea45cSKlaus Jensen static uint16_t nvme_zrm_finish(NvmeNamespace *ns, NvmeZone *zone)
194188eea45cSKlaus Jensen {
194288eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
194388eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
194488eea45cSKlaus Jensen         return NVME_SUCCESS;
194588eea45cSKlaus Jensen 
194688eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
194788eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
194888eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
194988eea45cSKlaus Jensen         /* fallthrough */
195088eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
195188eea45cSKlaus Jensen         nvme_aor_dec_active(ns);
1952e321b4cdSKlaus Jensen 
1953e321b4cdSKlaus Jensen         if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1954e321b4cdSKlaus Jensen             zone->d.za &= ~NVME_ZA_ZRWA_VALID;
1955e321b4cdSKlaus Jensen             if (ns->params.numzrwa) {
1956e321b4cdSKlaus Jensen                 ns->zns.numzrwa++;
1957e321b4cdSKlaus Jensen             }
1958e321b4cdSKlaus Jensen         }
1959e321b4cdSKlaus Jensen 
196088eea45cSKlaus Jensen         /* fallthrough */
196188eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
196288eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_FULL);
196388eea45cSKlaus Jensen         return NVME_SUCCESS;
196488eea45cSKlaus Jensen 
196588eea45cSKlaus Jensen     default:
196688eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
196788eea45cSKlaus Jensen     }
196888eea45cSKlaus Jensen }
196988eea45cSKlaus Jensen 
nvme_zrm_close(NvmeNamespace * ns,NvmeZone * zone)197088eea45cSKlaus Jensen static uint16_t nvme_zrm_close(NvmeNamespace *ns, NvmeZone *zone)
197188eea45cSKlaus Jensen {
197288eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
197388eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
197488eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
197588eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
197688eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
197788eea45cSKlaus Jensen         /* fall through */
197888eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
197988eea45cSKlaus Jensen         return NVME_SUCCESS;
198088eea45cSKlaus Jensen 
198188eea45cSKlaus Jensen     default:
198288eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
198388eea45cSKlaus Jensen     }
198488eea45cSKlaus Jensen }
198588eea45cSKlaus Jensen 
nvme_zrm_reset(NvmeNamespace * ns,NvmeZone * zone)198663d96e4fSKlaus Jensen static uint16_t nvme_zrm_reset(NvmeNamespace *ns, NvmeZone *zone)
198763d96e4fSKlaus Jensen {
198863d96e4fSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
198963d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
199063d96e4fSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
199163d96e4fSKlaus Jensen         nvme_aor_dec_open(ns);
199263d96e4fSKlaus Jensen         /* fallthrough */
199363d96e4fSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
199463d96e4fSKlaus Jensen         nvme_aor_dec_active(ns);
1995e321b4cdSKlaus Jensen 
1996e321b4cdSKlaus Jensen         if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1997e321b4cdSKlaus Jensen             if (ns->params.numzrwa) {
1998e321b4cdSKlaus Jensen                 ns->zns.numzrwa++;
1999e321b4cdSKlaus Jensen             }
2000e321b4cdSKlaus Jensen         }
2001e321b4cdSKlaus Jensen 
200263d96e4fSKlaus Jensen         /* fallthrough */
200363d96e4fSKlaus Jensen     case NVME_ZONE_STATE_FULL:
200463d96e4fSKlaus Jensen         zone->w_ptr = zone->d.zslba;
200563d96e4fSKlaus Jensen         zone->d.wp = zone->w_ptr;
200663d96e4fSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EMPTY);
200763d96e4fSKlaus Jensen         /* fallthrough */
200863d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
200963d96e4fSKlaus Jensen         return NVME_SUCCESS;
201063d96e4fSKlaus Jensen 
201163d96e4fSKlaus Jensen     default:
201263d96e4fSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
201363d96e4fSKlaus Jensen     }
201463d96e4fSKlaus Jensen }
201563d96e4fSKlaus Jensen 
nvme_zrm_auto_transition_zone(NvmeNamespace * ns)201688eea45cSKlaus Jensen static void nvme_zrm_auto_transition_zone(NvmeNamespace *ns)
201788eea45cSKlaus Jensen {
201888eea45cSKlaus Jensen     NvmeZone *zone;
201988eea45cSKlaus Jensen 
202088eea45cSKlaus Jensen     if (ns->params.max_open_zones &&
202188eea45cSKlaus Jensen         ns->nr_open_zones == ns->params.max_open_zones) {
202288eea45cSKlaus Jensen         zone = QTAILQ_FIRST(&ns->imp_open_zones);
202388eea45cSKlaus Jensen         if (zone) {
202488eea45cSKlaus Jensen             /*
202588eea45cSKlaus Jensen              * Automatically close this implicitly open zone.
202688eea45cSKlaus Jensen              */
202788eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
202888eea45cSKlaus Jensen             nvme_zrm_close(ns, zone);
202988eea45cSKlaus Jensen         }
203088eea45cSKlaus Jensen     }
203188eea45cSKlaus Jensen }
203288eea45cSKlaus Jensen 
203388eea45cSKlaus Jensen enum {
203488eea45cSKlaus Jensen     NVME_ZRM_AUTO = 1 << 0,
2035e321b4cdSKlaus Jensen     NVME_ZRM_ZRWA = 1 << 1,
203688eea45cSKlaus Jensen };
203788eea45cSKlaus Jensen 
nvme_zrm_open_flags(NvmeCtrl * n,NvmeNamespace * ns,NvmeZone * zone,int flags)2038cccc2651SNiklas Cassel static uint16_t nvme_zrm_open_flags(NvmeCtrl *n, NvmeNamespace *ns,
2039cccc2651SNiklas Cassel                                     NvmeZone *zone, int flags)
204088eea45cSKlaus Jensen {
204188eea45cSKlaus Jensen     int act = 0;
204288eea45cSKlaus Jensen     uint16_t status;
204388eea45cSKlaus Jensen 
204488eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
204588eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
204688eea45cSKlaus Jensen         act = 1;
204788eea45cSKlaus Jensen 
204888eea45cSKlaus Jensen         /* fallthrough */
204988eea45cSKlaus Jensen 
205088eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
2051cccc2651SNiklas Cassel         if (n->params.auto_transition_zones) {
205288eea45cSKlaus Jensen             nvme_zrm_auto_transition_zone(ns);
2053cccc2651SNiklas Cassel         }
2054e321b4cdSKlaus Jensen         status = nvme_zns_check_resources(ns, act, 1,
2055e321b4cdSKlaus Jensen                                           (flags & NVME_ZRM_ZRWA) ? 1 : 0);
205688eea45cSKlaus Jensen         if (status) {
205788eea45cSKlaus Jensen             return status;
205888eea45cSKlaus Jensen         }
205988eea45cSKlaus Jensen 
206088eea45cSKlaus Jensen         if (act) {
206188eea45cSKlaus Jensen             nvme_aor_inc_active(ns);
206288eea45cSKlaus Jensen         }
206388eea45cSKlaus Jensen 
206488eea45cSKlaus Jensen         nvme_aor_inc_open(ns);
206588eea45cSKlaus Jensen 
206688eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
206788eea45cSKlaus Jensen             nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_IMPLICITLY_OPEN);
206888eea45cSKlaus Jensen             return NVME_SUCCESS;
206988eea45cSKlaus Jensen         }
207088eea45cSKlaus Jensen 
207188eea45cSKlaus Jensen         /* fallthrough */
207288eea45cSKlaus Jensen 
207388eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
207488eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
207588eea45cSKlaus Jensen             return NVME_SUCCESS;
207688eea45cSKlaus Jensen         }
207788eea45cSKlaus Jensen 
207888eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EXPLICITLY_OPEN);
207988eea45cSKlaus Jensen 
208088eea45cSKlaus Jensen         /* fallthrough */
208188eea45cSKlaus Jensen 
208288eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
2083e321b4cdSKlaus Jensen         if (flags & NVME_ZRM_ZRWA) {
2084e321b4cdSKlaus Jensen             ns->zns.numzrwa--;
2085e321b4cdSKlaus Jensen 
2086e321b4cdSKlaus Jensen             zone->d.za |= NVME_ZA_ZRWA_VALID;
2087e321b4cdSKlaus Jensen         }
2088e321b4cdSKlaus Jensen 
208988eea45cSKlaus Jensen         return NVME_SUCCESS;
209088eea45cSKlaus Jensen 
209188eea45cSKlaus Jensen     default:
209288eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
209388eea45cSKlaus Jensen     }
209488eea45cSKlaus Jensen }
209588eea45cSKlaus Jensen 
nvme_zrm_auto(NvmeCtrl * n,NvmeNamespace * ns,NvmeZone * zone)2096cccc2651SNiklas Cassel static inline uint16_t nvme_zrm_auto(NvmeCtrl *n, NvmeNamespace *ns,
2097cccc2651SNiklas Cassel                                      NvmeZone *zone)
209888eea45cSKlaus Jensen {
2099cccc2651SNiklas Cassel     return nvme_zrm_open_flags(n, ns, zone, NVME_ZRM_AUTO);
210088eea45cSKlaus Jensen }
210188eea45cSKlaus Jensen 
nvme_advance_zone_wp(NvmeNamespace * ns,NvmeZone * zone,uint32_t nlb)210288eea45cSKlaus Jensen static void nvme_advance_zone_wp(NvmeNamespace *ns, NvmeZone *zone,
210388eea45cSKlaus Jensen                                  uint32_t nlb)
210488eea45cSKlaus Jensen {
210588eea45cSKlaus Jensen     zone->d.wp += nlb;
210688eea45cSKlaus Jensen 
210788eea45cSKlaus Jensen     if (zone->d.wp == nvme_zone_wr_boundary(zone)) {
210888eea45cSKlaus Jensen         nvme_zrm_finish(ns, zone);
210988eea45cSKlaus Jensen     }
211088eea45cSKlaus Jensen }
211188eea45cSKlaus Jensen 
nvme_zoned_zrwa_implicit_flush(NvmeNamespace * ns,NvmeZone * zone,uint32_t nlbc)2112e321b4cdSKlaus Jensen static void nvme_zoned_zrwa_implicit_flush(NvmeNamespace *ns, NvmeZone *zone,
2113e321b4cdSKlaus Jensen                                            uint32_t nlbc)
2114e321b4cdSKlaus Jensen {
2115e321b4cdSKlaus Jensen     uint16_t nzrwafgs = DIV_ROUND_UP(nlbc, ns->zns.zrwafg);
2116e321b4cdSKlaus Jensen 
2117e321b4cdSKlaus Jensen     nlbc = nzrwafgs * ns->zns.zrwafg;
2118e321b4cdSKlaus Jensen 
2119e321b4cdSKlaus Jensen     trace_pci_nvme_zoned_zrwa_implicit_flush(zone->d.zslba, nlbc);
2120e321b4cdSKlaus Jensen 
2121e321b4cdSKlaus Jensen     zone->w_ptr += nlbc;
2122e321b4cdSKlaus Jensen 
2123e321b4cdSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlbc);
2124e321b4cdSKlaus Jensen }
2125e321b4cdSKlaus Jensen 
nvme_finalize_zoned_write(NvmeNamespace * ns,NvmeRequest * req)212688eea45cSKlaus Jensen static void nvme_finalize_zoned_write(NvmeNamespace *ns, NvmeRequest *req)
212788eea45cSKlaus Jensen {
212888eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
212988eea45cSKlaus Jensen     NvmeZone *zone;
213088eea45cSKlaus Jensen     uint64_t slba;
213188eea45cSKlaus Jensen     uint32_t nlb;
213288eea45cSKlaus Jensen 
213388eea45cSKlaus Jensen     slba = le64_to_cpu(rw->slba);
213488eea45cSKlaus Jensen     nlb = le16_to_cpu(rw->nlb) + 1;
213588eea45cSKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
2136189a8bf7SKlaus Jensen     assert(zone);
213788eea45cSKlaus Jensen 
2138e321b4cdSKlaus Jensen     if (zone->d.za & NVME_ZA_ZRWA_VALID) {
2139e321b4cdSKlaus Jensen         uint64_t ezrwa = zone->w_ptr + ns->zns.zrwas - 1;
2140e321b4cdSKlaus Jensen         uint64_t elba = slba + nlb - 1;
2141e321b4cdSKlaus Jensen 
2142e321b4cdSKlaus Jensen         if (elba > ezrwa) {
2143e321b4cdSKlaus Jensen             nvme_zoned_zrwa_implicit_flush(ns, zone, elba - ezrwa);
2144e321b4cdSKlaus Jensen         }
2145e321b4cdSKlaus Jensen 
2146e321b4cdSKlaus Jensen         return;
2147e321b4cdSKlaus Jensen     }
2148e321b4cdSKlaus Jensen 
214988eea45cSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlb);
215088eea45cSKlaus Jensen }
215188eea45cSKlaus Jensen 
nvme_is_write(NvmeRequest * req)215288eea45cSKlaus Jensen static inline bool nvme_is_write(NvmeRequest *req)
215388eea45cSKlaus Jensen {
215488eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
215588eea45cSKlaus Jensen 
215688eea45cSKlaus Jensen     return rw->opcode == NVME_CMD_WRITE ||
215788eea45cSKlaus Jensen            rw->opcode == NVME_CMD_ZONE_APPEND ||
215888eea45cSKlaus Jensen            rw->opcode == NVME_CMD_WRITE_ZEROES;
215988eea45cSKlaus Jensen }
216088eea45cSKlaus Jensen 
nvme_misc_cb(void * opaque,int ret)216188eea45cSKlaus Jensen static void nvme_misc_cb(void *opaque, int ret)
216288eea45cSKlaus Jensen {
216388eea45cSKlaus Jensen     NvmeRequest *req = opaque;
216488eea45cSKlaus Jensen 
216538f4ac65SKlaus Jensen     trace_pci_nvme_misc_cb(nvme_cid(req));
216688eea45cSKlaus Jensen 
216788eea45cSKlaus Jensen     if (ret) {
216888eea45cSKlaus Jensen         nvme_aio_err(req, ret);
216988eea45cSKlaus Jensen     }
217088eea45cSKlaus Jensen 
217188eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
217288eea45cSKlaus Jensen }
217388eea45cSKlaus Jensen 
nvme_rw_complete_cb(void * opaque,int ret)217488eea45cSKlaus Jensen void nvme_rw_complete_cb(void *opaque, int ret)
217588eea45cSKlaus Jensen {
217688eea45cSKlaus Jensen     NvmeRequest *req = opaque;
217788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
217888eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
217988eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
218088eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
218188eea45cSKlaus Jensen 
218288eea45cSKlaus Jensen     trace_pci_nvme_rw_complete_cb(nvme_cid(req), blk_name(blk));
218388eea45cSKlaus Jensen 
218488eea45cSKlaus Jensen     if (ret) {
218588eea45cSKlaus Jensen         block_acct_failed(stats, acct);
218688eea45cSKlaus Jensen         nvme_aio_err(req, ret);
218788eea45cSKlaus Jensen     } else {
218888eea45cSKlaus Jensen         block_acct_done(stats, acct);
218988eea45cSKlaus Jensen     }
219088eea45cSKlaus Jensen 
219188eea45cSKlaus Jensen     if (ns->params.zoned && nvme_is_write(req)) {
219288eea45cSKlaus Jensen         nvme_finalize_zoned_write(ns, req);
219388eea45cSKlaus Jensen     }
219488eea45cSKlaus Jensen 
219588eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
219688eea45cSKlaus Jensen }
219788eea45cSKlaus Jensen 
nvme_rw_cb(void * opaque,int ret)219888eea45cSKlaus Jensen static void nvme_rw_cb(void *opaque, int ret)
219988eea45cSKlaus Jensen {
220088eea45cSKlaus Jensen     NvmeRequest *req = opaque;
220188eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
220288eea45cSKlaus Jensen 
220388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
220488eea45cSKlaus Jensen 
220588eea45cSKlaus Jensen     trace_pci_nvme_rw_cb(nvme_cid(req), blk_name(blk));
220688eea45cSKlaus Jensen 
220788eea45cSKlaus Jensen     if (ret) {
220888eea45cSKlaus Jensen         goto out;
220988eea45cSKlaus Jensen     }
221088eea45cSKlaus Jensen 
221188eea45cSKlaus Jensen     if (ns->lbaf.ms) {
221288eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
221388eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
221488eea45cSKlaus Jensen         uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
221588eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
221688eea45cSKlaus Jensen 
221788eea45cSKlaus Jensen         if (req->cmd.opcode == NVME_CMD_WRITE_ZEROES) {
221888eea45cSKlaus Jensen             size_t mlen = nvme_m2b(ns, nlb);
221988eea45cSKlaus Jensen 
222088eea45cSKlaus Jensen             req->aiocb = blk_aio_pwrite_zeroes(blk, offset, mlen,
222188eea45cSKlaus Jensen                                                BDRV_REQ_MAY_UNMAP,
222288eea45cSKlaus Jensen                                                nvme_rw_complete_cb, req);
222388eea45cSKlaus Jensen             return;
222488eea45cSKlaus Jensen         }
222588eea45cSKlaus Jensen 
222688eea45cSKlaus Jensen         if (nvme_ns_ext(ns) || req->cmd.mptr) {
222788eea45cSKlaus Jensen             uint16_t status;
222888eea45cSKlaus Jensen 
222988eea45cSKlaus Jensen             nvme_sg_unmap(&req->sg);
223088eea45cSKlaus Jensen             status = nvme_map_mdata(nvme_ctrl(req), nlb, req);
223188eea45cSKlaus Jensen             if (status) {
223288eea45cSKlaus Jensen                 ret = -EFAULT;
223388eea45cSKlaus Jensen                 goto out;
223488eea45cSKlaus Jensen             }
223588eea45cSKlaus Jensen 
223688eea45cSKlaus Jensen             if (req->cmd.opcode == NVME_CMD_READ) {
22379b4f0181SMateusz Kozlowski                 return nvme_blk_read(blk, offset, 1, nvme_rw_complete_cb, req);
223888eea45cSKlaus Jensen             }
223988eea45cSKlaus Jensen 
22409b4f0181SMateusz Kozlowski             return nvme_blk_write(blk, offset, 1, nvme_rw_complete_cb, req);
224188eea45cSKlaus Jensen         }
224288eea45cSKlaus Jensen     }
224388eea45cSKlaus Jensen 
224488eea45cSKlaus Jensen out:
224588eea45cSKlaus Jensen     nvme_rw_complete_cb(req, ret);
224688eea45cSKlaus Jensen }
224788eea45cSKlaus Jensen 
nvme_verify_cb(void * opaque,int ret)224888eea45cSKlaus Jensen static void nvme_verify_cb(void *opaque, int ret)
224988eea45cSKlaus Jensen {
225088eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
225188eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
225288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
225388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
225488eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
225588eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
225688eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
225788eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
22582a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
225988eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
226088eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
226144219b60SNaveen Nagar     uint64_t reftag = le32_to_cpu(rw->reftag);
226244219b60SNaveen Nagar     uint64_t cdw3 = le32_to_cpu(rw->cdw3);
226388eea45cSKlaus Jensen     uint16_t status;
226488eea45cSKlaus Jensen 
226544219b60SNaveen Nagar     reftag |= cdw3 << 32;
226644219b60SNaveen Nagar 
22672a132309SKlaus Jensen     trace_pci_nvme_verify_cb(nvme_cid(req), prinfo, apptag, appmask, reftag);
226888eea45cSKlaus Jensen 
226988eea45cSKlaus Jensen     if (ret) {
227088eea45cSKlaus Jensen         block_acct_failed(stats, acct);
227188eea45cSKlaus Jensen         nvme_aio_err(req, ret);
227288eea45cSKlaus Jensen         goto out;
227388eea45cSKlaus Jensen     }
227488eea45cSKlaus Jensen 
227588eea45cSKlaus Jensen     block_acct_done(stats, acct);
227688eea45cSKlaus Jensen 
227788eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
227888eea45cSKlaus Jensen         status = nvme_dif_mangle_mdata(ns, ctx->mdata.bounce,
227988eea45cSKlaus Jensen                                        ctx->mdata.iov.size, slba);
228088eea45cSKlaus Jensen         if (status) {
228188eea45cSKlaus Jensen             req->status = status;
228288eea45cSKlaus Jensen             goto out;
228388eea45cSKlaus Jensen         }
228488eea45cSKlaus Jensen 
228588eea45cSKlaus Jensen         req->status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
228688eea45cSKlaus Jensen                                      ctx->mdata.bounce, ctx->mdata.iov.size,
22872a132309SKlaus Jensen                                      prinfo, slba, apptag, appmask, &reftag);
228888eea45cSKlaus Jensen     }
228988eea45cSKlaus Jensen 
229088eea45cSKlaus Jensen out:
229188eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
229288eea45cSKlaus Jensen     g_free(ctx->data.bounce);
229388eea45cSKlaus Jensen 
229488eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
229588eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
229688eea45cSKlaus Jensen 
229788eea45cSKlaus Jensen     g_free(ctx);
229888eea45cSKlaus Jensen 
229988eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
230088eea45cSKlaus Jensen }
230188eea45cSKlaus Jensen 
230288eea45cSKlaus Jensen 
nvme_verify_mdata_in_cb(void * opaque,int ret)230388eea45cSKlaus Jensen static void nvme_verify_mdata_in_cb(void *opaque, int ret)
230488eea45cSKlaus Jensen {
230588eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
230688eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
230788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
230888eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
230988eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
231088eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
231188eea45cSKlaus Jensen     size_t mlen = nvme_m2b(ns, nlb);
231288eea45cSKlaus Jensen     uint64_t offset = nvme_moff(ns, slba);
231388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
231488eea45cSKlaus Jensen 
231588eea45cSKlaus Jensen     trace_pci_nvme_verify_mdata_in_cb(nvme_cid(req), blk_name(blk));
231688eea45cSKlaus Jensen 
231788eea45cSKlaus Jensen     if (ret) {
231888eea45cSKlaus Jensen         goto out;
231988eea45cSKlaus Jensen     }
232088eea45cSKlaus Jensen 
232188eea45cSKlaus Jensen     ctx->mdata.bounce = g_malloc(mlen);
232288eea45cSKlaus Jensen 
232388eea45cSKlaus Jensen     qemu_iovec_reset(&ctx->mdata.iov);
232488eea45cSKlaus Jensen     qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
232588eea45cSKlaus Jensen 
232688eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
232788eea45cSKlaus Jensen                                 nvme_verify_cb, ctx);
232888eea45cSKlaus Jensen     return;
232988eea45cSKlaus Jensen 
233088eea45cSKlaus Jensen out:
233188eea45cSKlaus Jensen     nvme_verify_cb(ctx, ret);
233288eea45cSKlaus Jensen }
233388eea45cSKlaus Jensen 
233488eea45cSKlaus Jensen struct nvme_compare_ctx {
233588eea45cSKlaus Jensen     struct {
233688eea45cSKlaus Jensen         QEMUIOVector iov;
233788eea45cSKlaus Jensen         uint8_t *bounce;
233888eea45cSKlaus Jensen     } data;
233988eea45cSKlaus Jensen 
234088eea45cSKlaus Jensen     struct {
234188eea45cSKlaus Jensen         QEMUIOVector iov;
234288eea45cSKlaus Jensen         uint8_t *bounce;
234388eea45cSKlaus Jensen     } mdata;
234488eea45cSKlaus Jensen };
234588eea45cSKlaus Jensen 
nvme_compare_mdata_cb(void * opaque,int ret)234688eea45cSKlaus Jensen static void nvme_compare_mdata_cb(void *opaque, int ret)
234788eea45cSKlaus Jensen {
234888eea45cSKlaus Jensen     NvmeRequest *req = opaque;
234988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
235088eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
235188eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
23522a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
235388eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
235488eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
235544219b60SNaveen Nagar     uint64_t reftag = le32_to_cpu(rw->reftag);
235644219b60SNaveen Nagar     uint64_t cdw3 = le32_to_cpu(rw->cdw3);
235788eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
235888eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
235988eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
236088eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
236188eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
236288eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
236388eea45cSKlaus Jensen 
236444219b60SNaveen Nagar     reftag |= cdw3 << 32;
236544219b60SNaveen Nagar 
236688eea45cSKlaus Jensen     trace_pci_nvme_compare_mdata_cb(nvme_cid(req));
236788eea45cSKlaus Jensen 
236888eea45cSKlaus Jensen     if (ret) {
236988eea45cSKlaus Jensen         block_acct_failed(stats, acct);
237088eea45cSKlaus Jensen         nvme_aio_err(req, ret);
237188eea45cSKlaus Jensen         goto out;
237288eea45cSKlaus Jensen     }
237388eea45cSKlaus Jensen 
237488eea45cSKlaus Jensen     buf = g_malloc(ctx->mdata.iov.size);
237588eea45cSKlaus Jensen 
237688eea45cSKlaus Jensen     status = nvme_bounce_mdata(n, buf, ctx->mdata.iov.size,
237788eea45cSKlaus Jensen                                NVME_TX_DIRECTION_TO_DEVICE, req);
237888eea45cSKlaus Jensen     if (status) {
237988eea45cSKlaus Jensen         req->status = status;
238088eea45cSKlaus Jensen         goto out;
238188eea45cSKlaus Jensen     }
238288eea45cSKlaus Jensen 
238388eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
238488eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
238588eea45cSKlaus Jensen         uint8_t *bufp;
238688eea45cSKlaus Jensen         uint8_t *mbufp = ctx->mdata.bounce;
238788eea45cSKlaus Jensen         uint8_t *end = mbufp + ctx->mdata.iov.size;
238888eea45cSKlaus Jensen         int16_t pil = 0;
238988eea45cSKlaus Jensen 
239088eea45cSKlaus Jensen         status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
23912a132309SKlaus Jensen                                 ctx->mdata.bounce, ctx->mdata.iov.size, prinfo,
23920ca5c3ccSKlaus Jensen                                 slba, apptag, appmask, &reftag);
239388eea45cSKlaus Jensen         if (status) {
239488eea45cSKlaus Jensen             req->status = status;
239588eea45cSKlaus Jensen             goto out;
239688eea45cSKlaus Jensen         }
239788eea45cSKlaus Jensen 
239888eea45cSKlaus Jensen         /*
239988eea45cSKlaus Jensen          * When formatted with protection information, do not compare the DIF
240088eea45cSKlaus Jensen          * tuple.
240188eea45cSKlaus Jensen          */
240288eea45cSKlaus Jensen         if (!(ns->id_ns.dps & NVME_ID_NS_DPS_FIRST_EIGHT)) {
2403ac0b34c5SKlaus Jensen             pil = ns->lbaf.ms - nvme_pi_tuple_size(ns);
240488eea45cSKlaus Jensen         }
240588eea45cSKlaus Jensen 
240688eea45cSKlaus Jensen         for (bufp = buf; mbufp < end; bufp += ns->lbaf.ms, mbufp += ns->lbaf.ms) {
240788eea45cSKlaus Jensen             if (memcmp(bufp + pil, mbufp + pil, ns->lbaf.ms - pil)) {
2408ca2a0918SKlaus Jensen                 req->status = NVME_CMP_FAILURE | NVME_DNR;
240988eea45cSKlaus Jensen                 goto out;
241088eea45cSKlaus Jensen             }
241188eea45cSKlaus Jensen         }
241288eea45cSKlaus Jensen 
241388eea45cSKlaus Jensen         goto out;
241488eea45cSKlaus Jensen     }
241588eea45cSKlaus Jensen 
241688eea45cSKlaus Jensen     if (memcmp(buf, ctx->mdata.bounce, ctx->mdata.iov.size)) {
2417ca2a0918SKlaus Jensen         req->status = NVME_CMP_FAILURE | NVME_DNR;
241888eea45cSKlaus Jensen         goto out;
241988eea45cSKlaus Jensen     }
242088eea45cSKlaus Jensen 
242188eea45cSKlaus Jensen     block_acct_done(stats, acct);
242288eea45cSKlaus Jensen 
242388eea45cSKlaus Jensen out:
242488eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
242588eea45cSKlaus Jensen     g_free(ctx->data.bounce);
242688eea45cSKlaus Jensen 
242788eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
242888eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
242988eea45cSKlaus Jensen 
243088eea45cSKlaus Jensen     g_free(ctx);
243188eea45cSKlaus Jensen 
243288eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
243388eea45cSKlaus Jensen }
243488eea45cSKlaus Jensen 
nvme_compare_data_cb(void * opaque,int ret)243588eea45cSKlaus Jensen static void nvme_compare_data_cb(void *opaque, int ret)
243688eea45cSKlaus Jensen {
243788eea45cSKlaus Jensen     NvmeRequest *req = opaque;
243888eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
243988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
244088eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
244188eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
244288eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
244388eea45cSKlaus Jensen 
244488eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
244588eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
244688eea45cSKlaus Jensen     uint16_t status;
244788eea45cSKlaus Jensen 
244888eea45cSKlaus Jensen     trace_pci_nvme_compare_data_cb(nvme_cid(req));
244988eea45cSKlaus Jensen 
245088eea45cSKlaus Jensen     if (ret) {
245188eea45cSKlaus Jensen         block_acct_failed(stats, acct);
245288eea45cSKlaus Jensen         nvme_aio_err(req, ret);
245388eea45cSKlaus Jensen         goto out;
245488eea45cSKlaus Jensen     }
245588eea45cSKlaus Jensen 
245688eea45cSKlaus Jensen     buf = g_malloc(ctx->data.iov.size);
245788eea45cSKlaus Jensen 
245888eea45cSKlaus Jensen     status = nvme_bounce_data(n, buf, ctx->data.iov.size,
245988eea45cSKlaus Jensen                               NVME_TX_DIRECTION_TO_DEVICE, req);
246088eea45cSKlaus Jensen     if (status) {
246188eea45cSKlaus Jensen         req->status = status;
246288eea45cSKlaus Jensen         goto out;
246388eea45cSKlaus Jensen     }
246488eea45cSKlaus Jensen 
246588eea45cSKlaus Jensen     if (memcmp(buf, ctx->data.bounce, ctx->data.iov.size)) {
2466ca2a0918SKlaus Jensen         req->status = NVME_CMP_FAILURE | NVME_DNR;
246788eea45cSKlaus Jensen         goto out;
246888eea45cSKlaus Jensen     }
246988eea45cSKlaus Jensen 
247088eea45cSKlaus Jensen     if (ns->lbaf.ms) {
247188eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
247288eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
247388eea45cSKlaus Jensen         uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
247488eea45cSKlaus Jensen         size_t mlen = nvme_m2b(ns, nlb);
247588eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
247688eea45cSKlaus Jensen 
247788eea45cSKlaus Jensen         ctx->mdata.bounce = g_malloc(mlen);
247888eea45cSKlaus Jensen 
247988eea45cSKlaus Jensen         qemu_iovec_init(&ctx->mdata.iov, 1);
248088eea45cSKlaus Jensen         qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
248188eea45cSKlaus Jensen 
248288eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
248388eea45cSKlaus Jensen                                     nvme_compare_mdata_cb, req);
248488eea45cSKlaus Jensen         return;
248588eea45cSKlaus Jensen     }
248688eea45cSKlaus Jensen 
248788eea45cSKlaus Jensen     block_acct_done(stats, acct);
248888eea45cSKlaus Jensen 
248988eea45cSKlaus Jensen out:
249088eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
249188eea45cSKlaus Jensen     g_free(ctx->data.bounce);
249288eea45cSKlaus Jensen     g_free(ctx);
249388eea45cSKlaus Jensen 
249488eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
249588eea45cSKlaus Jensen }
249688eea45cSKlaus Jensen 
2497d7d1474fSKlaus Jensen typedef struct NvmeDSMAIOCB {
2498d7d1474fSKlaus Jensen     BlockAIOCB common;
2499d7d1474fSKlaus Jensen     BlockAIOCB *aiocb;
2500d7d1474fSKlaus Jensen     NvmeRequest *req;
2501d7d1474fSKlaus Jensen     int ret;
2502d7d1474fSKlaus Jensen 
2503d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2504d7d1474fSKlaus Jensen     unsigned int nr;
2505d7d1474fSKlaus Jensen     unsigned int idx;
2506d7d1474fSKlaus Jensen } NvmeDSMAIOCB;
2507d7d1474fSKlaus Jensen 
nvme_dsm_cancel(BlockAIOCB * aiocb)2508d7d1474fSKlaus Jensen static void nvme_dsm_cancel(BlockAIOCB *aiocb)
2509d7d1474fSKlaus Jensen {
2510d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = container_of(aiocb, NvmeDSMAIOCB, common);
2511d7d1474fSKlaus Jensen 
2512d7d1474fSKlaus Jensen     /* break nvme_dsm_cb loop */
2513d7d1474fSKlaus Jensen     iocb->idx = iocb->nr;
2514d7d1474fSKlaus Jensen     iocb->ret = -ECANCELED;
2515d7d1474fSKlaus Jensen 
2516d7d1474fSKlaus Jensen     if (iocb->aiocb) {
2517d7d1474fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2518d7d1474fSKlaus Jensen         iocb->aiocb = NULL;
2519d7d1474fSKlaus Jensen     } else {
2520d7d1474fSKlaus Jensen         /*
2521d7d1474fSKlaus Jensen          * We only reach this if nvme_dsm_cancel() has already been called or
2522818b9b8fSKlaus Jensen          * the command ran to completion.
2523d7d1474fSKlaus Jensen          */
2524d7d1474fSKlaus Jensen         assert(iocb->idx == iocb->nr);
2525d7d1474fSKlaus Jensen     }
2526d7d1474fSKlaus Jensen }
2527d7d1474fSKlaus Jensen 
2528d7d1474fSKlaus Jensen static const AIOCBInfo nvme_dsm_aiocb_info = {
2529d7d1474fSKlaus Jensen     .aiocb_size   = sizeof(NvmeDSMAIOCB),
2530d7d1474fSKlaus Jensen     .cancel_async = nvme_dsm_cancel,
2531d7d1474fSKlaus Jensen };
2532d7d1474fSKlaus Jensen 
2533d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret);
2534d7d1474fSKlaus Jensen 
nvme_dsm_md_cb(void * opaque,int ret)2535d7d1474fSKlaus Jensen static void nvme_dsm_md_cb(void *opaque, int ret)
2536d7d1474fSKlaus Jensen {
2537d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2538d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2539d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2540d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2541d7d1474fSKlaus Jensen     uint64_t slba;
2542d7d1474fSKlaus Jensen     uint32_t nlb;
2543d7d1474fSKlaus Jensen 
2544818b9b8fSKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
2545d7d1474fSKlaus Jensen         goto done;
2546d7d1474fSKlaus Jensen     }
2547d7d1474fSKlaus Jensen 
2548d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx - 1];
2549d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2550d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2551d7d1474fSKlaus Jensen 
2552d7d1474fSKlaus Jensen     /*
2553d7d1474fSKlaus Jensen      * Check that all block were discarded (zeroed); otherwise we do not zero
2554d7d1474fSKlaus Jensen      * the metadata.
2555d7d1474fSKlaus Jensen      */
2556d7d1474fSKlaus Jensen 
2557d7d1474fSKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_ZERO);
2558d7d1474fSKlaus Jensen     if (ret) {
2559d7d1474fSKlaus Jensen         if (ret < 0) {
2560d7d1474fSKlaus Jensen             goto done;
2561d7d1474fSKlaus Jensen         }
2562d7d1474fSKlaus Jensen 
2563d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
256451c45326SDmitry Tikhov         return;
2565d7d1474fSKlaus Jensen     }
2566d7d1474fSKlaus Jensen 
2567d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, nvme_moff(ns, slba),
2568d7d1474fSKlaus Jensen                                         nvme_m2b(ns, nlb), BDRV_REQ_MAY_UNMAP,
2569d7d1474fSKlaus Jensen                                         nvme_dsm_cb, iocb);
2570d7d1474fSKlaus Jensen     return;
2571d7d1474fSKlaus Jensen 
2572d7d1474fSKlaus Jensen done:
2573818b9b8fSKlaus Jensen     nvme_dsm_cb(iocb, ret);
2574d7d1474fSKlaus Jensen }
2575d7d1474fSKlaus Jensen 
nvme_dsm_cb(void * opaque,int ret)2576d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret)
2577d7d1474fSKlaus Jensen {
2578d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2579d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2580d7d1474fSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
2581d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2582d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2583d7d1474fSKlaus Jensen     uint64_t slba;
2584d7d1474fSKlaus Jensen     uint32_t nlb;
2585d7d1474fSKlaus Jensen 
2586818b9b8fSKlaus Jensen     if (iocb->ret < 0) {
2587818b9b8fSKlaus Jensen         goto done;
2588818b9b8fSKlaus Jensen     } else if (ret < 0) {
2589d7d1474fSKlaus Jensen         iocb->ret = ret;
2590d7d1474fSKlaus Jensen         goto done;
2591d7d1474fSKlaus Jensen     }
2592d7d1474fSKlaus Jensen 
2593d7d1474fSKlaus Jensen next:
2594d7d1474fSKlaus Jensen     if (iocb->idx == iocb->nr) {
2595d7d1474fSKlaus Jensen         goto done;
2596d7d1474fSKlaus Jensen     }
2597d7d1474fSKlaus Jensen 
2598d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx++];
2599d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2600d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2601d7d1474fSKlaus Jensen 
2602d7d1474fSKlaus Jensen     trace_pci_nvme_dsm_deallocate(slba, nlb);
2603d7d1474fSKlaus Jensen 
2604d7d1474fSKlaus Jensen     if (nlb > n->dmrsl) {
2605d7d1474fSKlaus Jensen         trace_pci_nvme_dsm_single_range_limit_exceeded(nlb, n->dmrsl);
2606d7d1474fSKlaus Jensen         goto next;
2607d7d1474fSKlaus Jensen     }
2608d7d1474fSKlaus Jensen 
2609d7d1474fSKlaus Jensen     if (nvme_check_bounds(ns, slba, nlb)) {
2610d7d1474fSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb,
2611d7d1474fSKlaus Jensen                                              ns->id_ns.nsze);
2612d7d1474fSKlaus Jensen         goto next;
2613d7d1474fSKlaus Jensen     }
2614d7d1474fSKlaus Jensen 
2615d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pdiscard(ns->blkconf.blk, nvme_l2b(ns, slba),
2616d7d1474fSKlaus Jensen                                    nvme_l2b(ns, nlb),
2617d7d1474fSKlaus Jensen                                    nvme_dsm_md_cb, iocb);
2618d7d1474fSKlaus Jensen     return;
2619d7d1474fSKlaus Jensen 
2620d7d1474fSKlaus Jensen done:
2621d7d1474fSKlaus Jensen     iocb->aiocb = NULL;
2622818b9b8fSKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2623c510fe78SZheyu Ma     g_free(iocb->range);
2624818b9b8fSKlaus Jensen     qemu_aio_unref(iocb);
2625d7d1474fSKlaus Jensen }
2626d7d1474fSKlaus Jensen 
nvme_dsm(NvmeCtrl * n,NvmeRequest * req)262788eea45cSKlaus Jensen static uint16_t nvme_dsm(NvmeCtrl *n, NvmeRequest *req)
262888eea45cSKlaus Jensen {
262988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
263088eea45cSKlaus Jensen     NvmeDsmCmd *dsm = (NvmeDsmCmd *) &req->cmd;
263188eea45cSKlaus Jensen     uint32_t attr = le32_to_cpu(dsm->attributes);
263288eea45cSKlaus Jensen     uint32_t nr = (le32_to_cpu(dsm->nr) & 0xff) + 1;
263388eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
263488eea45cSKlaus Jensen 
2635d7d1474fSKlaus Jensen     trace_pci_nvme_dsm(nr, attr);
263688eea45cSKlaus Jensen 
263788eea45cSKlaus Jensen     if (attr & NVME_DSMGMT_AD) {
2638d7d1474fSKlaus Jensen         NvmeDSMAIOCB *iocb = blk_aio_get(&nvme_dsm_aiocb_info, ns->blkconf.blk,
2639d7d1474fSKlaus Jensen                                          nvme_misc_cb, req);
264088eea45cSKlaus Jensen 
2641d7d1474fSKlaus Jensen         iocb->req = req;
2642d7d1474fSKlaus Jensen         iocb->ret = 0;
2643d7d1474fSKlaus Jensen         iocb->range = g_new(NvmeDsmRange, nr);
2644d7d1474fSKlaus Jensen         iocb->nr = nr;
2645d7d1474fSKlaus Jensen         iocb->idx = 0;
2646d7d1474fSKlaus Jensen 
2647d7d1474fSKlaus Jensen         status = nvme_h2c(n, (uint8_t *)iocb->range, sizeof(NvmeDsmRange) * nr,
2648d7d1474fSKlaus Jensen                           req);
264988eea45cSKlaus Jensen         if (status) {
26504b32319cSKlaus Jensen             g_free(iocb->range);
26514b32319cSKlaus Jensen             qemu_aio_unref(iocb);
26524b32319cSKlaus Jensen 
265388eea45cSKlaus Jensen             return status;
265488eea45cSKlaus Jensen         }
265588eea45cSKlaus Jensen 
2656d7d1474fSKlaus Jensen         req->aiocb = &iocb->common;
2657d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
265888eea45cSKlaus Jensen 
2659d7d1474fSKlaus Jensen         return NVME_NO_COMPLETE;
266088eea45cSKlaus Jensen     }
266188eea45cSKlaus Jensen 
266288eea45cSKlaus Jensen     return status;
266388eea45cSKlaus Jensen }
266488eea45cSKlaus Jensen 
nvme_verify(NvmeCtrl * n,NvmeRequest * req)266588eea45cSKlaus Jensen static uint16_t nvme_verify(NvmeCtrl *n, NvmeRequest *req)
266688eea45cSKlaus Jensen {
266788eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
266888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
266988eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
267088eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
267188eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
267288eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
2673a1ab6788SArun Kumar     size_t data_len = len;
267488eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
26752a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
267688eea45cSKlaus Jensen     uint32_t reftag = le32_to_cpu(rw->reftag);
267788eea45cSKlaus Jensen     NvmeBounceContext *ctx = NULL;
267888eea45cSKlaus Jensen     uint16_t status;
267988eea45cSKlaus Jensen 
268088eea45cSKlaus Jensen     trace_pci_nvme_verify(nvme_cid(req), nvme_nsid(ns), slba, nlb);
268188eea45cSKlaus Jensen 
268288eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
26832a132309SKlaus Jensen         status = nvme_check_prinfo(ns, prinfo, slba, reftag);
268488eea45cSKlaus Jensen         if (status) {
268588eea45cSKlaus Jensen             return status;
268688eea45cSKlaus Jensen         }
268788eea45cSKlaus Jensen 
26882a132309SKlaus Jensen         if (prinfo & NVME_PRINFO_PRACT) {
268988eea45cSKlaus Jensen             return NVME_INVALID_PROT_INFO | NVME_DNR;
269088eea45cSKlaus Jensen         }
269188eea45cSKlaus Jensen     }
269288eea45cSKlaus Jensen 
2693a1ab6788SArun Kumar     if (nvme_ns_ext(ns) && !(NVME_ID_CTRL_CTRATT_MEM(n->id_ctrl.ctratt))) {
2694a1ab6788SArun Kumar         data_len += nvme_m2b(ns, nlb);
2695a1ab6788SArun Kumar     }
2696a1ab6788SArun Kumar 
2697a1ab6788SArun Kumar     if (data_len > (n->page_size << n->params.vsl)) {
269888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
269988eea45cSKlaus Jensen     }
270088eea45cSKlaus Jensen 
270188eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
270288eea45cSKlaus Jensen     if (status) {
270388eea45cSKlaus Jensen         return status;
270488eea45cSKlaus Jensen     }
270588eea45cSKlaus Jensen 
270688eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
270788eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
270888eea45cSKlaus Jensen         if (status) {
270988eea45cSKlaus Jensen             return status;
271088eea45cSKlaus Jensen         }
271188eea45cSKlaus Jensen     }
271288eea45cSKlaus Jensen 
271388eea45cSKlaus Jensen     ctx = g_new0(NvmeBounceContext, 1);
271488eea45cSKlaus Jensen     ctx->req = req;
271588eea45cSKlaus Jensen 
271688eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(len);
271788eea45cSKlaus Jensen 
271888eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
271988eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, len);
272088eea45cSKlaus Jensen 
272188eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, ctx->data.iov.size,
272288eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
272388eea45cSKlaus Jensen 
272488eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(ns->blkconf.blk, offset, &ctx->data.iov, 0,
272588eea45cSKlaus Jensen                                 nvme_verify_mdata_in_cb, ctx);
272688eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
272788eea45cSKlaus Jensen }
272888eea45cSKlaus Jensen 
2729796d2068SKlaus Jensen typedef struct NvmeCopyAIOCB {
2730796d2068SKlaus Jensen     BlockAIOCB common;
2731796d2068SKlaus Jensen     BlockAIOCB *aiocb;
2732796d2068SKlaus Jensen     NvmeRequest *req;
2733d522aef8SArun Kumar     NvmeCtrl *n;
2734796d2068SKlaus Jensen     int ret;
2735796d2068SKlaus Jensen 
273644219b60SNaveen Nagar     void *ranges;
273744219b60SNaveen Nagar     unsigned int format;
2738796d2068SKlaus Jensen     int nr;
2739796d2068SKlaus Jensen     int idx;
2740796d2068SKlaus Jensen 
2741796d2068SKlaus Jensen     uint8_t *bounce;
2742796d2068SKlaus Jensen     QEMUIOVector iov;
2743796d2068SKlaus Jensen     struct {
2744796d2068SKlaus Jensen         BlockAcctCookie read;
2745796d2068SKlaus Jensen         BlockAcctCookie write;
2746796d2068SKlaus Jensen     } acct;
2747796d2068SKlaus Jensen 
274844219b60SNaveen Nagar     uint64_t reftag;
2749796d2068SKlaus Jensen     uint64_t slba;
2750796d2068SKlaus Jensen 
2751796d2068SKlaus Jensen     NvmeZone *zone;
2752d522aef8SArun Kumar     NvmeNamespace *sns;
2753d522aef8SArun Kumar     uint32_t tcl;
2754796d2068SKlaus Jensen } NvmeCopyAIOCB;
2755796d2068SKlaus Jensen 
nvme_copy_cancel(BlockAIOCB * aiocb)2756796d2068SKlaus Jensen static void nvme_copy_cancel(BlockAIOCB *aiocb)
275788eea45cSKlaus Jensen {
2758796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = container_of(aiocb, NvmeCopyAIOCB, common);
2759796d2068SKlaus Jensen 
2760796d2068SKlaus Jensen     iocb->ret = -ECANCELED;
2761796d2068SKlaus Jensen 
2762796d2068SKlaus Jensen     if (iocb->aiocb) {
2763796d2068SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2764796d2068SKlaus Jensen         iocb->aiocb = NULL;
2765796d2068SKlaus Jensen     }
2766796d2068SKlaus Jensen }
2767796d2068SKlaus Jensen 
2768796d2068SKlaus Jensen static const AIOCBInfo nvme_copy_aiocb_info = {
2769796d2068SKlaus Jensen     .aiocb_size   = sizeof(NvmeCopyAIOCB),
2770796d2068SKlaus Jensen     .cancel_async = nvme_copy_cancel,
2771796d2068SKlaus Jensen };
2772796d2068SKlaus Jensen 
nvme_copy_done(NvmeCopyAIOCB * iocb)277383f56ac3SKlaus Jensen static void nvme_copy_done(NvmeCopyAIOCB *iocb)
2774796d2068SKlaus Jensen {
2775796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
277688eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
2777796d2068SKlaus Jensen     BlockAcctStats *stats = blk_get_stats(ns->blkconf.blk);
2778796d2068SKlaus Jensen 
2779796d2068SKlaus Jensen     if (iocb->idx != iocb->nr) {
2780796d2068SKlaus Jensen         req->cqe.result = cpu_to_le32(iocb->idx);
2781796d2068SKlaus Jensen     }
2782796d2068SKlaus Jensen 
2783796d2068SKlaus Jensen     qemu_iovec_destroy(&iocb->iov);
2784796d2068SKlaus Jensen     g_free(iocb->bounce);
2785796d2068SKlaus Jensen 
2786796d2068SKlaus Jensen     if (iocb->ret < 0) {
2787796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.read);
2788796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.write);
2789796d2068SKlaus Jensen     } else {
2790796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.read);
2791796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.write);
2792796d2068SKlaus Jensen     }
2793796d2068SKlaus Jensen 
2794796d2068SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2795796d2068SKlaus Jensen     qemu_aio_unref(iocb);
2796796d2068SKlaus Jensen }
2797796d2068SKlaus Jensen 
279883f56ac3SKlaus Jensen static void nvme_do_copy(NvmeCopyAIOCB *iocb);
2799796d2068SKlaus Jensen 
nvme_copy_source_range_parse_format0_2(void * ranges,int idx,uint64_t * slba,uint32_t * nlb,uint32_t * snsid,uint16_t * apptag,uint16_t * appmask,uint64_t * reftag)2800d522aef8SArun Kumar static void nvme_copy_source_range_parse_format0_2(void *ranges,
2801d522aef8SArun Kumar                                                    int idx, uint64_t *slba,
2802d522aef8SArun Kumar                                                    uint32_t *nlb,
2803d522aef8SArun Kumar                                                    uint32_t *snsid,
280444219b60SNaveen Nagar                                                    uint16_t *apptag,
280544219b60SNaveen Nagar                                                    uint16_t *appmask,
280644219b60SNaveen Nagar                                                    uint64_t *reftag)
280744219b60SNaveen Nagar {
2808d522aef8SArun Kumar     NvmeCopySourceRangeFormat0_2 *_ranges = ranges;
2809d522aef8SArun Kumar 
2810d522aef8SArun Kumar     if (snsid) {
2811d522aef8SArun Kumar         *snsid = le32_to_cpu(_ranges[idx].sparams);
2812d522aef8SArun Kumar     }
281344219b60SNaveen Nagar 
281444219b60SNaveen Nagar     if (slba) {
281544219b60SNaveen Nagar         *slba = le64_to_cpu(_ranges[idx].slba);
281644219b60SNaveen Nagar     }
281744219b60SNaveen Nagar 
281844219b60SNaveen Nagar     if (nlb) {
281944219b60SNaveen Nagar         *nlb = le16_to_cpu(_ranges[idx].nlb) + 1;
282044219b60SNaveen Nagar     }
282144219b60SNaveen Nagar 
282244219b60SNaveen Nagar     if (apptag) {
282344219b60SNaveen Nagar         *apptag = le16_to_cpu(_ranges[idx].apptag);
282444219b60SNaveen Nagar     }
282544219b60SNaveen Nagar 
282644219b60SNaveen Nagar     if (appmask) {
282744219b60SNaveen Nagar         *appmask = le16_to_cpu(_ranges[idx].appmask);
282844219b60SNaveen Nagar     }
282944219b60SNaveen Nagar 
283044219b60SNaveen Nagar     if (reftag) {
283144219b60SNaveen Nagar         *reftag = le32_to_cpu(_ranges[idx].reftag);
283244219b60SNaveen Nagar     }
283344219b60SNaveen Nagar }
283444219b60SNaveen Nagar 
nvme_copy_source_range_parse_format1_3(void * ranges,int idx,uint64_t * slba,uint32_t * nlb,uint32_t * snsid,uint16_t * apptag,uint16_t * appmask,uint64_t * reftag)2835d522aef8SArun Kumar static void nvme_copy_source_range_parse_format1_3(void *ranges, int idx,
2836d522aef8SArun Kumar                                                    uint64_t *slba,
2837d522aef8SArun Kumar                                                    uint32_t *nlb,
2838d522aef8SArun Kumar                                                    uint32_t *snsid,
283944219b60SNaveen Nagar                                                    uint16_t *apptag,
284044219b60SNaveen Nagar                                                    uint16_t *appmask,
284144219b60SNaveen Nagar                                                    uint64_t *reftag)
284244219b60SNaveen Nagar {
2843d522aef8SArun Kumar     NvmeCopySourceRangeFormat1_3 *_ranges = ranges;
2844d522aef8SArun Kumar 
2845d522aef8SArun Kumar     if (snsid) {
2846d522aef8SArun Kumar         *snsid = le32_to_cpu(_ranges[idx].sparams);
2847d522aef8SArun Kumar     }
284844219b60SNaveen Nagar 
284944219b60SNaveen Nagar     if (slba) {
285044219b60SNaveen Nagar         *slba = le64_to_cpu(_ranges[idx].slba);
285144219b60SNaveen Nagar     }
285244219b60SNaveen Nagar 
285344219b60SNaveen Nagar     if (nlb) {
285444219b60SNaveen Nagar         *nlb = le16_to_cpu(_ranges[idx].nlb) + 1;
285544219b60SNaveen Nagar     }
285644219b60SNaveen Nagar 
285744219b60SNaveen Nagar     if (apptag) {
285844219b60SNaveen Nagar         *apptag = le16_to_cpu(_ranges[idx].apptag);
285944219b60SNaveen Nagar     }
286044219b60SNaveen Nagar 
286144219b60SNaveen Nagar     if (appmask) {
286244219b60SNaveen Nagar         *appmask = le16_to_cpu(_ranges[idx].appmask);
286344219b60SNaveen Nagar     }
286444219b60SNaveen Nagar 
286544219b60SNaveen Nagar     if (reftag) {
286644219b60SNaveen Nagar         *reftag = 0;
286744219b60SNaveen Nagar 
286844219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[4] << 40;
286944219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[5] << 32;
287044219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[6] << 24;
287144219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[7] << 16;
287244219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[8] << 8;
287344219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[9];
287444219b60SNaveen Nagar     }
287544219b60SNaveen Nagar }
287644219b60SNaveen Nagar 
nvme_copy_source_range_parse(void * ranges,int idx,uint8_t format,uint64_t * slba,uint32_t * nlb,uint32_t * snsid,uint16_t * apptag,uint16_t * appmask,uint64_t * reftag)287744219b60SNaveen Nagar static void nvme_copy_source_range_parse(void *ranges, int idx, uint8_t format,
287844219b60SNaveen Nagar                                          uint64_t *slba, uint32_t *nlb,
2879d522aef8SArun Kumar                                          uint32_t *snsid, uint16_t *apptag,
2880d522aef8SArun Kumar                                          uint16_t *appmask, uint64_t *reftag)
288144219b60SNaveen Nagar {
288244219b60SNaveen Nagar     switch (format) {
288344219b60SNaveen Nagar     case NVME_COPY_FORMAT_0:
2884d522aef8SArun Kumar     case NVME_COPY_FORMAT_2:
2885d522aef8SArun Kumar         nvme_copy_source_range_parse_format0_2(ranges, idx, slba, nlb, snsid,
2886d522aef8SArun Kumar                                                apptag, appmask, reftag);
288744219b60SNaveen Nagar         break;
288844219b60SNaveen Nagar 
288944219b60SNaveen Nagar     case NVME_COPY_FORMAT_1:
2890d522aef8SArun Kumar     case NVME_COPY_FORMAT_3:
2891d522aef8SArun Kumar         nvme_copy_source_range_parse_format1_3(ranges, idx, slba, nlb, snsid,
2892d522aef8SArun Kumar                                                apptag, appmask, reftag);
289344219b60SNaveen Nagar         break;
289444219b60SNaveen Nagar 
289544219b60SNaveen Nagar     default:
289644219b60SNaveen Nagar         abort();
289744219b60SNaveen Nagar     }
289844219b60SNaveen Nagar }
289944219b60SNaveen Nagar 
nvme_check_copy_mcl(NvmeNamespace * ns,NvmeCopyAIOCB * iocb,uint16_t nr)2900381ab99dSMinwoo Im static inline uint16_t nvme_check_copy_mcl(NvmeNamespace *ns,
2901381ab99dSMinwoo Im                                            NvmeCopyAIOCB *iocb, uint16_t nr)
2902381ab99dSMinwoo Im {
2903381ab99dSMinwoo Im     uint32_t copy_len = 0;
2904381ab99dSMinwoo Im 
2905381ab99dSMinwoo Im     for (int idx = 0; idx < nr; idx++) {
2906381ab99dSMinwoo Im         uint32_t nlb;
2907381ab99dSMinwoo Im         nvme_copy_source_range_parse(iocb->ranges, idx, iocb->format, NULL,
2908d522aef8SArun Kumar                                      &nlb, NULL, NULL, NULL, NULL);
29098c78015aSKlaus Jensen         copy_len += nlb;
2910381ab99dSMinwoo Im     }
2911d522aef8SArun Kumar     iocb->tcl = copy_len;
2912381ab99dSMinwoo Im     if (copy_len > ns->id_ns.mcl) {
2913381ab99dSMinwoo Im         return NVME_CMD_SIZE_LIMIT | NVME_DNR;
2914381ab99dSMinwoo Im     }
2915381ab99dSMinwoo Im 
2916381ab99dSMinwoo Im     return NVME_SUCCESS;
2917381ab99dSMinwoo Im }
2918381ab99dSMinwoo Im 
nvme_copy_out_completed_cb(void * opaque,int ret)2919796d2068SKlaus Jensen static void nvme_copy_out_completed_cb(void *opaque, int ret)
2920796d2068SKlaus Jensen {
2921796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2922796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2923d522aef8SArun Kumar     NvmeNamespace *dns = req->ns;
292444219b60SNaveen Nagar     uint32_t nlb;
292544219b60SNaveen Nagar 
292644219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, NULL,
2927d522aef8SArun Kumar                                  &nlb, NULL, NULL, NULL, NULL);
2928796d2068SKlaus Jensen 
2929796d2068SKlaus Jensen     if (ret < 0) {
2930796d2068SKlaus Jensen         iocb->ret = ret;
2931796d2068SKlaus Jensen         goto out;
2932796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2933796d2068SKlaus Jensen         goto out;
2934796d2068SKlaus Jensen     }
2935796d2068SKlaus Jensen 
2936d522aef8SArun Kumar     if (dns->params.zoned) {
2937d522aef8SArun Kumar         nvme_advance_zone_wp(dns, iocb->zone, nlb);
2938796d2068SKlaus Jensen     }
2939796d2068SKlaus Jensen 
2940796d2068SKlaus Jensen     iocb->idx++;
2941796d2068SKlaus Jensen     iocb->slba += nlb;
2942796d2068SKlaus Jensen out:
294383f56ac3SKlaus Jensen     nvme_do_copy(iocb);
2944796d2068SKlaus Jensen }
2945796d2068SKlaus Jensen 
nvme_copy_out_cb(void * opaque,int ret)2946796d2068SKlaus Jensen static void nvme_copy_out_cb(void *opaque, int ret)
2947796d2068SKlaus Jensen {
2948796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2949796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2950d522aef8SArun Kumar     NvmeNamespace *dns = req->ns;
2951796d2068SKlaus Jensen     uint32_t nlb;
2952796d2068SKlaus Jensen     size_t mlen;
2953796d2068SKlaus Jensen     uint8_t *mbounce;
2954796d2068SKlaus Jensen 
2955d522aef8SArun Kumar     if (ret < 0 || iocb->ret < 0 || !dns->lbaf.ms) {
2956796d2068SKlaus Jensen         goto out;
2957796d2068SKlaus Jensen     }
2958796d2068SKlaus Jensen 
295944219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, NULL,
2960d522aef8SArun Kumar                                  &nlb, NULL, NULL, NULL, NULL);
2961796d2068SKlaus Jensen 
2962d522aef8SArun Kumar     mlen = nvme_m2b(dns, nlb);
2963d522aef8SArun Kumar     mbounce = iocb->bounce + nvme_l2b(dns, nlb);
2964796d2068SKlaus Jensen 
2965796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2966796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, mbounce, mlen);
2967796d2068SKlaus Jensen 
2968d522aef8SArun Kumar     iocb->aiocb = blk_aio_pwritev(dns->blkconf.blk, nvme_moff(dns, iocb->slba),
2969796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_completed_cb,
2970796d2068SKlaus Jensen                                   iocb);
2971796d2068SKlaus Jensen 
2972796d2068SKlaus Jensen     return;
2973796d2068SKlaus Jensen 
2974796d2068SKlaus Jensen out:
297583f56ac3SKlaus Jensen     nvme_copy_out_completed_cb(iocb, ret);
2976796d2068SKlaus Jensen }
2977796d2068SKlaus Jensen 
nvme_copy_in_completed_cb(void * opaque,int ret)2978796d2068SKlaus Jensen static void nvme_copy_in_completed_cb(void *opaque, int ret)
2979796d2068SKlaus Jensen {
2980796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2981796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2982d522aef8SArun Kumar     NvmeNamespace *sns = iocb->sns;
2983d522aef8SArun Kumar     NvmeNamespace *dns = req->ns;
2984d522aef8SArun Kumar     NvmeCopyCmd *copy = NULL;
2985d522aef8SArun Kumar     uint8_t *mbounce = NULL;
2986796d2068SKlaus Jensen     uint32_t nlb;
298744219b60SNaveen Nagar     uint64_t slba;
298844219b60SNaveen Nagar     uint16_t apptag, appmask;
298944219b60SNaveen Nagar     uint64_t reftag;
2990d522aef8SArun Kumar     size_t len, mlen;
2991796d2068SKlaus Jensen     uint16_t status;
2992796d2068SKlaus Jensen 
2993796d2068SKlaus Jensen     if (ret < 0) {
2994796d2068SKlaus Jensen         iocb->ret = ret;
2995796d2068SKlaus Jensen         goto out;
2996796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2997796d2068SKlaus Jensen         goto out;
2998796d2068SKlaus Jensen     }
2999796d2068SKlaus Jensen 
300044219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
3001d522aef8SArun Kumar                                  &nlb, NULL, &apptag, &appmask, &reftag);
3002796d2068SKlaus Jensen 
3003796d2068SKlaus Jensen     trace_pci_nvme_copy_out(iocb->slba, nlb);
3004796d2068SKlaus Jensen 
3005d522aef8SArun Kumar     len = nvme_l2b(sns, nlb);
3006d522aef8SArun Kumar 
3007d522aef8SArun Kumar     if (NVME_ID_NS_DPS_TYPE(sns->id_ns.dps)) {
3008d522aef8SArun Kumar         copy = (NvmeCopyCmd *)&req->cmd;
300988eea45cSKlaus Jensen 
3010796d2068SKlaus Jensen         uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
301188eea45cSKlaus Jensen 
3012d522aef8SArun Kumar         mlen = nvme_m2b(sns, nlb);
3013d522aef8SArun Kumar         mbounce = iocb->bounce + nvme_l2b(sns, nlb);
3014796d2068SKlaus Jensen 
3015d522aef8SArun Kumar         status = nvme_dif_mangle_mdata(sns, mbounce, mlen, slba);
30162e8f952aSDmitry Tikhov         if (status) {
30172e8f952aSDmitry Tikhov             goto invalid;
30182e8f952aSDmitry Tikhov         }
3019d522aef8SArun Kumar         status = nvme_dif_check(sns, iocb->bounce, len, mbounce, mlen, prinfor,
3020796d2068SKlaus Jensen                                 slba, apptag, appmask, &reftag);
3021796d2068SKlaus Jensen         if (status) {
3022796d2068SKlaus Jensen             goto invalid;
3023796d2068SKlaus Jensen         }
3024d522aef8SArun Kumar     }
3025d522aef8SArun Kumar 
3026d522aef8SArun Kumar     if (NVME_ID_NS_DPS_TYPE(dns->id_ns.dps)) {
3027d522aef8SArun Kumar         copy = (NvmeCopyCmd *)&req->cmd;
3028d522aef8SArun Kumar         uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
3029d522aef8SArun Kumar 
3030d522aef8SArun Kumar         mlen = nvme_m2b(dns, nlb);
3031d522aef8SArun Kumar         mbounce = iocb->bounce + nvme_l2b(dns, nlb);
3032796d2068SKlaus Jensen 
3033796d2068SKlaus Jensen         apptag = le16_to_cpu(copy->apptag);
3034796d2068SKlaus Jensen         appmask = le16_to_cpu(copy->appmask);
3035796d2068SKlaus Jensen 
3036796d2068SKlaus Jensen         if (prinfow & NVME_PRINFO_PRACT) {
3037d522aef8SArun Kumar             status = nvme_check_prinfo(dns, prinfow, iocb->slba, iocb->reftag);
3038796d2068SKlaus Jensen             if (status) {
3039796d2068SKlaus Jensen                 goto invalid;
3040796d2068SKlaus Jensen             }
3041796d2068SKlaus Jensen 
3042d522aef8SArun Kumar             nvme_dif_pract_generate_dif(dns, iocb->bounce, len, mbounce, mlen,
3043796d2068SKlaus Jensen                                         apptag, &iocb->reftag);
3044796d2068SKlaus Jensen         } else {
3045d522aef8SArun Kumar             status = nvme_dif_check(dns, iocb->bounce, len, mbounce, mlen,
3046796d2068SKlaus Jensen                                     prinfow, iocb->slba, apptag, appmask,
3047796d2068SKlaus Jensen                                     &iocb->reftag);
3048796d2068SKlaus Jensen             if (status) {
3049796d2068SKlaus Jensen                 goto invalid;
3050796d2068SKlaus Jensen             }
3051796d2068SKlaus Jensen         }
3052796d2068SKlaus Jensen     }
3053796d2068SKlaus Jensen 
3054d522aef8SArun Kumar     status = nvme_check_bounds(dns, iocb->slba, nlb);
3055796d2068SKlaus Jensen     if (status) {
3056796d2068SKlaus Jensen         goto invalid;
3057796d2068SKlaus Jensen     }
3058796d2068SKlaus Jensen 
3059d522aef8SArun Kumar     if (dns->params.zoned) {
3060d522aef8SArun Kumar         status = nvme_check_zone_write(dns, iocb->zone, iocb->slba, nlb);
3061796d2068SKlaus Jensen         if (status) {
3062796d2068SKlaus Jensen             goto invalid;
3063796d2068SKlaus Jensen         }
3064796d2068SKlaus Jensen 
3065e321b4cdSKlaus Jensen         if (!(iocb->zone->d.za & NVME_ZA_ZRWA_VALID)) {
3066796d2068SKlaus Jensen             iocb->zone->w_ptr += nlb;
3067796d2068SKlaus Jensen         }
3068e321b4cdSKlaus Jensen     }
3069796d2068SKlaus Jensen 
3070796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
3071796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
3072796d2068SKlaus Jensen 
3073d522aef8SArun Kumar     block_acct_start(blk_get_stats(dns->blkconf.blk), &iocb->acct.write, 0,
3074d522aef8SArun Kumar                      BLOCK_ACCT_WRITE);
3075d522aef8SArun Kumar 
3076d522aef8SArun Kumar     iocb->aiocb = blk_aio_pwritev(dns->blkconf.blk, nvme_l2b(dns, iocb->slba),
3077796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_cb, iocb);
3078796d2068SKlaus Jensen 
3079796d2068SKlaus Jensen     return;
3080796d2068SKlaus Jensen 
3081796d2068SKlaus Jensen invalid:
3082796d2068SKlaus Jensen     req->status = status;
308383f56ac3SKlaus Jensen     iocb->ret = -1;
3084796d2068SKlaus Jensen out:
308583f56ac3SKlaus Jensen     nvme_do_copy(iocb);
3086796d2068SKlaus Jensen }
3087796d2068SKlaus Jensen 
nvme_copy_in_cb(void * opaque,int ret)3088796d2068SKlaus Jensen static void nvme_copy_in_cb(void *opaque, int ret)
3089796d2068SKlaus Jensen {
3090796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
3091d522aef8SArun Kumar     NvmeNamespace *sns = iocb->sns;
3092796d2068SKlaus Jensen     uint64_t slba;
3093796d2068SKlaus Jensen     uint32_t nlb;
3094796d2068SKlaus Jensen 
3095d522aef8SArun Kumar     if (ret < 0 || iocb->ret < 0 || !sns->lbaf.ms) {
3096796d2068SKlaus Jensen         goto out;
3097796d2068SKlaus Jensen     }
3098796d2068SKlaus Jensen 
309944219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
3100d522aef8SArun Kumar                                  &nlb, NULL, NULL, NULL, NULL);
3101796d2068SKlaus Jensen 
3102796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
3103d522aef8SArun Kumar     qemu_iovec_add(&iocb->iov, iocb->bounce + nvme_l2b(sns, nlb),
3104d522aef8SArun Kumar                    nvme_m2b(sns, nlb));
3105796d2068SKlaus Jensen 
3106d522aef8SArun Kumar     iocb->aiocb = blk_aio_preadv(sns->blkconf.blk, nvme_moff(sns, slba),
3107796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_completed_cb,
3108796d2068SKlaus Jensen                                  iocb);
3109796d2068SKlaus Jensen     return;
3110796d2068SKlaus Jensen 
3111796d2068SKlaus Jensen out:
311283f56ac3SKlaus Jensen     nvme_copy_in_completed_cb(iocb, ret);
3113796d2068SKlaus Jensen }
3114796d2068SKlaus Jensen 
nvme_csi_supports_copy(uint8_t csi)3115d522aef8SArun Kumar static inline bool nvme_csi_supports_copy(uint8_t csi)
3116d522aef8SArun Kumar {
3117d522aef8SArun Kumar     return csi == NVME_CSI_NVM || csi == NVME_CSI_ZONED;
3118d522aef8SArun Kumar }
3119d522aef8SArun Kumar 
nvme_copy_ns_format_match(NvmeNamespace * sns,NvmeNamespace * dns)3120d522aef8SArun Kumar static inline bool nvme_copy_ns_format_match(NvmeNamespace *sns,
3121d522aef8SArun Kumar                                              NvmeNamespace *dns)
3122d522aef8SArun Kumar {
3123d522aef8SArun Kumar     return sns->lbaf.ds == dns->lbaf.ds && sns->lbaf.ms == dns->lbaf.ms;
3124d522aef8SArun Kumar }
3125d522aef8SArun Kumar 
nvme_copy_matching_ns_format(NvmeNamespace * sns,NvmeNamespace * dns,bool pi_enable)3126d522aef8SArun Kumar static bool nvme_copy_matching_ns_format(NvmeNamespace *sns, NvmeNamespace *dns,
3127d522aef8SArun Kumar                                          bool pi_enable)
3128d522aef8SArun Kumar {
3129d522aef8SArun Kumar     if (!nvme_csi_supports_copy(sns->csi) ||
3130d522aef8SArun Kumar         !nvme_csi_supports_copy(dns->csi)) {
3131d522aef8SArun Kumar         return false;
3132d522aef8SArun Kumar     }
3133d522aef8SArun Kumar 
3134d522aef8SArun Kumar     if (!pi_enable && !nvme_copy_ns_format_match(sns, dns)) {
3135d522aef8SArun Kumar             return false;
3136d522aef8SArun Kumar     }
3137d522aef8SArun Kumar 
3138d522aef8SArun Kumar     if (pi_enable && (!nvme_copy_ns_format_match(sns, dns) ||
3139d522aef8SArun Kumar         sns->id_ns.dps != dns->id_ns.dps)) {
3140d522aef8SArun Kumar             return false;
3141d522aef8SArun Kumar     }
3142d522aef8SArun Kumar 
3143d522aef8SArun Kumar     return true;
3144d522aef8SArun Kumar }
3145d522aef8SArun Kumar 
nvme_copy_corresp_pi_match(NvmeNamespace * sns,NvmeNamespace * dns)3146d522aef8SArun Kumar static inline bool nvme_copy_corresp_pi_match(NvmeNamespace *sns,
3147d522aef8SArun Kumar                                               NvmeNamespace *dns)
3148d522aef8SArun Kumar {
3149d522aef8SArun Kumar     return sns->lbaf.ms == 0 &&
3150d522aef8SArun Kumar            ((dns->lbaf.ms == 8 && dns->pif == 0) ||
3151d522aef8SArun Kumar            (dns->lbaf.ms == 16 && dns->pif == 1));
3152d522aef8SArun Kumar }
3153d522aef8SArun Kumar 
nvme_copy_corresp_pi_format(NvmeNamespace * sns,NvmeNamespace * dns,bool sns_pi_en)3154d522aef8SArun Kumar static bool nvme_copy_corresp_pi_format(NvmeNamespace *sns, NvmeNamespace *dns,
3155d522aef8SArun Kumar                                         bool sns_pi_en)
3156d522aef8SArun Kumar {
3157d522aef8SArun Kumar     if (!nvme_csi_supports_copy(sns->csi) ||
3158d522aef8SArun Kumar         !nvme_csi_supports_copy(dns->csi)) {
3159d522aef8SArun Kumar         return false;
3160d522aef8SArun Kumar     }
3161d522aef8SArun Kumar 
3162d522aef8SArun Kumar     if (!sns_pi_en && !nvme_copy_corresp_pi_match(sns, dns)) {
3163d522aef8SArun Kumar         return false;
3164d522aef8SArun Kumar     }
3165d522aef8SArun Kumar 
3166d522aef8SArun Kumar     if (sns_pi_en && !nvme_copy_corresp_pi_match(dns, sns)) {
3167d522aef8SArun Kumar         return false;
3168d522aef8SArun Kumar     }
3169d522aef8SArun Kumar 
3170d522aef8SArun Kumar     return true;
3171d522aef8SArun Kumar }
3172d522aef8SArun Kumar 
nvme_do_copy(NvmeCopyAIOCB * iocb)317383f56ac3SKlaus Jensen static void nvme_do_copy(NvmeCopyAIOCB *iocb)
3174796d2068SKlaus Jensen {
3175796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
3176d522aef8SArun Kumar     NvmeNamespace *sns;
3177d522aef8SArun Kumar     NvmeNamespace *dns = req->ns;
3178d522aef8SArun Kumar     NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
3179d522aef8SArun Kumar     uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
3180d522aef8SArun Kumar     uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
3181796d2068SKlaus Jensen     uint64_t slba;
3182796d2068SKlaus Jensen     uint32_t nlb;
3183796d2068SKlaus Jensen     size_t len;
318488eea45cSKlaus Jensen     uint16_t status;
3185d522aef8SArun Kumar     uint32_t dnsid = le32_to_cpu(req->cmd.nsid);
3186d522aef8SArun Kumar     uint32_t snsid = dnsid;
318788eea45cSKlaus Jensen 
318883f56ac3SKlaus Jensen     if (iocb->ret < 0) {
3189796d2068SKlaus Jensen         goto done;
319088eea45cSKlaus Jensen     }
319188eea45cSKlaus Jensen 
3192796d2068SKlaus Jensen     if (iocb->idx == iocb->nr) {
3193796d2068SKlaus Jensen         goto done;
319488eea45cSKlaus Jensen     }
319588eea45cSKlaus Jensen 
3196d522aef8SArun Kumar     if (iocb->format == 2 || iocb->format == 3) {
3197d522aef8SArun Kumar         nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format,
3198d522aef8SArun Kumar                                      &slba, &nlb, &snsid, NULL, NULL, NULL);
3199d522aef8SArun Kumar         if (snsid != dnsid) {
3200d522aef8SArun Kumar             if (snsid == NVME_NSID_BROADCAST ||
3201d522aef8SArun Kumar                 !nvme_nsid_valid(iocb->n, snsid)) {
3202d522aef8SArun Kumar                 status = NVME_INVALID_NSID | NVME_DNR;
3203d522aef8SArun Kumar                 goto invalid;
3204d522aef8SArun Kumar             }
3205d522aef8SArun Kumar             iocb->sns = nvme_ns(iocb->n, snsid);
3206d522aef8SArun Kumar             if (unlikely(!iocb->sns)) {
3207d522aef8SArun Kumar                 status = NVME_INVALID_FIELD | NVME_DNR;
3208d522aef8SArun Kumar                 goto invalid;
3209d522aef8SArun Kumar             }
3210d522aef8SArun Kumar         } else {
3211d522aef8SArun Kumar             if (((slba + nlb) > iocb->slba) &&
3212d522aef8SArun Kumar                 ((slba + nlb) < (iocb->slba + iocb->tcl))) {
3213d522aef8SArun Kumar                 status = NVME_CMD_OVERLAP_IO_RANGE | NVME_DNR;
3214d522aef8SArun Kumar                 goto invalid;
3215d522aef8SArun Kumar             }
3216d522aef8SArun Kumar         }
3217d522aef8SArun Kumar     } else {
3218d522aef8SArun Kumar         nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format,
3219d522aef8SArun Kumar                                      &slba, &nlb, NULL, NULL, NULL, NULL);
3220d522aef8SArun Kumar     }
3221d522aef8SArun Kumar 
3222d522aef8SArun Kumar     sns = iocb->sns;
3223d522aef8SArun Kumar     if ((snsid == dnsid) && NVME_ID_NS_DPS_TYPE(sns->id_ns.dps) &&
3224d522aef8SArun Kumar         ((prinfor & NVME_PRINFO_PRACT) != (prinfow & NVME_PRINFO_PRACT))) {
3225d522aef8SArun Kumar         status = NVME_INVALID_FIELD | NVME_DNR;
3226d522aef8SArun Kumar         goto invalid;
3227d522aef8SArun Kumar     } else if (snsid != dnsid) {
3228d522aef8SArun Kumar         if (!NVME_ID_NS_DPS_TYPE(sns->id_ns.dps) &&
3229d522aef8SArun Kumar             !NVME_ID_NS_DPS_TYPE(dns->id_ns.dps)) {
3230d522aef8SArun Kumar             if (!nvme_copy_matching_ns_format(sns, dns, false)) {
3231d522aef8SArun Kumar                 status = NVME_CMD_INCOMP_NS_OR_FMT | NVME_DNR;
3232d522aef8SArun Kumar                 goto invalid;
3233d522aef8SArun Kumar             }
3234d522aef8SArun Kumar         }
3235d522aef8SArun Kumar         if (NVME_ID_NS_DPS_TYPE(sns->id_ns.dps) &&
3236d522aef8SArun Kumar             NVME_ID_NS_DPS_TYPE(dns->id_ns.dps)) {
3237d522aef8SArun Kumar             if ((prinfor & NVME_PRINFO_PRACT) !=
3238d522aef8SArun Kumar                 (prinfow & NVME_PRINFO_PRACT)) {
3239d522aef8SArun Kumar                 status = NVME_CMD_INCOMP_NS_OR_FMT | NVME_DNR;
3240d522aef8SArun Kumar                 goto invalid;
3241d522aef8SArun Kumar             } else {
3242d522aef8SArun Kumar                 if (!nvme_copy_matching_ns_format(sns, dns, true)) {
3243d522aef8SArun Kumar                     status = NVME_CMD_INCOMP_NS_OR_FMT | NVME_DNR;
3244d522aef8SArun Kumar                     goto invalid;
3245d522aef8SArun Kumar                 }
3246d522aef8SArun Kumar             }
3247d522aef8SArun Kumar         }
3248d522aef8SArun Kumar 
3249d522aef8SArun Kumar         if (!NVME_ID_NS_DPS_TYPE(sns->id_ns.dps) &&
3250d522aef8SArun Kumar             NVME_ID_NS_DPS_TYPE(dns->id_ns.dps)) {
3251d522aef8SArun Kumar             if (!(prinfow & NVME_PRINFO_PRACT)) {
3252d522aef8SArun Kumar                 status = NVME_CMD_INCOMP_NS_OR_FMT | NVME_DNR;
3253d522aef8SArun Kumar                 goto invalid;
3254d522aef8SArun Kumar             } else {
3255d522aef8SArun Kumar                 if (!nvme_copy_corresp_pi_format(sns, dns, false)) {
3256d522aef8SArun Kumar                     status = NVME_CMD_INCOMP_NS_OR_FMT | NVME_DNR;
3257d522aef8SArun Kumar                     goto invalid;
3258d522aef8SArun Kumar                 }
3259d522aef8SArun Kumar             }
3260d522aef8SArun Kumar         }
3261d522aef8SArun Kumar 
3262d522aef8SArun Kumar         if (NVME_ID_NS_DPS_TYPE(sns->id_ns.dps) &&
3263d522aef8SArun Kumar             !NVME_ID_NS_DPS_TYPE(dns->id_ns.dps)) {
3264d522aef8SArun Kumar             if (!(prinfor & NVME_PRINFO_PRACT)) {
3265d522aef8SArun Kumar                 status = NVME_CMD_INCOMP_NS_OR_FMT | NVME_DNR;
3266d522aef8SArun Kumar                 goto invalid;
3267d522aef8SArun Kumar             } else {
3268d522aef8SArun Kumar                 if (!nvme_copy_corresp_pi_format(sns, dns, true)) {
3269d522aef8SArun Kumar                     status = NVME_CMD_INCOMP_NS_OR_FMT | NVME_DNR;
3270d522aef8SArun Kumar                     goto invalid;
3271d522aef8SArun Kumar                 }
3272d522aef8SArun Kumar             }
3273d522aef8SArun Kumar         }
3274d522aef8SArun Kumar     }
3275d522aef8SArun Kumar     len = nvme_l2b(sns, nlb);
327688eea45cSKlaus Jensen 
3277796d2068SKlaus Jensen     trace_pci_nvme_copy_source_range(slba, nlb);
327888eea45cSKlaus Jensen 
3279d522aef8SArun Kumar     if (nlb > le16_to_cpu(sns->id_ns.mssrl)) {
328088eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
3281796d2068SKlaus Jensen         goto invalid;
328288eea45cSKlaus Jensen     }
328388eea45cSKlaus Jensen 
3284d522aef8SArun Kumar     status = nvme_check_bounds(sns, slba, nlb);
328588eea45cSKlaus Jensen     if (status) {
3286796d2068SKlaus Jensen         goto invalid;
328788eea45cSKlaus Jensen     }
328888eea45cSKlaus Jensen 
3289d522aef8SArun Kumar     if (NVME_ERR_REC_DULBE(sns->features.err_rec)) {
3290d522aef8SArun Kumar         status = nvme_check_dulbe(sns, slba, nlb);
329188eea45cSKlaus Jensen         if (status) {
3292796d2068SKlaus Jensen             goto invalid;
329388eea45cSKlaus Jensen         }
329488eea45cSKlaus Jensen     }
329588eea45cSKlaus Jensen 
3296d522aef8SArun Kumar     if (sns->params.zoned) {
3297d522aef8SArun Kumar         status = nvme_check_zone_read(sns, slba, nlb);
329888eea45cSKlaus Jensen         if (status) {
3299796d2068SKlaus Jensen             goto invalid;
330088eea45cSKlaus Jensen         }
330188eea45cSKlaus Jensen     }
330288eea45cSKlaus Jensen 
3303d522aef8SArun Kumar     g_free(iocb->bounce);
3304d522aef8SArun Kumar     iocb->bounce = g_malloc_n(le16_to_cpu(sns->id_ns.mssrl),
3305d522aef8SArun Kumar                               sns->lbasz + sns->lbaf.ms);
3306d522aef8SArun Kumar 
3307796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
3308796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
3309796d2068SKlaus Jensen 
3310d522aef8SArun Kumar     block_acct_start(blk_get_stats(sns->blkconf.blk), &iocb->acct.read, 0,
3311d522aef8SArun Kumar                      BLOCK_ACCT_READ);
3312d522aef8SArun Kumar 
3313d522aef8SArun Kumar     iocb->aiocb = blk_aio_preadv(sns->blkconf.blk, nvme_l2b(sns, slba),
3314796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_cb, iocb);
3315796d2068SKlaus Jensen     return;
3316796d2068SKlaus Jensen 
3317796d2068SKlaus Jensen invalid:
3318796d2068SKlaus Jensen     req->status = status;
331983f56ac3SKlaus Jensen     iocb->ret = -1;
3320796d2068SKlaus Jensen done:
332183f56ac3SKlaus Jensen     nvme_copy_done(iocb);
3322796d2068SKlaus Jensen }
3323796d2068SKlaus Jensen 
nvme_copy(NvmeCtrl * n,NvmeRequest * req)3324796d2068SKlaus Jensen static uint16_t nvme_copy(NvmeCtrl *n, NvmeRequest *req)
3325796d2068SKlaus Jensen {
3326796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
3327796d2068SKlaus Jensen     NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
3328796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = blk_aio_get(&nvme_copy_aiocb_info, ns->blkconf.blk,
3329796d2068SKlaus Jensen                                       nvme_misc_cb, req);
3330796d2068SKlaus Jensen     uint16_t nr = copy->nr + 1;
3331796d2068SKlaus Jensen     uint8_t format = copy->control[0] & 0xf;
3332d522aef8SArun Kumar     size_t len = sizeof(NvmeCopySourceRangeFormat0_2);
3333796d2068SKlaus Jensen 
3334796d2068SKlaus Jensen     uint16_t status;
3335796d2068SKlaus Jensen 
3336796d2068SKlaus Jensen     trace_pci_nvme_copy(nvme_cid(req), nvme_nsid(ns), nr, format);
3337796d2068SKlaus Jensen 
3338796d2068SKlaus Jensen     iocb->ranges = NULL;
3339796d2068SKlaus Jensen     iocb->zone = NULL;
3340796d2068SKlaus Jensen 
3341d522aef8SArun Kumar     if (!(n->id_ctrl.ocfs & (1 << format)) ||
3342d522aef8SArun Kumar         ((format == 2 || format == 3) &&
3343d522aef8SArun Kumar          !(n->features.hbs.cdfe & (1 << format)))) {
3344796d2068SKlaus Jensen         trace_pci_nvme_err_copy_invalid_format(format);
3345796d2068SKlaus Jensen         status = NVME_INVALID_FIELD | NVME_DNR;
3346796d2068SKlaus Jensen         goto invalid;
3347796d2068SKlaus Jensen     }
3348796d2068SKlaus Jensen 
3349796d2068SKlaus Jensen     if (nr > ns->id_ns.msrc + 1) {
335088eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
3351796d2068SKlaus Jensen         goto invalid;
335288eea45cSKlaus Jensen     }
335388eea45cSKlaus Jensen 
3354d522aef8SArun Kumar     if ((ns->pif == 0x0 && (format != 0x0 && format != 0x2)) ||
3355d522aef8SArun Kumar         (ns->pif != 0x0 && (format != 0x1 && format != 0x3))) {
335644219b60SNaveen Nagar         status = NVME_INVALID_FORMAT | NVME_DNR;
335744219b60SNaveen Nagar         goto invalid;
335844219b60SNaveen Nagar     }
3359796d2068SKlaus Jensen 
336044219b60SNaveen Nagar     if (ns->pif) {
3361d522aef8SArun Kumar         len = sizeof(NvmeCopySourceRangeFormat1_3);
336244219b60SNaveen Nagar     }
336344219b60SNaveen Nagar 
336444219b60SNaveen Nagar     iocb->format = format;
336544219b60SNaveen Nagar     iocb->ranges = g_malloc_n(nr, len);
336644219b60SNaveen Nagar     status = nvme_h2c(n, (uint8_t *)iocb->ranges, len * nr, req);
3367796d2068SKlaus Jensen     if (status) {
3368796d2068SKlaus Jensen         goto invalid;
336988eea45cSKlaus Jensen     }
337088eea45cSKlaus Jensen 
3371796d2068SKlaus Jensen     iocb->slba = le64_to_cpu(copy->sdlba);
3372796d2068SKlaus Jensen 
3373796d2068SKlaus Jensen     if (ns->params.zoned) {
3374796d2068SKlaus Jensen         iocb->zone = nvme_get_zone_by_slba(ns, iocb->slba);
3375796d2068SKlaus Jensen         if (!iocb->zone) {
3376796d2068SKlaus Jensen             status = NVME_LBA_RANGE | NVME_DNR;
3377796d2068SKlaus Jensen             goto invalid;
3378796d2068SKlaus Jensen         }
3379796d2068SKlaus Jensen 
3380796d2068SKlaus Jensen         status = nvme_zrm_auto(n, ns, iocb->zone);
3381796d2068SKlaus Jensen         if (status) {
3382796d2068SKlaus Jensen             goto invalid;
3383796d2068SKlaus Jensen         }
3384796d2068SKlaus Jensen     }
3385796d2068SKlaus Jensen 
3386381ab99dSMinwoo Im     status = nvme_check_copy_mcl(ns, iocb, nr);
3387381ab99dSMinwoo Im     if (status) {
3388381ab99dSMinwoo Im         goto invalid;
3389381ab99dSMinwoo Im     }
3390381ab99dSMinwoo Im 
3391796d2068SKlaus Jensen     iocb->req = req;
3392796d2068SKlaus Jensen     iocb->ret = 0;
3393796d2068SKlaus Jensen     iocb->nr = nr;
3394796d2068SKlaus Jensen     iocb->idx = 0;
3395796d2068SKlaus Jensen     iocb->reftag = le32_to_cpu(copy->reftag);
339644219b60SNaveen Nagar     iocb->reftag |= (uint64_t)le32_to_cpu(copy->cdw3) << 32;
3397796d2068SKlaus Jensen 
3398796d2068SKlaus Jensen     qemu_iovec_init(&iocb->iov, 1);
3399796d2068SKlaus Jensen 
3400796d2068SKlaus Jensen     req->aiocb = &iocb->common;
3401d522aef8SArun Kumar     iocb->sns = req->ns;
3402d522aef8SArun Kumar     iocb->n = n;
3403d522aef8SArun Kumar     iocb->bounce = NULL;
340483f56ac3SKlaus Jensen     nvme_do_copy(iocb);
340588eea45cSKlaus Jensen 
340688eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
340788eea45cSKlaus Jensen 
3408796d2068SKlaus Jensen invalid:
3409796d2068SKlaus Jensen     g_free(iocb->ranges);
3410796d2068SKlaus Jensen     qemu_aio_unref(iocb);
341188eea45cSKlaus Jensen     return status;
341288eea45cSKlaus Jensen }
341388eea45cSKlaus Jensen 
nvme_compare(NvmeCtrl * n,NvmeRequest * req)341488eea45cSKlaus Jensen static uint16_t nvme_compare(NvmeCtrl *n, NvmeRequest *req)
341588eea45cSKlaus Jensen {
341688eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
341788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
341888eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
341988eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
342088eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
34212a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
342288eea45cSKlaus Jensen     size_t data_len = nvme_l2b(ns, nlb);
342388eea45cSKlaus Jensen     size_t len = data_len;
342488eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
342588eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = NULL;
342688eea45cSKlaus Jensen     uint16_t status;
342788eea45cSKlaus Jensen 
342888eea45cSKlaus Jensen     trace_pci_nvme_compare(nvme_cid(req), nvme_nsid(ns), slba, nlb);
342988eea45cSKlaus Jensen 
34302a132309SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps) && (prinfo & NVME_PRINFO_PRACT)) {
343188eea45cSKlaus Jensen         return NVME_INVALID_PROT_INFO | NVME_DNR;
343288eea45cSKlaus Jensen     }
343388eea45cSKlaus Jensen 
343488eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
343588eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
343688eea45cSKlaus Jensen     }
343788eea45cSKlaus Jensen 
3438a1ab6788SArun Kumar     if (NVME_ID_CTRL_CTRATT_MEM(n->id_ctrl.ctratt)) {
3439a1ab6788SArun Kumar         status = nvme_check_mdts(n, data_len);
3440a1ab6788SArun Kumar     } else {
344188eea45cSKlaus Jensen         status = nvme_check_mdts(n, len);
3442a1ab6788SArun Kumar     }
344388eea45cSKlaus Jensen     if (status) {
344488eea45cSKlaus Jensen         return status;
344588eea45cSKlaus Jensen     }
344688eea45cSKlaus Jensen 
344788eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
344888eea45cSKlaus Jensen     if (status) {
344988eea45cSKlaus Jensen         return status;
345088eea45cSKlaus Jensen     }
345188eea45cSKlaus Jensen 
345288eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
345388eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
345488eea45cSKlaus Jensen         if (status) {
345588eea45cSKlaus Jensen             return status;
345688eea45cSKlaus Jensen         }
345788eea45cSKlaus Jensen     }
345888eea45cSKlaus Jensen 
345988eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
346088eea45cSKlaus Jensen     if (status) {
346188eea45cSKlaus Jensen         return status;
346288eea45cSKlaus Jensen     }
346388eea45cSKlaus Jensen 
346488eea45cSKlaus Jensen     ctx = g_new(struct nvme_compare_ctx, 1);
346588eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(data_len);
346688eea45cSKlaus Jensen 
346788eea45cSKlaus Jensen     req->opaque = ctx;
346888eea45cSKlaus Jensen 
346988eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
347088eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, data_len);
347188eea45cSKlaus Jensen 
347288eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_len,
347388eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
347488eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->data.iov, 0,
347588eea45cSKlaus Jensen                                 nvme_compare_data_cb, req);
347688eea45cSKlaus Jensen 
347788eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
347888eea45cSKlaus Jensen }
347988eea45cSKlaus Jensen 
348038f4ac65SKlaus Jensen typedef struct NvmeFlushAIOCB {
348138f4ac65SKlaus Jensen     BlockAIOCB common;
348238f4ac65SKlaus Jensen     BlockAIOCB *aiocb;
348338f4ac65SKlaus Jensen     NvmeRequest *req;
348438f4ac65SKlaus Jensen     int ret;
348538f4ac65SKlaus Jensen 
348638f4ac65SKlaus Jensen     NvmeNamespace *ns;
348738f4ac65SKlaus Jensen     uint32_t nsid;
348838f4ac65SKlaus Jensen     bool broadcast;
348938f4ac65SKlaus Jensen } NvmeFlushAIOCB;
349038f4ac65SKlaus Jensen 
nvme_flush_cancel(BlockAIOCB * acb)349138f4ac65SKlaus Jensen static void nvme_flush_cancel(BlockAIOCB *acb)
349238f4ac65SKlaus Jensen {
349338f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = container_of(acb, NvmeFlushAIOCB, common);
349438f4ac65SKlaus Jensen 
349538f4ac65SKlaus Jensen     iocb->ret = -ECANCELED;
349638f4ac65SKlaus Jensen 
349738f4ac65SKlaus Jensen     if (iocb->aiocb) {
349838f4ac65SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
34993dbc1708SKlaus Jensen         iocb->aiocb = NULL;
350038f4ac65SKlaus Jensen     }
350138f4ac65SKlaus Jensen }
350238f4ac65SKlaus Jensen 
350338f4ac65SKlaus Jensen static const AIOCBInfo nvme_flush_aiocb_info = {
350438f4ac65SKlaus Jensen     .aiocb_size = sizeof(NvmeFlushAIOCB),
350538f4ac65SKlaus Jensen     .cancel_async = nvme_flush_cancel,
350638f4ac65SKlaus Jensen };
350738f4ac65SKlaus Jensen 
35083dbc1708SKlaus Jensen static void nvme_do_flush(NvmeFlushAIOCB *iocb);
35093dbc1708SKlaus Jensen 
nvme_flush_ns_cb(void * opaque,int ret)351038f4ac65SKlaus Jensen static void nvme_flush_ns_cb(void *opaque, int ret)
351138f4ac65SKlaus Jensen {
351238f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = opaque;
351338f4ac65SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
351438f4ac65SKlaus Jensen 
351538f4ac65SKlaus Jensen     if (ret < 0) {
351638f4ac65SKlaus Jensen         iocb->ret = ret;
351738f4ac65SKlaus Jensen         goto out;
351838f4ac65SKlaus Jensen     } else if (iocb->ret < 0) {
351938f4ac65SKlaus Jensen         goto out;
352038f4ac65SKlaus Jensen     }
352138f4ac65SKlaus Jensen 
352238f4ac65SKlaus Jensen     if (ns) {
352338f4ac65SKlaus Jensen         trace_pci_nvme_flush_ns(iocb->nsid);
352438f4ac65SKlaus Jensen 
352538f4ac65SKlaus Jensen         iocb->ns = NULL;
352638f4ac65SKlaus Jensen         iocb->aiocb = blk_aio_flush(ns->blkconf.blk, nvme_flush_ns_cb, iocb);
352738f4ac65SKlaus Jensen         return;
352838f4ac65SKlaus Jensen     }
352938f4ac65SKlaus Jensen 
353038f4ac65SKlaus Jensen out:
35313dbc1708SKlaus Jensen     nvme_do_flush(iocb);
353238f4ac65SKlaus Jensen }
353338f4ac65SKlaus Jensen 
nvme_do_flush(NvmeFlushAIOCB * iocb)35343dbc1708SKlaus Jensen static void nvme_do_flush(NvmeFlushAIOCB *iocb)
353538f4ac65SKlaus Jensen {
353638f4ac65SKlaus Jensen     NvmeRequest *req = iocb->req;
353738f4ac65SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
353838f4ac65SKlaus Jensen     int i;
353938f4ac65SKlaus Jensen 
354038f4ac65SKlaus Jensen     if (iocb->ret < 0) {
354138f4ac65SKlaus Jensen         goto done;
354238f4ac65SKlaus Jensen     }
354338f4ac65SKlaus Jensen 
354438f4ac65SKlaus Jensen     if (iocb->broadcast) {
354538f4ac65SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
354638f4ac65SKlaus Jensen             iocb->ns = nvme_ns(n, i);
354738f4ac65SKlaus Jensen             if (iocb->ns) {
354838f4ac65SKlaus Jensen                 iocb->nsid = i;
354938f4ac65SKlaus Jensen                 break;
355038f4ac65SKlaus Jensen             }
355138f4ac65SKlaus Jensen         }
355238f4ac65SKlaus Jensen     }
355338f4ac65SKlaus Jensen 
355438f4ac65SKlaus Jensen     if (!iocb->ns) {
355538f4ac65SKlaus Jensen         goto done;
355638f4ac65SKlaus Jensen     }
355738f4ac65SKlaus Jensen 
355838f4ac65SKlaus Jensen     nvme_flush_ns_cb(iocb, 0);
355938f4ac65SKlaus Jensen     return;
356038f4ac65SKlaus Jensen 
356138f4ac65SKlaus Jensen done:
356238f4ac65SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
356338f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
356438f4ac65SKlaus Jensen }
356538f4ac65SKlaus Jensen 
nvme_flush(NvmeCtrl * n,NvmeRequest * req)356688eea45cSKlaus Jensen static uint16_t nvme_flush(NvmeCtrl *n, NvmeRequest *req)
356788eea45cSKlaus Jensen {
356838f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb;
356988eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
357088eea45cSKlaus Jensen     uint16_t status;
357188eea45cSKlaus Jensen 
357238f4ac65SKlaus Jensen     iocb = qemu_aio_get(&nvme_flush_aiocb_info, NULL, nvme_misc_cb, req);
357388eea45cSKlaus Jensen 
357438f4ac65SKlaus Jensen     iocb->req = req;
357538f4ac65SKlaus Jensen     iocb->ret = 0;
357638f4ac65SKlaus Jensen     iocb->ns = NULL;
357738f4ac65SKlaus Jensen     iocb->nsid = 0;
357838f4ac65SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
357938f4ac65SKlaus Jensen 
358038f4ac65SKlaus Jensen     if (!iocb->broadcast) {
358138f4ac65SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
358238f4ac65SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
358338f4ac65SKlaus Jensen             goto out;
358488eea45cSKlaus Jensen         }
358588eea45cSKlaus Jensen 
358638f4ac65SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
358738f4ac65SKlaus Jensen         if (!iocb->ns) {
358838f4ac65SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
358938f4ac65SKlaus Jensen             goto out;
359038f4ac65SKlaus Jensen         }
359138f4ac65SKlaus Jensen 
359238f4ac65SKlaus Jensen         iocb->nsid = nsid;
359338f4ac65SKlaus Jensen     }
359438f4ac65SKlaus Jensen 
359538f4ac65SKlaus Jensen     req->aiocb = &iocb->common;
35963dbc1708SKlaus Jensen     nvme_do_flush(iocb);
359738f4ac65SKlaus Jensen 
359888eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
359988eea45cSKlaus Jensen 
360038f4ac65SKlaus Jensen out:
360138f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
360288eea45cSKlaus Jensen 
360388eea45cSKlaus Jensen     return status;
360488eea45cSKlaus Jensen }
360588eea45cSKlaus Jensen 
nvme_read(NvmeCtrl * n,NvmeRequest * req)360688eea45cSKlaus Jensen static uint16_t nvme_read(NvmeCtrl *n, NvmeRequest *req)
360788eea45cSKlaus Jensen {
360888eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
360988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
361088eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
361188eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
36122a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
361388eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
361488eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
361588eea45cSKlaus Jensen     uint64_t data_offset;
361688eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
361788eea45cSKlaus Jensen     uint16_t status;
361888eea45cSKlaus Jensen 
3619a1ab6788SArun Kumar     if (nvme_ns_ext(ns) && !(NVME_ID_CTRL_CTRATT_MEM(n->id_ctrl.ctratt))) {
362088eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
362188eea45cSKlaus Jensen 
362288eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
36232a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
362488eea45cSKlaus Jensen 
3625ac0b34c5SKlaus Jensen             if (pract && ns->lbaf.ms == nvme_pi_tuple_size(ns)) {
362688eea45cSKlaus Jensen                 mapped_size = data_size;
362788eea45cSKlaus Jensen             }
362888eea45cSKlaus Jensen         }
362988eea45cSKlaus Jensen     }
363088eea45cSKlaus Jensen 
363188eea45cSKlaus Jensen     trace_pci_nvme_read(nvme_cid(req), nvme_nsid(ns), nlb, mapped_size, slba);
363288eea45cSKlaus Jensen 
363388eea45cSKlaus Jensen     status = nvme_check_mdts(n, mapped_size);
363488eea45cSKlaus Jensen     if (status) {
363588eea45cSKlaus Jensen         goto invalid;
363688eea45cSKlaus Jensen     }
363788eea45cSKlaus Jensen 
363888eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
363988eea45cSKlaus Jensen     if (status) {
364088eea45cSKlaus Jensen         goto invalid;
364188eea45cSKlaus Jensen     }
364288eea45cSKlaus Jensen 
364388eea45cSKlaus Jensen     if (ns->params.zoned) {
364488eea45cSKlaus Jensen         status = nvme_check_zone_read(ns, slba, nlb);
364588eea45cSKlaus Jensen         if (status) {
364688eea45cSKlaus Jensen             trace_pci_nvme_err_zone_read_not_ok(slba, nlb, status);
364788eea45cSKlaus Jensen             goto invalid;
364888eea45cSKlaus Jensen         }
364988eea45cSKlaus Jensen     }
365088eea45cSKlaus Jensen 
365188eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
365288eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
365388eea45cSKlaus Jensen         if (status) {
365488eea45cSKlaus Jensen             goto invalid;
365588eea45cSKlaus Jensen         }
365688eea45cSKlaus Jensen     }
365788eea45cSKlaus Jensen 
365888eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
365988eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
366088eea45cSKlaus Jensen     }
366188eea45cSKlaus Jensen 
366288eea45cSKlaus Jensen     status = nvme_map_data(n, nlb, req);
366388eea45cSKlaus Jensen     if (status) {
366488eea45cSKlaus Jensen         goto invalid;
366588eea45cSKlaus Jensen     }
366688eea45cSKlaus Jensen 
366788eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
366888eea45cSKlaus Jensen 
366988eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_size,
367088eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
36719b4f0181SMateusz Kozlowski     nvme_blk_read(blk, data_offset, BDRV_SECTOR_SIZE, nvme_rw_cb, req);
367288eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
367388eea45cSKlaus Jensen 
367488eea45cSKlaus Jensen invalid:
367588eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_READ);
367688eea45cSKlaus Jensen     return status | NVME_DNR;
367788eea45cSKlaus Jensen }
367888eea45cSKlaus Jensen 
nvme_do_write_fdp(NvmeCtrl * n,NvmeRequest * req,uint64_t slba,uint32_t nlb)367973064edfSJesper Devantier static void nvme_do_write_fdp(NvmeCtrl *n, NvmeRequest *req, uint64_t slba,
368073064edfSJesper Devantier                               uint32_t nlb)
368173064edfSJesper Devantier {
368273064edfSJesper Devantier     NvmeNamespace *ns = req->ns;
368373064edfSJesper Devantier     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
368473064edfSJesper Devantier     uint64_t data_size = nvme_l2b(ns, nlb);
368573064edfSJesper Devantier     uint32_t dw12 = le32_to_cpu(req->cmd.cdw12);
368673064edfSJesper Devantier     uint8_t dtype = (dw12 >> 20) & 0xf;
368773064edfSJesper Devantier     uint16_t pid = le16_to_cpu(rw->dspec);
368873064edfSJesper Devantier     uint16_t ph, rg, ruhid;
368973064edfSJesper Devantier     NvmeReclaimUnit *ru;
369073064edfSJesper Devantier 
369173064edfSJesper Devantier     if (dtype != NVME_DIRECTIVE_DATA_PLACEMENT ||
369273064edfSJesper Devantier         !nvme_parse_pid(ns, pid, &ph, &rg)) {
369373064edfSJesper Devantier         ph = 0;
369473064edfSJesper Devantier         rg = 0;
369573064edfSJesper Devantier     }
369673064edfSJesper Devantier 
369773064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
369873064edfSJesper Devantier     ru = &ns->endgrp->fdp.ruhs[ruhid].rus[rg];
369973064edfSJesper Devantier 
370073064edfSJesper Devantier     nvme_fdp_stat_inc(&ns->endgrp->fdp.hbmw, data_size);
370173064edfSJesper Devantier     nvme_fdp_stat_inc(&ns->endgrp->fdp.mbmw, data_size);
370273064edfSJesper Devantier 
370373064edfSJesper Devantier     while (nlb) {
370473064edfSJesper Devantier         if (nlb < ru->ruamw) {
370573064edfSJesper Devantier             ru->ruamw -= nlb;
370673064edfSJesper Devantier             break;
370773064edfSJesper Devantier         }
370873064edfSJesper Devantier 
370973064edfSJesper Devantier         nlb -= ru->ruamw;
371073064edfSJesper Devantier         nvme_update_ruh(n, ns, pid);
371173064edfSJesper Devantier     }
371273064edfSJesper Devantier }
371373064edfSJesper Devantier 
nvme_do_write(NvmeCtrl * n,NvmeRequest * req,bool append,bool wrz)371488eea45cSKlaus Jensen static uint16_t nvme_do_write(NvmeCtrl *n, NvmeRequest *req, bool append,
371588eea45cSKlaus Jensen                               bool wrz)
371688eea45cSKlaus Jensen {
371788eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
371888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
371988eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
372088eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
372188eea45cSKlaus Jensen     uint16_t ctrl = le16_to_cpu(rw->control);
37222a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(ctrl);
372388eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
372488eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
372588eea45cSKlaus Jensen     uint64_t data_offset;
372688eea45cSKlaus Jensen     NvmeZone *zone;
372788eea45cSKlaus Jensen     NvmeZonedResult *res = (NvmeZonedResult *)&req->cqe;
372888eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
372988eea45cSKlaus Jensen     uint16_t status;
373088eea45cSKlaus Jensen 
3731a1ab6788SArun Kumar     if (nvme_ns_ext(ns) && !(NVME_ID_CTRL_CTRATT_MEM(n->id_ctrl.ctratt))) {
373288eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
373388eea45cSKlaus Jensen 
373488eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
37352a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
373688eea45cSKlaus Jensen 
3737ac0b34c5SKlaus Jensen             if (pract && ns->lbaf.ms == nvme_pi_tuple_size(ns)) {
373888eea45cSKlaus Jensen                 mapped_size -= nvme_m2b(ns, nlb);
373988eea45cSKlaus Jensen             }
374088eea45cSKlaus Jensen         }
374188eea45cSKlaus Jensen     }
374288eea45cSKlaus Jensen 
374388eea45cSKlaus Jensen     trace_pci_nvme_write(nvme_cid(req), nvme_io_opc_str(rw->opcode),
374488eea45cSKlaus Jensen                          nvme_nsid(ns), nlb, mapped_size, slba);
374588eea45cSKlaus Jensen 
374688eea45cSKlaus Jensen     if (!wrz) {
374788eea45cSKlaus Jensen         status = nvme_check_mdts(n, mapped_size);
374888eea45cSKlaus Jensen         if (status) {
374988eea45cSKlaus Jensen             goto invalid;
375088eea45cSKlaus Jensen         }
375188eea45cSKlaus Jensen     }
375288eea45cSKlaus Jensen 
375388eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
375488eea45cSKlaus Jensen     if (status) {
375588eea45cSKlaus Jensen         goto invalid;
375688eea45cSKlaus Jensen     }
375788eea45cSKlaus Jensen 
375888eea45cSKlaus Jensen     if (ns->params.zoned) {
375988eea45cSKlaus Jensen         zone = nvme_get_zone_by_slba(ns, slba);
3760189a8bf7SKlaus Jensen         assert(zone);
376188eea45cSKlaus Jensen 
376288eea45cSKlaus Jensen         if (append) {
376388eea45cSKlaus Jensen             bool piremap = !!(ctrl & NVME_RW_PIREMAP);
376488eea45cSKlaus Jensen 
3765e321b4cdSKlaus Jensen             if (unlikely(zone->d.za & NVME_ZA_ZRWA_VALID)) {
3766e321b4cdSKlaus Jensen                 return NVME_INVALID_ZONE_OP | NVME_DNR;
3767e321b4cdSKlaus Jensen             }
3768e321b4cdSKlaus Jensen 
376988eea45cSKlaus Jensen             if (unlikely(slba != zone->d.zslba)) {
377088eea45cSKlaus Jensen                 trace_pci_nvme_err_append_not_at_start(slba, zone->d.zslba);
377188eea45cSKlaus Jensen                 status = NVME_INVALID_FIELD;
377288eea45cSKlaus Jensen                 goto invalid;
377388eea45cSKlaus Jensen             }
377488eea45cSKlaus Jensen 
377588eea45cSKlaus Jensen             if (n->params.zasl &&
377688eea45cSKlaus Jensen                 data_size > (uint64_t)n->page_size << n->params.zasl) {
377788eea45cSKlaus Jensen                 trace_pci_nvme_err_zasl(data_size);
377888eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
377988eea45cSKlaus Jensen             }
378088eea45cSKlaus Jensen 
378188eea45cSKlaus Jensen             slba = zone->w_ptr;
378288eea45cSKlaus Jensen             rw->slba = cpu_to_le64(slba);
378388eea45cSKlaus Jensen             res->slba = cpu_to_le64(slba);
378488eea45cSKlaus Jensen 
378588eea45cSKlaus Jensen             switch (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
378688eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_1:
378788eea45cSKlaus Jensen                 if (!piremap) {
378888eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
378988eea45cSKlaus Jensen                 }
379088eea45cSKlaus Jensen 
379188eea45cSKlaus Jensen                 /* fallthrough */
379288eea45cSKlaus Jensen 
379388eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_2:
379488eea45cSKlaus Jensen                 if (piremap) {
379588eea45cSKlaus Jensen                     uint32_t reftag = le32_to_cpu(rw->reftag);
379688eea45cSKlaus Jensen                     rw->reftag = cpu_to_le32(reftag + (slba - zone->d.zslba));
379788eea45cSKlaus Jensen                 }
379888eea45cSKlaus Jensen 
379988eea45cSKlaus Jensen                 break;
380088eea45cSKlaus Jensen 
380188eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_3:
380288eea45cSKlaus Jensen                 if (piremap) {
380388eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
380488eea45cSKlaus Jensen                 }
380588eea45cSKlaus Jensen 
380688eea45cSKlaus Jensen                 break;
380788eea45cSKlaus Jensen             }
380888eea45cSKlaus Jensen         }
380988eea45cSKlaus Jensen 
381088eea45cSKlaus Jensen         status = nvme_check_zone_write(ns, zone, slba, nlb);
381188eea45cSKlaus Jensen         if (status) {
381288eea45cSKlaus Jensen             goto invalid;
381388eea45cSKlaus Jensen         }
381488eea45cSKlaus Jensen 
3815cccc2651SNiklas Cassel         status = nvme_zrm_auto(n, ns, zone);
381688eea45cSKlaus Jensen         if (status) {
381788eea45cSKlaus Jensen             goto invalid;
381888eea45cSKlaus Jensen         }
381988eea45cSKlaus Jensen 
3820e321b4cdSKlaus Jensen         if (!(zone->d.za & NVME_ZA_ZRWA_VALID)) {
382188eea45cSKlaus Jensen             zone->w_ptr += nlb;
382288eea45cSKlaus Jensen         }
382373064edfSJesper Devantier     } else if (ns->endgrp && ns->endgrp->fdp.enabled) {
382473064edfSJesper Devantier         nvme_do_write_fdp(n, req, slba, nlb);
3825e321b4cdSKlaus Jensen     }
382688eea45cSKlaus Jensen 
382788eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
382888eea45cSKlaus Jensen 
382988eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
383088eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
383188eea45cSKlaus Jensen     }
383288eea45cSKlaus Jensen 
383388eea45cSKlaus Jensen     if (!wrz) {
383488eea45cSKlaus Jensen         status = nvme_map_data(n, nlb, req);
383588eea45cSKlaus Jensen         if (status) {
383688eea45cSKlaus Jensen             goto invalid;
383788eea45cSKlaus Jensen         }
383888eea45cSKlaus Jensen 
383988eea45cSKlaus Jensen         block_acct_start(blk_get_stats(blk), &req->acct, data_size,
384088eea45cSKlaus Jensen                          BLOCK_ACCT_WRITE);
38419b4f0181SMateusz Kozlowski         nvme_blk_write(blk, data_offset, BDRV_SECTOR_SIZE, nvme_rw_cb, req);
384288eea45cSKlaus Jensen     } else {
384388eea45cSKlaus Jensen         req->aiocb = blk_aio_pwrite_zeroes(blk, data_offset, data_size,
384488eea45cSKlaus Jensen                                            BDRV_REQ_MAY_UNMAP, nvme_rw_cb,
384588eea45cSKlaus Jensen                                            req);
384688eea45cSKlaus Jensen     }
384788eea45cSKlaus Jensen 
384888eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
384988eea45cSKlaus Jensen 
385088eea45cSKlaus Jensen invalid:
385188eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_WRITE);
385288eea45cSKlaus Jensen     return status | NVME_DNR;
385388eea45cSKlaus Jensen }
385488eea45cSKlaus Jensen 
nvme_write(NvmeCtrl * n,NvmeRequest * req)385588eea45cSKlaus Jensen static inline uint16_t nvme_write(NvmeCtrl *n, NvmeRequest *req)
385688eea45cSKlaus Jensen {
385788eea45cSKlaus Jensen     return nvme_do_write(n, req, false, false);
385888eea45cSKlaus Jensen }
385988eea45cSKlaus Jensen 
nvme_write_zeroes(NvmeCtrl * n,NvmeRequest * req)386088eea45cSKlaus Jensen static inline uint16_t nvme_write_zeroes(NvmeCtrl *n, NvmeRequest *req)
386188eea45cSKlaus Jensen {
386288eea45cSKlaus Jensen     return nvme_do_write(n, req, false, true);
386388eea45cSKlaus Jensen }
386488eea45cSKlaus Jensen 
nvme_zone_append(NvmeCtrl * n,NvmeRequest * req)386588eea45cSKlaus Jensen static inline uint16_t nvme_zone_append(NvmeCtrl *n, NvmeRequest *req)
386688eea45cSKlaus Jensen {
386788eea45cSKlaus Jensen     return nvme_do_write(n, req, true, false);
386888eea45cSKlaus Jensen }
386988eea45cSKlaus Jensen 
nvme_get_mgmt_zone_slba_idx(NvmeNamespace * ns,NvmeCmd * c,uint64_t * slba,uint32_t * zone_idx)387088eea45cSKlaus Jensen static uint16_t nvme_get_mgmt_zone_slba_idx(NvmeNamespace *ns, NvmeCmd *c,
387188eea45cSKlaus Jensen                                             uint64_t *slba, uint32_t *zone_idx)
387288eea45cSKlaus Jensen {
387388eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(c->cdw10);
387488eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(c->cdw11);
387588eea45cSKlaus Jensen 
387688eea45cSKlaus Jensen     if (!ns->params.zoned) {
387788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(c->opcode);
387888eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
387988eea45cSKlaus Jensen     }
388088eea45cSKlaus Jensen 
388188eea45cSKlaus Jensen     *slba = ((uint64_t)dw11) << 32 | dw10;
388288eea45cSKlaus Jensen     if (unlikely(*slba >= ns->id_ns.nsze)) {
388388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(*slba, 0, ns->id_ns.nsze);
388488eea45cSKlaus Jensen         *slba = 0;
388588eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
388688eea45cSKlaus Jensen     }
388788eea45cSKlaus Jensen 
388888eea45cSKlaus Jensen     *zone_idx = nvme_zone_idx(ns, *slba);
388988eea45cSKlaus Jensen     assert(*zone_idx < ns->num_zones);
389088eea45cSKlaus Jensen 
389188eea45cSKlaus Jensen     return NVME_SUCCESS;
389288eea45cSKlaus Jensen }
389388eea45cSKlaus Jensen 
389488eea45cSKlaus Jensen typedef uint16_t (*op_handler_t)(NvmeNamespace *, NvmeZone *, NvmeZoneState,
389588eea45cSKlaus Jensen                                  NvmeRequest *);
389688eea45cSKlaus Jensen 
389788eea45cSKlaus Jensen enum NvmeZoneProcessingMask {
389888eea45cSKlaus Jensen     NVME_PROC_CURRENT_ZONE    = 0,
389988eea45cSKlaus Jensen     NVME_PROC_OPENED_ZONES    = 1 << 0,
390088eea45cSKlaus Jensen     NVME_PROC_CLOSED_ZONES    = 1 << 1,
390188eea45cSKlaus Jensen     NVME_PROC_READ_ONLY_ZONES = 1 << 2,
390288eea45cSKlaus Jensen     NVME_PROC_FULL_ZONES      = 1 << 3,
390388eea45cSKlaus Jensen };
390488eea45cSKlaus Jensen 
nvme_open_zone(NvmeNamespace * ns,NvmeZone * zone,NvmeZoneState state,NvmeRequest * req)390588eea45cSKlaus Jensen static uint16_t nvme_open_zone(NvmeNamespace *ns, NvmeZone *zone,
390688eea45cSKlaus Jensen                                NvmeZoneState state, NvmeRequest *req)
390788eea45cSKlaus Jensen {
3908e321b4cdSKlaus Jensen     NvmeZoneSendCmd *cmd = (NvmeZoneSendCmd *)&req->cmd;
3909e321b4cdSKlaus Jensen     int flags = 0;
3910e321b4cdSKlaus Jensen 
3911e321b4cdSKlaus Jensen     if (cmd->zsflags & NVME_ZSFLAG_ZRWA_ALLOC) {
3912e321b4cdSKlaus Jensen         uint16_t ozcs = le16_to_cpu(ns->id_ns_zoned->ozcs);
3913e321b4cdSKlaus Jensen 
3914e321b4cdSKlaus Jensen         if (!(ozcs & NVME_ID_NS_ZONED_OZCS_ZRWASUP)) {
3915e321b4cdSKlaus Jensen             return NVME_INVALID_ZONE_OP | NVME_DNR;
3916e321b4cdSKlaus Jensen         }
3917e321b4cdSKlaus Jensen 
3918e321b4cdSKlaus Jensen         if (zone->w_ptr % ns->zns.zrwafg) {
3919e321b4cdSKlaus Jensen             return NVME_NOZRWA | NVME_DNR;
3920e321b4cdSKlaus Jensen         }
3921e321b4cdSKlaus Jensen 
3922e321b4cdSKlaus Jensen         flags = NVME_ZRM_ZRWA;
3923e321b4cdSKlaus Jensen     }
3924e321b4cdSKlaus Jensen 
3925e321b4cdSKlaus Jensen     return nvme_zrm_open_flags(nvme_ctrl(req), ns, zone, flags);
392688eea45cSKlaus Jensen }
392788eea45cSKlaus Jensen 
nvme_close_zone(NvmeNamespace * ns,NvmeZone * zone,NvmeZoneState state,NvmeRequest * req)392888eea45cSKlaus Jensen static uint16_t nvme_close_zone(NvmeNamespace *ns, NvmeZone *zone,
392988eea45cSKlaus Jensen                                 NvmeZoneState state, NvmeRequest *req)
393088eea45cSKlaus Jensen {
393188eea45cSKlaus Jensen     return nvme_zrm_close(ns, zone);
393288eea45cSKlaus Jensen }
393388eea45cSKlaus Jensen 
nvme_finish_zone(NvmeNamespace * ns,NvmeZone * zone,NvmeZoneState state,NvmeRequest * req)393488eea45cSKlaus Jensen static uint16_t nvme_finish_zone(NvmeNamespace *ns, NvmeZone *zone,
393588eea45cSKlaus Jensen                                  NvmeZoneState state, NvmeRequest *req)
393688eea45cSKlaus Jensen {
393788eea45cSKlaus Jensen     return nvme_zrm_finish(ns, zone);
393888eea45cSKlaus Jensen }
393988eea45cSKlaus Jensen 
nvme_offline_zone(NvmeNamespace * ns,NvmeZone * zone,NvmeZoneState state,NvmeRequest * req)394088eea45cSKlaus Jensen static uint16_t nvme_offline_zone(NvmeNamespace *ns, NvmeZone *zone,
394188eea45cSKlaus Jensen                                   NvmeZoneState state, NvmeRequest *req)
394288eea45cSKlaus Jensen {
394388eea45cSKlaus Jensen     switch (state) {
394488eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
394588eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_OFFLINE);
394688eea45cSKlaus Jensen         /* fall through */
394788eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
394888eea45cSKlaus Jensen         return NVME_SUCCESS;
394988eea45cSKlaus Jensen     default:
395088eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
395188eea45cSKlaus Jensen     }
395288eea45cSKlaus Jensen }
395388eea45cSKlaus Jensen 
nvme_set_zd_ext(NvmeNamespace * ns,NvmeZone * zone)395488eea45cSKlaus Jensen static uint16_t nvme_set_zd_ext(NvmeNamespace *ns, NvmeZone *zone)
395588eea45cSKlaus Jensen {
395688eea45cSKlaus Jensen     uint16_t status;
395788eea45cSKlaus Jensen     uint8_t state = nvme_get_zone_state(zone);
395888eea45cSKlaus Jensen 
395988eea45cSKlaus Jensen     if (state == NVME_ZONE_STATE_EMPTY) {
396088eea45cSKlaus Jensen         status = nvme_aor_check(ns, 1, 0);
396188eea45cSKlaus Jensen         if (status) {
396288eea45cSKlaus Jensen             return status;
396388eea45cSKlaus Jensen         }
396488eea45cSKlaus Jensen         nvme_aor_inc_active(ns);
396588eea45cSKlaus Jensen         zone->d.za |= NVME_ZA_ZD_EXT_VALID;
396688eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
396788eea45cSKlaus Jensen         return NVME_SUCCESS;
396888eea45cSKlaus Jensen     }
396988eea45cSKlaus Jensen 
397088eea45cSKlaus Jensen     return NVME_ZONE_INVAL_TRANSITION;
397188eea45cSKlaus Jensen }
397288eea45cSKlaus Jensen 
nvme_bulk_proc_zone(NvmeNamespace * ns,NvmeZone * zone,enum NvmeZoneProcessingMask proc_mask,op_handler_t op_hndlr,NvmeRequest * req)397388eea45cSKlaus Jensen static uint16_t nvme_bulk_proc_zone(NvmeNamespace *ns, NvmeZone *zone,
397488eea45cSKlaus Jensen                                     enum NvmeZoneProcessingMask proc_mask,
397588eea45cSKlaus Jensen                                     op_handler_t op_hndlr, NvmeRequest *req)
397688eea45cSKlaus Jensen {
397788eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
397888eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zone);
397988eea45cSKlaus Jensen     bool proc_zone;
398088eea45cSKlaus Jensen 
398188eea45cSKlaus Jensen     switch (zs) {
398288eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
398388eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
398488eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_OPENED_ZONES;
398588eea45cSKlaus Jensen         break;
398688eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
398788eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_CLOSED_ZONES;
398888eea45cSKlaus Jensen         break;
398988eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
399088eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_READ_ONLY_ZONES;
399188eea45cSKlaus Jensen         break;
399288eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
399388eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_FULL_ZONES;
399488eea45cSKlaus Jensen         break;
399588eea45cSKlaus Jensen     default:
399688eea45cSKlaus Jensen         proc_zone = false;
399788eea45cSKlaus Jensen     }
399888eea45cSKlaus Jensen 
399988eea45cSKlaus Jensen     if (proc_zone) {
400088eea45cSKlaus Jensen         status = op_hndlr(ns, zone, zs, req);
400188eea45cSKlaus Jensen     }
400288eea45cSKlaus Jensen 
400388eea45cSKlaus Jensen     return status;
400488eea45cSKlaus Jensen }
400588eea45cSKlaus Jensen 
nvme_do_zone_op(NvmeNamespace * ns,NvmeZone * zone,enum NvmeZoneProcessingMask proc_mask,op_handler_t op_hndlr,NvmeRequest * req)400688eea45cSKlaus Jensen static uint16_t nvme_do_zone_op(NvmeNamespace *ns, NvmeZone *zone,
400788eea45cSKlaus Jensen                                 enum NvmeZoneProcessingMask proc_mask,
400888eea45cSKlaus Jensen                                 op_handler_t op_hndlr, NvmeRequest *req)
400988eea45cSKlaus Jensen {
401088eea45cSKlaus Jensen     NvmeZone *next;
401188eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
401288eea45cSKlaus Jensen     int i;
401388eea45cSKlaus Jensen 
401488eea45cSKlaus Jensen     if (!proc_mask) {
401588eea45cSKlaus Jensen         status = op_hndlr(ns, zone, nvme_get_zone_state(zone), req);
401688eea45cSKlaus Jensen     } else {
401788eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_CLOSED_ZONES) {
401888eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->closed_zones, entry, next) {
401988eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
402088eea45cSKlaus Jensen                                              req);
402188eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
402288eea45cSKlaus Jensen                     goto out;
402388eea45cSKlaus Jensen                 }
402488eea45cSKlaus Jensen             }
402588eea45cSKlaus Jensen         }
402688eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_OPENED_ZONES) {
402788eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->imp_open_zones, entry, next) {
402888eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
402988eea45cSKlaus Jensen                                              req);
403088eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
403188eea45cSKlaus Jensen                     goto out;
403288eea45cSKlaus Jensen                 }
403388eea45cSKlaus Jensen             }
403488eea45cSKlaus Jensen 
403588eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->exp_open_zones, entry, next) {
403688eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
403788eea45cSKlaus Jensen                                              req);
403888eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
403988eea45cSKlaus Jensen                     goto out;
404088eea45cSKlaus Jensen                 }
404188eea45cSKlaus Jensen             }
404288eea45cSKlaus Jensen         }
404388eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_FULL_ZONES) {
404488eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->full_zones, entry, next) {
404588eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
404688eea45cSKlaus Jensen                                              req);
404788eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
404888eea45cSKlaus Jensen                     goto out;
404988eea45cSKlaus Jensen                 }
405088eea45cSKlaus Jensen             }
405188eea45cSKlaus Jensen         }
405288eea45cSKlaus Jensen 
405388eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_READ_ONLY_ZONES) {
405488eea45cSKlaus Jensen             for (i = 0; i < ns->num_zones; i++, zone++) {
405588eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
405688eea45cSKlaus Jensen                                              req);
405788eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
405888eea45cSKlaus Jensen                     goto out;
405988eea45cSKlaus Jensen                 }
406088eea45cSKlaus Jensen             }
406188eea45cSKlaus Jensen         }
406288eea45cSKlaus Jensen     }
406388eea45cSKlaus Jensen 
406488eea45cSKlaus Jensen out:
406588eea45cSKlaus Jensen     return status;
406688eea45cSKlaus Jensen }
406788eea45cSKlaus Jensen 
406863d96e4fSKlaus Jensen typedef struct NvmeZoneResetAIOCB {
406963d96e4fSKlaus Jensen     BlockAIOCB common;
407063d96e4fSKlaus Jensen     BlockAIOCB *aiocb;
407163d96e4fSKlaus Jensen     NvmeRequest *req;
407263d96e4fSKlaus Jensen     int ret;
407363d96e4fSKlaus Jensen 
407463d96e4fSKlaus Jensen     bool all;
407563d96e4fSKlaus Jensen     int idx;
407663d96e4fSKlaus Jensen     NvmeZone *zone;
407763d96e4fSKlaus Jensen } NvmeZoneResetAIOCB;
407863d96e4fSKlaus Jensen 
nvme_zone_reset_cancel(BlockAIOCB * aiocb)407963d96e4fSKlaus Jensen static void nvme_zone_reset_cancel(BlockAIOCB *aiocb)
408063d96e4fSKlaus Jensen {
408163d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = container_of(aiocb, NvmeZoneResetAIOCB, common);
408263d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
408363d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
408463d96e4fSKlaus Jensen 
408563d96e4fSKlaus Jensen     iocb->idx = ns->num_zones;
408663d96e4fSKlaus Jensen 
408763d96e4fSKlaus Jensen     iocb->ret = -ECANCELED;
408863d96e4fSKlaus Jensen 
408963d96e4fSKlaus Jensen     if (iocb->aiocb) {
409063d96e4fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
409163d96e4fSKlaus Jensen         iocb->aiocb = NULL;
409263d96e4fSKlaus Jensen     }
409363d96e4fSKlaus Jensen }
409463d96e4fSKlaus Jensen 
409563d96e4fSKlaus Jensen static const AIOCBInfo nvme_zone_reset_aiocb_info = {
409663d96e4fSKlaus Jensen     .aiocb_size = sizeof(NvmeZoneResetAIOCB),
409763d96e4fSKlaus Jensen     .cancel_async = nvme_zone_reset_cancel,
409863d96e4fSKlaus Jensen };
409963d96e4fSKlaus Jensen 
410063d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret);
410163d96e4fSKlaus Jensen 
nvme_zone_reset_epilogue_cb(void * opaque,int ret)410263d96e4fSKlaus Jensen static void nvme_zone_reset_epilogue_cb(void *opaque, int ret)
410363d96e4fSKlaus Jensen {
410463d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
410563d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
410663d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
410763d96e4fSKlaus Jensen     int64_t moff;
410863d96e4fSKlaus Jensen     int count;
410963d96e4fSKlaus Jensen 
411036a251c3SKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
411136a251c3SKlaus Jensen         goto out;
411263d96e4fSKlaus Jensen     }
411363d96e4fSKlaus Jensen 
411463d96e4fSKlaus Jensen     moff = nvme_moff(ns, iocb->zone->d.zslba);
411563d96e4fSKlaus Jensen     count = nvme_m2b(ns, ns->zone_size);
411663d96e4fSKlaus Jensen 
411763d96e4fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, moff, count,
411863d96e4fSKlaus Jensen                                         BDRV_REQ_MAY_UNMAP,
411963d96e4fSKlaus Jensen                                         nvme_zone_reset_cb, iocb);
412063d96e4fSKlaus Jensen     return;
412136a251c3SKlaus Jensen 
412236a251c3SKlaus Jensen out:
412336a251c3SKlaus Jensen     nvme_zone_reset_cb(iocb, ret);
412463d96e4fSKlaus Jensen }
412563d96e4fSKlaus Jensen 
nvme_zone_reset_cb(void * opaque,int ret)412663d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret)
412763d96e4fSKlaus Jensen {
412863d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
412963d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
413063d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
413163d96e4fSKlaus Jensen 
413236a251c3SKlaus Jensen     if (iocb->ret < 0) {
413336a251c3SKlaus Jensen         goto done;
413436a251c3SKlaus Jensen     } else if (ret < 0) {
413563d96e4fSKlaus Jensen         iocb->ret = ret;
413663d96e4fSKlaus Jensen         goto done;
413763d96e4fSKlaus Jensen     }
413863d96e4fSKlaus Jensen 
413963d96e4fSKlaus Jensen     if (iocb->zone) {
414063d96e4fSKlaus Jensen         nvme_zrm_reset(ns, iocb->zone);
414163d96e4fSKlaus Jensen 
414263d96e4fSKlaus Jensen         if (!iocb->all) {
414363d96e4fSKlaus Jensen             goto done;
414463d96e4fSKlaus Jensen         }
414563d96e4fSKlaus Jensen     }
414663d96e4fSKlaus Jensen 
414763d96e4fSKlaus Jensen     while (iocb->idx < ns->num_zones) {
414863d96e4fSKlaus Jensen         NvmeZone *zone = &ns->zone_array[iocb->idx++];
414963d96e4fSKlaus Jensen 
415063d96e4fSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
415163d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EMPTY:
415263d96e4fSKlaus Jensen             if (!iocb->all) {
415363d96e4fSKlaus Jensen                 goto done;
415463d96e4fSKlaus Jensen             }
415563d96e4fSKlaus Jensen 
415663d96e4fSKlaus Jensen             continue;
415763d96e4fSKlaus Jensen 
415863d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
415963d96e4fSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
416063d96e4fSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
416163d96e4fSKlaus Jensen         case NVME_ZONE_STATE_FULL:
416263d96e4fSKlaus Jensen             iocb->zone = zone;
416363d96e4fSKlaus Jensen             break;
416463d96e4fSKlaus Jensen 
416563d96e4fSKlaus Jensen         default:
416663d96e4fSKlaus Jensen             continue;
416763d96e4fSKlaus Jensen         }
416863d96e4fSKlaus Jensen 
416963d96e4fSKlaus Jensen         trace_pci_nvme_zns_zone_reset(zone->d.zslba);
417063d96e4fSKlaus Jensen 
417163d96e4fSKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk,
417263d96e4fSKlaus Jensen                                             nvme_l2b(ns, zone->d.zslba),
417363d96e4fSKlaus Jensen                                             nvme_l2b(ns, ns->zone_size),
417463d96e4fSKlaus Jensen                                             BDRV_REQ_MAY_UNMAP,
417563d96e4fSKlaus Jensen                                             nvme_zone_reset_epilogue_cb,
417663d96e4fSKlaus Jensen                                             iocb);
417763d96e4fSKlaus Jensen         return;
417863d96e4fSKlaus Jensen     }
417963d96e4fSKlaus Jensen 
418063d96e4fSKlaus Jensen done:
418163d96e4fSKlaus Jensen     iocb->aiocb = NULL;
418236a251c3SKlaus Jensen 
418336a251c3SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
418436a251c3SKlaus Jensen     qemu_aio_unref(iocb);
418563d96e4fSKlaus Jensen }
418663d96e4fSKlaus Jensen 
nvme_zone_mgmt_send_zrwa_flush(NvmeCtrl * n,NvmeZone * zone,uint64_t elba,NvmeRequest * req)4187e321b4cdSKlaus Jensen static uint16_t nvme_zone_mgmt_send_zrwa_flush(NvmeCtrl *n, NvmeZone *zone,
4188e321b4cdSKlaus Jensen                                                uint64_t elba, NvmeRequest *req)
4189e321b4cdSKlaus Jensen {
4190e321b4cdSKlaus Jensen     NvmeNamespace *ns = req->ns;
4191e321b4cdSKlaus Jensen     uint16_t ozcs = le16_to_cpu(ns->id_ns_zoned->ozcs);
4192e321b4cdSKlaus Jensen     uint64_t wp = zone->d.wp;
4193e321b4cdSKlaus Jensen     uint32_t nlb = elba - wp + 1;
4194e321b4cdSKlaus Jensen     uint16_t status;
4195e321b4cdSKlaus Jensen 
4196e321b4cdSKlaus Jensen 
4197e321b4cdSKlaus Jensen     if (!(ozcs & NVME_ID_NS_ZONED_OZCS_ZRWASUP)) {
4198e321b4cdSKlaus Jensen         return NVME_INVALID_ZONE_OP | NVME_DNR;
4199e321b4cdSKlaus Jensen     }
4200e321b4cdSKlaus Jensen 
4201e321b4cdSKlaus Jensen     if (!(zone->d.za & NVME_ZA_ZRWA_VALID)) {
4202e321b4cdSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4203e321b4cdSKlaus Jensen     }
4204e321b4cdSKlaus Jensen 
4205e321b4cdSKlaus Jensen     if (elba < wp || elba > wp + ns->zns.zrwas) {
4206e321b4cdSKlaus Jensen         return NVME_ZONE_BOUNDARY_ERROR | NVME_DNR;
4207e321b4cdSKlaus Jensen     }
4208e321b4cdSKlaus Jensen 
4209e321b4cdSKlaus Jensen     if (nlb % ns->zns.zrwafg) {
4210e321b4cdSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4211e321b4cdSKlaus Jensen     }
4212e321b4cdSKlaus Jensen 
4213e321b4cdSKlaus Jensen     status = nvme_zrm_auto(n, ns, zone);
4214e321b4cdSKlaus Jensen     if (status) {
4215e321b4cdSKlaus Jensen         return status;
4216e321b4cdSKlaus Jensen     }
4217e321b4cdSKlaus Jensen 
4218e321b4cdSKlaus Jensen     zone->w_ptr += nlb;
4219e321b4cdSKlaus Jensen 
4220e321b4cdSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlb);
4221e321b4cdSKlaus Jensen 
4222e321b4cdSKlaus Jensen     return NVME_SUCCESS;
4223e321b4cdSKlaus Jensen }
4224e321b4cdSKlaus Jensen 
nvme_zone_mgmt_send(NvmeCtrl * n,NvmeRequest * req)422588eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_send(NvmeCtrl *n, NvmeRequest *req)
422688eea45cSKlaus Jensen {
42276190d92fSKlaus Jensen     NvmeZoneSendCmd *cmd = (NvmeZoneSendCmd *)&req->cmd;
422888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
422988eea45cSKlaus Jensen     NvmeZone *zone;
423063d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb;
423188eea45cSKlaus Jensen     uint8_t *zd_ext;
423288eea45cSKlaus Jensen     uint64_t slba = 0;
423388eea45cSKlaus Jensen     uint32_t zone_idx = 0;
423488eea45cSKlaus Jensen     uint16_t status;
42356190d92fSKlaus Jensen     uint8_t action = cmd->zsa;
423688eea45cSKlaus Jensen     bool all;
423788eea45cSKlaus Jensen     enum NvmeZoneProcessingMask proc_mask = NVME_PROC_CURRENT_ZONE;
423888eea45cSKlaus Jensen 
42396190d92fSKlaus Jensen     all = cmd->zsflags & NVME_ZSFLAG_SELECT_ALL;
424088eea45cSKlaus Jensen 
424188eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
424288eea45cSKlaus Jensen 
424388eea45cSKlaus Jensen     if (!all) {
42446190d92fSKlaus Jensen         status = nvme_get_mgmt_zone_slba_idx(ns, &req->cmd, &slba, &zone_idx);
424588eea45cSKlaus Jensen         if (status) {
424688eea45cSKlaus Jensen             return status;
424788eea45cSKlaus Jensen         }
424888eea45cSKlaus Jensen     }
424988eea45cSKlaus Jensen 
425088eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
4251e321b4cdSKlaus Jensen     if (slba != zone->d.zslba && action != NVME_ZONE_ACTION_ZRWA_FLUSH) {
425288eea45cSKlaus Jensen         trace_pci_nvme_err_unaligned_zone_cmd(action, slba, zone->d.zslba);
425388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
425488eea45cSKlaus Jensen     }
425588eea45cSKlaus Jensen 
425688eea45cSKlaus Jensen     switch (action) {
425788eea45cSKlaus Jensen 
425888eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OPEN:
425988eea45cSKlaus Jensen         if (all) {
426088eea45cSKlaus Jensen             proc_mask = NVME_PROC_CLOSED_ZONES;
426188eea45cSKlaus Jensen         }
426288eea45cSKlaus Jensen         trace_pci_nvme_open_zone(slba, zone_idx, all);
426388eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_open_zone, req);
426488eea45cSKlaus Jensen         break;
426588eea45cSKlaus Jensen 
426688eea45cSKlaus Jensen     case NVME_ZONE_ACTION_CLOSE:
426788eea45cSKlaus Jensen         if (all) {
426888eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES;
426988eea45cSKlaus Jensen         }
427088eea45cSKlaus Jensen         trace_pci_nvme_close_zone(slba, zone_idx, all);
427188eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_close_zone, req);
427288eea45cSKlaus Jensen         break;
427388eea45cSKlaus Jensen 
427488eea45cSKlaus Jensen     case NVME_ZONE_ACTION_FINISH:
427588eea45cSKlaus Jensen         if (all) {
427688eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES | NVME_PROC_CLOSED_ZONES;
427788eea45cSKlaus Jensen         }
427888eea45cSKlaus Jensen         trace_pci_nvme_finish_zone(slba, zone_idx, all);
427988eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_finish_zone, req);
428088eea45cSKlaus Jensen         break;
428188eea45cSKlaus Jensen 
428288eea45cSKlaus Jensen     case NVME_ZONE_ACTION_RESET:
428388eea45cSKlaus Jensen         trace_pci_nvme_reset_zone(slba, zone_idx, all);
428488eea45cSKlaus Jensen 
428563d96e4fSKlaus Jensen         iocb = blk_aio_get(&nvme_zone_reset_aiocb_info, ns->blkconf.blk,
428663d96e4fSKlaus Jensen                            nvme_misc_cb, req);
428788eea45cSKlaus Jensen 
428863d96e4fSKlaus Jensen         iocb->req = req;
428963d96e4fSKlaus Jensen         iocb->ret = 0;
429063d96e4fSKlaus Jensen         iocb->all = all;
429163d96e4fSKlaus Jensen         iocb->idx = zone_idx;
429263d96e4fSKlaus Jensen         iocb->zone = NULL;
429388eea45cSKlaus Jensen 
429463d96e4fSKlaus Jensen         req->aiocb = &iocb->common;
429563d96e4fSKlaus Jensen         nvme_zone_reset_cb(iocb, 0);
429688eea45cSKlaus Jensen 
429763d96e4fSKlaus Jensen         return NVME_NO_COMPLETE;
429888eea45cSKlaus Jensen 
429988eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OFFLINE:
430088eea45cSKlaus Jensen         if (all) {
430188eea45cSKlaus Jensen             proc_mask = NVME_PROC_READ_ONLY_ZONES;
430288eea45cSKlaus Jensen         }
430388eea45cSKlaus Jensen         trace_pci_nvme_offline_zone(slba, zone_idx, all);
430488eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_offline_zone, req);
430588eea45cSKlaus Jensen         break;
430688eea45cSKlaus Jensen 
430788eea45cSKlaus Jensen     case NVME_ZONE_ACTION_SET_ZD_EXT:
430888eea45cSKlaus Jensen         trace_pci_nvme_set_descriptor_extension(slba, zone_idx);
430988eea45cSKlaus Jensen         if (all || !ns->params.zd_extension_size) {
431088eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
431188eea45cSKlaus Jensen         }
431288eea45cSKlaus Jensen         zd_ext = nvme_get_zd_extension(ns, zone_idx);
431388eea45cSKlaus Jensen         status = nvme_h2c(n, zd_ext, ns->params.zd_extension_size, req);
431488eea45cSKlaus Jensen         if (status) {
431588eea45cSKlaus Jensen             trace_pci_nvme_err_zd_extension_map_error(zone_idx);
431688eea45cSKlaus Jensen             return status;
431788eea45cSKlaus Jensen         }
431888eea45cSKlaus Jensen 
431988eea45cSKlaus Jensen         status = nvme_set_zd_ext(ns, zone);
432088eea45cSKlaus Jensen         if (status == NVME_SUCCESS) {
432188eea45cSKlaus Jensen             trace_pci_nvme_zd_extension_set(zone_idx);
432288eea45cSKlaus Jensen             return status;
432388eea45cSKlaus Jensen         }
432488eea45cSKlaus Jensen         break;
432588eea45cSKlaus Jensen 
4326e321b4cdSKlaus Jensen     case NVME_ZONE_ACTION_ZRWA_FLUSH:
4327e321b4cdSKlaus Jensen         if (all) {
4328e321b4cdSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
4329e321b4cdSKlaus Jensen         }
4330e321b4cdSKlaus Jensen 
4331e321b4cdSKlaus Jensen         return nvme_zone_mgmt_send_zrwa_flush(n, zone, slba, req);
4332e321b4cdSKlaus Jensen 
433388eea45cSKlaus Jensen     default:
433488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_mgmt_action(action);
433588eea45cSKlaus Jensen         status = NVME_INVALID_FIELD;
433688eea45cSKlaus Jensen     }
433788eea45cSKlaus Jensen 
433888eea45cSKlaus Jensen     if (status == NVME_ZONE_INVAL_TRANSITION) {
433988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_zone_state_transition(action, slba,
434088eea45cSKlaus Jensen                                                          zone->d.za);
434188eea45cSKlaus Jensen     }
434288eea45cSKlaus Jensen     if (status) {
434388eea45cSKlaus Jensen         status |= NVME_DNR;
434488eea45cSKlaus Jensen     }
434588eea45cSKlaus Jensen 
434688eea45cSKlaus Jensen     return status;
434788eea45cSKlaus Jensen }
434888eea45cSKlaus Jensen 
nvme_zone_matches_filter(uint32_t zafs,NvmeZone * zl)434988eea45cSKlaus Jensen static bool nvme_zone_matches_filter(uint32_t zafs, NvmeZone *zl)
435088eea45cSKlaus Jensen {
435188eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zl);
435288eea45cSKlaus Jensen 
435388eea45cSKlaus Jensen     switch (zafs) {
435488eea45cSKlaus Jensen     case NVME_ZONE_REPORT_ALL:
435588eea45cSKlaus Jensen         return true;
435688eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EMPTY:
435788eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EMPTY;
435888eea45cSKlaus Jensen     case NVME_ZONE_REPORT_IMPLICITLY_OPEN:
435988eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_IMPLICITLY_OPEN;
436088eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EXPLICITLY_OPEN:
436188eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EXPLICITLY_OPEN;
436288eea45cSKlaus Jensen     case NVME_ZONE_REPORT_CLOSED:
436388eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_CLOSED;
436488eea45cSKlaus Jensen     case NVME_ZONE_REPORT_FULL:
436588eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_FULL;
436688eea45cSKlaus Jensen     case NVME_ZONE_REPORT_READ_ONLY:
436788eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_READ_ONLY;
436888eea45cSKlaus Jensen     case NVME_ZONE_REPORT_OFFLINE:
436988eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_OFFLINE;
437088eea45cSKlaus Jensen     default:
437188eea45cSKlaus Jensen         return false;
437288eea45cSKlaus Jensen     }
437388eea45cSKlaus Jensen }
437488eea45cSKlaus Jensen 
nvme_zone_mgmt_recv(NvmeCtrl * n,NvmeRequest * req)437588eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_recv(NvmeCtrl *n, NvmeRequest *req)
437688eea45cSKlaus Jensen {
43774ea3de93SYao Xingtao     NvmeCmd *cmd = &req->cmd;
437888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
437988eea45cSKlaus Jensen     /* cdw12 is zero-based number of dwords to return. Convert to bytes */
438088eea45cSKlaus Jensen     uint32_t data_size = (le32_to_cpu(cmd->cdw12) + 1) << 2;
438188eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
438288eea45cSKlaus Jensen     uint32_t zone_idx, zra, zrasf, partial;
438388eea45cSKlaus Jensen     uint64_t max_zones, nr_zones = 0;
438488eea45cSKlaus Jensen     uint16_t status;
438588eea45cSKlaus Jensen     uint64_t slba;
438688eea45cSKlaus Jensen     NvmeZoneDescr *z;
438788eea45cSKlaus Jensen     NvmeZone *zone;
438888eea45cSKlaus Jensen     NvmeZoneReportHeader *header;
438988eea45cSKlaus Jensen     void *buf, *buf_p;
439088eea45cSKlaus Jensen     size_t zone_entry_sz;
439188eea45cSKlaus Jensen     int i;
439288eea45cSKlaus Jensen 
439388eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
439488eea45cSKlaus Jensen 
439588eea45cSKlaus Jensen     status = nvme_get_mgmt_zone_slba_idx(ns, cmd, &slba, &zone_idx);
439688eea45cSKlaus Jensen     if (status) {
439788eea45cSKlaus Jensen         return status;
439888eea45cSKlaus Jensen     }
439988eea45cSKlaus Jensen 
440088eea45cSKlaus Jensen     zra = dw13 & 0xff;
440188eea45cSKlaus Jensen     if (zra != NVME_ZONE_REPORT && zra != NVME_ZONE_REPORT_EXTENDED) {
440288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
440388eea45cSKlaus Jensen     }
440488eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED && !ns->params.zd_extension_size) {
440588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
440688eea45cSKlaus Jensen     }
440788eea45cSKlaus Jensen 
440888eea45cSKlaus Jensen     zrasf = (dw13 >> 8) & 0xff;
440988eea45cSKlaus Jensen     if (zrasf > NVME_ZONE_REPORT_OFFLINE) {
441088eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
441188eea45cSKlaus Jensen     }
441288eea45cSKlaus Jensen 
441388eea45cSKlaus Jensen     if (data_size < sizeof(NvmeZoneReportHeader)) {
441488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
441588eea45cSKlaus Jensen     }
441688eea45cSKlaus Jensen 
441788eea45cSKlaus Jensen     status = nvme_check_mdts(n, data_size);
441888eea45cSKlaus Jensen     if (status) {
441988eea45cSKlaus Jensen         return status;
442088eea45cSKlaus Jensen     }
442188eea45cSKlaus Jensen 
442288eea45cSKlaus Jensen     partial = (dw13 >> 16) & 0x01;
442388eea45cSKlaus Jensen 
442488eea45cSKlaus Jensen     zone_entry_sz = sizeof(NvmeZoneDescr);
442588eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED) {
442688eea45cSKlaus Jensen         zone_entry_sz += ns->params.zd_extension_size;
442788eea45cSKlaus Jensen     }
442888eea45cSKlaus Jensen 
442988eea45cSKlaus Jensen     max_zones = (data_size - sizeof(NvmeZoneReportHeader)) / zone_entry_sz;
443088eea45cSKlaus Jensen     buf = g_malloc0(data_size);
443188eea45cSKlaus Jensen 
443288eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
443388eea45cSKlaus Jensen     for (i = zone_idx; i < ns->num_zones; i++) {
443488eea45cSKlaus Jensen         if (partial && nr_zones >= max_zones) {
443588eea45cSKlaus Jensen             break;
443688eea45cSKlaus Jensen         }
443788eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone++)) {
443888eea45cSKlaus Jensen             nr_zones++;
443988eea45cSKlaus Jensen         }
444088eea45cSKlaus Jensen     }
44413d558330SMarkus Armbruster     header = buf;
444288eea45cSKlaus Jensen     header->nr_zones = cpu_to_le64(nr_zones);
444388eea45cSKlaus Jensen 
444488eea45cSKlaus Jensen     buf_p = buf + sizeof(NvmeZoneReportHeader);
444588eea45cSKlaus Jensen     for (; zone_idx < ns->num_zones && max_zones > 0; zone_idx++) {
444688eea45cSKlaus Jensen         zone = &ns->zone_array[zone_idx];
444788eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone)) {
44483d558330SMarkus Armbruster             z = buf_p;
444988eea45cSKlaus Jensen             buf_p += sizeof(NvmeZoneDescr);
445088eea45cSKlaus Jensen 
445188eea45cSKlaus Jensen             z->zt = zone->d.zt;
445288eea45cSKlaus Jensen             z->zs = zone->d.zs;
445388eea45cSKlaus Jensen             z->zcap = cpu_to_le64(zone->d.zcap);
445488eea45cSKlaus Jensen             z->zslba = cpu_to_le64(zone->d.zslba);
445588eea45cSKlaus Jensen             z->za = zone->d.za;
445688eea45cSKlaus Jensen 
445788eea45cSKlaus Jensen             if (nvme_wp_is_valid(zone)) {
445888eea45cSKlaus Jensen                 z->wp = cpu_to_le64(zone->d.wp);
445988eea45cSKlaus Jensen             } else {
446088eea45cSKlaus Jensen                 z->wp = cpu_to_le64(~0ULL);
446188eea45cSKlaus Jensen             }
446288eea45cSKlaus Jensen 
446388eea45cSKlaus Jensen             if (zra == NVME_ZONE_REPORT_EXTENDED) {
446488eea45cSKlaus Jensen                 if (zone->d.za & NVME_ZA_ZD_EXT_VALID) {
446588eea45cSKlaus Jensen                     memcpy(buf_p, nvme_get_zd_extension(ns, zone_idx),
446688eea45cSKlaus Jensen                            ns->params.zd_extension_size);
446788eea45cSKlaus Jensen                 }
446888eea45cSKlaus Jensen                 buf_p += ns->params.zd_extension_size;
446988eea45cSKlaus Jensen             }
447088eea45cSKlaus Jensen 
447188eea45cSKlaus Jensen             max_zones--;
447288eea45cSKlaus Jensen         }
447388eea45cSKlaus Jensen     }
447488eea45cSKlaus Jensen 
447588eea45cSKlaus Jensen     status = nvme_c2h(n, (uint8_t *)buf, data_size, req);
447688eea45cSKlaus Jensen 
447788eea45cSKlaus Jensen     g_free(buf);
447888eea45cSKlaus Jensen 
447988eea45cSKlaus Jensen     return status;
448088eea45cSKlaus Jensen }
448188eea45cSKlaus Jensen 
nvme_io_mgmt_recv_ruhs(NvmeCtrl * n,NvmeRequest * req,size_t len)448273064edfSJesper Devantier static uint16_t nvme_io_mgmt_recv_ruhs(NvmeCtrl *n, NvmeRequest *req,
448373064edfSJesper Devantier                                        size_t len)
448473064edfSJesper Devantier {
448573064edfSJesper Devantier     NvmeNamespace *ns = req->ns;
448673064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
448773064edfSJesper Devantier     NvmeRuhStatus *hdr;
448873064edfSJesper Devantier     NvmeRuhStatusDescr *ruhsd;
448973064edfSJesper Devantier     unsigned int nruhsd;
449073064edfSJesper Devantier     uint16_t rg, ph, *ruhid;
449173064edfSJesper Devantier     size_t trans_len;
449273064edfSJesper Devantier     g_autofree uint8_t *buf = NULL;
449373064edfSJesper Devantier 
449473064edfSJesper Devantier     if (!n->subsys) {
449573064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
449673064edfSJesper Devantier     }
449773064edfSJesper Devantier 
449873064edfSJesper Devantier     if (ns->params.nsid == 0 || ns->params.nsid == 0xffffffff) {
449973064edfSJesper Devantier         return NVME_INVALID_NSID | NVME_DNR;
450073064edfSJesper Devantier     }
450173064edfSJesper Devantier 
450273064edfSJesper Devantier     if (!n->subsys->endgrp.fdp.enabled) {
450373064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
450473064edfSJesper Devantier     }
450573064edfSJesper Devantier 
450673064edfSJesper Devantier     endgrp = ns->endgrp;
450773064edfSJesper Devantier 
450873064edfSJesper Devantier     nruhsd = ns->fdp.nphs * endgrp->fdp.nrg;
450973064edfSJesper Devantier     trans_len = sizeof(NvmeRuhStatus) + nruhsd * sizeof(NvmeRuhStatusDescr);
45106a22121cSKlaus Jensen     buf = g_malloc0(trans_len);
451173064edfSJesper Devantier 
451273064edfSJesper Devantier     trans_len = MIN(trans_len, len);
451373064edfSJesper Devantier 
451473064edfSJesper Devantier     hdr = (NvmeRuhStatus *)buf;
451573064edfSJesper Devantier     ruhsd = (NvmeRuhStatusDescr *)(buf + sizeof(NvmeRuhStatus));
451673064edfSJesper Devantier 
451773064edfSJesper Devantier     hdr->nruhsd = cpu_to_le16(nruhsd);
451873064edfSJesper Devantier 
451973064edfSJesper Devantier     ruhid = ns->fdp.phs;
452073064edfSJesper Devantier 
452173064edfSJesper Devantier     for (ph = 0; ph < ns->fdp.nphs; ph++, ruhid++) {
452273064edfSJesper Devantier         NvmeRuHandle *ruh = &endgrp->fdp.ruhs[*ruhid];
452373064edfSJesper Devantier 
452473064edfSJesper Devantier         for (rg = 0; rg < endgrp->fdp.nrg; rg++, ruhsd++) {
452573064edfSJesper Devantier             uint16_t pid = nvme_make_pid(ns, rg, ph);
452673064edfSJesper Devantier 
452773064edfSJesper Devantier             ruhsd->pid = cpu_to_le16(pid);
452873064edfSJesper Devantier             ruhsd->ruhid = *ruhid;
452973064edfSJesper Devantier             ruhsd->earutr = 0;
453073064edfSJesper Devantier             ruhsd->ruamw = cpu_to_le64(ruh->rus[rg].ruamw);
453173064edfSJesper Devantier         }
453273064edfSJesper Devantier     }
453373064edfSJesper Devantier 
453473064edfSJesper Devantier     return nvme_c2h(n, buf, trans_len, req);
453573064edfSJesper Devantier }
453673064edfSJesper Devantier 
nvme_io_mgmt_recv(NvmeCtrl * n,NvmeRequest * req)453773064edfSJesper Devantier static uint16_t nvme_io_mgmt_recv(NvmeCtrl *n, NvmeRequest *req)
453873064edfSJesper Devantier {
453973064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
454073064edfSJesper Devantier     uint32_t cdw10 = le32_to_cpu(cmd->cdw10);
454173064edfSJesper Devantier     uint32_t numd = le32_to_cpu(cmd->cdw11);
454273064edfSJesper Devantier     uint8_t mo = (cdw10 & 0xff);
454373064edfSJesper Devantier     size_t len = (numd + 1) << 2;
454473064edfSJesper Devantier 
454573064edfSJesper Devantier     switch (mo) {
454673064edfSJesper Devantier     case NVME_IOMR_MO_NOP:
454773064edfSJesper Devantier         return 0;
454873064edfSJesper Devantier     case NVME_IOMR_MO_RUH_STATUS:
454973064edfSJesper Devantier         return nvme_io_mgmt_recv_ruhs(n, req, len);
455073064edfSJesper Devantier     default:
455173064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
455273064edfSJesper Devantier     };
455373064edfSJesper Devantier }
455473064edfSJesper Devantier 
nvme_io_mgmt_send_ruh_update(NvmeCtrl * n,NvmeRequest * req)455573064edfSJesper Devantier static uint16_t nvme_io_mgmt_send_ruh_update(NvmeCtrl *n, NvmeRequest *req)
455673064edfSJesper Devantier {
455773064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
455873064edfSJesper Devantier     NvmeNamespace *ns = req->ns;
455973064edfSJesper Devantier     uint32_t cdw10 = le32_to_cpu(cmd->cdw10);
456073064edfSJesper Devantier     uint16_t ret = NVME_SUCCESS;
45613936bbdfSVincent Fu     uint32_t npid = (cdw10 >> 16) + 1;
456273064edfSJesper Devantier     unsigned int i = 0;
456373064edfSJesper Devantier     g_autofree uint16_t *pids = NULL;
45643439ba9cSKlaus Jensen     uint32_t maxnpid;
45653439ba9cSKlaus Jensen 
45663439ba9cSKlaus Jensen     if (!ns->endgrp || !ns->endgrp->fdp.enabled) {
45673439ba9cSKlaus Jensen         return NVME_FDP_DISABLED | NVME_DNR;
45683439ba9cSKlaus Jensen     }
45693439ba9cSKlaus Jensen 
45703439ba9cSKlaus Jensen     maxnpid = n->subsys->endgrp.fdp.nrg * n->subsys->endgrp.fdp.nruh;
457173064edfSJesper Devantier 
457273064edfSJesper Devantier     if (unlikely(npid >= MIN(NVME_FDP_MAXPIDS, maxnpid))) {
457373064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
457473064edfSJesper Devantier     }
457573064edfSJesper Devantier 
457673064edfSJesper Devantier     pids = g_new(uint16_t, npid);
457773064edfSJesper Devantier 
457873064edfSJesper Devantier     ret = nvme_h2c(n, pids, npid * sizeof(uint16_t), req);
457973064edfSJesper Devantier     if (ret) {
458073064edfSJesper Devantier         return ret;
458173064edfSJesper Devantier     }
458273064edfSJesper Devantier 
458373064edfSJesper Devantier     for (; i < npid; i++) {
458473064edfSJesper Devantier         if (!nvme_update_ruh(n, ns, pids[i])) {
458573064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
458673064edfSJesper Devantier         }
458773064edfSJesper Devantier     }
458873064edfSJesper Devantier 
458973064edfSJesper Devantier     return ret;
459073064edfSJesper Devantier }
459173064edfSJesper Devantier 
nvme_io_mgmt_send(NvmeCtrl * n,NvmeRequest * req)459273064edfSJesper Devantier static uint16_t nvme_io_mgmt_send(NvmeCtrl *n, NvmeRequest *req)
459373064edfSJesper Devantier {
459473064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
459573064edfSJesper Devantier     uint32_t cdw10 = le32_to_cpu(cmd->cdw10);
459673064edfSJesper Devantier     uint8_t mo = (cdw10 & 0xff);
459773064edfSJesper Devantier 
459873064edfSJesper Devantier     switch (mo) {
459973064edfSJesper Devantier     case NVME_IOMS_MO_NOP:
460073064edfSJesper Devantier         return 0;
460173064edfSJesper Devantier     case NVME_IOMS_MO_RUH_UPDATE:
460273064edfSJesper Devantier         return nvme_io_mgmt_send_ruh_update(n, req);
460373064edfSJesper Devantier     default:
460473064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
460573064edfSJesper Devantier     };
460673064edfSJesper Devantier }
460773064edfSJesper Devantier 
nvme_io_cmd(NvmeCtrl * n,NvmeRequest * req)460888eea45cSKlaus Jensen static uint16_t nvme_io_cmd(NvmeCtrl *n, NvmeRequest *req)
460988eea45cSKlaus Jensen {
461088eea45cSKlaus Jensen     NvmeNamespace *ns;
461188eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
461288eea45cSKlaus Jensen 
461388eea45cSKlaus Jensen     trace_pci_nvme_io_cmd(nvme_cid(req), nsid, nvme_sqid(req),
461488eea45cSKlaus Jensen                           req->cmd.opcode, nvme_io_opc_str(req->cmd.opcode));
461588eea45cSKlaus Jensen 
461688eea45cSKlaus Jensen     /*
461788eea45cSKlaus Jensen      * In the base NVM command set, Flush may apply to all namespaces
461888eea45cSKlaus Jensen      * (indicated by NSID being set to FFFFFFFFh). But if that feature is used
461988eea45cSKlaus Jensen      * along with TP 4056 (Namespace Types), it may be pretty screwed up.
462088eea45cSKlaus Jensen      *
462188eea45cSKlaus Jensen      * If NSID is indeed set to FFFFFFFFh, we simply cannot associate the
462288eea45cSKlaus Jensen      * opcode with a specific command since we cannot determine a unique I/O
462388eea45cSKlaus Jensen      * command set. Opcode 0h could have any other meaning than something
462488eea45cSKlaus Jensen      * equivalent to flushing and say it DOES have completely different
462588eea45cSKlaus Jensen      * semantics in some other command set - does an NSID of FFFFFFFFh then
462688eea45cSKlaus Jensen      * mean "for all namespaces, apply whatever command set specific command
462788eea45cSKlaus Jensen      * that uses the 0h opcode?" Or does it mean "for all namespaces, apply
462888eea45cSKlaus Jensen      * whatever command that uses the 0h opcode if, and only if, it allows NSID
462988eea45cSKlaus Jensen      * to be FFFFFFFFh"?
463088eea45cSKlaus Jensen      *
463188eea45cSKlaus Jensen      * Anyway (and luckily), for now, we do not care about this since the
463288eea45cSKlaus Jensen      * device only supports namespace types that includes the NVM Flush command
463388eea45cSKlaus Jensen      * (NVM and Zoned), so always do an NVM Flush.
463488eea45cSKlaus Jensen      */
4635d522aef8SArun Kumar 
463688eea45cSKlaus Jensen     if (req->cmd.opcode == NVME_CMD_FLUSH) {
463788eea45cSKlaus Jensen         return nvme_flush(n, req);
463888eea45cSKlaus Jensen     }
463988eea45cSKlaus Jensen 
4640d522aef8SArun Kumar     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
4641d522aef8SArun Kumar         return NVME_INVALID_NSID | NVME_DNR;
4642d522aef8SArun Kumar     }
4643d522aef8SArun Kumar 
464488eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
464588eea45cSKlaus Jensen     if (unlikely(!ns)) {
464688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
464788eea45cSKlaus Jensen     }
464888eea45cSKlaus Jensen 
464988eea45cSKlaus Jensen     if (!(ns->iocs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
465088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(req->cmd.opcode);
465188eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
465288eea45cSKlaus Jensen     }
465388eea45cSKlaus Jensen 
465488eea45cSKlaus Jensen     if (ns->status) {
465588eea45cSKlaus Jensen         return ns->status;
465688eea45cSKlaus Jensen     }
465788eea45cSKlaus Jensen 
4658c53a9a91SPankaj Raghav     if (NVME_CMD_FLAGS_FUSE(req->cmd.flags)) {
4659c53a9a91SPankaj Raghav         return NVME_INVALID_FIELD;
4660c53a9a91SPankaj Raghav     }
4661c53a9a91SPankaj Raghav 
466288eea45cSKlaus Jensen     req->ns = ns;
466388eea45cSKlaus Jensen 
466488eea45cSKlaus Jensen     switch (req->cmd.opcode) {
466588eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
466688eea45cSKlaus Jensen         return nvme_write_zeroes(n, req);
466788eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
466888eea45cSKlaus Jensen         return nvme_zone_append(n, req);
466988eea45cSKlaus Jensen     case NVME_CMD_WRITE:
467088eea45cSKlaus Jensen         return nvme_write(n, req);
467188eea45cSKlaus Jensen     case NVME_CMD_READ:
467288eea45cSKlaus Jensen         return nvme_read(n, req);
467388eea45cSKlaus Jensen     case NVME_CMD_COMPARE:
467488eea45cSKlaus Jensen         return nvme_compare(n, req);
467588eea45cSKlaus Jensen     case NVME_CMD_DSM:
467688eea45cSKlaus Jensen         return nvme_dsm(n, req);
467788eea45cSKlaus Jensen     case NVME_CMD_VERIFY:
467888eea45cSKlaus Jensen         return nvme_verify(n, req);
467988eea45cSKlaus Jensen     case NVME_CMD_COPY:
468088eea45cSKlaus Jensen         return nvme_copy(n, req);
468188eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_SEND:
468288eea45cSKlaus Jensen         return nvme_zone_mgmt_send(n, req);
468388eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_RECV:
468488eea45cSKlaus Jensen         return nvme_zone_mgmt_recv(n, req);
468573064edfSJesper Devantier     case NVME_CMD_IO_MGMT_RECV:
468673064edfSJesper Devantier         return nvme_io_mgmt_recv(n, req);
468773064edfSJesper Devantier     case NVME_CMD_IO_MGMT_SEND:
468873064edfSJesper Devantier         return nvme_io_mgmt_send(n, req);
468988eea45cSKlaus Jensen     default:
46907f2acdfbSPierrick Bouvier         g_assert_not_reached();
469188eea45cSKlaus Jensen     }
469288eea45cSKlaus Jensen 
469388eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
469488eea45cSKlaus Jensen }
469588eea45cSKlaus Jensen 
nvme_cq_notifier(EventNotifier * e)46962e53b0b4SJinhao Fan static void nvme_cq_notifier(EventNotifier *e)
46972e53b0b4SJinhao Fan {
46982e53b0b4SJinhao Fan     NvmeCQueue *cq = container_of(e, NvmeCQueue, notifier);
46992e53b0b4SJinhao Fan     NvmeCtrl *n = cq->ctrl;
47002e53b0b4SJinhao Fan 
4701a2da7377SKlaus Jensen     if (!event_notifier_test_and_clear(e)) {
4702a2da7377SKlaus Jensen         return;
4703a2da7377SKlaus Jensen     }
47042e53b0b4SJinhao Fan 
47052e53b0b4SJinhao Fan     nvme_update_cq_head(cq);
47062e53b0b4SJinhao Fan 
47072e53b0b4SJinhao Fan     if (cq->tail == cq->head) {
47082e53b0b4SJinhao Fan         if (cq->irq_enabled) {
47092e53b0b4SJinhao Fan             n->cq_pending--;
47102e53b0b4SJinhao Fan         }
47112e53b0b4SJinhao Fan 
47122e53b0b4SJinhao Fan         nvme_irq_deassert(n, cq);
47132e53b0b4SJinhao Fan     }
47142e53b0b4SJinhao Fan 
4715d38cc6fdSKlaus Jensen     qemu_bh_schedule(cq->bh);
47162e53b0b4SJinhao Fan }
47172e53b0b4SJinhao Fan 
nvme_init_cq_ioeventfd(NvmeCQueue * cq)47182e53b0b4SJinhao Fan static int nvme_init_cq_ioeventfd(NvmeCQueue *cq)
47192e53b0b4SJinhao Fan {
47202e53b0b4SJinhao Fan     NvmeCtrl *n = cq->ctrl;
47212e53b0b4SJinhao Fan     uint16_t offset = (cq->cqid << 3) + (1 << 2);
47222e53b0b4SJinhao Fan     int ret;
47232e53b0b4SJinhao Fan 
47242e53b0b4SJinhao Fan     ret = event_notifier_init(&cq->notifier, 0);
47252e53b0b4SJinhao Fan     if (ret < 0) {
47262e53b0b4SJinhao Fan         return ret;
47272e53b0b4SJinhao Fan     }
47282e53b0b4SJinhao Fan 
47292e53b0b4SJinhao Fan     event_notifier_set_handler(&cq->notifier, nvme_cq_notifier);
47302e53b0b4SJinhao Fan     memory_region_add_eventfd(&n->iomem,
47312e53b0b4SJinhao Fan                               0x1000 + offset, 4, false, 0, &cq->notifier);
47322e53b0b4SJinhao Fan 
47332e53b0b4SJinhao Fan     return 0;
47342e53b0b4SJinhao Fan }
47352e53b0b4SJinhao Fan 
nvme_sq_notifier(EventNotifier * e)47362e53b0b4SJinhao Fan static void nvme_sq_notifier(EventNotifier *e)
47372e53b0b4SJinhao Fan {
47382e53b0b4SJinhao Fan     NvmeSQueue *sq = container_of(e, NvmeSQueue, notifier);
47392e53b0b4SJinhao Fan 
4740a2da7377SKlaus Jensen     if (!event_notifier_test_and_clear(e)) {
4741a2da7377SKlaus Jensen         return;
4742a2da7377SKlaus Jensen     }
47432e53b0b4SJinhao Fan 
47442e53b0b4SJinhao Fan     nvme_process_sq(sq);
47452e53b0b4SJinhao Fan }
47462e53b0b4SJinhao Fan 
nvme_init_sq_ioeventfd(NvmeSQueue * sq)47472e53b0b4SJinhao Fan static int nvme_init_sq_ioeventfd(NvmeSQueue *sq)
47482e53b0b4SJinhao Fan {
47492e53b0b4SJinhao Fan     NvmeCtrl *n = sq->ctrl;
47502e53b0b4SJinhao Fan     uint16_t offset = sq->sqid << 3;
47512e53b0b4SJinhao Fan     int ret;
47522e53b0b4SJinhao Fan 
47532e53b0b4SJinhao Fan     ret = event_notifier_init(&sq->notifier, 0);
47542e53b0b4SJinhao Fan     if (ret < 0) {
47552e53b0b4SJinhao Fan         return ret;
47562e53b0b4SJinhao Fan     }
47572e53b0b4SJinhao Fan 
47582e53b0b4SJinhao Fan     event_notifier_set_handler(&sq->notifier, nvme_sq_notifier);
47592e53b0b4SJinhao Fan     memory_region_add_eventfd(&n->iomem,
47602e53b0b4SJinhao Fan                               0x1000 + offset, 4, false, 0, &sq->notifier);
47612e53b0b4SJinhao Fan 
47622e53b0b4SJinhao Fan     return 0;
47632e53b0b4SJinhao Fan }
47642e53b0b4SJinhao Fan 
nvme_free_sq(NvmeSQueue * sq,NvmeCtrl * n)476588eea45cSKlaus Jensen static void nvme_free_sq(NvmeSQueue *sq, NvmeCtrl *n)
476688eea45cSKlaus Jensen {
47672e53b0b4SJinhao Fan     uint16_t offset = sq->sqid << 3;
47682e53b0b4SJinhao Fan 
476988eea45cSKlaus Jensen     n->sq[sq->sqid] = NULL;
4770d38cc6fdSKlaus Jensen     qemu_bh_delete(sq->bh);
47712e53b0b4SJinhao Fan     if (sq->ioeventfd_enabled) {
47722e53b0b4SJinhao Fan         memory_region_del_eventfd(&n->iomem,
47732e53b0b4SJinhao Fan                                   0x1000 + offset, 4, false, 0, &sq->notifier);
477404e8da88SKlaus Jensen         event_notifier_set_handler(&sq->notifier, NULL);
47752e53b0b4SJinhao Fan         event_notifier_cleanup(&sq->notifier);
47762e53b0b4SJinhao Fan     }
477788eea45cSKlaus Jensen     g_free(sq->io_req);
477888eea45cSKlaus Jensen     if (sq->sqid) {
477988eea45cSKlaus Jensen         g_free(sq);
478088eea45cSKlaus Jensen     }
478188eea45cSKlaus Jensen }
478288eea45cSKlaus Jensen 
nvme_del_sq(NvmeCtrl * n,NvmeRequest * req)478388eea45cSKlaus Jensen static uint16_t nvme_del_sq(NvmeCtrl *n, NvmeRequest *req)
478488eea45cSKlaus Jensen {
478588eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
478688eea45cSKlaus Jensen     NvmeRequest *r, *next;
478788eea45cSKlaus Jensen     NvmeSQueue *sq;
478888eea45cSKlaus Jensen     NvmeCQueue *cq;
478988eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
479088eea45cSKlaus Jensen 
479188eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_sqid(n, qid))) {
479288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_sq(qid);
479388eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
479488eea45cSKlaus Jensen     }
479588eea45cSKlaus Jensen 
479688eea45cSKlaus Jensen     trace_pci_nvme_del_sq(qid);
479788eea45cSKlaus Jensen 
479888eea45cSKlaus Jensen     sq = n->sq[qid];
479988eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&sq->out_req_list)) {
480088eea45cSKlaus Jensen         r = QTAILQ_FIRST(&sq->out_req_list);
4801e76fb260SKlaus Jensen         assert(r->aiocb);
480288eea45cSKlaus Jensen         blk_aio_cancel(r->aiocb);
480388eea45cSKlaus Jensen     }
480488eea45cSKlaus Jensen 
480588eea45cSKlaus Jensen     assert(QTAILQ_EMPTY(&sq->out_req_list));
480688eea45cSKlaus Jensen 
480788eea45cSKlaus Jensen     if (!nvme_check_cqid(n, sq->cqid)) {
480888eea45cSKlaus Jensen         cq = n->cq[sq->cqid];
480988eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->sq_list, sq, entry);
481088eea45cSKlaus Jensen 
481188eea45cSKlaus Jensen         nvme_post_cqes(cq);
481288eea45cSKlaus Jensen         QTAILQ_FOREACH_SAFE(r, &cq->req_list, entry, next) {
481388eea45cSKlaus Jensen             if (r->sq == sq) {
481488eea45cSKlaus Jensen                 QTAILQ_REMOVE(&cq->req_list, r, entry);
481588eea45cSKlaus Jensen                 QTAILQ_INSERT_TAIL(&sq->req_list, r, entry);
481688eea45cSKlaus Jensen             }
481788eea45cSKlaus Jensen         }
481888eea45cSKlaus Jensen     }
481988eea45cSKlaus Jensen 
482088eea45cSKlaus Jensen     nvme_free_sq(sq, n);
482188eea45cSKlaus Jensen     return NVME_SUCCESS;
482288eea45cSKlaus Jensen }
482388eea45cSKlaus Jensen 
nvme_init_sq(NvmeSQueue * sq,NvmeCtrl * n,uint64_t dma_addr,uint16_t sqid,uint16_t cqid,uint16_t size)482488eea45cSKlaus Jensen static void nvme_init_sq(NvmeSQueue *sq, NvmeCtrl *n, uint64_t dma_addr,
482588eea45cSKlaus Jensen                          uint16_t sqid, uint16_t cqid, uint16_t size)
482688eea45cSKlaus Jensen {
482788eea45cSKlaus Jensen     int i;
482888eea45cSKlaus Jensen     NvmeCQueue *cq;
482988eea45cSKlaus Jensen 
483088eea45cSKlaus Jensen     sq->ctrl = n;
483188eea45cSKlaus Jensen     sq->dma_addr = dma_addr;
483288eea45cSKlaus Jensen     sq->sqid = sqid;
483388eea45cSKlaus Jensen     sq->size = size;
483488eea45cSKlaus Jensen     sq->cqid = cqid;
483588eea45cSKlaus Jensen     sq->head = sq->tail = 0;
483688eea45cSKlaus Jensen     sq->io_req = g_new0(NvmeRequest, sq->size);
483788eea45cSKlaus Jensen 
483888eea45cSKlaus Jensen     QTAILQ_INIT(&sq->req_list);
483988eea45cSKlaus Jensen     QTAILQ_INIT(&sq->out_req_list);
484088eea45cSKlaus Jensen     for (i = 0; i < sq->size; i++) {
484188eea45cSKlaus Jensen         sq->io_req[i].sq = sq;
484288eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&(sq->req_list), &sq->io_req[i], entry);
484388eea45cSKlaus Jensen     }
4844d38cc6fdSKlaus Jensen 
4845f63192b0SAlexander Bulekov     sq->bh = qemu_bh_new_guarded(nvme_process_sq, sq,
4846f63192b0SAlexander Bulekov                                  &DEVICE(sq->ctrl)->mem_reentrancy_guard);
484788eea45cSKlaus Jensen 
48483f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
48493f7fe8deSJinhao Fan         sq->db_addr = n->dbbuf_dbs + (sqid << 3);
48503f7fe8deSJinhao Fan         sq->ei_addr = n->dbbuf_eis + (sqid << 3);
48512e53b0b4SJinhao Fan 
48522e53b0b4SJinhao Fan         if (n->params.ioeventfd && sq->sqid != 0) {
48532e53b0b4SJinhao Fan             if (!nvme_init_sq_ioeventfd(sq)) {
48542e53b0b4SJinhao Fan                 sq->ioeventfd_enabled = true;
48552e53b0b4SJinhao Fan             }
48562e53b0b4SJinhao Fan         }
48573f7fe8deSJinhao Fan     }
48583f7fe8deSJinhao Fan 
485988eea45cSKlaus Jensen     assert(n->cq[cqid]);
486088eea45cSKlaus Jensen     cq = n->cq[cqid];
486188eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&(cq->sq_list), sq, entry);
486288eea45cSKlaus Jensen     n->sq[sqid] = sq;
486388eea45cSKlaus Jensen }
486488eea45cSKlaus Jensen 
nvme_create_sq(NvmeCtrl * n,NvmeRequest * req)486588eea45cSKlaus Jensen static uint16_t nvme_create_sq(NvmeCtrl *n, NvmeRequest *req)
486688eea45cSKlaus Jensen {
486788eea45cSKlaus Jensen     NvmeSQueue *sq;
486888eea45cSKlaus Jensen     NvmeCreateSq *c = (NvmeCreateSq *)&req->cmd;
486988eea45cSKlaus Jensen 
487088eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
487188eea45cSKlaus Jensen     uint16_t sqid = le16_to_cpu(c->sqid);
487288eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
487388eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->sq_flags);
487488eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
487588eea45cSKlaus Jensen 
487688eea45cSKlaus Jensen     trace_pci_nvme_create_sq(prp1, sqid, cqid, qsize, qflags);
487788eea45cSKlaus Jensen 
487888eea45cSKlaus Jensen     if (unlikely(!cqid || nvme_check_cqid(n, cqid))) {
487988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_cqid(cqid);
488088eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
488188eea45cSKlaus Jensen     }
4882decc0261SŁukasz Gieryk     if (unlikely(!sqid || sqid > n->conf_ioqpairs || n->sq[sqid] != NULL)) {
488388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_sqid(sqid);
488488eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
488588eea45cSKlaus Jensen     }
488649e03457SKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(ldq_le_p(&n->bar.cap)))) {
488788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_size(qsize);
488888eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
488988eea45cSKlaus Jensen     }
489088eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
489188eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_addr(prp1);
489288eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
489388eea45cSKlaus Jensen     }
489488eea45cSKlaus Jensen     if (unlikely(!(NVME_SQ_FLAGS_PC(qflags)))) {
489588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_qflags(NVME_SQ_FLAGS_PC(qflags));
489688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
489788eea45cSKlaus Jensen     }
489888eea45cSKlaus Jensen     sq = g_malloc0(sizeof(*sq));
489988eea45cSKlaus Jensen     nvme_init_sq(sq, n, prp1, sqid, cqid, qsize + 1);
490088eea45cSKlaus Jensen     return NVME_SUCCESS;
490188eea45cSKlaus Jensen }
490288eea45cSKlaus Jensen 
490388eea45cSKlaus Jensen struct nvme_stats {
490488eea45cSKlaus Jensen     uint64_t units_read;
490588eea45cSKlaus Jensen     uint64_t units_written;
490688eea45cSKlaus Jensen     uint64_t read_commands;
490788eea45cSKlaus Jensen     uint64_t write_commands;
490888eea45cSKlaus Jensen };
490988eea45cSKlaus Jensen 
nvme_set_blk_stats(NvmeNamespace * ns,struct nvme_stats * stats)491088eea45cSKlaus Jensen static void nvme_set_blk_stats(NvmeNamespace *ns, struct nvme_stats *stats)
491188eea45cSKlaus Jensen {
491288eea45cSKlaus Jensen     BlockAcctStats *s = blk_get_stats(ns->blkconf.blk);
491388eea45cSKlaus Jensen 
4914a555af17SJoel Granados     stats->units_read += s->nr_bytes[BLOCK_ACCT_READ];
4915a555af17SJoel Granados     stats->units_written += s->nr_bytes[BLOCK_ACCT_WRITE];
491688eea45cSKlaus Jensen     stats->read_commands += s->nr_ops[BLOCK_ACCT_READ];
491788eea45cSKlaus Jensen     stats->write_commands += s->nr_ops[BLOCK_ACCT_WRITE];
491888eea45cSKlaus Jensen }
491988eea45cSKlaus Jensen 
nvme_smart_info(NvmeCtrl * n,uint8_t rae,uint32_t buf_len,uint64_t off,NvmeRequest * req)492088eea45cSKlaus Jensen static uint16_t nvme_smart_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
492188eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
492288eea45cSKlaus Jensen {
492388eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
492488eea45cSKlaus Jensen     struct nvme_stats stats = { 0 };
492588eea45cSKlaus Jensen     NvmeSmartLog smart = { 0 };
492688eea45cSKlaus Jensen     uint32_t trans_len;
492788eea45cSKlaus Jensen     NvmeNamespace *ns;
492888eea45cSKlaus Jensen     time_t current_ms;
4929a555af17SJoel Granados     uint64_t u_read, u_written;
493088eea45cSKlaus Jensen 
493188eea45cSKlaus Jensen     if (off >= sizeof(smart)) {
493288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
493388eea45cSKlaus Jensen     }
493488eea45cSKlaus Jensen 
493588eea45cSKlaus Jensen     if (nsid != 0xffffffff) {
493688eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
493788eea45cSKlaus Jensen         if (!ns) {
493888eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
493988eea45cSKlaus Jensen         }
494088eea45cSKlaus Jensen         nvme_set_blk_stats(ns, &stats);
494188eea45cSKlaus Jensen     } else {
494288eea45cSKlaus Jensen         int i;
494388eea45cSKlaus Jensen 
494488eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
494588eea45cSKlaus Jensen             ns = nvme_ns(n, i);
494688eea45cSKlaus Jensen             if (!ns) {
494788eea45cSKlaus Jensen                 continue;
494888eea45cSKlaus Jensen             }
494988eea45cSKlaus Jensen             nvme_set_blk_stats(ns, &stats);
495088eea45cSKlaus Jensen         }
495188eea45cSKlaus Jensen     }
495288eea45cSKlaus Jensen 
495388eea45cSKlaus Jensen     trans_len = MIN(sizeof(smart) - off, buf_len);
495488eea45cSKlaus Jensen     smart.critical_warning = n->smart_critical_warning;
495588eea45cSKlaus Jensen 
4956a555af17SJoel Granados     u_read = DIV_ROUND_UP(stats.units_read >> BDRV_SECTOR_BITS, 1000);
4957a555af17SJoel Granados     u_written = DIV_ROUND_UP(stats.units_written >> BDRV_SECTOR_BITS, 1000);
4958a555af17SJoel Granados 
4959a555af17SJoel Granados     smart.data_units_read[0] = cpu_to_le64(u_read);
4960a555af17SJoel Granados     smart.data_units_written[0] = cpu_to_le64(u_written);
496188eea45cSKlaus Jensen     smart.host_read_commands[0] = cpu_to_le64(stats.read_commands);
496288eea45cSKlaus Jensen     smart.host_write_commands[0] = cpu_to_le64(stats.write_commands);
496388eea45cSKlaus Jensen 
496488eea45cSKlaus Jensen     smart.temperature = cpu_to_le16(n->temperature);
496588eea45cSKlaus Jensen 
496688eea45cSKlaus Jensen     if ((n->temperature >= n->features.temp_thresh_hi) ||
496788eea45cSKlaus Jensen         (n->temperature <= n->features.temp_thresh_low)) {
496888eea45cSKlaus Jensen         smart.critical_warning |= NVME_SMART_TEMPERATURE;
496988eea45cSKlaus Jensen     }
497088eea45cSKlaus Jensen 
497188eea45cSKlaus Jensen     current_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
497288eea45cSKlaus Jensen     smart.power_on_hours[0] =
497388eea45cSKlaus Jensen         cpu_to_le64((((current_ms - n->starttime_ms) / 1000) / 60) / 60);
497488eea45cSKlaus Jensen 
497588eea45cSKlaus Jensen     if (!rae) {
497688eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_SMART);
497788eea45cSKlaus Jensen     }
497888eea45cSKlaus Jensen 
497988eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &smart + off, trans_len, req);
498088eea45cSKlaus Jensen }
498188eea45cSKlaus Jensen 
nvme_endgrp_info(NvmeCtrl * n,uint8_t rae,uint32_t buf_len,uint64_t off,NvmeRequest * req)4982771dbc3aSKlaus Jensen static uint16_t nvme_endgrp_info(NvmeCtrl *n,  uint8_t rae, uint32_t buf_len,
4983771dbc3aSKlaus Jensen                                  uint64_t off, NvmeRequest *req)
4984771dbc3aSKlaus Jensen {
4985771dbc3aSKlaus Jensen     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
4986771dbc3aSKlaus Jensen     uint16_t endgrpid = (dw11 >> 16) & 0xffff;
4987771dbc3aSKlaus Jensen     struct nvme_stats stats = {};
4988771dbc3aSKlaus Jensen     NvmeEndGrpLog info = {};
4989771dbc3aSKlaus Jensen     int i;
4990771dbc3aSKlaus Jensen 
4991771dbc3aSKlaus Jensen     if (!n->subsys || endgrpid != 0x1) {
4992771dbc3aSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4993771dbc3aSKlaus Jensen     }
4994771dbc3aSKlaus Jensen 
4995771dbc3aSKlaus Jensen     if (off >= sizeof(info)) {
4996771dbc3aSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4997771dbc3aSKlaus Jensen     }
4998771dbc3aSKlaus Jensen 
4999771dbc3aSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
5000771dbc3aSKlaus Jensen         NvmeNamespace *ns = nvme_subsys_ns(n->subsys, i);
5001771dbc3aSKlaus Jensen         if (!ns) {
5002771dbc3aSKlaus Jensen             continue;
5003771dbc3aSKlaus Jensen         }
5004771dbc3aSKlaus Jensen 
5005771dbc3aSKlaus Jensen         nvme_set_blk_stats(ns, &stats);
5006771dbc3aSKlaus Jensen     }
5007771dbc3aSKlaus Jensen 
5008771dbc3aSKlaus Jensen     info.data_units_read[0] =
5009771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_read / 1000000000, 1000000000));
5010771dbc3aSKlaus Jensen     info.data_units_written[0] =
5011771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_written / 1000000000, 1000000000));
5012771dbc3aSKlaus Jensen     info.media_units_written[0] =
5013771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_written / 1000000000, 1000000000));
5014771dbc3aSKlaus Jensen 
5015771dbc3aSKlaus Jensen     info.host_read_commands[0] = cpu_to_le64(stats.read_commands);
5016771dbc3aSKlaus Jensen     info.host_write_commands[0] = cpu_to_le64(stats.write_commands);
5017771dbc3aSKlaus Jensen 
5018771dbc3aSKlaus Jensen     buf_len = MIN(sizeof(info) - off, buf_len);
5019771dbc3aSKlaus Jensen 
5020771dbc3aSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&info + off, buf_len, req);
5021771dbc3aSKlaus Jensen }
5022771dbc3aSKlaus Jensen 
5023771dbc3aSKlaus Jensen 
nvme_fw_log_info(NvmeCtrl * n,uint32_t buf_len,uint64_t off,NvmeRequest * req)502488eea45cSKlaus Jensen static uint16_t nvme_fw_log_info(NvmeCtrl *n, uint32_t buf_len, uint64_t off,
502588eea45cSKlaus Jensen                                  NvmeRequest *req)
502688eea45cSKlaus Jensen {
502788eea45cSKlaus Jensen     uint32_t trans_len;
502888eea45cSKlaus Jensen     NvmeFwSlotInfoLog fw_log = {
502988eea45cSKlaus Jensen         .afi = 0x1,
503088eea45cSKlaus Jensen     };
503188eea45cSKlaus Jensen 
503288eea45cSKlaus Jensen     if (off >= sizeof(fw_log)) {
503388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
503488eea45cSKlaus Jensen     }
503588eea45cSKlaus Jensen 
503688eea45cSKlaus Jensen     strpadcpy((char *)&fw_log.frs1, sizeof(fw_log.frs1), "1.0", ' ');
503788eea45cSKlaus Jensen     trans_len = MIN(sizeof(fw_log) - off, buf_len);
503888eea45cSKlaus Jensen 
503988eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &fw_log + off, trans_len, req);
504088eea45cSKlaus Jensen }
504188eea45cSKlaus Jensen 
nvme_error_info(NvmeCtrl * n,uint8_t rae,uint32_t buf_len,uint64_t off,NvmeRequest * req)504288eea45cSKlaus Jensen static uint16_t nvme_error_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
504388eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
504488eea45cSKlaus Jensen {
504588eea45cSKlaus Jensen     uint32_t trans_len;
504688eea45cSKlaus Jensen     NvmeErrorLog errlog;
504788eea45cSKlaus Jensen 
504888eea45cSKlaus Jensen     if (off >= sizeof(errlog)) {
504988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
505088eea45cSKlaus Jensen     }
505188eea45cSKlaus Jensen 
505288eea45cSKlaus Jensen     if (!rae) {
505388eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_ERROR);
505488eea45cSKlaus Jensen     }
505588eea45cSKlaus Jensen 
505688eea45cSKlaus Jensen     memset(&errlog, 0x0, sizeof(errlog));
505788eea45cSKlaus Jensen     trans_len = MIN(sizeof(errlog) - off, buf_len);
505888eea45cSKlaus Jensen 
505988eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&errlog, trans_len, req);
506088eea45cSKlaus Jensen }
506188eea45cSKlaus Jensen 
nvme_changed_nslist(NvmeCtrl * n,uint8_t rae,uint32_t buf_len,uint64_t off,NvmeRequest * req)506288eea45cSKlaus Jensen static uint16_t nvme_changed_nslist(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
506388eea45cSKlaus Jensen                                     uint64_t off, NvmeRequest *req)
506488eea45cSKlaus Jensen {
506588eea45cSKlaus Jensen     uint32_t nslist[1024];
506688eea45cSKlaus Jensen     uint32_t trans_len;
506788eea45cSKlaus Jensen     int i = 0;
506888eea45cSKlaus Jensen     uint32_t nsid;
506988eea45cSKlaus Jensen 
5070e2c57529SKlaus Jensen     if (off >= sizeof(nslist)) {
5071e2c57529SKlaus Jensen         trace_pci_nvme_err_invalid_log_page_offset(off, sizeof(nslist));
5072e2c57529SKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
5073e2c57529SKlaus Jensen     }
5074e2c57529SKlaus Jensen 
507588eea45cSKlaus Jensen     memset(nslist, 0x0, sizeof(nslist));
507688eea45cSKlaus Jensen     trans_len = MIN(sizeof(nslist) - off, buf_len);
507788eea45cSKlaus Jensen 
507888eea45cSKlaus Jensen     while ((nsid = find_first_bit(n->changed_nsids, NVME_CHANGED_NSID_SIZE)) !=
507988eea45cSKlaus Jensen             NVME_CHANGED_NSID_SIZE) {
508088eea45cSKlaus Jensen         /*
508188eea45cSKlaus Jensen          * If more than 1024 namespaces, the first entry in the log page should
508288eea45cSKlaus Jensen          * be set to FFFFFFFFh and the others to 0 as spec.
508388eea45cSKlaus Jensen          */
508488eea45cSKlaus Jensen         if (i == ARRAY_SIZE(nslist)) {
508588eea45cSKlaus Jensen             memset(nslist, 0x0, sizeof(nslist));
508688eea45cSKlaus Jensen             nslist[0] = 0xffffffff;
508788eea45cSKlaus Jensen             break;
508888eea45cSKlaus Jensen         }
508988eea45cSKlaus Jensen 
509088eea45cSKlaus Jensen         nslist[i++] = nsid;
509188eea45cSKlaus Jensen         clear_bit(nsid, n->changed_nsids);
509288eea45cSKlaus Jensen     }
509388eea45cSKlaus Jensen 
509488eea45cSKlaus Jensen     /*
509588eea45cSKlaus Jensen      * Remove all the remaining list entries in case returns directly due to
509688eea45cSKlaus Jensen      * more than 1024 namespaces.
509788eea45cSKlaus Jensen      */
509888eea45cSKlaus Jensen     if (nslist[0] == 0xffffffff) {
509988eea45cSKlaus Jensen         bitmap_zero(n->changed_nsids, NVME_CHANGED_NSID_SIZE);
510088eea45cSKlaus Jensen     }
510188eea45cSKlaus Jensen 
510288eea45cSKlaus Jensen     if (!rae) {
510388eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_NOTICE);
510488eea45cSKlaus Jensen     }
510588eea45cSKlaus Jensen 
510688eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)nslist) + off, trans_len, req);
510788eea45cSKlaus Jensen }
510888eea45cSKlaus Jensen 
nvme_cmd_effects(NvmeCtrl * n,uint8_t csi,uint32_t buf_len,uint64_t off,NvmeRequest * req)510988eea45cSKlaus Jensen static uint16_t nvme_cmd_effects(NvmeCtrl *n, uint8_t csi, uint32_t buf_len,
511088eea45cSKlaus Jensen                                  uint64_t off, NvmeRequest *req)
511188eea45cSKlaus Jensen {
511288eea45cSKlaus Jensen     NvmeEffectsLog log = {};
511388eea45cSKlaus Jensen     const uint32_t *src_iocs = NULL;
511488eea45cSKlaus Jensen     uint32_t trans_len;
511588eea45cSKlaus Jensen 
511688eea45cSKlaus Jensen     if (off >= sizeof(log)) {
511788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page_offset(off, sizeof(log));
511888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
511988eea45cSKlaus Jensen     }
512088eea45cSKlaus Jensen 
512149e03457SKlaus Jensen     switch (NVME_CC_CSS(ldl_le_p(&n->bar.cc))) {
512288eea45cSKlaus Jensen     case NVME_CC_CSS_NVM:
512388eea45cSKlaus Jensen         src_iocs = nvme_cse_iocs_nvm;
512488eea45cSKlaus Jensen         /* fall through */
512588eea45cSKlaus Jensen     case NVME_CC_CSS_ADMIN_ONLY:
512688eea45cSKlaus Jensen         break;
512788eea45cSKlaus Jensen     case NVME_CC_CSS_CSI:
512888eea45cSKlaus Jensen         switch (csi) {
512988eea45cSKlaus Jensen         case NVME_CSI_NVM:
513088eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_nvm;
513188eea45cSKlaus Jensen             break;
513288eea45cSKlaus Jensen         case NVME_CSI_ZONED:
513388eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_zoned;
513488eea45cSKlaus Jensen             break;
513588eea45cSKlaus Jensen         }
513688eea45cSKlaus Jensen     }
513788eea45cSKlaus Jensen 
513888eea45cSKlaus Jensen     memcpy(log.acs, nvme_cse_acs, sizeof(nvme_cse_acs));
513988eea45cSKlaus Jensen 
514088eea45cSKlaus Jensen     if (src_iocs) {
514188eea45cSKlaus Jensen         memcpy(log.iocs, src_iocs, sizeof(log.iocs));
514288eea45cSKlaus Jensen     }
514388eea45cSKlaus Jensen 
514488eea45cSKlaus Jensen     trans_len = MIN(sizeof(log) - off, buf_len);
514588eea45cSKlaus Jensen 
514688eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)&log) + off, trans_len, req);
514788eea45cSKlaus Jensen }
514888eea45cSKlaus Jensen 
sizeof_fdp_conf_descr(size_t nruh,size_t vss)514973064edfSJesper Devantier static size_t sizeof_fdp_conf_descr(size_t nruh, size_t vss)
515073064edfSJesper Devantier {
515173064edfSJesper Devantier     size_t entry_siz = sizeof(NvmeFdpDescrHdr) + nruh * sizeof(NvmeRuhDescr)
515273064edfSJesper Devantier                        + vss;
515373064edfSJesper Devantier     return ROUND_UP(entry_siz, 8);
515473064edfSJesper Devantier }
515573064edfSJesper Devantier 
nvme_fdp_confs(NvmeCtrl * n,uint32_t endgrpid,uint32_t buf_len,uint64_t off,NvmeRequest * req)515673064edfSJesper Devantier static uint16_t nvme_fdp_confs(NvmeCtrl *n, uint32_t endgrpid, uint32_t buf_len,
515773064edfSJesper Devantier                                uint64_t off, NvmeRequest *req)
515873064edfSJesper Devantier {
515973064edfSJesper Devantier     uint32_t log_size, trans_len;
516073064edfSJesper Devantier     g_autofree uint8_t *buf = NULL;
516173064edfSJesper Devantier     NvmeFdpDescrHdr *hdr;
516273064edfSJesper Devantier     NvmeRuhDescr *ruhd;
516373064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
516473064edfSJesper Devantier     NvmeFdpConfsHdr *log;
516573064edfSJesper Devantier     size_t nruh, fdp_descr_size;
516673064edfSJesper Devantier     int i;
516773064edfSJesper Devantier 
516873064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
516973064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
517073064edfSJesper Devantier     }
517173064edfSJesper Devantier 
517273064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
517373064edfSJesper Devantier 
517473064edfSJesper Devantier     if (endgrp->fdp.enabled) {
517573064edfSJesper Devantier         nruh = endgrp->fdp.nruh;
517673064edfSJesper Devantier     } else {
517773064edfSJesper Devantier         nruh = 1;
517873064edfSJesper Devantier     }
517973064edfSJesper Devantier 
518073064edfSJesper Devantier     fdp_descr_size = sizeof_fdp_conf_descr(nruh, FDPVSS);
518173064edfSJesper Devantier     log_size = sizeof(NvmeFdpConfsHdr) + fdp_descr_size;
518273064edfSJesper Devantier 
518373064edfSJesper Devantier     if (off >= log_size) {
518473064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
518573064edfSJesper Devantier     }
518673064edfSJesper Devantier 
518773064edfSJesper Devantier     trans_len = MIN(log_size - off, buf_len);
518873064edfSJesper Devantier 
518973064edfSJesper Devantier     buf = g_malloc0(log_size);
519073064edfSJesper Devantier     log = (NvmeFdpConfsHdr *)buf;
519173064edfSJesper Devantier     hdr = (NvmeFdpDescrHdr *)(log + 1);
519273064edfSJesper Devantier     ruhd = (NvmeRuhDescr *)(buf + sizeof(*log) + sizeof(*hdr));
519373064edfSJesper Devantier 
519473064edfSJesper Devantier     log->num_confs = cpu_to_le16(0);
519573064edfSJesper Devantier     log->size = cpu_to_le32(log_size);
519673064edfSJesper Devantier 
519773064edfSJesper Devantier     hdr->descr_size = cpu_to_le16(fdp_descr_size);
519873064edfSJesper Devantier     if (endgrp->fdp.enabled) {
519973064edfSJesper Devantier         hdr->fdpa = FIELD_DP8(hdr->fdpa, FDPA, VALID, 1);
520073064edfSJesper Devantier         hdr->fdpa = FIELD_DP8(hdr->fdpa, FDPA, RGIF, endgrp->fdp.rgif);
520173064edfSJesper Devantier         hdr->nrg = cpu_to_le16(endgrp->fdp.nrg);
520273064edfSJesper Devantier         hdr->nruh = cpu_to_le16(endgrp->fdp.nruh);
520373064edfSJesper Devantier         hdr->maxpids = cpu_to_le16(NVME_FDP_MAXPIDS - 1);
520473064edfSJesper Devantier         hdr->nnss = cpu_to_le32(NVME_MAX_NAMESPACES);
520573064edfSJesper Devantier         hdr->runs = cpu_to_le64(endgrp->fdp.runs);
520673064edfSJesper Devantier 
520773064edfSJesper Devantier         for (i = 0; i < nruh; i++) {
520873064edfSJesper Devantier             ruhd->ruht = NVME_RUHT_INITIALLY_ISOLATED;
520973064edfSJesper Devantier             ruhd++;
521073064edfSJesper Devantier         }
521173064edfSJesper Devantier     } else {
521273064edfSJesper Devantier         /* 1 bit for RUH in PIF -> 2 RUHs max. */
521373064edfSJesper Devantier         hdr->nrg = cpu_to_le16(1);
521473064edfSJesper Devantier         hdr->nruh = cpu_to_le16(1);
521573064edfSJesper Devantier         hdr->maxpids = cpu_to_le16(NVME_FDP_MAXPIDS - 1);
521673064edfSJesper Devantier         hdr->nnss = cpu_to_le32(1);
521773064edfSJesper Devantier         hdr->runs = cpu_to_le64(96 * MiB);
521873064edfSJesper Devantier 
521973064edfSJesper Devantier         ruhd->ruht = NVME_RUHT_INITIALLY_ISOLATED;
522073064edfSJesper Devantier     }
522173064edfSJesper Devantier 
522273064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)buf + off, trans_len, req);
522373064edfSJesper Devantier }
522473064edfSJesper Devantier 
nvme_fdp_ruh_usage(NvmeCtrl * n,uint32_t endgrpid,uint32_t dw10,uint32_t dw12,uint32_t buf_len,uint64_t off,NvmeRequest * req)522573064edfSJesper Devantier static uint16_t nvme_fdp_ruh_usage(NvmeCtrl *n, uint32_t endgrpid,
522673064edfSJesper Devantier                                    uint32_t dw10, uint32_t dw12,
522773064edfSJesper Devantier                                    uint32_t buf_len, uint64_t off,
522873064edfSJesper Devantier                                    NvmeRequest *req)
522973064edfSJesper Devantier {
523073064edfSJesper Devantier     NvmeRuHandle *ruh;
523173064edfSJesper Devantier     NvmeRuhuLog *hdr;
523273064edfSJesper Devantier     NvmeRuhuDescr *ruhud;
523373064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
523473064edfSJesper Devantier     g_autofree uint8_t *buf = NULL;
523573064edfSJesper Devantier     uint32_t log_size, trans_len;
523673064edfSJesper Devantier     uint16_t i;
523773064edfSJesper Devantier 
523873064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
523973064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
524073064edfSJesper Devantier     }
524173064edfSJesper Devantier 
524273064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
524373064edfSJesper Devantier 
524473064edfSJesper Devantier     if (!endgrp->fdp.enabled) {
524573064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
524673064edfSJesper Devantier     }
524773064edfSJesper Devantier 
524873064edfSJesper Devantier     log_size = sizeof(NvmeRuhuLog) + endgrp->fdp.nruh * sizeof(NvmeRuhuDescr);
524973064edfSJesper Devantier 
525073064edfSJesper Devantier     if (off >= log_size) {
525173064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
525273064edfSJesper Devantier     }
525373064edfSJesper Devantier 
525473064edfSJesper Devantier     trans_len = MIN(log_size - off, buf_len);
525573064edfSJesper Devantier 
525673064edfSJesper Devantier     buf = g_malloc0(log_size);
525773064edfSJesper Devantier     hdr = (NvmeRuhuLog *)buf;
525873064edfSJesper Devantier     ruhud = (NvmeRuhuDescr *)(hdr + 1);
525973064edfSJesper Devantier 
526073064edfSJesper Devantier     ruh = endgrp->fdp.ruhs;
526173064edfSJesper Devantier     hdr->nruh = cpu_to_le16(endgrp->fdp.nruh);
526273064edfSJesper Devantier 
526373064edfSJesper Devantier     for (i = 0; i < endgrp->fdp.nruh; i++, ruhud++, ruh++) {
526473064edfSJesper Devantier         ruhud->ruha = ruh->ruha;
526573064edfSJesper Devantier     }
526673064edfSJesper Devantier 
526773064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)buf + off, trans_len, req);
526873064edfSJesper Devantier }
526973064edfSJesper Devantier 
nvme_fdp_stats(NvmeCtrl * n,uint32_t endgrpid,uint32_t buf_len,uint64_t off,NvmeRequest * req)527073064edfSJesper Devantier static uint16_t nvme_fdp_stats(NvmeCtrl *n, uint32_t endgrpid, uint32_t buf_len,
527173064edfSJesper Devantier                                uint64_t off, NvmeRequest *req)
527273064edfSJesper Devantier {
527373064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
527473064edfSJesper Devantier     NvmeFdpStatsLog log = {};
527573064edfSJesper Devantier     uint32_t trans_len;
527673064edfSJesper Devantier 
527773064edfSJesper Devantier     if (off >= sizeof(NvmeFdpStatsLog)) {
527873064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
527973064edfSJesper Devantier     }
528073064edfSJesper Devantier 
528173064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
528273064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
528373064edfSJesper Devantier     }
528473064edfSJesper Devantier 
528573064edfSJesper Devantier     if (!n->subsys->endgrp.fdp.enabled) {
528673064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
528773064edfSJesper Devantier     }
528873064edfSJesper Devantier 
528973064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
529073064edfSJesper Devantier 
529173064edfSJesper Devantier     trans_len = MIN(sizeof(log) - off, buf_len);
529273064edfSJesper Devantier 
529373064edfSJesper Devantier     /* spec value is 128 bit, we only use 64 bit */
529473064edfSJesper Devantier     log.hbmw[0] = cpu_to_le64(endgrp->fdp.hbmw);
529573064edfSJesper Devantier     log.mbmw[0] = cpu_to_le64(endgrp->fdp.mbmw);
529673064edfSJesper Devantier     log.mbe[0] = cpu_to_le64(endgrp->fdp.mbe);
529773064edfSJesper Devantier 
529873064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)&log + off, trans_len, req);
529973064edfSJesper Devantier }
530073064edfSJesper Devantier 
nvme_fdp_events(NvmeCtrl * n,uint32_t endgrpid,uint32_t buf_len,uint64_t off,NvmeRequest * req)530173064edfSJesper Devantier static uint16_t nvme_fdp_events(NvmeCtrl *n, uint32_t endgrpid,
530273064edfSJesper Devantier                                 uint32_t buf_len, uint64_t off,
530373064edfSJesper Devantier                                 NvmeRequest *req)
530473064edfSJesper Devantier {
530573064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
530673064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
530773064edfSJesper Devantier     bool host_events = (cmd->cdw10 >> 8) & 0x1;
530873064edfSJesper Devantier     uint32_t log_size, trans_len;
530973064edfSJesper Devantier     NvmeFdpEventBuffer *ebuf;
531073064edfSJesper Devantier     g_autofree NvmeFdpEventsLog *elog = NULL;
531173064edfSJesper Devantier     NvmeFdpEvent *event;
531273064edfSJesper Devantier 
531373064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
531473064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
531573064edfSJesper Devantier     }
531673064edfSJesper Devantier 
531773064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
531873064edfSJesper Devantier 
531973064edfSJesper Devantier     if (!endgrp->fdp.enabled) {
532073064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
532173064edfSJesper Devantier     }
532273064edfSJesper Devantier 
532373064edfSJesper Devantier     if (host_events) {
532473064edfSJesper Devantier         ebuf = &endgrp->fdp.host_events;
532573064edfSJesper Devantier     } else {
532673064edfSJesper Devantier         ebuf = &endgrp->fdp.ctrl_events;
532773064edfSJesper Devantier     }
532873064edfSJesper Devantier 
532973064edfSJesper Devantier     log_size = sizeof(NvmeFdpEventsLog) + ebuf->nelems * sizeof(NvmeFdpEvent);
5330ecb1b7b0SKlaus Jensen 
5331ecb1b7b0SKlaus Jensen     if (off >= log_size) {
5332ecb1b7b0SKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
5333ecb1b7b0SKlaus Jensen     }
5334ecb1b7b0SKlaus Jensen 
533573064edfSJesper Devantier     trans_len = MIN(log_size - off, buf_len);
533673064edfSJesper Devantier     elog = g_malloc0(log_size);
533773064edfSJesper Devantier     elog->num_events = cpu_to_le32(ebuf->nelems);
533873064edfSJesper Devantier     event = (NvmeFdpEvent *)(elog + 1);
533973064edfSJesper Devantier 
534073064edfSJesper Devantier     if (ebuf->nelems && ebuf->start == ebuf->next) {
534173064edfSJesper Devantier         unsigned int nelems = (NVME_FDP_MAX_EVENTS - ebuf->start);
534273064edfSJesper Devantier         /* wrap over, copy [start;NVME_FDP_MAX_EVENTS[ and [0; next[ */
534373064edfSJesper Devantier         memcpy(event, &ebuf->events[ebuf->start],
534473064edfSJesper Devantier                sizeof(NvmeFdpEvent) * nelems);
534573064edfSJesper Devantier         memcpy(event + nelems, ebuf->events,
534673064edfSJesper Devantier                sizeof(NvmeFdpEvent) * ebuf->next);
534773064edfSJesper Devantier     } else if (ebuf->start < ebuf->next) {
534873064edfSJesper Devantier         memcpy(event, &ebuf->events[ebuf->start],
534973064edfSJesper Devantier                sizeof(NvmeFdpEvent) * (ebuf->next - ebuf->start));
535073064edfSJesper Devantier     }
535173064edfSJesper Devantier 
535273064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)elog + off, trans_len, req);
535373064edfSJesper Devantier }
535473064edfSJesper Devantier 
nvme_get_log(NvmeCtrl * n,NvmeRequest * req)535588eea45cSKlaus Jensen static uint16_t nvme_get_log(NvmeCtrl *n, NvmeRequest *req)
535688eea45cSKlaus Jensen {
535788eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
535888eea45cSKlaus Jensen 
535988eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
536088eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
536188eea45cSKlaus Jensen     uint32_t dw12 = le32_to_cpu(cmd->cdw12);
536288eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
536388eea45cSKlaus Jensen     uint8_t  lid = dw10 & 0xff;
536488eea45cSKlaus Jensen     uint8_t  lsp = (dw10 >> 8) & 0xf;
536588eea45cSKlaus Jensen     uint8_t  rae = (dw10 >> 15) & 0x1;
536688eea45cSKlaus Jensen     uint8_t  csi = le32_to_cpu(cmd->cdw14) >> 24;
536773064edfSJesper Devantier     uint32_t numdl, numdu, lspi;
536888eea45cSKlaus Jensen     uint64_t off, lpol, lpou;
536988eea45cSKlaus Jensen     size_t   len;
537088eea45cSKlaus Jensen     uint16_t status;
537188eea45cSKlaus Jensen 
537288eea45cSKlaus Jensen     numdl = (dw10 >> 16);
537388eea45cSKlaus Jensen     numdu = (dw11 & 0xffff);
537473064edfSJesper Devantier     lspi = (dw11 >> 16);
537588eea45cSKlaus Jensen     lpol = dw12;
537688eea45cSKlaus Jensen     lpou = dw13;
537788eea45cSKlaus Jensen 
537888eea45cSKlaus Jensen     len = (((numdu << 16) | numdl) + 1) << 2;
537988eea45cSKlaus Jensen     off = (lpou << 32ULL) | lpol;
538088eea45cSKlaus Jensen 
538188eea45cSKlaus Jensen     if (off & 0x3) {
538288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
538388eea45cSKlaus Jensen     }
538488eea45cSKlaus Jensen 
538588eea45cSKlaus Jensen     trace_pci_nvme_get_log(nvme_cid(req), lid, lsp, rae, len, off);
538688eea45cSKlaus Jensen 
538788eea45cSKlaus Jensen     status = nvme_check_mdts(n, len);
538888eea45cSKlaus Jensen     if (status) {
538988eea45cSKlaus Jensen         return status;
539088eea45cSKlaus Jensen     }
539188eea45cSKlaus Jensen 
539288eea45cSKlaus Jensen     switch (lid) {
539388eea45cSKlaus Jensen     case NVME_LOG_ERROR_INFO:
539488eea45cSKlaus Jensen         return nvme_error_info(n, rae, len, off, req);
539588eea45cSKlaus Jensen     case NVME_LOG_SMART_INFO:
539688eea45cSKlaus Jensen         return nvme_smart_info(n, rae, len, off, req);
539788eea45cSKlaus Jensen     case NVME_LOG_FW_SLOT_INFO:
539888eea45cSKlaus Jensen         return nvme_fw_log_info(n, len, off, req);
539988eea45cSKlaus Jensen     case NVME_LOG_CHANGED_NSLIST:
540088eea45cSKlaus Jensen         return nvme_changed_nslist(n, rae, len, off, req);
540188eea45cSKlaus Jensen     case NVME_LOG_CMD_EFFECTS:
540288eea45cSKlaus Jensen         return nvme_cmd_effects(n, csi, len, off, req);
5403771dbc3aSKlaus Jensen     case NVME_LOG_ENDGRP:
5404771dbc3aSKlaus Jensen         return nvme_endgrp_info(n, rae, len, off, req);
540573064edfSJesper Devantier     case NVME_LOG_FDP_CONFS:
540673064edfSJesper Devantier         return nvme_fdp_confs(n, lspi, len, off, req);
540773064edfSJesper Devantier     case NVME_LOG_FDP_RUH_USAGE:
540873064edfSJesper Devantier         return nvme_fdp_ruh_usage(n, lspi, dw10, dw12, len, off, req);
540973064edfSJesper Devantier     case NVME_LOG_FDP_STATS:
541073064edfSJesper Devantier         return nvme_fdp_stats(n, lspi, len, off, req);
541173064edfSJesper Devantier     case NVME_LOG_FDP_EVENTS:
541273064edfSJesper Devantier         return nvme_fdp_events(n, lspi, len, off, req);
541388eea45cSKlaus Jensen     default:
541488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page(nvme_cid(req), lid);
541588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
541688eea45cSKlaus Jensen     }
541788eea45cSKlaus Jensen }
541888eea45cSKlaus Jensen 
nvme_free_cq(NvmeCQueue * cq,NvmeCtrl * n)541988eea45cSKlaus Jensen static void nvme_free_cq(NvmeCQueue *cq, NvmeCtrl *n)
542088eea45cSKlaus Jensen {
542148b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
54222e53b0b4SJinhao Fan     uint16_t offset = (cq->cqid << 3) + (1 << 2);
54232e53b0b4SJinhao Fan 
542488eea45cSKlaus Jensen     n->cq[cq->cqid] = NULL;
5425d38cc6fdSKlaus Jensen     qemu_bh_delete(cq->bh);
54262e53b0b4SJinhao Fan     if (cq->ioeventfd_enabled) {
54272e53b0b4SJinhao Fan         memory_region_del_eventfd(&n->iomem,
54282e53b0b4SJinhao Fan                                   0x1000 + offset, 4, false, 0, &cq->notifier);
542904e8da88SKlaus Jensen         event_notifier_set_handler(&cq->notifier, NULL);
54302e53b0b4SJinhao Fan         event_notifier_cleanup(&cq->notifier);
54312e53b0b4SJinhao Fan     }
5432149f6e90SKlaus Jensen     if (msix_enabled(pci) && cq->irq_enabled) {
543348b32c28SKlaus Jensen         msix_vector_unuse(pci, cq->vector);
543488eea45cSKlaus Jensen     }
543588eea45cSKlaus Jensen     if (cq->cqid) {
543688eea45cSKlaus Jensen         g_free(cq);
543788eea45cSKlaus Jensen     }
543888eea45cSKlaus Jensen }
543988eea45cSKlaus Jensen 
nvme_del_cq(NvmeCtrl * n,NvmeRequest * req)544088eea45cSKlaus Jensen static uint16_t nvme_del_cq(NvmeCtrl *n, NvmeRequest *req)
544188eea45cSKlaus Jensen {
544288eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
544388eea45cSKlaus Jensen     NvmeCQueue *cq;
544488eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
544588eea45cSKlaus Jensen 
544688eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_cqid(n, qid))) {
544788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_cqid(qid);
544888eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
544988eea45cSKlaus Jensen     }
545088eea45cSKlaus Jensen 
545188eea45cSKlaus Jensen     cq = n->cq[qid];
545288eea45cSKlaus Jensen     if (unlikely(!QTAILQ_EMPTY(&cq->sq_list))) {
545388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_notempty(qid);
545488eea45cSKlaus Jensen         return NVME_INVALID_QUEUE_DEL;
545588eea45cSKlaus Jensen     }
545683d7ed5cSKlaus Jensen 
545783d7ed5cSKlaus Jensen     if (cq->irq_enabled && cq->tail != cq->head) {
545883d7ed5cSKlaus Jensen         n->cq_pending--;
545983d7ed5cSKlaus Jensen     }
546083d7ed5cSKlaus Jensen 
546188eea45cSKlaus Jensen     nvme_irq_deassert(n, cq);
546288eea45cSKlaus Jensen     trace_pci_nvme_del_cq(qid);
546388eea45cSKlaus Jensen     nvme_free_cq(cq, n);
546488eea45cSKlaus Jensen     return NVME_SUCCESS;
546588eea45cSKlaus Jensen }
546688eea45cSKlaus Jensen 
nvme_init_cq(NvmeCQueue * cq,NvmeCtrl * n,uint64_t dma_addr,uint16_t cqid,uint16_t vector,uint16_t size,uint16_t irq_enabled)546788eea45cSKlaus Jensen static void nvme_init_cq(NvmeCQueue *cq, NvmeCtrl *n, uint64_t dma_addr,
546888eea45cSKlaus Jensen                          uint16_t cqid, uint16_t vector, uint16_t size,
546988eea45cSKlaus Jensen                          uint16_t irq_enabled)
547088eea45cSKlaus Jensen {
547148b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
547248b32c28SKlaus Jensen 
5473149f6e90SKlaus Jensen     if (msix_enabled(pci) && irq_enabled) {
547448b32c28SKlaus Jensen         msix_vector_use(pci, vector);
547588eea45cSKlaus Jensen     }
5476149f6e90SKlaus Jensen 
547788eea45cSKlaus Jensen     cq->ctrl = n;
547888eea45cSKlaus Jensen     cq->cqid = cqid;
547988eea45cSKlaus Jensen     cq->size = size;
548088eea45cSKlaus Jensen     cq->dma_addr = dma_addr;
548188eea45cSKlaus Jensen     cq->phase = 1;
548288eea45cSKlaus Jensen     cq->irq_enabled = irq_enabled;
548388eea45cSKlaus Jensen     cq->vector = vector;
548488eea45cSKlaus Jensen     cq->head = cq->tail = 0;
548588eea45cSKlaus Jensen     QTAILQ_INIT(&cq->req_list);
548688eea45cSKlaus Jensen     QTAILQ_INIT(&cq->sq_list);
54873f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
54883f7fe8deSJinhao Fan         cq->db_addr = n->dbbuf_dbs + (cqid << 3) + (1 << 2);
54893f7fe8deSJinhao Fan         cq->ei_addr = n->dbbuf_eis + (cqid << 3) + (1 << 2);
54902e53b0b4SJinhao Fan 
54912e53b0b4SJinhao Fan         if (n->params.ioeventfd && cqid != 0) {
54922e53b0b4SJinhao Fan             if (!nvme_init_cq_ioeventfd(cq)) {
54932e53b0b4SJinhao Fan                 cq->ioeventfd_enabled = true;
54942e53b0b4SJinhao Fan             }
54952e53b0b4SJinhao Fan         }
54963f7fe8deSJinhao Fan     }
549788eea45cSKlaus Jensen     n->cq[cqid] = cq;
5498f63192b0SAlexander Bulekov     cq->bh = qemu_bh_new_guarded(nvme_post_cqes, cq,
5499f63192b0SAlexander Bulekov                                  &DEVICE(cq->ctrl)->mem_reentrancy_guard);
550088eea45cSKlaus Jensen }
550188eea45cSKlaus Jensen 
nvme_create_cq(NvmeCtrl * n,NvmeRequest * req)550288eea45cSKlaus Jensen static uint16_t nvme_create_cq(NvmeCtrl *n, NvmeRequest *req)
550388eea45cSKlaus Jensen {
550488eea45cSKlaus Jensen     NvmeCQueue *cq;
550588eea45cSKlaus Jensen     NvmeCreateCq *c = (NvmeCreateCq *)&req->cmd;
550688eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
550788eea45cSKlaus Jensen     uint16_t vector = le16_to_cpu(c->irq_vector);
550888eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
550988eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->cq_flags);
551088eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
55116a33f2e9SKlaus Jensen     uint32_t cc = ldq_le_p(&n->bar.cc);
55126a33f2e9SKlaus Jensen     uint8_t iocqes = NVME_CC_IOCQES(cc);
55136a33f2e9SKlaus Jensen     uint8_t iosqes = NVME_CC_IOSQES(cc);
551488eea45cSKlaus Jensen 
551588eea45cSKlaus Jensen     trace_pci_nvme_create_cq(prp1, cqid, vector, qsize, qflags,
551688eea45cSKlaus Jensen                              NVME_CQ_FLAGS_IEN(qflags) != 0);
551788eea45cSKlaus Jensen 
55186a33f2e9SKlaus Jensen     if (iosqes != NVME_SQES || iocqes != NVME_CQES) {
55196a33f2e9SKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_entry_size(iosqes, iocqes);
55206a33f2e9SKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
55216a33f2e9SKlaus Jensen     }
55226a33f2e9SKlaus Jensen 
5523decc0261SŁukasz Gieryk     if (unlikely(!cqid || cqid > n->conf_ioqpairs || n->cq[cqid] != NULL)) {
552488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_cqid(cqid);
552588eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
552688eea45cSKlaus Jensen     }
552749e03457SKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(ldq_le_p(&n->bar.cap)))) {
552888eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_size(qsize);
552988eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
553088eea45cSKlaus Jensen     }
553188eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
553288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_addr(prp1);
553388eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
553488eea45cSKlaus Jensen     }
553548b32c28SKlaus Jensen     if (unlikely(!msix_enabled(PCI_DEVICE(n)) && vector)) {
553688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
553788eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
553888eea45cSKlaus Jensen     }
5539decc0261SŁukasz Gieryk     if (unlikely(vector >= n->conf_msix_qsize)) {
554088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
554188eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
554288eea45cSKlaus Jensen     }
554388eea45cSKlaus Jensen     if (unlikely(!(NVME_CQ_FLAGS_PC(qflags)))) {
554488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_qflags(NVME_CQ_FLAGS_PC(qflags));
554588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
554688eea45cSKlaus Jensen     }
554788eea45cSKlaus Jensen 
554888eea45cSKlaus Jensen     cq = g_malloc0(sizeof(*cq));
554988eea45cSKlaus Jensen     nvme_init_cq(cq, n, prp1, cqid, vector, qsize + 1,
555088eea45cSKlaus Jensen                  NVME_CQ_FLAGS_IEN(qflags));
555188eea45cSKlaus Jensen 
555288eea45cSKlaus Jensen     /*
555388eea45cSKlaus Jensen      * It is only required to set qs_created when creating a completion queue;
555488eea45cSKlaus Jensen      * creating a submission queue without a matching completion queue will
555588eea45cSKlaus Jensen      * fail.
555688eea45cSKlaus Jensen      */
555788eea45cSKlaus Jensen     n->qs_created = true;
555888eea45cSKlaus Jensen     return NVME_SUCCESS;
555988eea45cSKlaus Jensen }
556088eea45cSKlaus Jensen 
nvme_rpt_empty_id_struct(NvmeCtrl * n,NvmeRequest * req)556188eea45cSKlaus Jensen static uint16_t nvme_rpt_empty_id_struct(NvmeCtrl *n, NvmeRequest *req)
556288eea45cSKlaus Jensen {
556388eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
556488eea45cSKlaus Jensen 
556588eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
556688eea45cSKlaus Jensen }
556788eea45cSKlaus Jensen 
nvme_identify_ctrl(NvmeCtrl * n,NvmeRequest * req)556888eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl(NvmeCtrl *n, NvmeRequest *req)
556988eea45cSKlaus Jensen {
557088eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl();
557188eea45cSKlaus Jensen 
557288eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&n->id_ctrl, sizeof(n->id_ctrl), req);
557388eea45cSKlaus Jensen }
557488eea45cSKlaus Jensen 
nvme_identify_ctrl_csi(NvmeCtrl * n,NvmeRequest * req)557588eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl_csi(NvmeCtrl *n, NvmeRequest *req)
557688eea45cSKlaus Jensen {
557788eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
557888eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
557988eea45cSKlaus Jensen     NvmeIdCtrlNvm *id_nvm = (NvmeIdCtrlNvm *)&id;
558088eea45cSKlaus Jensen 
558188eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl_csi(c->csi);
558288eea45cSKlaus Jensen 
558388eea45cSKlaus Jensen     switch (c->csi) {
558488eea45cSKlaus Jensen     case NVME_CSI_NVM:
558588eea45cSKlaus Jensen         id_nvm->vsl = n->params.vsl;
558688eea45cSKlaus Jensen         id_nvm->dmrsl = cpu_to_le32(n->dmrsl);
558788eea45cSKlaus Jensen         break;
558888eea45cSKlaus Jensen 
558988eea45cSKlaus Jensen     case NVME_CSI_ZONED:
559088eea45cSKlaus Jensen         ((NvmeIdCtrlZoned *)&id)->zasl = n->params.zasl;
559188eea45cSKlaus Jensen         break;
559288eea45cSKlaus Jensen 
559388eea45cSKlaus Jensen     default:
559488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
559588eea45cSKlaus Jensen     }
559688eea45cSKlaus Jensen 
559788eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
559888eea45cSKlaus Jensen }
559988eea45cSKlaus Jensen 
nvme_identify_ns(NvmeCtrl * n,NvmeRequest * req,bool active)560088eea45cSKlaus Jensen static uint16_t nvme_identify_ns(NvmeCtrl *n, NvmeRequest *req, bool active)
560188eea45cSKlaus Jensen {
560288eea45cSKlaus Jensen     NvmeNamespace *ns;
560388eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
560488eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
560588eea45cSKlaus Jensen 
560688eea45cSKlaus Jensen     trace_pci_nvme_identify_ns(nsid);
560788eea45cSKlaus Jensen 
560888eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
560988eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
561088eea45cSKlaus Jensen     }
561188eea45cSKlaus Jensen 
561288eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
561388eea45cSKlaus Jensen     if (unlikely(!ns)) {
561488eea45cSKlaus Jensen         if (!active) {
561588eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
561688eea45cSKlaus Jensen             if (!ns) {
561788eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
561888eea45cSKlaus Jensen             }
561988eea45cSKlaus Jensen         } else {
562088eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
562188eea45cSKlaus Jensen         }
562288eea45cSKlaus Jensen     }
562388eea45cSKlaus Jensen 
56243553c48fSGollu Appalanaidu     if (active || ns->csi == NVME_CSI_NVM) {
562588eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)&ns->id_ns, sizeof(NvmeIdNs), req);
562688eea45cSKlaus Jensen     }
562788eea45cSKlaus Jensen 
562888eea45cSKlaus Jensen     return NVME_INVALID_CMD_SET | NVME_DNR;
562988eea45cSKlaus Jensen }
563088eea45cSKlaus Jensen 
nvme_identify_ctrl_list(NvmeCtrl * n,NvmeRequest * req,bool attached)56315f4eb94dSGollu Appalanaidu static uint16_t nvme_identify_ctrl_list(NvmeCtrl *n, NvmeRequest *req,
56325f4eb94dSGollu Appalanaidu                                         bool attached)
563388eea45cSKlaus Jensen {
563488eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
56355f4eb94dSGollu Appalanaidu     uint32_t nsid = le32_to_cpu(c->nsid);
563688eea45cSKlaus Jensen     uint16_t min_id = le16_to_cpu(c->ctrlid);
563788eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
563888eea45cSKlaus Jensen     uint16_t *ids = &list[1];
563988eea45cSKlaus Jensen     NvmeNamespace *ns;
564088eea45cSKlaus Jensen     NvmeCtrl *ctrl;
564188eea45cSKlaus Jensen     int cntlid, nr_ids = 0;
564288eea45cSKlaus Jensen 
56435f4eb94dSGollu Appalanaidu     trace_pci_nvme_identify_ctrl_list(c->cns, min_id);
564488eea45cSKlaus Jensen 
56455f4eb94dSGollu Appalanaidu     if (!n->subsys) {
564688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
564788eea45cSKlaus Jensen     }
564888eea45cSKlaus Jensen 
56495f4eb94dSGollu Appalanaidu     if (attached) {
56505f4eb94dSGollu Appalanaidu         if (nsid == NVME_NSID_BROADCAST) {
56515f4eb94dSGollu Appalanaidu             return NVME_INVALID_FIELD | NVME_DNR;
56525f4eb94dSGollu Appalanaidu         }
56535f4eb94dSGollu Appalanaidu 
56545f4eb94dSGollu Appalanaidu         ns = nvme_subsys_ns(n->subsys, nsid);
565588eea45cSKlaus Jensen         if (!ns) {
565688eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
565788eea45cSKlaus Jensen         }
56585f4eb94dSGollu Appalanaidu     }
565988eea45cSKlaus Jensen 
566088eea45cSKlaus Jensen     for (cntlid = min_id; cntlid < ARRAY_SIZE(n->subsys->ctrls); cntlid++) {
566188eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, cntlid);
566288eea45cSKlaus Jensen         if (!ctrl) {
566388eea45cSKlaus Jensen             continue;
566488eea45cSKlaus Jensen         }
566588eea45cSKlaus Jensen 
56665f4eb94dSGollu Appalanaidu         if (attached && !nvme_ns(ctrl, nsid)) {
566788eea45cSKlaus Jensen             continue;
566888eea45cSKlaus Jensen         }
566988eea45cSKlaus Jensen 
567088eea45cSKlaus Jensen         ids[nr_ids++] = cntlid;
567188eea45cSKlaus Jensen     }
567288eea45cSKlaus Jensen 
567388eea45cSKlaus Jensen     list[0] = nr_ids;
567488eea45cSKlaus Jensen 
567588eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)list, sizeof(list), req);
567688eea45cSKlaus Jensen }
567788eea45cSKlaus Jensen 
nvme_identify_pri_ctrl_cap(NvmeCtrl * n,NvmeRequest * req)56785e6f963fSLukasz Maniak static uint16_t nvme_identify_pri_ctrl_cap(NvmeCtrl *n, NvmeRequest *req)
56795e6f963fSLukasz Maniak {
56805e6f963fSLukasz Maniak     trace_pci_nvme_identify_pri_ctrl_cap(le16_to_cpu(n->pri_ctrl_cap.cntlid));
56815e6f963fSLukasz Maniak 
56825e6f963fSLukasz Maniak     return nvme_c2h(n, (uint8_t *)&n->pri_ctrl_cap,
56835e6f963fSLukasz Maniak                     sizeof(NvmePriCtrlCap), req);
56845e6f963fSLukasz Maniak }
56855e6f963fSLukasz Maniak 
nvme_identify_sec_ctrl_list(NvmeCtrl * n,NvmeRequest * req)568699f48ae7SLukasz Maniak static uint16_t nvme_identify_sec_ctrl_list(NvmeCtrl *n, NvmeRequest *req)
568799f48ae7SLukasz Maniak {
568899f48ae7SLukasz Maniak     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
568999f48ae7SLukasz Maniak     uint16_t pri_ctrl_id = le16_to_cpu(n->pri_ctrl_cap.cntlid);
569099f48ae7SLukasz Maniak     uint16_t min_id = le16_to_cpu(c->ctrlid);
56911a494d11SMinwoo Im     uint8_t num_sec_ctrl = n->nr_sec_ctrls;
569299f48ae7SLukasz Maniak     NvmeSecCtrlList list = {0};
569399f48ae7SLukasz Maniak     uint8_t i;
569499f48ae7SLukasz Maniak 
569599f48ae7SLukasz Maniak     for (i = 0; i < num_sec_ctrl; i++) {
56961a494d11SMinwoo Im         if (n->sec_ctrl_list[i].scid >= min_id) {
56971a494d11SMinwoo Im             list.numcntl = MIN(num_sec_ctrl - i, 127);
56981a494d11SMinwoo Im             memcpy(&list.sec, n->sec_ctrl_list + i,
569999f48ae7SLukasz Maniak                    list.numcntl * sizeof(NvmeSecCtrlEntry));
570099f48ae7SLukasz Maniak             break;
570199f48ae7SLukasz Maniak         }
570299f48ae7SLukasz Maniak     }
570399f48ae7SLukasz Maniak 
570499f48ae7SLukasz Maniak     trace_pci_nvme_identify_sec_ctrl_list(pri_ctrl_id, list.numcntl);
570599f48ae7SLukasz Maniak 
570699f48ae7SLukasz Maniak     return nvme_c2h(n, (uint8_t *)&list, sizeof(list), req);
570799f48ae7SLukasz Maniak }
570899f48ae7SLukasz Maniak 
nvme_identify_ns_ind(NvmeCtrl * n,NvmeRequest * req,bool alloc)570979e49005SArun Kumar static uint16_t nvme_identify_ns_ind(NvmeCtrl *n, NvmeRequest *req, bool alloc)
571079e49005SArun Kumar {
571179e49005SArun Kumar     NvmeNamespace *ns;
571279e49005SArun Kumar     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
571379e49005SArun Kumar     uint32_t nsid = le32_to_cpu(c->nsid);
571479e49005SArun Kumar 
571579e49005SArun Kumar     trace_pci_nvme_identify_ns_ind(nsid);
571679e49005SArun Kumar 
571779e49005SArun Kumar     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
571879e49005SArun Kumar         return NVME_INVALID_NSID | NVME_DNR;
571979e49005SArun Kumar     }
572079e49005SArun Kumar 
572179e49005SArun Kumar     ns = nvme_ns(n, nsid);
572279e49005SArun Kumar     if (unlikely(!ns)) {
572379e49005SArun Kumar         if (alloc) {
572479e49005SArun Kumar             ns = nvme_subsys_ns(n->subsys, nsid);
572579e49005SArun Kumar             if (!ns) {
572679e49005SArun Kumar                 return nvme_rpt_empty_id_struct(n, req);
572779e49005SArun Kumar             }
572879e49005SArun Kumar         } else {
572979e49005SArun Kumar             return nvme_rpt_empty_id_struct(n, req);
573079e49005SArun Kumar         }
573179e49005SArun Kumar     }
573279e49005SArun Kumar 
573379e49005SArun Kumar     return nvme_c2h(n, (uint8_t *)&ns->id_ns_ind, sizeof(NvmeIdNsInd), req);
573479e49005SArun Kumar }
573579e49005SArun Kumar 
nvme_identify_ns_csi(NvmeCtrl * n,NvmeRequest * req,bool active)573688eea45cSKlaus Jensen static uint16_t nvme_identify_ns_csi(NvmeCtrl *n, NvmeRequest *req,
573788eea45cSKlaus Jensen                                      bool active)
573888eea45cSKlaus Jensen {
573988eea45cSKlaus Jensen     NvmeNamespace *ns;
574088eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
574188eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
574288eea45cSKlaus Jensen 
574388eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_csi(nsid, c->csi);
574488eea45cSKlaus Jensen 
574588eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
574688eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
574788eea45cSKlaus Jensen     }
574888eea45cSKlaus Jensen 
574988eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
575088eea45cSKlaus Jensen     if (unlikely(!ns)) {
575188eea45cSKlaus Jensen         if (!active) {
575288eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
575388eea45cSKlaus Jensen             if (!ns) {
575488eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
575588eea45cSKlaus Jensen             }
575688eea45cSKlaus Jensen         } else {
575788eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
575888eea45cSKlaus Jensen         }
575988eea45cSKlaus Jensen     }
576088eea45cSKlaus Jensen 
57613553c48fSGollu Appalanaidu     if (c->csi == NVME_CSI_NVM) {
576244219b60SNaveen Nagar         return nvme_c2h(n, (uint8_t *)&ns->id_ns_nvm, sizeof(NvmeIdNsNvm),
576344219b60SNaveen Nagar                         req);
576488eea45cSKlaus Jensen     } else if (c->csi == NVME_CSI_ZONED && ns->csi == NVME_CSI_ZONED) {
576588eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)ns->id_ns_zoned, sizeof(NvmeIdNsZoned),
576688eea45cSKlaus Jensen                         req);
576788eea45cSKlaus Jensen     }
576888eea45cSKlaus Jensen 
576988eea45cSKlaus Jensen     return NVME_INVALID_FIELD | NVME_DNR;
577088eea45cSKlaus Jensen }
577188eea45cSKlaus Jensen 
nvme_identify_nslist(NvmeCtrl * n,NvmeRequest * req,bool active)577288eea45cSKlaus Jensen static uint16_t nvme_identify_nslist(NvmeCtrl *n, NvmeRequest *req,
577388eea45cSKlaus Jensen                                      bool active)
577488eea45cSKlaus Jensen {
577588eea45cSKlaus Jensen     NvmeNamespace *ns;
577688eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
577788eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
577888eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
577988eea45cSKlaus Jensen     static const int data_len = sizeof(list);
578088eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
578188eea45cSKlaus Jensen     int i, j = 0;
578288eea45cSKlaus Jensen 
578388eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist(min_nsid);
578488eea45cSKlaus Jensen 
578588eea45cSKlaus Jensen     /*
578688eea45cSKlaus Jensen      * Both FFFFFFFFh (NVME_NSID_BROADCAST) and FFFFFFFFEh are invalid values
578788eea45cSKlaus Jensen      * since the Active Namespace ID List should return namespaces with ids
578888eea45cSKlaus Jensen      * *higher* than the NSID specified in the command. This is also specified
578988eea45cSKlaus Jensen      * in the spec (NVM Express v1.3d, Section 5.15.4).
579088eea45cSKlaus Jensen      */
579188eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
579288eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
579388eea45cSKlaus Jensen     }
579488eea45cSKlaus Jensen 
579588eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
579688eea45cSKlaus Jensen         ns = nvme_ns(n, i);
579788eea45cSKlaus Jensen         if (!ns) {
579888eea45cSKlaus Jensen             if (!active) {
579988eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
580088eea45cSKlaus Jensen                 if (!ns) {
580188eea45cSKlaus Jensen                     continue;
580288eea45cSKlaus Jensen                 }
580388eea45cSKlaus Jensen             } else {
580488eea45cSKlaus Jensen                 continue;
580588eea45cSKlaus Jensen             }
580688eea45cSKlaus Jensen         }
580788eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid) {
580888eea45cSKlaus Jensen             continue;
580988eea45cSKlaus Jensen         }
581088eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
581188eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
581288eea45cSKlaus Jensen             break;
581388eea45cSKlaus Jensen         }
581488eea45cSKlaus Jensen     }
581588eea45cSKlaus Jensen 
581688eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
581788eea45cSKlaus Jensen }
581888eea45cSKlaus Jensen 
nvme_identify_nslist_csi(NvmeCtrl * n,NvmeRequest * req,bool active)581988eea45cSKlaus Jensen static uint16_t nvme_identify_nslist_csi(NvmeCtrl *n, NvmeRequest *req,
582088eea45cSKlaus Jensen                                          bool active)
582188eea45cSKlaus Jensen {
582288eea45cSKlaus Jensen     NvmeNamespace *ns;
582388eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
582488eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
582588eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
582688eea45cSKlaus Jensen     static const int data_len = sizeof(list);
582788eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
582888eea45cSKlaus Jensen     int i, j = 0;
582988eea45cSKlaus Jensen 
583088eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist_csi(min_nsid, c->csi);
583188eea45cSKlaus Jensen 
583288eea45cSKlaus Jensen     /*
583388eea45cSKlaus Jensen      * Same as in nvme_identify_nslist(), FFFFFFFFh/FFFFFFFFEh are invalid.
583488eea45cSKlaus Jensen      */
583588eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
583688eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
583788eea45cSKlaus Jensen     }
583888eea45cSKlaus Jensen 
583988eea45cSKlaus Jensen     if (c->csi != NVME_CSI_NVM && c->csi != NVME_CSI_ZONED) {
584088eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
584188eea45cSKlaus Jensen     }
584288eea45cSKlaus Jensen 
584388eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
584488eea45cSKlaus Jensen         ns = nvme_ns(n, i);
584588eea45cSKlaus Jensen         if (!ns) {
584688eea45cSKlaus Jensen             if (!active) {
584788eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
584888eea45cSKlaus Jensen                 if (!ns) {
584988eea45cSKlaus Jensen                     continue;
585088eea45cSKlaus Jensen                 }
585188eea45cSKlaus Jensen             } else {
585288eea45cSKlaus Jensen                 continue;
585388eea45cSKlaus Jensen             }
585488eea45cSKlaus Jensen         }
585588eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid || c->csi != ns->csi) {
585688eea45cSKlaus Jensen             continue;
585788eea45cSKlaus Jensen         }
585888eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
585988eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
586088eea45cSKlaus Jensen             break;
586188eea45cSKlaus Jensen         }
586288eea45cSKlaus Jensen     }
586388eea45cSKlaus Jensen 
586488eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
586588eea45cSKlaus Jensen }
586688eea45cSKlaus Jensen 
nvme_endurance_group_list(NvmeCtrl * n,NvmeRequest * req)586764715565SMinwoo Im static uint16_t nvme_endurance_group_list(NvmeCtrl *n, NvmeRequest *req)
586864715565SMinwoo Im {
586964715565SMinwoo Im     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
587064715565SMinwoo Im     uint16_t *nr_ids = &list[0];
587164715565SMinwoo Im     uint16_t *ids = &list[1];
587264715565SMinwoo Im     uint16_t endgid = le32_to_cpu(req->cmd.cdw11) & 0xffff;
587364715565SMinwoo Im 
587464715565SMinwoo Im     /*
587564715565SMinwoo Im      * The current nvme-subsys only supports Endurance Group #1.
587664715565SMinwoo Im      */
587764715565SMinwoo Im     if (!endgid) {
587864715565SMinwoo Im         *nr_ids = 1;
587964715565SMinwoo Im         ids[0] = 1;
588064715565SMinwoo Im     } else {
588164715565SMinwoo Im         *nr_ids = 0;
588264715565SMinwoo Im     }
588364715565SMinwoo Im 
588464715565SMinwoo Im     return nvme_c2h(n, list, sizeof(list), req);
588564715565SMinwoo Im }
588664715565SMinwoo Im 
nvme_identify_ns_descr_list(NvmeCtrl * n,NvmeRequest * req)588788eea45cSKlaus Jensen static uint16_t nvme_identify_ns_descr_list(NvmeCtrl *n, NvmeRequest *req)
588888eea45cSKlaus Jensen {
588988eea45cSKlaus Jensen     NvmeNamespace *ns;
589088eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
589188eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
589288eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
58936870cfb8SHeinrich Schuchardt     uint8_t *pos = list;
589488eea45cSKlaus Jensen     struct {
589588eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
589688eea45cSKlaus Jensen         uint8_t v[NVME_NIDL_UUID];
58975f4884c4SKlaus Jensen     } QEMU_PACKED uuid = {};
58986870cfb8SHeinrich Schuchardt     struct {
58996870cfb8SHeinrich Schuchardt         NvmeIdNsDescr hdr;
5900bdc31646SRoque Arcudia Hernandez         uint8_t v[NVME_NIDL_NGUID];
5901bdc31646SRoque Arcudia Hernandez     } QEMU_PACKED nguid = {};
5902bdc31646SRoque Arcudia Hernandez     struct {
5903bdc31646SRoque Arcudia Hernandez         NvmeIdNsDescr hdr;
59046870cfb8SHeinrich Schuchardt         uint64_t v;
59055f4884c4SKlaus Jensen     } QEMU_PACKED eui64 = {};
590688eea45cSKlaus Jensen     struct {
590788eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
590888eea45cSKlaus Jensen         uint8_t v;
59095f4884c4SKlaus Jensen     } QEMU_PACKED csi = {};
591088eea45cSKlaus Jensen 
591188eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_descr_list(nsid);
591288eea45cSKlaus Jensen 
591388eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
591488eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
591588eea45cSKlaus Jensen     }
591688eea45cSKlaus Jensen 
591788eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
591888eea45cSKlaus Jensen     if (unlikely(!ns)) {
591988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
592088eea45cSKlaus Jensen     }
592188eea45cSKlaus Jensen 
59229f2e1acfSKlaus Jensen     if (!qemu_uuid_is_null(&ns->params.uuid)) {
59236870cfb8SHeinrich Schuchardt         uuid.hdr.nidt = NVME_NIDT_UUID;
59246870cfb8SHeinrich Schuchardt         uuid.hdr.nidl = NVME_NIDL_UUID;
59256870cfb8SHeinrich Schuchardt         memcpy(uuid.v, ns->params.uuid.data, NVME_NIDL_UUID);
59266870cfb8SHeinrich Schuchardt         memcpy(pos, &uuid, sizeof(uuid));
59276870cfb8SHeinrich Schuchardt         pos += sizeof(uuid);
59289f2e1acfSKlaus Jensen     }
592988eea45cSKlaus Jensen 
5930bdc31646SRoque Arcudia Hernandez     if (!nvme_nguid_is_null(&ns->params.nguid)) {
5931bdc31646SRoque Arcudia Hernandez         nguid.hdr.nidt = NVME_NIDT_NGUID;
5932bdc31646SRoque Arcudia Hernandez         nguid.hdr.nidl = NVME_NIDL_NGUID;
5933bdc31646SRoque Arcudia Hernandez         memcpy(nguid.v, ns->params.nguid.data, NVME_NIDL_NGUID);
5934bdc31646SRoque Arcudia Hernandez         memcpy(pos, &nguid, sizeof(nguid));
5935bdc31646SRoque Arcudia Hernandez         pos += sizeof(nguid);
5936bdc31646SRoque Arcudia Hernandez     }
5937bdc31646SRoque Arcudia Hernandez 
59386870cfb8SHeinrich Schuchardt     if (ns->params.eui64) {
59396870cfb8SHeinrich Schuchardt         eui64.hdr.nidt = NVME_NIDT_EUI64;
59406870cfb8SHeinrich Schuchardt         eui64.hdr.nidl = NVME_NIDL_EUI64;
59416870cfb8SHeinrich Schuchardt         eui64.v = cpu_to_be64(ns->params.eui64);
59426870cfb8SHeinrich Schuchardt         memcpy(pos, &eui64, sizeof(eui64));
59436870cfb8SHeinrich Schuchardt         pos += sizeof(eui64);
59446870cfb8SHeinrich Schuchardt     }
59456870cfb8SHeinrich Schuchardt 
59466870cfb8SHeinrich Schuchardt     csi.hdr.nidt = NVME_NIDT_CSI;
59476870cfb8SHeinrich Schuchardt     csi.hdr.nidl = NVME_NIDL_CSI;
59486870cfb8SHeinrich Schuchardt     csi.v = ns->csi;
59496870cfb8SHeinrich Schuchardt     memcpy(pos, &csi, sizeof(csi));
59506870cfb8SHeinrich Schuchardt     pos += sizeof(csi);
595188eea45cSKlaus Jensen 
595288eea45cSKlaus Jensen     return nvme_c2h(n, list, sizeof(list), req);
595388eea45cSKlaus Jensen }
595488eea45cSKlaus Jensen 
nvme_identify_cmd_set(NvmeCtrl * n,NvmeRequest * req)595588eea45cSKlaus Jensen static uint16_t nvme_identify_cmd_set(NvmeCtrl *n, NvmeRequest *req)
595688eea45cSKlaus Jensen {
595788eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
595888eea45cSKlaus Jensen     static const int data_len = sizeof(list);
595988eea45cSKlaus Jensen 
596088eea45cSKlaus Jensen     trace_pci_nvme_identify_cmd_set();
596188eea45cSKlaus Jensen 
596288eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_NVM);
596388eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_ZONED);
596488eea45cSKlaus Jensen 
596588eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
596688eea45cSKlaus Jensen }
596788eea45cSKlaus Jensen 
nvme_identify(NvmeCtrl * n,NvmeRequest * req)596888eea45cSKlaus Jensen static uint16_t nvme_identify(NvmeCtrl *n, NvmeRequest *req)
596988eea45cSKlaus Jensen {
597088eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
597188eea45cSKlaus Jensen 
597288eea45cSKlaus Jensen     trace_pci_nvme_identify(nvme_cid(req), c->cns, le16_to_cpu(c->ctrlid),
597388eea45cSKlaus Jensen                             c->csi);
597488eea45cSKlaus Jensen 
597588eea45cSKlaus Jensen     switch (c->cns) {
597688eea45cSKlaus Jensen     case NVME_ID_CNS_NS:
597788eea45cSKlaus Jensen         return nvme_identify_ns(n, req, true);
597888eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT:
597988eea45cSKlaus Jensen         return nvme_identify_ns(n, req, false);
598088eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ATTACHED_CTRL_LIST:
59815f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, true);
59825f4eb94dSGollu Appalanaidu     case NVME_ID_CNS_CTRL_LIST:
59835f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, false);
59845e6f963fSLukasz Maniak     case NVME_ID_CNS_PRIMARY_CTRL_CAP:
59855e6f963fSLukasz Maniak         return nvme_identify_pri_ctrl_cap(n, req);
598699f48ae7SLukasz Maniak     case NVME_ID_CNS_SECONDARY_CTRL_LIST:
598799f48ae7SLukasz Maniak         return nvme_identify_sec_ctrl_list(n, req);
598888eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS:
598988eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, true);
599079e49005SArun Kumar     case NVME_ID_CNS_CS_IND_NS:
599179e49005SArun Kumar         return nvme_identify_ns_ind(n, req, false);
599279e49005SArun Kumar     case NVME_ID_CNS_CS_IND_NS_ALLOCATED:
599379e49005SArun Kumar         return nvme_identify_ns_ind(n, req, true);
599488eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT:
599588eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, false);
599688eea45cSKlaus Jensen     case NVME_ID_CNS_CTRL:
599788eea45cSKlaus Jensen         return nvme_identify_ctrl(n, req);
599888eea45cSKlaus Jensen     case NVME_ID_CNS_CS_CTRL:
599988eea45cSKlaus Jensen         return nvme_identify_ctrl_csi(n, req);
600088eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ACTIVE_LIST:
600188eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, true);
600288eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT_LIST:
600388eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, false);
600488eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_ACTIVE_LIST:
600588eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, true);
600664715565SMinwoo Im     case NVME_ID_CNS_ENDURANCE_GROUP_LIST:
600764715565SMinwoo Im         return nvme_endurance_group_list(n, req);
600888eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT_LIST:
600988eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, false);
601088eea45cSKlaus Jensen     case NVME_ID_CNS_NS_DESCR_LIST:
601188eea45cSKlaus Jensen         return nvme_identify_ns_descr_list(n, req);
601288eea45cSKlaus Jensen     case NVME_ID_CNS_IO_COMMAND_SET:
601388eea45cSKlaus Jensen         return nvme_identify_cmd_set(n, req);
601488eea45cSKlaus Jensen     default:
601588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_identify_cns(le32_to_cpu(c->cns));
601688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
601788eea45cSKlaus Jensen     }
601888eea45cSKlaus Jensen }
601988eea45cSKlaus Jensen 
nvme_abort(NvmeCtrl * n,NvmeRequest * req)602088eea45cSKlaus Jensen static uint16_t nvme_abort(NvmeCtrl *n, NvmeRequest *req)
602188eea45cSKlaus Jensen {
602288eea45cSKlaus Jensen     uint16_t sqid = le32_to_cpu(req->cmd.cdw10) & 0xffff;
602375209c07SAyush Mishra     uint16_t cid  = (le32_to_cpu(req->cmd.cdw10) >> 16) & 0xffff;
602475209c07SAyush Mishra     NvmeSQueue *sq = n->sq[sqid];
602575209c07SAyush Mishra     NvmeRequest *r, *next;
602675209c07SAyush Mishra     int i;
602788eea45cSKlaus Jensen 
602888eea45cSKlaus Jensen     req->cqe.result = 1;
602988eea45cSKlaus Jensen     if (nvme_check_sqid(n, sqid)) {
603088eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
603188eea45cSKlaus Jensen     }
603288eea45cSKlaus Jensen 
603375209c07SAyush Mishra     if (sqid == 0) {
603475209c07SAyush Mishra         for (i = 0; i < n->outstanding_aers; i++) {
603575209c07SAyush Mishra             NvmeRequest *re = n->aer_reqs[i];
603675209c07SAyush Mishra             if (re->cqe.cid == cid) {
603775209c07SAyush Mishra                 memmove(n->aer_reqs + i, n->aer_reqs + i + 1,
603875209c07SAyush Mishra                          (n->outstanding_aers - i - 1) * sizeof(NvmeRequest *));
603975209c07SAyush Mishra                 n->outstanding_aers--;
604075209c07SAyush Mishra                 re->status = NVME_CMD_ABORT_REQ;
604175209c07SAyush Mishra                 req->cqe.result = 0;
604275209c07SAyush Mishra                 nvme_enqueue_req_completion(&n->admin_cq, re);
604375209c07SAyush Mishra                 return NVME_SUCCESS;
604475209c07SAyush Mishra             }
604575209c07SAyush Mishra         }
604675209c07SAyush Mishra     }
604775209c07SAyush Mishra 
604875209c07SAyush Mishra     QTAILQ_FOREACH_SAFE(r, &sq->out_req_list, entry, next) {
604975209c07SAyush Mishra         if (r->cqe.cid == cid) {
605075209c07SAyush Mishra             if (r->aiocb) {
605175209c07SAyush Mishra                 blk_aio_cancel_async(r->aiocb);
605275209c07SAyush Mishra             }
605375209c07SAyush Mishra             break;
605475209c07SAyush Mishra         }
605575209c07SAyush Mishra     }
605675209c07SAyush Mishra 
605788eea45cSKlaus Jensen     return NVME_SUCCESS;
605888eea45cSKlaus Jensen }
605988eea45cSKlaus Jensen 
nvme_set_timestamp(NvmeCtrl * n,uint64_t ts)606088eea45cSKlaus Jensen static inline void nvme_set_timestamp(NvmeCtrl *n, uint64_t ts)
606188eea45cSKlaus Jensen {
606288eea45cSKlaus Jensen     trace_pci_nvme_setfeat_timestamp(ts);
606388eea45cSKlaus Jensen 
606488eea45cSKlaus Jensen     n->host_timestamp = le64_to_cpu(ts);
606588eea45cSKlaus Jensen     n->timestamp_set_qemu_clock_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
606688eea45cSKlaus Jensen }
606788eea45cSKlaus Jensen 
nvme_get_timestamp(const NvmeCtrl * n)606888eea45cSKlaus Jensen static inline uint64_t nvme_get_timestamp(const NvmeCtrl *n)
606988eea45cSKlaus Jensen {
607088eea45cSKlaus Jensen     uint64_t current_time = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
607188eea45cSKlaus Jensen     uint64_t elapsed_time = current_time - n->timestamp_set_qemu_clock_ms;
607288eea45cSKlaus Jensen 
607388eea45cSKlaus Jensen     union nvme_timestamp {
607488eea45cSKlaus Jensen         struct {
607588eea45cSKlaus Jensen             uint64_t timestamp:48;
607688eea45cSKlaus Jensen             uint64_t sync:1;
607788eea45cSKlaus Jensen             uint64_t origin:3;
607888eea45cSKlaus Jensen             uint64_t rsvd1:12;
607988eea45cSKlaus Jensen         };
608088eea45cSKlaus Jensen         uint64_t all;
608188eea45cSKlaus Jensen     };
608288eea45cSKlaus Jensen 
608388eea45cSKlaus Jensen     union nvme_timestamp ts;
608488eea45cSKlaus Jensen     ts.all = 0;
608588eea45cSKlaus Jensen     ts.timestamp = n->host_timestamp + elapsed_time;
608688eea45cSKlaus Jensen 
608788eea45cSKlaus Jensen     /* If the host timestamp is non-zero, set the timestamp origin */
608888eea45cSKlaus Jensen     ts.origin = n->host_timestamp ? 0x01 : 0x00;
608988eea45cSKlaus Jensen 
609088eea45cSKlaus Jensen     trace_pci_nvme_getfeat_timestamp(ts.all);
609188eea45cSKlaus Jensen 
609288eea45cSKlaus Jensen     return cpu_to_le64(ts.all);
609388eea45cSKlaus Jensen }
609488eea45cSKlaus Jensen 
nvme_get_feature_timestamp(NvmeCtrl * n,NvmeRequest * req)609588eea45cSKlaus Jensen static uint16_t nvme_get_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
609688eea45cSKlaus Jensen {
609788eea45cSKlaus Jensen     uint64_t timestamp = nvme_get_timestamp(n);
609888eea45cSKlaus Jensen 
609988eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
610088eea45cSKlaus Jensen }
610188eea45cSKlaus Jensen 
nvme_get_feature_fdp(NvmeCtrl * n,uint32_t endgrpid,uint32_t * result)610273064edfSJesper Devantier static int nvme_get_feature_fdp(NvmeCtrl *n, uint32_t endgrpid,
610373064edfSJesper Devantier                                 uint32_t *result)
610473064edfSJesper Devantier {
610573064edfSJesper Devantier     *result = 0;
610673064edfSJesper Devantier 
610773064edfSJesper Devantier     if (!n->subsys || !n->subsys->endgrp.fdp.enabled) {
610873064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
610973064edfSJesper Devantier     }
611073064edfSJesper Devantier 
611173064edfSJesper Devantier     *result = FIELD_DP16(0, FEAT_FDP, FDPE, 1);
611273064edfSJesper Devantier     *result = FIELD_DP16(*result, FEAT_FDP, CONF_NDX, 0);
611373064edfSJesper Devantier 
611473064edfSJesper Devantier     return NVME_SUCCESS;
611573064edfSJesper Devantier }
611673064edfSJesper Devantier 
nvme_get_feature_fdp_events(NvmeCtrl * n,NvmeNamespace * ns,NvmeRequest * req,uint32_t * result)611773064edfSJesper Devantier static uint16_t nvme_get_feature_fdp_events(NvmeCtrl *n, NvmeNamespace *ns,
611873064edfSJesper Devantier                                             NvmeRequest *req, uint32_t *result)
611973064edfSJesper Devantier {
612073064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
612173064edfSJesper Devantier     uint32_t cdw11 = le32_to_cpu(cmd->cdw11);
612273064edfSJesper Devantier     uint16_t ph = cdw11 & 0xffff;
612373064edfSJesper Devantier     uint8_t noet = (cdw11 >> 16) & 0xff;
612473064edfSJesper Devantier     uint16_t ruhid, ret;
612573064edfSJesper Devantier     uint32_t nentries = 0;
612673064edfSJesper Devantier     uint8_t s_events_ndx = 0;
612773064edfSJesper Devantier     size_t s_events_siz = sizeof(NvmeFdpEventDescr) * noet;
612873064edfSJesper Devantier     g_autofree NvmeFdpEventDescr *s_events = g_malloc0(s_events_siz);
612973064edfSJesper Devantier     NvmeRuHandle *ruh;
613073064edfSJesper Devantier     NvmeFdpEventDescr *s_event;
613173064edfSJesper Devantier 
613273064edfSJesper Devantier     if (!n->subsys || !n->subsys->endgrp.fdp.enabled) {
613373064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
613473064edfSJesper Devantier     }
613573064edfSJesper Devantier 
613673064edfSJesper Devantier     if (!nvme_ph_valid(ns, ph)) {
613773064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
613873064edfSJesper Devantier     }
613973064edfSJesper Devantier 
614073064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
614173064edfSJesper Devantier     ruh = &n->subsys->endgrp.fdp.ruhs[ruhid];
614273064edfSJesper Devantier 
614373064edfSJesper Devantier     assert(ruh);
614473064edfSJesper Devantier 
614573064edfSJesper Devantier     if (unlikely(noet == 0)) {
614673064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
614773064edfSJesper Devantier     }
614873064edfSJesper Devantier 
614973064edfSJesper Devantier     for (uint8_t event_type = 0; event_type < FDP_EVT_MAX; event_type++) {
615073064edfSJesper Devantier         uint8_t shift = nvme_fdp_evf_shifts[event_type];
615173064edfSJesper Devantier         if (!shift && event_type) {
615273064edfSJesper Devantier             /*
615373064edfSJesper Devantier              * only first entry (event_type == 0) has a shift value of 0
615473064edfSJesper Devantier              * other entries are simply unpopulated.
615573064edfSJesper Devantier              */
615673064edfSJesper Devantier             continue;
615773064edfSJesper Devantier         }
615873064edfSJesper Devantier 
615973064edfSJesper Devantier         nentries++;
616073064edfSJesper Devantier 
616173064edfSJesper Devantier         s_event = &s_events[s_events_ndx];
616273064edfSJesper Devantier         s_event->evt = event_type;
616373064edfSJesper Devantier         s_event->evta = (ruh->event_filter >> shift) & 0x1;
616473064edfSJesper Devantier 
616573064edfSJesper Devantier         /* break if all `noet` entries are filled */
616673064edfSJesper Devantier         if ((++s_events_ndx) == noet) {
616773064edfSJesper Devantier             break;
616873064edfSJesper Devantier         }
616973064edfSJesper Devantier     }
617073064edfSJesper Devantier 
617173064edfSJesper Devantier     ret = nvme_c2h(n, s_events, s_events_siz, req);
617273064edfSJesper Devantier     if (ret) {
617373064edfSJesper Devantier         return ret;
617473064edfSJesper Devantier     }
617573064edfSJesper Devantier 
617673064edfSJesper Devantier     *result = nentries;
617773064edfSJesper Devantier     return NVME_SUCCESS;
617873064edfSJesper Devantier }
617973064edfSJesper Devantier 
nvme_get_feature(NvmeCtrl * n,NvmeRequest * req)618088eea45cSKlaus Jensen static uint16_t nvme_get_feature(NvmeCtrl *n, NvmeRequest *req)
618188eea45cSKlaus Jensen {
618288eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
618388eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
618488eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
618588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
61868cdb368dSMarc-André Lureau     uint32_t result = 0;
618788eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
618888eea45cSKlaus Jensen     NvmeGetFeatureSelect sel = NVME_GETFEAT_SELECT(dw10);
618988eea45cSKlaus Jensen     uint16_t iv;
619088eea45cSKlaus Jensen     NvmeNamespace *ns;
619188eea45cSKlaus Jensen     int i;
619273064edfSJesper Devantier     uint16_t endgrpid = 0, ret = NVME_SUCCESS;
619388eea45cSKlaus Jensen 
619488eea45cSKlaus Jensen     static const uint32_t nvme_feature_default[NVME_FID_MAX] = {
619588eea45cSKlaus Jensen         [NVME_ARBITRATION] = NVME_ARB_AB_NOLIMIT,
619688eea45cSKlaus Jensen     };
619788eea45cSKlaus Jensen 
619888eea45cSKlaus Jensen     trace_pci_nvme_getfeat(nvme_cid(req), nsid, fid, sel, dw11);
619988eea45cSKlaus Jensen 
620088eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
620188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
620288eea45cSKlaus Jensen     }
620388eea45cSKlaus Jensen 
620488eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
620588eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
620688eea45cSKlaus Jensen             /*
620788eea45cSKlaus Jensen              * The Reservation Notification Mask and Reservation Persistence
620888eea45cSKlaus Jensen              * features require a status code of Invalid Field in Command when
620988eea45cSKlaus Jensen              * NSID is FFFFFFFFh. Since the device does not support those
621088eea45cSKlaus Jensen              * features we can always return Invalid Namespace or Format as we
621188eea45cSKlaus Jensen              * should do for all other features.
621288eea45cSKlaus Jensen              */
621388eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
621488eea45cSKlaus Jensen         }
621588eea45cSKlaus Jensen 
621688eea45cSKlaus Jensen         if (!nvme_ns(n, nsid)) {
621788eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
621888eea45cSKlaus Jensen         }
621988eea45cSKlaus Jensen     }
622088eea45cSKlaus Jensen 
622188eea45cSKlaus Jensen     switch (sel) {
622288eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CURRENT:
622388eea45cSKlaus Jensen         break;
622488eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_SAVED:
622588eea45cSKlaus Jensen         /* no features are saveable by the controller; fallthrough */
622688eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_DEFAULT:
622788eea45cSKlaus Jensen         goto defaults;
622888eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CAP:
622988eea45cSKlaus Jensen         result = nvme_feature_cap[fid];
623088eea45cSKlaus Jensen         goto out;
623188eea45cSKlaus Jensen     }
623288eea45cSKlaus Jensen 
623388eea45cSKlaus Jensen     switch (fid) {
623488eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
623588eea45cSKlaus Jensen         result = 0;
623688eea45cSKlaus Jensen 
623788eea45cSKlaus Jensen         /*
623888eea45cSKlaus Jensen          * The controller only implements the Composite Temperature sensor, so
623988eea45cSKlaus Jensen          * return 0 for all other sensors.
624088eea45cSKlaus Jensen          */
624188eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
624288eea45cSKlaus Jensen             goto out;
624388eea45cSKlaus Jensen         }
624488eea45cSKlaus Jensen 
624588eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
624688eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
624788eea45cSKlaus Jensen             result = n->features.temp_thresh_hi;
624888eea45cSKlaus Jensen             goto out;
624988eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
625088eea45cSKlaus Jensen             result = n->features.temp_thresh_low;
625188eea45cSKlaus Jensen             goto out;
625288eea45cSKlaus Jensen         }
625388eea45cSKlaus Jensen 
625488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
625588eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
625688eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
625788eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
625888eea45cSKlaus Jensen         }
625988eea45cSKlaus Jensen 
626088eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
626188eea45cSKlaus Jensen         if (unlikely(!ns)) {
626288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
626388eea45cSKlaus Jensen         }
626488eea45cSKlaus Jensen 
626588eea45cSKlaus Jensen         result = ns->features.err_rec;
626688eea45cSKlaus Jensen         goto out;
626788eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
626888eea45cSKlaus Jensen         result = 0;
626988eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
627088eea45cSKlaus Jensen             ns = nvme_ns(n, i);
627188eea45cSKlaus Jensen             if (!ns) {
627288eea45cSKlaus Jensen                 continue;
627388eea45cSKlaus Jensen             }
627488eea45cSKlaus Jensen 
627588eea45cSKlaus Jensen             result = blk_enable_write_cache(ns->blkconf.blk);
627688eea45cSKlaus Jensen             if (result) {
627788eea45cSKlaus Jensen                 break;
627888eea45cSKlaus Jensen             }
627988eea45cSKlaus Jensen         }
628088eea45cSKlaus Jensen         trace_pci_nvme_getfeat_vwcache(result ? "enabled" : "disabled");
628188eea45cSKlaus Jensen         goto out;
628288eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
628388eea45cSKlaus Jensen         result = n->features.async_config;
628488eea45cSKlaus Jensen         goto out;
628588eea45cSKlaus Jensen     case NVME_TIMESTAMP:
628688eea45cSKlaus Jensen         return nvme_get_feature_timestamp(n, req);
6287d0c0697bSNaveen Nagar     case NVME_HOST_BEHAVIOR_SUPPORT:
6288d0c0697bSNaveen Nagar         return nvme_c2h(n, (uint8_t *)&n->features.hbs,
6289d0c0697bSNaveen Nagar                         sizeof(n->features.hbs), req);
629073064edfSJesper Devantier     case NVME_FDP_MODE:
629173064edfSJesper Devantier         endgrpid = dw11 & 0xff;
629273064edfSJesper Devantier 
629373064edfSJesper Devantier         if (endgrpid != 0x1) {
629473064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
629573064edfSJesper Devantier         }
629673064edfSJesper Devantier 
629773064edfSJesper Devantier         ret = nvme_get_feature_fdp(n, endgrpid, &result);
629873064edfSJesper Devantier         if (ret) {
629973064edfSJesper Devantier             return ret;
630073064edfSJesper Devantier         }
630173064edfSJesper Devantier         goto out;
630273064edfSJesper Devantier     case NVME_FDP_EVENTS:
630373064edfSJesper Devantier         if (!nvme_nsid_valid(n, nsid)) {
630473064edfSJesper Devantier             return NVME_INVALID_NSID | NVME_DNR;
630573064edfSJesper Devantier         }
630673064edfSJesper Devantier 
630773064edfSJesper Devantier         ns = nvme_ns(n, nsid);
630873064edfSJesper Devantier         if (unlikely(!ns)) {
630973064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
631073064edfSJesper Devantier         }
631173064edfSJesper Devantier 
631273064edfSJesper Devantier         ret = nvme_get_feature_fdp_events(n, ns, req, &result);
631373064edfSJesper Devantier         if (ret) {
631473064edfSJesper Devantier             return ret;
631573064edfSJesper Devantier         }
631673064edfSJesper Devantier         goto out;
631788eea45cSKlaus Jensen     default:
631888eea45cSKlaus Jensen         break;
631988eea45cSKlaus Jensen     }
632088eea45cSKlaus Jensen 
632188eea45cSKlaus Jensen defaults:
632288eea45cSKlaus Jensen     switch (fid) {
632388eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
632488eea45cSKlaus Jensen         result = 0;
632588eea45cSKlaus Jensen 
632688eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
632788eea45cSKlaus Jensen             break;
632888eea45cSKlaus Jensen         }
632988eea45cSKlaus Jensen 
633088eea45cSKlaus Jensen         if (NVME_TEMP_THSEL(dw11) == NVME_TEMP_THSEL_OVER) {
633188eea45cSKlaus Jensen             result = NVME_TEMPERATURE_WARNING;
633288eea45cSKlaus Jensen         }
633388eea45cSKlaus Jensen 
633488eea45cSKlaus Jensen         break;
633588eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
6336decc0261SŁukasz Gieryk         result = (n->conf_ioqpairs - 1) | ((n->conf_ioqpairs - 1) << 16);
633788eea45cSKlaus Jensen         trace_pci_nvme_getfeat_numq(result);
633888eea45cSKlaus Jensen         break;
633988eea45cSKlaus Jensen     case NVME_INTERRUPT_VECTOR_CONF:
634088eea45cSKlaus Jensen         iv = dw11 & 0xffff;
6341decc0261SŁukasz Gieryk         if (iv >= n->conf_ioqpairs + 1) {
634288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
634388eea45cSKlaus Jensen         }
634488eea45cSKlaus Jensen 
634588eea45cSKlaus Jensen         result = iv;
634688eea45cSKlaus Jensen         if (iv == n->admin_cq.vector) {
634788eea45cSKlaus Jensen             result |= NVME_INTVC_NOCOALESCING;
634888eea45cSKlaus Jensen         }
634988eea45cSKlaus Jensen         break;
635073064edfSJesper Devantier     case NVME_FDP_MODE:
635173064edfSJesper Devantier         endgrpid = dw11 & 0xff;
635273064edfSJesper Devantier 
635373064edfSJesper Devantier         if (endgrpid != 0x1) {
635473064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
635573064edfSJesper Devantier         }
635673064edfSJesper Devantier 
635773064edfSJesper Devantier         ret = nvme_get_feature_fdp(n, endgrpid, &result);
635873064edfSJesper Devantier         if (ret) {
635973064edfSJesper Devantier             return ret;
636073064edfSJesper Devantier         }
6361ebd1568fSAlan Adamson         break;
636273064edfSJesper Devantier 
6363ebd1568fSAlan Adamson     case NVME_WRITE_ATOMICITY:
6364ebd1568fSAlan Adamson         result = n->dn;
636573064edfSJesper Devantier         break;
636688eea45cSKlaus Jensen     default:
636788eea45cSKlaus Jensen         result = nvme_feature_default[fid];
636888eea45cSKlaus Jensen         break;
636988eea45cSKlaus Jensen     }
637088eea45cSKlaus Jensen 
637188eea45cSKlaus Jensen out:
637288eea45cSKlaus Jensen     req->cqe.result = cpu_to_le32(result);
637373064edfSJesper Devantier     return ret;
637488eea45cSKlaus Jensen }
637588eea45cSKlaus Jensen 
nvme_set_feature_timestamp(NvmeCtrl * n,NvmeRequest * req)637688eea45cSKlaus Jensen static uint16_t nvme_set_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
637788eea45cSKlaus Jensen {
637888eea45cSKlaus Jensen     uint16_t ret;
637988eea45cSKlaus Jensen     uint64_t timestamp;
638088eea45cSKlaus Jensen 
638188eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
638288eea45cSKlaus Jensen     if (ret) {
638388eea45cSKlaus Jensen         return ret;
638488eea45cSKlaus Jensen     }
638588eea45cSKlaus Jensen 
638688eea45cSKlaus Jensen     nvme_set_timestamp(n, timestamp);
638788eea45cSKlaus Jensen 
638888eea45cSKlaus Jensen     return NVME_SUCCESS;
638988eea45cSKlaus Jensen }
639088eea45cSKlaus Jensen 
nvme_set_feature_fdp_events(NvmeCtrl * n,NvmeNamespace * ns,NvmeRequest * req)639173064edfSJesper Devantier static uint16_t nvme_set_feature_fdp_events(NvmeCtrl *n, NvmeNamespace *ns,
639273064edfSJesper Devantier                                             NvmeRequest *req)
639373064edfSJesper Devantier {
639473064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
639573064edfSJesper Devantier     uint32_t cdw11 = le32_to_cpu(cmd->cdw11);
639673064edfSJesper Devantier     uint16_t ph = cdw11 & 0xffff;
639773064edfSJesper Devantier     uint8_t noet = (cdw11 >> 16) & 0xff;
639873064edfSJesper Devantier     uint16_t ret, ruhid;
639973064edfSJesper Devantier     uint8_t enable = le32_to_cpu(cmd->cdw12) & 0x1;
640073064edfSJesper Devantier     uint8_t event_mask = 0;
640173064edfSJesper Devantier     unsigned int i;
640273064edfSJesper Devantier     g_autofree uint8_t *events = g_malloc0(noet);
640373064edfSJesper Devantier     NvmeRuHandle *ruh = NULL;
640473064edfSJesper Devantier 
640573064edfSJesper Devantier     assert(ns);
640673064edfSJesper Devantier 
640773064edfSJesper Devantier     if (!n->subsys || !n->subsys->endgrp.fdp.enabled) {
640873064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
640973064edfSJesper Devantier     }
641073064edfSJesper Devantier 
641173064edfSJesper Devantier     if (!nvme_ph_valid(ns, ph)) {
641273064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
641373064edfSJesper Devantier     }
641473064edfSJesper Devantier 
641573064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
641673064edfSJesper Devantier     ruh = &n->subsys->endgrp.fdp.ruhs[ruhid];
641773064edfSJesper Devantier 
641873064edfSJesper Devantier     ret = nvme_h2c(n, events, noet, req);
641973064edfSJesper Devantier     if (ret) {
642073064edfSJesper Devantier         return ret;
642173064edfSJesper Devantier     }
642273064edfSJesper Devantier 
642373064edfSJesper Devantier     for (i = 0; i < noet; i++) {
642473064edfSJesper Devantier         event_mask |= (1 << nvme_fdp_evf_shifts[events[i]]);
642573064edfSJesper Devantier     }
642673064edfSJesper Devantier 
642773064edfSJesper Devantier     if (enable) {
642873064edfSJesper Devantier         ruh->event_filter |= event_mask;
642973064edfSJesper Devantier     } else {
643073064edfSJesper Devantier         ruh->event_filter = ruh->event_filter & ~event_mask;
643173064edfSJesper Devantier     }
643273064edfSJesper Devantier 
643373064edfSJesper Devantier     return NVME_SUCCESS;
643473064edfSJesper Devantier }
643573064edfSJesper Devantier 
nvme_set_feature(NvmeCtrl * n,NvmeRequest * req)643688eea45cSKlaus Jensen static uint16_t nvme_set_feature(NvmeCtrl *n, NvmeRequest *req)
643788eea45cSKlaus Jensen {
643888eea45cSKlaus Jensen     NvmeNamespace *ns = NULL;
643988eea45cSKlaus Jensen 
644088eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
644188eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
644288eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
644388eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
644488eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
644588eea45cSKlaus Jensen     uint8_t save = NVME_SETFEAT_SAVE(dw10);
6446763c05dfSNaveen Nagar     uint16_t status;
644788eea45cSKlaus Jensen     int i;
6448ebd1568fSAlan Adamson     NvmeIdCtrl *id = &n->id_ctrl;
6449ebd1568fSAlan Adamson     NvmeAtomic *atomic = &n->atomic;
645088eea45cSKlaus Jensen 
645188eea45cSKlaus Jensen     trace_pci_nvme_setfeat(nvme_cid(req), nsid, fid, save, dw11);
645288eea45cSKlaus Jensen 
645388eea45cSKlaus Jensen     if (save && !(nvme_feature_cap[fid] & NVME_FEAT_CAP_SAVE)) {
645488eea45cSKlaus Jensen         return NVME_FID_NOT_SAVEABLE | NVME_DNR;
645588eea45cSKlaus Jensen     }
645688eea45cSKlaus Jensen 
645788eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
645888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
645988eea45cSKlaus Jensen     }
646088eea45cSKlaus Jensen 
646188eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
646288eea45cSKlaus Jensen         if (nsid != NVME_NSID_BROADCAST) {
646388eea45cSKlaus Jensen             if (!nvme_nsid_valid(n, nsid)) {
646488eea45cSKlaus Jensen                 return NVME_INVALID_NSID | NVME_DNR;
646588eea45cSKlaus Jensen             }
646688eea45cSKlaus Jensen 
646788eea45cSKlaus Jensen             ns = nvme_ns(n, nsid);
646888eea45cSKlaus Jensen             if (unlikely(!ns)) {
646988eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
647088eea45cSKlaus Jensen             }
647188eea45cSKlaus Jensen         }
647288eea45cSKlaus Jensen     } else if (nsid && nsid != NVME_NSID_BROADCAST) {
647388eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
647488eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
647588eea45cSKlaus Jensen         }
647688eea45cSKlaus Jensen 
647788eea45cSKlaus Jensen         return NVME_FEAT_NOT_NS_SPEC | NVME_DNR;
647888eea45cSKlaus Jensen     }
647988eea45cSKlaus Jensen 
648088eea45cSKlaus Jensen     if (!(nvme_feature_cap[fid] & NVME_FEAT_CAP_CHANGE)) {
648188eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
648288eea45cSKlaus Jensen     }
648388eea45cSKlaus Jensen 
648488eea45cSKlaus Jensen     switch (fid) {
648588eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
648688eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
648788eea45cSKlaus Jensen             break;
648888eea45cSKlaus Jensen         }
648988eea45cSKlaus Jensen 
649088eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
649188eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
649288eea45cSKlaus Jensen             n->features.temp_thresh_hi = NVME_TEMP_TMPTH(dw11);
649388eea45cSKlaus Jensen             break;
649488eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
649588eea45cSKlaus Jensen             n->features.temp_thresh_low = NVME_TEMP_TMPTH(dw11);
649688eea45cSKlaus Jensen             break;
649788eea45cSKlaus Jensen         default:
649888eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
649988eea45cSKlaus Jensen         }
650088eea45cSKlaus Jensen 
650188eea45cSKlaus Jensen         if ((n->temperature >= n->features.temp_thresh_hi) ||
650288eea45cSKlaus Jensen             (n->temperature <= n->features.temp_thresh_low)) {
65039235a72aSKlaus Jensen             nvme_smart_event(n, NVME_SMART_TEMPERATURE);
650488eea45cSKlaus Jensen         }
650588eea45cSKlaus Jensen 
650688eea45cSKlaus Jensen         break;
650788eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
650888eea45cSKlaus Jensen         if (nsid == NVME_NSID_BROADCAST) {
650988eea45cSKlaus Jensen             for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
651088eea45cSKlaus Jensen                 ns = nvme_ns(n, i);
651188eea45cSKlaus Jensen 
651288eea45cSKlaus Jensen                 if (!ns) {
651388eea45cSKlaus Jensen                     continue;
651488eea45cSKlaus Jensen                 }
651588eea45cSKlaus Jensen 
651688eea45cSKlaus Jensen                 if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat)) {
651788eea45cSKlaus Jensen                     ns->features.err_rec = dw11;
651888eea45cSKlaus Jensen                 }
651988eea45cSKlaus Jensen             }
652088eea45cSKlaus Jensen 
652188eea45cSKlaus Jensen             break;
652288eea45cSKlaus Jensen         }
652388eea45cSKlaus Jensen 
652488eea45cSKlaus Jensen         assert(ns);
652588eea45cSKlaus Jensen         if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat))  {
652688eea45cSKlaus Jensen             ns->features.err_rec = dw11;
652788eea45cSKlaus Jensen         }
652888eea45cSKlaus Jensen         break;
652988eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
653088eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
653188eea45cSKlaus Jensen             ns = nvme_ns(n, i);
653288eea45cSKlaus Jensen             if (!ns) {
653388eea45cSKlaus Jensen                 continue;
653488eea45cSKlaus Jensen             }
653588eea45cSKlaus Jensen 
653688eea45cSKlaus Jensen             if (!(dw11 & 0x1) && blk_enable_write_cache(ns->blkconf.blk)) {
653788eea45cSKlaus Jensen                 blk_flush(ns->blkconf.blk);
653888eea45cSKlaus Jensen             }
653988eea45cSKlaus Jensen 
654088eea45cSKlaus Jensen             blk_set_enable_write_cache(ns->blkconf.blk, dw11 & 1);
654188eea45cSKlaus Jensen         }
654288eea45cSKlaus Jensen 
654388eea45cSKlaus Jensen         break;
654488eea45cSKlaus Jensen 
654588eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
654688eea45cSKlaus Jensen         if (n->qs_created) {
654788eea45cSKlaus Jensen             return NVME_CMD_SEQ_ERROR | NVME_DNR;
654888eea45cSKlaus Jensen         }
654988eea45cSKlaus Jensen 
655088eea45cSKlaus Jensen         /*
655188eea45cSKlaus Jensen          * NVMe v1.3, Section 5.21.1.7: FFFFh is not an allowed value for NCQR
655288eea45cSKlaus Jensen          * and NSQR.
655388eea45cSKlaus Jensen          */
655488eea45cSKlaus Jensen         if ((dw11 & 0xffff) == 0xffff || ((dw11 >> 16) & 0xffff) == 0xffff) {
655588eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
655688eea45cSKlaus Jensen         }
655788eea45cSKlaus Jensen 
655888eea45cSKlaus Jensen         trace_pci_nvme_setfeat_numq((dw11 & 0xffff) + 1,
655988eea45cSKlaus Jensen                                     ((dw11 >> 16) & 0xffff) + 1,
6560decc0261SŁukasz Gieryk                                     n->conf_ioqpairs,
6561decc0261SŁukasz Gieryk                                     n->conf_ioqpairs);
6562decc0261SŁukasz Gieryk         req->cqe.result = cpu_to_le32((n->conf_ioqpairs - 1) |
6563decc0261SŁukasz Gieryk                                       ((n->conf_ioqpairs - 1) << 16));
656488eea45cSKlaus Jensen         break;
656588eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
656688eea45cSKlaus Jensen         n->features.async_config = dw11;
656788eea45cSKlaus Jensen         break;
656888eea45cSKlaus Jensen     case NVME_TIMESTAMP:
656988eea45cSKlaus Jensen         return nvme_set_feature_timestamp(n, req);
6570d0c0697bSNaveen Nagar     case NVME_HOST_BEHAVIOR_SUPPORT:
6571763c05dfSNaveen Nagar         status = nvme_h2c(n, (uint8_t *)&n->features.hbs,
6572d0c0697bSNaveen Nagar                           sizeof(n->features.hbs), req);
6573763c05dfSNaveen Nagar         if (status) {
6574763c05dfSNaveen Nagar             return status;
6575763c05dfSNaveen Nagar         }
6576763c05dfSNaveen Nagar 
6577763c05dfSNaveen Nagar         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
6578763c05dfSNaveen Nagar             ns = nvme_ns(n, i);
6579763c05dfSNaveen Nagar 
6580763c05dfSNaveen Nagar             if (!ns) {
6581763c05dfSNaveen Nagar                 continue;
6582763c05dfSNaveen Nagar             }
6583763c05dfSNaveen Nagar 
6584763c05dfSNaveen Nagar             ns->id_ns.nlbaf = ns->nlbaf - 1;
6585763c05dfSNaveen Nagar             if (!n->features.hbs.lbafee) {
6586763c05dfSNaveen Nagar                 ns->id_ns.nlbaf = MIN(ns->id_ns.nlbaf, 15);
6587763c05dfSNaveen Nagar             }
6588763c05dfSNaveen Nagar         }
6589763c05dfSNaveen Nagar 
6590763c05dfSNaveen Nagar         return status;
659188eea45cSKlaus Jensen     case NVME_COMMAND_SET_PROFILE:
659288eea45cSKlaus Jensen         if (dw11 & 0x1ff) {
659388eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_iocsci(dw11 & 0x1ff);
659488eea45cSKlaus Jensen             return NVME_CMD_SET_CMB_REJECTED | NVME_DNR;
659588eea45cSKlaus Jensen         }
659688eea45cSKlaus Jensen         break;
659773064edfSJesper Devantier     case NVME_FDP_MODE:
659873064edfSJesper Devantier         /* spec: abort with cmd seq err if there's one or more NS' in endgrp */
659973064edfSJesper Devantier         return NVME_CMD_SEQ_ERROR | NVME_DNR;
660073064edfSJesper Devantier     case NVME_FDP_EVENTS:
660173064edfSJesper Devantier         return nvme_set_feature_fdp_events(n, ns, req);
6602ebd1568fSAlan Adamson     case NVME_WRITE_ATOMICITY:
6603ebd1568fSAlan Adamson 
6604ebd1568fSAlan Adamson         n->dn = 0x1 & dw11;
6605ebd1568fSAlan Adamson 
6606ebd1568fSAlan Adamson         if (n->dn) {
6607ebd1568fSAlan Adamson             atomic->atomic_max_write_size = le16_to_cpu(id->awupf) + 1;
6608ebd1568fSAlan Adamson         } else {
6609ebd1568fSAlan Adamson             atomic->atomic_max_write_size = le16_to_cpu(id->awun) + 1;
6610ebd1568fSAlan Adamson         }
6611ebd1568fSAlan Adamson 
6612ebd1568fSAlan Adamson         if (atomic->atomic_max_write_size == 1) {
6613ebd1568fSAlan Adamson             atomic->atomic_writes = 0;
6614ebd1568fSAlan Adamson         } else {
6615ebd1568fSAlan Adamson             atomic->atomic_writes = 1;
6616ebd1568fSAlan Adamson         }
6617ebd1568fSAlan Adamson         break;
661888eea45cSKlaus Jensen     default:
661988eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
662088eea45cSKlaus Jensen     }
662188eea45cSKlaus Jensen     return NVME_SUCCESS;
662288eea45cSKlaus Jensen }
662388eea45cSKlaus Jensen 
nvme_aer(NvmeCtrl * n,NvmeRequest * req)662488eea45cSKlaus Jensen static uint16_t nvme_aer(NvmeCtrl *n, NvmeRequest *req)
662588eea45cSKlaus Jensen {
662688eea45cSKlaus Jensen     trace_pci_nvme_aer(nvme_cid(req));
662788eea45cSKlaus Jensen 
662888eea45cSKlaus Jensen     if (n->outstanding_aers > n->params.aerl) {
662988eea45cSKlaus Jensen         trace_pci_nvme_aer_aerl_exceeded();
663088eea45cSKlaus Jensen         return NVME_AER_LIMIT_EXCEEDED;
663188eea45cSKlaus Jensen     }
663288eea45cSKlaus Jensen 
663388eea45cSKlaus Jensen     n->aer_reqs[n->outstanding_aers] = req;
663488eea45cSKlaus Jensen     n->outstanding_aers++;
663588eea45cSKlaus Jensen 
663688eea45cSKlaus Jensen     if (!QTAILQ_EMPTY(&n->aer_queue)) {
663788eea45cSKlaus Jensen         nvme_process_aers(n);
663888eea45cSKlaus Jensen     }
663988eea45cSKlaus Jensen 
664088eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
664188eea45cSKlaus Jensen }
664288eea45cSKlaus Jensen 
nvme_update_dmrsl(NvmeCtrl * n)664388eea45cSKlaus Jensen static void nvme_update_dmrsl(NvmeCtrl *n)
664488eea45cSKlaus Jensen {
664588eea45cSKlaus Jensen     int nsid;
664688eea45cSKlaus Jensen 
664788eea45cSKlaus Jensen     for (nsid = 1; nsid <= NVME_MAX_NAMESPACES; nsid++) {
664888eea45cSKlaus Jensen         NvmeNamespace *ns = nvme_ns(n, nsid);
664988eea45cSKlaus Jensen         if (!ns) {
665088eea45cSKlaus Jensen             continue;
665188eea45cSKlaus Jensen         }
665288eea45cSKlaus Jensen 
665388eea45cSKlaus Jensen         n->dmrsl = MIN_NON_ZERO(n->dmrsl,
665488eea45cSKlaus Jensen                                 BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
665588eea45cSKlaus Jensen     }
665688eea45cSKlaus Jensen }
665788eea45cSKlaus Jensen 
nvme_select_iocs_ns(NvmeCtrl * n,NvmeNamespace * ns)665888eea45cSKlaus Jensen static void nvme_select_iocs_ns(NvmeCtrl *n, NvmeNamespace *ns)
665988eea45cSKlaus Jensen {
666049e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
666149e03457SKlaus Jensen 
666288eea45cSKlaus Jensen     ns->iocs = nvme_cse_iocs_none;
666388eea45cSKlaus Jensen     switch (ns->csi) {
666488eea45cSKlaus Jensen     case NVME_CSI_NVM:
666549e03457SKlaus Jensen         if (NVME_CC_CSS(cc) != NVME_CC_CSS_ADMIN_ONLY) {
666688eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
666788eea45cSKlaus Jensen         }
666888eea45cSKlaus Jensen         break;
666988eea45cSKlaus Jensen     case NVME_CSI_ZONED:
667049e03457SKlaus Jensen         if (NVME_CC_CSS(cc) == NVME_CC_CSS_CSI) {
667188eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_zoned;
667249e03457SKlaus Jensen         } else if (NVME_CC_CSS(cc) == NVME_CC_CSS_NVM) {
667388eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
667488eea45cSKlaus Jensen         }
667588eea45cSKlaus Jensen         break;
667688eea45cSKlaus Jensen     }
667788eea45cSKlaus Jensen }
667888eea45cSKlaus Jensen 
nvme_ns_attachment(NvmeCtrl * n,NvmeRequest * req)667988eea45cSKlaus Jensen static uint16_t nvme_ns_attachment(NvmeCtrl *n, NvmeRequest *req)
668088eea45cSKlaus Jensen {
668188eea45cSKlaus Jensen     NvmeNamespace *ns;
668288eea45cSKlaus Jensen     NvmeCtrl *ctrl;
668388eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
668488eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
668588eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
668607a3dfa7SNaveen Nagar     uint8_t sel = dw10 & 0xf;
668788eea45cSKlaus Jensen     uint16_t *nr_ids = &list[0];
668888eea45cSKlaus Jensen     uint16_t *ids = &list[1];
668988eea45cSKlaus Jensen     uint16_t ret;
669088eea45cSKlaus Jensen     int i;
669188eea45cSKlaus Jensen 
669288eea45cSKlaus Jensen     trace_pci_nvme_ns_attachment(nvme_cid(req), dw10 & 0xf);
669388eea45cSKlaus Jensen 
669488eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid)) {
669588eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
669688eea45cSKlaus Jensen     }
669788eea45cSKlaus Jensen 
669888eea45cSKlaus Jensen     ns = nvme_subsys_ns(n->subsys, nsid);
669988eea45cSKlaus Jensen     if (!ns) {
670088eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
670188eea45cSKlaus Jensen     }
670288eea45cSKlaus Jensen 
670388eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)list, 4096, req);
670488eea45cSKlaus Jensen     if (ret) {
670588eea45cSKlaus Jensen         return ret;
670688eea45cSKlaus Jensen     }
670788eea45cSKlaus Jensen 
670888eea45cSKlaus Jensen     if (!*nr_ids) {
670988eea45cSKlaus Jensen         return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
671088eea45cSKlaus Jensen     }
671188eea45cSKlaus Jensen 
671288eea45cSKlaus Jensen     *nr_ids = MIN(*nr_ids, NVME_CONTROLLER_LIST_SIZE - 1);
671388eea45cSKlaus Jensen     for (i = 0; i < *nr_ids; i++) {
671488eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, ids[i]);
671588eea45cSKlaus Jensen         if (!ctrl) {
671688eea45cSKlaus Jensen             return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
671788eea45cSKlaus Jensen         }
671888eea45cSKlaus Jensen 
671907a3dfa7SNaveen Nagar         switch (sel) {
672007a3dfa7SNaveen Nagar         case NVME_NS_ATTACHMENT_ATTACH:
672188eea45cSKlaus Jensen             if (nvme_ns(ctrl, nsid)) {
672288eea45cSKlaus Jensen                 return NVME_NS_ALREADY_ATTACHED | NVME_DNR;
672388eea45cSKlaus Jensen             }
672488eea45cSKlaus Jensen 
672588eea45cSKlaus Jensen             if (ns->attached && !ns->params.shared) {
672688eea45cSKlaus Jensen                 return NVME_NS_PRIVATE | NVME_DNR;
672788eea45cSKlaus Jensen             }
672888eea45cSKlaus Jensen 
672988eea45cSKlaus Jensen             nvme_attach_ns(ctrl, ns);
673088eea45cSKlaus Jensen             nvme_select_iocs_ns(ctrl, ns);
673107a3dfa7SNaveen Nagar 
673207a3dfa7SNaveen Nagar             break;
673307a3dfa7SNaveen Nagar 
673407a3dfa7SNaveen Nagar         case NVME_NS_ATTACHMENT_DETACH:
673588eea45cSKlaus Jensen             if (!nvme_ns(ctrl, nsid)) {
673688eea45cSKlaus Jensen                 return NVME_NS_NOT_ATTACHED | NVME_DNR;
673788eea45cSKlaus Jensen             }
673888eea45cSKlaus Jensen 
673988eea45cSKlaus Jensen             ctrl->namespaces[nsid] = NULL;
674088eea45cSKlaus Jensen             ns->attached--;
674188eea45cSKlaus Jensen 
674288eea45cSKlaus Jensen             nvme_update_dmrsl(ctrl);
674307a3dfa7SNaveen Nagar 
674407a3dfa7SNaveen Nagar             break;
674507a3dfa7SNaveen Nagar 
674607a3dfa7SNaveen Nagar         default:
674707a3dfa7SNaveen Nagar             return NVME_INVALID_FIELD | NVME_DNR;
674888eea45cSKlaus Jensen         }
674988eea45cSKlaus Jensen 
675088eea45cSKlaus Jensen         /*
675188eea45cSKlaus Jensen          * Add namespace id to the changed namespace id list for event clearing
675288eea45cSKlaus Jensen          * via Get Log Page command.
675388eea45cSKlaus Jensen          */
675488eea45cSKlaus Jensen         if (!test_and_set_bit(nsid, ctrl->changed_nsids)) {
675588eea45cSKlaus Jensen             nvme_enqueue_event(ctrl, NVME_AER_TYPE_NOTICE,
675688eea45cSKlaus Jensen                                NVME_AER_INFO_NOTICE_NS_ATTR_CHANGED,
675788eea45cSKlaus Jensen                                NVME_LOG_CHANGED_NSLIST);
675888eea45cSKlaus Jensen         }
675988eea45cSKlaus Jensen     }
676088eea45cSKlaus Jensen 
676188eea45cSKlaus Jensen     return NVME_SUCCESS;
676288eea45cSKlaus Jensen }
676388eea45cSKlaus Jensen 
67643bcf26d3SKlaus Jensen typedef struct NvmeFormatAIOCB {
67653bcf26d3SKlaus Jensen     BlockAIOCB common;
67663bcf26d3SKlaus Jensen     BlockAIOCB *aiocb;
67673bcf26d3SKlaus Jensen     NvmeRequest *req;
67683bcf26d3SKlaus Jensen     int ret;
676988eea45cSKlaus Jensen 
67703bcf26d3SKlaus Jensen     NvmeNamespace *ns;
67713bcf26d3SKlaus Jensen     uint32_t nsid;
67723bcf26d3SKlaus Jensen     bool broadcast;
67733bcf26d3SKlaus Jensen     int64_t offset;
6774a6de6ed5SKlaus Jensen 
6775a6de6ed5SKlaus Jensen     uint8_t lbaf;
6776a6de6ed5SKlaus Jensen     uint8_t mset;
6777a6de6ed5SKlaus Jensen     uint8_t pi;
6778a6de6ed5SKlaus Jensen     uint8_t pil;
67793bcf26d3SKlaus Jensen } NvmeFormatAIOCB;
67803bcf26d3SKlaus Jensen 
nvme_format_cancel(BlockAIOCB * aiocb)67813bcf26d3SKlaus Jensen static void nvme_format_cancel(BlockAIOCB *aiocb)
67823bcf26d3SKlaus Jensen {
67833bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = container_of(aiocb, NvmeFormatAIOCB, common);
67843bcf26d3SKlaus Jensen 
6785433c71e4SKlaus Jensen     iocb->ret = -ECANCELED;
6786433c71e4SKlaus Jensen 
67873bcf26d3SKlaus Jensen     if (iocb->aiocb) {
67883bcf26d3SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
6789433c71e4SKlaus Jensen         iocb->aiocb = NULL;
67903bcf26d3SKlaus Jensen     }
67913bcf26d3SKlaus Jensen }
67923bcf26d3SKlaus Jensen 
67933bcf26d3SKlaus Jensen static const AIOCBInfo nvme_format_aiocb_info = {
67943bcf26d3SKlaus Jensen     .aiocb_size = sizeof(NvmeFormatAIOCB),
67953bcf26d3SKlaus Jensen     .cancel_async = nvme_format_cancel,
67963bcf26d3SKlaus Jensen };
67973bcf26d3SKlaus Jensen 
nvme_format_set(NvmeNamespace * ns,uint8_t lbaf,uint8_t mset,uint8_t pi,uint8_t pil)6798a6de6ed5SKlaus Jensen static void nvme_format_set(NvmeNamespace *ns, uint8_t lbaf, uint8_t mset,
6799a6de6ed5SKlaus Jensen                             uint8_t pi, uint8_t pil)
68003bcf26d3SKlaus Jensen {
6801763c05dfSNaveen Nagar     uint8_t lbafl = lbaf & 0xf;
6802763c05dfSNaveen Nagar     uint8_t lbafu = lbaf >> 4;
6803763c05dfSNaveen Nagar 
68043bcf26d3SKlaus Jensen     trace_pci_nvme_format_set(ns->params.nsid, lbaf, mset, pi, pil);
68053bcf26d3SKlaus Jensen 
68063bcf26d3SKlaus Jensen     ns->id_ns.dps = (pil << 3) | pi;
6807763c05dfSNaveen Nagar     ns->id_ns.flbas = (lbafu << 5) | (mset << 4) | lbafl;
68083bcf26d3SKlaus Jensen 
68093bcf26d3SKlaus Jensen     nvme_ns_init_format(ns);
68103bcf26d3SKlaus Jensen }
68113bcf26d3SKlaus Jensen 
6812433c71e4SKlaus Jensen static void nvme_do_format(NvmeFormatAIOCB *iocb);
6813433c71e4SKlaus Jensen 
nvme_format_ns_cb(void * opaque,int ret)68143bcf26d3SKlaus Jensen static void nvme_format_ns_cb(void *opaque, int ret)
68153bcf26d3SKlaus Jensen {
68163bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = opaque;
68173bcf26d3SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
68183bcf26d3SKlaus Jensen     int bytes;
68193bcf26d3SKlaus Jensen 
6820433c71e4SKlaus Jensen     if (iocb->ret < 0) {
6821433c71e4SKlaus Jensen         goto done;
6822433c71e4SKlaus Jensen     } else if (ret < 0) {
68233bcf26d3SKlaus Jensen         iocb->ret = ret;
68243bcf26d3SKlaus Jensen         goto done;
68253bcf26d3SKlaus Jensen     }
68263bcf26d3SKlaus Jensen 
68273bcf26d3SKlaus Jensen     assert(ns);
68283bcf26d3SKlaus Jensen 
68293bcf26d3SKlaus Jensen     if (iocb->offset < ns->size) {
68303bcf26d3SKlaus Jensen         bytes = MIN(BDRV_REQUEST_MAX_BYTES, ns->size - iocb->offset);
68313bcf26d3SKlaus Jensen 
68323bcf26d3SKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, iocb->offset,
68333bcf26d3SKlaus Jensen                                             bytes, BDRV_REQ_MAY_UNMAP,
68343bcf26d3SKlaus Jensen                                             nvme_format_ns_cb, iocb);
68353bcf26d3SKlaus Jensen 
68363bcf26d3SKlaus Jensen         iocb->offset += bytes;
68373bcf26d3SKlaus Jensen         return;
68383bcf26d3SKlaus Jensen     }
68393bcf26d3SKlaus Jensen 
6840a6de6ed5SKlaus Jensen     nvme_format_set(ns, iocb->lbaf, iocb->mset, iocb->pi, iocb->pil);
68413bcf26d3SKlaus Jensen     ns->status = 0x0;
68423bcf26d3SKlaus Jensen     iocb->ns = NULL;
68433bcf26d3SKlaus Jensen     iocb->offset = 0;
68443bcf26d3SKlaus Jensen 
68453bcf26d3SKlaus Jensen done:
6846433c71e4SKlaus Jensen     nvme_do_format(iocb);
68473bcf26d3SKlaus Jensen }
68483bcf26d3SKlaus Jensen 
nvme_format_check(NvmeNamespace * ns,uint8_t lbaf,uint8_t pi)68493bcf26d3SKlaus Jensen static uint16_t nvme_format_check(NvmeNamespace *ns, uint8_t lbaf, uint8_t pi)
68503bcf26d3SKlaus Jensen {
685188eea45cSKlaus Jensen     if (ns->params.zoned) {
685288eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
685388eea45cSKlaus Jensen     }
685488eea45cSKlaus Jensen 
685588eea45cSKlaus Jensen     if (lbaf > ns->id_ns.nlbaf) {
685688eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
685788eea45cSKlaus Jensen     }
685888eea45cSKlaus Jensen 
6859ac0b34c5SKlaus Jensen     if (pi && (ns->id_ns.lbaf[lbaf].ms < nvme_pi_tuple_size(ns))) {
686088eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
686188eea45cSKlaus Jensen     }
686288eea45cSKlaus Jensen 
686388eea45cSKlaus Jensen     if (pi && pi > NVME_ID_NS_DPS_TYPE_3) {
686488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
686588eea45cSKlaus Jensen     }
686688eea45cSKlaus Jensen 
686788eea45cSKlaus Jensen     return NVME_SUCCESS;
686888eea45cSKlaus Jensen }
686988eea45cSKlaus Jensen 
nvme_do_format(NvmeFormatAIOCB * iocb)6870433c71e4SKlaus Jensen static void nvme_do_format(NvmeFormatAIOCB *iocb)
687188eea45cSKlaus Jensen {
68723bcf26d3SKlaus Jensen     NvmeRequest *req = iocb->req;
68733bcf26d3SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
687444219b60SNaveen Nagar     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
687544219b60SNaveen Nagar     uint8_t lbaf = dw10 & 0xf;
687644219b60SNaveen Nagar     uint8_t pi = (dw10 >> 5) & 0x7;
687788eea45cSKlaus Jensen     uint16_t status;
687888eea45cSKlaus Jensen     int i;
687988eea45cSKlaus Jensen 
68803bcf26d3SKlaus Jensen     if (iocb->ret < 0) {
68813bcf26d3SKlaus Jensen         goto done;
688288eea45cSKlaus Jensen     }
688388eea45cSKlaus Jensen 
68843bcf26d3SKlaus Jensen     if (iocb->broadcast) {
68853bcf26d3SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
68863bcf26d3SKlaus Jensen             iocb->ns = nvme_ns(n, i);
68873bcf26d3SKlaus Jensen             if (iocb->ns) {
68883bcf26d3SKlaus Jensen                 iocb->nsid = i;
688988eea45cSKlaus Jensen                 break;
689088eea45cSKlaus Jensen             }
689188eea45cSKlaus Jensen         }
689288eea45cSKlaus Jensen     }
689388eea45cSKlaus Jensen 
68943bcf26d3SKlaus Jensen     if (!iocb->ns) {
68953bcf26d3SKlaus Jensen         goto done;
689688eea45cSKlaus Jensen     }
689788eea45cSKlaus Jensen 
689844219b60SNaveen Nagar     status = nvme_format_check(iocb->ns, lbaf, pi);
68993bcf26d3SKlaus Jensen     if (status) {
69003bcf26d3SKlaus Jensen         req->status = status;
69013bcf26d3SKlaus Jensen         goto done;
69023bcf26d3SKlaus Jensen     }
69033bcf26d3SKlaus Jensen 
69043bcf26d3SKlaus Jensen     iocb->ns->status = NVME_FORMAT_IN_PROGRESS;
69053bcf26d3SKlaus Jensen     nvme_format_ns_cb(iocb, 0);
69063bcf26d3SKlaus Jensen     return;
69073bcf26d3SKlaus Jensen 
69083bcf26d3SKlaus Jensen done:
69093bcf26d3SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
69103bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
69113bcf26d3SKlaus Jensen }
69123bcf26d3SKlaus Jensen 
nvme_format(NvmeCtrl * n,NvmeRequest * req)69133bcf26d3SKlaus Jensen static uint16_t nvme_format(NvmeCtrl *n, NvmeRequest *req)
69143bcf26d3SKlaus Jensen {
69153bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb;
69163bcf26d3SKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
6917a6de6ed5SKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
6918a6de6ed5SKlaus Jensen     uint8_t lbaf = dw10 & 0xf;
6919a6de6ed5SKlaus Jensen     uint8_t mset = (dw10 >> 4) & 0x1;
6920a6de6ed5SKlaus Jensen     uint8_t pi = (dw10 >> 5) & 0x7;
6921a6de6ed5SKlaus Jensen     uint8_t pil = (dw10 >> 8) & 0x1;
6922763c05dfSNaveen Nagar     uint8_t lbafu = (dw10 >> 12) & 0x3;
69233bcf26d3SKlaus Jensen     uint16_t status;
69243bcf26d3SKlaus Jensen 
69253bcf26d3SKlaus Jensen     iocb = qemu_aio_get(&nvme_format_aiocb_info, NULL, nvme_misc_cb, req);
69263bcf26d3SKlaus Jensen 
69273bcf26d3SKlaus Jensen     iocb->req = req;
69283bcf26d3SKlaus Jensen     iocb->ret = 0;
69293bcf26d3SKlaus Jensen     iocb->ns = NULL;
69303bcf26d3SKlaus Jensen     iocb->nsid = 0;
6931a6de6ed5SKlaus Jensen     iocb->lbaf = lbaf;
6932a6de6ed5SKlaus Jensen     iocb->mset = mset;
6933a6de6ed5SKlaus Jensen     iocb->pi = pi;
6934a6de6ed5SKlaus Jensen     iocb->pil = pil;
69353bcf26d3SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
69363bcf26d3SKlaus Jensen     iocb->offset = 0;
69373bcf26d3SKlaus Jensen 
6938763c05dfSNaveen Nagar     if (n->features.hbs.lbafee) {
6939763c05dfSNaveen Nagar         iocb->lbaf |= lbafu << 4;
6940763c05dfSNaveen Nagar     }
6941763c05dfSNaveen Nagar 
69423bcf26d3SKlaus Jensen     if (!iocb->broadcast) {
69433bcf26d3SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
69443bcf26d3SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
69453bcf26d3SKlaus Jensen             goto out;
69463bcf26d3SKlaus Jensen         }
69473bcf26d3SKlaus Jensen 
69483bcf26d3SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
69493bcf26d3SKlaus Jensen         if (!iocb->ns) {
69503bcf26d3SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
69513bcf26d3SKlaus Jensen             goto out;
69523bcf26d3SKlaus Jensen         }
69533bcf26d3SKlaus Jensen     }
69543bcf26d3SKlaus Jensen 
69553bcf26d3SKlaus Jensen     req->aiocb = &iocb->common;
6956433c71e4SKlaus Jensen     nvme_do_format(iocb);
69573bcf26d3SKlaus Jensen 
69583bcf26d3SKlaus Jensen     return NVME_NO_COMPLETE;
69593bcf26d3SKlaus Jensen 
69603bcf26d3SKlaus Jensen out:
69613bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
6962433c71e4SKlaus Jensen 
69633bcf26d3SKlaus Jensen     return status;
696488eea45cSKlaus Jensen }
696588eea45cSKlaus Jensen 
nvme_get_virt_res_num(NvmeCtrl * n,uint8_t rt,int * num_total,int * num_prim,int * num_sec)696611871f53SŁukasz Gieryk static void nvme_get_virt_res_num(NvmeCtrl *n, uint8_t rt, int *num_total,
696711871f53SŁukasz Gieryk                                   int *num_prim, int *num_sec)
696811871f53SŁukasz Gieryk {
696911871f53SŁukasz Gieryk     *num_total = le32_to_cpu(rt ?
697011871f53SŁukasz Gieryk                              n->pri_ctrl_cap.vifrt : n->pri_ctrl_cap.vqfrt);
697111871f53SŁukasz Gieryk     *num_prim = le16_to_cpu(rt ?
697211871f53SŁukasz Gieryk                             n->pri_ctrl_cap.virfap : n->pri_ctrl_cap.vqrfap);
697311871f53SŁukasz Gieryk     *num_sec = le16_to_cpu(rt ? n->pri_ctrl_cap.virfa : n->pri_ctrl_cap.vqrfa);
697411871f53SŁukasz Gieryk }
697511871f53SŁukasz Gieryk 
nvme_assign_virt_res_to_prim(NvmeCtrl * n,NvmeRequest * req,uint16_t cntlid,uint8_t rt,int nr)697611871f53SŁukasz Gieryk static uint16_t nvme_assign_virt_res_to_prim(NvmeCtrl *n, NvmeRequest *req,
697711871f53SŁukasz Gieryk                                              uint16_t cntlid, uint8_t rt,
697811871f53SŁukasz Gieryk                                              int nr)
697911871f53SŁukasz Gieryk {
698011871f53SŁukasz Gieryk     int num_total, num_prim, num_sec;
698111871f53SŁukasz Gieryk 
698211871f53SŁukasz Gieryk     if (cntlid != n->cntlid) {
698311871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
698411871f53SŁukasz Gieryk     }
698511871f53SŁukasz Gieryk 
698611871f53SŁukasz Gieryk     nvme_get_virt_res_num(n, rt, &num_total, &num_prim, &num_sec);
698711871f53SŁukasz Gieryk 
698811871f53SŁukasz Gieryk     if (nr > num_total) {
698911871f53SŁukasz Gieryk         return NVME_INVALID_NUM_RESOURCES | NVME_DNR;
699011871f53SŁukasz Gieryk     }
699111871f53SŁukasz Gieryk 
699211871f53SŁukasz Gieryk     if (nr > num_total - num_sec) {
699311871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
699411871f53SŁukasz Gieryk     }
699511871f53SŁukasz Gieryk 
699611871f53SŁukasz Gieryk     if (rt) {
699711871f53SŁukasz Gieryk         n->next_pri_ctrl_cap.virfap = cpu_to_le16(nr);
699811871f53SŁukasz Gieryk     } else {
699911871f53SŁukasz Gieryk         n->next_pri_ctrl_cap.vqrfap = cpu_to_le16(nr);
700011871f53SŁukasz Gieryk     }
700111871f53SŁukasz Gieryk 
700211871f53SŁukasz Gieryk     req->cqe.result = cpu_to_le32(nr);
700311871f53SŁukasz Gieryk     return req->status;
700411871f53SŁukasz Gieryk }
700511871f53SŁukasz Gieryk 
nvme_update_virt_res(NvmeCtrl * n,NvmeSecCtrlEntry * sctrl,uint8_t rt,int nr)700611871f53SŁukasz Gieryk static void nvme_update_virt_res(NvmeCtrl *n, NvmeSecCtrlEntry *sctrl,
700711871f53SŁukasz Gieryk                                  uint8_t rt, int nr)
700811871f53SŁukasz Gieryk {
700911871f53SŁukasz Gieryk     int prev_nr, prev_total;
701011871f53SŁukasz Gieryk 
701111871f53SŁukasz Gieryk     if (rt) {
701211871f53SŁukasz Gieryk         prev_nr = le16_to_cpu(sctrl->nvi);
701311871f53SŁukasz Gieryk         prev_total = le32_to_cpu(n->pri_ctrl_cap.virfa);
701411871f53SŁukasz Gieryk         sctrl->nvi = cpu_to_le16(nr);
701511871f53SŁukasz Gieryk         n->pri_ctrl_cap.virfa = cpu_to_le32(prev_total + nr - prev_nr);
701611871f53SŁukasz Gieryk     } else {
701711871f53SŁukasz Gieryk         prev_nr = le16_to_cpu(sctrl->nvq);
701811871f53SŁukasz Gieryk         prev_total = le32_to_cpu(n->pri_ctrl_cap.vqrfa);
701911871f53SŁukasz Gieryk         sctrl->nvq = cpu_to_le16(nr);
702011871f53SŁukasz Gieryk         n->pri_ctrl_cap.vqrfa = cpu_to_le32(prev_total + nr - prev_nr);
702111871f53SŁukasz Gieryk     }
702211871f53SŁukasz Gieryk }
702311871f53SŁukasz Gieryk 
nvme_assign_virt_res_to_sec(NvmeCtrl * n,NvmeRequest * req,uint16_t cntlid,uint8_t rt,int nr)702411871f53SŁukasz Gieryk static uint16_t nvme_assign_virt_res_to_sec(NvmeCtrl *n, NvmeRequest *req,
702511871f53SŁukasz Gieryk                                             uint16_t cntlid, uint8_t rt, int nr)
702611871f53SŁukasz Gieryk {
702711871f53SŁukasz Gieryk     int num_total, num_prim, num_sec, num_free, diff, limit;
702811871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
702911871f53SŁukasz Gieryk 
703011871f53SŁukasz Gieryk     sctrl = nvme_sctrl_for_cntlid(n, cntlid);
703111871f53SŁukasz Gieryk     if (!sctrl) {
703211871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
703311871f53SŁukasz Gieryk     }
703411871f53SŁukasz Gieryk 
703511871f53SŁukasz Gieryk     if (sctrl->scs) {
703611871f53SŁukasz Gieryk         return NVME_INVALID_SEC_CTRL_STATE | NVME_DNR;
703711871f53SŁukasz Gieryk     }
703811871f53SŁukasz Gieryk 
703911871f53SŁukasz Gieryk     limit = le16_to_cpu(rt ? n->pri_ctrl_cap.vifrsm : n->pri_ctrl_cap.vqfrsm);
704011871f53SŁukasz Gieryk     if (nr > limit) {
704111871f53SŁukasz Gieryk         return NVME_INVALID_NUM_RESOURCES | NVME_DNR;
704211871f53SŁukasz Gieryk     }
704311871f53SŁukasz Gieryk 
704411871f53SŁukasz Gieryk     nvme_get_virt_res_num(n, rt, &num_total, &num_prim, &num_sec);
704511871f53SŁukasz Gieryk     num_free = num_total - num_prim - num_sec;
704611871f53SŁukasz Gieryk     diff = nr - le16_to_cpu(rt ? sctrl->nvi : sctrl->nvq);
704711871f53SŁukasz Gieryk 
704811871f53SŁukasz Gieryk     if (diff > num_free) {
704911871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
705011871f53SŁukasz Gieryk     }
705111871f53SŁukasz Gieryk 
705211871f53SŁukasz Gieryk     nvme_update_virt_res(n, sctrl, rt, nr);
705311871f53SŁukasz Gieryk     req->cqe.result = cpu_to_le32(nr);
705411871f53SŁukasz Gieryk 
705511871f53SŁukasz Gieryk     return req->status;
705611871f53SŁukasz Gieryk }
705711871f53SŁukasz Gieryk 
nvme_virt_set_state(NvmeCtrl * n,uint16_t cntlid,bool online)705811871f53SŁukasz Gieryk static uint16_t nvme_virt_set_state(NvmeCtrl *n, uint16_t cntlid, bool online)
705911871f53SŁukasz Gieryk {
706048b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
706111871f53SŁukasz Gieryk     NvmeCtrl *sn = NULL;
706211871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
706311871f53SŁukasz Gieryk     int vf_index;
706411871f53SŁukasz Gieryk 
706511871f53SŁukasz Gieryk     sctrl = nvme_sctrl_for_cntlid(n, cntlid);
706611871f53SŁukasz Gieryk     if (!sctrl) {
706711871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
706811871f53SŁukasz Gieryk     }
706911871f53SŁukasz Gieryk 
707048b32c28SKlaus Jensen     if (!pci_is_vf(pci)) {
707111871f53SŁukasz Gieryk         vf_index = le16_to_cpu(sctrl->vfn) - 1;
707248b32c28SKlaus Jensen         sn = NVME(pcie_sriov_get_vf_at_index(pci, vf_index));
707311871f53SŁukasz Gieryk     }
707411871f53SŁukasz Gieryk 
707511871f53SŁukasz Gieryk     if (online) {
707611871f53SŁukasz Gieryk         if (!sctrl->nvi || (le16_to_cpu(sctrl->nvq) < 2) || !sn) {
707711871f53SŁukasz Gieryk             return NVME_INVALID_SEC_CTRL_STATE | NVME_DNR;
707811871f53SŁukasz Gieryk         }
707911871f53SŁukasz Gieryk 
708011871f53SŁukasz Gieryk         if (!sctrl->scs) {
708111871f53SŁukasz Gieryk             sctrl->scs = 0x1;
708211871f53SŁukasz Gieryk             nvme_ctrl_reset(sn, NVME_RESET_FUNCTION);
708311871f53SŁukasz Gieryk         }
708411871f53SŁukasz Gieryk     } else {
708511871f53SŁukasz Gieryk         nvme_update_virt_res(n, sctrl, NVME_VIRT_RES_INTERRUPT, 0);
708611871f53SŁukasz Gieryk         nvme_update_virt_res(n, sctrl, NVME_VIRT_RES_QUEUE, 0);
708711871f53SŁukasz Gieryk 
708811871f53SŁukasz Gieryk         if (sctrl->scs) {
708911871f53SŁukasz Gieryk             sctrl->scs = 0x0;
709011871f53SŁukasz Gieryk             if (sn) {
709111871f53SŁukasz Gieryk                 nvme_ctrl_reset(sn, NVME_RESET_FUNCTION);
709211871f53SŁukasz Gieryk             }
709311871f53SŁukasz Gieryk         }
709411871f53SŁukasz Gieryk     }
709511871f53SŁukasz Gieryk 
709611871f53SŁukasz Gieryk     return NVME_SUCCESS;
709711871f53SŁukasz Gieryk }
709811871f53SŁukasz Gieryk 
nvme_virt_mngmt(NvmeCtrl * n,NvmeRequest * req)709911871f53SŁukasz Gieryk static uint16_t nvme_virt_mngmt(NvmeCtrl *n, NvmeRequest *req)
710011871f53SŁukasz Gieryk {
710111871f53SŁukasz Gieryk     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
710211871f53SŁukasz Gieryk     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
710311871f53SŁukasz Gieryk     uint8_t act = dw10 & 0xf;
710411871f53SŁukasz Gieryk     uint8_t rt = (dw10 >> 8) & 0x7;
710511871f53SŁukasz Gieryk     uint16_t cntlid = (dw10 >> 16) & 0xffff;
710611871f53SŁukasz Gieryk     int nr = dw11 & 0xffff;
710711871f53SŁukasz Gieryk 
710811871f53SŁukasz Gieryk     trace_pci_nvme_virt_mngmt(nvme_cid(req), act, cntlid, rt ? "VI" : "VQ", nr);
710911871f53SŁukasz Gieryk 
711011871f53SŁukasz Gieryk     if (rt != NVME_VIRT_RES_QUEUE && rt != NVME_VIRT_RES_INTERRUPT) {
711111871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
711211871f53SŁukasz Gieryk     }
711311871f53SŁukasz Gieryk 
711411871f53SŁukasz Gieryk     switch (act) {
711511871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_ASSIGN:
711611871f53SŁukasz Gieryk         return nvme_assign_virt_res_to_sec(n, req, cntlid, rt, nr);
711711871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_PRM_ALLOC:
711811871f53SŁukasz Gieryk         return nvme_assign_virt_res_to_prim(n, req, cntlid, rt, nr);
711911871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_ONLINE:
712011871f53SŁukasz Gieryk         return nvme_virt_set_state(n, cntlid, true);
712111871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_OFFLINE:
712211871f53SŁukasz Gieryk         return nvme_virt_set_state(n, cntlid, false);
712311871f53SŁukasz Gieryk     default:
712411871f53SŁukasz Gieryk         return NVME_INVALID_FIELD | NVME_DNR;
712511871f53SŁukasz Gieryk     }
712611871f53SŁukasz Gieryk }
712711871f53SŁukasz Gieryk 
nvme_dbbuf_config(NvmeCtrl * n,const NvmeRequest * req)71283f7fe8deSJinhao Fan static uint16_t nvme_dbbuf_config(NvmeCtrl *n, const NvmeRequest *req)
71293f7fe8deSJinhao Fan {
713048b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
71313f7fe8deSJinhao Fan     uint64_t dbs_addr = le64_to_cpu(req->cmd.dptr.prp1);
71323f7fe8deSJinhao Fan     uint64_t eis_addr = le64_to_cpu(req->cmd.dptr.prp2);
71333f7fe8deSJinhao Fan     int i;
71343f7fe8deSJinhao Fan 
71353f7fe8deSJinhao Fan     /* Address should be page aligned */
71363f7fe8deSJinhao Fan     if (dbs_addr & (n->page_size - 1) || eis_addr & (n->page_size - 1)) {
71373f7fe8deSJinhao Fan         return NVME_INVALID_FIELD | NVME_DNR;
71383f7fe8deSJinhao Fan     }
71393f7fe8deSJinhao Fan 
71403f7fe8deSJinhao Fan     /* Save shadow buffer base addr for use during queue creation */
71413f7fe8deSJinhao Fan     n->dbbuf_dbs = dbs_addr;
71423f7fe8deSJinhao Fan     n->dbbuf_eis = eis_addr;
71433f7fe8deSJinhao Fan     n->dbbuf_enabled = true;
71443f7fe8deSJinhao Fan 
71453f7fe8deSJinhao Fan     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
71463f7fe8deSJinhao Fan         NvmeSQueue *sq = n->sq[i];
71473f7fe8deSJinhao Fan         NvmeCQueue *cq = n->cq[i];
71483f7fe8deSJinhao Fan 
71493f7fe8deSJinhao Fan         if (sq) {
71503f7fe8deSJinhao Fan             /*
71513f7fe8deSJinhao Fan              * CAP.DSTRD is 0, so offset of ith sq db_addr is (i<<3)
71523f7fe8deSJinhao Fan              * nvme_process_db() uses this hard-coded way to calculate
71533f7fe8deSJinhao Fan              * doorbell offsets. Be consistent with that here.
71543f7fe8deSJinhao Fan              */
71553f7fe8deSJinhao Fan             sq->db_addr = dbs_addr + (i << 3);
71563f7fe8deSJinhao Fan             sq->ei_addr = eis_addr + (i << 3);
7157c1e244b6SKlaus Jensen             stl_le_pci_dma(pci, sq->db_addr, sq->tail, MEMTXATTRS_UNSPECIFIED);
71582e53b0b4SJinhao Fan 
71592e53b0b4SJinhao Fan             if (n->params.ioeventfd && sq->sqid != 0) {
71602e53b0b4SJinhao Fan                 if (!nvme_init_sq_ioeventfd(sq)) {
71612e53b0b4SJinhao Fan                     sq->ioeventfd_enabled = true;
71622e53b0b4SJinhao Fan                 }
71632e53b0b4SJinhao Fan             }
71643f7fe8deSJinhao Fan         }
71653f7fe8deSJinhao Fan 
71663f7fe8deSJinhao Fan         if (cq) {
71673f7fe8deSJinhao Fan             /* CAP.DSTRD is 0, so offset of ith cq db_addr is (i<<3)+(1<<2) */
71683f7fe8deSJinhao Fan             cq->db_addr = dbs_addr + (i << 3) + (1 << 2);
71693f7fe8deSJinhao Fan             cq->ei_addr = eis_addr + (i << 3) + (1 << 2);
7170c1e244b6SKlaus Jensen             stl_le_pci_dma(pci, cq->db_addr, cq->head, MEMTXATTRS_UNSPECIFIED);
71712e53b0b4SJinhao Fan 
71722e53b0b4SJinhao Fan             if (n->params.ioeventfd && cq->cqid != 0) {
71732e53b0b4SJinhao Fan                 if (!nvme_init_cq_ioeventfd(cq)) {
71742e53b0b4SJinhao Fan                     cq->ioeventfd_enabled = true;
71752e53b0b4SJinhao Fan                 }
71762e53b0b4SJinhao Fan             }
71773f7fe8deSJinhao Fan         }
71783f7fe8deSJinhao Fan     }
71793f7fe8deSJinhao Fan 
7180387350d5SJinhao Fan     trace_pci_nvme_dbbuf_config(dbs_addr, eis_addr);
7181387350d5SJinhao Fan 
71823f7fe8deSJinhao Fan     return NVME_SUCCESS;
71833f7fe8deSJinhao Fan }
71843f7fe8deSJinhao Fan 
nvme_directive_send(NvmeCtrl * n,NvmeRequest * req)7185e181d3daSGollu Appalanaidu static uint16_t nvme_directive_send(NvmeCtrl *n, NvmeRequest *req)
7186e181d3daSGollu Appalanaidu {
7187e181d3daSGollu Appalanaidu     return NVME_INVALID_FIELD | NVME_DNR;
7188e181d3daSGollu Appalanaidu }
7189e181d3daSGollu Appalanaidu 
nvme_directive_receive(NvmeCtrl * n,NvmeRequest * req)7190e181d3daSGollu Appalanaidu static uint16_t nvme_directive_receive(NvmeCtrl *n, NvmeRequest *req)
7191e181d3daSGollu Appalanaidu {
719273064edfSJesper Devantier     NvmeNamespace *ns;
7193e181d3daSGollu Appalanaidu     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
7194e181d3daSGollu Appalanaidu     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
7195e181d3daSGollu Appalanaidu     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
7196e181d3daSGollu Appalanaidu     uint8_t doper, dtype;
7197e181d3daSGollu Appalanaidu     uint32_t numd, trans_len;
7198e181d3daSGollu Appalanaidu     NvmeDirectiveIdentify id = {
7199e181d3daSGollu Appalanaidu         .supported = 1 << NVME_DIRECTIVE_IDENTIFY,
7200e181d3daSGollu Appalanaidu         .enabled = 1 << NVME_DIRECTIVE_IDENTIFY,
7201e181d3daSGollu Appalanaidu     };
7202e181d3daSGollu Appalanaidu 
7203e181d3daSGollu Appalanaidu     numd = dw10 + 1;
7204e181d3daSGollu Appalanaidu     doper = dw11 & 0xff;
7205e181d3daSGollu Appalanaidu     dtype = (dw11 >> 8) & 0xff;
7206e181d3daSGollu Appalanaidu 
7207e181d3daSGollu Appalanaidu     trans_len = MIN(sizeof(NvmeDirectiveIdentify), numd << 2);
7208e181d3daSGollu Appalanaidu 
7209e181d3daSGollu Appalanaidu     if (nsid == NVME_NSID_BROADCAST || dtype != NVME_DIRECTIVE_IDENTIFY ||
7210e181d3daSGollu Appalanaidu         doper != NVME_DIRECTIVE_RETURN_PARAMS) {
7211e181d3daSGollu Appalanaidu         return NVME_INVALID_FIELD | NVME_DNR;
7212e181d3daSGollu Appalanaidu     }
7213e181d3daSGollu Appalanaidu 
721473064edfSJesper Devantier     ns = nvme_ns(n, nsid);
721573064edfSJesper Devantier     if (!ns) {
721673064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
721773064edfSJesper Devantier     }
721873064edfSJesper Devantier 
721973064edfSJesper Devantier     switch (dtype) {
722073064edfSJesper Devantier     case NVME_DIRECTIVE_IDENTIFY:
722173064edfSJesper Devantier         switch (doper) {
722273064edfSJesper Devantier         case NVME_DIRECTIVE_RETURN_PARAMS:
72236c8f8456SKlaus Jensen             if (ns->endgrp && ns->endgrp->fdp.enabled) {
722473064edfSJesper Devantier                 id.supported |= 1 << NVME_DIRECTIVE_DATA_PLACEMENT;
722573064edfSJesper Devantier                 id.enabled |= 1 << NVME_DIRECTIVE_DATA_PLACEMENT;
722673064edfSJesper Devantier                 id.persistent |= 1 << NVME_DIRECTIVE_DATA_PLACEMENT;
722773064edfSJesper Devantier             }
722873064edfSJesper Devantier 
7229e181d3daSGollu Appalanaidu             return nvme_c2h(n, (uint8_t *)&id, trans_len, req);
723073064edfSJesper Devantier 
723173064edfSJesper Devantier         default:
723273064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
723373064edfSJesper Devantier         }
723473064edfSJesper Devantier 
723573064edfSJesper Devantier     default:
723673064edfSJesper Devantier         return NVME_INVALID_FIELD;
723773064edfSJesper Devantier     }
7238e181d3daSGollu Appalanaidu }
7239e181d3daSGollu Appalanaidu 
nvme_admin_cmd(NvmeCtrl * n,NvmeRequest * req)724088eea45cSKlaus Jensen static uint16_t nvme_admin_cmd(NvmeCtrl *n, NvmeRequest *req)
724188eea45cSKlaus Jensen {
724288eea45cSKlaus Jensen     trace_pci_nvme_admin_cmd(nvme_cid(req), nvme_sqid(req), req->cmd.opcode,
724388eea45cSKlaus Jensen                              nvme_adm_opc_str(req->cmd.opcode));
724488eea45cSKlaus Jensen 
724588eea45cSKlaus Jensen     if (!(nvme_cse_acs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
724688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_admin_opc(req->cmd.opcode);
724788eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
724888eea45cSKlaus Jensen     }
724988eea45cSKlaus Jensen 
725088eea45cSKlaus Jensen     /* SGLs shall not be used for Admin commands in NVMe over PCIe */
725188eea45cSKlaus Jensen     if (NVME_CMD_FLAGS_PSDT(req->cmd.flags) != NVME_PSDT_PRP) {
725288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
725388eea45cSKlaus Jensen     }
725488eea45cSKlaus Jensen 
7255c53a9a91SPankaj Raghav     if (NVME_CMD_FLAGS_FUSE(req->cmd.flags)) {
7256c53a9a91SPankaj Raghav         return NVME_INVALID_FIELD;
7257c53a9a91SPankaj Raghav     }
7258c53a9a91SPankaj Raghav 
725988eea45cSKlaus Jensen     switch (req->cmd.opcode) {
726088eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_SQ:
726188eea45cSKlaus Jensen         return nvme_del_sq(n, req);
726288eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_SQ:
726388eea45cSKlaus Jensen         return nvme_create_sq(n, req);
726488eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_LOG_PAGE:
726588eea45cSKlaus Jensen         return nvme_get_log(n, req);
726688eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_CQ:
726788eea45cSKlaus Jensen         return nvme_del_cq(n, req);
726888eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_CQ:
726988eea45cSKlaus Jensen         return nvme_create_cq(n, req);
727088eea45cSKlaus Jensen     case NVME_ADM_CMD_IDENTIFY:
727188eea45cSKlaus Jensen         return nvme_identify(n, req);
727288eea45cSKlaus Jensen     case NVME_ADM_CMD_ABORT:
727388eea45cSKlaus Jensen         return nvme_abort(n, req);
727488eea45cSKlaus Jensen     case NVME_ADM_CMD_SET_FEATURES:
727588eea45cSKlaus Jensen         return nvme_set_feature(n, req);
727688eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_FEATURES:
727788eea45cSKlaus Jensen         return nvme_get_feature(n, req);
727888eea45cSKlaus Jensen     case NVME_ADM_CMD_ASYNC_EV_REQ:
727988eea45cSKlaus Jensen         return nvme_aer(n, req);
728088eea45cSKlaus Jensen     case NVME_ADM_CMD_NS_ATTACHMENT:
728188eea45cSKlaus Jensen         return nvme_ns_attachment(n, req);
728211871f53SŁukasz Gieryk     case NVME_ADM_CMD_VIRT_MNGMT:
728311871f53SŁukasz Gieryk         return nvme_virt_mngmt(n, req);
72843f7fe8deSJinhao Fan     case NVME_ADM_CMD_DBBUF_CONFIG:
72853f7fe8deSJinhao Fan         return nvme_dbbuf_config(n, req);
728688eea45cSKlaus Jensen     case NVME_ADM_CMD_FORMAT_NVM:
728788eea45cSKlaus Jensen         return nvme_format(n, req);
7288e181d3daSGollu Appalanaidu     case NVME_ADM_CMD_DIRECTIVE_SEND:
7289e181d3daSGollu Appalanaidu         return nvme_directive_send(n, req);
7290e181d3daSGollu Appalanaidu     case NVME_ADM_CMD_DIRECTIVE_RECV:
7291e181d3daSGollu Appalanaidu         return nvme_directive_receive(n, req);
729288eea45cSKlaus Jensen     default:
72937f2acdfbSPierrick Bouvier         g_assert_not_reached();
729488eea45cSKlaus Jensen     }
729588eea45cSKlaus Jensen 
729688eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
729788eea45cSKlaus Jensen }
729888eea45cSKlaus Jensen 
nvme_update_sq_eventidx(const NvmeSQueue * sq)72993f7fe8deSJinhao Fan static void nvme_update_sq_eventidx(const NvmeSQueue *sq)
73003f7fe8deSJinhao Fan {
730147cd3539SKlaus Jensen     trace_pci_nvme_update_sq_eventidx(sq->sqid, sq->tail);
730247cd3539SKlaus Jensen 
7303c1e244b6SKlaus Jensen     stl_le_pci_dma(PCI_DEVICE(sq->ctrl), sq->ei_addr, sq->tail,
7304c1e244b6SKlaus Jensen                    MEMTXATTRS_UNSPECIFIED);
73053f7fe8deSJinhao Fan }
73063f7fe8deSJinhao Fan 
nvme_update_sq_tail(NvmeSQueue * sq)73073f7fe8deSJinhao Fan static void nvme_update_sq_tail(NvmeSQueue *sq)
73083f7fe8deSJinhao Fan {
7309c1e244b6SKlaus Jensen     ldl_le_pci_dma(PCI_DEVICE(sq->ctrl), sq->db_addr, &sq->tail,
7310c1e244b6SKlaus Jensen                    MEMTXATTRS_UNSPECIFIED);
731147cd3539SKlaus Jensen 
731247cd3539SKlaus Jensen     trace_pci_nvme_update_sq_tail(sq->sqid, sq->tail);
73133f7fe8deSJinhao Fan }
73143f7fe8deSJinhao Fan 
7315ebd1568fSAlan Adamson #define NVME_ATOMIC_NO_START        0
7316ebd1568fSAlan Adamson #define NVME_ATOMIC_START_ATOMIC    1
7317ebd1568fSAlan Adamson #define NVME_ATOMIC_START_NONATOMIC 2
7318ebd1568fSAlan Adamson 
nvme_atomic_write_check(NvmeCtrl * n,NvmeCmd * cmd,NvmeAtomic * atomic)7319ebd1568fSAlan Adamson static int nvme_atomic_write_check(NvmeCtrl *n, NvmeCmd *cmd,
7320ebd1568fSAlan Adamson     NvmeAtomic *atomic)
7321ebd1568fSAlan Adamson {
7322ebd1568fSAlan Adamson     NvmeRwCmd *rw = (NvmeRwCmd *)cmd;
7323ebd1568fSAlan Adamson     uint64_t slba = le64_to_cpu(rw->slba);
7324ebd1568fSAlan Adamson     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb);
7325ebd1568fSAlan Adamson     uint64_t elba = slba + nlb;
7326ebd1568fSAlan Adamson     bool cmd_atomic_wr = true;
7327ebd1568fSAlan Adamson     int i;
7328ebd1568fSAlan Adamson 
7329ebd1568fSAlan Adamson     if ((cmd->opcode == NVME_CMD_READ) || ((cmd->opcode == NVME_CMD_WRITE) &&
7330ebd1568fSAlan Adamson         ((rw->nlb + 1) > atomic->atomic_max_write_size))) {
7331ebd1568fSAlan Adamson         cmd_atomic_wr = false;
7332ebd1568fSAlan Adamson     }
7333ebd1568fSAlan Adamson 
7334ebd1568fSAlan Adamson     /*
7335ebd1568fSAlan Adamson      * Walk the queues to see if there are any atomic conflicts.
7336ebd1568fSAlan Adamson      */
7337ebd1568fSAlan Adamson     for (i = 1; i < n->params.max_ioqpairs + 1; i++) {
7338ebd1568fSAlan Adamson         NvmeSQueue *sq;
7339ebd1568fSAlan Adamson         NvmeRequest *req;
7340ebd1568fSAlan Adamson         NvmeRwCmd *req_rw;
7341ebd1568fSAlan Adamson         uint64_t req_slba;
7342ebd1568fSAlan Adamson         uint32_t req_nlb;
7343ebd1568fSAlan Adamson         uint64_t req_elba;
7344ebd1568fSAlan Adamson 
7345ebd1568fSAlan Adamson         sq = n->sq[i];
7346ebd1568fSAlan Adamson         if (!sq) {
7347ebd1568fSAlan Adamson             continue;
7348ebd1568fSAlan Adamson         }
7349ebd1568fSAlan Adamson 
7350ebd1568fSAlan Adamson         /*
7351ebd1568fSAlan Adamson          * Walk all the requests on a given queue.
7352ebd1568fSAlan Adamson          */
7353ebd1568fSAlan Adamson         QTAILQ_FOREACH(req, &sq->out_req_list, entry) {
7354ebd1568fSAlan Adamson             req_rw = (NvmeRwCmd *)&req->cmd;
7355ebd1568fSAlan Adamson 
7356ebd1568fSAlan Adamson             if (((req_rw->opcode == NVME_CMD_WRITE) ||
7357ebd1568fSAlan Adamson                  (req_rw->opcode == NVME_CMD_READ)) &&
7358ebd1568fSAlan Adamson                 (cmd->nsid == req->ns->params.nsid)) {
7359ebd1568fSAlan Adamson                 req_slba = le64_to_cpu(req_rw->slba);
7360ebd1568fSAlan Adamson                 req_nlb = (uint32_t)le16_to_cpu(req_rw->nlb);
7361ebd1568fSAlan Adamson                 req_elba = req_slba + req_nlb;
7362ebd1568fSAlan Adamson 
7363ebd1568fSAlan Adamson                 if (cmd_atomic_wr) {
7364ebd1568fSAlan Adamson                     if ((elba >= req_slba) && (slba <= req_elba)) {
7365ebd1568fSAlan Adamson                         return NVME_ATOMIC_NO_START;
7366ebd1568fSAlan Adamson                     }
7367ebd1568fSAlan Adamson                 } else {
7368ebd1568fSAlan Adamson                     if (req->atomic_write && ((elba >= req_slba) &&
7369ebd1568fSAlan Adamson                         (slba <= req_elba))) {
7370ebd1568fSAlan Adamson                         return NVME_ATOMIC_NO_START;
7371ebd1568fSAlan Adamson                     }
7372ebd1568fSAlan Adamson                 }
7373ebd1568fSAlan Adamson             }
7374ebd1568fSAlan Adamson         }
7375ebd1568fSAlan Adamson     }
7376ebd1568fSAlan Adamson     if (cmd_atomic_wr) {
7377ebd1568fSAlan Adamson         return NVME_ATOMIC_START_ATOMIC;
7378ebd1568fSAlan Adamson     }
7379ebd1568fSAlan Adamson     return NVME_ATOMIC_START_NONATOMIC;
7380ebd1568fSAlan Adamson }
7381ebd1568fSAlan Adamson 
nvme_get_atomic(NvmeCtrl * n,NvmeCmd * cmd)7382ebd1568fSAlan Adamson static NvmeAtomic *nvme_get_atomic(NvmeCtrl *n, NvmeCmd *cmd)
7383ebd1568fSAlan Adamson {
7384ebd1568fSAlan Adamson     if (n->atomic.atomic_writes) {
7385ebd1568fSAlan Adamson         return &n->atomic;
7386ebd1568fSAlan Adamson     }
7387ebd1568fSAlan Adamson     return NULL;
7388ebd1568fSAlan Adamson }
7389ebd1568fSAlan Adamson 
nvme_process_sq(void * opaque)739088eea45cSKlaus Jensen static void nvme_process_sq(void *opaque)
739188eea45cSKlaus Jensen {
739288eea45cSKlaus Jensen     NvmeSQueue *sq = opaque;
739388eea45cSKlaus Jensen     NvmeCtrl *n = sq->ctrl;
739488eea45cSKlaus Jensen     NvmeCQueue *cq = n->cq[sq->cqid];
739588eea45cSKlaus Jensen 
739688eea45cSKlaus Jensen     uint16_t status;
739788eea45cSKlaus Jensen     hwaddr addr;
739888eea45cSKlaus Jensen     NvmeCmd cmd;
739988eea45cSKlaus Jensen     NvmeRequest *req;
740088eea45cSKlaus Jensen 
74013f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
74023f7fe8deSJinhao Fan         nvme_update_sq_tail(sq);
74033f7fe8deSJinhao Fan     }
74043f7fe8deSJinhao Fan 
740588eea45cSKlaus Jensen     while (!(nvme_sq_empty(sq) || QTAILQ_EMPTY(&sq->req_list))) {
7406ebd1568fSAlan Adamson         NvmeAtomic *atomic;
7407ebd1568fSAlan Adamson         bool cmd_is_atomic;
7408ebd1568fSAlan Adamson 
74096a33f2e9SKlaus Jensen         addr = sq->dma_addr + (sq->head << NVME_SQES);
741088eea45cSKlaus Jensen         if (nvme_addr_read(n, addr, (void *)&cmd, sizeof(cmd))) {
741188eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
741288eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
741349e03457SKlaus Jensen             stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
741488eea45cSKlaus Jensen             break;
741588eea45cSKlaus Jensen         }
7416ebd1568fSAlan Adamson 
7417ebd1568fSAlan Adamson         atomic = nvme_get_atomic(n, &cmd);
7418ebd1568fSAlan Adamson 
7419ebd1568fSAlan Adamson         cmd_is_atomic = false;
7420ebd1568fSAlan Adamson         if (sq->sqid && atomic) {
7421ebd1568fSAlan Adamson             int ret;
7422ebd1568fSAlan Adamson 
7423ebd1568fSAlan Adamson             ret = nvme_atomic_write_check(n, &cmd, atomic);
7424ebd1568fSAlan Adamson             switch (ret) {
7425ebd1568fSAlan Adamson             case NVME_ATOMIC_NO_START:
7426ebd1568fSAlan Adamson                 qemu_bh_schedule(sq->bh);
7427ebd1568fSAlan Adamson                 return;
7428ebd1568fSAlan Adamson             case NVME_ATOMIC_START_ATOMIC:
7429ebd1568fSAlan Adamson                 cmd_is_atomic = true;
7430ebd1568fSAlan Adamson                 break;
7431ebd1568fSAlan Adamson             case NVME_ATOMIC_START_NONATOMIC:
7432ebd1568fSAlan Adamson             default:
7433ebd1568fSAlan Adamson                 break;
7434ebd1568fSAlan Adamson             }
7435ebd1568fSAlan Adamson         }
743688eea45cSKlaus Jensen         nvme_inc_sq_head(sq);
743788eea45cSKlaus Jensen 
743888eea45cSKlaus Jensen         req = QTAILQ_FIRST(&sq->req_list);
743988eea45cSKlaus Jensen         QTAILQ_REMOVE(&sq->req_list, req, entry);
744088eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->out_req_list, req, entry);
744188eea45cSKlaus Jensen         nvme_req_clear(req);
744288eea45cSKlaus Jensen         req->cqe.cid = cmd.cid;
744388eea45cSKlaus Jensen         memcpy(&req->cmd, &cmd, sizeof(NvmeCmd));
744488eea45cSKlaus Jensen 
7445ebd1568fSAlan Adamson         if (sq->sqid && atomic) {
7446ebd1568fSAlan Adamson             req->atomic_write = cmd_is_atomic;
7447ebd1568fSAlan Adamson         }
7448ebd1568fSAlan Adamson 
744988eea45cSKlaus Jensen         status = sq->sqid ? nvme_io_cmd(n, req) :
745088eea45cSKlaus Jensen             nvme_admin_cmd(n, req);
745188eea45cSKlaus Jensen         if (status != NVME_NO_COMPLETE) {
745288eea45cSKlaus Jensen             req->status = status;
745388eea45cSKlaus Jensen             nvme_enqueue_req_completion(cq, req);
745488eea45cSKlaus Jensen         }
74553f7fe8deSJinhao Fan 
74563f7fe8deSJinhao Fan         if (n->dbbuf_enabled) {
74573f7fe8deSJinhao Fan             nvme_update_sq_eventidx(sq);
74583f7fe8deSJinhao Fan             nvme_update_sq_tail(sq);
74593f7fe8deSJinhao Fan         }
746088eea45cSKlaus Jensen     }
746188eea45cSKlaus Jensen }
746288eea45cSKlaus Jensen 
nvme_update_msixcap_ts(PCIDevice * pci_dev,uint32_t table_size)7463decc0261SŁukasz Gieryk static void nvme_update_msixcap_ts(PCIDevice *pci_dev, uint32_t table_size)
7464decc0261SŁukasz Gieryk {
7465decc0261SŁukasz Gieryk     uint8_t *config;
7466decc0261SŁukasz Gieryk 
7467decc0261SŁukasz Gieryk     if (!msix_present(pci_dev)) {
7468decc0261SŁukasz Gieryk         return;
7469decc0261SŁukasz Gieryk     }
7470decc0261SŁukasz Gieryk 
7471decc0261SŁukasz Gieryk     assert(table_size > 0 && table_size <= pci_dev->msix_entries_nr);
7472decc0261SŁukasz Gieryk 
7473decc0261SŁukasz Gieryk     config = pci_dev->config + pci_dev->msix_cap;
7474decc0261SŁukasz Gieryk     pci_set_word_by_mask(config + PCI_MSIX_FLAGS, PCI_MSIX_FLAGS_QSIZE,
7475decc0261SŁukasz Gieryk                          table_size - 1);
7476decc0261SŁukasz Gieryk }
7477decc0261SŁukasz Gieryk 
nvme_activate_virt_res(NvmeCtrl * n)747811871f53SŁukasz Gieryk static void nvme_activate_virt_res(NvmeCtrl *n)
747911871f53SŁukasz Gieryk {
748048b32c28SKlaus Jensen     PCIDevice *pci_dev = PCI_DEVICE(n);
748111871f53SŁukasz Gieryk     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
748211871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
748311871f53SŁukasz Gieryk 
748411871f53SŁukasz Gieryk     /* -1 to account for the admin queue */
748511871f53SŁukasz Gieryk     if (pci_is_vf(pci_dev)) {
748611871f53SŁukasz Gieryk         sctrl = nvme_sctrl(n);
748711871f53SŁukasz Gieryk         cap->vqprt = sctrl->nvq;
748811871f53SŁukasz Gieryk         cap->viprt = sctrl->nvi;
748911871f53SŁukasz Gieryk         n->conf_ioqpairs = sctrl->nvq ? le16_to_cpu(sctrl->nvq) - 1 : 0;
749011871f53SŁukasz Gieryk         n->conf_msix_qsize = sctrl->nvi ? le16_to_cpu(sctrl->nvi) : 1;
749111871f53SŁukasz Gieryk     } else {
749211871f53SŁukasz Gieryk         cap->vqrfap = n->next_pri_ctrl_cap.vqrfap;
749311871f53SŁukasz Gieryk         cap->virfap = n->next_pri_ctrl_cap.virfap;
749411871f53SŁukasz Gieryk         n->conf_ioqpairs = le16_to_cpu(cap->vqprt) +
749511871f53SŁukasz Gieryk                            le16_to_cpu(cap->vqrfap) - 1;
749611871f53SŁukasz Gieryk         n->conf_msix_qsize = le16_to_cpu(cap->viprt) +
749711871f53SŁukasz Gieryk                              le16_to_cpu(cap->virfap);
749811871f53SŁukasz Gieryk     }
749911871f53SŁukasz Gieryk }
750011871f53SŁukasz Gieryk 
nvme_ctrl_reset(NvmeCtrl * n,NvmeResetType rst)75011e9c685eSŁukasz Gieryk static void nvme_ctrl_reset(NvmeCtrl *n, NvmeResetType rst)
750288eea45cSKlaus Jensen {
750348b32c28SKlaus Jensen     PCIDevice *pci_dev = PCI_DEVICE(n);
750411871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
750588eea45cSKlaus Jensen     NvmeNamespace *ns;
750688eea45cSKlaus Jensen     int i;
750788eea45cSKlaus Jensen 
750888eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
750988eea45cSKlaus Jensen         ns = nvme_ns(n, i);
751088eea45cSKlaus Jensen         if (!ns) {
751188eea45cSKlaus Jensen             continue;
751288eea45cSKlaus Jensen         }
751388eea45cSKlaus Jensen 
751488eea45cSKlaus Jensen         nvme_ns_drain(ns);
751588eea45cSKlaus Jensen     }
751688eea45cSKlaus Jensen 
751788eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
751888eea45cSKlaus Jensen         if (n->sq[i] != NULL) {
751988eea45cSKlaus Jensen             nvme_free_sq(n->sq[i], n);
752088eea45cSKlaus Jensen         }
752188eea45cSKlaus Jensen     }
752288eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
752388eea45cSKlaus Jensen         if (n->cq[i] != NULL) {
752488eea45cSKlaus Jensen             nvme_free_cq(n->cq[i], n);
752588eea45cSKlaus Jensen         }
752688eea45cSKlaus Jensen     }
752788eea45cSKlaus Jensen 
752888eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&n->aer_queue)) {
752988eea45cSKlaus Jensen         NvmeAsyncEvent *event = QTAILQ_FIRST(&n->aer_queue);
753088eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
753188eea45cSKlaus Jensen         g_free(event);
753288eea45cSKlaus Jensen     }
753388eea45cSKlaus Jensen 
753411871f53SŁukasz Gieryk     if (n->params.sriov_max_vfs) {
753511871f53SŁukasz Gieryk         if (!pci_is_vf(pci_dev)) {
75361a494d11SMinwoo Im             for (i = 0; i < n->nr_sec_ctrls; i++) {
75371a494d11SMinwoo Im                 sctrl = &n->sec_ctrl_list[i];
753811871f53SŁukasz Gieryk                 nvme_virt_set_state(n, le16_to_cpu(sctrl->scid), false);
753911871f53SŁukasz Gieryk             }
75401e9c685eSŁukasz Gieryk         }
754144c2c094SLukasz Maniak 
754211871f53SŁukasz Gieryk         if (rst != NVME_RESET_CONTROLLER) {
754311871f53SŁukasz Gieryk             nvme_activate_virt_res(n);
754411871f53SŁukasz Gieryk         }
754511871f53SŁukasz Gieryk     }
754611871f53SŁukasz Gieryk 
754788eea45cSKlaus Jensen     n->aer_queued = 0;
754898836e8eSKlaus Jensen     n->aer_mask = 0;
754988eea45cSKlaus Jensen     n->outstanding_aers = 0;
755088eea45cSKlaus Jensen     n->qs_created = false;
7551decc0261SŁukasz Gieryk 
7552ebd1568fSAlan Adamson     n->dn = n->params.atomic_dn; /* Set Disable Normal */
7553ebd1568fSAlan Adamson 
7554decc0261SŁukasz Gieryk     nvme_update_msixcap_ts(pci_dev, n->conf_msix_qsize);
755511871f53SŁukasz Gieryk 
755611871f53SŁukasz Gieryk     if (pci_is_vf(pci_dev)) {
755711871f53SŁukasz Gieryk         sctrl = nvme_sctrl(n);
7558cc9bcee2SKlaus Jensen 
755911871f53SŁukasz Gieryk         stl_le_p(&n->bar.csts, sctrl->scs ? 0 : NVME_CSTS_FAILED);
756011871f53SŁukasz Gieryk     } else {
756111871f53SŁukasz Gieryk         stl_le_p(&n->bar.csts, 0);
756211871f53SŁukasz Gieryk     }
7563cc9bcee2SKlaus Jensen 
7564cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.intms, 0);
7565cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.intmc, 0);
7566cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.cc, 0);
75673f7fe8deSJinhao Fan 
75683f7fe8deSJinhao Fan     n->dbbuf_dbs = 0;
75693f7fe8deSJinhao Fan     n->dbbuf_eis = 0;
75703f7fe8deSJinhao Fan     n->dbbuf_enabled = false;
757188eea45cSKlaus Jensen }
757288eea45cSKlaus Jensen 
nvme_ctrl_shutdown(NvmeCtrl * n)757388eea45cSKlaus Jensen static void nvme_ctrl_shutdown(NvmeCtrl *n)
757488eea45cSKlaus Jensen {
757588eea45cSKlaus Jensen     NvmeNamespace *ns;
757688eea45cSKlaus Jensen     int i;
757788eea45cSKlaus Jensen 
757888eea45cSKlaus Jensen     if (n->pmr.dev) {
757988eea45cSKlaus Jensen         memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
758088eea45cSKlaus Jensen     }
758188eea45cSKlaus Jensen 
758288eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
758388eea45cSKlaus Jensen         ns = nvme_ns(n, i);
758488eea45cSKlaus Jensen         if (!ns) {
758588eea45cSKlaus Jensen             continue;
758688eea45cSKlaus Jensen         }
758788eea45cSKlaus Jensen 
758888eea45cSKlaus Jensen         nvme_ns_shutdown(ns);
758988eea45cSKlaus Jensen     }
759088eea45cSKlaus Jensen }
759188eea45cSKlaus Jensen 
nvme_select_iocs(NvmeCtrl * n)759288eea45cSKlaus Jensen static void nvme_select_iocs(NvmeCtrl *n)
759388eea45cSKlaus Jensen {
759488eea45cSKlaus Jensen     NvmeNamespace *ns;
759588eea45cSKlaus Jensen     int i;
759688eea45cSKlaus Jensen 
759788eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
759888eea45cSKlaus Jensen         ns = nvme_ns(n, i);
759988eea45cSKlaus Jensen         if (!ns) {
760088eea45cSKlaus Jensen             continue;
760188eea45cSKlaus Jensen         }
760288eea45cSKlaus Jensen 
760388eea45cSKlaus Jensen         nvme_select_iocs_ns(n, ns);
760488eea45cSKlaus Jensen     }
760588eea45cSKlaus Jensen }
760688eea45cSKlaus Jensen 
nvme_start_ctrl(NvmeCtrl * n)760788eea45cSKlaus Jensen static int nvme_start_ctrl(NvmeCtrl *n)
760888eea45cSKlaus Jensen {
760949e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
761049e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
761149e03457SKlaus Jensen     uint32_t aqa = ldl_le_p(&n->bar.aqa);
761249e03457SKlaus Jensen     uint64_t asq = ldq_le_p(&n->bar.asq);
761349e03457SKlaus Jensen     uint64_t acq = ldq_le_p(&n->bar.acq);
761449e03457SKlaus Jensen     uint32_t page_bits = NVME_CC_MPS(cc) + 12;
761588eea45cSKlaus Jensen     uint32_t page_size = 1 << page_bits;
761611871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl = nvme_sctrl(n);
761788eea45cSKlaus Jensen 
761848b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !sctrl->scs) {
761911871f53SŁukasz Gieryk         trace_pci_nvme_err_startfail_virt_state(le16_to_cpu(sctrl->nvi),
76203488fc32SPaolo Bonzini                                                 le16_to_cpu(sctrl->nvq));
762111871f53SŁukasz Gieryk         return -1;
762211871f53SŁukasz Gieryk     }
762388eea45cSKlaus Jensen     if (unlikely(n->cq[0])) {
762488eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cq();
762588eea45cSKlaus Jensen         return -1;
762688eea45cSKlaus Jensen     }
762788eea45cSKlaus Jensen     if (unlikely(n->sq[0])) {
762888eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sq();
762988eea45cSKlaus Jensen         return -1;
763088eea45cSKlaus Jensen     }
763149e03457SKlaus Jensen     if (unlikely(asq & (page_size - 1))) {
763249e03457SKlaus Jensen         trace_pci_nvme_err_startfail_asq_misaligned(asq);
763388eea45cSKlaus Jensen         return -1;
763488eea45cSKlaus Jensen     }
763549e03457SKlaus Jensen     if (unlikely(acq & (page_size - 1))) {
763649e03457SKlaus Jensen         trace_pci_nvme_err_startfail_acq_misaligned(acq);
763788eea45cSKlaus Jensen         return -1;
763888eea45cSKlaus Jensen     }
763949e03457SKlaus Jensen     if (unlikely(!(NVME_CAP_CSS(cap) & (1 << NVME_CC_CSS(cc))))) {
764049e03457SKlaus Jensen         trace_pci_nvme_err_startfail_css(NVME_CC_CSS(cc));
764188eea45cSKlaus Jensen         return -1;
764288eea45cSKlaus Jensen     }
764349e03457SKlaus Jensen     if (unlikely(NVME_CC_MPS(cc) < NVME_CAP_MPSMIN(cap))) {
764488eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_small(
764549e03457SKlaus Jensen                     NVME_CC_MPS(cc),
764649e03457SKlaus Jensen                     NVME_CAP_MPSMIN(cap));
764788eea45cSKlaus Jensen         return -1;
764888eea45cSKlaus Jensen     }
764949e03457SKlaus Jensen     if (unlikely(NVME_CC_MPS(cc) >
765049e03457SKlaus Jensen                  NVME_CAP_MPSMAX(cap))) {
765188eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_large(
765249e03457SKlaus Jensen                     NVME_CC_MPS(cc),
765349e03457SKlaus Jensen                     NVME_CAP_MPSMAX(cap));
765488eea45cSKlaus Jensen         return -1;
765588eea45cSKlaus Jensen     }
765649e03457SKlaus Jensen     if (unlikely(!NVME_AQA_ASQS(aqa))) {
765788eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_asqent_sz_zero();
765888eea45cSKlaus Jensen         return -1;
765988eea45cSKlaus Jensen     }
766049e03457SKlaus Jensen     if (unlikely(!NVME_AQA_ACQS(aqa))) {
766188eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_acqent_sz_zero();
766288eea45cSKlaus Jensen         return -1;
766388eea45cSKlaus Jensen     }
766488eea45cSKlaus Jensen 
766588eea45cSKlaus Jensen     n->page_bits = page_bits;
766688eea45cSKlaus Jensen     n->page_size = page_size;
766788eea45cSKlaus Jensen     n->max_prp_ents = n->page_size / sizeof(uint64_t);
766849e03457SKlaus Jensen     nvme_init_cq(&n->admin_cq, n, acq, 0, 0, NVME_AQA_ACQS(aqa) + 1, 1);
766949e03457SKlaus Jensen     nvme_init_sq(&n->admin_sq, n, asq, 0, 0, NVME_AQA_ASQS(aqa) + 1);
767088eea45cSKlaus Jensen 
767188eea45cSKlaus Jensen     nvme_set_timestamp(n, 0ULL);
767288eea45cSKlaus Jensen 
767388eea45cSKlaus Jensen     nvme_select_iocs(n);
767488eea45cSKlaus Jensen 
767588eea45cSKlaus Jensen     return 0;
767688eea45cSKlaus Jensen }
767788eea45cSKlaus Jensen 
nvme_cmb_enable_regs(NvmeCtrl * n)767888eea45cSKlaus Jensen static void nvme_cmb_enable_regs(NvmeCtrl *n)
767988eea45cSKlaus Jensen {
768049e03457SKlaus Jensen     uint32_t cmbloc = ldl_le_p(&n->bar.cmbloc);
768149e03457SKlaus Jensen     uint32_t cmbsz = ldl_le_p(&n->bar.cmbsz);
768288eea45cSKlaus Jensen 
768349e03457SKlaus Jensen     NVME_CMBLOC_SET_CDPCILS(cmbloc, 1);
768449e03457SKlaus Jensen     NVME_CMBLOC_SET_CDPMLS(cmbloc, 1);
768549e03457SKlaus Jensen     NVME_CMBLOC_SET_BIR(cmbloc, NVME_CMB_BIR);
768649e03457SKlaus Jensen     stl_le_p(&n->bar.cmbloc, cmbloc);
768749e03457SKlaus Jensen 
768849e03457SKlaus Jensen     NVME_CMBSZ_SET_SQS(cmbsz, 1);
768949e03457SKlaus Jensen     NVME_CMBSZ_SET_CQS(cmbsz, 0);
769049e03457SKlaus Jensen     NVME_CMBSZ_SET_LISTS(cmbsz, 1);
769149e03457SKlaus Jensen     NVME_CMBSZ_SET_RDS(cmbsz, 1);
769249e03457SKlaus Jensen     NVME_CMBSZ_SET_WDS(cmbsz, 1);
769349e03457SKlaus Jensen     NVME_CMBSZ_SET_SZU(cmbsz, 2); /* MBs */
769449e03457SKlaus Jensen     NVME_CMBSZ_SET_SZ(cmbsz, n->params.cmb_size_mb);
769549e03457SKlaus Jensen     stl_le_p(&n->bar.cmbsz, cmbsz);
769688eea45cSKlaus Jensen }
769788eea45cSKlaus Jensen 
nvme_write_bar(NvmeCtrl * n,hwaddr offset,uint64_t data,unsigned size)769888eea45cSKlaus Jensen static void nvme_write_bar(NvmeCtrl *n, hwaddr offset, uint64_t data,
769988eea45cSKlaus Jensen                            unsigned size)
770088eea45cSKlaus Jensen {
770148b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
770249e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
770349e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
770449e03457SKlaus Jensen     uint32_t intms = ldl_le_p(&n->bar.intms);
770549e03457SKlaus Jensen     uint32_t csts = ldl_le_p(&n->bar.csts);
770649e03457SKlaus Jensen     uint32_t pmrsts = ldl_le_p(&n->bar.pmrsts);
770749e03457SKlaus Jensen 
770888eea45cSKlaus Jensen     if (unlikely(offset & (sizeof(uint32_t) - 1))) {
770988eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_misaligned32,
771088eea45cSKlaus Jensen                        "MMIO write not 32-bit aligned,"
771188eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", offset);
771288eea45cSKlaus Jensen         /* should be ignored, fall through for now */
771388eea45cSKlaus Jensen     }
771488eea45cSKlaus Jensen 
771588eea45cSKlaus Jensen     if (unlikely(size < sizeof(uint32_t))) {
771688eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_toosmall,
771788eea45cSKlaus Jensen                        "MMIO write smaller than 32-bits,"
771888eea45cSKlaus Jensen                        " offset=0x%"PRIx64", size=%u",
771988eea45cSKlaus Jensen                        offset, size);
772088eea45cSKlaus Jensen         /* should be ignored, fall through for now */
772188eea45cSKlaus Jensen     }
772288eea45cSKlaus Jensen 
772388eea45cSKlaus Jensen     switch (offset) {
7724a316aa50SKlaus Jensen     case NVME_REG_INTMS:
772548b32c28SKlaus Jensen         if (unlikely(msix_enabled(pci))) {
772688eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
772788eea45cSKlaus Jensen                            "undefined access to interrupt mask set"
772888eea45cSKlaus Jensen                            " when MSI-X is enabled");
772988eea45cSKlaus Jensen             /* should be ignored, fall through for now */
773088eea45cSKlaus Jensen         }
773149e03457SKlaus Jensen         intms |= data;
773249e03457SKlaus Jensen         stl_le_p(&n->bar.intms, intms);
773388eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
773449e03457SKlaus Jensen         trace_pci_nvme_mmio_intm_set(data & 0xffffffff, intms);
773588eea45cSKlaus Jensen         nvme_irq_check(n);
773688eea45cSKlaus Jensen         break;
7737a316aa50SKlaus Jensen     case NVME_REG_INTMC:
773848b32c28SKlaus Jensen         if (unlikely(msix_enabled(pci))) {
773988eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
774088eea45cSKlaus Jensen                            "undefined access to interrupt mask clr"
774188eea45cSKlaus Jensen                            " when MSI-X is enabled");
774288eea45cSKlaus Jensen             /* should be ignored, fall through for now */
774388eea45cSKlaus Jensen         }
774449e03457SKlaus Jensen         intms &= ~data;
774549e03457SKlaus Jensen         stl_le_p(&n->bar.intms, intms);
774688eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
774749e03457SKlaus Jensen         trace_pci_nvme_mmio_intm_clr(data & 0xffffffff, intms);
774888eea45cSKlaus Jensen         nvme_irq_check(n);
774988eea45cSKlaus Jensen         break;
7750a316aa50SKlaus Jensen     case NVME_REG_CC:
7751cc9bcee2SKlaus Jensen         stl_le_p(&n->bar.cc, data);
7752cc9bcee2SKlaus Jensen 
775388eea45cSKlaus Jensen         trace_pci_nvme_mmio_cfg(data & 0xffffffff);
775449e03457SKlaus Jensen 
7755cc9bcee2SKlaus Jensen         if (NVME_CC_SHN(data) && !(NVME_CC_SHN(cc))) {
7756cc9bcee2SKlaus Jensen             trace_pci_nvme_mmio_shutdown_set();
7757cc9bcee2SKlaus Jensen             nvme_ctrl_shutdown(n);
7758cc9bcee2SKlaus Jensen             csts &= ~(CSTS_SHST_MASK << CSTS_SHST_SHIFT);
7759cc9bcee2SKlaus Jensen             csts |= NVME_CSTS_SHST_COMPLETE;
7760cc9bcee2SKlaus Jensen         } else if (!NVME_CC_SHN(data) && NVME_CC_SHN(cc)) {
7761cc9bcee2SKlaus Jensen             trace_pci_nvme_mmio_shutdown_cleared();
7762cc9bcee2SKlaus Jensen             csts &= ~(CSTS_SHST_MASK << CSTS_SHST_SHIFT);
776388eea45cSKlaus Jensen         }
776488eea45cSKlaus Jensen 
776549e03457SKlaus Jensen         if (NVME_CC_EN(data) && !NVME_CC_EN(cc)) {
776688eea45cSKlaus Jensen             if (unlikely(nvme_start_ctrl(n))) {
776788eea45cSKlaus Jensen                 trace_pci_nvme_err_startfail();
776849e03457SKlaus Jensen                 csts = NVME_CSTS_FAILED;
776988eea45cSKlaus Jensen             } else {
777088eea45cSKlaus Jensen                 trace_pci_nvme_mmio_start_success();
777149e03457SKlaus Jensen                 csts = NVME_CSTS_READY;
777288eea45cSKlaus Jensen             }
777349e03457SKlaus Jensen         } else if (!NVME_CC_EN(data) && NVME_CC_EN(cc)) {
777488eea45cSKlaus Jensen             trace_pci_nvme_mmio_stopped();
77751e9c685eSŁukasz Gieryk             nvme_ctrl_reset(n, NVME_RESET_CONTROLLER);
7776cc9bcee2SKlaus Jensen 
7777cc9bcee2SKlaus Jensen             break;
777888eea45cSKlaus Jensen         }
777949e03457SKlaus Jensen 
778049e03457SKlaus Jensen         stl_le_p(&n->bar.csts, csts);
778149e03457SKlaus Jensen 
778288eea45cSKlaus Jensen         break;
7783a316aa50SKlaus Jensen     case NVME_REG_CSTS:
778488eea45cSKlaus Jensen         if (data & (1 << 4)) {
778588eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ssreset_w1c_unsupported,
778688eea45cSKlaus Jensen                            "attempted to W1C CSTS.NSSRO"
778788eea45cSKlaus Jensen                            " but CAP.NSSRS is zero (not supported)");
778888eea45cSKlaus Jensen         } else if (data != 0) {
778988eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ro_csts,
779088eea45cSKlaus Jensen                            "attempted to set a read only bit"
779188eea45cSKlaus Jensen                            " of controller status");
779288eea45cSKlaus Jensen         }
779388eea45cSKlaus Jensen         break;
7794a316aa50SKlaus Jensen     case NVME_REG_NSSR:
779588eea45cSKlaus Jensen         if (data == 0x4e564d65) {
779688eea45cSKlaus Jensen             trace_pci_nvme_ub_mmiowr_ssreset_unsupported();
779788eea45cSKlaus Jensen         } else {
779888eea45cSKlaus Jensen             /* The spec says that writes of other values have no effect */
779988eea45cSKlaus Jensen             return;
780088eea45cSKlaus Jensen         }
780188eea45cSKlaus Jensen         break;
7802a316aa50SKlaus Jensen     case NVME_REG_AQA:
780349e03457SKlaus Jensen         stl_le_p(&n->bar.aqa, data);
780488eea45cSKlaus Jensen         trace_pci_nvme_mmio_aqattr(data & 0xffffffff);
780588eea45cSKlaus Jensen         break;
7806a316aa50SKlaus Jensen     case NVME_REG_ASQ:
780749e03457SKlaus Jensen         stn_le_p(&n->bar.asq, size, data);
780888eea45cSKlaus Jensen         trace_pci_nvme_mmio_asqaddr(data);
780988eea45cSKlaus Jensen         break;
7810a316aa50SKlaus Jensen     case NVME_REG_ASQ + 4:
781149e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.asq + 4, data);
781249e03457SKlaus Jensen         trace_pci_nvme_mmio_asqaddr_hi(data, ldq_le_p(&n->bar.asq));
781388eea45cSKlaus Jensen         break;
7814a316aa50SKlaus Jensen     case NVME_REG_ACQ:
781588eea45cSKlaus Jensen         trace_pci_nvme_mmio_acqaddr(data);
781649e03457SKlaus Jensen         stn_le_p(&n->bar.acq, size, data);
781788eea45cSKlaus Jensen         break;
7818a316aa50SKlaus Jensen     case NVME_REG_ACQ + 4:
781949e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.acq + 4, data);
782049e03457SKlaus Jensen         trace_pci_nvme_mmio_acqaddr_hi(data, ldq_le_p(&n->bar.acq));
782188eea45cSKlaus Jensen         break;
7822a316aa50SKlaus Jensen     case NVME_REG_CMBLOC:
782388eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbloc_reserved,
782488eea45cSKlaus Jensen                        "invalid write to reserved CMBLOC"
782588eea45cSKlaus Jensen                        " when CMBSZ is zero, ignored");
782688eea45cSKlaus Jensen         return;
7827a316aa50SKlaus Jensen     case NVME_REG_CMBSZ:
782888eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbsz_readonly,
782988eea45cSKlaus Jensen                        "invalid write to read only CMBSZ, ignored");
783088eea45cSKlaus Jensen         return;
7831a316aa50SKlaus Jensen     case NVME_REG_CMBMSC:
783249e03457SKlaus Jensen         if (!NVME_CAP_CMBS(cap)) {
783388eea45cSKlaus Jensen             return;
783488eea45cSKlaus Jensen         }
783588eea45cSKlaus Jensen 
783649e03457SKlaus Jensen         stn_le_p(&n->bar.cmbmsc, size, data);
783788eea45cSKlaus Jensen         n->cmb.cmse = false;
783888eea45cSKlaus Jensen 
783988eea45cSKlaus Jensen         if (NVME_CMBMSC_CRE(data)) {
784088eea45cSKlaus Jensen             nvme_cmb_enable_regs(n);
784188eea45cSKlaus Jensen 
784288eea45cSKlaus Jensen             if (NVME_CMBMSC_CMSE(data)) {
784349e03457SKlaus Jensen                 uint64_t cmbmsc = ldq_le_p(&n->bar.cmbmsc);
784449e03457SKlaus Jensen                 hwaddr cba = NVME_CMBMSC_CBA(cmbmsc) << CMBMSC_CBA_SHIFT;
784588eea45cSKlaus Jensen                 if (cba + int128_get64(n->cmb.mem.size) < cba) {
784649e03457SKlaus Jensen                     uint32_t cmbsts = ldl_le_p(&n->bar.cmbsts);
784749e03457SKlaus Jensen                     NVME_CMBSTS_SET_CBAI(cmbsts, 1);
784849e03457SKlaus Jensen                     stl_le_p(&n->bar.cmbsts, cmbsts);
784988eea45cSKlaus Jensen                     return;
785088eea45cSKlaus Jensen                 }
785188eea45cSKlaus Jensen 
785288eea45cSKlaus Jensen                 n->cmb.cba = cba;
785388eea45cSKlaus Jensen                 n->cmb.cmse = true;
785488eea45cSKlaus Jensen             }
785588eea45cSKlaus Jensen         } else {
785688eea45cSKlaus Jensen             n->bar.cmbsz = 0;
785788eea45cSKlaus Jensen             n->bar.cmbloc = 0;
785888eea45cSKlaus Jensen         }
785988eea45cSKlaus Jensen 
786088eea45cSKlaus Jensen         return;
7861a316aa50SKlaus Jensen     case NVME_REG_CMBMSC + 4:
786249e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.cmbmsc + 4, data);
786388eea45cSKlaus Jensen         return;
786488eea45cSKlaus Jensen 
7865a316aa50SKlaus Jensen     case NVME_REG_PMRCAP:
786688eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrcap_readonly,
786788eea45cSKlaus Jensen                        "invalid write to PMRCAP register, ignored");
786888eea45cSKlaus Jensen         return;
7869a316aa50SKlaus Jensen     case NVME_REG_PMRCTL:
787049e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
78712b02aabcSKlaus Jensen             return;
78722b02aabcSKlaus Jensen         }
78732b02aabcSKlaus Jensen 
787449e03457SKlaus Jensen         stl_le_p(&n->bar.pmrctl, data);
787588eea45cSKlaus Jensen         if (NVME_PMRCTL_EN(data)) {
787688eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, true);
787749e03457SKlaus Jensen             pmrsts = 0;
787888eea45cSKlaus Jensen         } else {
787988eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, false);
788049e03457SKlaus Jensen             NVME_PMRSTS_SET_NRDY(pmrsts, 1);
788188eea45cSKlaus Jensen             n->pmr.cmse = false;
788288eea45cSKlaus Jensen         }
788349e03457SKlaus Jensen         stl_le_p(&n->bar.pmrsts, pmrsts);
788488eea45cSKlaus Jensen         return;
7885a316aa50SKlaus Jensen     case NVME_REG_PMRSTS:
788688eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrsts_readonly,
788788eea45cSKlaus Jensen                        "invalid write to PMRSTS register, ignored");
788888eea45cSKlaus Jensen         return;
7889a316aa50SKlaus Jensen     case NVME_REG_PMREBS:
789088eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrebs_readonly,
789188eea45cSKlaus Jensen                        "invalid write to PMREBS register, ignored");
789288eea45cSKlaus Jensen         return;
7893a316aa50SKlaus Jensen     case NVME_REG_PMRSWTP:
789488eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrswtp_readonly,
789588eea45cSKlaus Jensen                        "invalid write to PMRSWTP register, ignored");
789688eea45cSKlaus Jensen         return;
7897a316aa50SKlaus Jensen     case NVME_REG_PMRMSCL:
789849e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
789988eea45cSKlaus Jensen             return;
790088eea45cSKlaus Jensen         }
790188eea45cSKlaus Jensen 
790249e03457SKlaus Jensen         stl_le_p(&n->bar.pmrmscl, data);
790388eea45cSKlaus Jensen         n->pmr.cmse = false;
790488eea45cSKlaus Jensen 
790549e03457SKlaus Jensen         if (NVME_PMRMSCL_CMSE(data)) {
790649e03457SKlaus Jensen             uint64_t pmrmscu = ldl_le_p(&n->bar.pmrmscu);
790749e03457SKlaus Jensen             hwaddr cba = pmrmscu << 32 |
790849e03457SKlaus Jensen                 (NVME_PMRMSCL_CBA(data) << PMRMSCL_CBA_SHIFT);
790988eea45cSKlaus Jensen             if (cba + int128_get64(n->pmr.dev->mr.size) < cba) {
791049e03457SKlaus Jensen                 NVME_PMRSTS_SET_CBAI(pmrsts, 1);
791149e03457SKlaus Jensen                 stl_le_p(&n->bar.pmrsts, pmrsts);
791288eea45cSKlaus Jensen                 return;
791388eea45cSKlaus Jensen             }
791488eea45cSKlaus Jensen 
791588eea45cSKlaus Jensen             n->pmr.cmse = true;
791688eea45cSKlaus Jensen             n->pmr.cba = cba;
791788eea45cSKlaus Jensen         }
791888eea45cSKlaus Jensen 
791988eea45cSKlaus Jensen         return;
7920a316aa50SKlaus Jensen     case NVME_REG_PMRMSCU:
792149e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
792288eea45cSKlaus Jensen             return;
792388eea45cSKlaus Jensen         }
792488eea45cSKlaus Jensen 
792549e03457SKlaus Jensen         stl_le_p(&n->bar.pmrmscu, data);
792688eea45cSKlaus Jensen         return;
792788eea45cSKlaus Jensen     default:
792888eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_invalid,
792988eea45cSKlaus Jensen                        "invalid MMIO write,"
793088eea45cSKlaus Jensen                        " offset=0x%"PRIx64", data=%"PRIx64"",
793188eea45cSKlaus Jensen                        offset, data);
793288eea45cSKlaus Jensen         break;
793388eea45cSKlaus Jensen     }
793488eea45cSKlaus Jensen }
793588eea45cSKlaus Jensen 
nvme_mmio_read(void * opaque,hwaddr addr,unsigned size)793688eea45cSKlaus Jensen static uint64_t nvme_mmio_read(void *opaque, hwaddr addr, unsigned size)
793788eea45cSKlaus Jensen {
793888eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
793988eea45cSKlaus Jensen     uint8_t *ptr = (uint8_t *)&n->bar;
794088eea45cSKlaus Jensen 
794188eea45cSKlaus Jensen     trace_pci_nvme_mmio_read(addr, size);
794288eea45cSKlaus Jensen 
794388eea45cSKlaus Jensen     if (unlikely(addr & (sizeof(uint32_t) - 1))) {
794488eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_misaligned32,
794588eea45cSKlaus Jensen                        "MMIO read not 32-bit aligned,"
794688eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
794788eea45cSKlaus Jensen         /* should RAZ, fall through for now */
794888eea45cSKlaus Jensen     } else if (unlikely(size < sizeof(uint32_t))) {
794988eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_toosmall,
795088eea45cSKlaus Jensen                        "MMIO read smaller than 32-bits,"
795188eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
795288eea45cSKlaus Jensen         /* should RAZ, fall through for now */
795388eea45cSKlaus Jensen     }
795488eea45cSKlaus Jensen 
79555029de44SKlaus Jensen     if (addr > sizeof(n->bar) - size) {
79565029de44SKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_invalid_ofs,
79575029de44SKlaus Jensen                        "MMIO read beyond last register,"
79585029de44SKlaus Jensen                        " offset=0x%"PRIx64", returning 0", addr);
79595029de44SKlaus Jensen 
79605029de44SKlaus Jensen         return 0;
79615029de44SKlaus Jensen     }
79625029de44SKlaus Jensen 
796348b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !nvme_sctrl(n)->scs &&
796411871f53SŁukasz Gieryk         addr != NVME_REG_CSTS) {
796511871f53SŁukasz Gieryk         trace_pci_nvme_err_ignored_mmio_vf_offline(addr, size);
796611871f53SŁukasz Gieryk         return 0;
796711871f53SŁukasz Gieryk     }
796811871f53SŁukasz Gieryk 
796988eea45cSKlaus Jensen     /*
797088eea45cSKlaus Jensen      * When PMRWBM bit 1 is set then read from
797188eea45cSKlaus Jensen      * from PMRSTS should ensure prior writes
797288eea45cSKlaus Jensen      * made it to persistent media
797388eea45cSKlaus Jensen      */
7974a316aa50SKlaus Jensen     if (addr == NVME_REG_PMRSTS &&
797549e03457SKlaus Jensen         (NVME_PMRCAP_PMRWBM(ldl_le_p(&n->bar.pmrcap)) & 0x02)) {
797688eea45cSKlaus Jensen         memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
797788eea45cSKlaus Jensen     }
79785029de44SKlaus Jensen 
797949e03457SKlaus Jensen     return ldn_le_p(ptr + addr, size);
798088eea45cSKlaus Jensen }
798188eea45cSKlaus Jensen 
nvme_process_db(NvmeCtrl * n,hwaddr addr,int val)798288eea45cSKlaus Jensen static void nvme_process_db(NvmeCtrl *n, hwaddr addr, int val)
798388eea45cSKlaus Jensen {
798448b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
7985c1e244b6SKlaus Jensen     uint32_t qid;
798688eea45cSKlaus Jensen 
798788eea45cSKlaus Jensen     if (unlikely(addr & ((1 << 2) - 1))) {
798888eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_db_wr_misaligned,
798988eea45cSKlaus Jensen                        "doorbell write not 32-bit aligned,"
799088eea45cSKlaus Jensen                        " offset=0x%"PRIx64", ignoring", addr);
799188eea45cSKlaus Jensen         return;
799288eea45cSKlaus Jensen     }
799388eea45cSKlaus Jensen 
799488eea45cSKlaus Jensen     if (((addr - 0x1000) >> 2) & 1) {
799588eea45cSKlaus Jensen         /* Completion queue doorbell write */
799688eea45cSKlaus Jensen 
799788eea45cSKlaus Jensen         uint16_t new_head = val & 0xffff;
799888eea45cSKlaus Jensen         NvmeCQueue *cq;
799988eea45cSKlaus Jensen 
800088eea45cSKlaus Jensen         qid = (addr - (0x1000 + (1 << 2))) >> 3;
800188eea45cSKlaus Jensen         if (unlikely(nvme_check_cqid(n, qid))) {
800288eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cq,
800388eea45cSKlaus Jensen                            "completion queue doorbell write"
800488eea45cSKlaus Jensen                            " for nonexistent queue,"
800588eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
800688eea45cSKlaus Jensen 
800788eea45cSKlaus Jensen             /*
800888eea45cSKlaus Jensen              * NVM Express v1.3d, Section 4.1 state: "If host software writes
800988eea45cSKlaus Jensen              * an invalid value to the Submission Queue Tail Doorbell or
80109b4b4e51SMichael Tokarev              * Completion Queue Head Doorbell register and an Asynchronous Event
801188eea45cSKlaus Jensen              * Request command is outstanding, then an asynchronous event is
801288eea45cSKlaus Jensen              * posted to the Admin Completion Queue with a status code of
801388eea45cSKlaus Jensen              * Invalid Doorbell Write Value."
801488eea45cSKlaus Jensen              *
801588eea45cSKlaus Jensen              * Also note that the spec includes the "Invalid Doorbell Register"
801688eea45cSKlaus Jensen              * status code, but nowhere does it specify when to use it.
801788eea45cSKlaus Jensen              * However, it seems reasonable to use it here in a similar
801888eea45cSKlaus Jensen              * fashion.
801988eea45cSKlaus Jensen              */
802088eea45cSKlaus Jensen             if (n->outstanding_aers) {
802188eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
802288eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
802388eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
802488eea45cSKlaus Jensen             }
802588eea45cSKlaus Jensen 
802688eea45cSKlaus Jensen             return;
802788eea45cSKlaus Jensen         }
802888eea45cSKlaus Jensen 
802988eea45cSKlaus Jensen         cq = n->cq[qid];
803088eea45cSKlaus Jensen         if (unlikely(new_head >= cq->size)) {
803188eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cqhead,
803288eea45cSKlaus Jensen                            "completion queue doorbell write value"
803388eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
803488eea45cSKlaus Jensen                            " new_head=%"PRIu16", ignoring",
803588eea45cSKlaus Jensen                            qid, new_head);
803688eea45cSKlaus Jensen 
803788eea45cSKlaus Jensen             if (n->outstanding_aers) {
803888eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
803988eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
804088eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
804188eea45cSKlaus Jensen             }
804288eea45cSKlaus Jensen 
804388eea45cSKlaus Jensen             return;
804488eea45cSKlaus Jensen         }
804588eea45cSKlaus Jensen 
804688eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_cq(cq->cqid, new_head);
804788eea45cSKlaus Jensen 
80489529aa6bSKlaus Jensen         /* scheduled deferred cqe posting if queue was previously full */
80499529aa6bSKlaus Jensen         if (nvme_cq_full(cq)) {
80509529aa6bSKlaus Jensen             qemu_bh_schedule(cq->bh);
80519529aa6bSKlaus Jensen         }
80529529aa6bSKlaus Jensen 
805388eea45cSKlaus Jensen         cq->head = new_head;
80543f7fe8deSJinhao Fan         if (!qid && n->dbbuf_enabled) {
8055c1e244b6SKlaus Jensen             stl_le_pci_dma(pci, cq->db_addr, cq->head, MEMTXATTRS_UNSPECIFIED);
80563f7fe8deSJinhao Fan         }
805788eea45cSKlaus Jensen 
805888eea45cSKlaus Jensen         if (cq->tail == cq->head) {
805983d7ed5cSKlaus Jensen             if (cq->irq_enabled) {
806083d7ed5cSKlaus Jensen                 n->cq_pending--;
806183d7ed5cSKlaus Jensen             }
806283d7ed5cSKlaus Jensen 
806388eea45cSKlaus Jensen             nvme_irq_deassert(n, cq);
806488eea45cSKlaus Jensen         }
806588eea45cSKlaus Jensen     } else {
806688eea45cSKlaus Jensen         /* Submission queue doorbell write */
806788eea45cSKlaus Jensen 
806888eea45cSKlaus Jensen         uint16_t new_tail = val & 0xffff;
806988eea45cSKlaus Jensen         NvmeSQueue *sq;
807088eea45cSKlaus Jensen 
807188eea45cSKlaus Jensen         qid = (addr - 0x1000) >> 3;
807288eea45cSKlaus Jensen         if (unlikely(nvme_check_sqid(n, qid))) {
807388eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sq,
807488eea45cSKlaus Jensen                            "submission queue doorbell write"
807588eea45cSKlaus Jensen                            " for nonexistent queue,"
807688eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
807788eea45cSKlaus Jensen 
807888eea45cSKlaus Jensen             if (n->outstanding_aers) {
807988eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
808088eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
808188eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
808288eea45cSKlaus Jensen             }
808388eea45cSKlaus Jensen 
808488eea45cSKlaus Jensen             return;
808588eea45cSKlaus Jensen         }
808688eea45cSKlaus Jensen 
808788eea45cSKlaus Jensen         sq = n->sq[qid];
808888eea45cSKlaus Jensen         if (unlikely(new_tail >= sq->size)) {
808988eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sqtail,
809088eea45cSKlaus Jensen                            "submission queue doorbell write value"
809188eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
809288eea45cSKlaus Jensen                            " new_tail=%"PRIu16", ignoring",
809388eea45cSKlaus Jensen                            qid, new_tail);
809488eea45cSKlaus Jensen 
809588eea45cSKlaus Jensen             if (n->outstanding_aers) {
809688eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
809788eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
809888eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
809988eea45cSKlaus Jensen             }
810088eea45cSKlaus Jensen 
810188eea45cSKlaus Jensen             return;
810288eea45cSKlaus Jensen         }
810388eea45cSKlaus Jensen 
810488eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_sq(sq->sqid, new_tail);
810588eea45cSKlaus Jensen 
810688eea45cSKlaus Jensen         sq->tail = new_tail;
81073f7fe8deSJinhao Fan         if (!qid && n->dbbuf_enabled) {
81083f7fe8deSJinhao Fan             /*
81093f7fe8deSJinhao Fan              * The spec states "the host shall also update the controller's
81103f7fe8deSJinhao Fan              * corresponding doorbell property to match the value of that entry
81113f7fe8deSJinhao Fan              * in the Shadow Doorbell buffer."
81123f7fe8deSJinhao Fan              *
81133f7fe8deSJinhao Fan              * Since this context is currently a VM trap, we can safely enforce
81143f7fe8deSJinhao Fan              * the requirement from the device side in case the host is
81153f7fe8deSJinhao Fan              * misbehaving.
81163f7fe8deSJinhao Fan              *
81173f7fe8deSJinhao Fan              * Note, we shouldn't have to do this, but various drivers
81183f7fe8deSJinhao Fan              * including ones that run on Linux, are not updating Admin Queues,
81193f7fe8deSJinhao Fan              * so we can't trust reading it for an appropriate sq tail.
81203f7fe8deSJinhao Fan              */
8121c1e244b6SKlaus Jensen             stl_le_pci_dma(pci, sq->db_addr, sq->tail, MEMTXATTRS_UNSPECIFIED);
81223f7fe8deSJinhao Fan         }
8123d38cc6fdSKlaus Jensen 
8124d38cc6fdSKlaus Jensen         qemu_bh_schedule(sq->bh);
812588eea45cSKlaus Jensen     }
812688eea45cSKlaus Jensen }
812788eea45cSKlaus Jensen 
nvme_mmio_write(void * opaque,hwaddr addr,uint64_t data,unsigned size)812888eea45cSKlaus Jensen static void nvme_mmio_write(void *opaque, hwaddr addr, uint64_t data,
812988eea45cSKlaus Jensen                             unsigned size)
813088eea45cSKlaus Jensen {
813188eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
813288eea45cSKlaus Jensen 
813388eea45cSKlaus Jensen     trace_pci_nvme_mmio_write(addr, data, size);
813488eea45cSKlaus Jensen 
813548b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !nvme_sctrl(n)->scs &&
813611871f53SŁukasz Gieryk         addr != NVME_REG_CSTS) {
813711871f53SŁukasz Gieryk         trace_pci_nvme_err_ignored_mmio_vf_offline(addr, size);
813811871f53SŁukasz Gieryk         return;
813911871f53SŁukasz Gieryk     }
814011871f53SŁukasz Gieryk 
814188eea45cSKlaus Jensen     if (addr < sizeof(n->bar)) {
814288eea45cSKlaus Jensen         nvme_write_bar(n, addr, data, size);
814388eea45cSKlaus Jensen     } else {
814488eea45cSKlaus Jensen         nvme_process_db(n, addr, data);
814588eea45cSKlaus Jensen     }
814688eea45cSKlaus Jensen }
814788eea45cSKlaus Jensen 
814888eea45cSKlaus Jensen static const MemoryRegionOps nvme_mmio_ops = {
814988eea45cSKlaus Jensen     .read = nvme_mmio_read,
815088eea45cSKlaus Jensen     .write = nvme_mmio_write,
815188eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
815288eea45cSKlaus Jensen     .impl = {
815388eea45cSKlaus Jensen         .min_access_size = 2,
815488eea45cSKlaus Jensen         .max_access_size = 8,
815588eea45cSKlaus Jensen     },
815688eea45cSKlaus Jensen };
815788eea45cSKlaus Jensen 
nvme_cmb_write(void * opaque,hwaddr addr,uint64_t data,unsigned size)815888eea45cSKlaus Jensen static void nvme_cmb_write(void *opaque, hwaddr addr, uint64_t data,
815988eea45cSKlaus Jensen                            unsigned size)
816088eea45cSKlaus Jensen {
816188eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
816288eea45cSKlaus Jensen     stn_le_p(&n->cmb.buf[addr], size, data);
816388eea45cSKlaus Jensen }
816488eea45cSKlaus Jensen 
nvme_cmb_read(void * opaque,hwaddr addr,unsigned size)816588eea45cSKlaus Jensen static uint64_t nvme_cmb_read(void *opaque, hwaddr addr, unsigned size)
816688eea45cSKlaus Jensen {
816788eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
816888eea45cSKlaus Jensen     return ldn_le_p(&n->cmb.buf[addr], size);
816988eea45cSKlaus Jensen }
817088eea45cSKlaus Jensen 
817188eea45cSKlaus Jensen static const MemoryRegionOps nvme_cmb_ops = {
817288eea45cSKlaus Jensen     .read = nvme_cmb_read,
817388eea45cSKlaus Jensen     .write = nvme_cmb_write,
817488eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
817588eea45cSKlaus Jensen     .impl = {
817688eea45cSKlaus Jensen         .min_access_size = 1,
817788eea45cSKlaus Jensen         .max_access_size = 8,
817888eea45cSKlaus Jensen     },
817988eea45cSKlaus Jensen };
818088eea45cSKlaus Jensen 
nvme_check_params(NvmeCtrl * n,Error ** errp)8181784fd353SKlaus Jensen static bool nvme_check_params(NvmeCtrl *n, Error **errp)
818288eea45cSKlaus Jensen {
818388eea45cSKlaus Jensen     NvmeParams *params = &n->params;
818488eea45cSKlaus Jensen 
818588eea45cSKlaus Jensen     if (params->num_queues) {
818688eea45cSKlaus Jensen         warn_report("num_queues is deprecated; please use max_ioqpairs "
818788eea45cSKlaus Jensen                     "instead");
818888eea45cSKlaus Jensen 
818988eea45cSKlaus Jensen         params->max_ioqpairs = params->num_queues - 1;
819088eea45cSKlaus Jensen     }
819188eea45cSKlaus Jensen 
819288eea45cSKlaus Jensen     if (n->namespace.blkconf.blk && n->subsys) {
819388eea45cSKlaus Jensen         error_setg(errp, "subsystem support is unavailable with legacy "
819488eea45cSKlaus Jensen                    "namespace ('drive' property)");
8195784fd353SKlaus Jensen         return false;
819688eea45cSKlaus Jensen     }
819788eea45cSKlaus Jensen 
819888eea45cSKlaus Jensen     if (params->max_ioqpairs < 1 ||
819988eea45cSKlaus Jensen         params->max_ioqpairs > NVME_MAX_IOQPAIRS) {
820088eea45cSKlaus Jensen         error_setg(errp, "max_ioqpairs must be between 1 and %d",
820188eea45cSKlaus Jensen                    NVME_MAX_IOQPAIRS);
8202784fd353SKlaus Jensen         return false;
820388eea45cSKlaus Jensen     }
820488eea45cSKlaus Jensen 
820588eea45cSKlaus Jensen     if (params->msix_qsize < 1 ||
820688eea45cSKlaus Jensen         params->msix_qsize > PCI_MSIX_FLAGS_QSIZE + 1) {
820788eea45cSKlaus Jensen         error_setg(errp, "msix_qsize must be between 1 and %d",
820888eea45cSKlaus Jensen                    PCI_MSIX_FLAGS_QSIZE + 1);
8209784fd353SKlaus Jensen         return false;
821088eea45cSKlaus Jensen     }
821188eea45cSKlaus Jensen 
821288eea45cSKlaus Jensen     if (!params->serial) {
821388eea45cSKlaus Jensen         error_setg(errp, "serial property not set");
8214784fd353SKlaus Jensen         return false;
821588eea45cSKlaus Jensen     }
821688eea45cSKlaus Jensen 
8217bc432bc5SJohn Berg     if (params->mqes < 1) {
8218bc432bc5SJohn Berg         error_setg(errp, "mqes property cannot be less than 1");
8219bc432bc5SJohn Berg         return false;
8220bc432bc5SJohn Berg     }
8221bc432bc5SJohn Berg 
822288eea45cSKlaus Jensen     if (n->pmr.dev) {
8223fa905f65SKlaus Jensen         if (params->msix_exclusive_bar) {
8224fa905f65SKlaus Jensen             error_setg(errp, "not enough BARs available to enable PMR");
8225fa905f65SKlaus Jensen             return false;
8226fa905f65SKlaus Jensen         }
8227fa905f65SKlaus Jensen 
822888eea45cSKlaus Jensen         if (host_memory_backend_is_mapped(n->pmr.dev)) {
822988eea45cSKlaus Jensen             error_setg(errp, "can't use already busy memdev: %s",
823088eea45cSKlaus Jensen                        object_get_canonical_path_component(OBJECT(n->pmr.dev)));
8231784fd353SKlaus Jensen             return false;
823288eea45cSKlaus Jensen         }
823388eea45cSKlaus Jensen 
823488eea45cSKlaus Jensen         if (!is_power_of_2(n->pmr.dev->size)) {
823588eea45cSKlaus Jensen             error_setg(errp, "pmr backend size needs to be power of 2 in size");
8236784fd353SKlaus Jensen             return false;
823788eea45cSKlaus Jensen         }
823888eea45cSKlaus Jensen 
823988eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, true);
824088eea45cSKlaus Jensen     }
824188eea45cSKlaus Jensen 
824288eea45cSKlaus Jensen     if (n->params.zasl > n->params.mdts) {
824388eea45cSKlaus Jensen         error_setg(errp, "zoned.zasl (Zone Append Size Limit) must be less "
824488eea45cSKlaus Jensen                    "than or equal to mdts (Maximum Data Transfer Size)");
8245784fd353SKlaus Jensen         return false;
824688eea45cSKlaus Jensen     }
824788eea45cSKlaus Jensen 
824888eea45cSKlaus Jensen     if (!n->params.vsl) {
824988eea45cSKlaus Jensen         error_setg(errp, "vsl must be non-zero");
8250784fd353SKlaus Jensen         return false;
825188eea45cSKlaus Jensen     }
825244c2c094SLukasz Maniak 
825344c2c094SLukasz Maniak     if (params->sriov_max_vfs) {
825444c2c094SLukasz Maniak         if (!n->subsys) {
825544c2c094SLukasz Maniak             error_setg(errp, "subsystem is required for the use of SR-IOV");
8256784fd353SKlaus Jensen             return false;
825744c2c094SLukasz Maniak         }
825844c2c094SLukasz Maniak 
825944c2c094SLukasz Maniak         if (params->cmb_size_mb) {
826044c2c094SLukasz Maniak             error_setg(errp, "CMB is not supported with SR-IOV");
8261784fd353SKlaus Jensen             return false;
826244c2c094SLukasz Maniak         }
826344c2c094SLukasz Maniak 
826444c2c094SLukasz Maniak         if (n->pmr.dev) {
826544c2c094SLukasz Maniak             error_setg(errp, "PMR is not supported with SR-IOV");
8266784fd353SKlaus Jensen             return false;
826744c2c094SLukasz Maniak         }
8268746d42b1SŁukasz Gieryk 
8269746d42b1SŁukasz Gieryk         if (!params->sriov_vq_flexible || !params->sriov_vi_flexible) {
8270746d42b1SŁukasz Gieryk             error_setg(errp, "both sriov_vq_flexible and sriov_vi_flexible"
8271746d42b1SŁukasz Gieryk                        " must be set for the use of SR-IOV");
8272784fd353SKlaus Jensen             return false;
8273746d42b1SŁukasz Gieryk         }
8274746d42b1SŁukasz Gieryk 
8275746d42b1SŁukasz Gieryk         if (params->sriov_vq_flexible < params->sriov_max_vfs * 2) {
8276746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_vq_flexible must be greater than or equal"
8277746d42b1SŁukasz Gieryk                        " to %d (sriov_max_vfs * 2)", params->sriov_max_vfs * 2);
8278784fd353SKlaus Jensen             return false;
8279746d42b1SŁukasz Gieryk         }
8280746d42b1SŁukasz Gieryk 
8281746d42b1SŁukasz Gieryk         if (params->max_ioqpairs < params->sriov_vq_flexible + 2) {
8282746d42b1SŁukasz Gieryk             error_setg(errp, "(max_ioqpairs - sriov_vq_flexible) must be"
8283746d42b1SŁukasz Gieryk                        " greater than or equal to 2");
8284784fd353SKlaus Jensen             return false;
8285746d42b1SŁukasz Gieryk         }
8286746d42b1SŁukasz Gieryk 
8287746d42b1SŁukasz Gieryk         if (params->sriov_vi_flexible < params->sriov_max_vfs) {
8288746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_vi_flexible must be greater than or equal"
8289746d42b1SŁukasz Gieryk                        " to %d (sriov_max_vfs)", params->sriov_max_vfs);
8290784fd353SKlaus Jensen             return false;
8291746d42b1SŁukasz Gieryk         }
8292746d42b1SŁukasz Gieryk 
8293746d42b1SŁukasz Gieryk         if (params->msix_qsize < params->sriov_vi_flexible + 1) {
8294746d42b1SŁukasz Gieryk             error_setg(errp, "(msix_qsize - sriov_vi_flexible) must be"
8295746d42b1SŁukasz Gieryk                        " greater than or equal to 1");
8296784fd353SKlaus Jensen             return false;
8297746d42b1SŁukasz Gieryk         }
8298746d42b1SŁukasz Gieryk 
8299746d42b1SŁukasz Gieryk         if (params->sriov_max_vi_per_vf &&
8300746d42b1SŁukasz Gieryk             (params->sriov_max_vi_per_vf - 1) % NVME_VF_RES_GRANULARITY) {
8301746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_max_vi_per_vf must meet:"
8302746d42b1SŁukasz Gieryk                        " (sriov_max_vi_per_vf - 1) %% %d == 0 and"
8303746d42b1SŁukasz Gieryk                        " sriov_max_vi_per_vf >= 1", NVME_VF_RES_GRANULARITY);
8304784fd353SKlaus Jensen             return false;
8305746d42b1SŁukasz Gieryk         }
8306746d42b1SŁukasz Gieryk 
8307746d42b1SŁukasz Gieryk         if (params->sriov_max_vq_per_vf &&
8308746d42b1SŁukasz Gieryk             (params->sriov_max_vq_per_vf < 2 ||
8309746d42b1SŁukasz Gieryk              (params->sriov_max_vq_per_vf - 1) % NVME_VF_RES_GRANULARITY)) {
8310746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_max_vq_per_vf must meet:"
8311746d42b1SŁukasz Gieryk                        " (sriov_max_vq_per_vf - 1) %% %d == 0 and"
8312746d42b1SŁukasz Gieryk                        " sriov_max_vq_per_vf >= 2", NVME_VF_RES_GRANULARITY);
8313784fd353SKlaus Jensen             return false;
8314746d42b1SŁukasz Gieryk         }
831544c2c094SLukasz Maniak     }
8316784fd353SKlaus Jensen 
8317784fd353SKlaus Jensen     return true;
831888eea45cSKlaus Jensen }
831988eea45cSKlaus Jensen 
nvme_init_state(NvmeCtrl * n)832088eea45cSKlaus Jensen static void nvme_init_state(NvmeCtrl *n)
832188eea45cSKlaus Jensen {
83225e6f963fSLukasz Maniak     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
83231a494d11SMinwoo Im     NvmeSecCtrlEntry *list = n->sec_ctrl_list;
832499f48ae7SLukasz Maniak     NvmeSecCtrlEntry *sctrl;
832548b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
8326ebd1568fSAlan Adamson     NvmeAtomic *atomic = &n->atomic;
8327ebd1568fSAlan Adamson     NvmeIdCtrl *id = &n->id_ctrl;
8328746d42b1SŁukasz Gieryk     uint8_t max_vfs;
832999f48ae7SLukasz Maniak     int i;
83305e6f963fSLukasz Maniak 
833148b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
8332746d42b1SŁukasz Gieryk         sctrl = nvme_sctrl(n);
8333746d42b1SŁukasz Gieryk         max_vfs = 0;
8334746d42b1SŁukasz Gieryk         n->conf_ioqpairs = sctrl->nvq ? le16_to_cpu(sctrl->nvq) - 1 : 0;
8335746d42b1SŁukasz Gieryk         n->conf_msix_qsize = sctrl->nvi ? le16_to_cpu(sctrl->nvi) : 1;
8336746d42b1SŁukasz Gieryk     } else {
8337746d42b1SŁukasz Gieryk         max_vfs = n->params.sriov_max_vfs;
8338decc0261SŁukasz Gieryk         n->conf_ioqpairs = n->params.max_ioqpairs;
8339decc0261SŁukasz Gieryk         n->conf_msix_qsize = n->params.msix_qsize;
8340746d42b1SŁukasz Gieryk     }
8341decc0261SŁukasz Gieryk 
834288eea45cSKlaus Jensen     n->sq = g_new0(NvmeSQueue *, n->params.max_ioqpairs + 1);
834388eea45cSKlaus Jensen     n->cq = g_new0(NvmeCQueue *, n->params.max_ioqpairs + 1);
834488eea45cSKlaus Jensen     n->temperature = NVME_TEMPERATURE;
834588eea45cSKlaus Jensen     n->features.temp_thresh_hi = NVME_TEMPERATURE_WARNING;
834688eea45cSKlaus Jensen     n->starttime_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
834788eea45cSKlaus Jensen     n->aer_reqs = g_new0(NvmeRequest *, n->params.aerl + 1);
8348b7698b91SŁukasz Gieryk     QTAILQ_INIT(&n->aer_queue);
83495e6f963fSLukasz Maniak 
83501a494d11SMinwoo Im     n->nr_sec_ctrls = max_vfs;
8351746d42b1SŁukasz Gieryk     for (i = 0; i < max_vfs; i++) {
83521a494d11SMinwoo Im         sctrl = &list[i];
835399f48ae7SLukasz Maniak         sctrl->pcid = cpu_to_le16(n->cntlid);
835499f48ae7SLukasz Maniak         sctrl->vfn = cpu_to_le16(i + 1);
835599f48ae7SLukasz Maniak     }
835699f48ae7SLukasz Maniak 
83575e6f963fSLukasz Maniak     cap->cntlid = cpu_to_le16(n->cntlid);
8358746d42b1SŁukasz Gieryk     cap->crt = NVME_CRT_VQ | NVME_CRT_VI;
8359746d42b1SŁukasz Gieryk 
836048b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
8361746d42b1SŁukasz Gieryk         cap->vqprt = cpu_to_le16(1 + n->conf_ioqpairs);
8362746d42b1SŁukasz Gieryk     } else {
8363746d42b1SŁukasz Gieryk         cap->vqprt = cpu_to_le16(1 + n->params.max_ioqpairs -
8364746d42b1SŁukasz Gieryk                                  n->params.sriov_vq_flexible);
8365746d42b1SŁukasz Gieryk         cap->vqfrt = cpu_to_le32(n->params.sriov_vq_flexible);
8366746d42b1SŁukasz Gieryk         cap->vqrfap = cap->vqfrt;
8367746d42b1SŁukasz Gieryk         cap->vqgran = cpu_to_le16(NVME_VF_RES_GRANULARITY);
8368746d42b1SŁukasz Gieryk         cap->vqfrsm = n->params.sriov_max_vq_per_vf ?
8369746d42b1SŁukasz Gieryk                         cpu_to_le16(n->params.sriov_max_vq_per_vf) :
8370746d42b1SŁukasz Gieryk                         cap->vqfrt / MAX(max_vfs, 1);
8371746d42b1SŁukasz Gieryk     }
8372746d42b1SŁukasz Gieryk 
837348b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
8374746d42b1SŁukasz Gieryk         cap->viprt = cpu_to_le16(n->conf_msix_qsize);
8375746d42b1SŁukasz Gieryk     } else {
8376746d42b1SŁukasz Gieryk         cap->viprt = cpu_to_le16(n->params.msix_qsize -
8377746d42b1SŁukasz Gieryk                                  n->params.sriov_vi_flexible);
8378746d42b1SŁukasz Gieryk         cap->vifrt = cpu_to_le32(n->params.sriov_vi_flexible);
8379746d42b1SŁukasz Gieryk         cap->virfap = cap->vifrt;
8380746d42b1SŁukasz Gieryk         cap->vigran = cpu_to_le16(NVME_VF_RES_GRANULARITY);
8381746d42b1SŁukasz Gieryk         cap->vifrsm = n->params.sriov_max_vi_per_vf ?
8382746d42b1SŁukasz Gieryk                         cpu_to_le16(n->params.sriov_max_vi_per_vf) :
8383746d42b1SŁukasz Gieryk                         cap->vifrt / MAX(max_vfs, 1);
8384746d42b1SŁukasz Gieryk     }
8385ebd1568fSAlan Adamson 
8386ebd1568fSAlan Adamson     /* Atomic Write */
8387ebd1568fSAlan Adamson     id->awun = cpu_to_le16(n->params.atomic_awun);
8388ebd1568fSAlan Adamson     id->awupf = cpu_to_le16(n->params.atomic_awupf);
8389ebd1568fSAlan Adamson     n->dn = n->params.atomic_dn;
8390ebd1568fSAlan Adamson 
8391ebd1568fSAlan Adamson     if (id->awun || id->awupf) {
8392ebd1568fSAlan Adamson         if (id->awupf > id->awun) {
8393ebd1568fSAlan Adamson             id->awupf = 0;
8394ebd1568fSAlan Adamson         }
8395ebd1568fSAlan Adamson 
8396ebd1568fSAlan Adamson         if (n->dn) {
8397ebd1568fSAlan Adamson             atomic->atomic_max_write_size = id->awupf + 1;
8398ebd1568fSAlan Adamson         } else {
8399ebd1568fSAlan Adamson             atomic->atomic_max_write_size = id->awun + 1;
8400ebd1568fSAlan Adamson         }
8401ebd1568fSAlan Adamson 
8402ebd1568fSAlan Adamson         if (atomic->atomic_max_write_size == 1) {
8403ebd1568fSAlan Adamson             atomic->atomic_writes = 0;
8404ebd1568fSAlan Adamson         } else {
8405ebd1568fSAlan Adamson             atomic->atomic_writes = 1;
8406ebd1568fSAlan Adamson         }
8407ebd1568fSAlan Adamson     }
840888eea45cSKlaus Jensen }
840988eea45cSKlaus Jensen 
nvme_init_cmb(NvmeCtrl * n,PCIDevice * pci_dev)841088eea45cSKlaus Jensen static void nvme_init_cmb(NvmeCtrl *n, PCIDevice *pci_dev)
841188eea45cSKlaus Jensen {
841288eea45cSKlaus Jensen     uint64_t cmb_size = n->params.cmb_size_mb * MiB;
841349e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
841488eea45cSKlaus Jensen 
841588eea45cSKlaus Jensen     n->cmb.buf = g_malloc0(cmb_size);
841688eea45cSKlaus Jensen     memory_region_init_io(&n->cmb.mem, OBJECT(n), &nvme_cmb_ops, n,
841788eea45cSKlaus Jensen                           "nvme-cmb", cmb_size);
841888eea45cSKlaus Jensen     pci_register_bar(pci_dev, NVME_CMB_BIR,
841988eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
842088eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
842188eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->cmb.mem);
842288eea45cSKlaus Jensen 
842349e03457SKlaus Jensen     NVME_CAP_SET_CMBS(cap, 1);
842449e03457SKlaus Jensen     stq_le_p(&n->bar.cap, cap);
842588eea45cSKlaus Jensen 
842688eea45cSKlaus Jensen     if (n->params.legacy_cmb) {
842788eea45cSKlaus Jensen         nvme_cmb_enable_regs(n);
842888eea45cSKlaus Jensen         n->cmb.cmse = true;
842988eea45cSKlaus Jensen     }
843088eea45cSKlaus Jensen }
843188eea45cSKlaus Jensen 
nvme_init_pmr(NvmeCtrl * n,PCIDevice * pci_dev)843288eea45cSKlaus Jensen static void nvme_init_pmr(NvmeCtrl *n, PCIDevice *pci_dev)
843388eea45cSKlaus Jensen {
843449e03457SKlaus Jensen     uint32_t pmrcap = ldl_le_p(&n->bar.pmrcap);
843588eea45cSKlaus Jensen 
843649e03457SKlaus Jensen     NVME_PMRCAP_SET_RDS(pmrcap, 1);
843749e03457SKlaus Jensen     NVME_PMRCAP_SET_WDS(pmrcap, 1);
843849e03457SKlaus Jensen     NVME_PMRCAP_SET_BIR(pmrcap, NVME_PMR_BIR);
843949e03457SKlaus Jensen     /* Turn on bit 1 support */
844049e03457SKlaus Jensen     NVME_PMRCAP_SET_PMRWBM(pmrcap, 0x02);
844149e03457SKlaus Jensen     NVME_PMRCAP_SET_CMSS(pmrcap, 1);
844249e03457SKlaus Jensen     stl_le_p(&n->bar.pmrcap, pmrcap);
844349e03457SKlaus Jensen 
844449e03457SKlaus Jensen     pci_register_bar(pci_dev, NVME_PMR_BIR,
844588eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
844688eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
844788eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->pmr.dev->mr);
844888eea45cSKlaus Jensen 
844988eea45cSKlaus Jensen     memory_region_set_enabled(&n->pmr.dev->mr, false);
845088eea45cSKlaus Jensen }
845188eea45cSKlaus Jensen 
nvme_mbar_size(unsigned total_queues,unsigned total_irqs,unsigned * msix_table_offset,unsigned * msix_pba_offset)8452ee7bda4dSKlaus Jensen static uint64_t nvme_mbar_size(unsigned total_queues, unsigned total_irqs,
8453aa817713SŁukasz Gieryk                                unsigned *msix_table_offset,
8454aa817713SŁukasz Gieryk                                unsigned *msix_pba_offset)
8455aa817713SŁukasz Gieryk {
8456ee7bda4dSKlaus Jensen     uint64_t bar_size, msix_table_size;
8457aa817713SŁukasz Gieryk 
8458aa817713SŁukasz Gieryk     bar_size = sizeof(NvmeBar) + 2 * total_queues * NVME_DB_SIZE;
8459ee7bda4dSKlaus Jensen 
8460ee7bda4dSKlaus Jensen     if (total_irqs == 0) {
8461ee7bda4dSKlaus Jensen         goto out;
8462ee7bda4dSKlaus Jensen     }
8463ee7bda4dSKlaus Jensen 
8464aa817713SŁukasz Gieryk     bar_size = QEMU_ALIGN_UP(bar_size, 4 * KiB);
8465aa817713SŁukasz Gieryk 
8466aa817713SŁukasz Gieryk     if (msix_table_offset) {
8467aa817713SŁukasz Gieryk         *msix_table_offset = bar_size;
8468aa817713SŁukasz Gieryk     }
8469aa817713SŁukasz Gieryk 
8470aa817713SŁukasz Gieryk     msix_table_size = PCI_MSIX_ENTRY_SIZE * total_irqs;
8471aa817713SŁukasz Gieryk     bar_size += msix_table_size;
8472aa817713SŁukasz Gieryk     bar_size = QEMU_ALIGN_UP(bar_size, 4 * KiB);
8473aa817713SŁukasz Gieryk 
8474aa817713SŁukasz Gieryk     if (msix_pba_offset) {
8475aa817713SŁukasz Gieryk         *msix_pba_offset = bar_size;
8476aa817713SŁukasz Gieryk     }
8477aa817713SŁukasz Gieryk 
8478ee7bda4dSKlaus Jensen     bar_size += QEMU_ALIGN_UP(total_irqs, 64) / 8;
8479aa817713SŁukasz Gieryk 
8480ee7bda4dSKlaus Jensen out:
8481ee7bda4dSKlaus Jensen     return pow2ceil(bar_size);
8482aa817713SŁukasz Gieryk }
8483aa817713SŁukasz Gieryk 
nvme_init_sriov(NvmeCtrl * n,PCIDevice * pci_dev,uint16_t offset)848419c45c00SMichael S. Tsirkin static void nvme_init_sriov(NvmeCtrl *n, PCIDevice *pci_dev, uint16_t offset)
848544c2c094SLukasz Maniak {
848644c2c094SLukasz Maniak     uint16_t vf_dev_id = n->params.use_intel_id ?
848744c2c094SLukasz Maniak                          PCI_DEVICE_ID_INTEL_NVME : PCI_DEVICE_ID_REDHAT_NVME;
8488746d42b1SŁukasz Gieryk     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
8489ee7bda4dSKlaus Jensen     uint64_t bar_size = nvme_mbar_size(le16_to_cpu(cap->vqfrsm),
8490746d42b1SŁukasz Gieryk                                       le16_to_cpu(cap->vifrsm),
8491746d42b1SŁukasz Gieryk                                       NULL, NULL);
849244c2c094SLukasz Maniak 
849319c45c00SMichael S. Tsirkin     pcie_sriov_pf_init(pci_dev, offset, "nvme", vf_dev_id,
849444c2c094SLukasz Maniak                        n->params.sriov_max_vfs, n->params.sriov_max_vfs,
849519c45c00SMichael S. Tsirkin                        NVME_VF_OFFSET, NVME_VF_STRIDE);
849644c2c094SLukasz Maniak 
849744c2c094SLukasz Maniak     pcie_sriov_pf_init_vf_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
849844c2c094SLukasz Maniak                               PCI_BASE_ADDRESS_MEM_TYPE_64, bar_size);
849944c2c094SLukasz Maniak }
850044c2c094SLukasz Maniak 
nvme_add_pm_capability(PCIDevice * pci_dev,uint8_t offset)85011e9c685eSŁukasz Gieryk static int nvme_add_pm_capability(PCIDevice *pci_dev, uint8_t offset)
85021e9c685eSŁukasz Gieryk {
85031e9c685eSŁukasz Gieryk     Error *err = NULL;
85041e9c685eSŁukasz Gieryk     int ret;
85051e9c685eSŁukasz Gieryk 
85061e9c685eSŁukasz Gieryk     ret = pci_add_capability(pci_dev, PCI_CAP_ID_PM, offset,
85071e9c685eSŁukasz Gieryk                              PCI_PM_SIZEOF, &err);
85081e9c685eSŁukasz Gieryk     if (err) {
85091e9c685eSŁukasz Gieryk         error_report_err(err);
85101e9c685eSŁukasz Gieryk         return ret;
85111e9c685eSŁukasz Gieryk     }
85121e9c685eSŁukasz Gieryk 
85131e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->config + offset + PCI_PM_PMC,
85141e9c685eSŁukasz Gieryk                  PCI_PM_CAP_VER_1_2);
85151e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->config + offset + PCI_PM_CTRL,
85161e9c685eSŁukasz Gieryk                  PCI_PM_CTRL_NO_SOFT_RESET);
85171e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->wmask + offset + PCI_PM_CTRL,
85181e9c685eSŁukasz Gieryk                  PCI_PM_CTRL_STATE_MASK);
85191e9c685eSŁukasz Gieryk 
85201e9c685eSŁukasz Gieryk     return 0;
85211e9c685eSŁukasz Gieryk }
85221e9c685eSŁukasz Gieryk 
pcie_doe_spdm_rsp(DOECap * doe_cap)85234f947b10SWilfred Mallawa static bool pcie_doe_spdm_rsp(DOECap *doe_cap)
85244f947b10SWilfred Mallawa {
85254f947b10SWilfred Mallawa     void *req = pcie_doe_get_write_mbox_ptr(doe_cap);
85264f947b10SWilfred Mallawa     uint32_t req_len = pcie_doe_get_obj_len(req) * 4;
85274f947b10SWilfred Mallawa     void *rsp = doe_cap->read_mbox;
85284f947b10SWilfred Mallawa     uint32_t rsp_len = SPDM_SOCKET_MAX_MESSAGE_BUFFER_SIZE;
85294f947b10SWilfred Mallawa 
85304f947b10SWilfred Mallawa     uint32_t recvd = spdm_socket_rsp(doe_cap->spdm_socket,
85314f947b10SWilfred Mallawa                              SPDM_SOCKET_TRANSPORT_TYPE_PCI_DOE,
85324f947b10SWilfred Mallawa                              req, req_len, rsp, rsp_len);
85334f947b10SWilfred Mallawa     doe_cap->read_mbox_len += DIV_ROUND_UP(recvd, 4);
85344f947b10SWilfred Mallawa 
85354f947b10SWilfred Mallawa     return recvd != 0;
85364f947b10SWilfred Mallawa }
85374f947b10SWilfred Mallawa 
85384f947b10SWilfred Mallawa static DOEProtocol doe_spdm_prot[] = {
85394f947b10SWilfred Mallawa     { PCI_VENDOR_ID_PCI_SIG, PCI_SIG_DOE_CMA, pcie_doe_spdm_rsp },
85404f947b10SWilfred Mallawa     { PCI_VENDOR_ID_PCI_SIG, PCI_SIG_DOE_SECURED_CMA, pcie_doe_spdm_rsp },
85414f947b10SWilfred Mallawa     { }
85424f947b10SWilfred Mallawa };
85434f947b10SWilfred Mallawa 
nvme_init_pci(NvmeCtrl * n,PCIDevice * pci_dev,Error ** errp)8544973f76cfSKlaus Jensen static bool nvme_init_pci(NvmeCtrl *n, PCIDevice *pci_dev, Error **errp)
854588eea45cSKlaus Jensen {
8546973f76cfSKlaus Jensen     ERRP_GUARD();
854788eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
8548aa817713SŁukasz Gieryk     uint64_t bar_size;
8549ee7bda4dSKlaus Jensen     unsigned msix_table_offset = 0, msix_pba_offset = 0;
85508ab8a6dbSMinwoo Im     unsigned nr_vectors;
855188eea45cSKlaus Jensen     int ret;
855288eea45cSKlaus Jensen 
8553e8598778SKlaus Jensen     pci_conf[PCI_INTERRUPT_PIN] = pci_is_vf(pci_dev) ? 0 : 1;
855488eea45cSKlaus Jensen     pci_config_set_prog_interface(pci_conf, 0x2);
855588eea45cSKlaus Jensen 
855688eea45cSKlaus Jensen     if (n->params.use_intel_id) {
855788eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_INTEL);
855844c2c094SLukasz Maniak         pci_config_set_device_id(pci_conf, PCI_DEVICE_ID_INTEL_NVME);
855988eea45cSKlaus Jensen     } else {
856088eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_REDHAT);
856188eea45cSKlaus Jensen         pci_config_set_device_id(pci_conf, PCI_DEVICE_ID_REDHAT_NVME);
856288eea45cSKlaus Jensen     }
856388eea45cSKlaus Jensen 
856488eea45cSKlaus Jensen     pci_config_set_class(pci_conf, PCI_CLASS_STORAGE_EXPRESS);
85651e9c685eSŁukasz Gieryk     nvme_add_pm_capability(pci_dev, 0x60);
856688eea45cSKlaus Jensen     pcie_endpoint_cap_init(pci_dev, 0x80);
85671e9c685eSŁukasz Gieryk     pcie_cap_flr_init(pci_dev);
856844c2c094SLukasz Maniak     if (n->params.sriov_max_vfs) {
8569445416e3SAkihiko Odaki         pcie_ari_init(pci_dev, 0x100);
857044c2c094SLukasz Maniak     }
857188eea45cSKlaus Jensen 
8572fa905f65SKlaus Jensen     if (n->params.msix_exclusive_bar && !pci_is_vf(pci_dev)) {
8573fa905f65SKlaus Jensen         bar_size = nvme_mbar_size(n->params.max_ioqpairs + 1, 0, NULL, NULL);
8574fa905f65SKlaus Jensen         memory_region_init_io(&n->iomem, OBJECT(n), &nvme_mmio_ops, n, "nvme",
8575fa905f65SKlaus Jensen                               bar_size);
8576fa905f65SKlaus Jensen         pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
8577fa905f65SKlaus Jensen                          PCI_BASE_ADDRESS_MEM_TYPE_64, &n->iomem);
8578fa905f65SKlaus Jensen         ret = msix_init_exclusive_bar(pci_dev, n->params.msix_qsize, 4, errp);
8579fa905f65SKlaus Jensen     } else {
8580fa905f65SKlaus Jensen         assert(n->params.msix_qsize >= 1);
8581fa905f65SKlaus Jensen 
85823bfcc517SŁukasz Gieryk         /* add one to max_ioqpairs to account for the admin queue pair */
85838ab8a6dbSMinwoo Im         if (!pci_is_vf(pci_dev)) {
85848ab8a6dbSMinwoo Im             nr_vectors = n->params.msix_qsize;
8585fa905f65SKlaus Jensen             bar_size = nvme_mbar_size(n->params.max_ioqpairs + 1,
85868ab8a6dbSMinwoo Im                                       nr_vectors, &msix_table_offset,
8587fa905f65SKlaus Jensen                                       &msix_pba_offset);
85888ab8a6dbSMinwoo Im         } else {
85898ab8a6dbSMinwoo Im             NvmeCtrl *pn = NVME(pcie_sriov_get_pf(pci_dev));
85908ab8a6dbSMinwoo Im             NvmePriCtrlCap *cap = &pn->pri_ctrl_cap;
85918ab8a6dbSMinwoo Im 
85928ab8a6dbSMinwoo Im             nr_vectors = le16_to_cpu(cap->vifrsm);
85938ab8a6dbSMinwoo Im             bar_size = nvme_mbar_size(le16_to_cpu(cap->vqfrsm), nr_vectors,
85948ab8a6dbSMinwoo Im                                       &msix_table_offset, &msix_pba_offset);
85958ab8a6dbSMinwoo Im         }
859688eea45cSKlaus Jensen 
859788eea45cSKlaus Jensen         memory_region_init(&n->bar0, OBJECT(n), "nvme-bar0", bar_size);
859888eea45cSKlaus Jensen         memory_region_init_io(&n->iomem, OBJECT(n), &nvme_mmio_ops, n, "nvme",
85993bfcc517SŁukasz Gieryk                               msix_table_offset);
860088eea45cSKlaus Jensen         memory_region_add_subregion(&n->bar0, 0, &n->iomem);
860188eea45cSKlaus Jensen 
860244c2c094SLukasz Maniak         if (pci_is_vf(pci_dev)) {
860344c2c094SLukasz Maniak             pcie_sriov_vf_register_bar(pci_dev, 0, &n->bar0);
860444c2c094SLukasz Maniak         } else {
860588eea45cSKlaus Jensen             pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
860688eea45cSKlaus Jensen                              PCI_BASE_ADDRESS_MEM_TYPE_64, &n->bar0);
860744c2c094SLukasz Maniak         }
8608fa905f65SKlaus Jensen 
86098ab8a6dbSMinwoo Im         ret = msix_init(pci_dev, nr_vectors,
861088eea45cSKlaus Jensen                         &n->bar0, 0, msix_table_offset,
8611973f76cfSKlaus Jensen                         &n->bar0, 0, msix_pba_offset, 0, errp);
8612fa905f65SKlaus Jensen     }
8613fa905f65SKlaus Jensen 
861488eea45cSKlaus Jensen     if (ret == -ENOTSUP) {
8615973f76cfSKlaus Jensen         /* report that msix is not supported, but do not error out */
8616973f76cfSKlaus Jensen         warn_report_err(*errp);
8617973f76cfSKlaus Jensen         *errp = NULL;
8618973f76cfSKlaus Jensen     } else if (ret < 0) {
8619973f76cfSKlaus Jensen         /* propagate error to caller */
8620973f76cfSKlaus Jensen         return false;
862188eea45cSKlaus Jensen     }
862288eea45cSKlaus Jensen 
8623decc0261SŁukasz Gieryk     nvme_update_msixcap_ts(pci_dev, n->conf_msix_qsize);
8624decc0261SŁukasz Gieryk 
86254f947b10SWilfred Mallawa     pcie_cap_deverr_init(pci_dev);
86264f947b10SWilfred Mallawa 
86274f947b10SWilfred Mallawa     /* DOE Initialisation */
86284f947b10SWilfred Mallawa     if (pci_dev->spdm_port) {
86294f947b10SWilfred Mallawa         uint16_t doe_offset = n->params.sriov_max_vfs ?
86304f947b10SWilfred Mallawa                                   PCI_CONFIG_SPACE_SIZE + PCI_ARI_SIZEOF
86314f947b10SWilfred Mallawa                                   : PCI_CONFIG_SPACE_SIZE;
86324f947b10SWilfred Mallawa 
86334f947b10SWilfred Mallawa         pcie_doe_init(pci_dev, &pci_dev->doe_spdm, doe_offset,
86344f947b10SWilfred Mallawa                       doe_spdm_prot, true, 0);
86354f947b10SWilfred Mallawa 
86364f947b10SWilfred Mallawa         pci_dev->doe_spdm.spdm_socket = spdm_socket_connect(pci_dev->spdm_port,
86374f947b10SWilfred Mallawa                                                             errp);
86384f947b10SWilfred Mallawa 
86394f947b10SWilfred Mallawa         if (pci_dev->doe_spdm.spdm_socket < 0) {
86404f947b10SWilfred Mallawa             return false;
86414f947b10SWilfred Mallawa         }
86424f947b10SWilfred Mallawa     }
86434f947b10SWilfred Mallawa 
864488eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
864588eea45cSKlaus Jensen         nvme_init_cmb(n, pci_dev);
864688eea45cSKlaus Jensen     }
864788eea45cSKlaus Jensen 
864888eea45cSKlaus Jensen     if (n->pmr.dev) {
864988eea45cSKlaus Jensen         nvme_init_pmr(n, pci_dev);
865088eea45cSKlaus Jensen     }
865188eea45cSKlaus Jensen 
865219c45c00SMichael S. Tsirkin     if (!pci_is_vf(pci_dev) && n->params.sriov_max_vfs) {
865319c45c00SMichael S. Tsirkin         nvme_init_sriov(n, pci_dev, 0x120);
865419c45c00SMichael S. Tsirkin     }
865519c45c00SMichael S. Tsirkin 
8656973f76cfSKlaus Jensen     return true;
865788eea45cSKlaus Jensen }
865888eea45cSKlaus Jensen 
nvme_init_subnqn(NvmeCtrl * n)865988eea45cSKlaus Jensen static void nvme_init_subnqn(NvmeCtrl *n)
866088eea45cSKlaus Jensen {
866188eea45cSKlaus Jensen     NvmeSubsystem *subsys = n->subsys;
866288eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
866388eea45cSKlaus Jensen 
866488eea45cSKlaus Jensen     if (!subsys) {
866588eea45cSKlaus Jensen         snprintf((char *)id->subnqn, sizeof(id->subnqn),
866688eea45cSKlaus Jensen                  "nqn.2019-08.org.qemu:%s", n->params.serial);
866788eea45cSKlaus Jensen     } else {
866888eea45cSKlaus Jensen         pstrcpy((char *)id->subnqn, sizeof(id->subnqn), (char*)subsys->subnqn);
866988eea45cSKlaus Jensen     }
867088eea45cSKlaus Jensen }
867188eea45cSKlaus Jensen 
nvme_init_ctrl(NvmeCtrl * n,PCIDevice * pci_dev)867288eea45cSKlaus Jensen static void nvme_init_ctrl(NvmeCtrl *n, PCIDevice *pci_dev)
867388eea45cSKlaus Jensen {
867488eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
867588eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
867649e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
8677746d42b1SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl = nvme_sctrl(n);
8678771dbc3aSKlaus Jensen     uint32_t ctratt;
867988eea45cSKlaus Jensen 
868088eea45cSKlaus Jensen     id->vid = cpu_to_le16(pci_get_word(pci_conf + PCI_VENDOR_ID));
868188eea45cSKlaus Jensen     id->ssvid = cpu_to_le16(pci_get_word(pci_conf + PCI_SUBSYSTEM_VENDOR_ID));
868288eea45cSKlaus Jensen     strpadcpy((char *)id->mn, sizeof(id->mn), "QEMU NVMe Ctrl", ' ');
8683fbba243bSKlaus Jensen     strpadcpy((char *)id->fr, sizeof(id->fr), QEMU_VERSION, ' ');
868488eea45cSKlaus Jensen     strpadcpy((char *)id->sn, sizeof(id->sn), n->params.serial, ' ');
868588eea45cSKlaus Jensen 
868688eea45cSKlaus Jensen     id->cntlid = cpu_to_le16(n->cntlid);
868788eea45cSKlaus Jensen 
868888eea45cSKlaus Jensen     id->oaes = cpu_to_le32(NVME_OAES_NS_ATTR);
8689e4bcb586SKlaus Jensen 
8690e4bcb586SKlaus Jensen     ctratt = NVME_CTRATT_ELBAS;
8691e4bcb586SKlaus Jensen     if (n->params.ctratt.mem) {
8692e4bcb586SKlaus Jensen         ctratt |= NVME_CTRATT_MEM;
8693e4bcb586SKlaus Jensen     }
869488eea45cSKlaus Jensen 
869588eea45cSKlaus Jensen     id->rab = 6;
869688eea45cSKlaus Jensen 
869788eea45cSKlaus Jensen     if (n->params.use_intel_id) {
869888eea45cSKlaus Jensen         id->ieee[0] = 0xb3;
869988eea45cSKlaus Jensen         id->ieee[1] = 0x02;
870088eea45cSKlaus Jensen         id->ieee[2] = 0x00;
870188eea45cSKlaus Jensen     } else {
870288eea45cSKlaus Jensen         id->ieee[0] = 0x00;
870388eea45cSKlaus Jensen         id->ieee[1] = 0x54;
870488eea45cSKlaus Jensen         id->ieee[2] = 0x52;
870588eea45cSKlaus Jensen     }
870688eea45cSKlaus Jensen 
870788eea45cSKlaus Jensen     id->mdts = n->params.mdts;
870888eea45cSKlaus Jensen     id->ver = cpu_to_le32(NVME_SPEC_VER);
87093f7fe8deSJinhao Fan     id->oacs =
8710e181d3daSGollu Appalanaidu         cpu_to_le16(NVME_OACS_NS_MGMT | NVME_OACS_FORMAT | NVME_OACS_DBBUF |
8711e181d3daSGollu Appalanaidu                     NVME_OACS_DIRECTIVES);
871288eea45cSKlaus Jensen     id->cntrltype = 0x1;
871388eea45cSKlaus Jensen 
871488eea45cSKlaus Jensen     /*
871588eea45cSKlaus Jensen      * Because the controller always completes the Abort command immediately,
871688eea45cSKlaus Jensen      * there can never be more than one concurrently executing Abort command,
871788eea45cSKlaus Jensen      * so this value is never used for anything. Note that there can easily be
871888eea45cSKlaus Jensen      * many Abort commands in the queues, but they are not considered
871988eea45cSKlaus Jensen      * "executing" until processed by nvme_abort.
872088eea45cSKlaus Jensen      *
872188eea45cSKlaus Jensen      * The specification recommends a value of 3 for Abort Command Limit (four
872288eea45cSKlaus Jensen      * concurrently outstanding Abort commands), so lets use that though it is
872388eea45cSKlaus Jensen      * inconsequential.
872488eea45cSKlaus Jensen      */
872588eea45cSKlaus Jensen     id->acl = 3;
872688eea45cSKlaus Jensen     id->aerl = n->params.aerl;
872788eea45cSKlaus Jensen     id->frmw = (NVME_NUM_FW_SLOTS << 1) | NVME_FRMW_SLOT1_RO;
872888eea45cSKlaus Jensen     id->lpa = NVME_LPA_NS_SMART | NVME_LPA_CSE | NVME_LPA_EXTENDED;
872988eea45cSKlaus Jensen 
873088eea45cSKlaus Jensen     /* recommended default value (~70 C) */
873188eea45cSKlaus Jensen     id->wctemp = cpu_to_le16(NVME_TEMPERATURE_WARNING);
873288eea45cSKlaus Jensen     id->cctemp = cpu_to_le16(NVME_TEMPERATURE_CRITICAL);
873388eea45cSKlaus Jensen 
87346a33f2e9SKlaus Jensen     id->sqes = (NVME_SQES << 4) | NVME_SQES;
87356a33f2e9SKlaus Jensen     id->cqes = (NVME_CQES << 4) | NVME_CQES;
873688eea45cSKlaus Jensen     id->nn = cpu_to_le32(NVME_MAX_NAMESPACES);
873788eea45cSKlaus Jensen     id->oncs = cpu_to_le16(NVME_ONCS_WRITE_ZEROES | NVME_ONCS_TIMESTAMP |
873888eea45cSKlaus Jensen                            NVME_ONCS_FEATURES | NVME_ONCS_DSM |
8739d522aef8SArun Kumar                            NVME_ONCS_COMPARE | NVME_ONCS_COPY |
8740d522aef8SArun Kumar                            NVME_ONCS_NVMCSA | NVME_ONCS_NVMAFC);
874188eea45cSKlaus Jensen 
874288eea45cSKlaus Jensen     /*
874388eea45cSKlaus Jensen      * NOTE: If this device ever supports a command set that does NOT use 0x0
874488eea45cSKlaus Jensen      * as a Flush-equivalent operation, support for the broadcast NSID in Flush
874588eea45cSKlaus Jensen      * should probably be removed.
874688eea45cSKlaus Jensen      *
874788eea45cSKlaus Jensen      * See comment in nvme_io_cmd.
874888eea45cSKlaus Jensen      */
874988eea45cSKlaus Jensen     id->vwc = NVME_VWC_NSID_BROADCAST_SUPPORT | NVME_VWC_PRESENT;
875088eea45cSKlaus Jensen 
8751d522aef8SArun Kumar     id->ocfs = cpu_to_le16(NVME_OCFS_COPY_FORMAT_0 | NVME_OCFS_COPY_FORMAT_1 |
8752d522aef8SArun Kumar                             NVME_OCFS_COPY_FORMAT_2 | NVME_OCFS_COPY_FORMAT_3);
875378ca36dfSKeith Busch     id->sgls = cpu_to_le32(NVME_CTRL_SGLS_SUPPORT_NO_ALIGN |
875478ca36dfSKeith Busch                            NVME_CTRL_SGLS_MPTR_SGL);
875588eea45cSKlaus Jensen 
875688eea45cSKlaus Jensen     nvme_init_subnqn(n);
875788eea45cSKlaus Jensen 
875888eea45cSKlaus Jensen     id->psd[0].mp = cpu_to_le16(0x9c4);
875988eea45cSKlaus Jensen     id->psd[0].enlat = cpu_to_le32(0x10);
876088eea45cSKlaus Jensen     id->psd[0].exlat = cpu_to_le32(0x4);
876188eea45cSKlaus Jensen 
876288eea45cSKlaus Jensen     if (n->subsys) {
876388eea45cSKlaus Jensen         id->cmic |= NVME_CMIC_MULTI_CTRL;
8764771dbc3aSKlaus Jensen         ctratt |= NVME_CTRATT_ENDGRPS;
8765771dbc3aSKlaus Jensen 
8766771dbc3aSKlaus Jensen         id->endgidmax = cpu_to_le16(0x1);
876773064edfSJesper Devantier 
876873064edfSJesper Devantier         if (n->subsys->endgrp.fdp.enabled) {
876973064edfSJesper Devantier             ctratt |= NVME_CTRATT_FDPS;
877073064edfSJesper Devantier         }
877188eea45cSKlaus Jensen     }
877288eea45cSKlaus Jensen 
8773771dbc3aSKlaus Jensen     id->ctratt = cpu_to_le32(ctratt);
8774771dbc3aSKlaus Jensen 
8775bc432bc5SJohn Berg     NVME_CAP_SET_MQES(cap, n->params.mqes);
877649e03457SKlaus Jensen     NVME_CAP_SET_CQR(cap, 1);
877749e03457SKlaus Jensen     NVME_CAP_SET_TO(cap, 0xf);
877849e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_NVM);
877949e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_CSI_SUPP);
878049e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_ADMIN_ONLY);
878149e03457SKlaus Jensen     NVME_CAP_SET_MPSMAX(cap, 4);
878249e03457SKlaus Jensen     NVME_CAP_SET_CMBS(cap, n->params.cmb_size_mb ? 1 : 0);
878349e03457SKlaus Jensen     NVME_CAP_SET_PMRS(cap, n->pmr.dev ? 1 : 0);
878449e03457SKlaus Jensen     stq_le_p(&n->bar.cap, cap);
878588eea45cSKlaus Jensen 
878649e03457SKlaus Jensen     stl_le_p(&n->bar.vs, NVME_SPEC_VER);
878788eea45cSKlaus Jensen     n->bar.intmc = n->bar.intms = 0;
8788746d42b1SŁukasz Gieryk 
878948b32c28SKlaus Jensen     if (pci_is_vf(pci_dev) && !sctrl->scs) {
8790746d42b1SŁukasz Gieryk         stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
8791746d42b1SŁukasz Gieryk     }
879288eea45cSKlaus Jensen }
879388eea45cSKlaus Jensen 
nvme_init_subsys(NvmeCtrl * n,Error ** errp)879488eea45cSKlaus Jensen static int nvme_init_subsys(NvmeCtrl *n, Error **errp)
879588eea45cSKlaus Jensen {
879688eea45cSKlaus Jensen     int cntlid;
879788eea45cSKlaus Jensen 
879888eea45cSKlaus Jensen     if (!n->subsys) {
879988eea45cSKlaus Jensen         return 0;
880088eea45cSKlaus Jensen     }
880188eea45cSKlaus Jensen 
880288eea45cSKlaus Jensen     cntlid = nvme_subsys_register_ctrl(n, errp);
880388eea45cSKlaus Jensen     if (cntlid < 0) {
880488eea45cSKlaus Jensen         return -1;
880588eea45cSKlaus Jensen     }
880688eea45cSKlaus Jensen 
880788eea45cSKlaus Jensen     n->cntlid = cntlid;
880888eea45cSKlaus Jensen 
880988eea45cSKlaus Jensen     return 0;
881088eea45cSKlaus Jensen }
881188eea45cSKlaus Jensen 
nvme_attach_ns(NvmeCtrl * n,NvmeNamespace * ns)881288eea45cSKlaus Jensen void nvme_attach_ns(NvmeCtrl *n, NvmeNamespace *ns)
881388eea45cSKlaus Jensen {
881488eea45cSKlaus Jensen     uint32_t nsid = ns->params.nsid;
881588eea45cSKlaus Jensen     assert(nsid && nsid <= NVME_MAX_NAMESPACES);
881688eea45cSKlaus Jensen 
881788eea45cSKlaus Jensen     n->namespaces[nsid] = ns;
881888eea45cSKlaus Jensen     ns->attached++;
881988eea45cSKlaus Jensen 
882088eea45cSKlaus Jensen     n->dmrsl = MIN_NON_ZERO(n->dmrsl,
882188eea45cSKlaus Jensen                             BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
882288eea45cSKlaus Jensen }
882388eea45cSKlaus Jensen 
nvme_realize(PCIDevice * pci_dev,Error ** errp)882488eea45cSKlaus Jensen static void nvme_realize(PCIDevice *pci_dev, Error **errp)
882588eea45cSKlaus Jensen {
882688eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
882748b32c28SKlaus Jensen     DeviceState *dev = DEVICE(pci_dev);
882888eea45cSKlaus Jensen     NvmeNamespace *ns;
882944c2c094SLukasz Maniak     NvmeCtrl *pn = NVME(pcie_sriov_get_pf(pci_dev));
883044c2c094SLukasz Maniak 
883144c2c094SLukasz Maniak     if (pci_is_vf(pci_dev)) {
883244c2c094SLukasz Maniak         /*
883344c2c094SLukasz Maniak          * VFs derive settings from the parent. PF's lifespan exceeds
88344f0a4a3dSMinwoo Im          * that of VF's.
883544c2c094SLukasz Maniak          */
883644c2c094SLukasz Maniak         memcpy(&n->params, &pn->params, sizeof(NvmeParams));
88374f0a4a3dSMinwoo Im 
88384f0a4a3dSMinwoo Im         /*
88394f0a4a3dSMinwoo Im          * Set PF's serial value to a new string memory to prevent 'serial'
88404f0a4a3dSMinwoo Im          * property object release of PF when a VF is removed from the system.
88414f0a4a3dSMinwoo Im          */
88424f0a4a3dSMinwoo Im         n->params.serial = g_strdup(pn->params.serial);
884344c2c094SLukasz Maniak         n->subsys = pn->subsys;
8844*6651f8f2SKlaus Jensen 
8845*6651f8f2SKlaus Jensen         /*
8846*6651f8f2SKlaus Jensen          * Assigning this link (strong link) causes an `object_unref` later in
8847*6651f8f2SKlaus Jensen          * `object_release_link_property`. Increment the refcount to balance
8848*6651f8f2SKlaus Jensen          * this out.
8849*6651f8f2SKlaus Jensen          */
8850*6651f8f2SKlaus Jensen         object_ref(OBJECT(pn->subsys));
885144c2c094SLukasz Maniak     }
885288eea45cSKlaus Jensen 
8853784fd353SKlaus Jensen     if (!nvme_check_params(n, errp)) {
885488eea45cSKlaus Jensen         return;
885588eea45cSKlaus Jensen     }
885688eea45cSKlaus Jensen 
885748b32c28SKlaus Jensen     qbus_init(&n->bus, sizeof(NvmeBus), TYPE_NVME_BUS, dev, dev->id);
885888eea45cSKlaus Jensen 
885988eea45cSKlaus Jensen     if (nvme_init_subsys(n, errp)) {
886088eea45cSKlaus Jensen         return;
886188eea45cSKlaus Jensen     }
88625e6f963fSLukasz Maniak     nvme_init_state(n);
8863973f76cfSKlaus Jensen     if (!nvme_init_pci(n, pci_dev, errp)) {
88645e6f963fSLukasz Maniak         return;
88655e6f963fSLukasz Maniak     }
886688eea45cSKlaus Jensen     nvme_init_ctrl(n, pci_dev);
886788eea45cSKlaus Jensen 
886888eea45cSKlaus Jensen     /* setup a namespace if the controller drive property was given */
886988eea45cSKlaus Jensen     if (n->namespace.blkconf.blk) {
887088eea45cSKlaus Jensen         ns = &n->namespace;
887188eea45cSKlaus Jensen         ns->params.nsid = 1;
887288eea45cSKlaus Jensen 
88735e4f6bccSKlaus Jensen         if (nvme_ns_setup(ns, errp)) {
887488eea45cSKlaus Jensen             return;
887588eea45cSKlaus Jensen         }
887688eea45cSKlaus Jensen 
887788eea45cSKlaus Jensen         nvme_attach_ns(n, ns);
887888eea45cSKlaus Jensen     }
887988eea45cSKlaus Jensen }
888088eea45cSKlaus Jensen 
nvme_exit(PCIDevice * pci_dev)888188eea45cSKlaus Jensen static void nvme_exit(PCIDevice *pci_dev)
888288eea45cSKlaus Jensen {
888388eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
888488eea45cSKlaus Jensen     NvmeNamespace *ns;
888588eea45cSKlaus Jensen     int i;
888688eea45cSKlaus Jensen 
88871e9c685eSŁukasz Gieryk     nvme_ctrl_reset(n, NVME_RESET_FUNCTION);
888888eea45cSKlaus Jensen 
88895ffbaeedSKlaus Jensen     if (n->subsys) {
889088eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
889188eea45cSKlaus Jensen             ns = nvme_ns(n, i);
88925ffbaeedSKlaus Jensen             if (ns) {
88935ffbaeedSKlaus Jensen                 ns->attached--;
88945ffbaeedSKlaus Jensen             }
889588eea45cSKlaus Jensen         }
889688eea45cSKlaus Jensen 
8897b0fde9e8SKlaus Jensen         nvme_subsys_unregister_ctrl(n->subsys, n);
8898b0fde9e8SKlaus Jensen     }
8899b0fde9e8SKlaus Jensen 
890088eea45cSKlaus Jensen     g_free(n->cq);
890188eea45cSKlaus Jensen     g_free(n->sq);
890288eea45cSKlaus Jensen     g_free(n->aer_reqs);
890388eea45cSKlaus Jensen 
890488eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
890588eea45cSKlaus Jensen         g_free(n->cmb.buf);
890688eea45cSKlaus Jensen     }
890788eea45cSKlaus Jensen 
89084f947b10SWilfred Mallawa     if (pci_dev->doe_spdm.spdm_socket > 0) {
89094f947b10SWilfred Mallawa         spdm_socket_close(pci_dev->doe_spdm.spdm_socket,
89104f947b10SWilfred Mallawa                           SPDM_SOCKET_TRANSPORT_TYPE_PCI_DOE);
89114f947b10SWilfred Mallawa     }
89124f947b10SWilfred Mallawa 
891388eea45cSKlaus Jensen     if (n->pmr.dev) {
891488eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, false);
891588eea45cSKlaus Jensen     }
891644c2c094SLukasz Maniak 
891744c2c094SLukasz Maniak     if (!pci_is_vf(pci_dev) && n->params.sriov_max_vfs) {
891844c2c094SLukasz Maniak         pcie_sriov_pf_exit(pci_dev);
891944c2c094SLukasz Maniak     }
892044c2c094SLukasz Maniak 
89219162f101SKlaus Jensen     if (n->params.msix_exclusive_bar && !pci_is_vf(pci_dev)) {
89229162f101SKlaus Jensen         msix_uninit_exclusive_bar(pci_dev);
89239162f101SKlaus Jensen     } else {
892488eea45cSKlaus Jensen         msix_uninit(pci_dev, &n->bar0, &n->bar0);
89259162f101SKlaus Jensen     }
89269162f101SKlaus Jensen 
892788eea45cSKlaus Jensen     memory_region_del_subregion(&n->bar0, &n->iomem);
892888eea45cSKlaus Jensen }
892988eea45cSKlaus Jensen 
893088eea45cSKlaus Jensen static Property nvme_props[] = {
893188eea45cSKlaus Jensen     DEFINE_BLOCK_PROPERTIES(NvmeCtrl, namespace.blkconf),
893288eea45cSKlaus Jensen     DEFINE_PROP_LINK("pmrdev", NvmeCtrl, pmr.dev, TYPE_MEMORY_BACKEND,
893388eea45cSKlaus Jensen                      HostMemoryBackend *),
893488eea45cSKlaus Jensen     DEFINE_PROP_LINK("subsys", NvmeCtrl, subsys, TYPE_NVME_SUBSYS,
893588eea45cSKlaus Jensen                      NvmeSubsystem *),
893688eea45cSKlaus Jensen     DEFINE_PROP_STRING("serial", NvmeCtrl, params.serial),
893788eea45cSKlaus Jensen     DEFINE_PROP_UINT32("cmb_size_mb", NvmeCtrl, params.cmb_size_mb, 0),
893888eea45cSKlaus Jensen     DEFINE_PROP_UINT32("num_queues", NvmeCtrl, params.num_queues, 0),
893988eea45cSKlaus Jensen     DEFINE_PROP_UINT32("max_ioqpairs", NvmeCtrl, params.max_ioqpairs, 64),
894088eea45cSKlaus Jensen     DEFINE_PROP_UINT16("msix_qsize", NvmeCtrl, params.msix_qsize, 65),
894188eea45cSKlaus Jensen     DEFINE_PROP_UINT8("aerl", NvmeCtrl, params.aerl, 3),
894288eea45cSKlaus Jensen     DEFINE_PROP_UINT32("aer_max_queued", NvmeCtrl, params.aer_max_queued, 64),
894388eea45cSKlaus Jensen     DEFINE_PROP_UINT8("mdts", NvmeCtrl, params.mdts, 7),
894488eea45cSKlaus Jensen     DEFINE_PROP_UINT8("vsl", NvmeCtrl, params.vsl, 7),
894588eea45cSKlaus Jensen     DEFINE_PROP_BOOL("use-intel-id", NvmeCtrl, params.use_intel_id, false),
894688eea45cSKlaus Jensen     DEFINE_PROP_BOOL("legacy-cmb", NvmeCtrl, params.legacy_cmb, false),
8947e2e137f6SKlaus Jensen     DEFINE_PROP_BOOL("ioeventfd", NvmeCtrl, params.ioeventfd, false),
894888eea45cSKlaus Jensen     DEFINE_PROP_UINT8("zoned.zasl", NvmeCtrl, params.zasl, 0),
8949cccc2651SNiklas Cassel     DEFINE_PROP_BOOL("zoned.auto_transition", NvmeCtrl,
8950cccc2651SNiklas Cassel                      params.auto_transition_zones, true),
8951c6159d0eSMinwoo Im     DEFINE_PROP_UINT16("sriov_max_vfs", NvmeCtrl, params.sriov_max_vfs, 0),
8952746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT16("sriov_vq_flexible", NvmeCtrl,
8953746d42b1SŁukasz Gieryk                        params.sriov_vq_flexible, 0),
8954746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT16("sriov_vi_flexible", NvmeCtrl,
8955746d42b1SŁukasz Gieryk                        params.sriov_vi_flexible, 0),
895615ef124cSMinwoo Im     DEFINE_PROP_UINT32("sriov_max_vi_per_vf", NvmeCtrl,
8957746d42b1SŁukasz Gieryk                        params.sriov_max_vi_per_vf, 0),
895815ef124cSMinwoo Im     DEFINE_PROP_UINT32("sriov_max_vq_per_vf", NvmeCtrl,
8959746d42b1SŁukasz Gieryk                        params.sriov_max_vq_per_vf, 0),
8960fa905f65SKlaus Jensen     DEFINE_PROP_BOOL("msix-exclusive-bar", NvmeCtrl, params.msix_exclusive_bar,
8961fa905f65SKlaus Jensen                      false),
8962bc432bc5SJohn Berg     DEFINE_PROP_UINT16("mqes", NvmeCtrl, params.mqes, 0x7ff),
89634f947b10SWilfred Mallawa     DEFINE_PROP_UINT16("spdm_port", PCIDevice, spdm_port, 0),
8964e4bcb586SKlaus Jensen     DEFINE_PROP_BOOL("ctratt.mem", NvmeCtrl, params.ctratt.mem, false),
8965ebd1568fSAlan Adamson     DEFINE_PROP_BOOL("atomic.dn", NvmeCtrl, params.atomic_dn, 0),
8966ebd1568fSAlan Adamson     DEFINE_PROP_UINT16("atomic.awun", NvmeCtrl, params.atomic_awun, 0),
8967ebd1568fSAlan Adamson     DEFINE_PROP_UINT16("atomic.awupf", NvmeCtrl, params.atomic_awupf, 0),
896888eea45cSKlaus Jensen     DEFINE_PROP_END_OF_LIST(),
896988eea45cSKlaus Jensen };
897088eea45cSKlaus Jensen 
nvme_get_smart_warning(Object * obj,Visitor * v,const char * name,void * opaque,Error ** errp)897188eea45cSKlaus Jensen static void nvme_get_smart_warning(Object *obj, Visitor *v, const char *name,
897288eea45cSKlaus Jensen                                    void *opaque, Error **errp)
897388eea45cSKlaus Jensen {
897488eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
897588eea45cSKlaus Jensen     uint8_t value = n->smart_critical_warning;
897688eea45cSKlaus Jensen 
897788eea45cSKlaus Jensen     visit_type_uint8(v, name, &value, errp);
897888eea45cSKlaus Jensen }
897988eea45cSKlaus Jensen 
nvme_set_smart_warning(Object * obj,Visitor * v,const char * name,void * opaque,Error ** errp)898088eea45cSKlaus Jensen static void nvme_set_smart_warning(Object *obj, Visitor *v, const char *name,
898188eea45cSKlaus Jensen                                    void *opaque, Error **errp)
898288eea45cSKlaus Jensen {
898388eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
898488eea45cSKlaus Jensen     uint8_t value, old_value, cap = 0, index, event;
898588eea45cSKlaus Jensen 
898688eea45cSKlaus Jensen     if (!visit_type_uint8(v, name, &value, errp)) {
898788eea45cSKlaus Jensen         return;
898888eea45cSKlaus Jensen     }
898988eea45cSKlaus Jensen 
899088eea45cSKlaus Jensen     cap = NVME_SMART_SPARE | NVME_SMART_TEMPERATURE | NVME_SMART_RELIABILITY
899188eea45cSKlaus Jensen           | NVME_SMART_MEDIA_READ_ONLY | NVME_SMART_FAILED_VOLATILE_MEDIA;
899249e03457SKlaus Jensen     if (NVME_CAP_PMRS(ldq_le_p(&n->bar.cap))) {
899388eea45cSKlaus Jensen         cap |= NVME_SMART_PMR_UNRELIABLE;
899488eea45cSKlaus Jensen     }
899588eea45cSKlaus Jensen 
899688eea45cSKlaus Jensen     if ((value & cap) != value) {
899788eea45cSKlaus Jensen         error_setg(errp, "unsupported smart critical warning bits: 0x%x",
899888eea45cSKlaus Jensen                    value & ~cap);
899988eea45cSKlaus Jensen         return;
900088eea45cSKlaus Jensen     }
900188eea45cSKlaus Jensen 
900288eea45cSKlaus Jensen     old_value = n->smart_critical_warning;
900388eea45cSKlaus Jensen     n->smart_critical_warning = value;
900488eea45cSKlaus Jensen 
900588eea45cSKlaus Jensen     /* only inject new bits of smart critical warning */
900688eea45cSKlaus Jensen     for (index = 0; index < NVME_SMART_WARN_MAX; index++) {
900788eea45cSKlaus Jensen         event = 1 << index;
900888eea45cSKlaus Jensen         if (value & ~old_value & event)
900988eea45cSKlaus Jensen             nvme_smart_event(n, event);
901088eea45cSKlaus Jensen     }
901188eea45cSKlaus Jensen }
901288eea45cSKlaus Jensen 
nvme_pci_reset(DeviceState * qdev)90131e9c685eSŁukasz Gieryk static void nvme_pci_reset(DeviceState *qdev)
90141e9c685eSŁukasz Gieryk {
90151e9c685eSŁukasz Gieryk     PCIDevice *pci_dev = PCI_DEVICE(qdev);
90161e9c685eSŁukasz Gieryk     NvmeCtrl *n = NVME(pci_dev);
90171e9c685eSŁukasz Gieryk 
90181e9c685eSŁukasz Gieryk     trace_pci_nvme_pci_reset();
90191e9c685eSŁukasz Gieryk     nvme_ctrl_reset(n, NVME_RESET_FUNCTION);
90201e9c685eSŁukasz Gieryk }
90211e9c685eSŁukasz Gieryk 
nvme_sriov_post_write_config(PCIDevice * dev,uint16_t old_num_vfs)902291bb64a8SAkihiko Odaki static void nvme_sriov_post_write_config(PCIDevice *dev, uint16_t old_num_vfs)
902311871f53SŁukasz Gieryk {
902411871f53SŁukasz Gieryk     NvmeCtrl *n = NVME(dev);
902511871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
902691bb64a8SAkihiko Odaki     int i;
902711871f53SŁukasz Gieryk 
902891bb64a8SAkihiko Odaki     for (i = pcie_sriov_num_vfs(dev); i < old_num_vfs; i++) {
90291a494d11SMinwoo Im         sctrl = &n->sec_ctrl_list[i];
903011871f53SŁukasz Gieryk         nvme_virt_set_state(n, le16_to_cpu(sctrl->scid), false);
903111871f53SŁukasz Gieryk     }
903211871f53SŁukasz Gieryk }
903311871f53SŁukasz Gieryk 
nvme_pci_write_config(PCIDevice * dev,uint32_t address,uint32_t val,int len)90341e9c685eSŁukasz Gieryk static void nvme_pci_write_config(PCIDevice *dev, uint32_t address,
90351e9c685eSŁukasz Gieryk                                   uint32_t val, int len)
90361e9c685eSŁukasz Gieryk {
903791bb64a8SAkihiko Odaki     uint16_t old_num_vfs = pcie_sriov_num_vfs(dev);
903891bb64a8SAkihiko Odaki 
90394f947b10SWilfred Mallawa     if (pcie_find_capability(dev, PCI_EXT_CAP_ID_DOE)) {
90404f947b10SWilfred Mallawa         pcie_doe_write_config(&dev->doe_spdm, address, val, len);
90414f947b10SWilfred Mallawa     }
90421e9c685eSŁukasz Gieryk     pci_default_write_config(dev, address, val, len);
90431e9c685eSŁukasz Gieryk     pcie_cap_flr_write_config(dev, address, val, len);
904491bb64a8SAkihiko Odaki     nvme_sriov_post_write_config(dev, old_num_vfs);
90451e9c685eSŁukasz Gieryk }
90461e9c685eSŁukasz Gieryk 
nvme_pci_read_config(PCIDevice * dev,uint32_t address,int len)90474f947b10SWilfred Mallawa static uint32_t nvme_pci_read_config(PCIDevice *dev, uint32_t address, int len)
90484f947b10SWilfred Mallawa {
90494f947b10SWilfred Mallawa     uint32_t val;
90504f947b10SWilfred Mallawa     if (dev->spdm_port && pcie_find_capability(dev, PCI_EXT_CAP_ID_DOE)) {
90514f947b10SWilfred Mallawa         if (pcie_doe_read_config(&dev->doe_spdm, address, len, &val)) {
90524f947b10SWilfred Mallawa             return val;
90534f947b10SWilfred Mallawa         }
90544f947b10SWilfred Mallawa     }
90554f947b10SWilfred Mallawa     return pci_default_read_config(dev, address, len);
90564f947b10SWilfred Mallawa }
90574f947b10SWilfred Mallawa 
905888eea45cSKlaus Jensen static const VMStateDescription nvme_vmstate = {
905988eea45cSKlaus Jensen     .name = "nvme",
906088eea45cSKlaus Jensen     .unmigratable = 1,
906188eea45cSKlaus Jensen };
906288eea45cSKlaus Jensen 
nvme_class_init(ObjectClass * oc,void * data)906388eea45cSKlaus Jensen static void nvme_class_init(ObjectClass *oc, void *data)
906488eea45cSKlaus Jensen {
906588eea45cSKlaus Jensen     DeviceClass *dc = DEVICE_CLASS(oc);
906688eea45cSKlaus Jensen     PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc);
906788eea45cSKlaus Jensen 
906888eea45cSKlaus Jensen     pc->realize = nvme_realize;
90691e9c685eSŁukasz Gieryk     pc->config_write = nvme_pci_write_config;
90704f947b10SWilfred Mallawa     pc->config_read = nvme_pci_read_config;
907188eea45cSKlaus Jensen     pc->exit = nvme_exit;
907288eea45cSKlaus Jensen     pc->class_id = PCI_CLASS_STORAGE_EXPRESS;
907388eea45cSKlaus Jensen     pc->revision = 2;
907488eea45cSKlaus Jensen 
907588eea45cSKlaus Jensen     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
907688eea45cSKlaus Jensen     dc->desc = "Non-Volatile Memory Express";
907788eea45cSKlaus Jensen     device_class_set_props(dc, nvme_props);
907888eea45cSKlaus Jensen     dc->vmsd = &nvme_vmstate;
9079e3d08143SPeter Maydell     device_class_set_legacy_reset(dc, nvme_pci_reset);
908088eea45cSKlaus Jensen }
908188eea45cSKlaus Jensen 
nvme_instance_init(Object * obj)908288eea45cSKlaus Jensen static void nvme_instance_init(Object *obj)
908388eea45cSKlaus Jensen {
908488eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
908588eea45cSKlaus Jensen 
908688eea45cSKlaus Jensen     device_add_bootindex_property(obj, &n->namespace.blkconf.bootindex,
908788eea45cSKlaus Jensen                                   "bootindex", "/namespace@1,0",
908888eea45cSKlaus Jensen                                   DEVICE(obj));
908988eea45cSKlaus Jensen 
909088eea45cSKlaus Jensen     object_property_add(obj, "smart_critical_warning", "uint8",
909188eea45cSKlaus Jensen                         nvme_get_smart_warning,
909288eea45cSKlaus Jensen                         nvme_set_smart_warning, NULL, NULL);
909388eea45cSKlaus Jensen }
909488eea45cSKlaus Jensen 
909588eea45cSKlaus Jensen static const TypeInfo nvme_info = {
909688eea45cSKlaus Jensen     .name          = TYPE_NVME,
909788eea45cSKlaus Jensen     .parent        = TYPE_PCI_DEVICE,
909888eea45cSKlaus Jensen     .instance_size = sizeof(NvmeCtrl),
909988eea45cSKlaus Jensen     .instance_init = nvme_instance_init,
910088eea45cSKlaus Jensen     .class_init    = nvme_class_init,
910188eea45cSKlaus Jensen     .interfaces = (InterfaceInfo[]) {
910288eea45cSKlaus Jensen         { INTERFACE_PCIE_DEVICE },
910388eea45cSKlaus Jensen         { }
910488eea45cSKlaus Jensen     },
910588eea45cSKlaus Jensen };
910688eea45cSKlaus Jensen 
910788eea45cSKlaus Jensen static const TypeInfo nvme_bus_info = {
910888eea45cSKlaus Jensen     .name = TYPE_NVME_BUS,
910988eea45cSKlaus Jensen     .parent = TYPE_BUS,
911088eea45cSKlaus Jensen     .instance_size = sizeof(NvmeBus),
911188eea45cSKlaus Jensen };
911288eea45cSKlaus Jensen 
nvme_register_types(void)911388eea45cSKlaus Jensen static void nvme_register_types(void)
911488eea45cSKlaus Jensen {
911588eea45cSKlaus Jensen     type_register_static(&nvme_info);
911688eea45cSKlaus Jensen     type_register_static(&nvme_bus_info);
911788eea45cSKlaus Jensen }
911888eea45cSKlaus Jensen 
911988eea45cSKlaus Jensen type_init(nvme_register_types)
9120