xref: /openbmc/qemu/hw/nvme/ctrl.c (revision e181d3da)
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
2088eea45cSKlaus Jensen  * NVMe subsystem use thes 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]> \
4388eea45cSKlaus Jensen  *              subsys=<subsys_id>
4488eea45cSKlaus Jensen  *      -device nvme-ns,drive=<drive_id>,bus=<bus_name>,nsid=<nsid>,\
4588eea45cSKlaus Jensen  *              zoned=<true|false[optional]>, \
4688eea45cSKlaus Jensen  *              subsys=<subsys_id>,detached=<true|false[optional]>
4788eea45cSKlaus Jensen  *
4888eea45cSKlaus Jensen  * Note cmb_size_mb denotes size of CMB in MB. CMB is assumed to be at
4988eea45cSKlaus Jensen  * offset 0 in BAR2 and supports only WDS, RDS and SQS for now. By default, the
5088eea45cSKlaus Jensen  * device will use the "v1.4 CMB scheme" - use the `legacy-cmb` parameter to
5188eea45cSKlaus Jensen  * always enable the CMBLOC and CMBSZ registers (v1.3 behavior).
5288eea45cSKlaus Jensen  *
5388eea45cSKlaus Jensen  * Enabling pmr emulation can be achieved by pointing to memory-backend-file.
5488eea45cSKlaus Jensen  * For example:
5588eea45cSKlaus Jensen  * -object memory-backend-file,id=<mem_id>,share=on,mem-path=<file_path>, \
5688eea45cSKlaus Jensen  *  size=<size> .... -device nvme,...,pmrdev=<mem_id>
5788eea45cSKlaus Jensen  *
5888eea45cSKlaus Jensen  * The PMR will use BAR 4/5 exclusively.
5988eea45cSKlaus Jensen  *
6088eea45cSKlaus Jensen  * To place controller(s) and namespace(s) to a subsystem, then provide
6188eea45cSKlaus Jensen  * nvme-subsys device as above.
6288eea45cSKlaus Jensen  *
6388eea45cSKlaus Jensen  * nvme subsystem device parameters
6488eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
6588eea45cSKlaus Jensen  * - `nqn`
6688eea45cSKlaus Jensen  *   This parameter provides the `<nqn_id>` part of the string
6788eea45cSKlaus Jensen  *   `nqn.2019-08.org.qemu:<nqn_id>` which will be reported in the SUBNQN field
6888eea45cSKlaus Jensen  *   of subsystem controllers. Note that `<nqn_id>` should be unique per
6988eea45cSKlaus Jensen  *   subsystem, but this is not enforced by QEMU. If not specified, it will
7088eea45cSKlaus Jensen  *   default to the value of the `id` parameter (`<subsys_id>`).
7188eea45cSKlaus Jensen  *
7288eea45cSKlaus Jensen  * nvme device parameters
7388eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~
7488eea45cSKlaus Jensen  * - `subsys`
7588eea45cSKlaus Jensen  *   Specifying this parameter attaches the controller to the subsystem and
7688eea45cSKlaus Jensen  *   the SUBNQN field in the controller will report the NQN of the subsystem
7788eea45cSKlaus Jensen  *   device. This also enables multi controller capability represented in
7888eea45cSKlaus Jensen  *   Identify Controller data structure in CMIC (Controller Multi-path I/O and
79a0984714SDr. David Alan Gilbert  *   Namespace Sharing Capabilities).
8088eea45cSKlaus Jensen  *
8188eea45cSKlaus Jensen  * - `aerl`
8288eea45cSKlaus Jensen  *   The Asynchronous Event Request Limit (AERL). Indicates the maximum number
8388eea45cSKlaus Jensen  *   of concurrently outstanding Asynchronous Event Request commands support
8488eea45cSKlaus Jensen  *   by the controller. This is a 0's based value.
8588eea45cSKlaus Jensen  *
8688eea45cSKlaus Jensen  * - `aer_max_queued`
8788eea45cSKlaus Jensen  *   This is the maximum number of events that the device will enqueue for
8888eea45cSKlaus Jensen  *   completion when there are no outstanding AERs. When the maximum number of
8988eea45cSKlaus Jensen  *   enqueued events are reached, subsequent events will be dropped.
9088eea45cSKlaus Jensen  *
9188eea45cSKlaus Jensen  * - `mdts`
9288eea45cSKlaus Jensen  *   Indicates the maximum data transfer size for a command that transfers data
9388eea45cSKlaus Jensen  *   between host-accessible memory and the controller. The value is specified
9488eea45cSKlaus Jensen  *   as a power of two (2^n) and is in units of the minimum memory page size
9588eea45cSKlaus Jensen  *   (CAP.MPSMIN). The default value is 7 (i.e. 512 KiB).
9688eea45cSKlaus Jensen  *
9788eea45cSKlaus Jensen  * - `vsl`
9888eea45cSKlaus Jensen  *   Indicates the maximum data size limit for the Verify command. Like `mdts`,
9988eea45cSKlaus Jensen  *   this value is specified as a power of two (2^n) and is in units of the
10088eea45cSKlaus Jensen  *   minimum memory page size (CAP.MPSMIN). The default value is 7 (i.e. 512
10188eea45cSKlaus Jensen  *   KiB).
10288eea45cSKlaus Jensen  *
10388eea45cSKlaus Jensen  * - `zoned.zasl`
10488eea45cSKlaus Jensen  *   Indicates the maximum data transfer size for the Zone Append command. Like
10588eea45cSKlaus Jensen  *   `mdts`, the value is specified as a power of two (2^n) and is in units of
10688eea45cSKlaus Jensen  *   the minimum memory page size (CAP.MPSMIN). The default value is 0 (i.e.
10788eea45cSKlaus Jensen  *   defaulting to the value of `mdts`).
10888eea45cSKlaus Jensen  *
109cccc2651SNiklas Cassel  * - `zoned.auto_transition`
110cccc2651SNiklas Cassel  *   Indicates if zones in zone state implicitly opened can be automatically
111cccc2651SNiklas Cassel  *   transitioned to zone state closed for resource management purposes.
112cccc2651SNiklas Cassel  *   Defaults to 'on'.
113cccc2651SNiklas Cassel  *
11444c2c094SLukasz Maniak  * - `sriov_max_vfs`
11544c2c094SLukasz Maniak  *   Indicates the maximum number of PCIe virtual functions supported
11644c2c094SLukasz Maniak  *   by the controller. The default value is 0. Specifying a non-zero value
11744c2c094SLukasz Maniak  *   enables reporting of both SR-IOV and ARI capabilities by the NVMe device.
11844c2c094SLukasz Maniak  *   Virtual function controllers will not report SR-IOV capability.
11944c2c094SLukasz Maniak  *
120746d42b1SŁukasz Gieryk  *   NOTE: Single Root I/O Virtualization support is experimental.
121746d42b1SŁukasz Gieryk  *   All the related parameters may be subject to change.
122746d42b1SŁukasz Gieryk  *
123746d42b1SŁukasz Gieryk  * - `sriov_vq_flexible`
124746d42b1SŁukasz Gieryk  *   Indicates the total number of flexible queue resources assignable to all
125746d42b1SŁukasz Gieryk  *   the secondary controllers. Implicitly sets the number of primary
126746d42b1SŁukasz Gieryk  *   controller's private resources to `(max_ioqpairs - sriov_vq_flexible)`.
127746d42b1SŁukasz Gieryk  *
128746d42b1SŁukasz Gieryk  * - `sriov_vi_flexible`
129746d42b1SŁukasz Gieryk  *   Indicates the total number of flexible interrupt resources assignable to
130746d42b1SŁukasz Gieryk  *   all the secondary controllers. Implicitly sets the number of primary
131746d42b1SŁukasz Gieryk  *   controller's private resources to `(msix_qsize - sriov_vi_flexible)`.
132746d42b1SŁukasz Gieryk  *
133746d42b1SŁukasz Gieryk  * - `sriov_max_vi_per_vf`
134746d42b1SŁukasz Gieryk  *   Indicates the maximum number of virtual interrupt resources assignable
135746d42b1SŁukasz Gieryk  *   to a secondary controller. The default 0 resolves to
136746d42b1SŁukasz Gieryk  *   `(sriov_vi_flexible / sriov_max_vfs)`.
137746d42b1SŁukasz Gieryk  *
138746d42b1SŁukasz Gieryk  * - `sriov_max_vq_per_vf`
139746d42b1SŁukasz Gieryk  *   Indicates the maximum number of virtual queue resources assignable to
140746d42b1SŁukasz Gieryk  *   a secondary controller. The default 0 resolves to
141746d42b1SŁukasz Gieryk  *   `(sriov_vq_flexible / sriov_max_vfs)`.
142746d42b1SŁukasz Gieryk  *
14388eea45cSKlaus Jensen  * nvme namespace device parameters
14488eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
14588eea45cSKlaus Jensen  * - `shared`
14688eea45cSKlaus Jensen  *   When the parent nvme device (as defined explicitly by the 'bus' parameter
14788eea45cSKlaus Jensen  *   or implicitly by the most recently defined NvmeBus) is linked to an
14888eea45cSKlaus Jensen  *   nvme-subsys device, the namespace will be attached to all controllers in
14988eea45cSKlaus Jensen  *   the subsystem. If set to 'off' (the default), the namespace will remain a
15088eea45cSKlaus Jensen  *   private namespace and may only be attached to a single controller at a
15188eea45cSKlaus Jensen  *   time.
15288eea45cSKlaus Jensen  *
15388eea45cSKlaus Jensen  * - `detached`
15488eea45cSKlaus Jensen  *   This parameter is only valid together with the `subsys` parameter. If left
15588eea45cSKlaus Jensen  *   at the default value (`false/off`), the namespace will be attached to all
15688eea45cSKlaus Jensen  *   controllers in the NVMe subsystem at boot-up. If set to `true/on`, the
157eeef4329SGollu Appalanaidu  *   namespace will be available in the subsystem but not attached to any
15888eea45cSKlaus Jensen  *   controllers.
15988eea45cSKlaus Jensen  *
16088eea45cSKlaus Jensen  * Setting `zoned` to true selects Zoned Command Set at the namespace.
16188eea45cSKlaus Jensen  * In this case, the following namespace properties are available to configure
16288eea45cSKlaus Jensen  * zoned operation:
16388eea45cSKlaus Jensen  *     zoned.zone_size=<zone size in bytes, default: 128MiB>
16488eea45cSKlaus Jensen  *         The number may be followed by K, M, G as in kilo-, mega- or giga-.
16588eea45cSKlaus Jensen  *
16688eea45cSKlaus Jensen  *     zoned.zone_capacity=<zone capacity in bytes, default: zone size>
16788eea45cSKlaus Jensen  *         The value 0 (default) forces zone capacity to be the same as zone
16888eea45cSKlaus Jensen  *         size. The value of this property may not exceed zone size.
16988eea45cSKlaus Jensen  *
17088eea45cSKlaus Jensen  *     zoned.descr_ext_size=<zone descriptor extension size, default 0>
17188eea45cSKlaus Jensen  *         This value needs to be specified in 64B units. If it is zero,
17288eea45cSKlaus Jensen  *         namespace(s) will not support zone descriptor extensions.
17388eea45cSKlaus Jensen  *
17488eea45cSKlaus Jensen  *     zoned.max_active=<Maximum Active Resources (zones), default: 0>
17588eea45cSKlaus Jensen  *         The default value means there is no limit to the number of
17688eea45cSKlaus Jensen  *         concurrently active zones.
17788eea45cSKlaus Jensen  *
17888eea45cSKlaus Jensen  *     zoned.max_open=<Maximum Open Resources (zones), default: 0>
17988eea45cSKlaus Jensen  *         The default value means there is no limit to the number of
18088eea45cSKlaus Jensen  *         concurrently open zones.
18188eea45cSKlaus Jensen  *
18288eea45cSKlaus Jensen  *     zoned.cross_read=<enable RAZB, default: false>
18388eea45cSKlaus Jensen  *         Setting this property to true enables Read Across Zone Boundaries.
18488eea45cSKlaus Jensen  */
18588eea45cSKlaus Jensen 
18688eea45cSKlaus Jensen #include "qemu/osdep.h"
18788eea45cSKlaus Jensen #include "qemu/cutils.h"
18888eea45cSKlaus Jensen #include "qemu/error-report.h"
18988eea45cSKlaus Jensen #include "qemu/log.h"
19088eea45cSKlaus Jensen #include "qemu/units.h"
19111871f53SŁukasz Gieryk #include "qemu/range.h"
19288eea45cSKlaus Jensen #include "qapi/error.h"
19388eea45cSKlaus Jensen #include "qapi/visitor.h"
19488eea45cSKlaus Jensen #include "sysemu/sysemu.h"
19588eea45cSKlaus Jensen #include "sysemu/block-backend.h"
19688eea45cSKlaus Jensen #include "sysemu/hostmem.h"
19788eea45cSKlaus Jensen #include "hw/pci/msix.h"
19844c2c094SLukasz Maniak #include "hw/pci/pcie_sriov.h"
19988eea45cSKlaus Jensen #include "migration/vmstate.h"
20088eea45cSKlaus Jensen 
20188eea45cSKlaus Jensen #include "nvme.h"
20205f7ae45SKlaus Jensen #include "dif.h"
20388eea45cSKlaus Jensen #include "trace.h"
20488eea45cSKlaus Jensen 
20588eea45cSKlaus Jensen #define NVME_MAX_IOQPAIRS 0xffff
20688eea45cSKlaus Jensen #define NVME_DB_SIZE  4
20788eea45cSKlaus Jensen #define NVME_SPEC_VER 0x00010400
20888eea45cSKlaus Jensen #define NVME_CMB_BIR 2
20988eea45cSKlaus Jensen #define NVME_PMR_BIR 4
21088eea45cSKlaus Jensen #define NVME_TEMPERATURE 0x143
21188eea45cSKlaus Jensen #define NVME_TEMPERATURE_WARNING 0x157
21288eea45cSKlaus Jensen #define NVME_TEMPERATURE_CRITICAL 0x175
21388eea45cSKlaus Jensen #define NVME_NUM_FW_SLOTS 1
21488eea45cSKlaus Jensen #define NVME_DEFAULT_MAX_ZA_SIZE (128 * KiB)
21544c2c094SLukasz Maniak #define NVME_MAX_VFS 127
216746d42b1SŁukasz Gieryk #define NVME_VF_RES_GRANULARITY 1
21744c2c094SLukasz Maniak #define NVME_VF_OFFSET 0x1
21844c2c094SLukasz Maniak #define NVME_VF_STRIDE 1
21988eea45cSKlaus Jensen 
22088eea45cSKlaus Jensen #define NVME_GUEST_ERR(trace, fmt, ...) \
22188eea45cSKlaus Jensen     do { \
22288eea45cSKlaus Jensen         (trace_##trace)(__VA_ARGS__); \
22388eea45cSKlaus Jensen         qemu_log_mask(LOG_GUEST_ERROR, #trace \
22488eea45cSKlaus Jensen             " in %s: " fmt "\n", __func__, ## __VA_ARGS__); \
22588eea45cSKlaus Jensen     } while (0)
22688eea45cSKlaus Jensen 
22788eea45cSKlaus Jensen static const bool nvme_feature_support[NVME_FID_MAX] = {
22888eea45cSKlaus Jensen     [NVME_ARBITRATION]              = true,
22988eea45cSKlaus Jensen     [NVME_POWER_MANAGEMENT]         = true,
23088eea45cSKlaus Jensen     [NVME_TEMPERATURE_THRESHOLD]    = true,
23188eea45cSKlaus Jensen     [NVME_ERROR_RECOVERY]           = true,
23288eea45cSKlaus Jensen     [NVME_VOLATILE_WRITE_CACHE]     = true,
23388eea45cSKlaus Jensen     [NVME_NUMBER_OF_QUEUES]         = true,
23488eea45cSKlaus Jensen     [NVME_INTERRUPT_COALESCING]     = true,
23588eea45cSKlaus Jensen     [NVME_INTERRUPT_VECTOR_CONF]    = true,
23688eea45cSKlaus Jensen     [NVME_WRITE_ATOMICITY]          = true,
23788eea45cSKlaus Jensen     [NVME_ASYNCHRONOUS_EVENT_CONF]  = true,
23888eea45cSKlaus Jensen     [NVME_TIMESTAMP]                = true,
239d0c0697bSNaveen Nagar     [NVME_HOST_BEHAVIOR_SUPPORT]    = true,
24088eea45cSKlaus Jensen     [NVME_COMMAND_SET_PROFILE]      = true,
24188eea45cSKlaus Jensen };
24288eea45cSKlaus Jensen 
24388eea45cSKlaus Jensen static const uint32_t nvme_feature_cap[NVME_FID_MAX] = {
24488eea45cSKlaus Jensen     [NVME_TEMPERATURE_THRESHOLD]    = NVME_FEAT_CAP_CHANGE,
24588eea45cSKlaus Jensen     [NVME_ERROR_RECOVERY]           = NVME_FEAT_CAP_CHANGE | NVME_FEAT_CAP_NS,
24688eea45cSKlaus Jensen     [NVME_VOLATILE_WRITE_CACHE]     = NVME_FEAT_CAP_CHANGE,
24788eea45cSKlaus Jensen     [NVME_NUMBER_OF_QUEUES]         = NVME_FEAT_CAP_CHANGE,
24888eea45cSKlaus Jensen     [NVME_ASYNCHRONOUS_EVENT_CONF]  = NVME_FEAT_CAP_CHANGE,
24988eea45cSKlaus Jensen     [NVME_TIMESTAMP]                = NVME_FEAT_CAP_CHANGE,
250d0c0697bSNaveen Nagar     [NVME_HOST_BEHAVIOR_SUPPORT]    = NVME_FEAT_CAP_CHANGE,
25188eea45cSKlaus Jensen     [NVME_COMMAND_SET_PROFILE]      = NVME_FEAT_CAP_CHANGE,
25288eea45cSKlaus Jensen };
25388eea45cSKlaus Jensen 
25488eea45cSKlaus Jensen static const uint32_t nvme_cse_acs[256] = {
25588eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_SQ]        = NVME_CMD_EFF_CSUPP,
25688eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_SQ]        = NVME_CMD_EFF_CSUPP,
25788eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_LOG_PAGE]     = NVME_CMD_EFF_CSUPP,
25888eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_CQ]        = NVME_CMD_EFF_CSUPP,
25988eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_CQ]        = NVME_CMD_EFF_CSUPP,
26088eea45cSKlaus Jensen     [NVME_ADM_CMD_IDENTIFY]         = NVME_CMD_EFF_CSUPP,
26188eea45cSKlaus Jensen     [NVME_ADM_CMD_ABORT]            = NVME_CMD_EFF_CSUPP,
26288eea45cSKlaus Jensen     [NVME_ADM_CMD_SET_FEATURES]     = NVME_CMD_EFF_CSUPP,
26388eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_FEATURES]     = NVME_CMD_EFF_CSUPP,
26488eea45cSKlaus Jensen     [NVME_ADM_CMD_ASYNC_EV_REQ]     = NVME_CMD_EFF_CSUPP,
26588eea45cSKlaus Jensen     [NVME_ADM_CMD_NS_ATTACHMENT]    = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_NIC,
26611871f53SŁukasz Gieryk     [NVME_ADM_CMD_VIRT_MNGMT]       = NVME_CMD_EFF_CSUPP,
2673f7fe8deSJinhao Fan     [NVME_ADM_CMD_DBBUF_CONFIG]     = NVME_CMD_EFF_CSUPP,
26888eea45cSKlaus Jensen     [NVME_ADM_CMD_FORMAT_NVM]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
269*e181d3daSGollu Appalanaidu     [NVME_ADM_CMD_DIRECTIVE_RECV]   = NVME_CMD_EFF_CSUPP,
270*e181d3daSGollu Appalanaidu     [NVME_ADM_CMD_DIRECTIVE_SEND]   = NVME_CMD_EFF_CSUPP,
27188eea45cSKlaus Jensen };
27288eea45cSKlaus Jensen 
27388eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_none[256];
27488eea45cSKlaus Jensen 
27588eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_nvm[256] = {
27688eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
27788eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
27888eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
27988eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
28088eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28188eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
28288eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28388eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
28488eea45cSKlaus Jensen };
28588eea45cSKlaus Jensen 
28688eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_zoned[256] = {
28788eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28888eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28988eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29088eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
29188eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29288eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
29388eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29488eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
29588eea45cSKlaus Jensen     [NVME_CMD_ZONE_APPEND]          = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29688eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_SEND]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29788eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_RECV]       = NVME_CMD_EFF_CSUPP,
29888eea45cSKlaus Jensen };
29988eea45cSKlaus Jensen 
30088eea45cSKlaus Jensen static void nvme_process_sq(void *opaque);
30111871f53SŁukasz Gieryk static void nvme_ctrl_reset(NvmeCtrl *n, NvmeResetType rst);
30288eea45cSKlaus Jensen 
30388eea45cSKlaus Jensen static uint16_t nvme_sqid(NvmeRequest *req)
30488eea45cSKlaus Jensen {
30588eea45cSKlaus Jensen     return le16_to_cpu(req->sq->sqid);
30688eea45cSKlaus Jensen }
30788eea45cSKlaus Jensen 
30888eea45cSKlaus Jensen static void nvme_assign_zone_state(NvmeNamespace *ns, NvmeZone *zone,
30988eea45cSKlaus Jensen                                    NvmeZoneState state)
31088eea45cSKlaus Jensen {
31188eea45cSKlaus Jensen     if (QTAILQ_IN_USE(zone, entry)) {
31288eea45cSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
31388eea45cSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
31488eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->exp_open_zones, zone, entry);
31588eea45cSKlaus Jensen             break;
31688eea45cSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
31788eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
31888eea45cSKlaus Jensen             break;
31988eea45cSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
32088eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->closed_zones, zone, entry);
32188eea45cSKlaus Jensen             break;
32288eea45cSKlaus Jensen         case NVME_ZONE_STATE_FULL:
32388eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->full_zones, zone, entry);
32488eea45cSKlaus Jensen         default:
32588eea45cSKlaus Jensen             ;
32688eea45cSKlaus Jensen         }
32788eea45cSKlaus Jensen     }
32888eea45cSKlaus Jensen 
32988eea45cSKlaus Jensen     nvme_set_zone_state(zone, state);
33088eea45cSKlaus Jensen 
33188eea45cSKlaus Jensen     switch (state) {
33288eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
33388eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->exp_open_zones, zone, entry);
33488eea45cSKlaus Jensen         break;
33588eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
33688eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->imp_open_zones, zone, entry);
33788eea45cSKlaus Jensen         break;
33888eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
33988eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->closed_zones, zone, entry);
34088eea45cSKlaus Jensen         break;
34188eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
34288eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->full_zones, zone, entry);
34388eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
34488eea45cSKlaus Jensen         break;
34588eea45cSKlaus Jensen     default:
34688eea45cSKlaus Jensen         zone->d.za = 0;
34788eea45cSKlaus Jensen     }
34888eea45cSKlaus Jensen }
34988eea45cSKlaus Jensen 
350e321b4cdSKlaus Jensen static uint16_t nvme_zns_check_resources(NvmeNamespace *ns, uint32_t act,
351e321b4cdSKlaus Jensen                                          uint32_t opn, uint32_t zrwa)
35288eea45cSKlaus Jensen {
35388eea45cSKlaus Jensen     if (ns->params.max_active_zones != 0 &&
35488eea45cSKlaus Jensen         ns->nr_active_zones + act > ns->params.max_active_zones) {
35588eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_active_res(ns->params.max_active_zones);
35688eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_ACTIVE | NVME_DNR;
35788eea45cSKlaus Jensen     }
358e321b4cdSKlaus Jensen 
35988eea45cSKlaus Jensen     if (ns->params.max_open_zones != 0 &&
36088eea45cSKlaus Jensen         ns->nr_open_zones + opn > ns->params.max_open_zones) {
36188eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_open_res(ns->params.max_open_zones);
36288eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_OPEN | NVME_DNR;
36388eea45cSKlaus Jensen     }
36488eea45cSKlaus Jensen 
365e321b4cdSKlaus Jensen     if (zrwa > ns->zns.numzrwa) {
366e321b4cdSKlaus Jensen         return NVME_NOZRWA | NVME_DNR;
367e321b4cdSKlaus Jensen     }
368e321b4cdSKlaus Jensen 
36988eea45cSKlaus Jensen     return NVME_SUCCESS;
37088eea45cSKlaus Jensen }
37188eea45cSKlaus Jensen 
372e321b4cdSKlaus Jensen /*
373e321b4cdSKlaus Jensen  * Check if we can open a zone without exceeding open/active limits.
374e321b4cdSKlaus Jensen  * AOR stands for "Active and Open Resources" (see TP 4053 section 2.5).
375e321b4cdSKlaus Jensen  */
376e321b4cdSKlaus Jensen static uint16_t nvme_aor_check(NvmeNamespace *ns, uint32_t act, uint32_t opn)
377e321b4cdSKlaus Jensen {
378e321b4cdSKlaus Jensen     return nvme_zns_check_resources(ns, act, opn, 0);
379e321b4cdSKlaus Jensen }
380e321b4cdSKlaus Jensen 
38188eea45cSKlaus Jensen static bool nvme_addr_is_cmb(NvmeCtrl *n, hwaddr addr)
38288eea45cSKlaus Jensen {
38388eea45cSKlaus Jensen     hwaddr hi, lo;
38488eea45cSKlaus Jensen 
38588eea45cSKlaus Jensen     if (!n->cmb.cmse) {
38688eea45cSKlaus Jensen         return false;
38788eea45cSKlaus Jensen     }
38888eea45cSKlaus Jensen 
38988eea45cSKlaus Jensen     lo = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
39088eea45cSKlaus Jensen     hi = lo + int128_get64(n->cmb.mem.size);
39188eea45cSKlaus Jensen 
39288eea45cSKlaus Jensen     return addr >= lo && addr < hi;
39388eea45cSKlaus Jensen }
39488eea45cSKlaus Jensen 
39588eea45cSKlaus Jensen static inline void *nvme_addr_to_cmb(NvmeCtrl *n, hwaddr addr)
39688eea45cSKlaus Jensen {
39788eea45cSKlaus Jensen     hwaddr base = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
39888eea45cSKlaus Jensen     return &n->cmb.buf[addr - base];
39988eea45cSKlaus Jensen }
40088eea45cSKlaus Jensen 
40188eea45cSKlaus Jensen static bool nvme_addr_is_pmr(NvmeCtrl *n, hwaddr addr)
40288eea45cSKlaus Jensen {
40388eea45cSKlaus Jensen     hwaddr hi;
40488eea45cSKlaus Jensen 
40588eea45cSKlaus Jensen     if (!n->pmr.cmse) {
40688eea45cSKlaus Jensen         return false;
40788eea45cSKlaus Jensen     }
40888eea45cSKlaus Jensen 
40988eea45cSKlaus Jensen     hi = n->pmr.cba + int128_get64(n->pmr.dev->mr.size);
41088eea45cSKlaus Jensen 
41188eea45cSKlaus Jensen     return addr >= n->pmr.cba && addr < hi;
41288eea45cSKlaus Jensen }
41388eea45cSKlaus Jensen 
41488eea45cSKlaus Jensen static inline void *nvme_addr_to_pmr(NvmeCtrl *n, hwaddr addr)
41588eea45cSKlaus Jensen {
41688eea45cSKlaus Jensen     return memory_region_get_ram_ptr(&n->pmr.dev->mr) + (addr - n->pmr.cba);
41788eea45cSKlaus Jensen }
41888eea45cSKlaus Jensen 
419736b0164SKlaus Jensen static inline bool nvme_addr_is_iomem(NvmeCtrl *n, hwaddr addr)
420736b0164SKlaus Jensen {
421736b0164SKlaus Jensen     hwaddr hi, lo;
422736b0164SKlaus Jensen 
423736b0164SKlaus Jensen     /*
424736b0164SKlaus Jensen      * The purpose of this check is to guard against invalid "local" access to
425736b0164SKlaus Jensen      * the iomem (i.e. controller registers). Thus, we check against the range
426736b0164SKlaus Jensen      * covered by the 'bar0' MemoryRegion since that is currently composed of
427736b0164SKlaus Jensen      * two subregions (the NVMe "MBAR" and the MSI-X table/pba). Note, however,
428736b0164SKlaus Jensen      * that if the device model is ever changed to allow the CMB to be located
429736b0164SKlaus Jensen      * in BAR0 as well, then this must be changed.
430736b0164SKlaus Jensen      */
431736b0164SKlaus Jensen     lo = n->bar0.addr;
432736b0164SKlaus Jensen     hi = lo + int128_get64(n->bar0.size);
433736b0164SKlaus Jensen 
434736b0164SKlaus Jensen     return addr >= lo && addr < hi;
435736b0164SKlaus Jensen }
436736b0164SKlaus Jensen 
43788eea45cSKlaus Jensen static int nvme_addr_read(NvmeCtrl *n, hwaddr addr, void *buf, int size)
43888eea45cSKlaus Jensen {
43988eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
44088eea45cSKlaus Jensen     if (hi < addr) {
44188eea45cSKlaus Jensen         return 1;
44288eea45cSKlaus Jensen     }
44388eea45cSKlaus Jensen 
44488eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
44588eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_cmb(n, addr), size);
44688eea45cSKlaus Jensen         return 0;
44788eea45cSKlaus Jensen     }
44888eea45cSKlaus Jensen 
44988eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
45088eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_pmr(n, addr), size);
45188eea45cSKlaus Jensen         return 0;
45288eea45cSKlaus Jensen     }
45388eea45cSKlaus Jensen 
45448b32c28SKlaus Jensen     return pci_dma_read(PCI_DEVICE(n), addr, buf, size);
45588eea45cSKlaus Jensen }
45688eea45cSKlaus Jensen 
457e080ce86SPhilippe Mathieu-Daudé static int nvme_addr_write(NvmeCtrl *n, hwaddr addr, const void *buf, int size)
45888eea45cSKlaus Jensen {
45988eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
46088eea45cSKlaus Jensen     if (hi < addr) {
46188eea45cSKlaus Jensen         return 1;
46288eea45cSKlaus Jensen     }
46388eea45cSKlaus Jensen 
46488eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
46588eea45cSKlaus Jensen         memcpy(nvme_addr_to_cmb(n, addr), buf, size);
46688eea45cSKlaus Jensen         return 0;
46788eea45cSKlaus Jensen     }
46888eea45cSKlaus Jensen 
46988eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
47088eea45cSKlaus Jensen         memcpy(nvme_addr_to_pmr(n, addr), buf, size);
47188eea45cSKlaus Jensen         return 0;
47288eea45cSKlaus Jensen     }
47388eea45cSKlaus Jensen 
47448b32c28SKlaus Jensen     return pci_dma_write(PCI_DEVICE(n), addr, buf, size);
47588eea45cSKlaus Jensen }
47688eea45cSKlaus Jensen 
47788eea45cSKlaus Jensen static bool nvme_nsid_valid(NvmeCtrl *n, uint32_t nsid)
47888eea45cSKlaus Jensen {
47988eea45cSKlaus Jensen     return nsid &&
48088eea45cSKlaus Jensen         (nsid == NVME_NSID_BROADCAST || nsid <= NVME_MAX_NAMESPACES);
48188eea45cSKlaus Jensen }
48288eea45cSKlaus Jensen 
48388eea45cSKlaus Jensen static int nvme_check_sqid(NvmeCtrl *n, uint16_t sqid)
48488eea45cSKlaus Jensen {
485decc0261SŁukasz Gieryk     return sqid < n->conf_ioqpairs + 1 && n->sq[sqid] != NULL ? 0 : -1;
48688eea45cSKlaus Jensen }
48788eea45cSKlaus Jensen 
48888eea45cSKlaus Jensen static int nvme_check_cqid(NvmeCtrl *n, uint16_t cqid)
48988eea45cSKlaus Jensen {
490decc0261SŁukasz Gieryk     return cqid < n->conf_ioqpairs + 1 && n->cq[cqid] != NULL ? 0 : -1;
49188eea45cSKlaus Jensen }
49288eea45cSKlaus Jensen 
49388eea45cSKlaus Jensen static void nvme_inc_cq_tail(NvmeCQueue *cq)
49488eea45cSKlaus Jensen {
49588eea45cSKlaus Jensen     cq->tail++;
49688eea45cSKlaus Jensen     if (cq->tail >= cq->size) {
49788eea45cSKlaus Jensen         cq->tail = 0;
49888eea45cSKlaus Jensen         cq->phase = !cq->phase;
49988eea45cSKlaus Jensen     }
50088eea45cSKlaus Jensen }
50188eea45cSKlaus Jensen 
50288eea45cSKlaus Jensen static void nvme_inc_sq_head(NvmeSQueue *sq)
50388eea45cSKlaus Jensen {
50488eea45cSKlaus Jensen     sq->head = (sq->head + 1) % sq->size;
50588eea45cSKlaus Jensen }
50688eea45cSKlaus Jensen 
50788eea45cSKlaus Jensen static uint8_t nvme_cq_full(NvmeCQueue *cq)
50888eea45cSKlaus Jensen {
50988eea45cSKlaus Jensen     return (cq->tail + 1) % cq->size == cq->head;
51088eea45cSKlaus Jensen }
51188eea45cSKlaus Jensen 
51288eea45cSKlaus Jensen static uint8_t nvme_sq_empty(NvmeSQueue *sq)
51388eea45cSKlaus Jensen {
51488eea45cSKlaus Jensen     return sq->head == sq->tail;
51588eea45cSKlaus Jensen }
51688eea45cSKlaus Jensen 
51788eea45cSKlaus Jensen static void nvme_irq_check(NvmeCtrl *n)
51888eea45cSKlaus Jensen {
51948b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
52049e03457SKlaus Jensen     uint32_t intms = ldl_le_p(&n->bar.intms);
52149e03457SKlaus Jensen 
52248b32c28SKlaus Jensen     if (msix_enabled(pci)) {
52388eea45cSKlaus Jensen         return;
52488eea45cSKlaus Jensen     }
52549e03457SKlaus Jensen     if (~intms & n->irq_status) {
52648b32c28SKlaus Jensen         pci_irq_assert(pci);
52788eea45cSKlaus Jensen     } else {
52848b32c28SKlaus Jensen         pci_irq_deassert(pci);
52988eea45cSKlaus Jensen     }
53088eea45cSKlaus Jensen }
53188eea45cSKlaus Jensen 
53288eea45cSKlaus Jensen static void nvme_irq_assert(NvmeCtrl *n, NvmeCQueue *cq)
53388eea45cSKlaus Jensen {
53448b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
53548b32c28SKlaus Jensen 
53688eea45cSKlaus Jensen     if (cq->irq_enabled) {
53748b32c28SKlaus Jensen         if (msix_enabled(pci)) {
53888eea45cSKlaus Jensen             trace_pci_nvme_irq_msix(cq->vector);
53948b32c28SKlaus Jensen             msix_notify(pci, cq->vector);
54088eea45cSKlaus Jensen         } else {
54188eea45cSKlaus Jensen             trace_pci_nvme_irq_pin();
54288eea45cSKlaus Jensen             assert(cq->vector < 32);
54388eea45cSKlaus Jensen             n->irq_status |= 1 << cq->vector;
54488eea45cSKlaus Jensen             nvme_irq_check(n);
54588eea45cSKlaus Jensen         }
54688eea45cSKlaus Jensen     } else {
54788eea45cSKlaus Jensen         trace_pci_nvme_irq_masked();
54888eea45cSKlaus Jensen     }
54988eea45cSKlaus Jensen }
55088eea45cSKlaus Jensen 
55188eea45cSKlaus Jensen static void nvme_irq_deassert(NvmeCtrl *n, NvmeCQueue *cq)
55288eea45cSKlaus Jensen {
55388eea45cSKlaus Jensen     if (cq->irq_enabled) {
55448b32c28SKlaus Jensen         if (msix_enabled(PCI_DEVICE(n))) {
55588eea45cSKlaus Jensen             return;
55688eea45cSKlaus Jensen         } else {
55788eea45cSKlaus Jensen             assert(cq->vector < 32);
55883d7ed5cSKlaus Jensen             if (!n->cq_pending) {
55988eea45cSKlaus Jensen                 n->irq_status &= ~(1 << cq->vector);
56083d7ed5cSKlaus Jensen             }
56188eea45cSKlaus Jensen             nvme_irq_check(n);
56288eea45cSKlaus Jensen         }
56388eea45cSKlaus Jensen     }
56488eea45cSKlaus Jensen }
56588eea45cSKlaus Jensen 
56688eea45cSKlaus Jensen static void nvme_req_clear(NvmeRequest *req)
56788eea45cSKlaus Jensen {
56888eea45cSKlaus Jensen     req->ns = NULL;
56988eea45cSKlaus Jensen     req->opaque = NULL;
57088eea45cSKlaus Jensen     req->aiocb = NULL;
57188eea45cSKlaus Jensen     memset(&req->cqe, 0x0, sizeof(req->cqe));
57288eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
57388eea45cSKlaus Jensen }
57488eea45cSKlaus Jensen 
57588eea45cSKlaus Jensen static inline void nvme_sg_init(NvmeCtrl *n, NvmeSg *sg, bool dma)
57688eea45cSKlaus Jensen {
57788eea45cSKlaus Jensen     if (dma) {
57848b32c28SKlaus Jensen         pci_dma_sglist_init(&sg->qsg, PCI_DEVICE(n), 0);
57988eea45cSKlaus Jensen         sg->flags = NVME_SG_DMA;
58088eea45cSKlaus Jensen     } else {
58188eea45cSKlaus Jensen         qemu_iovec_init(&sg->iov, 0);
58288eea45cSKlaus Jensen     }
58388eea45cSKlaus Jensen 
58488eea45cSKlaus Jensen     sg->flags |= NVME_SG_ALLOC;
58588eea45cSKlaus Jensen }
58688eea45cSKlaus Jensen 
58788eea45cSKlaus Jensen static inline void nvme_sg_unmap(NvmeSg *sg)
58888eea45cSKlaus Jensen {
58988eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_ALLOC)) {
59088eea45cSKlaus Jensen         return;
59188eea45cSKlaus Jensen     }
59288eea45cSKlaus Jensen 
59388eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
59488eea45cSKlaus Jensen         qemu_sglist_destroy(&sg->qsg);
59588eea45cSKlaus Jensen     } else {
59688eea45cSKlaus Jensen         qemu_iovec_destroy(&sg->iov);
59788eea45cSKlaus Jensen     }
59888eea45cSKlaus Jensen 
59988eea45cSKlaus Jensen     memset(sg, 0x0, sizeof(*sg));
60088eea45cSKlaus Jensen }
60188eea45cSKlaus Jensen 
60288eea45cSKlaus Jensen /*
60388eea45cSKlaus Jensen  * When metadata is transfered as extended LBAs, the DPTR mapped into `sg`
60488eea45cSKlaus Jensen  * holds both data and metadata. This function splits the data and metadata
60588eea45cSKlaus Jensen  * into two separate QSG/IOVs.
60688eea45cSKlaus Jensen  */
60788eea45cSKlaus Jensen static void nvme_sg_split(NvmeSg *sg, NvmeNamespace *ns, NvmeSg *data,
60888eea45cSKlaus Jensen                           NvmeSg *mdata)
60988eea45cSKlaus Jensen {
61088eea45cSKlaus Jensen     NvmeSg *dst = data;
61188eea45cSKlaus Jensen     uint32_t trans_len, count = ns->lbasz;
61288eea45cSKlaus Jensen     uint64_t offset = 0;
61388eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
61488eea45cSKlaus Jensen     size_t sge_len;
61588eea45cSKlaus Jensen     size_t sg_len = dma ? sg->qsg.size : sg->iov.size;
61688eea45cSKlaus Jensen     int sg_idx = 0;
61788eea45cSKlaus Jensen 
61888eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
61988eea45cSKlaus Jensen 
62088eea45cSKlaus Jensen     while (sg_len) {
62188eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
62288eea45cSKlaus Jensen 
62388eea45cSKlaus Jensen         trans_len = MIN(sg_len, count);
62488eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
62588eea45cSKlaus Jensen 
62688eea45cSKlaus Jensen         if (dst) {
62788eea45cSKlaus Jensen             if (dma) {
62888eea45cSKlaus Jensen                 qemu_sglist_add(&dst->qsg, sg->qsg.sg[sg_idx].base + offset,
62988eea45cSKlaus Jensen                                 trans_len);
63088eea45cSKlaus Jensen             } else {
63188eea45cSKlaus Jensen                 qemu_iovec_add(&dst->iov,
63288eea45cSKlaus Jensen                                sg->iov.iov[sg_idx].iov_base + offset,
63388eea45cSKlaus Jensen                                trans_len);
63488eea45cSKlaus Jensen             }
63588eea45cSKlaus Jensen         }
63688eea45cSKlaus Jensen 
63788eea45cSKlaus Jensen         sg_len -= trans_len;
63888eea45cSKlaus Jensen         count -= trans_len;
63988eea45cSKlaus Jensen         offset += trans_len;
64088eea45cSKlaus Jensen 
64188eea45cSKlaus Jensen         if (count == 0) {
64288eea45cSKlaus Jensen             dst = (dst == data) ? mdata : data;
64388eea45cSKlaus Jensen             count = (dst == data) ? ns->lbasz : ns->lbaf.ms;
64488eea45cSKlaus Jensen         }
64588eea45cSKlaus Jensen 
64688eea45cSKlaus Jensen         if (sge_len == offset) {
64788eea45cSKlaus Jensen             offset = 0;
64888eea45cSKlaus Jensen             sg_idx++;
64988eea45cSKlaus Jensen         }
65088eea45cSKlaus Jensen     }
65188eea45cSKlaus Jensen }
65288eea45cSKlaus Jensen 
65388eea45cSKlaus Jensen static uint16_t nvme_map_addr_cmb(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
65488eea45cSKlaus Jensen                                   size_t len)
65588eea45cSKlaus Jensen {
65688eea45cSKlaus Jensen     if (!len) {
65788eea45cSKlaus Jensen         return NVME_SUCCESS;
65888eea45cSKlaus Jensen     }
65988eea45cSKlaus Jensen 
66088eea45cSKlaus Jensen     trace_pci_nvme_map_addr_cmb(addr, len);
66188eea45cSKlaus Jensen 
66288eea45cSKlaus Jensen     if (!nvme_addr_is_cmb(n, addr) || !nvme_addr_is_cmb(n, addr + len - 1)) {
66388eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
66488eea45cSKlaus Jensen     }
66588eea45cSKlaus Jensen 
66688eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_cmb(n, addr), len);
66788eea45cSKlaus Jensen 
66888eea45cSKlaus Jensen     return NVME_SUCCESS;
66988eea45cSKlaus Jensen }
67088eea45cSKlaus Jensen 
67188eea45cSKlaus Jensen static uint16_t nvme_map_addr_pmr(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
67288eea45cSKlaus Jensen                                   size_t len)
67388eea45cSKlaus Jensen {
67488eea45cSKlaus Jensen     if (!len) {
67588eea45cSKlaus Jensen         return NVME_SUCCESS;
67688eea45cSKlaus Jensen     }
67788eea45cSKlaus Jensen 
67888eea45cSKlaus Jensen     if (!nvme_addr_is_pmr(n, addr) || !nvme_addr_is_pmr(n, addr + len - 1)) {
67988eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
68088eea45cSKlaus Jensen     }
68188eea45cSKlaus Jensen 
68288eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_pmr(n, addr), len);
68388eea45cSKlaus Jensen 
68488eea45cSKlaus Jensen     return NVME_SUCCESS;
68588eea45cSKlaus Jensen }
68688eea45cSKlaus Jensen 
68788eea45cSKlaus Jensen static uint16_t nvme_map_addr(NvmeCtrl *n, NvmeSg *sg, hwaddr addr, size_t len)
68888eea45cSKlaus Jensen {
68988eea45cSKlaus Jensen     bool cmb = false, pmr = false;
69088eea45cSKlaus Jensen 
69188eea45cSKlaus Jensen     if (!len) {
69288eea45cSKlaus Jensen         return NVME_SUCCESS;
69388eea45cSKlaus Jensen     }
69488eea45cSKlaus Jensen 
69588eea45cSKlaus Jensen     trace_pci_nvme_map_addr(addr, len);
69688eea45cSKlaus Jensen 
697736b0164SKlaus Jensen     if (nvme_addr_is_iomem(n, addr)) {
698736b0164SKlaus Jensen         return NVME_DATA_TRAS_ERROR;
699736b0164SKlaus Jensen     }
700736b0164SKlaus Jensen 
70188eea45cSKlaus Jensen     if (nvme_addr_is_cmb(n, addr)) {
70288eea45cSKlaus Jensen         cmb = true;
70388eea45cSKlaus Jensen     } else if (nvme_addr_is_pmr(n, addr)) {
70488eea45cSKlaus Jensen         pmr = true;
70588eea45cSKlaus Jensen     }
70688eea45cSKlaus Jensen 
70788eea45cSKlaus Jensen     if (cmb || pmr) {
70888eea45cSKlaus Jensen         if (sg->flags & NVME_SG_DMA) {
70988eea45cSKlaus Jensen             return NVME_INVALID_USE_OF_CMB | NVME_DNR;
71088eea45cSKlaus Jensen         }
71188eea45cSKlaus Jensen 
71223421473SPadmakar Kalghatgi         if (sg->iov.niov + 1 > IOV_MAX) {
71323421473SPadmakar Kalghatgi             goto max_mappings_exceeded;
71423421473SPadmakar Kalghatgi         }
71523421473SPadmakar Kalghatgi 
71688eea45cSKlaus Jensen         if (cmb) {
71788eea45cSKlaus Jensen             return nvme_map_addr_cmb(n, &sg->iov, addr, len);
71888eea45cSKlaus Jensen         } else {
71988eea45cSKlaus Jensen             return nvme_map_addr_pmr(n, &sg->iov, addr, len);
72088eea45cSKlaus Jensen         }
72188eea45cSKlaus Jensen     }
72288eea45cSKlaus Jensen 
72388eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_DMA)) {
72488eea45cSKlaus Jensen         return NVME_INVALID_USE_OF_CMB | NVME_DNR;
72588eea45cSKlaus Jensen     }
72688eea45cSKlaus Jensen 
72723421473SPadmakar Kalghatgi     if (sg->qsg.nsg + 1 > IOV_MAX) {
72823421473SPadmakar Kalghatgi         goto max_mappings_exceeded;
72923421473SPadmakar Kalghatgi     }
73023421473SPadmakar Kalghatgi 
73188eea45cSKlaus Jensen     qemu_sglist_add(&sg->qsg, addr, len);
73288eea45cSKlaus Jensen 
73388eea45cSKlaus Jensen     return NVME_SUCCESS;
73423421473SPadmakar Kalghatgi 
73523421473SPadmakar Kalghatgi max_mappings_exceeded:
73623421473SPadmakar Kalghatgi     NVME_GUEST_ERR(pci_nvme_ub_too_many_mappings,
73723421473SPadmakar Kalghatgi                    "number of mappings exceed 1024");
73823421473SPadmakar Kalghatgi     return NVME_INTERNAL_DEV_ERROR | NVME_DNR;
73988eea45cSKlaus Jensen }
74088eea45cSKlaus Jensen 
74188eea45cSKlaus Jensen static inline bool nvme_addr_is_dma(NvmeCtrl *n, hwaddr addr)
74288eea45cSKlaus Jensen {
74388eea45cSKlaus Jensen     return !(nvme_addr_is_cmb(n, addr) || nvme_addr_is_pmr(n, addr));
74488eea45cSKlaus Jensen }
74588eea45cSKlaus Jensen 
74688eea45cSKlaus Jensen static uint16_t nvme_map_prp(NvmeCtrl *n, NvmeSg *sg, uint64_t prp1,
74788eea45cSKlaus Jensen                              uint64_t prp2, uint32_t len)
74888eea45cSKlaus Jensen {
74988eea45cSKlaus Jensen     hwaddr trans_len = n->page_size - (prp1 % n->page_size);
75088eea45cSKlaus Jensen     trans_len = MIN(len, trans_len);
75188eea45cSKlaus Jensen     int num_prps = (len >> n->page_bits) + 1;
75288eea45cSKlaus Jensen     uint16_t status;
75388eea45cSKlaus Jensen     int ret;
75488eea45cSKlaus Jensen 
75588eea45cSKlaus Jensen     trace_pci_nvme_map_prp(trans_len, len, prp1, prp2, num_prps);
75688eea45cSKlaus Jensen 
75788eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, prp1));
75888eea45cSKlaus Jensen 
75988eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, prp1, trans_len);
76088eea45cSKlaus Jensen     if (status) {
76188eea45cSKlaus Jensen         goto unmap;
76288eea45cSKlaus Jensen     }
76388eea45cSKlaus Jensen 
76488eea45cSKlaus Jensen     len -= trans_len;
76588eea45cSKlaus Jensen     if (len) {
76688eea45cSKlaus Jensen         if (len > n->page_size) {
76788eea45cSKlaus Jensen             uint64_t prp_list[n->max_prp_ents];
76888eea45cSKlaus Jensen             uint32_t nents, prp_trans;
76988eea45cSKlaus Jensen             int i = 0;
77088eea45cSKlaus Jensen 
77188eea45cSKlaus Jensen             /*
77288eea45cSKlaus Jensen              * The first PRP list entry, pointed to by PRP2 may contain offset.
77388eea45cSKlaus Jensen              * Hence, we need to calculate the number of entries in based on
77488eea45cSKlaus Jensen              * that offset.
77588eea45cSKlaus Jensen              */
77688eea45cSKlaus Jensen             nents = (n->page_size - (prp2 & (n->page_size - 1))) >> 3;
77788eea45cSKlaus Jensen             prp_trans = MIN(n->max_prp_ents, nents) * sizeof(uint64_t);
77888eea45cSKlaus Jensen             ret = nvme_addr_read(n, prp2, (void *)prp_list, prp_trans);
77988eea45cSKlaus Jensen             if (ret) {
78088eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(prp2);
78188eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
78288eea45cSKlaus Jensen                 goto unmap;
78388eea45cSKlaus Jensen             }
78488eea45cSKlaus Jensen             while (len != 0) {
78588eea45cSKlaus Jensen                 uint64_t prp_ent = le64_to_cpu(prp_list[i]);
78688eea45cSKlaus Jensen 
78788eea45cSKlaus Jensen                 if (i == nents - 1 && len > n->page_size) {
78888eea45cSKlaus Jensen                     if (unlikely(prp_ent & (n->page_size - 1))) {
78988eea45cSKlaus Jensen                         trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
79088eea45cSKlaus Jensen                         status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
79188eea45cSKlaus Jensen                         goto unmap;
79288eea45cSKlaus Jensen                     }
79388eea45cSKlaus Jensen 
79488eea45cSKlaus Jensen                     i = 0;
79588eea45cSKlaus Jensen                     nents = (len + n->page_size - 1) >> n->page_bits;
79688eea45cSKlaus Jensen                     nents = MIN(nents, n->max_prp_ents);
79788eea45cSKlaus Jensen                     prp_trans = nents * sizeof(uint64_t);
79888eea45cSKlaus Jensen                     ret = nvme_addr_read(n, prp_ent, (void *)prp_list,
79988eea45cSKlaus Jensen                                          prp_trans);
80088eea45cSKlaus Jensen                     if (ret) {
80188eea45cSKlaus Jensen                         trace_pci_nvme_err_addr_read(prp_ent);
80288eea45cSKlaus Jensen                         status = NVME_DATA_TRAS_ERROR;
80388eea45cSKlaus Jensen                         goto unmap;
80488eea45cSKlaus Jensen                     }
80588eea45cSKlaus Jensen                     prp_ent = le64_to_cpu(prp_list[i]);
80688eea45cSKlaus Jensen                 }
80788eea45cSKlaus Jensen 
80888eea45cSKlaus Jensen                 if (unlikely(prp_ent & (n->page_size - 1))) {
80988eea45cSKlaus Jensen                     trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
81088eea45cSKlaus Jensen                     status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
81188eea45cSKlaus Jensen                     goto unmap;
81288eea45cSKlaus Jensen                 }
81388eea45cSKlaus Jensen 
81488eea45cSKlaus Jensen                 trans_len = MIN(len, n->page_size);
81588eea45cSKlaus Jensen                 status = nvme_map_addr(n, sg, prp_ent, trans_len);
81688eea45cSKlaus Jensen                 if (status) {
81788eea45cSKlaus Jensen                     goto unmap;
81888eea45cSKlaus Jensen                 }
81988eea45cSKlaus Jensen 
82088eea45cSKlaus Jensen                 len -= trans_len;
82188eea45cSKlaus Jensen                 i++;
82288eea45cSKlaus Jensen             }
82388eea45cSKlaus Jensen         } else {
82488eea45cSKlaus Jensen             if (unlikely(prp2 & (n->page_size - 1))) {
82588eea45cSKlaus Jensen                 trace_pci_nvme_err_invalid_prp2_align(prp2);
82688eea45cSKlaus Jensen                 status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
82788eea45cSKlaus Jensen                 goto unmap;
82888eea45cSKlaus Jensen             }
82988eea45cSKlaus Jensen             status = nvme_map_addr(n, sg, prp2, len);
83088eea45cSKlaus Jensen             if (status) {
83188eea45cSKlaus Jensen                 goto unmap;
83288eea45cSKlaus Jensen             }
83388eea45cSKlaus Jensen         }
83488eea45cSKlaus Jensen     }
83588eea45cSKlaus Jensen 
83688eea45cSKlaus Jensen     return NVME_SUCCESS;
83788eea45cSKlaus Jensen 
83888eea45cSKlaus Jensen unmap:
83988eea45cSKlaus Jensen     nvme_sg_unmap(sg);
84088eea45cSKlaus Jensen     return status;
84188eea45cSKlaus Jensen }
84288eea45cSKlaus Jensen 
84388eea45cSKlaus Jensen /*
84488eea45cSKlaus Jensen  * Map 'nsgld' data descriptors from 'segment'. The function will subtract the
84588eea45cSKlaus Jensen  * number of bytes mapped in len.
84688eea45cSKlaus Jensen  */
84788eea45cSKlaus Jensen static uint16_t nvme_map_sgl_data(NvmeCtrl *n, NvmeSg *sg,
84888eea45cSKlaus Jensen                                   NvmeSglDescriptor *segment, uint64_t nsgld,
84988eea45cSKlaus Jensen                                   size_t *len, NvmeCmd *cmd)
85088eea45cSKlaus Jensen {
85188eea45cSKlaus Jensen     dma_addr_t addr, trans_len;
85288eea45cSKlaus Jensen     uint32_t dlen;
85388eea45cSKlaus Jensen     uint16_t status;
85488eea45cSKlaus Jensen 
85588eea45cSKlaus Jensen     for (int i = 0; i < nsgld; i++) {
85688eea45cSKlaus Jensen         uint8_t type = NVME_SGL_TYPE(segment[i].type);
85788eea45cSKlaus Jensen 
85888eea45cSKlaus Jensen         switch (type) {
85988eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_DATA_BLOCK:
86088eea45cSKlaus Jensen             break;
86188eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
86288eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
86388eea45cSKlaus Jensen             return NVME_INVALID_NUM_SGL_DESCRS | NVME_DNR;
86488eea45cSKlaus Jensen         default:
86588eea45cSKlaus Jensen             return NVME_SGL_DESCR_TYPE_INVALID | NVME_DNR;
86688eea45cSKlaus Jensen         }
86788eea45cSKlaus Jensen 
86888eea45cSKlaus Jensen         dlen = le32_to_cpu(segment[i].len);
86988eea45cSKlaus Jensen 
87088eea45cSKlaus Jensen         if (!dlen) {
87188eea45cSKlaus Jensen             continue;
87288eea45cSKlaus Jensen         }
87388eea45cSKlaus Jensen 
87488eea45cSKlaus Jensen         if (*len == 0) {
87588eea45cSKlaus Jensen             /*
87688eea45cSKlaus Jensen              * All data has been mapped, but the SGL contains additional
87788eea45cSKlaus Jensen              * segments and/or descriptors. The controller might accept
87888eea45cSKlaus Jensen              * ignoring the rest of the SGL.
87988eea45cSKlaus Jensen              */
88088eea45cSKlaus Jensen             uint32_t sgls = le32_to_cpu(n->id_ctrl.sgls);
88188eea45cSKlaus Jensen             if (sgls & NVME_CTRL_SGLS_EXCESS_LENGTH) {
88288eea45cSKlaus Jensen                 break;
88388eea45cSKlaus Jensen             }
88488eea45cSKlaus Jensen 
88588eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_sgl_excess_length(dlen);
88688eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
88788eea45cSKlaus Jensen         }
88888eea45cSKlaus Jensen 
88988eea45cSKlaus Jensen         trans_len = MIN(*len, dlen);
89088eea45cSKlaus Jensen 
89188eea45cSKlaus Jensen         addr = le64_to_cpu(segment[i].addr);
89288eea45cSKlaus Jensen 
89388eea45cSKlaus Jensen         if (UINT64_MAX - addr < dlen) {
89488eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
89588eea45cSKlaus Jensen         }
89688eea45cSKlaus Jensen 
89788eea45cSKlaus Jensen         status = nvme_map_addr(n, sg, addr, trans_len);
89888eea45cSKlaus Jensen         if (status) {
89988eea45cSKlaus Jensen             return status;
90088eea45cSKlaus Jensen         }
90188eea45cSKlaus Jensen 
90288eea45cSKlaus Jensen         *len -= trans_len;
90388eea45cSKlaus Jensen     }
90488eea45cSKlaus Jensen 
90588eea45cSKlaus Jensen     return NVME_SUCCESS;
90688eea45cSKlaus Jensen }
90788eea45cSKlaus Jensen 
90888eea45cSKlaus Jensen static uint16_t nvme_map_sgl(NvmeCtrl *n, NvmeSg *sg, NvmeSglDescriptor sgl,
90988eea45cSKlaus Jensen                              size_t len, NvmeCmd *cmd)
91088eea45cSKlaus Jensen {
91188eea45cSKlaus Jensen     /*
91288eea45cSKlaus Jensen      * Read the segment in chunks of 256 descriptors (one 4k page) to avoid
91388eea45cSKlaus Jensen      * dynamically allocating a potentially huge SGL. The spec allows the SGL
91488eea45cSKlaus Jensen      * to be larger (as in number of bytes required to describe the SGL
91588eea45cSKlaus Jensen      * descriptors and segment chain) than the command transfer size, so it is
91688eea45cSKlaus Jensen      * not bounded by MDTS.
91788eea45cSKlaus Jensen      */
91888eea45cSKlaus Jensen     const int SEG_CHUNK_SIZE = 256;
91988eea45cSKlaus Jensen 
92088eea45cSKlaus Jensen     NvmeSglDescriptor segment[SEG_CHUNK_SIZE], *sgld, *last_sgld;
92188eea45cSKlaus Jensen     uint64_t nsgld;
92288eea45cSKlaus Jensen     uint32_t seg_len;
92388eea45cSKlaus Jensen     uint16_t status;
92488eea45cSKlaus Jensen     hwaddr addr;
92588eea45cSKlaus Jensen     int ret;
92688eea45cSKlaus Jensen 
92788eea45cSKlaus Jensen     sgld = &sgl;
92888eea45cSKlaus Jensen     addr = le64_to_cpu(sgl.addr);
92988eea45cSKlaus Jensen 
93088eea45cSKlaus Jensen     trace_pci_nvme_map_sgl(NVME_SGL_TYPE(sgl.type), len);
93188eea45cSKlaus Jensen 
93288eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, addr));
93388eea45cSKlaus Jensen 
93488eea45cSKlaus Jensen     /*
93588eea45cSKlaus Jensen      * If the entire transfer can be described with a single data block it can
93688eea45cSKlaus Jensen      * be mapped directly.
93788eea45cSKlaus Jensen      */
93888eea45cSKlaus Jensen     if (NVME_SGL_TYPE(sgl.type) == NVME_SGL_DESCR_TYPE_DATA_BLOCK) {
93988eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, sgld, 1, &len, cmd);
94088eea45cSKlaus Jensen         if (status) {
94188eea45cSKlaus Jensen             goto unmap;
94288eea45cSKlaus Jensen         }
94388eea45cSKlaus Jensen 
94488eea45cSKlaus Jensen         goto out;
94588eea45cSKlaus Jensen     }
94688eea45cSKlaus Jensen 
94788eea45cSKlaus Jensen     for (;;) {
94888eea45cSKlaus Jensen         switch (NVME_SGL_TYPE(sgld->type)) {
94988eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
95088eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
95188eea45cSKlaus Jensen             break;
95288eea45cSKlaus Jensen         default:
95388eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
95488eea45cSKlaus Jensen         }
95588eea45cSKlaus Jensen 
95688eea45cSKlaus Jensen         seg_len = le32_to_cpu(sgld->len);
95788eea45cSKlaus Jensen 
95888eea45cSKlaus Jensen         /* check the length of the (Last) Segment descriptor */
959b9147a3aSKlaus Jensen         if (!seg_len || seg_len & 0xf) {
96088eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
96188eea45cSKlaus Jensen         }
96288eea45cSKlaus Jensen 
96388eea45cSKlaus Jensen         if (UINT64_MAX - addr < seg_len) {
96488eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
96588eea45cSKlaus Jensen         }
96688eea45cSKlaus Jensen 
96788eea45cSKlaus Jensen         nsgld = seg_len / sizeof(NvmeSglDescriptor);
96888eea45cSKlaus Jensen 
96988eea45cSKlaus Jensen         while (nsgld > SEG_CHUNK_SIZE) {
97088eea45cSKlaus Jensen             if (nvme_addr_read(n, addr, segment, sizeof(segment))) {
97188eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(addr);
97288eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
97388eea45cSKlaus Jensen                 goto unmap;
97488eea45cSKlaus Jensen             }
97588eea45cSKlaus Jensen 
97688eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, SEG_CHUNK_SIZE,
97788eea45cSKlaus Jensen                                        &len, cmd);
97888eea45cSKlaus Jensen             if (status) {
97988eea45cSKlaus Jensen                 goto unmap;
98088eea45cSKlaus Jensen             }
98188eea45cSKlaus Jensen 
98288eea45cSKlaus Jensen             nsgld -= SEG_CHUNK_SIZE;
98388eea45cSKlaus Jensen             addr += SEG_CHUNK_SIZE * sizeof(NvmeSglDescriptor);
98488eea45cSKlaus Jensen         }
98588eea45cSKlaus Jensen 
98688eea45cSKlaus Jensen         ret = nvme_addr_read(n, addr, segment, nsgld *
98788eea45cSKlaus Jensen                              sizeof(NvmeSglDescriptor));
98888eea45cSKlaus Jensen         if (ret) {
98988eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
99088eea45cSKlaus Jensen             status = NVME_DATA_TRAS_ERROR;
99188eea45cSKlaus Jensen             goto unmap;
99288eea45cSKlaus Jensen         }
99388eea45cSKlaus Jensen 
99488eea45cSKlaus Jensen         last_sgld = &segment[nsgld - 1];
99588eea45cSKlaus Jensen 
99688eea45cSKlaus Jensen         /*
997b9147a3aSKlaus Jensen          * If the segment ends with a Data Block, then we are done.
99888eea45cSKlaus Jensen          */
999b9147a3aSKlaus Jensen         if (NVME_SGL_TYPE(last_sgld->type) == NVME_SGL_DESCR_TYPE_DATA_BLOCK) {
100088eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, nsgld, &len, cmd);
100188eea45cSKlaus Jensen             if (status) {
100288eea45cSKlaus Jensen                 goto unmap;
100388eea45cSKlaus Jensen             }
100488eea45cSKlaus Jensen 
100588eea45cSKlaus Jensen             goto out;
100688eea45cSKlaus Jensen         }
100788eea45cSKlaus Jensen 
100888eea45cSKlaus Jensen         /*
1009b9147a3aSKlaus Jensen          * If the last descriptor was not a Data Block, then the current
1010b9147a3aSKlaus Jensen          * segment must not be a Last Segment.
101188eea45cSKlaus Jensen          */
101288eea45cSKlaus Jensen         if (NVME_SGL_TYPE(sgld->type) == NVME_SGL_DESCR_TYPE_LAST_SEGMENT) {
101388eea45cSKlaus Jensen             status = NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
101488eea45cSKlaus Jensen             goto unmap;
101588eea45cSKlaus Jensen         }
101688eea45cSKlaus Jensen 
101788eea45cSKlaus Jensen         sgld = last_sgld;
101888eea45cSKlaus Jensen         addr = le64_to_cpu(sgld->addr);
101988eea45cSKlaus Jensen 
102088eea45cSKlaus Jensen         /*
102188eea45cSKlaus Jensen          * Do not map the last descriptor; it will be a Segment or Last Segment
102288eea45cSKlaus Jensen          * descriptor and is handled by the next iteration.
102388eea45cSKlaus Jensen          */
102488eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, segment, nsgld - 1, &len, cmd);
102588eea45cSKlaus Jensen         if (status) {
102688eea45cSKlaus Jensen             goto unmap;
102788eea45cSKlaus Jensen         }
102888eea45cSKlaus Jensen     }
102988eea45cSKlaus Jensen 
103088eea45cSKlaus Jensen out:
103188eea45cSKlaus Jensen     /* if there is any residual left in len, the SGL was too short */
103288eea45cSKlaus Jensen     if (len) {
103388eea45cSKlaus Jensen         status = NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
103488eea45cSKlaus Jensen         goto unmap;
103588eea45cSKlaus Jensen     }
103688eea45cSKlaus Jensen 
103788eea45cSKlaus Jensen     return NVME_SUCCESS;
103888eea45cSKlaus Jensen 
103988eea45cSKlaus Jensen unmap:
104088eea45cSKlaus Jensen     nvme_sg_unmap(sg);
104188eea45cSKlaus Jensen     return status;
104288eea45cSKlaus Jensen }
104388eea45cSKlaus Jensen 
104488eea45cSKlaus Jensen uint16_t nvme_map_dptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
104588eea45cSKlaus Jensen                        NvmeCmd *cmd)
104688eea45cSKlaus Jensen {
104788eea45cSKlaus Jensen     uint64_t prp1, prp2;
104888eea45cSKlaus Jensen 
104988eea45cSKlaus Jensen     switch (NVME_CMD_FLAGS_PSDT(cmd->flags)) {
105088eea45cSKlaus Jensen     case NVME_PSDT_PRP:
105188eea45cSKlaus Jensen         prp1 = le64_to_cpu(cmd->dptr.prp1);
105288eea45cSKlaus Jensen         prp2 = le64_to_cpu(cmd->dptr.prp2);
105388eea45cSKlaus Jensen 
105488eea45cSKlaus Jensen         return nvme_map_prp(n, sg, prp1, prp2, len);
105588eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_CONTIGUOUS:
105688eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_SGL:
105788eea45cSKlaus Jensen         return nvme_map_sgl(n, sg, cmd->dptr.sgl, len, cmd);
105888eea45cSKlaus Jensen     default:
105988eea45cSKlaus Jensen         return NVME_INVALID_FIELD;
106088eea45cSKlaus Jensen     }
106188eea45cSKlaus Jensen }
106288eea45cSKlaus Jensen 
106388eea45cSKlaus Jensen static uint16_t nvme_map_mptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
106488eea45cSKlaus Jensen                               NvmeCmd *cmd)
106588eea45cSKlaus Jensen {
106688eea45cSKlaus Jensen     int psdt = NVME_CMD_FLAGS_PSDT(cmd->flags);
106788eea45cSKlaus Jensen     hwaddr mptr = le64_to_cpu(cmd->mptr);
106888eea45cSKlaus Jensen     uint16_t status;
106988eea45cSKlaus Jensen 
107088eea45cSKlaus Jensen     if (psdt == NVME_PSDT_SGL_MPTR_SGL) {
107188eea45cSKlaus Jensen         NvmeSglDescriptor sgl;
107288eea45cSKlaus Jensen 
107388eea45cSKlaus Jensen         if (nvme_addr_read(n, mptr, &sgl, sizeof(sgl))) {
107488eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
107588eea45cSKlaus Jensen         }
107688eea45cSKlaus Jensen 
107788eea45cSKlaus Jensen         status = nvme_map_sgl(n, sg, sgl, len, cmd);
107888eea45cSKlaus Jensen         if (status && (status & 0x7ff) == NVME_DATA_SGL_LEN_INVALID) {
107988eea45cSKlaus Jensen             status = NVME_MD_SGL_LEN_INVALID | NVME_DNR;
108088eea45cSKlaus Jensen         }
108188eea45cSKlaus Jensen 
108288eea45cSKlaus Jensen         return status;
108388eea45cSKlaus Jensen     }
108488eea45cSKlaus Jensen 
108588eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, mptr));
108688eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, mptr, len);
108788eea45cSKlaus Jensen     if (status) {
108888eea45cSKlaus Jensen         nvme_sg_unmap(sg);
108988eea45cSKlaus Jensen     }
109088eea45cSKlaus Jensen 
109188eea45cSKlaus Jensen     return status;
109288eea45cSKlaus Jensen }
109388eea45cSKlaus Jensen 
109488eea45cSKlaus Jensen static uint16_t nvme_map_data(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
109588eea45cSKlaus Jensen {
109688eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
109788eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
10982a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
10992a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
110088eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
110188eea45cSKlaus Jensen     uint16_t status;
110288eea45cSKlaus Jensen 
1103ac0b34c5SKlaus Jensen     if (nvme_ns_ext(ns) &&
1104ac0b34c5SKlaus Jensen         !(pi && pract && ns->lbaf.ms == nvme_pi_tuple_size(ns))) {
110588eea45cSKlaus Jensen         NvmeSg sg;
110688eea45cSKlaus Jensen 
110788eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
110888eea45cSKlaus Jensen 
110988eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
111088eea45cSKlaus Jensen         if (status) {
111188eea45cSKlaus Jensen             return status;
111288eea45cSKlaus Jensen         }
111388eea45cSKlaus Jensen 
111488eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
111588eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, &req->sg, NULL);
111688eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
111788eea45cSKlaus Jensen 
111888eea45cSKlaus Jensen         return NVME_SUCCESS;
111988eea45cSKlaus Jensen     }
112088eea45cSKlaus Jensen 
112188eea45cSKlaus Jensen     return nvme_map_dptr(n, &req->sg, len, &req->cmd);
112288eea45cSKlaus Jensen }
112388eea45cSKlaus Jensen 
112488eea45cSKlaus Jensen static uint16_t nvme_map_mdata(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
112588eea45cSKlaus Jensen {
112688eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
112788eea45cSKlaus Jensen     size_t len = nvme_m2b(ns, nlb);
112888eea45cSKlaus Jensen     uint16_t status;
112988eea45cSKlaus Jensen 
113088eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
113188eea45cSKlaus Jensen         NvmeSg sg;
113288eea45cSKlaus Jensen 
113388eea45cSKlaus Jensen         len += nvme_l2b(ns, nlb);
113488eea45cSKlaus Jensen 
113588eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
113688eea45cSKlaus Jensen         if (status) {
113788eea45cSKlaus Jensen             return status;
113888eea45cSKlaus Jensen         }
113988eea45cSKlaus Jensen 
114088eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
114188eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, NULL, &req->sg);
114288eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
114388eea45cSKlaus Jensen 
114488eea45cSKlaus Jensen         return NVME_SUCCESS;
114588eea45cSKlaus Jensen     }
114688eea45cSKlaus Jensen 
114788eea45cSKlaus Jensen     return nvme_map_mptr(n, &req->sg, len, &req->cmd);
114888eea45cSKlaus Jensen }
114988eea45cSKlaus Jensen 
115088eea45cSKlaus Jensen static uint16_t nvme_tx_interleaved(NvmeCtrl *n, NvmeSg *sg, uint8_t *ptr,
115188eea45cSKlaus Jensen                                     uint32_t len, uint32_t bytes,
115288eea45cSKlaus Jensen                                     int32_t skip_bytes, int64_t offset,
115388eea45cSKlaus Jensen                                     NvmeTxDirection dir)
115488eea45cSKlaus Jensen {
115588eea45cSKlaus Jensen     hwaddr addr;
115688eea45cSKlaus Jensen     uint32_t trans_len, count = bytes;
115788eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
115888eea45cSKlaus Jensen     int64_t sge_len;
115988eea45cSKlaus Jensen     int sg_idx = 0;
116088eea45cSKlaus Jensen     int ret;
116188eea45cSKlaus Jensen 
116288eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
116388eea45cSKlaus Jensen 
116488eea45cSKlaus Jensen     while (len) {
116588eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
116688eea45cSKlaus Jensen 
116788eea45cSKlaus Jensen         if (sge_len - offset < 0) {
116888eea45cSKlaus Jensen             offset -= sge_len;
116988eea45cSKlaus Jensen             sg_idx++;
117088eea45cSKlaus Jensen             continue;
117188eea45cSKlaus Jensen         }
117288eea45cSKlaus Jensen 
117388eea45cSKlaus Jensen         if (sge_len == offset) {
117488eea45cSKlaus Jensen             offset = 0;
117588eea45cSKlaus Jensen             sg_idx++;
117688eea45cSKlaus Jensen             continue;
117788eea45cSKlaus Jensen         }
117888eea45cSKlaus Jensen 
117988eea45cSKlaus Jensen         trans_len = MIN(len, count);
118088eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
118188eea45cSKlaus Jensen 
118288eea45cSKlaus Jensen         if (dma) {
118388eea45cSKlaus Jensen             addr = sg->qsg.sg[sg_idx].base + offset;
118488eea45cSKlaus Jensen         } else {
118588eea45cSKlaus Jensen             addr = (hwaddr)(uintptr_t)sg->iov.iov[sg_idx].iov_base + offset;
118688eea45cSKlaus Jensen         }
118788eea45cSKlaus Jensen 
118888eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
118988eea45cSKlaus Jensen             ret = nvme_addr_read(n, addr, ptr, trans_len);
119088eea45cSKlaus Jensen         } else {
119188eea45cSKlaus Jensen             ret = nvme_addr_write(n, addr, ptr, trans_len);
119288eea45cSKlaus Jensen         }
119388eea45cSKlaus Jensen 
119488eea45cSKlaus Jensen         if (ret) {
119588eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
119688eea45cSKlaus Jensen         }
119788eea45cSKlaus Jensen 
119888eea45cSKlaus Jensen         ptr += trans_len;
119988eea45cSKlaus Jensen         len -= trans_len;
120088eea45cSKlaus Jensen         count -= trans_len;
120188eea45cSKlaus Jensen         offset += trans_len;
120288eea45cSKlaus Jensen 
120388eea45cSKlaus Jensen         if (count == 0) {
120488eea45cSKlaus Jensen             count = bytes;
120588eea45cSKlaus Jensen             offset += skip_bytes;
120688eea45cSKlaus Jensen         }
120788eea45cSKlaus Jensen     }
120888eea45cSKlaus Jensen 
120988eea45cSKlaus Jensen     return NVME_SUCCESS;
121088eea45cSKlaus Jensen }
121188eea45cSKlaus Jensen 
12128d3a17beSPhilippe Mathieu-Daudé static uint16_t nvme_tx(NvmeCtrl *n, NvmeSg *sg, void *ptr, uint32_t len,
121388eea45cSKlaus Jensen                         NvmeTxDirection dir)
121488eea45cSKlaus Jensen {
121588eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
121688eea45cSKlaus Jensen 
121788eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
1218392e48afSPhilippe Mathieu-Daudé         const MemTxAttrs attrs = MEMTXATTRS_UNSPECIFIED;
1219bfa30f39SPhilippe Mathieu-Daudé         dma_addr_t residual;
122088eea45cSKlaus Jensen 
122188eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
1222f02b664aSPhilippe Mathieu-Daudé             dma_buf_write(ptr, len, &residual, &sg->qsg, attrs);
122388eea45cSKlaus Jensen         } else {
1224f02b664aSPhilippe Mathieu-Daudé             dma_buf_read(ptr, len, &residual, &sg->qsg, attrs);
122588eea45cSKlaus Jensen         }
122688eea45cSKlaus Jensen 
122788eea45cSKlaus Jensen         if (unlikely(residual)) {
122888eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
122988eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
123088eea45cSKlaus Jensen         }
123188eea45cSKlaus Jensen     } else {
123288eea45cSKlaus Jensen         size_t bytes;
123388eea45cSKlaus Jensen 
123488eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
123588eea45cSKlaus Jensen             bytes = qemu_iovec_to_buf(&sg->iov, 0, ptr, len);
123688eea45cSKlaus Jensen         } else {
123788eea45cSKlaus Jensen             bytes = qemu_iovec_from_buf(&sg->iov, 0, ptr, len);
123888eea45cSKlaus Jensen         }
123988eea45cSKlaus Jensen 
124088eea45cSKlaus Jensen         if (unlikely(bytes != len)) {
124188eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
124288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
124388eea45cSKlaus Jensen         }
124488eea45cSKlaus Jensen     }
124588eea45cSKlaus Jensen 
124688eea45cSKlaus Jensen     return NVME_SUCCESS;
124788eea45cSKlaus Jensen }
124888eea45cSKlaus Jensen 
12498d3a17beSPhilippe Mathieu-Daudé static inline uint16_t nvme_c2h(NvmeCtrl *n, void *ptr, uint32_t len,
125088eea45cSKlaus Jensen                                 NvmeRequest *req)
125188eea45cSKlaus Jensen {
125288eea45cSKlaus Jensen     uint16_t status;
125388eea45cSKlaus Jensen 
125488eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
125588eea45cSKlaus Jensen     if (status) {
125688eea45cSKlaus Jensen         return status;
125788eea45cSKlaus Jensen     }
125888eea45cSKlaus Jensen 
125988eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_FROM_DEVICE);
126088eea45cSKlaus Jensen }
126188eea45cSKlaus Jensen 
12628d3a17beSPhilippe Mathieu-Daudé static inline uint16_t nvme_h2c(NvmeCtrl *n, void *ptr, uint32_t len,
126388eea45cSKlaus Jensen                                 NvmeRequest *req)
126488eea45cSKlaus Jensen {
126588eea45cSKlaus Jensen     uint16_t status;
126688eea45cSKlaus Jensen 
126788eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
126888eea45cSKlaus Jensen     if (status) {
126988eea45cSKlaus Jensen         return status;
127088eea45cSKlaus Jensen     }
127188eea45cSKlaus Jensen 
127288eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_TO_DEVICE);
127388eea45cSKlaus Jensen }
127488eea45cSKlaus Jensen 
12758d3a17beSPhilippe Mathieu-Daudé uint16_t nvme_bounce_data(NvmeCtrl *n, void *ptr, uint32_t len,
127688eea45cSKlaus Jensen                           NvmeTxDirection dir, NvmeRequest *req)
127788eea45cSKlaus Jensen {
127888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
127988eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
12802a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
12812a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
128288eea45cSKlaus Jensen 
1283ac0b34c5SKlaus Jensen     if (nvme_ns_ext(ns) &&
1284ac0b34c5SKlaus Jensen         !(pi && pract && ns->lbaf.ms == nvme_pi_tuple_size(ns))) {
128588eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbasz,
128688eea45cSKlaus Jensen                                    ns->lbaf.ms, 0, dir);
128788eea45cSKlaus Jensen     }
128888eea45cSKlaus Jensen 
128988eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
129088eea45cSKlaus Jensen }
129188eea45cSKlaus Jensen 
12928d3a17beSPhilippe Mathieu-Daudé uint16_t nvme_bounce_mdata(NvmeCtrl *n, void *ptr, uint32_t len,
129388eea45cSKlaus Jensen                            NvmeTxDirection dir, NvmeRequest *req)
129488eea45cSKlaus Jensen {
129588eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
129688eea45cSKlaus Jensen     uint16_t status;
129788eea45cSKlaus Jensen 
129888eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
129988eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbaf.ms,
130088eea45cSKlaus Jensen                                    ns->lbasz, ns->lbasz, dir);
130188eea45cSKlaus Jensen     }
130288eea45cSKlaus Jensen 
130388eea45cSKlaus Jensen     nvme_sg_unmap(&req->sg);
130488eea45cSKlaus Jensen 
130588eea45cSKlaus Jensen     status = nvme_map_mptr(n, &req->sg, len, &req->cmd);
130688eea45cSKlaus Jensen     if (status) {
130788eea45cSKlaus Jensen         return status;
130888eea45cSKlaus Jensen     }
130988eea45cSKlaus Jensen 
131088eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
131188eea45cSKlaus Jensen }
131288eea45cSKlaus Jensen 
131388eea45cSKlaus Jensen static inline void nvme_blk_read(BlockBackend *blk, int64_t offset,
131488eea45cSKlaus Jensen                                  BlockCompletionFunc *cb, NvmeRequest *req)
131588eea45cSKlaus Jensen {
131688eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
131788eea45cSKlaus Jensen 
131888eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
131988eea45cSKlaus Jensen         req->aiocb = dma_blk_read(blk, &req->sg.qsg, offset, BDRV_SECTOR_SIZE,
132088eea45cSKlaus Jensen                                   cb, req);
132188eea45cSKlaus Jensen     } else {
132288eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &req->sg.iov, 0, cb, req);
132388eea45cSKlaus Jensen     }
132488eea45cSKlaus Jensen }
132588eea45cSKlaus Jensen 
132688eea45cSKlaus Jensen static inline void nvme_blk_write(BlockBackend *blk, int64_t offset,
132788eea45cSKlaus Jensen                                   BlockCompletionFunc *cb, NvmeRequest *req)
132888eea45cSKlaus Jensen {
132988eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
133088eea45cSKlaus Jensen 
133188eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
133288eea45cSKlaus Jensen         req->aiocb = dma_blk_write(blk, &req->sg.qsg, offset, BDRV_SECTOR_SIZE,
133388eea45cSKlaus Jensen                                    cb, req);
133488eea45cSKlaus Jensen     } else {
133588eea45cSKlaus Jensen         req->aiocb = blk_aio_pwritev(blk, offset, &req->sg.iov, 0, cb, req);
133688eea45cSKlaus Jensen     }
133788eea45cSKlaus Jensen }
133888eea45cSKlaus Jensen 
1339fa5db2aaSKlaus Jensen static void nvme_update_cq_eventidx(const NvmeCQueue *cq)
1340fa5db2aaSKlaus Jensen {
1341fa5db2aaSKlaus Jensen     uint32_t v = cpu_to_le32(cq->head);
1342fa5db2aaSKlaus Jensen 
1343fa5db2aaSKlaus Jensen     trace_pci_nvme_update_cq_eventidx(cq->cqid, cq->head);
1344fa5db2aaSKlaus Jensen 
1345fa5db2aaSKlaus Jensen     pci_dma_write(PCI_DEVICE(cq->ctrl), cq->ei_addr, &v, sizeof(v));
1346fa5db2aaSKlaus Jensen }
1347fa5db2aaSKlaus Jensen 
13483f7fe8deSJinhao Fan static void nvme_update_cq_head(NvmeCQueue *cq)
13493f7fe8deSJinhao Fan {
13502fda0726SKlaus Jensen     uint32_t v;
13512fda0726SKlaus Jensen 
13522fda0726SKlaus Jensen     pci_dma_read(PCI_DEVICE(cq->ctrl), cq->db_addr, &v, sizeof(v));
13532fda0726SKlaus Jensen 
13542fda0726SKlaus Jensen     cq->head = le32_to_cpu(v);
135547cd3539SKlaus Jensen 
135647cd3539SKlaus Jensen     trace_pci_nvme_update_cq_head(cq->cqid, cq->head);
13573f7fe8deSJinhao Fan }
13583f7fe8deSJinhao Fan 
135988eea45cSKlaus Jensen static void nvme_post_cqes(void *opaque)
136088eea45cSKlaus Jensen {
136188eea45cSKlaus Jensen     NvmeCQueue *cq = opaque;
136288eea45cSKlaus Jensen     NvmeCtrl *n = cq->ctrl;
136388eea45cSKlaus Jensen     NvmeRequest *req, *next;
136483d7ed5cSKlaus Jensen     bool pending = cq->head != cq->tail;
136588eea45cSKlaus Jensen     int ret;
136688eea45cSKlaus Jensen 
136788eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(req, &cq->req_list, entry, next) {
136888eea45cSKlaus Jensen         NvmeSQueue *sq;
136988eea45cSKlaus Jensen         hwaddr addr;
137088eea45cSKlaus Jensen 
13713f7fe8deSJinhao Fan         if (n->dbbuf_enabled) {
1372fa5db2aaSKlaus Jensen             nvme_update_cq_eventidx(cq);
13733f7fe8deSJinhao Fan             nvme_update_cq_head(cq);
13743f7fe8deSJinhao Fan         }
13753f7fe8deSJinhao Fan 
137688eea45cSKlaus Jensen         if (nvme_cq_full(cq)) {
137788eea45cSKlaus Jensen             break;
137888eea45cSKlaus Jensen         }
137988eea45cSKlaus Jensen 
138088eea45cSKlaus Jensen         sq = req->sq;
138188eea45cSKlaus Jensen         req->cqe.status = cpu_to_le16((req->status << 1) | cq->phase);
138288eea45cSKlaus Jensen         req->cqe.sq_id = cpu_to_le16(sq->sqid);
138388eea45cSKlaus Jensen         req->cqe.sq_head = cpu_to_le16(sq->head);
138488eea45cSKlaus Jensen         addr = cq->dma_addr + cq->tail * n->cqe_size;
138548b32c28SKlaus Jensen         ret = pci_dma_write(PCI_DEVICE(n), addr, (void *)&req->cqe,
138688eea45cSKlaus Jensen                             sizeof(req->cqe));
138788eea45cSKlaus Jensen         if (ret) {
138888eea45cSKlaus Jensen             trace_pci_nvme_err_addr_write(addr);
138988eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
139049e03457SKlaus Jensen             stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
139188eea45cSKlaus Jensen             break;
139288eea45cSKlaus Jensen         }
139388eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->req_list, req, entry);
139488eea45cSKlaus Jensen         nvme_inc_cq_tail(cq);
139588eea45cSKlaus Jensen         nvme_sg_unmap(&req->sg);
139688eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->req_list, req, entry);
139788eea45cSKlaus Jensen     }
139888eea45cSKlaus Jensen     if (cq->tail != cq->head) {
139983d7ed5cSKlaus Jensen         if (cq->irq_enabled && !pending) {
140083d7ed5cSKlaus Jensen             n->cq_pending++;
140183d7ed5cSKlaus Jensen         }
140283d7ed5cSKlaus Jensen 
140388eea45cSKlaus Jensen         nvme_irq_assert(n, cq);
140488eea45cSKlaus Jensen     }
140588eea45cSKlaus Jensen }
140688eea45cSKlaus Jensen 
140788eea45cSKlaus Jensen static void nvme_enqueue_req_completion(NvmeCQueue *cq, NvmeRequest *req)
140888eea45cSKlaus Jensen {
140988eea45cSKlaus Jensen     assert(cq->cqid == req->sq->cqid);
141088eea45cSKlaus Jensen     trace_pci_nvme_enqueue_req_completion(nvme_cid(req), cq->cqid,
1411f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.result),
1412f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.dw1),
141388eea45cSKlaus Jensen                                           req->status);
141488eea45cSKlaus Jensen 
141588eea45cSKlaus Jensen     if (req->status) {
141688eea45cSKlaus Jensen         trace_pci_nvme_err_req_status(nvme_cid(req), nvme_nsid(req->ns),
141788eea45cSKlaus Jensen                                       req->status, req->cmd.opcode);
141888eea45cSKlaus Jensen     }
141988eea45cSKlaus Jensen 
142088eea45cSKlaus Jensen     QTAILQ_REMOVE(&req->sq->out_req_list, req, entry);
142188eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&cq->req_list, req, entry);
14222e53b0b4SJinhao Fan 
1423d38cc6fdSKlaus Jensen     qemu_bh_schedule(cq->bh);
14242e53b0b4SJinhao Fan }
142588eea45cSKlaus Jensen 
142688eea45cSKlaus Jensen static void nvme_process_aers(void *opaque)
142788eea45cSKlaus Jensen {
142888eea45cSKlaus Jensen     NvmeCtrl *n = opaque;
142988eea45cSKlaus Jensen     NvmeAsyncEvent *event, *next;
143088eea45cSKlaus Jensen 
143188eea45cSKlaus Jensen     trace_pci_nvme_process_aers(n->aer_queued);
143288eea45cSKlaus Jensen 
143388eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(event, &n->aer_queue, entry, next) {
143488eea45cSKlaus Jensen         NvmeRequest *req;
143588eea45cSKlaus Jensen         NvmeAerResult *result;
143688eea45cSKlaus Jensen 
143788eea45cSKlaus Jensen         /* can't post cqe if there is nothing to complete */
143888eea45cSKlaus Jensen         if (!n->outstanding_aers) {
143988eea45cSKlaus Jensen             trace_pci_nvme_no_outstanding_aers();
144088eea45cSKlaus Jensen             break;
144188eea45cSKlaus Jensen         }
144288eea45cSKlaus Jensen 
144388eea45cSKlaus Jensen         /* ignore if masked (cqe posted, but event not cleared) */
144488eea45cSKlaus Jensen         if (n->aer_mask & (1 << event->result.event_type)) {
144588eea45cSKlaus Jensen             trace_pci_nvme_aer_masked(event->result.event_type, n->aer_mask);
144688eea45cSKlaus Jensen             continue;
144788eea45cSKlaus Jensen         }
144888eea45cSKlaus Jensen 
144988eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
145088eea45cSKlaus Jensen         n->aer_queued--;
145188eea45cSKlaus Jensen 
145288eea45cSKlaus Jensen         n->aer_mask |= 1 << event->result.event_type;
145388eea45cSKlaus Jensen         n->outstanding_aers--;
145488eea45cSKlaus Jensen 
145588eea45cSKlaus Jensen         req = n->aer_reqs[n->outstanding_aers];
145688eea45cSKlaus Jensen 
145788eea45cSKlaus Jensen         result = (NvmeAerResult *) &req->cqe.result;
145888eea45cSKlaus Jensen         result->event_type = event->result.event_type;
145988eea45cSKlaus Jensen         result->event_info = event->result.event_info;
146088eea45cSKlaus Jensen         result->log_page = event->result.log_page;
146188eea45cSKlaus Jensen         g_free(event);
146288eea45cSKlaus Jensen 
146388eea45cSKlaus Jensen         trace_pci_nvme_aer_post_cqe(result->event_type, result->event_info,
146488eea45cSKlaus Jensen                                     result->log_page);
146588eea45cSKlaus Jensen 
146688eea45cSKlaus Jensen         nvme_enqueue_req_completion(&n->admin_cq, req);
146788eea45cSKlaus Jensen     }
146888eea45cSKlaus Jensen }
146988eea45cSKlaus Jensen 
147088eea45cSKlaus Jensen static void nvme_enqueue_event(NvmeCtrl *n, uint8_t event_type,
147188eea45cSKlaus Jensen                                uint8_t event_info, uint8_t log_page)
147288eea45cSKlaus Jensen {
147388eea45cSKlaus Jensen     NvmeAsyncEvent *event;
147488eea45cSKlaus Jensen 
147588eea45cSKlaus Jensen     trace_pci_nvme_enqueue_event(event_type, event_info, log_page);
147688eea45cSKlaus Jensen 
147788eea45cSKlaus Jensen     if (n->aer_queued == n->params.aer_max_queued) {
147888eea45cSKlaus Jensen         trace_pci_nvme_enqueue_event_noqueue(n->aer_queued);
147988eea45cSKlaus Jensen         return;
148088eea45cSKlaus Jensen     }
148188eea45cSKlaus Jensen 
148288eea45cSKlaus Jensen     event = g_new(NvmeAsyncEvent, 1);
148388eea45cSKlaus Jensen     event->result = (NvmeAerResult) {
148488eea45cSKlaus Jensen         .event_type = event_type,
148588eea45cSKlaus Jensen         .event_info = event_info,
148688eea45cSKlaus Jensen         .log_page   = log_page,
148788eea45cSKlaus Jensen     };
148888eea45cSKlaus Jensen 
148988eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&n->aer_queue, event, entry);
149088eea45cSKlaus Jensen     n->aer_queued++;
149188eea45cSKlaus Jensen 
149288eea45cSKlaus Jensen     nvme_process_aers(n);
149388eea45cSKlaus Jensen }
149488eea45cSKlaus Jensen 
149588eea45cSKlaus Jensen static void nvme_smart_event(NvmeCtrl *n, uint8_t event)
149688eea45cSKlaus Jensen {
149788eea45cSKlaus Jensen     uint8_t aer_info;
149888eea45cSKlaus Jensen 
149988eea45cSKlaus Jensen     /* Ref SPEC <Asynchronous Event Information 0x2013 SMART / Health Status> */
150088eea45cSKlaus Jensen     if (!(NVME_AEC_SMART(n->features.async_config) & event)) {
150188eea45cSKlaus Jensen         return;
150288eea45cSKlaus Jensen     }
150388eea45cSKlaus Jensen 
150488eea45cSKlaus Jensen     switch (event) {
150588eea45cSKlaus Jensen     case NVME_SMART_SPARE:
150688eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_SPARE_THRESH;
150788eea45cSKlaus Jensen         break;
150888eea45cSKlaus Jensen     case NVME_SMART_TEMPERATURE:
150988eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_TEMP_THRESH;
151088eea45cSKlaus Jensen         break;
151188eea45cSKlaus Jensen     case NVME_SMART_RELIABILITY:
151288eea45cSKlaus Jensen     case NVME_SMART_MEDIA_READ_ONLY:
151388eea45cSKlaus Jensen     case NVME_SMART_FAILED_VOLATILE_MEDIA:
151488eea45cSKlaus Jensen     case NVME_SMART_PMR_UNRELIABLE:
151588eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_RELIABILITY;
151688eea45cSKlaus Jensen         break;
151788eea45cSKlaus Jensen     default:
151888eea45cSKlaus Jensen         return;
151988eea45cSKlaus Jensen     }
152088eea45cSKlaus Jensen 
152188eea45cSKlaus Jensen     nvme_enqueue_event(n, NVME_AER_TYPE_SMART, aer_info, NVME_LOG_SMART_INFO);
152288eea45cSKlaus Jensen }
152388eea45cSKlaus Jensen 
152488eea45cSKlaus Jensen static void nvme_clear_events(NvmeCtrl *n, uint8_t event_type)
152588eea45cSKlaus Jensen {
152688eea45cSKlaus Jensen     n->aer_mask &= ~(1 << event_type);
152788eea45cSKlaus Jensen     if (!QTAILQ_EMPTY(&n->aer_queue)) {
152888eea45cSKlaus Jensen         nvme_process_aers(n);
152988eea45cSKlaus Jensen     }
153088eea45cSKlaus Jensen }
153188eea45cSKlaus Jensen 
153288eea45cSKlaus Jensen static inline uint16_t nvme_check_mdts(NvmeCtrl *n, size_t len)
153388eea45cSKlaus Jensen {
153488eea45cSKlaus Jensen     uint8_t mdts = n->params.mdts;
153588eea45cSKlaus Jensen 
153688eea45cSKlaus Jensen     if (mdts && len > n->page_size << mdts) {
153788eea45cSKlaus Jensen         trace_pci_nvme_err_mdts(len);
153888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
153988eea45cSKlaus Jensen     }
154088eea45cSKlaus Jensen 
154188eea45cSKlaus Jensen     return NVME_SUCCESS;
154288eea45cSKlaus Jensen }
154388eea45cSKlaus Jensen 
154488eea45cSKlaus Jensen static inline uint16_t nvme_check_bounds(NvmeNamespace *ns, uint64_t slba,
154588eea45cSKlaus Jensen                                          uint32_t nlb)
154688eea45cSKlaus Jensen {
154788eea45cSKlaus Jensen     uint64_t nsze = le64_to_cpu(ns->id_ns.nsze);
154888eea45cSKlaus Jensen 
154988eea45cSKlaus Jensen     if (unlikely(UINT64_MAX - slba < nlb || slba + nlb > nsze)) {
155088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb, nsze);
155188eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
155288eea45cSKlaus Jensen     }
155388eea45cSKlaus Jensen 
155488eea45cSKlaus Jensen     return NVME_SUCCESS;
155588eea45cSKlaus Jensen }
155688eea45cSKlaus Jensen 
1557ff0ac2c8SKlaus Jensen static int nvme_block_status_all(NvmeNamespace *ns, uint64_t slba,
1558ff0ac2c8SKlaus Jensen                                  uint32_t nlb, int flags)
155988eea45cSKlaus Jensen {
156088eea45cSKlaus Jensen     BlockDriverState *bs = blk_bs(ns->blkconf.blk);
156188eea45cSKlaus Jensen 
156288eea45cSKlaus Jensen     int64_t pnum = 0, bytes = nvme_l2b(ns, nlb);
156388eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
156488eea45cSKlaus Jensen     int ret;
156588eea45cSKlaus Jensen 
156688eea45cSKlaus Jensen     /*
156788eea45cSKlaus Jensen      * `pnum` holds the number of bytes after offset that shares the same
156888eea45cSKlaus Jensen      * allocation status as the byte at offset. If `pnum` is different from
156988eea45cSKlaus Jensen      * `bytes`, we should check the allocation status of the next range and
157088eea45cSKlaus Jensen      * continue this until all bytes have been checked.
157188eea45cSKlaus Jensen      */
157288eea45cSKlaus Jensen     do {
157388eea45cSKlaus Jensen         bytes -= pnum;
157488eea45cSKlaus Jensen 
157588eea45cSKlaus Jensen         ret = bdrv_block_status(bs, offset, bytes, &pnum, NULL, NULL);
157688eea45cSKlaus Jensen         if (ret < 0) {
1577ff0ac2c8SKlaus Jensen             return ret;
157888eea45cSKlaus Jensen         }
157988eea45cSKlaus Jensen 
158088eea45cSKlaus Jensen 
1581ff0ac2c8SKlaus Jensen         trace_pci_nvme_block_status(offset, bytes, pnum, ret,
1582ff0ac2c8SKlaus Jensen                                     !!(ret & BDRV_BLOCK_ZERO));
158388eea45cSKlaus Jensen 
1584ff0ac2c8SKlaus Jensen         if (!(ret & flags)) {
1585ff0ac2c8SKlaus Jensen             return 1;
158688eea45cSKlaus Jensen         }
158788eea45cSKlaus Jensen 
158888eea45cSKlaus Jensen         offset += pnum;
158988eea45cSKlaus Jensen     } while (pnum != bytes);
159088eea45cSKlaus Jensen 
1591ff0ac2c8SKlaus Jensen     return 0;
1592ff0ac2c8SKlaus Jensen }
1593ff0ac2c8SKlaus Jensen 
1594ff0ac2c8SKlaus Jensen static uint16_t nvme_check_dulbe(NvmeNamespace *ns, uint64_t slba,
1595ff0ac2c8SKlaus Jensen                                  uint32_t nlb)
1596ff0ac2c8SKlaus Jensen {
1597ff0ac2c8SKlaus Jensen     int ret;
1598ff0ac2c8SKlaus Jensen     Error *err = NULL;
1599ff0ac2c8SKlaus Jensen 
1600ff0ac2c8SKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_DATA);
1601ff0ac2c8SKlaus Jensen     if (ret) {
1602ff0ac2c8SKlaus Jensen         if (ret < 0) {
1603ff0ac2c8SKlaus Jensen             error_setg_errno(&err, -ret, "unable to get block status");
1604ff0ac2c8SKlaus Jensen             error_report_err(err);
1605ff0ac2c8SKlaus Jensen 
1606ff0ac2c8SKlaus Jensen             return NVME_INTERNAL_DEV_ERROR;
1607ff0ac2c8SKlaus Jensen         }
1608ff0ac2c8SKlaus Jensen 
1609ff0ac2c8SKlaus Jensen         return NVME_DULB;
1610ff0ac2c8SKlaus Jensen     }
1611ff0ac2c8SKlaus Jensen 
161288eea45cSKlaus Jensen     return NVME_SUCCESS;
161388eea45cSKlaus Jensen }
161488eea45cSKlaus Jensen 
161588eea45cSKlaus Jensen static void nvme_aio_err(NvmeRequest *req, int ret)
161688eea45cSKlaus Jensen {
161788eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
161888eea45cSKlaus Jensen     Error *local_err = NULL;
161988eea45cSKlaus Jensen 
162088eea45cSKlaus Jensen     switch (req->cmd.opcode) {
162188eea45cSKlaus Jensen     case NVME_CMD_READ:
162288eea45cSKlaus Jensen         status = NVME_UNRECOVERED_READ;
162388eea45cSKlaus Jensen         break;
162488eea45cSKlaus Jensen     case NVME_CMD_FLUSH:
162588eea45cSKlaus Jensen     case NVME_CMD_WRITE:
162688eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
162788eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
162888eea45cSKlaus Jensen         status = NVME_WRITE_FAULT;
162988eea45cSKlaus Jensen         break;
163088eea45cSKlaus Jensen     default:
163188eea45cSKlaus Jensen         status = NVME_INTERNAL_DEV_ERROR;
163288eea45cSKlaus Jensen         break;
163388eea45cSKlaus Jensen     }
163488eea45cSKlaus Jensen 
163588eea45cSKlaus Jensen     trace_pci_nvme_err_aio(nvme_cid(req), strerror(-ret), status);
163688eea45cSKlaus Jensen 
163788eea45cSKlaus Jensen     error_setg_errno(&local_err, -ret, "aio failed");
163888eea45cSKlaus Jensen     error_report_err(local_err);
163988eea45cSKlaus Jensen 
164088eea45cSKlaus Jensen     /*
164188eea45cSKlaus Jensen      * Set the command status code to the first encountered error but allow a
164288eea45cSKlaus Jensen      * subsequent Internal Device Error to trump it.
164388eea45cSKlaus Jensen      */
164488eea45cSKlaus Jensen     if (req->status && status != NVME_INTERNAL_DEV_ERROR) {
164588eea45cSKlaus Jensen         return;
164688eea45cSKlaus Jensen     }
164788eea45cSKlaus Jensen 
164888eea45cSKlaus Jensen     req->status = status;
164988eea45cSKlaus Jensen }
165088eea45cSKlaus Jensen 
165188eea45cSKlaus Jensen static inline uint32_t nvme_zone_idx(NvmeNamespace *ns, uint64_t slba)
165288eea45cSKlaus Jensen {
165388eea45cSKlaus Jensen     return ns->zone_size_log2 > 0 ? slba >> ns->zone_size_log2 :
165488eea45cSKlaus Jensen                                     slba / ns->zone_size;
165588eea45cSKlaus Jensen }
165688eea45cSKlaus Jensen 
165788eea45cSKlaus Jensen static inline NvmeZone *nvme_get_zone_by_slba(NvmeNamespace *ns, uint64_t slba)
165888eea45cSKlaus Jensen {
165988eea45cSKlaus Jensen     uint32_t zone_idx = nvme_zone_idx(ns, slba);
166088eea45cSKlaus Jensen 
1661189a8bf7SKlaus Jensen     if (zone_idx >= ns->num_zones) {
1662189a8bf7SKlaus Jensen         return NULL;
1663189a8bf7SKlaus Jensen     }
1664189a8bf7SKlaus Jensen 
166588eea45cSKlaus Jensen     return &ns->zone_array[zone_idx];
166688eea45cSKlaus Jensen }
166788eea45cSKlaus Jensen 
166888eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_write(NvmeZone *zone)
166988eea45cSKlaus Jensen {
167088eea45cSKlaus Jensen     uint64_t zslba = zone->d.zslba;
167188eea45cSKlaus Jensen 
167288eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
167388eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
167488eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
167588eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
167688eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
167788eea45cSKlaus Jensen         return NVME_SUCCESS;
167888eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
167988eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_full(zslba);
168088eea45cSKlaus Jensen         return NVME_ZONE_FULL;
168188eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
168288eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zslba);
168388eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
168488eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
168588eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_read_only(zslba);
168688eea45cSKlaus Jensen         return NVME_ZONE_READ_ONLY;
168788eea45cSKlaus Jensen     default:
168888eea45cSKlaus Jensen         assert(false);
168988eea45cSKlaus Jensen     }
169088eea45cSKlaus Jensen 
169188eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
169288eea45cSKlaus Jensen }
169388eea45cSKlaus Jensen 
169488eea45cSKlaus Jensen static uint16_t nvme_check_zone_write(NvmeNamespace *ns, NvmeZone *zone,
169588eea45cSKlaus Jensen                                       uint64_t slba, uint32_t nlb)
169688eea45cSKlaus Jensen {
169788eea45cSKlaus Jensen     uint64_t zcap = nvme_zone_wr_boundary(zone);
169888eea45cSKlaus Jensen     uint16_t status;
169988eea45cSKlaus Jensen 
170088eea45cSKlaus Jensen     status = nvme_check_zone_state_for_write(zone);
170188eea45cSKlaus Jensen     if (status) {
170288eea45cSKlaus Jensen         return status;
170388eea45cSKlaus Jensen     }
170488eea45cSKlaus Jensen 
1705e321b4cdSKlaus Jensen     if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1706e321b4cdSKlaus Jensen         uint64_t ezrwa = zone->w_ptr + 2 * ns->zns.zrwas;
1707e321b4cdSKlaus Jensen 
1708e321b4cdSKlaus Jensen         if (slba < zone->w_ptr || slba + nlb > ezrwa) {
1709e321b4cdSKlaus Jensen             trace_pci_nvme_err_zone_invalid_write(slba, zone->w_ptr);
171088eea45cSKlaus Jensen             return NVME_ZONE_INVALID_WRITE;
171188eea45cSKlaus Jensen         }
1712e321b4cdSKlaus Jensen     } else {
1713e321b4cdSKlaus Jensen         if (unlikely(slba != zone->w_ptr)) {
1714e321b4cdSKlaus Jensen             trace_pci_nvme_err_write_not_at_wp(slba, zone->d.zslba,
1715e321b4cdSKlaus Jensen                                                zone->w_ptr);
1716e321b4cdSKlaus Jensen             return NVME_ZONE_INVALID_WRITE;
1717e321b4cdSKlaus Jensen         }
1718e321b4cdSKlaus Jensen     }
171988eea45cSKlaus Jensen 
172088eea45cSKlaus Jensen     if (unlikely((slba + nlb) > zcap)) {
172188eea45cSKlaus Jensen         trace_pci_nvme_err_zone_boundary(slba, nlb, zcap);
172288eea45cSKlaus Jensen         return NVME_ZONE_BOUNDARY_ERROR;
172388eea45cSKlaus Jensen     }
172488eea45cSKlaus Jensen 
172588eea45cSKlaus Jensen     return NVME_SUCCESS;
172688eea45cSKlaus Jensen }
172788eea45cSKlaus Jensen 
172888eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_read(NvmeZone *zone)
172988eea45cSKlaus Jensen {
173088eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
173188eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
173288eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
173388eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
173488eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
173588eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
173688eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
173788eea45cSKlaus Jensen         return NVME_SUCCESS;
173888eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
173988eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zone->d.zslba);
174088eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
174188eea45cSKlaus Jensen     default:
174288eea45cSKlaus Jensen         assert(false);
174388eea45cSKlaus Jensen     }
174488eea45cSKlaus Jensen 
174588eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
174688eea45cSKlaus Jensen }
174788eea45cSKlaus Jensen 
174888eea45cSKlaus Jensen static uint16_t nvme_check_zone_read(NvmeNamespace *ns, uint64_t slba,
174988eea45cSKlaus Jensen                                      uint32_t nlb)
175088eea45cSKlaus Jensen {
1751189a8bf7SKlaus Jensen     NvmeZone *zone;
1752189a8bf7SKlaus Jensen     uint64_t bndry, end;
175388eea45cSKlaus Jensen     uint16_t status;
175488eea45cSKlaus Jensen 
1755189a8bf7SKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
1756189a8bf7SKlaus Jensen     assert(zone);
1757189a8bf7SKlaus Jensen 
1758189a8bf7SKlaus Jensen     bndry = nvme_zone_rd_boundary(ns, zone);
1759189a8bf7SKlaus Jensen     end = slba + nlb;
1760189a8bf7SKlaus Jensen 
176188eea45cSKlaus Jensen     status = nvme_check_zone_state_for_read(zone);
176288eea45cSKlaus Jensen     if (status) {
176388eea45cSKlaus Jensen         ;
176488eea45cSKlaus Jensen     } else if (unlikely(end > bndry)) {
176588eea45cSKlaus Jensen         if (!ns->params.cross_zone_read) {
176688eea45cSKlaus Jensen             status = NVME_ZONE_BOUNDARY_ERROR;
176788eea45cSKlaus Jensen         } else {
176888eea45cSKlaus Jensen             /*
176988eea45cSKlaus Jensen              * Read across zone boundary - check that all subsequent
177088eea45cSKlaus Jensen              * zones that are being read have an appropriate state.
177188eea45cSKlaus Jensen              */
177288eea45cSKlaus Jensen             do {
177388eea45cSKlaus Jensen                 zone++;
177488eea45cSKlaus Jensen                 status = nvme_check_zone_state_for_read(zone);
177588eea45cSKlaus Jensen                 if (status) {
177688eea45cSKlaus Jensen                     break;
177788eea45cSKlaus Jensen                 }
177888eea45cSKlaus Jensen             } while (end > nvme_zone_rd_boundary(ns, zone));
177988eea45cSKlaus Jensen         }
178088eea45cSKlaus Jensen     }
178188eea45cSKlaus Jensen 
178288eea45cSKlaus Jensen     return status;
178388eea45cSKlaus Jensen }
178488eea45cSKlaus Jensen 
178588eea45cSKlaus Jensen static uint16_t nvme_zrm_finish(NvmeNamespace *ns, NvmeZone *zone)
178688eea45cSKlaus Jensen {
178788eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
178888eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
178988eea45cSKlaus Jensen         return NVME_SUCCESS;
179088eea45cSKlaus Jensen 
179188eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
179288eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
179388eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
179488eea45cSKlaus Jensen         /* fallthrough */
179588eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
179688eea45cSKlaus Jensen         nvme_aor_dec_active(ns);
1797e321b4cdSKlaus Jensen 
1798e321b4cdSKlaus Jensen         if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1799e321b4cdSKlaus Jensen             zone->d.za &= ~NVME_ZA_ZRWA_VALID;
1800e321b4cdSKlaus Jensen             if (ns->params.numzrwa) {
1801e321b4cdSKlaus Jensen                 ns->zns.numzrwa++;
1802e321b4cdSKlaus Jensen             }
1803e321b4cdSKlaus Jensen         }
1804e321b4cdSKlaus Jensen 
180588eea45cSKlaus Jensen         /* fallthrough */
180688eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
180788eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_FULL);
180888eea45cSKlaus Jensen         return NVME_SUCCESS;
180988eea45cSKlaus Jensen 
181088eea45cSKlaus Jensen     default:
181188eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
181288eea45cSKlaus Jensen     }
181388eea45cSKlaus Jensen }
181488eea45cSKlaus Jensen 
181588eea45cSKlaus Jensen static uint16_t nvme_zrm_close(NvmeNamespace *ns, NvmeZone *zone)
181688eea45cSKlaus Jensen {
181788eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
181888eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
181988eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
182088eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
182188eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
182288eea45cSKlaus Jensen         /* fall through */
182388eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
182488eea45cSKlaus Jensen         return NVME_SUCCESS;
182588eea45cSKlaus Jensen 
182688eea45cSKlaus Jensen     default:
182788eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
182888eea45cSKlaus Jensen     }
182988eea45cSKlaus Jensen }
183088eea45cSKlaus Jensen 
183163d96e4fSKlaus Jensen static uint16_t nvme_zrm_reset(NvmeNamespace *ns, NvmeZone *zone)
183263d96e4fSKlaus Jensen {
183363d96e4fSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
183463d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
183563d96e4fSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
183663d96e4fSKlaus Jensen         nvme_aor_dec_open(ns);
183763d96e4fSKlaus Jensen         /* fallthrough */
183863d96e4fSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
183963d96e4fSKlaus Jensen         nvme_aor_dec_active(ns);
1840e321b4cdSKlaus Jensen 
1841e321b4cdSKlaus Jensen         if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1842e321b4cdSKlaus Jensen             if (ns->params.numzrwa) {
1843e321b4cdSKlaus Jensen                 ns->zns.numzrwa++;
1844e321b4cdSKlaus Jensen             }
1845e321b4cdSKlaus Jensen         }
1846e321b4cdSKlaus Jensen 
184763d96e4fSKlaus Jensen         /* fallthrough */
184863d96e4fSKlaus Jensen     case NVME_ZONE_STATE_FULL:
184963d96e4fSKlaus Jensen         zone->w_ptr = zone->d.zslba;
185063d96e4fSKlaus Jensen         zone->d.wp = zone->w_ptr;
185163d96e4fSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EMPTY);
185263d96e4fSKlaus Jensen         /* fallthrough */
185363d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
185463d96e4fSKlaus Jensen         return NVME_SUCCESS;
185563d96e4fSKlaus Jensen 
185663d96e4fSKlaus Jensen     default:
185763d96e4fSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
185863d96e4fSKlaus Jensen     }
185963d96e4fSKlaus Jensen }
186063d96e4fSKlaus Jensen 
186188eea45cSKlaus Jensen static void nvme_zrm_auto_transition_zone(NvmeNamespace *ns)
186288eea45cSKlaus Jensen {
186388eea45cSKlaus Jensen     NvmeZone *zone;
186488eea45cSKlaus Jensen 
186588eea45cSKlaus Jensen     if (ns->params.max_open_zones &&
186688eea45cSKlaus Jensen         ns->nr_open_zones == ns->params.max_open_zones) {
186788eea45cSKlaus Jensen         zone = QTAILQ_FIRST(&ns->imp_open_zones);
186888eea45cSKlaus Jensen         if (zone) {
186988eea45cSKlaus Jensen             /*
187088eea45cSKlaus Jensen              * Automatically close this implicitly open zone.
187188eea45cSKlaus Jensen              */
187288eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
187388eea45cSKlaus Jensen             nvme_zrm_close(ns, zone);
187488eea45cSKlaus Jensen         }
187588eea45cSKlaus Jensen     }
187688eea45cSKlaus Jensen }
187788eea45cSKlaus Jensen 
187888eea45cSKlaus Jensen enum {
187988eea45cSKlaus Jensen     NVME_ZRM_AUTO = 1 << 0,
1880e321b4cdSKlaus Jensen     NVME_ZRM_ZRWA = 1 << 1,
188188eea45cSKlaus Jensen };
188288eea45cSKlaus Jensen 
1883cccc2651SNiklas Cassel static uint16_t nvme_zrm_open_flags(NvmeCtrl *n, NvmeNamespace *ns,
1884cccc2651SNiklas Cassel                                     NvmeZone *zone, int flags)
188588eea45cSKlaus Jensen {
188688eea45cSKlaus Jensen     int act = 0;
188788eea45cSKlaus Jensen     uint16_t status;
188888eea45cSKlaus Jensen 
188988eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
189088eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
189188eea45cSKlaus Jensen         act = 1;
189288eea45cSKlaus Jensen 
189388eea45cSKlaus Jensen         /* fallthrough */
189488eea45cSKlaus Jensen 
189588eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
1896cccc2651SNiklas Cassel         if (n->params.auto_transition_zones) {
189788eea45cSKlaus Jensen             nvme_zrm_auto_transition_zone(ns);
1898cccc2651SNiklas Cassel         }
1899e321b4cdSKlaus Jensen         status = nvme_zns_check_resources(ns, act, 1,
1900e321b4cdSKlaus Jensen                                           (flags & NVME_ZRM_ZRWA) ? 1 : 0);
190188eea45cSKlaus Jensen         if (status) {
190288eea45cSKlaus Jensen             return status;
190388eea45cSKlaus Jensen         }
190488eea45cSKlaus Jensen 
190588eea45cSKlaus Jensen         if (act) {
190688eea45cSKlaus Jensen             nvme_aor_inc_active(ns);
190788eea45cSKlaus Jensen         }
190888eea45cSKlaus Jensen 
190988eea45cSKlaus Jensen         nvme_aor_inc_open(ns);
191088eea45cSKlaus Jensen 
191188eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
191288eea45cSKlaus Jensen             nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_IMPLICITLY_OPEN);
191388eea45cSKlaus Jensen             return NVME_SUCCESS;
191488eea45cSKlaus Jensen         }
191588eea45cSKlaus Jensen 
191688eea45cSKlaus Jensen         /* fallthrough */
191788eea45cSKlaus Jensen 
191888eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
191988eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
192088eea45cSKlaus Jensen             return NVME_SUCCESS;
192188eea45cSKlaus Jensen         }
192288eea45cSKlaus Jensen 
192388eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EXPLICITLY_OPEN);
192488eea45cSKlaus Jensen 
192588eea45cSKlaus Jensen         /* fallthrough */
192688eea45cSKlaus Jensen 
192788eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
1928e321b4cdSKlaus Jensen         if (flags & NVME_ZRM_ZRWA) {
1929e321b4cdSKlaus Jensen             ns->zns.numzrwa--;
1930e321b4cdSKlaus Jensen 
1931e321b4cdSKlaus Jensen             zone->d.za |= NVME_ZA_ZRWA_VALID;
1932e321b4cdSKlaus Jensen         }
1933e321b4cdSKlaus Jensen 
193488eea45cSKlaus Jensen         return NVME_SUCCESS;
193588eea45cSKlaus Jensen 
193688eea45cSKlaus Jensen     default:
193788eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
193888eea45cSKlaus Jensen     }
193988eea45cSKlaus Jensen }
194088eea45cSKlaus Jensen 
1941cccc2651SNiklas Cassel static inline uint16_t nvme_zrm_auto(NvmeCtrl *n, NvmeNamespace *ns,
1942cccc2651SNiklas Cassel                                      NvmeZone *zone)
194388eea45cSKlaus Jensen {
1944cccc2651SNiklas Cassel     return nvme_zrm_open_flags(n, ns, zone, NVME_ZRM_AUTO);
194588eea45cSKlaus Jensen }
194688eea45cSKlaus Jensen 
194788eea45cSKlaus Jensen static void nvme_advance_zone_wp(NvmeNamespace *ns, NvmeZone *zone,
194888eea45cSKlaus Jensen                                  uint32_t nlb)
194988eea45cSKlaus Jensen {
195088eea45cSKlaus Jensen     zone->d.wp += nlb;
195188eea45cSKlaus Jensen 
195288eea45cSKlaus Jensen     if (zone->d.wp == nvme_zone_wr_boundary(zone)) {
195388eea45cSKlaus Jensen         nvme_zrm_finish(ns, zone);
195488eea45cSKlaus Jensen     }
195588eea45cSKlaus Jensen }
195688eea45cSKlaus Jensen 
1957e321b4cdSKlaus Jensen static void nvme_zoned_zrwa_implicit_flush(NvmeNamespace *ns, NvmeZone *zone,
1958e321b4cdSKlaus Jensen                                            uint32_t nlbc)
1959e321b4cdSKlaus Jensen {
1960e321b4cdSKlaus Jensen     uint16_t nzrwafgs = DIV_ROUND_UP(nlbc, ns->zns.zrwafg);
1961e321b4cdSKlaus Jensen 
1962e321b4cdSKlaus Jensen     nlbc = nzrwafgs * ns->zns.zrwafg;
1963e321b4cdSKlaus Jensen 
1964e321b4cdSKlaus Jensen     trace_pci_nvme_zoned_zrwa_implicit_flush(zone->d.zslba, nlbc);
1965e321b4cdSKlaus Jensen 
1966e321b4cdSKlaus Jensen     zone->w_ptr += nlbc;
1967e321b4cdSKlaus Jensen 
1968e321b4cdSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlbc);
1969e321b4cdSKlaus Jensen }
1970e321b4cdSKlaus Jensen 
197188eea45cSKlaus Jensen static void nvme_finalize_zoned_write(NvmeNamespace *ns, NvmeRequest *req)
197288eea45cSKlaus Jensen {
197388eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
197488eea45cSKlaus Jensen     NvmeZone *zone;
197588eea45cSKlaus Jensen     uint64_t slba;
197688eea45cSKlaus Jensen     uint32_t nlb;
197788eea45cSKlaus Jensen 
197888eea45cSKlaus Jensen     slba = le64_to_cpu(rw->slba);
197988eea45cSKlaus Jensen     nlb = le16_to_cpu(rw->nlb) + 1;
198088eea45cSKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
1981189a8bf7SKlaus Jensen     assert(zone);
198288eea45cSKlaus Jensen 
1983e321b4cdSKlaus Jensen     if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1984e321b4cdSKlaus Jensen         uint64_t ezrwa = zone->w_ptr + ns->zns.zrwas - 1;
1985e321b4cdSKlaus Jensen         uint64_t elba = slba + nlb - 1;
1986e321b4cdSKlaus Jensen 
1987e321b4cdSKlaus Jensen         if (elba > ezrwa) {
1988e321b4cdSKlaus Jensen             nvme_zoned_zrwa_implicit_flush(ns, zone, elba - ezrwa);
1989e321b4cdSKlaus Jensen         }
1990e321b4cdSKlaus Jensen 
1991e321b4cdSKlaus Jensen         return;
1992e321b4cdSKlaus Jensen     }
1993e321b4cdSKlaus Jensen 
199488eea45cSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlb);
199588eea45cSKlaus Jensen }
199688eea45cSKlaus Jensen 
199788eea45cSKlaus Jensen static inline bool nvme_is_write(NvmeRequest *req)
199888eea45cSKlaus Jensen {
199988eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
200088eea45cSKlaus Jensen 
200188eea45cSKlaus Jensen     return rw->opcode == NVME_CMD_WRITE ||
200288eea45cSKlaus Jensen            rw->opcode == NVME_CMD_ZONE_APPEND ||
200388eea45cSKlaus Jensen            rw->opcode == NVME_CMD_WRITE_ZEROES;
200488eea45cSKlaus Jensen }
200588eea45cSKlaus Jensen 
200638f4ac65SKlaus Jensen static AioContext *nvme_get_aio_context(BlockAIOCB *acb)
200738f4ac65SKlaus Jensen {
200838f4ac65SKlaus Jensen     return qemu_get_aio_context();
200938f4ac65SKlaus Jensen }
201038f4ac65SKlaus Jensen 
201188eea45cSKlaus Jensen static void nvme_misc_cb(void *opaque, int ret)
201288eea45cSKlaus Jensen {
201388eea45cSKlaus Jensen     NvmeRequest *req = opaque;
201488eea45cSKlaus Jensen 
201538f4ac65SKlaus Jensen     trace_pci_nvme_misc_cb(nvme_cid(req));
201688eea45cSKlaus Jensen 
201788eea45cSKlaus Jensen     if (ret) {
201888eea45cSKlaus Jensen         nvme_aio_err(req, ret);
201988eea45cSKlaus Jensen     }
202088eea45cSKlaus Jensen 
202188eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
202288eea45cSKlaus Jensen }
202388eea45cSKlaus Jensen 
202488eea45cSKlaus Jensen void nvme_rw_complete_cb(void *opaque, int ret)
202588eea45cSKlaus Jensen {
202688eea45cSKlaus Jensen     NvmeRequest *req = opaque;
202788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
202888eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
202988eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
203088eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
203188eea45cSKlaus Jensen 
203288eea45cSKlaus Jensen     trace_pci_nvme_rw_complete_cb(nvme_cid(req), blk_name(blk));
203388eea45cSKlaus Jensen 
203488eea45cSKlaus Jensen     if (ret) {
203588eea45cSKlaus Jensen         block_acct_failed(stats, acct);
203688eea45cSKlaus Jensen         nvme_aio_err(req, ret);
203788eea45cSKlaus Jensen     } else {
203888eea45cSKlaus Jensen         block_acct_done(stats, acct);
203988eea45cSKlaus Jensen     }
204088eea45cSKlaus Jensen 
204188eea45cSKlaus Jensen     if (ns->params.zoned && nvme_is_write(req)) {
204288eea45cSKlaus Jensen         nvme_finalize_zoned_write(ns, req);
204388eea45cSKlaus Jensen     }
204488eea45cSKlaus Jensen 
204588eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
204688eea45cSKlaus Jensen }
204788eea45cSKlaus Jensen 
204888eea45cSKlaus Jensen static void nvme_rw_cb(void *opaque, int ret)
204988eea45cSKlaus Jensen {
205088eea45cSKlaus Jensen     NvmeRequest *req = opaque;
205188eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
205288eea45cSKlaus Jensen 
205388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
205488eea45cSKlaus Jensen 
205588eea45cSKlaus Jensen     trace_pci_nvme_rw_cb(nvme_cid(req), blk_name(blk));
205688eea45cSKlaus Jensen 
205788eea45cSKlaus Jensen     if (ret) {
205888eea45cSKlaus Jensen         goto out;
205988eea45cSKlaus Jensen     }
206088eea45cSKlaus Jensen 
206188eea45cSKlaus Jensen     if (ns->lbaf.ms) {
206288eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
206388eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
206488eea45cSKlaus Jensen         uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
206588eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
206688eea45cSKlaus Jensen 
206788eea45cSKlaus Jensen         if (req->cmd.opcode == NVME_CMD_WRITE_ZEROES) {
206888eea45cSKlaus Jensen             size_t mlen = nvme_m2b(ns, nlb);
206988eea45cSKlaus Jensen 
207088eea45cSKlaus Jensen             req->aiocb = blk_aio_pwrite_zeroes(blk, offset, mlen,
207188eea45cSKlaus Jensen                                                BDRV_REQ_MAY_UNMAP,
207288eea45cSKlaus Jensen                                                nvme_rw_complete_cb, req);
207388eea45cSKlaus Jensen             return;
207488eea45cSKlaus Jensen         }
207588eea45cSKlaus Jensen 
207688eea45cSKlaus Jensen         if (nvme_ns_ext(ns) || req->cmd.mptr) {
207788eea45cSKlaus Jensen             uint16_t status;
207888eea45cSKlaus Jensen 
207988eea45cSKlaus Jensen             nvme_sg_unmap(&req->sg);
208088eea45cSKlaus Jensen             status = nvme_map_mdata(nvme_ctrl(req), nlb, req);
208188eea45cSKlaus Jensen             if (status) {
208288eea45cSKlaus Jensen                 ret = -EFAULT;
208388eea45cSKlaus Jensen                 goto out;
208488eea45cSKlaus Jensen             }
208588eea45cSKlaus Jensen 
208688eea45cSKlaus Jensen             if (req->cmd.opcode == NVME_CMD_READ) {
208788eea45cSKlaus Jensen                 return nvme_blk_read(blk, offset, nvme_rw_complete_cb, req);
208888eea45cSKlaus Jensen             }
208988eea45cSKlaus Jensen 
209088eea45cSKlaus Jensen             return nvme_blk_write(blk, offset, nvme_rw_complete_cb, req);
209188eea45cSKlaus Jensen         }
209288eea45cSKlaus Jensen     }
209388eea45cSKlaus Jensen 
209488eea45cSKlaus Jensen out:
209588eea45cSKlaus Jensen     nvme_rw_complete_cb(req, ret);
209688eea45cSKlaus Jensen }
209788eea45cSKlaus Jensen 
209888eea45cSKlaus Jensen static void nvme_verify_cb(void *opaque, int ret)
209988eea45cSKlaus Jensen {
210088eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
210188eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
210288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
210388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
210488eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
210588eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
210688eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
210788eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
21082a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
210988eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
211088eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
211144219b60SNaveen Nagar     uint64_t reftag = le32_to_cpu(rw->reftag);
211244219b60SNaveen Nagar     uint64_t cdw3 = le32_to_cpu(rw->cdw3);
211388eea45cSKlaus Jensen     uint16_t status;
211488eea45cSKlaus Jensen 
211544219b60SNaveen Nagar     reftag |= cdw3 << 32;
211644219b60SNaveen Nagar 
21172a132309SKlaus Jensen     trace_pci_nvme_verify_cb(nvme_cid(req), prinfo, apptag, appmask, reftag);
211888eea45cSKlaus Jensen 
211988eea45cSKlaus Jensen     if (ret) {
212088eea45cSKlaus Jensen         block_acct_failed(stats, acct);
212188eea45cSKlaus Jensen         nvme_aio_err(req, ret);
212288eea45cSKlaus Jensen         goto out;
212388eea45cSKlaus Jensen     }
212488eea45cSKlaus Jensen 
212588eea45cSKlaus Jensen     block_acct_done(stats, acct);
212688eea45cSKlaus Jensen 
212788eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
212888eea45cSKlaus Jensen         status = nvme_dif_mangle_mdata(ns, ctx->mdata.bounce,
212988eea45cSKlaus Jensen                                        ctx->mdata.iov.size, slba);
213088eea45cSKlaus Jensen         if (status) {
213188eea45cSKlaus Jensen             req->status = status;
213288eea45cSKlaus Jensen             goto out;
213388eea45cSKlaus Jensen         }
213488eea45cSKlaus Jensen 
213588eea45cSKlaus Jensen         req->status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
213688eea45cSKlaus Jensen                                      ctx->mdata.bounce, ctx->mdata.iov.size,
21372a132309SKlaus Jensen                                      prinfo, slba, apptag, appmask, &reftag);
213888eea45cSKlaus Jensen     }
213988eea45cSKlaus Jensen 
214088eea45cSKlaus Jensen out:
214188eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
214288eea45cSKlaus Jensen     g_free(ctx->data.bounce);
214388eea45cSKlaus Jensen 
214488eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
214588eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
214688eea45cSKlaus Jensen 
214788eea45cSKlaus Jensen     g_free(ctx);
214888eea45cSKlaus Jensen 
214988eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
215088eea45cSKlaus Jensen }
215188eea45cSKlaus Jensen 
215288eea45cSKlaus Jensen 
215388eea45cSKlaus Jensen static void nvme_verify_mdata_in_cb(void *opaque, int ret)
215488eea45cSKlaus Jensen {
215588eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
215688eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
215788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
215888eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
215988eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
216088eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
216188eea45cSKlaus Jensen     size_t mlen = nvme_m2b(ns, nlb);
216288eea45cSKlaus Jensen     uint64_t offset = nvme_moff(ns, slba);
216388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
216488eea45cSKlaus Jensen 
216588eea45cSKlaus Jensen     trace_pci_nvme_verify_mdata_in_cb(nvme_cid(req), blk_name(blk));
216688eea45cSKlaus Jensen 
216788eea45cSKlaus Jensen     if (ret) {
216888eea45cSKlaus Jensen         goto out;
216988eea45cSKlaus Jensen     }
217088eea45cSKlaus Jensen 
217188eea45cSKlaus Jensen     ctx->mdata.bounce = g_malloc(mlen);
217288eea45cSKlaus Jensen 
217388eea45cSKlaus Jensen     qemu_iovec_reset(&ctx->mdata.iov);
217488eea45cSKlaus Jensen     qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
217588eea45cSKlaus Jensen 
217688eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
217788eea45cSKlaus Jensen                                 nvme_verify_cb, ctx);
217888eea45cSKlaus Jensen     return;
217988eea45cSKlaus Jensen 
218088eea45cSKlaus Jensen out:
218188eea45cSKlaus Jensen     nvme_verify_cb(ctx, ret);
218288eea45cSKlaus Jensen }
218388eea45cSKlaus Jensen 
218488eea45cSKlaus Jensen struct nvme_compare_ctx {
218588eea45cSKlaus Jensen     struct {
218688eea45cSKlaus Jensen         QEMUIOVector iov;
218788eea45cSKlaus Jensen         uint8_t *bounce;
218888eea45cSKlaus Jensen     } data;
218988eea45cSKlaus Jensen 
219088eea45cSKlaus Jensen     struct {
219188eea45cSKlaus Jensen         QEMUIOVector iov;
219288eea45cSKlaus Jensen         uint8_t *bounce;
219388eea45cSKlaus Jensen     } mdata;
219488eea45cSKlaus Jensen };
219588eea45cSKlaus Jensen 
219688eea45cSKlaus Jensen static void nvme_compare_mdata_cb(void *opaque, int ret)
219788eea45cSKlaus Jensen {
219888eea45cSKlaus Jensen     NvmeRequest *req = opaque;
219988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
220088eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
220188eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
22022a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
220388eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
220488eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
220544219b60SNaveen Nagar     uint64_t reftag = le32_to_cpu(rw->reftag);
220644219b60SNaveen Nagar     uint64_t cdw3 = le32_to_cpu(rw->cdw3);
220788eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
220888eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
220988eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
221088eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
221188eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
221288eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
221388eea45cSKlaus Jensen 
221444219b60SNaveen Nagar     reftag |= cdw3 << 32;
221544219b60SNaveen Nagar 
221688eea45cSKlaus Jensen     trace_pci_nvme_compare_mdata_cb(nvme_cid(req));
221788eea45cSKlaus Jensen 
221888eea45cSKlaus Jensen     if (ret) {
221988eea45cSKlaus Jensen         block_acct_failed(stats, acct);
222088eea45cSKlaus Jensen         nvme_aio_err(req, ret);
222188eea45cSKlaus Jensen         goto out;
222288eea45cSKlaus Jensen     }
222388eea45cSKlaus Jensen 
222488eea45cSKlaus Jensen     buf = g_malloc(ctx->mdata.iov.size);
222588eea45cSKlaus Jensen 
222688eea45cSKlaus Jensen     status = nvme_bounce_mdata(n, buf, ctx->mdata.iov.size,
222788eea45cSKlaus Jensen                                NVME_TX_DIRECTION_TO_DEVICE, req);
222888eea45cSKlaus Jensen     if (status) {
222988eea45cSKlaus Jensen         req->status = status;
223088eea45cSKlaus Jensen         goto out;
223188eea45cSKlaus Jensen     }
223288eea45cSKlaus Jensen 
223388eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
223488eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
223588eea45cSKlaus Jensen         uint8_t *bufp;
223688eea45cSKlaus Jensen         uint8_t *mbufp = ctx->mdata.bounce;
223788eea45cSKlaus Jensen         uint8_t *end = mbufp + ctx->mdata.iov.size;
223888eea45cSKlaus Jensen         int16_t pil = 0;
223988eea45cSKlaus Jensen 
224088eea45cSKlaus Jensen         status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
22412a132309SKlaus Jensen                                 ctx->mdata.bounce, ctx->mdata.iov.size, prinfo,
22420ca5c3ccSKlaus Jensen                                 slba, apptag, appmask, &reftag);
224388eea45cSKlaus Jensen         if (status) {
224488eea45cSKlaus Jensen             req->status = status;
224588eea45cSKlaus Jensen             goto out;
224688eea45cSKlaus Jensen         }
224788eea45cSKlaus Jensen 
224888eea45cSKlaus Jensen         /*
224988eea45cSKlaus Jensen          * When formatted with protection information, do not compare the DIF
225088eea45cSKlaus Jensen          * tuple.
225188eea45cSKlaus Jensen          */
225288eea45cSKlaus Jensen         if (!(ns->id_ns.dps & NVME_ID_NS_DPS_FIRST_EIGHT)) {
2253ac0b34c5SKlaus Jensen             pil = ns->lbaf.ms - nvme_pi_tuple_size(ns);
225488eea45cSKlaus Jensen         }
225588eea45cSKlaus Jensen 
225688eea45cSKlaus Jensen         for (bufp = buf; mbufp < end; bufp += ns->lbaf.ms, mbufp += ns->lbaf.ms) {
225788eea45cSKlaus Jensen             if (memcmp(bufp + pil, mbufp + pil, ns->lbaf.ms - pil)) {
225888eea45cSKlaus Jensen                 req->status = NVME_CMP_FAILURE;
225988eea45cSKlaus Jensen                 goto out;
226088eea45cSKlaus Jensen             }
226188eea45cSKlaus Jensen         }
226288eea45cSKlaus Jensen 
226388eea45cSKlaus Jensen         goto out;
226488eea45cSKlaus Jensen     }
226588eea45cSKlaus Jensen 
226688eea45cSKlaus Jensen     if (memcmp(buf, ctx->mdata.bounce, ctx->mdata.iov.size)) {
226788eea45cSKlaus Jensen         req->status = NVME_CMP_FAILURE;
226888eea45cSKlaus Jensen         goto out;
226988eea45cSKlaus Jensen     }
227088eea45cSKlaus Jensen 
227188eea45cSKlaus Jensen     block_acct_done(stats, acct);
227288eea45cSKlaus Jensen 
227388eea45cSKlaus Jensen out:
227488eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
227588eea45cSKlaus Jensen     g_free(ctx->data.bounce);
227688eea45cSKlaus Jensen 
227788eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
227888eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
227988eea45cSKlaus Jensen 
228088eea45cSKlaus Jensen     g_free(ctx);
228188eea45cSKlaus Jensen 
228288eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
228388eea45cSKlaus Jensen }
228488eea45cSKlaus Jensen 
228588eea45cSKlaus Jensen static void nvme_compare_data_cb(void *opaque, int ret)
228688eea45cSKlaus Jensen {
228788eea45cSKlaus Jensen     NvmeRequest *req = opaque;
228888eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
228988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
229088eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
229188eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
229288eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
229388eea45cSKlaus Jensen 
229488eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
229588eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
229688eea45cSKlaus Jensen     uint16_t status;
229788eea45cSKlaus Jensen 
229888eea45cSKlaus Jensen     trace_pci_nvme_compare_data_cb(nvme_cid(req));
229988eea45cSKlaus Jensen 
230088eea45cSKlaus Jensen     if (ret) {
230188eea45cSKlaus Jensen         block_acct_failed(stats, acct);
230288eea45cSKlaus Jensen         nvme_aio_err(req, ret);
230388eea45cSKlaus Jensen         goto out;
230488eea45cSKlaus Jensen     }
230588eea45cSKlaus Jensen 
230688eea45cSKlaus Jensen     buf = g_malloc(ctx->data.iov.size);
230788eea45cSKlaus Jensen 
230888eea45cSKlaus Jensen     status = nvme_bounce_data(n, buf, ctx->data.iov.size,
230988eea45cSKlaus Jensen                               NVME_TX_DIRECTION_TO_DEVICE, req);
231088eea45cSKlaus Jensen     if (status) {
231188eea45cSKlaus Jensen         req->status = status;
231288eea45cSKlaus Jensen         goto out;
231388eea45cSKlaus Jensen     }
231488eea45cSKlaus Jensen 
231588eea45cSKlaus Jensen     if (memcmp(buf, ctx->data.bounce, ctx->data.iov.size)) {
231688eea45cSKlaus Jensen         req->status = NVME_CMP_FAILURE;
231788eea45cSKlaus Jensen         goto out;
231888eea45cSKlaus Jensen     }
231988eea45cSKlaus Jensen 
232088eea45cSKlaus Jensen     if (ns->lbaf.ms) {
232188eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
232288eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
232388eea45cSKlaus Jensen         uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
232488eea45cSKlaus Jensen         size_t mlen = nvme_m2b(ns, nlb);
232588eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
232688eea45cSKlaus Jensen 
232788eea45cSKlaus Jensen         ctx->mdata.bounce = g_malloc(mlen);
232888eea45cSKlaus Jensen 
232988eea45cSKlaus Jensen         qemu_iovec_init(&ctx->mdata.iov, 1);
233088eea45cSKlaus Jensen         qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
233188eea45cSKlaus Jensen 
233288eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
233388eea45cSKlaus Jensen                                     nvme_compare_mdata_cb, req);
233488eea45cSKlaus Jensen         return;
233588eea45cSKlaus Jensen     }
233688eea45cSKlaus Jensen 
233788eea45cSKlaus Jensen     block_acct_done(stats, acct);
233888eea45cSKlaus Jensen 
233988eea45cSKlaus Jensen out:
234088eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
234188eea45cSKlaus Jensen     g_free(ctx->data.bounce);
234288eea45cSKlaus Jensen     g_free(ctx);
234388eea45cSKlaus Jensen 
234488eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
234588eea45cSKlaus Jensen }
234688eea45cSKlaus Jensen 
2347d7d1474fSKlaus Jensen typedef struct NvmeDSMAIOCB {
2348d7d1474fSKlaus Jensen     BlockAIOCB common;
2349d7d1474fSKlaus Jensen     BlockAIOCB *aiocb;
2350d7d1474fSKlaus Jensen     NvmeRequest *req;
2351d7d1474fSKlaus Jensen     int ret;
2352d7d1474fSKlaus Jensen 
2353d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2354d7d1474fSKlaus Jensen     unsigned int nr;
2355d7d1474fSKlaus Jensen     unsigned int idx;
2356d7d1474fSKlaus Jensen } NvmeDSMAIOCB;
2357d7d1474fSKlaus Jensen 
2358d7d1474fSKlaus Jensen static void nvme_dsm_cancel(BlockAIOCB *aiocb)
2359d7d1474fSKlaus Jensen {
2360d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = container_of(aiocb, NvmeDSMAIOCB, common);
2361d7d1474fSKlaus Jensen 
2362d7d1474fSKlaus Jensen     /* break nvme_dsm_cb loop */
2363d7d1474fSKlaus Jensen     iocb->idx = iocb->nr;
2364d7d1474fSKlaus Jensen     iocb->ret = -ECANCELED;
2365d7d1474fSKlaus Jensen 
2366d7d1474fSKlaus Jensen     if (iocb->aiocb) {
2367d7d1474fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2368d7d1474fSKlaus Jensen         iocb->aiocb = NULL;
2369d7d1474fSKlaus Jensen     } else {
2370d7d1474fSKlaus Jensen         /*
2371d7d1474fSKlaus Jensen          * We only reach this if nvme_dsm_cancel() has already been called or
2372818b9b8fSKlaus Jensen          * the command ran to completion.
2373d7d1474fSKlaus Jensen          */
2374d7d1474fSKlaus Jensen         assert(iocb->idx == iocb->nr);
2375d7d1474fSKlaus Jensen     }
2376d7d1474fSKlaus Jensen }
2377d7d1474fSKlaus Jensen 
2378d7d1474fSKlaus Jensen static const AIOCBInfo nvme_dsm_aiocb_info = {
2379d7d1474fSKlaus Jensen     .aiocb_size   = sizeof(NvmeDSMAIOCB),
2380d7d1474fSKlaus Jensen     .cancel_async = nvme_dsm_cancel,
2381d7d1474fSKlaus Jensen };
2382d7d1474fSKlaus Jensen 
2383d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret);
2384d7d1474fSKlaus Jensen 
2385d7d1474fSKlaus Jensen static void nvme_dsm_md_cb(void *opaque, int ret)
2386d7d1474fSKlaus Jensen {
2387d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2388d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2389d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2390d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2391d7d1474fSKlaus Jensen     uint64_t slba;
2392d7d1474fSKlaus Jensen     uint32_t nlb;
2393d7d1474fSKlaus Jensen 
2394818b9b8fSKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
2395d7d1474fSKlaus Jensen         goto done;
2396d7d1474fSKlaus Jensen     }
2397d7d1474fSKlaus Jensen 
2398d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx - 1];
2399d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2400d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2401d7d1474fSKlaus Jensen 
2402d7d1474fSKlaus Jensen     /*
2403d7d1474fSKlaus Jensen      * Check that all block were discarded (zeroed); otherwise we do not zero
2404d7d1474fSKlaus Jensen      * the metadata.
2405d7d1474fSKlaus Jensen      */
2406d7d1474fSKlaus Jensen 
2407d7d1474fSKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_ZERO);
2408d7d1474fSKlaus Jensen     if (ret) {
2409d7d1474fSKlaus Jensen         if (ret < 0) {
2410d7d1474fSKlaus Jensen             goto done;
2411d7d1474fSKlaus Jensen         }
2412d7d1474fSKlaus Jensen 
2413d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
241451c45326SDmitry Tikhov         return;
2415d7d1474fSKlaus Jensen     }
2416d7d1474fSKlaus Jensen 
2417d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, nvme_moff(ns, slba),
2418d7d1474fSKlaus Jensen                                         nvme_m2b(ns, nlb), BDRV_REQ_MAY_UNMAP,
2419d7d1474fSKlaus Jensen                                         nvme_dsm_cb, iocb);
2420d7d1474fSKlaus Jensen     return;
2421d7d1474fSKlaus Jensen 
2422d7d1474fSKlaus Jensen done:
2423818b9b8fSKlaus Jensen     nvme_dsm_cb(iocb, ret);
2424d7d1474fSKlaus Jensen }
2425d7d1474fSKlaus Jensen 
2426d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret)
2427d7d1474fSKlaus Jensen {
2428d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2429d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2430d7d1474fSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
2431d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2432d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2433d7d1474fSKlaus Jensen     uint64_t slba;
2434d7d1474fSKlaus Jensen     uint32_t nlb;
2435d7d1474fSKlaus Jensen 
2436818b9b8fSKlaus Jensen     if (iocb->ret < 0) {
2437818b9b8fSKlaus Jensen         goto done;
2438818b9b8fSKlaus Jensen     } else if (ret < 0) {
2439d7d1474fSKlaus Jensen         iocb->ret = ret;
2440d7d1474fSKlaus Jensen         goto done;
2441d7d1474fSKlaus Jensen     }
2442d7d1474fSKlaus Jensen 
2443d7d1474fSKlaus Jensen next:
2444d7d1474fSKlaus Jensen     if (iocb->idx == iocb->nr) {
2445d7d1474fSKlaus Jensen         goto done;
2446d7d1474fSKlaus Jensen     }
2447d7d1474fSKlaus Jensen 
2448d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx++];
2449d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2450d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2451d7d1474fSKlaus Jensen 
2452d7d1474fSKlaus Jensen     trace_pci_nvme_dsm_deallocate(slba, nlb);
2453d7d1474fSKlaus Jensen 
2454d7d1474fSKlaus Jensen     if (nlb > n->dmrsl) {
2455d7d1474fSKlaus Jensen         trace_pci_nvme_dsm_single_range_limit_exceeded(nlb, n->dmrsl);
2456d7d1474fSKlaus Jensen         goto next;
2457d7d1474fSKlaus Jensen     }
2458d7d1474fSKlaus Jensen 
2459d7d1474fSKlaus Jensen     if (nvme_check_bounds(ns, slba, nlb)) {
2460d7d1474fSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb,
2461d7d1474fSKlaus Jensen                                              ns->id_ns.nsze);
2462d7d1474fSKlaus Jensen         goto next;
2463d7d1474fSKlaus Jensen     }
2464d7d1474fSKlaus Jensen 
2465d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pdiscard(ns->blkconf.blk, nvme_l2b(ns, slba),
2466d7d1474fSKlaus Jensen                                    nvme_l2b(ns, nlb),
2467d7d1474fSKlaus Jensen                                    nvme_dsm_md_cb, iocb);
2468d7d1474fSKlaus Jensen     return;
2469d7d1474fSKlaus Jensen 
2470d7d1474fSKlaus Jensen done:
2471d7d1474fSKlaus Jensen     iocb->aiocb = NULL;
2472818b9b8fSKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2473818b9b8fSKlaus Jensen     qemu_aio_unref(iocb);
2474d7d1474fSKlaus Jensen }
2475d7d1474fSKlaus Jensen 
247688eea45cSKlaus Jensen static uint16_t nvme_dsm(NvmeCtrl *n, NvmeRequest *req)
247788eea45cSKlaus Jensen {
247888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
247988eea45cSKlaus Jensen     NvmeDsmCmd *dsm = (NvmeDsmCmd *) &req->cmd;
248088eea45cSKlaus Jensen     uint32_t attr = le32_to_cpu(dsm->attributes);
248188eea45cSKlaus Jensen     uint32_t nr = (le32_to_cpu(dsm->nr) & 0xff) + 1;
248288eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
248388eea45cSKlaus Jensen 
2484d7d1474fSKlaus Jensen     trace_pci_nvme_dsm(nr, attr);
248588eea45cSKlaus Jensen 
248688eea45cSKlaus Jensen     if (attr & NVME_DSMGMT_AD) {
2487d7d1474fSKlaus Jensen         NvmeDSMAIOCB *iocb = blk_aio_get(&nvme_dsm_aiocb_info, ns->blkconf.blk,
2488d7d1474fSKlaus Jensen                                          nvme_misc_cb, req);
248988eea45cSKlaus Jensen 
2490d7d1474fSKlaus Jensen         iocb->req = req;
2491d7d1474fSKlaus Jensen         iocb->ret = 0;
2492d7d1474fSKlaus Jensen         iocb->range = g_new(NvmeDsmRange, nr);
2493d7d1474fSKlaus Jensen         iocb->nr = nr;
2494d7d1474fSKlaus Jensen         iocb->idx = 0;
2495d7d1474fSKlaus Jensen 
2496d7d1474fSKlaus Jensen         status = nvme_h2c(n, (uint8_t *)iocb->range, sizeof(NvmeDsmRange) * nr,
2497d7d1474fSKlaus Jensen                           req);
249888eea45cSKlaus Jensen         if (status) {
249988eea45cSKlaus Jensen             return status;
250088eea45cSKlaus Jensen         }
250188eea45cSKlaus Jensen 
2502d7d1474fSKlaus Jensen         req->aiocb = &iocb->common;
2503d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
250488eea45cSKlaus Jensen 
2505d7d1474fSKlaus Jensen         return NVME_NO_COMPLETE;
250688eea45cSKlaus Jensen     }
250788eea45cSKlaus Jensen 
250888eea45cSKlaus Jensen     return status;
250988eea45cSKlaus Jensen }
251088eea45cSKlaus Jensen 
251188eea45cSKlaus Jensen static uint16_t nvme_verify(NvmeCtrl *n, NvmeRequest *req)
251288eea45cSKlaus Jensen {
251388eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
251488eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
251588eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
251688eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
251788eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
251888eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
251988eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
25202a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
252188eea45cSKlaus Jensen     uint32_t reftag = le32_to_cpu(rw->reftag);
252288eea45cSKlaus Jensen     NvmeBounceContext *ctx = NULL;
252388eea45cSKlaus Jensen     uint16_t status;
252488eea45cSKlaus Jensen 
252588eea45cSKlaus Jensen     trace_pci_nvme_verify(nvme_cid(req), nvme_nsid(ns), slba, nlb);
252688eea45cSKlaus Jensen 
252788eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
25282a132309SKlaus Jensen         status = nvme_check_prinfo(ns, prinfo, slba, reftag);
252988eea45cSKlaus Jensen         if (status) {
253088eea45cSKlaus Jensen             return status;
253188eea45cSKlaus Jensen         }
253288eea45cSKlaus Jensen 
25332a132309SKlaus Jensen         if (prinfo & NVME_PRINFO_PRACT) {
253488eea45cSKlaus Jensen             return NVME_INVALID_PROT_INFO | NVME_DNR;
253588eea45cSKlaus Jensen         }
253688eea45cSKlaus Jensen     }
253788eea45cSKlaus Jensen 
253888eea45cSKlaus Jensen     if (len > n->page_size << n->params.vsl) {
253988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
254088eea45cSKlaus Jensen     }
254188eea45cSKlaus Jensen 
254288eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
254388eea45cSKlaus Jensen     if (status) {
254488eea45cSKlaus Jensen         return status;
254588eea45cSKlaus Jensen     }
254688eea45cSKlaus Jensen 
254788eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
254888eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
254988eea45cSKlaus Jensen         if (status) {
255088eea45cSKlaus Jensen             return status;
255188eea45cSKlaus Jensen         }
255288eea45cSKlaus Jensen     }
255388eea45cSKlaus Jensen 
255488eea45cSKlaus Jensen     ctx = g_new0(NvmeBounceContext, 1);
255588eea45cSKlaus Jensen     ctx->req = req;
255688eea45cSKlaus Jensen 
255788eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(len);
255888eea45cSKlaus Jensen 
255988eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
256088eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, len);
256188eea45cSKlaus Jensen 
256288eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, ctx->data.iov.size,
256388eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
256488eea45cSKlaus Jensen 
256588eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(ns->blkconf.blk, offset, &ctx->data.iov, 0,
256688eea45cSKlaus Jensen                                 nvme_verify_mdata_in_cb, ctx);
256788eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
256888eea45cSKlaus Jensen }
256988eea45cSKlaus Jensen 
2570796d2068SKlaus Jensen typedef struct NvmeCopyAIOCB {
2571796d2068SKlaus Jensen     BlockAIOCB common;
2572796d2068SKlaus Jensen     BlockAIOCB *aiocb;
2573796d2068SKlaus Jensen     NvmeRequest *req;
2574796d2068SKlaus Jensen     int ret;
2575796d2068SKlaus Jensen 
257644219b60SNaveen Nagar     void *ranges;
257744219b60SNaveen Nagar     unsigned int format;
2578796d2068SKlaus Jensen     int nr;
2579796d2068SKlaus Jensen     int idx;
2580796d2068SKlaus Jensen 
2581796d2068SKlaus Jensen     uint8_t *bounce;
2582796d2068SKlaus Jensen     QEMUIOVector iov;
2583796d2068SKlaus Jensen     struct {
2584796d2068SKlaus Jensen         BlockAcctCookie read;
2585796d2068SKlaus Jensen         BlockAcctCookie write;
2586796d2068SKlaus Jensen     } acct;
2587796d2068SKlaus Jensen 
258844219b60SNaveen Nagar     uint64_t reftag;
2589796d2068SKlaus Jensen     uint64_t slba;
2590796d2068SKlaus Jensen 
2591796d2068SKlaus Jensen     NvmeZone *zone;
2592796d2068SKlaus Jensen } NvmeCopyAIOCB;
2593796d2068SKlaus Jensen 
2594796d2068SKlaus Jensen static void nvme_copy_cancel(BlockAIOCB *aiocb)
259588eea45cSKlaus Jensen {
2596796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = container_of(aiocb, NvmeCopyAIOCB, common);
2597796d2068SKlaus Jensen 
2598796d2068SKlaus Jensen     iocb->ret = -ECANCELED;
2599796d2068SKlaus Jensen 
2600796d2068SKlaus Jensen     if (iocb->aiocb) {
2601796d2068SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2602796d2068SKlaus Jensen         iocb->aiocb = NULL;
2603796d2068SKlaus Jensen     }
2604796d2068SKlaus Jensen }
2605796d2068SKlaus Jensen 
2606796d2068SKlaus Jensen static const AIOCBInfo nvme_copy_aiocb_info = {
2607796d2068SKlaus Jensen     .aiocb_size   = sizeof(NvmeCopyAIOCB),
2608796d2068SKlaus Jensen     .cancel_async = nvme_copy_cancel,
2609796d2068SKlaus Jensen };
2610796d2068SKlaus Jensen 
261183f56ac3SKlaus Jensen static void nvme_copy_done(NvmeCopyAIOCB *iocb)
2612796d2068SKlaus Jensen {
2613796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
261488eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
2615796d2068SKlaus Jensen     BlockAcctStats *stats = blk_get_stats(ns->blkconf.blk);
2616796d2068SKlaus Jensen 
2617796d2068SKlaus Jensen     if (iocb->idx != iocb->nr) {
2618796d2068SKlaus Jensen         req->cqe.result = cpu_to_le32(iocb->idx);
2619796d2068SKlaus Jensen     }
2620796d2068SKlaus Jensen 
2621796d2068SKlaus Jensen     qemu_iovec_destroy(&iocb->iov);
2622796d2068SKlaus Jensen     g_free(iocb->bounce);
2623796d2068SKlaus Jensen 
2624796d2068SKlaus Jensen     if (iocb->ret < 0) {
2625796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.read);
2626796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.write);
2627796d2068SKlaus Jensen     } else {
2628796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.read);
2629796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.write);
2630796d2068SKlaus Jensen     }
2631796d2068SKlaus Jensen 
2632796d2068SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2633796d2068SKlaus Jensen     qemu_aio_unref(iocb);
2634796d2068SKlaus Jensen }
2635796d2068SKlaus Jensen 
263683f56ac3SKlaus Jensen static void nvme_do_copy(NvmeCopyAIOCB *iocb);
2637796d2068SKlaus Jensen 
263844219b60SNaveen Nagar static void nvme_copy_source_range_parse_format0(void *ranges, int idx,
263944219b60SNaveen Nagar                                                  uint64_t *slba, uint32_t *nlb,
264044219b60SNaveen Nagar                                                  uint16_t *apptag,
264144219b60SNaveen Nagar                                                  uint16_t *appmask,
264244219b60SNaveen Nagar                                                  uint64_t *reftag)
264344219b60SNaveen Nagar {
264444219b60SNaveen Nagar     NvmeCopySourceRangeFormat0 *_ranges = ranges;
264544219b60SNaveen Nagar 
264644219b60SNaveen Nagar     if (slba) {
264744219b60SNaveen Nagar         *slba = le64_to_cpu(_ranges[idx].slba);
264844219b60SNaveen Nagar     }
264944219b60SNaveen Nagar 
265044219b60SNaveen Nagar     if (nlb) {
265144219b60SNaveen Nagar         *nlb = le16_to_cpu(_ranges[idx].nlb) + 1;
265244219b60SNaveen Nagar     }
265344219b60SNaveen Nagar 
265444219b60SNaveen Nagar     if (apptag) {
265544219b60SNaveen Nagar         *apptag = le16_to_cpu(_ranges[idx].apptag);
265644219b60SNaveen Nagar     }
265744219b60SNaveen Nagar 
265844219b60SNaveen Nagar     if (appmask) {
265944219b60SNaveen Nagar         *appmask = le16_to_cpu(_ranges[idx].appmask);
266044219b60SNaveen Nagar     }
266144219b60SNaveen Nagar 
266244219b60SNaveen Nagar     if (reftag) {
266344219b60SNaveen Nagar         *reftag = le32_to_cpu(_ranges[idx].reftag);
266444219b60SNaveen Nagar     }
266544219b60SNaveen Nagar }
266644219b60SNaveen Nagar 
266744219b60SNaveen Nagar static void nvme_copy_source_range_parse_format1(void *ranges, int idx,
266844219b60SNaveen Nagar                                                  uint64_t *slba, uint32_t *nlb,
266944219b60SNaveen Nagar                                                  uint16_t *apptag,
267044219b60SNaveen Nagar                                                  uint16_t *appmask,
267144219b60SNaveen Nagar                                                  uint64_t *reftag)
267244219b60SNaveen Nagar {
267344219b60SNaveen Nagar     NvmeCopySourceRangeFormat1 *_ranges = ranges;
267444219b60SNaveen Nagar 
267544219b60SNaveen Nagar     if (slba) {
267644219b60SNaveen Nagar         *slba = le64_to_cpu(_ranges[idx].slba);
267744219b60SNaveen Nagar     }
267844219b60SNaveen Nagar 
267944219b60SNaveen Nagar     if (nlb) {
268044219b60SNaveen Nagar         *nlb = le16_to_cpu(_ranges[idx].nlb) + 1;
268144219b60SNaveen Nagar     }
268244219b60SNaveen Nagar 
268344219b60SNaveen Nagar     if (apptag) {
268444219b60SNaveen Nagar         *apptag = le16_to_cpu(_ranges[idx].apptag);
268544219b60SNaveen Nagar     }
268644219b60SNaveen Nagar 
268744219b60SNaveen Nagar     if (appmask) {
268844219b60SNaveen Nagar         *appmask = le16_to_cpu(_ranges[idx].appmask);
268944219b60SNaveen Nagar     }
269044219b60SNaveen Nagar 
269144219b60SNaveen Nagar     if (reftag) {
269244219b60SNaveen Nagar         *reftag = 0;
269344219b60SNaveen Nagar 
269444219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[4] << 40;
269544219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[5] << 32;
269644219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[6] << 24;
269744219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[7] << 16;
269844219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[8] << 8;
269944219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[9];
270044219b60SNaveen Nagar     }
270144219b60SNaveen Nagar }
270244219b60SNaveen Nagar 
270344219b60SNaveen Nagar static void nvme_copy_source_range_parse(void *ranges, int idx, uint8_t format,
270444219b60SNaveen Nagar                                          uint64_t *slba, uint32_t *nlb,
270544219b60SNaveen Nagar                                          uint16_t *apptag, uint16_t *appmask,
270644219b60SNaveen Nagar                                          uint64_t *reftag)
270744219b60SNaveen Nagar {
270844219b60SNaveen Nagar     switch (format) {
270944219b60SNaveen Nagar     case NVME_COPY_FORMAT_0:
271044219b60SNaveen Nagar         nvme_copy_source_range_parse_format0(ranges, idx, slba, nlb, apptag,
271144219b60SNaveen Nagar                                              appmask, reftag);
271244219b60SNaveen Nagar         break;
271344219b60SNaveen Nagar 
271444219b60SNaveen Nagar     case NVME_COPY_FORMAT_1:
271544219b60SNaveen Nagar         nvme_copy_source_range_parse_format1(ranges, idx, slba, nlb, apptag,
271644219b60SNaveen Nagar                                              appmask, reftag);
271744219b60SNaveen Nagar         break;
271844219b60SNaveen Nagar 
271944219b60SNaveen Nagar     default:
272044219b60SNaveen Nagar         abort();
272144219b60SNaveen Nagar     }
272244219b60SNaveen Nagar }
272344219b60SNaveen Nagar 
2724796d2068SKlaus Jensen static void nvme_copy_out_completed_cb(void *opaque, int ret)
2725796d2068SKlaus Jensen {
2726796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2727796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2728796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
272944219b60SNaveen Nagar     uint32_t nlb;
273044219b60SNaveen Nagar 
273144219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, NULL,
273244219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
2733796d2068SKlaus Jensen 
2734796d2068SKlaus Jensen     if (ret < 0) {
2735796d2068SKlaus Jensen         iocb->ret = ret;
2736796d2068SKlaus Jensen         goto out;
2737796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2738796d2068SKlaus Jensen         goto out;
2739796d2068SKlaus Jensen     }
2740796d2068SKlaus Jensen 
2741796d2068SKlaus Jensen     if (ns->params.zoned) {
2742796d2068SKlaus Jensen         nvme_advance_zone_wp(ns, iocb->zone, nlb);
2743796d2068SKlaus Jensen     }
2744796d2068SKlaus Jensen 
2745796d2068SKlaus Jensen     iocb->idx++;
2746796d2068SKlaus Jensen     iocb->slba += nlb;
2747796d2068SKlaus Jensen out:
274883f56ac3SKlaus Jensen     nvme_do_copy(iocb);
2749796d2068SKlaus Jensen }
2750796d2068SKlaus Jensen 
2751796d2068SKlaus Jensen static void nvme_copy_out_cb(void *opaque, int ret)
2752796d2068SKlaus Jensen {
2753796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2754796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2755796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2756796d2068SKlaus Jensen     uint32_t nlb;
2757796d2068SKlaus Jensen     size_t mlen;
2758796d2068SKlaus Jensen     uint8_t *mbounce;
2759796d2068SKlaus Jensen 
276083f56ac3SKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
2761796d2068SKlaus Jensen         goto out;
2762796d2068SKlaus Jensen     }
2763796d2068SKlaus Jensen 
276444219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, NULL,
276544219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
2766796d2068SKlaus Jensen 
2767796d2068SKlaus Jensen     mlen = nvme_m2b(ns, nlb);
2768796d2068SKlaus Jensen     mbounce = iocb->bounce + nvme_l2b(ns, nlb);
2769796d2068SKlaus Jensen 
2770796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2771796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, mbounce, mlen);
2772796d2068SKlaus Jensen 
2773796d2068SKlaus Jensen     iocb->aiocb = blk_aio_pwritev(ns->blkconf.blk, nvme_moff(ns, iocb->slba),
2774796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_completed_cb,
2775796d2068SKlaus Jensen                                   iocb);
2776796d2068SKlaus Jensen 
2777796d2068SKlaus Jensen     return;
2778796d2068SKlaus Jensen 
2779796d2068SKlaus Jensen out:
278083f56ac3SKlaus Jensen     nvme_copy_out_completed_cb(iocb, ret);
2781796d2068SKlaus Jensen }
2782796d2068SKlaus Jensen 
2783796d2068SKlaus Jensen static void nvme_copy_in_completed_cb(void *opaque, int ret)
2784796d2068SKlaus Jensen {
2785796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2786796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2787796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2788796d2068SKlaus Jensen     uint32_t nlb;
278944219b60SNaveen Nagar     uint64_t slba;
279044219b60SNaveen Nagar     uint16_t apptag, appmask;
279144219b60SNaveen Nagar     uint64_t reftag;
2792796d2068SKlaus Jensen     size_t len;
2793796d2068SKlaus Jensen     uint16_t status;
2794796d2068SKlaus Jensen 
2795796d2068SKlaus Jensen     if (ret < 0) {
2796796d2068SKlaus Jensen         iocb->ret = ret;
2797796d2068SKlaus Jensen         goto out;
2798796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2799796d2068SKlaus Jensen         goto out;
2800796d2068SKlaus Jensen     }
2801796d2068SKlaus Jensen 
280244219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
280344219b60SNaveen Nagar                                  &nlb, &apptag, &appmask, &reftag);
2804796d2068SKlaus Jensen     len = nvme_l2b(ns, nlb);
2805796d2068SKlaus Jensen 
2806796d2068SKlaus Jensen     trace_pci_nvme_copy_out(iocb->slba, nlb);
2807796d2068SKlaus Jensen 
2808796d2068SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
280988eea45cSKlaus Jensen         NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
281088eea45cSKlaus Jensen 
2811796d2068SKlaus Jensen         uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
2812796d2068SKlaus Jensen         uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
281388eea45cSKlaus Jensen 
2814796d2068SKlaus Jensen         size_t mlen = nvme_m2b(ns, nlb);
2815796d2068SKlaus Jensen         uint8_t *mbounce = iocb->bounce + nvme_l2b(ns, nlb);
2816796d2068SKlaus Jensen 
28172e8f952aSDmitry Tikhov         status = nvme_dif_mangle_mdata(ns, mbounce, mlen, slba);
28182e8f952aSDmitry Tikhov         if (status) {
28192e8f952aSDmitry Tikhov             goto invalid;
28202e8f952aSDmitry Tikhov         }
2821796d2068SKlaus Jensen         status = nvme_dif_check(ns, iocb->bounce, len, mbounce, mlen, prinfor,
2822796d2068SKlaus Jensen                                 slba, apptag, appmask, &reftag);
2823796d2068SKlaus Jensen         if (status) {
2824796d2068SKlaus Jensen             goto invalid;
2825796d2068SKlaus Jensen         }
2826796d2068SKlaus Jensen 
2827796d2068SKlaus Jensen         apptag = le16_to_cpu(copy->apptag);
2828796d2068SKlaus Jensen         appmask = le16_to_cpu(copy->appmask);
2829796d2068SKlaus Jensen 
2830796d2068SKlaus Jensen         if (prinfow & NVME_PRINFO_PRACT) {
2831796d2068SKlaus Jensen             status = nvme_check_prinfo(ns, prinfow, iocb->slba, iocb->reftag);
2832796d2068SKlaus Jensen             if (status) {
2833796d2068SKlaus Jensen                 goto invalid;
2834796d2068SKlaus Jensen             }
2835796d2068SKlaus Jensen 
2836796d2068SKlaus Jensen             nvme_dif_pract_generate_dif(ns, iocb->bounce, len, mbounce, mlen,
2837796d2068SKlaus Jensen                                         apptag, &iocb->reftag);
2838796d2068SKlaus Jensen         } else {
2839796d2068SKlaus Jensen             status = nvme_dif_check(ns, iocb->bounce, len, mbounce, mlen,
2840796d2068SKlaus Jensen                                     prinfow, iocb->slba, apptag, appmask,
2841796d2068SKlaus Jensen                                     &iocb->reftag);
2842796d2068SKlaus Jensen             if (status) {
2843796d2068SKlaus Jensen                 goto invalid;
2844796d2068SKlaus Jensen             }
2845796d2068SKlaus Jensen         }
2846796d2068SKlaus Jensen     }
2847796d2068SKlaus Jensen 
2848796d2068SKlaus Jensen     status = nvme_check_bounds(ns, iocb->slba, nlb);
2849796d2068SKlaus Jensen     if (status) {
2850796d2068SKlaus Jensen         goto invalid;
2851796d2068SKlaus Jensen     }
2852796d2068SKlaus Jensen 
2853796d2068SKlaus Jensen     if (ns->params.zoned) {
2854796d2068SKlaus Jensen         status = nvme_check_zone_write(ns, iocb->zone, iocb->slba, nlb);
2855796d2068SKlaus Jensen         if (status) {
2856796d2068SKlaus Jensen             goto invalid;
2857796d2068SKlaus Jensen         }
2858796d2068SKlaus Jensen 
2859e321b4cdSKlaus Jensen         if (!(iocb->zone->d.za & NVME_ZA_ZRWA_VALID)) {
2860796d2068SKlaus Jensen             iocb->zone->w_ptr += nlb;
2861796d2068SKlaus Jensen         }
2862e321b4cdSKlaus Jensen     }
2863796d2068SKlaus Jensen 
2864796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2865796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
2866796d2068SKlaus Jensen 
2867796d2068SKlaus Jensen     iocb->aiocb = blk_aio_pwritev(ns->blkconf.blk, nvme_l2b(ns, iocb->slba),
2868796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_cb, iocb);
2869796d2068SKlaus Jensen 
2870796d2068SKlaus Jensen     return;
2871796d2068SKlaus Jensen 
2872796d2068SKlaus Jensen invalid:
2873796d2068SKlaus Jensen     req->status = status;
287483f56ac3SKlaus Jensen     iocb->ret = -1;
2875796d2068SKlaus Jensen out:
287683f56ac3SKlaus Jensen     nvme_do_copy(iocb);
2877796d2068SKlaus Jensen }
2878796d2068SKlaus Jensen 
2879796d2068SKlaus Jensen static void nvme_copy_in_cb(void *opaque, int ret)
2880796d2068SKlaus Jensen {
2881796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2882796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2883796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2884796d2068SKlaus Jensen     uint64_t slba;
2885796d2068SKlaus Jensen     uint32_t nlb;
2886796d2068SKlaus Jensen 
288783f56ac3SKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
2888796d2068SKlaus Jensen         goto out;
2889796d2068SKlaus Jensen     }
2890796d2068SKlaus Jensen 
289144219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
289244219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
2893796d2068SKlaus Jensen 
2894796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2895796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce + nvme_l2b(ns, nlb),
2896796d2068SKlaus Jensen                    nvme_m2b(ns, nlb));
2897796d2068SKlaus Jensen 
2898796d2068SKlaus Jensen     iocb->aiocb = blk_aio_preadv(ns->blkconf.blk, nvme_moff(ns, slba),
2899796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_completed_cb,
2900796d2068SKlaus Jensen                                  iocb);
2901796d2068SKlaus Jensen     return;
2902796d2068SKlaus Jensen 
2903796d2068SKlaus Jensen out:
290483f56ac3SKlaus Jensen     nvme_copy_in_completed_cb(iocb, ret);
2905796d2068SKlaus Jensen }
2906796d2068SKlaus Jensen 
290783f56ac3SKlaus Jensen static void nvme_do_copy(NvmeCopyAIOCB *iocb)
2908796d2068SKlaus Jensen {
2909796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2910796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2911796d2068SKlaus Jensen     uint64_t slba;
2912796d2068SKlaus Jensen     uint32_t nlb;
2913796d2068SKlaus Jensen     size_t len;
291488eea45cSKlaus Jensen     uint16_t status;
291588eea45cSKlaus Jensen 
291683f56ac3SKlaus Jensen     if (iocb->ret < 0) {
2917796d2068SKlaus Jensen         goto done;
291888eea45cSKlaus Jensen     }
291988eea45cSKlaus Jensen 
2920796d2068SKlaus Jensen     if (iocb->idx == iocb->nr) {
2921796d2068SKlaus Jensen         goto done;
292288eea45cSKlaus Jensen     }
292388eea45cSKlaus Jensen 
292444219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
292544219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
2926796d2068SKlaus Jensen     len = nvme_l2b(ns, nlb);
292788eea45cSKlaus Jensen 
2928796d2068SKlaus Jensen     trace_pci_nvme_copy_source_range(slba, nlb);
292988eea45cSKlaus Jensen 
2930796d2068SKlaus Jensen     if (nlb > le16_to_cpu(ns->id_ns.mssrl)) {
293188eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
2932796d2068SKlaus Jensen         goto invalid;
293388eea45cSKlaus Jensen     }
293488eea45cSKlaus Jensen 
2935796d2068SKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
293688eea45cSKlaus Jensen     if (status) {
2937796d2068SKlaus Jensen         goto invalid;
293888eea45cSKlaus Jensen     }
293988eea45cSKlaus Jensen 
294088eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
2941796d2068SKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
294288eea45cSKlaus Jensen         if (status) {
2943796d2068SKlaus Jensen             goto invalid;
294488eea45cSKlaus Jensen         }
294588eea45cSKlaus Jensen     }
294688eea45cSKlaus Jensen 
294788eea45cSKlaus Jensen     if (ns->params.zoned) {
2948796d2068SKlaus Jensen         status = nvme_check_zone_read(ns, slba, nlb);
294988eea45cSKlaus Jensen         if (status) {
2950796d2068SKlaus Jensen             goto invalid;
295188eea45cSKlaus Jensen         }
295288eea45cSKlaus Jensen     }
295388eea45cSKlaus Jensen 
2954796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2955796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
2956796d2068SKlaus Jensen 
2957796d2068SKlaus Jensen     iocb->aiocb = blk_aio_preadv(ns->blkconf.blk, nvme_l2b(ns, slba),
2958796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_cb, iocb);
2959796d2068SKlaus Jensen     return;
2960796d2068SKlaus Jensen 
2961796d2068SKlaus Jensen invalid:
2962796d2068SKlaus Jensen     req->status = status;
296383f56ac3SKlaus Jensen     iocb->ret = -1;
2964796d2068SKlaus Jensen done:
296583f56ac3SKlaus Jensen     nvme_copy_done(iocb);
2966796d2068SKlaus Jensen }
2967796d2068SKlaus Jensen 
2968796d2068SKlaus Jensen static uint16_t nvme_copy(NvmeCtrl *n, NvmeRequest *req)
2969796d2068SKlaus Jensen {
2970796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2971796d2068SKlaus Jensen     NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
2972796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = blk_aio_get(&nvme_copy_aiocb_info, ns->blkconf.blk,
2973796d2068SKlaus Jensen                                       nvme_misc_cb, req);
2974796d2068SKlaus Jensen     uint16_t nr = copy->nr + 1;
2975796d2068SKlaus Jensen     uint8_t format = copy->control[0] & 0xf;
2976796d2068SKlaus Jensen     uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
2977796d2068SKlaus Jensen     uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
297844219b60SNaveen Nagar     size_t len = sizeof(NvmeCopySourceRangeFormat0);
2979796d2068SKlaus Jensen 
2980796d2068SKlaus Jensen     uint16_t status;
2981796d2068SKlaus Jensen 
2982796d2068SKlaus Jensen     trace_pci_nvme_copy(nvme_cid(req), nvme_nsid(ns), nr, format);
2983796d2068SKlaus Jensen 
2984796d2068SKlaus Jensen     iocb->ranges = NULL;
2985796d2068SKlaus Jensen     iocb->zone = NULL;
2986796d2068SKlaus Jensen 
2987796d2068SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps) &&
2988796d2068SKlaus Jensen         ((prinfor & NVME_PRINFO_PRACT) != (prinfow & NVME_PRINFO_PRACT))) {
2989796d2068SKlaus Jensen         status = NVME_INVALID_FIELD | NVME_DNR;
2990796d2068SKlaus Jensen         goto invalid;
2991796d2068SKlaus Jensen     }
2992796d2068SKlaus Jensen 
2993796d2068SKlaus Jensen     if (!(n->id_ctrl.ocfs & (1 << format))) {
2994796d2068SKlaus Jensen         trace_pci_nvme_err_copy_invalid_format(format);
2995796d2068SKlaus Jensen         status = NVME_INVALID_FIELD | NVME_DNR;
2996796d2068SKlaus Jensen         goto invalid;
2997796d2068SKlaus Jensen     }
2998796d2068SKlaus Jensen 
2999796d2068SKlaus Jensen     if (nr > ns->id_ns.msrc + 1) {
300088eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
3001796d2068SKlaus Jensen         goto invalid;
300288eea45cSKlaus Jensen     }
300388eea45cSKlaus Jensen 
3004632cb6cfSFrancis Pravin Antony Michael Raj     if ((ns->pif == 0x0 && format != 0x0) ||
3005632cb6cfSFrancis Pravin Antony Michael Raj         (ns->pif != 0x0 && format != 0x1)) {
300644219b60SNaveen Nagar         status = NVME_INVALID_FORMAT | NVME_DNR;
300744219b60SNaveen Nagar         goto invalid;
300844219b60SNaveen Nagar     }
3009796d2068SKlaus Jensen 
301044219b60SNaveen Nagar     if (ns->pif) {
301144219b60SNaveen Nagar         len = sizeof(NvmeCopySourceRangeFormat1);
301244219b60SNaveen Nagar     }
301344219b60SNaveen Nagar 
301444219b60SNaveen Nagar     iocb->format = format;
301544219b60SNaveen Nagar     iocb->ranges = g_malloc_n(nr, len);
301644219b60SNaveen Nagar     status = nvme_h2c(n, (uint8_t *)iocb->ranges, len * nr, req);
3017796d2068SKlaus Jensen     if (status) {
3018796d2068SKlaus Jensen         goto invalid;
301988eea45cSKlaus Jensen     }
302088eea45cSKlaus Jensen 
3021796d2068SKlaus Jensen     iocb->slba = le64_to_cpu(copy->sdlba);
3022796d2068SKlaus Jensen 
3023796d2068SKlaus Jensen     if (ns->params.zoned) {
3024796d2068SKlaus Jensen         iocb->zone = nvme_get_zone_by_slba(ns, iocb->slba);
3025796d2068SKlaus Jensen         if (!iocb->zone) {
3026796d2068SKlaus Jensen             status = NVME_LBA_RANGE | NVME_DNR;
3027796d2068SKlaus Jensen             goto invalid;
3028796d2068SKlaus Jensen         }
3029796d2068SKlaus Jensen 
3030796d2068SKlaus Jensen         status = nvme_zrm_auto(n, ns, iocb->zone);
3031796d2068SKlaus Jensen         if (status) {
3032796d2068SKlaus Jensen             goto invalid;
3033796d2068SKlaus Jensen         }
3034796d2068SKlaus Jensen     }
3035796d2068SKlaus Jensen 
3036796d2068SKlaus Jensen     iocb->req = req;
3037796d2068SKlaus Jensen     iocb->ret = 0;
3038796d2068SKlaus Jensen     iocb->nr = nr;
3039796d2068SKlaus Jensen     iocb->idx = 0;
3040796d2068SKlaus Jensen     iocb->reftag = le32_to_cpu(copy->reftag);
304144219b60SNaveen Nagar     iocb->reftag |= (uint64_t)le32_to_cpu(copy->cdw3) << 32;
3042796d2068SKlaus Jensen     iocb->bounce = g_malloc_n(le16_to_cpu(ns->id_ns.mssrl),
3043796d2068SKlaus Jensen                               ns->lbasz + ns->lbaf.ms);
3044796d2068SKlaus Jensen 
3045796d2068SKlaus Jensen     qemu_iovec_init(&iocb->iov, 1);
3046796d2068SKlaus Jensen 
3047796d2068SKlaus Jensen     block_acct_start(blk_get_stats(ns->blkconf.blk), &iocb->acct.read, 0,
304888eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
3049796d2068SKlaus Jensen     block_acct_start(blk_get_stats(ns->blkconf.blk), &iocb->acct.write, 0,
3050796d2068SKlaus Jensen                      BLOCK_ACCT_WRITE);
305188eea45cSKlaus Jensen 
3052796d2068SKlaus Jensen     req->aiocb = &iocb->common;
305383f56ac3SKlaus Jensen     nvme_do_copy(iocb);
305488eea45cSKlaus Jensen 
305588eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
305688eea45cSKlaus Jensen 
3057796d2068SKlaus Jensen invalid:
3058796d2068SKlaus Jensen     g_free(iocb->ranges);
3059796d2068SKlaus Jensen     qemu_aio_unref(iocb);
306088eea45cSKlaus Jensen     return status;
306188eea45cSKlaus Jensen }
306288eea45cSKlaus Jensen 
306388eea45cSKlaus Jensen static uint16_t nvme_compare(NvmeCtrl *n, NvmeRequest *req)
306488eea45cSKlaus Jensen {
306588eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
306688eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
306788eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
306888eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
306988eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
30702a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
307188eea45cSKlaus Jensen     size_t data_len = nvme_l2b(ns, nlb);
307288eea45cSKlaus Jensen     size_t len = data_len;
307388eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
307488eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = NULL;
307588eea45cSKlaus Jensen     uint16_t status;
307688eea45cSKlaus Jensen 
307788eea45cSKlaus Jensen     trace_pci_nvme_compare(nvme_cid(req), nvme_nsid(ns), slba, nlb);
307888eea45cSKlaus Jensen 
30792a132309SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps) && (prinfo & NVME_PRINFO_PRACT)) {
308088eea45cSKlaus Jensen         return NVME_INVALID_PROT_INFO | NVME_DNR;
308188eea45cSKlaus Jensen     }
308288eea45cSKlaus Jensen 
308388eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
308488eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
308588eea45cSKlaus Jensen     }
308688eea45cSKlaus Jensen 
308788eea45cSKlaus Jensen     status = nvme_check_mdts(n, len);
308888eea45cSKlaus Jensen     if (status) {
308988eea45cSKlaus Jensen         return status;
309088eea45cSKlaus Jensen     }
309188eea45cSKlaus Jensen 
309288eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
309388eea45cSKlaus Jensen     if (status) {
309488eea45cSKlaus Jensen         return status;
309588eea45cSKlaus Jensen     }
309688eea45cSKlaus Jensen 
309788eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
309888eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
309988eea45cSKlaus Jensen         if (status) {
310088eea45cSKlaus Jensen             return status;
310188eea45cSKlaus Jensen         }
310288eea45cSKlaus Jensen     }
310388eea45cSKlaus Jensen 
310488eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
310588eea45cSKlaus Jensen     if (status) {
310688eea45cSKlaus Jensen         return status;
310788eea45cSKlaus Jensen     }
310888eea45cSKlaus Jensen 
310988eea45cSKlaus Jensen     ctx = g_new(struct nvme_compare_ctx, 1);
311088eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(data_len);
311188eea45cSKlaus Jensen 
311288eea45cSKlaus Jensen     req->opaque = ctx;
311388eea45cSKlaus Jensen 
311488eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
311588eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, data_len);
311688eea45cSKlaus Jensen 
311788eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_len,
311888eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
311988eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->data.iov, 0,
312088eea45cSKlaus Jensen                                 nvme_compare_data_cb, req);
312188eea45cSKlaus Jensen 
312288eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
312388eea45cSKlaus Jensen }
312488eea45cSKlaus Jensen 
312538f4ac65SKlaus Jensen typedef struct NvmeFlushAIOCB {
312638f4ac65SKlaus Jensen     BlockAIOCB common;
312738f4ac65SKlaus Jensen     BlockAIOCB *aiocb;
312838f4ac65SKlaus Jensen     NvmeRequest *req;
312938f4ac65SKlaus Jensen     int ret;
313038f4ac65SKlaus Jensen 
313138f4ac65SKlaus Jensen     NvmeNamespace *ns;
313238f4ac65SKlaus Jensen     uint32_t nsid;
313338f4ac65SKlaus Jensen     bool broadcast;
313438f4ac65SKlaus Jensen } NvmeFlushAIOCB;
313538f4ac65SKlaus Jensen 
313638f4ac65SKlaus Jensen static void nvme_flush_cancel(BlockAIOCB *acb)
313738f4ac65SKlaus Jensen {
313838f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = container_of(acb, NvmeFlushAIOCB, common);
313938f4ac65SKlaus Jensen 
314038f4ac65SKlaus Jensen     iocb->ret = -ECANCELED;
314138f4ac65SKlaus Jensen 
314238f4ac65SKlaus Jensen     if (iocb->aiocb) {
314338f4ac65SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
31443dbc1708SKlaus Jensen         iocb->aiocb = NULL;
314538f4ac65SKlaus Jensen     }
314638f4ac65SKlaus Jensen }
314738f4ac65SKlaus Jensen 
314838f4ac65SKlaus Jensen static const AIOCBInfo nvme_flush_aiocb_info = {
314938f4ac65SKlaus Jensen     .aiocb_size = sizeof(NvmeFlushAIOCB),
315038f4ac65SKlaus Jensen     .cancel_async = nvme_flush_cancel,
315138f4ac65SKlaus Jensen     .get_aio_context = nvme_get_aio_context,
315238f4ac65SKlaus Jensen };
315338f4ac65SKlaus Jensen 
31543dbc1708SKlaus Jensen static void nvme_do_flush(NvmeFlushAIOCB *iocb);
31553dbc1708SKlaus Jensen 
315638f4ac65SKlaus Jensen static void nvme_flush_ns_cb(void *opaque, int ret)
315738f4ac65SKlaus Jensen {
315838f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = opaque;
315938f4ac65SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
316038f4ac65SKlaus Jensen 
316138f4ac65SKlaus Jensen     if (ret < 0) {
316238f4ac65SKlaus Jensen         iocb->ret = ret;
316338f4ac65SKlaus Jensen         goto out;
316438f4ac65SKlaus Jensen     } else if (iocb->ret < 0) {
316538f4ac65SKlaus Jensen         goto out;
316638f4ac65SKlaus Jensen     }
316738f4ac65SKlaus Jensen 
316838f4ac65SKlaus Jensen     if (ns) {
316938f4ac65SKlaus Jensen         trace_pci_nvme_flush_ns(iocb->nsid);
317038f4ac65SKlaus Jensen 
317138f4ac65SKlaus Jensen         iocb->ns = NULL;
317238f4ac65SKlaus Jensen         iocb->aiocb = blk_aio_flush(ns->blkconf.blk, nvme_flush_ns_cb, iocb);
317338f4ac65SKlaus Jensen         return;
317438f4ac65SKlaus Jensen     }
317538f4ac65SKlaus Jensen 
317638f4ac65SKlaus Jensen out:
31773dbc1708SKlaus Jensen     nvme_do_flush(iocb);
317838f4ac65SKlaus Jensen }
317938f4ac65SKlaus Jensen 
31803dbc1708SKlaus Jensen static void nvme_do_flush(NvmeFlushAIOCB *iocb)
318138f4ac65SKlaus Jensen {
318238f4ac65SKlaus Jensen     NvmeRequest *req = iocb->req;
318338f4ac65SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
318438f4ac65SKlaus Jensen     int i;
318538f4ac65SKlaus Jensen 
318638f4ac65SKlaus Jensen     if (iocb->ret < 0) {
318738f4ac65SKlaus Jensen         goto done;
318838f4ac65SKlaus Jensen     }
318938f4ac65SKlaus Jensen 
319038f4ac65SKlaus Jensen     if (iocb->broadcast) {
319138f4ac65SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
319238f4ac65SKlaus Jensen             iocb->ns = nvme_ns(n, i);
319338f4ac65SKlaus Jensen             if (iocb->ns) {
319438f4ac65SKlaus Jensen                 iocb->nsid = i;
319538f4ac65SKlaus Jensen                 break;
319638f4ac65SKlaus Jensen             }
319738f4ac65SKlaus Jensen         }
319838f4ac65SKlaus Jensen     }
319938f4ac65SKlaus Jensen 
320038f4ac65SKlaus Jensen     if (!iocb->ns) {
320138f4ac65SKlaus Jensen         goto done;
320238f4ac65SKlaus Jensen     }
320338f4ac65SKlaus Jensen 
320438f4ac65SKlaus Jensen     nvme_flush_ns_cb(iocb, 0);
320538f4ac65SKlaus Jensen     return;
320638f4ac65SKlaus Jensen 
320738f4ac65SKlaus Jensen done:
320838f4ac65SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
320938f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
321038f4ac65SKlaus Jensen }
321138f4ac65SKlaus Jensen 
321288eea45cSKlaus Jensen static uint16_t nvme_flush(NvmeCtrl *n, NvmeRequest *req)
321388eea45cSKlaus Jensen {
321438f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb;
321588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
321688eea45cSKlaus Jensen     uint16_t status;
321788eea45cSKlaus Jensen 
321838f4ac65SKlaus Jensen     iocb = qemu_aio_get(&nvme_flush_aiocb_info, NULL, nvme_misc_cb, req);
321988eea45cSKlaus Jensen 
322038f4ac65SKlaus Jensen     iocb->req = req;
322138f4ac65SKlaus Jensen     iocb->ret = 0;
322238f4ac65SKlaus Jensen     iocb->ns = NULL;
322338f4ac65SKlaus Jensen     iocb->nsid = 0;
322438f4ac65SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
322538f4ac65SKlaus Jensen 
322638f4ac65SKlaus Jensen     if (!iocb->broadcast) {
322738f4ac65SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
322838f4ac65SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
322938f4ac65SKlaus Jensen             goto out;
323088eea45cSKlaus Jensen         }
323188eea45cSKlaus Jensen 
323238f4ac65SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
323338f4ac65SKlaus Jensen         if (!iocb->ns) {
323438f4ac65SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
323538f4ac65SKlaus Jensen             goto out;
323638f4ac65SKlaus Jensen         }
323738f4ac65SKlaus Jensen 
323838f4ac65SKlaus Jensen         iocb->nsid = nsid;
323938f4ac65SKlaus Jensen     }
324038f4ac65SKlaus Jensen 
324138f4ac65SKlaus Jensen     req->aiocb = &iocb->common;
32423dbc1708SKlaus Jensen     nvme_do_flush(iocb);
324338f4ac65SKlaus Jensen 
324488eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
324588eea45cSKlaus Jensen 
324638f4ac65SKlaus Jensen out:
324738f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
324888eea45cSKlaus Jensen 
324988eea45cSKlaus Jensen     return status;
325088eea45cSKlaus Jensen }
325188eea45cSKlaus Jensen 
325288eea45cSKlaus Jensen static uint16_t nvme_read(NvmeCtrl *n, NvmeRequest *req)
325388eea45cSKlaus Jensen {
325488eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
325588eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
325688eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
325788eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
32582a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
325988eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
326088eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
326188eea45cSKlaus Jensen     uint64_t data_offset;
326288eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
326388eea45cSKlaus Jensen     uint16_t status;
326488eea45cSKlaus Jensen 
326588eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
326688eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
326788eea45cSKlaus Jensen 
326888eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
32692a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
327088eea45cSKlaus Jensen 
3271ac0b34c5SKlaus Jensen             if (pract && ns->lbaf.ms == nvme_pi_tuple_size(ns)) {
327288eea45cSKlaus Jensen                 mapped_size = data_size;
327388eea45cSKlaus Jensen             }
327488eea45cSKlaus Jensen         }
327588eea45cSKlaus Jensen     }
327688eea45cSKlaus Jensen 
327788eea45cSKlaus Jensen     trace_pci_nvme_read(nvme_cid(req), nvme_nsid(ns), nlb, mapped_size, slba);
327888eea45cSKlaus Jensen 
327988eea45cSKlaus Jensen     status = nvme_check_mdts(n, mapped_size);
328088eea45cSKlaus Jensen     if (status) {
328188eea45cSKlaus Jensen         goto invalid;
328288eea45cSKlaus Jensen     }
328388eea45cSKlaus Jensen 
328488eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
328588eea45cSKlaus Jensen     if (status) {
328688eea45cSKlaus Jensen         goto invalid;
328788eea45cSKlaus Jensen     }
328888eea45cSKlaus Jensen 
328988eea45cSKlaus Jensen     if (ns->params.zoned) {
329088eea45cSKlaus Jensen         status = nvme_check_zone_read(ns, slba, nlb);
329188eea45cSKlaus Jensen         if (status) {
329288eea45cSKlaus Jensen             trace_pci_nvme_err_zone_read_not_ok(slba, nlb, status);
329388eea45cSKlaus Jensen             goto invalid;
329488eea45cSKlaus Jensen         }
329588eea45cSKlaus Jensen     }
329688eea45cSKlaus Jensen 
329788eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
329888eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
329988eea45cSKlaus Jensen         if (status) {
330088eea45cSKlaus Jensen             goto invalid;
330188eea45cSKlaus Jensen         }
330288eea45cSKlaus Jensen     }
330388eea45cSKlaus Jensen 
330488eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
330588eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
330688eea45cSKlaus Jensen     }
330788eea45cSKlaus Jensen 
330888eea45cSKlaus Jensen     status = nvme_map_data(n, nlb, req);
330988eea45cSKlaus Jensen     if (status) {
331088eea45cSKlaus Jensen         goto invalid;
331188eea45cSKlaus Jensen     }
331288eea45cSKlaus Jensen 
331388eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
331488eea45cSKlaus Jensen 
331588eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_size,
331688eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
331788eea45cSKlaus Jensen     nvme_blk_read(blk, data_offset, nvme_rw_cb, req);
331888eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
331988eea45cSKlaus Jensen 
332088eea45cSKlaus Jensen invalid:
332188eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_READ);
332288eea45cSKlaus Jensen     return status | NVME_DNR;
332388eea45cSKlaus Jensen }
332488eea45cSKlaus Jensen 
332588eea45cSKlaus Jensen static uint16_t nvme_do_write(NvmeCtrl *n, NvmeRequest *req, bool append,
332688eea45cSKlaus Jensen                               bool wrz)
332788eea45cSKlaus Jensen {
332888eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
332988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
333088eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
333188eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
333288eea45cSKlaus Jensen     uint16_t ctrl = le16_to_cpu(rw->control);
33332a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(ctrl);
333488eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
333588eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
333688eea45cSKlaus Jensen     uint64_t data_offset;
333788eea45cSKlaus Jensen     NvmeZone *zone;
333888eea45cSKlaus Jensen     NvmeZonedResult *res = (NvmeZonedResult *)&req->cqe;
333988eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
334088eea45cSKlaus Jensen     uint16_t status;
334188eea45cSKlaus Jensen 
334288eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
334388eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
334488eea45cSKlaus Jensen 
334588eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
33462a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
334788eea45cSKlaus Jensen 
3348ac0b34c5SKlaus Jensen             if (pract && ns->lbaf.ms == nvme_pi_tuple_size(ns)) {
334988eea45cSKlaus Jensen                 mapped_size -= nvme_m2b(ns, nlb);
335088eea45cSKlaus Jensen             }
335188eea45cSKlaus Jensen         }
335288eea45cSKlaus Jensen     }
335388eea45cSKlaus Jensen 
335488eea45cSKlaus Jensen     trace_pci_nvme_write(nvme_cid(req), nvme_io_opc_str(rw->opcode),
335588eea45cSKlaus Jensen                          nvme_nsid(ns), nlb, mapped_size, slba);
335688eea45cSKlaus Jensen 
335788eea45cSKlaus Jensen     if (!wrz) {
335888eea45cSKlaus Jensen         status = nvme_check_mdts(n, mapped_size);
335988eea45cSKlaus Jensen         if (status) {
336088eea45cSKlaus Jensen             goto invalid;
336188eea45cSKlaus Jensen         }
336288eea45cSKlaus Jensen     }
336388eea45cSKlaus Jensen 
336488eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
336588eea45cSKlaus Jensen     if (status) {
336688eea45cSKlaus Jensen         goto invalid;
336788eea45cSKlaus Jensen     }
336888eea45cSKlaus Jensen 
336988eea45cSKlaus Jensen     if (ns->params.zoned) {
337088eea45cSKlaus Jensen         zone = nvme_get_zone_by_slba(ns, slba);
3371189a8bf7SKlaus Jensen         assert(zone);
337288eea45cSKlaus Jensen 
337388eea45cSKlaus Jensen         if (append) {
337488eea45cSKlaus Jensen             bool piremap = !!(ctrl & NVME_RW_PIREMAP);
337588eea45cSKlaus Jensen 
3376e321b4cdSKlaus Jensen             if (unlikely(zone->d.za & NVME_ZA_ZRWA_VALID)) {
3377e321b4cdSKlaus Jensen                 return NVME_INVALID_ZONE_OP | NVME_DNR;
3378e321b4cdSKlaus Jensen             }
3379e321b4cdSKlaus Jensen 
338088eea45cSKlaus Jensen             if (unlikely(slba != zone->d.zslba)) {
338188eea45cSKlaus Jensen                 trace_pci_nvme_err_append_not_at_start(slba, zone->d.zslba);
338288eea45cSKlaus Jensen                 status = NVME_INVALID_FIELD;
338388eea45cSKlaus Jensen                 goto invalid;
338488eea45cSKlaus Jensen             }
338588eea45cSKlaus Jensen 
338688eea45cSKlaus Jensen             if (n->params.zasl &&
338788eea45cSKlaus Jensen                 data_size > (uint64_t)n->page_size << n->params.zasl) {
338888eea45cSKlaus Jensen                 trace_pci_nvme_err_zasl(data_size);
338988eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
339088eea45cSKlaus Jensen             }
339188eea45cSKlaus Jensen 
339288eea45cSKlaus Jensen             slba = zone->w_ptr;
339388eea45cSKlaus Jensen             rw->slba = cpu_to_le64(slba);
339488eea45cSKlaus Jensen             res->slba = cpu_to_le64(slba);
339588eea45cSKlaus Jensen 
339688eea45cSKlaus Jensen             switch (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
339788eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_1:
339888eea45cSKlaus Jensen                 if (!piremap) {
339988eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
340088eea45cSKlaus Jensen                 }
340188eea45cSKlaus Jensen 
340288eea45cSKlaus Jensen                 /* fallthrough */
340388eea45cSKlaus Jensen 
340488eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_2:
340588eea45cSKlaus Jensen                 if (piremap) {
340688eea45cSKlaus Jensen                     uint32_t reftag = le32_to_cpu(rw->reftag);
340788eea45cSKlaus Jensen                     rw->reftag = cpu_to_le32(reftag + (slba - zone->d.zslba));
340888eea45cSKlaus Jensen                 }
340988eea45cSKlaus Jensen 
341088eea45cSKlaus Jensen                 break;
341188eea45cSKlaus Jensen 
341288eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_3:
341388eea45cSKlaus Jensen                 if (piremap) {
341488eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
341588eea45cSKlaus Jensen                 }
341688eea45cSKlaus Jensen 
341788eea45cSKlaus Jensen                 break;
341888eea45cSKlaus Jensen             }
341988eea45cSKlaus Jensen         }
342088eea45cSKlaus Jensen 
342188eea45cSKlaus Jensen         status = nvme_check_zone_write(ns, zone, slba, nlb);
342288eea45cSKlaus Jensen         if (status) {
342388eea45cSKlaus Jensen             goto invalid;
342488eea45cSKlaus Jensen         }
342588eea45cSKlaus Jensen 
3426cccc2651SNiklas Cassel         status = nvme_zrm_auto(n, ns, zone);
342788eea45cSKlaus Jensen         if (status) {
342888eea45cSKlaus Jensen             goto invalid;
342988eea45cSKlaus Jensen         }
343088eea45cSKlaus Jensen 
3431e321b4cdSKlaus Jensen         if (!(zone->d.za & NVME_ZA_ZRWA_VALID)) {
343288eea45cSKlaus Jensen             zone->w_ptr += nlb;
343388eea45cSKlaus Jensen         }
3434e321b4cdSKlaus Jensen     }
343588eea45cSKlaus Jensen 
343688eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
343788eea45cSKlaus Jensen 
343888eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
343988eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
344088eea45cSKlaus Jensen     }
344188eea45cSKlaus Jensen 
344288eea45cSKlaus Jensen     if (!wrz) {
344388eea45cSKlaus Jensen         status = nvme_map_data(n, nlb, req);
344488eea45cSKlaus Jensen         if (status) {
344588eea45cSKlaus Jensen             goto invalid;
344688eea45cSKlaus Jensen         }
344788eea45cSKlaus Jensen 
344888eea45cSKlaus Jensen         block_acct_start(blk_get_stats(blk), &req->acct, data_size,
344988eea45cSKlaus Jensen                          BLOCK_ACCT_WRITE);
345088eea45cSKlaus Jensen         nvme_blk_write(blk, data_offset, nvme_rw_cb, req);
345188eea45cSKlaus Jensen     } else {
345288eea45cSKlaus Jensen         req->aiocb = blk_aio_pwrite_zeroes(blk, data_offset, data_size,
345388eea45cSKlaus Jensen                                            BDRV_REQ_MAY_UNMAP, nvme_rw_cb,
345488eea45cSKlaus Jensen                                            req);
345588eea45cSKlaus Jensen     }
345688eea45cSKlaus Jensen 
345788eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
345888eea45cSKlaus Jensen 
345988eea45cSKlaus Jensen invalid:
346088eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_WRITE);
346188eea45cSKlaus Jensen     return status | NVME_DNR;
346288eea45cSKlaus Jensen }
346388eea45cSKlaus Jensen 
346488eea45cSKlaus Jensen static inline uint16_t nvme_write(NvmeCtrl *n, NvmeRequest *req)
346588eea45cSKlaus Jensen {
346688eea45cSKlaus Jensen     return nvme_do_write(n, req, false, false);
346788eea45cSKlaus Jensen }
346888eea45cSKlaus Jensen 
346988eea45cSKlaus Jensen static inline uint16_t nvme_write_zeroes(NvmeCtrl *n, NvmeRequest *req)
347088eea45cSKlaus Jensen {
347188eea45cSKlaus Jensen     return nvme_do_write(n, req, false, true);
347288eea45cSKlaus Jensen }
347388eea45cSKlaus Jensen 
347488eea45cSKlaus Jensen static inline uint16_t nvme_zone_append(NvmeCtrl *n, NvmeRequest *req)
347588eea45cSKlaus Jensen {
347688eea45cSKlaus Jensen     return nvme_do_write(n, req, true, false);
347788eea45cSKlaus Jensen }
347888eea45cSKlaus Jensen 
347988eea45cSKlaus Jensen static uint16_t nvme_get_mgmt_zone_slba_idx(NvmeNamespace *ns, NvmeCmd *c,
348088eea45cSKlaus Jensen                                             uint64_t *slba, uint32_t *zone_idx)
348188eea45cSKlaus Jensen {
348288eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(c->cdw10);
348388eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(c->cdw11);
348488eea45cSKlaus Jensen 
348588eea45cSKlaus Jensen     if (!ns->params.zoned) {
348688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(c->opcode);
348788eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
348888eea45cSKlaus Jensen     }
348988eea45cSKlaus Jensen 
349088eea45cSKlaus Jensen     *slba = ((uint64_t)dw11) << 32 | dw10;
349188eea45cSKlaus Jensen     if (unlikely(*slba >= ns->id_ns.nsze)) {
349288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(*slba, 0, ns->id_ns.nsze);
349388eea45cSKlaus Jensen         *slba = 0;
349488eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
349588eea45cSKlaus Jensen     }
349688eea45cSKlaus Jensen 
349788eea45cSKlaus Jensen     *zone_idx = nvme_zone_idx(ns, *slba);
349888eea45cSKlaus Jensen     assert(*zone_idx < ns->num_zones);
349988eea45cSKlaus Jensen 
350088eea45cSKlaus Jensen     return NVME_SUCCESS;
350188eea45cSKlaus Jensen }
350288eea45cSKlaus Jensen 
350388eea45cSKlaus Jensen typedef uint16_t (*op_handler_t)(NvmeNamespace *, NvmeZone *, NvmeZoneState,
350488eea45cSKlaus Jensen                                  NvmeRequest *);
350588eea45cSKlaus Jensen 
350688eea45cSKlaus Jensen enum NvmeZoneProcessingMask {
350788eea45cSKlaus Jensen     NVME_PROC_CURRENT_ZONE    = 0,
350888eea45cSKlaus Jensen     NVME_PROC_OPENED_ZONES    = 1 << 0,
350988eea45cSKlaus Jensen     NVME_PROC_CLOSED_ZONES    = 1 << 1,
351088eea45cSKlaus Jensen     NVME_PROC_READ_ONLY_ZONES = 1 << 2,
351188eea45cSKlaus Jensen     NVME_PROC_FULL_ZONES      = 1 << 3,
351288eea45cSKlaus Jensen };
351388eea45cSKlaus Jensen 
351488eea45cSKlaus Jensen static uint16_t nvme_open_zone(NvmeNamespace *ns, NvmeZone *zone,
351588eea45cSKlaus Jensen                                NvmeZoneState state, NvmeRequest *req)
351688eea45cSKlaus Jensen {
3517e321b4cdSKlaus Jensen     NvmeZoneSendCmd *cmd = (NvmeZoneSendCmd *)&req->cmd;
3518e321b4cdSKlaus Jensen     int flags = 0;
3519e321b4cdSKlaus Jensen 
3520e321b4cdSKlaus Jensen     if (cmd->zsflags & NVME_ZSFLAG_ZRWA_ALLOC) {
3521e321b4cdSKlaus Jensen         uint16_t ozcs = le16_to_cpu(ns->id_ns_zoned->ozcs);
3522e321b4cdSKlaus Jensen 
3523e321b4cdSKlaus Jensen         if (!(ozcs & NVME_ID_NS_ZONED_OZCS_ZRWASUP)) {
3524e321b4cdSKlaus Jensen             return NVME_INVALID_ZONE_OP | NVME_DNR;
3525e321b4cdSKlaus Jensen         }
3526e321b4cdSKlaus Jensen 
3527e321b4cdSKlaus Jensen         if (zone->w_ptr % ns->zns.zrwafg) {
3528e321b4cdSKlaus Jensen             return NVME_NOZRWA | NVME_DNR;
3529e321b4cdSKlaus Jensen         }
3530e321b4cdSKlaus Jensen 
3531e321b4cdSKlaus Jensen         flags = NVME_ZRM_ZRWA;
3532e321b4cdSKlaus Jensen     }
3533e321b4cdSKlaus Jensen 
3534e321b4cdSKlaus Jensen     return nvme_zrm_open_flags(nvme_ctrl(req), ns, zone, flags);
353588eea45cSKlaus Jensen }
353688eea45cSKlaus Jensen 
353788eea45cSKlaus Jensen static uint16_t nvme_close_zone(NvmeNamespace *ns, NvmeZone *zone,
353888eea45cSKlaus Jensen                                 NvmeZoneState state, NvmeRequest *req)
353988eea45cSKlaus Jensen {
354088eea45cSKlaus Jensen     return nvme_zrm_close(ns, zone);
354188eea45cSKlaus Jensen }
354288eea45cSKlaus Jensen 
354388eea45cSKlaus Jensen static uint16_t nvme_finish_zone(NvmeNamespace *ns, NvmeZone *zone,
354488eea45cSKlaus Jensen                                  NvmeZoneState state, NvmeRequest *req)
354588eea45cSKlaus Jensen {
354688eea45cSKlaus Jensen     return nvme_zrm_finish(ns, zone);
354788eea45cSKlaus Jensen }
354888eea45cSKlaus Jensen 
354988eea45cSKlaus Jensen static uint16_t nvme_offline_zone(NvmeNamespace *ns, NvmeZone *zone,
355088eea45cSKlaus Jensen                                   NvmeZoneState state, NvmeRequest *req)
355188eea45cSKlaus Jensen {
355288eea45cSKlaus Jensen     switch (state) {
355388eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
355488eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_OFFLINE);
355588eea45cSKlaus Jensen         /* fall through */
355688eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
355788eea45cSKlaus Jensen         return NVME_SUCCESS;
355888eea45cSKlaus Jensen     default:
355988eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
356088eea45cSKlaus Jensen     }
356188eea45cSKlaus Jensen }
356288eea45cSKlaus Jensen 
356388eea45cSKlaus Jensen static uint16_t nvme_set_zd_ext(NvmeNamespace *ns, NvmeZone *zone)
356488eea45cSKlaus Jensen {
356588eea45cSKlaus Jensen     uint16_t status;
356688eea45cSKlaus Jensen     uint8_t state = nvme_get_zone_state(zone);
356788eea45cSKlaus Jensen 
356888eea45cSKlaus Jensen     if (state == NVME_ZONE_STATE_EMPTY) {
356988eea45cSKlaus Jensen         status = nvme_aor_check(ns, 1, 0);
357088eea45cSKlaus Jensen         if (status) {
357188eea45cSKlaus Jensen             return status;
357288eea45cSKlaus Jensen         }
357388eea45cSKlaus Jensen         nvme_aor_inc_active(ns);
357488eea45cSKlaus Jensen         zone->d.za |= NVME_ZA_ZD_EXT_VALID;
357588eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
357688eea45cSKlaus Jensen         return NVME_SUCCESS;
357788eea45cSKlaus Jensen     }
357888eea45cSKlaus Jensen 
357988eea45cSKlaus Jensen     return NVME_ZONE_INVAL_TRANSITION;
358088eea45cSKlaus Jensen }
358188eea45cSKlaus Jensen 
358288eea45cSKlaus Jensen static uint16_t nvme_bulk_proc_zone(NvmeNamespace *ns, NvmeZone *zone,
358388eea45cSKlaus Jensen                                     enum NvmeZoneProcessingMask proc_mask,
358488eea45cSKlaus Jensen                                     op_handler_t op_hndlr, NvmeRequest *req)
358588eea45cSKlaus Jensen {
358688eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
358788eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zone);
358888eea45cSKlaus Jensen     bool proc_zone;
358988eea45cSKlaus Jensen 
359088eea45cSKlaus Jensen     switch (zs) {
359188eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
359288eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
359388eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_OPENED_ZONES;
359488eea45cSKlaus Jensen         break;
359588eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
359688eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_CLOSED_ZONES;
359788eea45cSKlaus Jensen         break;
359888eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
359988eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_READ_ONLY_ZONES;
360088eea45cSKlaus Jensen         break;
360188eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
360288eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_FULL_ZONES;
360388eea45cSKlaus Jensen         break;
360488eea45cSKlaus Jensen     default:
360588eea45cSKlaus Jensen         proc_zone = false;
360688eea45cSKlaus Jensen     }
360788eea45cSKlaus Jensen 
360888eea45cSKlaus Jensen     if (proc_zone) {
360988eea45cSKlaus Jensen         status = op_hndlr(ns, zone, zs, req);
361088eea45cSKlaus Jensen     }
361188eea45cSKlaus Jensen 
361288eea45cSKlaus Jensen     return status;
361388eea45cSKlaus Jensen }
361488eea45cSKlaus Jensen 
361588eea45cSKlaus Jensen static uint16_t nvme_do_zone_op(NvmeNamespace *ns, NvmeZone *zone,
361688eea45cSKlaus Jensen                                 enum NvmeZoneProcessingMask proc_mask,
361788eea45cSKlaus Jensen                                 op_handler_t op_hndlr, NvmeRequest *req)
361888eea45cSKlaus Jensen {
361988eea45cSKlaus Jensen     NvmeZone *next;
362088eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
362188eea45cSKlaus Jensen     int i;
362288eea45cSKlaus Jensen 
362388eea45cSKlaus Jensen     if (!proc_mask) {
362488eea45cSKlaus Jensen         status = op_hndlr(ns, zone, nvme_get_zone_state(zone), req);
362588eea45cSKlaus Jensen     } else {
362688eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_CLOSED_ZONES) {
362788eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->closed_zones, entry, next) {
362888eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
362988eea45cSKlaus Jensen                                              req);
363088eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
363188eea45cSKlaus Jensen                     goto out;
363288eea45cSKlaus Jensen                 }
363388eea45cSKlaus Jensen             }
363488eea45cSKlaus Jensen         }
363588eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_OPENED_ZONES) {
363688eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->imp_open_zones, entry, next) {
363788eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
363888eea45cSKlaus Jensen                                              req);
363988eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
364088eea45cSKlaus Jensen                     goto out;
364188eea45cSKlaus Jensen                 }
364288eea45cSKlaus Jensen             }
364388eea45cSKlaus Jensen 
364488eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->exp_open_zones, entry, next) {
364588eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
364688eea45cSKlaus Jensen                                              req);
364788eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
364888eea45cSKlaus Jensen                     goto out;
364988eea45cSKlaus Jensen                 }
365088eea45cSKlaus Jensen             }
365188eea45cSKlaus Jensen         }
365288eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_FULL_ZONES) {
365388eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->full_zones, entry, next) {
365488eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
365588eea45cSKlaus Jensen                                              req);
365688eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
365788eea45cSKlaus Jensen                     goto out;
365888eea45cSKlaus Jensen                 }
365988eea45cSKlaus Jensen             }
366088eea45cSKlaus Jensen         }
366188eea45cSKlaus Jensen 
366288eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_READ_ONLY_ZONES) {
366388eea45cSKlaus Jensen             for (i = 0; i < ns->num_zones; i++, zone++) {
366488eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
366588eea45cSKlaus Jensen                                              req);
366688eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
366788eea45cSKlaus Jensen                     goto out;
366888eea45cSKlaus Jensen                 }
366988eea45cSKlaus Jensen             }
367088eea45cSKlaus Jensen         }
367188eea45cSKlaus Jensen     }
367288eea45cSKlaus Jensen 
367388eea45cSKlaus Jensen out:
367488eea45cSKlaus Jensen     return status;
367588eea45cSKlaus Jensen }
367688eea45cSKlaus Jensen 
367763d96e4fSKlaus Jensen typedef struct NvmeZoneResetAIOCB {
367863d96e4fSKlaus Jensen     BlockAIOCB common;
367963d96e4fSKlaus Jensen     BlockAIOCB *aiocb;
368063d96e4fSKlaus Jensen     NvmeRequest *req;
368163d96e4fSKlaus Jensen     int ret;
368263d96e4fSKlaus Jensen 
368363d96e4fSKlaus Jensen     bool all;
368463d96e4fSKlaus Jensen     int idx;
368563d96e4fSKlaus Jensen     NvmeZone *zone;
368663d96e4fSKlaus Jensen } NvmeZoneResetAIOCB;
368763d96e4fSKlaus Jensen 
368863d96e4fSKlaus Jensen static void nvme_zone_reset_cancel(BlockAIOCB *aiocb)
368963d96e4fSKlaus Jensen {
369063d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = container_of(aiocb, NvmeZoneResetAIOCB, common);
369163d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
369263d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
369363d96e4fSKlaus Jensen 
369463d96e4fSKlaus Jensen     iocb->idx = ns->num_zones;
369563d96e4fSKlaus Jensen 
369663d96e4fSKlaus Jensen     iocb->ret = -ECANCELED;
369763d96e4fSKlaus Jensen 
369863d96e4fSKlaus Jensen     if (iocb->aiocb) {
369963d96e4fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
370063d96e4fSKlaus Jensen         iocb->aiocb = NULL;
370163d96e4fSKlaus Jensen     }
370263d96e4fSKlaus Jensen }
370363d96e4fSKlaus Jensen 
370463d96e4fSKlaus Jensen static const AIOCBInfo nvme_zone_reset_aiocb_info = {
370563d96e4fSKlaus Jensen     .aiocb_size = sizeof(NvmeZoneResetAIOCB),
370663d96e4fSKlaus Jensen     .cancel_async = nvme_zone_reset_cancel,
370763d96e4fSKlaus Jensen };
370863d96e4fSKlaus Jensen 
370963d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret);
371063d96e4fSKlaus Jensen 
371163d96e4fSKlaus Jensen static void nvme_zone_reset_epilogue_cb(void *opaque, int ret)
371263d96e4fSKlaus Jensen {
371363d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
371463d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
371563d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
371663d96e4fSKlaus Jensen     int64_t moff;
371763d96e4fSKlaus Jensen     int count;
371863d96e4fSKlaus Jensen 
371936a251c3SKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
372036a251c3SKlaus Jensen         goto out;
372163d96e4fSKlaus Jensen     }
372263d96e4fSKlaus Jensen 
372363d96e4fSKlaus Jensen     moff = nvme_moff(ns, iocb->zone->d.zslba);
372463d96e4fSKlaus Jensen     count = nvme_m2b(ns, ns->zone_size);
372563d96e4fSKlaus Jensen 
372663d96e4fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, moff, count,
372763d96e4fSKlaus Jensen                                         BDRV_REQ_MAY_UNMAP,
372863d96e4fSKlaus Jensen                                         nvme_zone_reset_cb, iocb);
372963d96e4fSKlaus Jensen     return;
373036a251c3SKlaus Jensen 
373136a251c3SKlaus Jensen out:
373236a251c3SKlaus Jensen     nvme_zone_reset_cb(iocb, ret);
373363d96e4fSKlaus Jensen }
373463d96e4fSKlaus Jensen 
373563d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret)
373663d96e4fSKlaus Jensen {
373763d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
373863d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
373963d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
374063d96e4fSKlaus Jensen 
374136a251c3SKlaus Jensen     if (iocb->ret < 0) {
374236a251c3SKlaus Jensen         goto done;
374336a251c3SKlaus Jensen     } else if (ret < 0) {
374463d96e4fSKlaus Jensen         iocb->ret = ret;
374563d96e4fSKlaus Jensen         goto done;
374663d96e4fSKlaus Jensen     }
374763d96e4fSKlaus Jensen 
374863d96e4fSKlaus Jensen     if (iocb->zone) {
374963d96e4fSKlaus Jensen         nvme_zrm_reset(ns, iocb->zone);
375063d96e4fSKlaus Jensen 
375163d96e4fSKlaus Jensen         if (!iocb->all) {
375263d96e4fSKlaus Jensen             goto done;
375363d96e4fSKlaus Jensen         }
375463d96e4fSKlaus Jensen     }
375563d96e4fSKlaus Jensen 
375663d96e4fSKlaus Jensen     while (iocb->idx < ns->num_zones) {
375763d96e4fSKlaus Jensen         NvmeZone *zone = &ns->zone_array[iocb->idx++];
375863d96e4fSKlaus Jensen 
375963d96e4fSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
376063d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EMPTY:
376163d96e4fSKlaus Jensen             if (!iocb->all) {
376263d96e4fSKlaus Jensen                 goto done;
376363d96e4fSKlaus Jensen             }
376463d96e4fSKlaus Jensen 
376563d96e4fSKlaus Jensen             continue;
376663d96e4fSKlaus Jensen 
376763d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
376863d96e4fSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
376963d96e4fSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
377063d96e4fSKlaus Jensen         case NVME_ZONE_STATE_FULL:
377163d96e4fSKlaus Jensen             iocb->zone = zone;
377263d96e4fSKlaus Jensen             break;
377363d96e4fSKlaus Jensen 
377463d96e4fSKlaus Jensen         default:
377563d96e4fSKlaus Jensen             continue;
377663d96e4fSKlaus Jensen         }
377763d96e4fSKlaus Jensen 
377863d96e4fSKlaus Jensen         trace_pci_nvme_zns_zone_reset(zone->d.zslba);
377963d96e4fSKlaus Jensen 
378063d96e4fSKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk,
378163d96e4fSKlaus Jensen                                             nvme_l2b(ns, zone->d.zslba),
378263d96e4fSKlaus Jensen                                             nvme_l2b(ns, ns->zone_size),
378363d96e4fSKlaus Jensen                                             BDRV_REQ_MAY_UNMAP,
378463d96e4fSKlaus Jensen                                             nvme_zone_reset_epilogue_cb,
378563d96e4fSKlaus Jensen                                             iocb);
378663d96e4fSKlaus Jensen         return;
378763d96e4fSKlaus Jensen     }
378863d96e4fSKlaus Jensen 
378963d96e4fSKlaus Jensen done:
379063d96e4fSKlaus Jensen     iocb->aiocb = NULL;
379136a251c3SKlaus Jensen 
379236a251c3SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
379336a251c3SKlaus Jensen     qemu_aio_unref(iocb);
379463d96e4fSKlaus Jensen }
379563d96e4fSKlaus Jensen 
3796e321b4cdSKlaus Jensen static uint16_t nvme_zone_mgmt_send_zrwa_flush(NvmeCtrl *n, NvmeZone *zone,
3797e321b4cdSKlaus Jensen                                                uint64_t elba, NvmeRequest *req)
3798e321b4cdSKlaus Jensen {
3799e321b4cdSKlaus Jensen     NvmeNamespace *ns = req->ns;
3800e321b4cdSKlaus Jensen     uint16_t ozcs = le16_to_cpu(ns->id_ns_zoned->ozcs);
3801e321b4cdSKlaus Jensen     uint64_t wp = zone->d.wp;
3802e321b4cdSKlaus Jensen     uint32_t nlb = elba - wp + 1;
3803e321b4cdSKlaus Jensen     uint16_t status;
3804e321b4cdSKlaus Jensen 
3805e321b4cdSKlaus Jensen 
3806e321b4cdSKlaus Jensen     if (!(ozcs & NVME_ID_NS_ZONED_OZCS_ZRWASUP)) {
3807e321b4cdSKlaus Jensen         return NVME_INVALID_ZONE_OP | NVME_DNR;
3808e321b4cdSKlaus Jensen     }
3809e321b4cdSKlaus Jensen 
3810e321b4cdSKlaus Jensen     if (!(zone->d.za & NVME_ZA_ZRWA_VALID)) {
3811e321b4cdSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
3812e321b4cdSKlaus Jensen     }
3813e321b4cdSKlaus Jensen 
3814e321b4cdSKlaus Jensen     if (elba < wp || elba > wp + ns->zns.zrwas) {
3815e321b4cdSKlaus Jensen         return NVME_ZONE_BOUNDARY_ERROR | NVME_DNR;
3816e321b4cdSKlaus Jensen     }
3817e321b4cdSKlaus Jensen 
3818e321b4cdSKlaus Jensen     if (nlb % ns->zns.zrwafg) {
3819e321b4cdSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
3820e321b4cdSKlaus Jensen     }
3821e321b4cdSKlaus Jensen 
3822e321b4cdSKlaus Jensen     status = nvme_zrm_auto(n, ns, zone);
3823e321b4cdSKlaus Jensen     if (status) {
3824e321b4cdSKlaus Jensen         return status;
3825e321b4cdSKlaus Jensen     }
3826e321b4cdSKlaus Jensen 
3827e321b4cdSKlaus Jensen     zone->w_ptr += nlb;
3828e321b4cdSKlaus Jensen 
3829e321b4cdSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlb);
3830e321b4cdSKlaus Jensen 
3831e321b4cdSKlaus Jensen     return NVME_SUCCESS;
3832e321b4cdSKlaus Jensen }
3833e321b4cdSKlaus Jensen 
383488eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_send(NvmeCtrl *n, NvmeRequest *req)
383588eea45cSKlaus Jensen {
38366190d92fSKlaus Jensen     NvmeZoneSendCmd *cmd = (NvmeZoneSendCmd *)&req->cmd;
383788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
383888eea45cSKlaus Jensen     NvmeZone *zone;
383963d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb;
384088eea45cSKlaus Jensen     uint8_t *zd_ext;
384188eea45cSKlaus Jensen     uint64_t slba = 0;
384288eea45cSKlaus Jensen     uint32_t zone_idx = 0;
384388eea45cSKlaus Jensen     uint16_t status;
38446190d92fSKlaus Jensen     uint8_t action = cmd->zsa;
384588eea45cSKlaus Jensen     bool all;
384688eea45cSKlaus Jensen     enum NvmeZoneProcessingMask proc_mask = NVME_PROC_CURRENT_ZONE;
384788eea45cSKlaus Jensen 
38486190d92fSKlaus Jensen     all = cmd->zsflags & NVME_ZSFLAG_SELECT_ALL;
384988eea45cSKlaus Jensen 
385088eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
385188eea45cSKlaus Jensen 
385288eea45cSKlaus Jensen     if (!all) {
38536190d92fSKlaus Jensen         status = nvme_get_mgmt_zone_slba_idx(ns, &req->cmd, &slba, &zone_idx);
385488eea45cSKlaus Jensen         if (status) {
385588eea45cSKlaus Jensen             return status;
385688eea45cSKlaus Jensen         }
385788eea45cSKlaus Jensen     }
385888eea45cSKlaus Jensen 
385988eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
3860e321b4cdSKlaus Jensen     if (slba != zone->d.zslba && action != NVME_ZONE_ACTION_ZRWA_FLUSH) {
386188eea45cSKlaus Jensen         trace_pci_nvme_err_unaligned_zone_cmd(action, slba, zone->d.zslba);
386288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
386388eea45cSKlaus Jensen     }
386488eea45cSKlaus Jensen 
386588eea45cSKlaus Jensen     switch (action) {
386688eea45cSKlaus Jensen 
386788eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OPEN:
386888eea45cSKlaus Jensen         if (all) {
386988eea45cSKlaus Jensen             proc_mask = NVME_PROC_CLOSED_ZONES;
387088eea45cSKlaus Jensen         }
387188eea45cSKlaus Jensen         trace_pci_nvme_open_zone(slba, zone_idx, all);
387288eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_open_zone, req);
387388eea45cSKlaus Jensen         break;
387488eea45cSKlaus Jensen 
387588eea45cSKlaus Jensen     case NVME_ZONE_ACTION_CLOSE:
387688eea45cSKlaus Jensen         if (all) {
387788eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES;
387888eea45cSKlaus Jensen         }
387988eea45cSKlaus Jensen         trace_pci_nvme_close_zone(slba, zone_idx, all);
388088eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_close_zone, req);
388188eea45cSKlaus Jensen         break;
388288eea45cSKlaus Jensen 
388388eea45cSKlaus Jensen     case NVME_ZONE_ACTION_FINISH:
388488eea45cSKlaus Jensen         if (all) {
388588eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES | NVME_PROC_CLOSED_ZONES;
388688eea45cSKlaus Jensen         }
388788eea45cSKlaus Jensen         trace_pci_nvme_finish_zone(slba, zone_idx, all);
388888eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_finish_zone, req);
388988eea45cSKlaus Jensen         break;
389088eea45cSKlaus Jensen 
389188eea45cSKlaus Jensen     case NVME_ZONE_ACTION_RESET:
389288eea45cSKlaus Jensen         trace_pci_nvme_reset_zone(slba, zone_idx, all);
389388eea45cSKlaus Jensen 
389463d96e4fSKlaus Jensen         iocb = blk_aio_get(&nvme_zone_reset_aiocb_info, ns->blkconf.blk,
389563d96e4fSKlaus Jensen                            nvme_misc_cb, req);
389688eea45cSKlaus Jensen 
389763d96e4fSKlaus Jensen         iocb->req = req;
389863d96e4fSKlaus Jensen         iocb->ret = 0;
389963d96e4fSKlaus Jensen         iocb->all = all;
390063d96e4fSKlaus Jensen         iocb->idx = zone_idx;
390163d96e4fSKlaus Jensen         iocb->zone = NULL;
390288eea45cSKlaus Jensen 
390363d96e4fSKlaus Jensen         req->aiocb = &iocb->common;
390463d96e4fSKlaus Jensen         nvme_zone_reset_cb(iocb, 0);
390588eea45cSKlaus Jensen 
390663d96e4fSKlaus Jensen         return NVME_NO_COMPLETE;
390788eea45cSKlaus Jensen 
390888eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OFFLINE:
390988eea45cSKlaus Jensen         if (all) {
391088eea45cSKlaus Jensen             proc_mask = NVME_PROC_READ_ONLY_ZONES;
391188eea45cSKlaus Jensen         }
391288eea45cSKlaus Jensen         trace_pci_nvme_offline_zone(slba, zone_idx, all);
391388eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_offline_zone, req);
391488eea45cSKlaus Jensen         break;
391588eea45cSKlaus Jensen 
391688eea45cSKlaus Jensen     case NVME_ZONE_ACTION_SET_ZD_EXT:
391788eea45cSKlaus Jensen         trace_pci_nvme_set_descriptor_extension(slba, zone_idx);
391888eea45cSKlaus Jensen         if (all || !ns->params.zd_extension_size) {
391988eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
392088eea45cSKlaus Jensen         }
392188eea45cSKlaus Jensen         zd_ext = nvme_get_zd_extension(ns, zone_idx);
392288eea45cSKlaus Jensen         status = nvme_h2c(n, zd_ext, ns->params.zd_extension_size, req);
392388eea45cSKlaus Jensen         if (status) {
392488eea45cSKlaus Jensen             trace_pci_nvme_err_zd_extension_map_error(zone_idx);
392588eea45cSKlaus Jensen             return status;
392688eea45cSKlaus Jensen         }
392788eea45cSKlaus Jensen 
392888eea45cSKlaus Jensen         status = nvme_set_zd_ext(ns, zone);
392988eea45cSKlaus Jensen         if (status == NVME_SUCCESS) {
393088eea45cSKlaus Jensen             trace_pci_nvme_zd_extension_set(zone_idx);
393188eea45cSKlaus Jensen             return status;
393288eea45cSKlaus Jensen         }
393388eea45cSKlaus Jensen         break;
393488eea45cSKlaus Jensen 
3935e321b4cdSKlaus Jensen     case NVME_ZONE_ACTION_ZRWA_FLUSH:
3936e321b4cdSKlaus Jensen         if (all) {
3937e321b4cdSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
3938e321b4cdSKlaus Jensen         }
3939e321b4cdSKlaus Jensen 
3940e321b4cdSKlaus Jensen         return nvme_zone_mgmt_send_zrwa_flush(n, zone, slba, req);
3941e321b4cdSKlaus Jensen 
394288eea45cSKlaus Jensen     default:
394388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_mgmt_action(action);
394488eea45cSKlaus Jensen         status = NVME_INVALID_FIELD;
394588eea45cSKlaus Jensen     }
394688eea45cSKlaus Jensen 
394788eea45cSKlaus Jensen     if (status == NVME_ZONE_INVAL_TRANSITION) {
394888eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_zone_state_transition(action, slba,
394988eea45cSKlaus Jensen                                                          zone->d.za);
395088eea45cSKlaus Jensen     }
395188eea45cSKlaus Jensen     if (status) {
395288eea45cSKlaus Jensen         status |= NVME_DNR;
395388eea45cSKlaus Jensen     }
395488eea45cSKlaus Jensen 
395588eea45cSKlaus Jensen     return status;
395688eea45cSKlaus Jensen }
395788eea45cSKlaus Jensen 
395888eea45cSKlaus Jensen static bool nvme_zone_matches_filter(uint32_t zafs, NvmeZone *zl)
395988eea45cSKlaus Jensen {
396088eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zl);
396188eea45cSKlaus Jensen 
396288eea45cSKlaus Jensen     switch (zafs) {
396388eea45cSKlaus Jensen     case NVME_ZONE_REPORT_ALL:
396488eea45cSKlaus Jensen         return true;
396588eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EMPTY:
396688eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EMPTY;
396788eea45cSKlaus Jensen     case NVME_ZONE_REPORT_IMPLICITLY_OPEN:
396888eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_IMPLICITLY_OPEN;
396988eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EXPLICITLY_OPEN:
397088eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EXPLICITLY_OPEN;
397188eea45cSKlaus Jensen     case NVME_ZONE_REPORT_CLOSED:
397288eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_CLOSED;
397388eea45cSKlaus Jensen     case NVME_ZONE_REPORT_FULL:
397488eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_FULL;
397588eea45cSKlaus Jensen     case NVME_ZONE_REPORT_READ_ONLY:
397688eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_READ_ONLY;
397788eea45cSKlaus Jensen     case NVME_ZONE_REPORT_OFFLINE:
397888eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_OFFLINE;
397988eea45cSKlaus Jensen     default:
398088eea45cSKlaus Jensen         return false;
398188eea45cSKlaus Jensen     }
398288eea45cSKlaus Jensen }
398388eea45cSKlaus Jensen 
398488eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_recv(NvmeCtrl *n, NvmeRequest *req)
398588eea45cSKlaus Jensen {
398688eea45cSKlaus Jensen     NvmeCmd *cmd = (NvmeCmd *)&req->cmd;
398788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
398888eea45cSKlaus Jensen     /* cdw12 is zero-based number of dwords to return. Convert to bytes */
398988eea45cSKlaus Jensen     uint32_t data_size = (le32_to_cpu(cmd->cdw12) + 1) << 2;
399088eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
399188eea45cSKlaus Jensen     uint32_t zone_idx, zra, zrasf, partial;
399288eea45cSKlaus Jensen     uint64_t max_zones, nr_zones = 0;
399388eea45cSKlaus Jensen     uint16_t status;
399488eea45cSKlaus Jensen     uint64_t slba;
399588eea45cSKlaus Jensen     NvmeZoneDescr *z;
399688eea45cSKlaus Jensen     NvmeZone *zone;
399788eea45cSKlaus Jensen     NvmeZoneReportHeader *header;
399888eea45cSKlaus Jensen     void *buf, *buf_p;
399988eea45cSKlaus Jensen     size_t zone_entry_sz;
400088eea45cSKlaus Jensen     int i;
400188eea45cSKlaus Jensen 
400288eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
400388eea45cSKlaus Jensen 
400488eea45cSKlaus Jensen     status = nvme_get_mgmt_zone_slba_idx(ns, cmd, &slba, &zone_idx);
400588eea45cSKlaus Jensen     if (status) {
400688eea45cSKlaus Jensen         return status;
400788eea45cSKlaus Jensen     }
400888eea45cSKlaus Jensen 
400988eea45cSKlaus Jensen     zra = dw13 & 0xff;
401088eea45cSKlaus Jensen     if (zra != NVME_ZONE_REPORT && zra != NVME_ZONE_REPORT_EXTENDED) {
401188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
401288eea45cSKlaus Jensen     }
401388eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED && !ns->params.zd_extension_size) {
401488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
401588eea45cSKlaus Jensen     }
401688eea45cSKlaus Jensen 
401788eea45cSKlaus Jensen     zrasf = (dw13 >> 8) & 0xff;
401888eea45cSKlaus Jensen     if (zrasf > NVME_ZONE_REPORT_OFFLINE) {
401988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
402088eea45cSKlaus Jensen     }
402188eea45cSKlaus Jensen 
402288eea45cSKlaus Jensen     if (data_size < sizeof(NvmeZoneReportHeader)) {
402388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
402488eea45cSKlaus Jensen     }
402588eea45cSKlaus Jensen 
402688eea45cSKlaus Jensen     status = nvme_check_mdts(n, data_size);
402788eea45cSKlaus Jensen     if (status) {
402888eea45cSKlaus Jensen         return status;
402988eea45cSKlaus Jensen     }
403088eea45cSKlaus Jensen 
403188eea45cSKlaus Jensen     partial = (dw13 >> 16) & 0x01;
403288eea45cSKlaus Jensen 
403388eea45cSKlaus Jensen     zone_entry_sz = sizeof(NvmeZoneDescr);
403488eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED) {
403588eea45cSKlaus Jensen         zone_entry_sz += ns->params.zd_extension_size;
403688eea45cSKlaus Jensen     }
403788eea45cSKlaus Jensen 
403888eea45cSKlaus Jensen     max_zones = (data_size - sizeof(NvmeZoneReportHeader)) / zone_entry_sz;
403988eea45cSKlaus Jensen     buf = g_malloc0(data_size);
404088eea45cSKlaus Jensen 
404188eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
404288eea45cSKlaus Jensen     for (i = zone_idx; i < ns->num_zones; i++) {
404388eea45cSKlaus Jensen         if (partial && nr_zones >= max_zones) {
404488eea45cSKlaus Jensen             break;
404588eea45cSKlaus Jensen         }
404688eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone++)) {
404788eea45cSKlaus Jensen             nr_zones++;
404888eea45cSKlaus Jensen         }
404988eea45cSKlaus Jensen     }
40503d558330SMarkus Armbruster     header = buf;
405188eea45cSKlaus Jensen     header->nr_zones = cpu_to_le64(nr_zones);
405288eea45cSKlaus Jensen 
405388eea45cSKlaus Jensen     buf_p = buf + sizeof(NvmeZoneReportHeader);
405488eea45cSKlaus Jensen     for (; zone_idx < ns->num_zones && max_zones > 0; zone_idx++) {
405588eea45cSKlaus Jensen         zone = &ns->zone_array[zone_idx];
405688eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone)) {
40573d558330SMarkus Armbruster             z = buf_p;
405888eea45cSKlaus Jensen             buf_p += sizeof(NvmeZoneDescr);
405988eea45cSKlaus Jensen 
406088eea45cSKlaus Jensen             z->zt = zone->d.zt;
406188eea45cSKlaus Jensen             z->zs = zone->d.zs;
406288eea45cSKlaus Jensen             z->zcap = cpu_to_le64(zone->d.zcap);
406388eea45cSKlaus Jensen             z->zslba = cpu_to_le64(zone->d.zslba);
406488eea45cSKlaus Jensen             z->za = zone->d.za;
406588eea45cSKlaus Jensen 
406688eea45cSKlaus Jensen             if (nvme_wp_is_valid(zone)) {
406788eea45cSKlaus Jensen                 z->wp = cpu_to_le64(zone->d.wp);
406888eea45cSKlaus Jensen             } else {
406988eea45cSKlaus Jensen                 z->wp = cpu_to_le64(~0ULL);
407088eea45cSKlaus Jensen             }
407188eea45cSKlaus Jensen 
407288eea45cSKlaus Jensen             if (zra == NVME_ZONE_REPORT_EXTENDED) {
407388eea45cSKlaus Jensen                 if (zone->d.za & NVME_ZA_ZD_EXT_VALID) {
407488eea45cSKlaus Jensen                     memcpy(buf_p, nvme_get_zd_extension(ns, zone_idx),
407588eea45cSKlaus Jensen                            ns->params.zd_extension_size);
407688eea45cSKlaus Jensen                 }
407788eea45cSKlaus Jensen                 buf_p += ns->params.zd_extension_size;
407888eea45cSKlaus Jensen             }
407988eea45cSKlaus Jensen 
408088eea45cSKlaus Jensen             max_zones--;
408188eea45cSKlaus Jensen         }
408288eea45cSKlaus Jensen     }
408388eea45cSKlaus Jensen 
408488eea45cSKlaus Jensen     status = nvme_c2h(n, (uint8_t *)buf, data_size, req);
408588eea45cSKlaus Jensen 
408688eea45cSKlaus Jensen     g_free(buf);
408788eea45cSKlaus Jensen 
408888eea45cSKlaus Jensen     return status;
408988eea45cSKlaus Jensen }
409088eea45cSKlaus Jensen 
409188eea45cSKlaus Jensen static uint16_t nvme_io_cmd(NvmeCtrl *n, NvmeRequest *req)
409288eea45cSKlaus Jensen {
409388eea45cSKlaus Jensen     NvmeNamespace *ns;
409488eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
409588eea45cSKlaus Jensen 
409688eea45cSKlaus Jensen     trace_pci_nvme_io_cmd(nvme_cid(req), nsid, nvme_sqid(req),
409788eea45cSKlaus Jensen                           req->cmd.opcode, nvme_io_opc_str(req->cmd.opcode));
409888eea45cSKlaus Jensen 
409988eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid)) {
410088eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
410188eea45cSKlaus Jensen     }
410288eea45cSKlaus Jensen 
410388eea45cSKlaus Jensen     /*
410488eea45cSKlaus Jensen      * In the base NVM command set, Flush may apply to all namespaces
410588eea45cSKlaus Jensen      * (indicated by NSID being set to FFFFFFFFh). But if that feature is used
410688eea45cSKlaus Jensen      * along with TP 4056 (Namespace Types), it may be pretty screwed up.
410788eea45cSKlaus Jensen      *
410888eea45cSKlaus Jensen      * If NSID is indeed set to FFFFFFFFh, we simply cannot associate the
410988eea45cSKlaus Jensen      * opcode with a specific command since we cannot determine a unique I/O
411088eea45cSKlaus Jensen      * command set. Opcode 0h could have any other meaning than something
411188eea45cSKlaus Jensen      * equivalent to flushing and say it DOES have completely different
411288eea45cSKlaus Jensen      * semantics in some other command set - does an NSID of FFFFFFFFh then
411388eea45cSKlaus Jensen      * mean "for all namespaces, apply whatever command set specific command
411488eea45cSKlaus Jensen      * that uses the 0h opcode?" Or does it mean "for all namespaces, apply
411588eea45cSKlaus Jensen      * whatever command that uses the 0h opcode if, and only if, it allows NSID
411688eea45cSKlaus Jensen      * to be FFFFFFFFh"?
411788eea45cSKlaus Jensen      *
411888eea45cSKlaus Jensen      * Anyway (and luckily), for now, we do not care about this since the
411988eea45cSKlaus Jensen      * device only supports namespace types that includes the NVM Flush command
412088eea45cSKlaus Jensen      * (NVM and Zoned), so always do an NVM Flush.
412188eea45cSKlaus Jensen      */
412288eea45cSKlaus Jensen     if (req->cmd.opcode == NVME_CMD_FLUSH) {
412388eea45cSKlaus Jensen         return nvme_flush(n, req);
412488eea45cSKlaus Jensen     }
412588eea45cSKlaus Jensen 
412688eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
412788eea45cSKlaus Jensen     if (unlikely(!ns)) {
412888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
412988eea45cSKlaus Jensen     }
413088eea45cSKlaus Jensen 
413188eea45cSKlaus Jensen     if (!(ns->iocs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
413288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(req->cmd.opcode);
413388eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
413488eea45cSKlaus Jensen     }
413588eea45cSKlaus Jensen 
413688eea45cSKlaus Jensen     if (ns->status) {
413788eea45cSKlaus Jensen         return ns->status;
413888eea45cSKlaus Jensen     }
413988eea45cSKlaus Jensen 
4140c53a9a91SPankaj Raghav     if (NVME_CMD_FLAGS_FUSE(req->cmd.flags)) {
4141c53a9a91SPankaj Raghav         return NVME_INVALID_FIELD;
4142c53a9a91SPankaj Raghav     }
4143c53a9a91SPankaj Raghav 
414488eea45cSKlaus Jensen     req->ns = ns;
414588eea45cSKlaus Jensen 
414688eea45cSKlaus Jensen     switch (req->cmd.opcode) {
414788eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
414888eea45cSKlaus Jensen         return nvme_write_zeroes(n, req);
414988eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
415088eea45cSKlaus Jensen         return nvme_zone_append(n, req);
415188eea45cSKlaus Jensen     case NVME_CMD_WRITE:
415288eea45cSKlaus Jensen         return nvme_write(n, req);
415388eea45cSKlaus Jensen     case NVME_CMD_READ:
415488eea45cSKlaus Jensen         return nvme_read(n, req);
415588eea45cSKlaus Jensen     case NVME_CMD_COMPARE:
415688eea45cSKlaus Jensen         return nvme_compare(n, req);
415788eea45cSKlaus Jensen     case NVME_CMD_DSM:
415888eea45cSKlaus Jensen         return nvme_dsm(n, req);
415988eea45cSKlaus Jensen     case NVME_CMD_VERIFY:
416088eea45cSKlaus Jensen         return nvme_verify(n, req);
416188eea45cSKlaus Jensen     case NVME_CMD_COPY:
416288eea45cSKlaus Jensen         return nvme_copy(n, req);
416388eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_SEND:
416488eea45cSKlaus Jensen         return nvme_zone_mgmt_send(n, req);
416588eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_RECV:
416688eea45cSKlaus Jensen         return nvme_zone_mgmt_recv(n, req);
416788eea45cSKlaus Jensen     default:
416888eea45cSKlaus Jensen         assert(false);
416988eea45cSKlaus Jensen     }
417088eea45cSKlaus Jensen 
417188eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
417288eea45cSKlaus Jensen }
417388eea45cSKlaus Jensen 
41742e53b0b4SJinhao Fan static void nvme_cq_notifier(EventNotifier *e)
41752e53b0b4SJinhao Fan {
41762e53b0b4SJinhao Fan     NvmeCQueue *cq = container_of(e, NvmeCQueue, notifier);
41772e53b0b4SJinhao Fan     NvmeCtrl *n = cq->ctrl;
41782e53b0b4SJinhao Fan 
4179a2da7377SKlaus Jensen     if (!event_notifier_test_and_clear(e)) {
4180a2da7377SKlaus Jensen         return;
4181a2da7377SKlaus Jensen     }
41822e53b0b4SJinhao Fan 
41832e53b0b4SJinhao Fan     nvme_update_cq_head(cq);
41842e53b0b4SJinhao Fan 
41852e53b0b4SJinhao Fan     if (cq->tail == cq->head) {
41862e53b0b4SJinhao Fan         if (cq->irq_enabled) {
41872e53b0b4SJinhao Fan             n->cq_pending--;
41882e53b0b4SJinhao Fan         }
41892e53b0b4SJinhao Fan 
41902e53b0b4SJinhao Fan         nvme_irq_deassert(n, cq);
41912e53b0b4SJinhao Fan     }
41922e53b0b4SJinhao Fan 
4193d38cc6fdSKlaus Jensen     qemu_bh_schedule(cq->bh);
41942e53b0b4SJinhao Fan }
41952e53b0b4SJinhao Fan 
41962e53b0b4SJinhao Fan static int nvme_init_cq_ioeventfd(NvmeCQueue *cq)
41972e53b0b4SJinhao Fan {
41982e53b0b4SJinhao Fan     NvmeCtrl *n = cq->ctrl;
41992e53b0b4SJinhao Fan     uint16_t offset = (cq->cqid << 3) + (1 << 2);
42002e53b0b4SJinhao Fan     int ret;
42012e53b0b4SJinhao Fan 
42022e53b0b4SJinhao Fan     ret = event_notifier_init(&cq->notifier, 0);
42032e53b0b4SJinhao Fan     if (ret < 0) {
42042e53b0b4SJinhao Fan         return ret;
42052e53b0b4SJinhao Fan     }
42062e53b0b4SJinhao Fan 
42072e53b0b4SJinhao Fan     event_notifier_set_handler(&cq->notifier, nvme_cq_notifier);
42082e53b0b4SJinhao Fan     memory_region_add_eventfd(&n->iomem,
42092e53b0b4SJinhao Fan                               0x1000 + offset, 4, false, 0, &cq->notifier);
42102e53b0b4SJinhao Fan 
42112e53b0b4SJinhao Fan     return 0;
42122e53b0b4SJinhao Fan }
42132e53b0b4SJinhao Fan 
42142e53b0b4SJinhao Fan static void nvme_sq_notifier(EventNotifier *e)
42152e53b0b4SJinhao Fan {
42162e53b0b4SJinhao Fan     NvmeSQueue *sq = container_of(e, NvmeSQueue, notifier);
42172e53b0b4SJinhao Fan 
4218a2da7377SKlaus Jensen     if (!event_notifier_test_and_clear(e)) {
4219a2da7377SKlaus Jensen         return;
4220a2da7377SKlaus Jensen     }
42212e53b0b4SJinhao Fan 
42222e53b0b4SJinhao Fan     nvme_process_sq(sq);
42232e53b0b4SJinhao Fan }
42242e53b0b4SJinhao Fan 
42252e53b0b4SJinhao Fan static int nvme_init_sq_ioeventfd(NvmeSQueue *sq)
42262e53b0b4SJinhao Fan {
42272e53b0b4SJinhao Fan     NvmeCtrl *n = sq->ctrl;
42282e53b0b4SJinhao Fan     uint16_t offset = sq->sqid << 3;
42292e53b0b4SJinhao Fan     int ret;
42302e53b0b4SJinhao Fan 
42312e53b0b4SJinhao Fan     ret = event_notifier_init(&sq->notifier, 0);
42322e53b0b4SJinhao Fan     if (ret < 0) {
42332e53b0b4SJinhao Fan         return ret;
42342e53b0b4SJinhao Fan     }
42352e53b0b4SJinhao Fan 
42362e53b0b4SJinhao Fan     event_notifier_set_handler(&sq->notifier, nvme_sq_notifier);
42372e53b0b4SJinhao Fan     memory_region_add_eventfd(&n->iomem,
42382e53b0b4SJinhao Fan                               0x1000 + offset, 4, false, 0, &sq->notifier);
42392e53b0b4SJinhao Fan 
42402e53b0b4SJinhao Fan     return 0;
42412e53b0b4SJinhao Fan }
42422e53b0b4SJinhao Fan 
424388eea45cSKlaus Jensen static void nvme_free_sq(NvmeSQueue *sq, NvmeCtrl *n)
424488eea45cSKlaus Jensen {
42452e53b0b4SJinhao Fan     uint16_t offset = sq->sqid << 3;
42462e53b0b4SJinhao Fan 
424788eea45cSKlaus Jensen     n->sq[sq->sqid] = NULL;
4248d38cc6fdSKlaus Jensen     qemu_bh_delete(sq->bh);
42492e53b0b4SJinhao Fan     if (sq->ioeventfd_enabled) {
42502e53b0b4SJinhao Fan         memory_region_del_eventfd(&n->iomem,
42512e53b0b4SJinhao Fan                                   0x1000 + offset, 4, false, 0, &sq->notifier);
425204e8da88SKlaus Jensen         event_notifier_set_handler(&sq->notifier, NULL);
42532e53b0b4SJinhao Fan         event_notifier_cleanup(&sq->notifier);
42542e53b0b4SJinhao Fan     }
425588eea45cSKlaus Jensen     g_free(sq->io_req);
425688eea45cSKlaus Jensen     if (sq->sqid) {
425788eea45cSKlaus Jensen         g_free(sq);
425888eea45cSKlaus Jensen     }
425988eea45cSKlaus Jensen }
426088eea45cSKlaus Jensen 
426188eea45cSKlaus Jensen static uint16_t nvme_del_sq(NvmeCtrl *n, NvmeRequest *req)
426288eea45cSKlaus Jensen {
426388eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
426488eea45cSKlaus Jensen     NvmeRequest *r, *next;
426588eea45cSKlaus Jensen     NvmeSQueue *sq;
426688eea45cSKlaus Jensen     NvmeCQueue *cq;
426788eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
426888eea45cSKlaus Jensen 
426988eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_sqid(n, qid))) {
427088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_sq(qid);
427188eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
427288eea45cSKlaus Jensen     }
427388eea45cSKlaus Jensen 
427488eea45cSKlaus Jensen     trace_pci_nvme_del_sq(qid);
427588eea45cSKlaus Jensen 
427688eea45cSKlaus Jensen     sq = n->sq[qid];
427788eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&sq->out_req_list)) {
427888eea45cSKlaus Jensen         r = QTAILQ_FIRST(&sq->out_req_list);
4279e76fb260SKlaus Jensen         assert(r->aiocb);
428088eea45cSKlaus Jensen         blk_aio_cancel(r->aiocb);
428188eea45cSKlaus Jensen     }
428288eea45cSKlaus Jensen 
428388eea45cSKlaus Jensen     assert(QTAILQ_EMPTY(&sq->out_req_list));
428488eea45cSKlaus Jensen 
428588eea45cSKlaus Jensen     if (!nvme_check_cqid(n, sq->cqid)) {
428688eea45cSKlaus Jensen         cq = n->cq[sq->cqid];
428788eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->sq_list, sq, entry);
428888eea45cSKlaus Jensen 
428988eea45cSKlaus Jensen         nvme_post_cqes(cq);
429088eea45cSKlaus Jensen         QTAILQ_FOREACH_SAFE(r, &cq->req_list, entry, next) {
429188eea45cSKlaus Jensen             if (r->sq == sq) {
429288eea45cSKlaus Jensen                 QTAILQ_REMOVE(&cq->req_list, r, entry);
429388eea45cSKlaus Jensen                 QTAILQ_INSERT_TAIL(&sq->req_list, r, entry);
429488eea45cSKlaus Jensen             }
429588eea45cSKlaus Jensen         }
429688eea45cSKlaus Jensen     }
429788eea45cSKlaus Jensen 
429888eea45cSKlaus Jensen     nvme_free_sq(sq, n);
429988eea45cSKlaus Jensen     return NVME_SUCCESS;
430088eea45cSKlaus Jensen }
430188eea45cSKlaus Jensen 
430288eea45cSKlaus Jensen static void nvme_init_sq(NvmeSQueue *sq, NvmeCtrl *n, uint64_t dma_addr,
430388eea45cSKlaus Jensen                          uint16_t sqid, uint16_t cqid, uint16_t size)
430488eea45cSKlaus Jensen {
430588eea45cSKlaus Jensen     int i;
430688eea45cSKlaus Jensen     NvmeCQueue *cq;
430788eea45cSKlaus Jensen 
430888eea45cSKlaus Jensen     sq->ctrl = n;
430988eea45cSKlaus Jensen     sq->dma_addr = dma_addr;
431088eea45cSKlaus Jensen     sq->sqid = sqid;
431188eea45cSKlaus Jensen     sq->size = size;
431288eea45cSKlaus Jensen     sq->cqid = cqid;
431388eea45cSKlaus Jensen     sq->head = sq->tail = 0;
431488eea45cSKlaus Jensen     sq->io_req = g_new0(NvmeRequest, sq->size);
431588eea45cSKlaus Jensen 
431688eea45cSKlaus Jensen     QTAILQ_INIT(&sq->req_list);
431788eea45cSKlaus Jensen     QTAILQ_INIT(&sq->out_req_list);
431888eea45cSKlaus Jensen     for (i = 0; i < sq->size; i++) {
431988eea45cSKlaus Jensen         sq->io_req[i].sq = sq;
432088eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&(sq->req_list), &sq->io_req[i], entry);
432188eea45cSKlaus Jensen     }
4322d38cc6fdSKlaus Jensen 
4323d38cc6fdSKlaus Jensen     sq->bh = qemu_bh_new(nvme_process_sq, sq);
432488eea45cSKlaus Jensen 
43253f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
43263f7fe8deSJinhao Fan         sq->db_addr = n->dbbuf_dbs + (sqid << 3);
43273f7fe8deSJinhao Fan         sq->ei_addr = n->dbbuf_eis + (sqid << 3);
43282e53b0b4SJinhao Fan 
43292e53b0b4SJinhao Fan         if (n->params.ioeventfd && sq->sqid != 0) {
43302e53b0b4SJinhao Fan             if (!nvme_init_sq_ioeventfd(sq)) {
43312e53b0b4SJinhao Fan                 sq->ioeventfd_enabled = true;
43322e53b0b4SJinhao Fan             }
43332e53b0b4SJinhao Fan         }
43343f7fe8deSJinhao Fan     }
43353f7fe8deSJinhao Fan 
433688eea45cSKlaus Jensen     assert(n->cq[cqid]);
433788eea45cSKlaus Jensen     cq = n->cq[cqid];
433888eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&(cq->sq_list), sq, entry);
433988eea45cSKlaus Jensen     n->sq[sqid] = sq;
434088eea45cSKlaus Jensen }
434188eea45cSKlaus Jensen 
434288eea45cSKlaus Jensen static uint16_t nvme_create_sq(NvmeCtrl *n, NvmeRequest *req)
434388eea45cSKlaus Jensen {
434488eea45cSKlaus Jensen     NvmeSQueue *sq;
434588eea45cSKlaus Jensen     NvmeCreateSq *c = (NvmeCreateSq *)&req->cmd;
434688eea45cSKlaus Jensen 
434788eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
434888eea45cSKlaus Jensen     uint16_t sqid = le16_to_cpu(c->sqid);
434988eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
435088eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->sq_flags);
435188eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
435288eea45cSKlaus Jensen 
435388eea45cSKlaus Jensen     trace_pci_nvme_create_sq(prp1, sqid, cqid, qsize, qflags);
435488eea45cSKlaus Jensen 
435588eea45cSKlaus Jensen     if (unlikely(!cqid || nvme_check_cqid(n, cqid))) {
435688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_cqid(cqid);
435788eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
435888eea45cSKlaus Jensen     }
4359decc0261SŁukasz Gieryk     if (unlikely(!sqid || sqid > n->conf_ioqpairs || n->sq[sqid] != NULL)) {
436088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_sqid(sqid);
436188eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
436288eea45cSKlaus Jensen     }
436349e03457SKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(ldq_le_p(&n->bar.cap)))) {
436488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_size(qsize);
436588eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
436688eea45cSKlaus Jensen     }
436788eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
436888eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_addr(prp1);
436988eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
437088eea45cSKlaus Jensen     }
437188eea45cSKlaus Jensen     if (unlikely(!(NVME_SQ_FLAGS_PC(qflags)))) {
437288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_qflags(NVME_SQ_FLAGS_PC(qflags));
437388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
437488eea45cSKlaus Jensen     }
437588eea45cSKlaus Jensen     sq = g_malloc0(sizeof(*sq));
437688eea45cSKlaus Jensen     nvme_init_sq(sq, n, prp1, sqid, cqid, qsize + 1);
437788eea45cSKlaus Jensen     return NVME_SUCCESS;
437888eea45cSKlaus Jensen }
437988eea45cSKlaus Jensen 
438088eea45cSKlaus Jensen struct nvme_stats {
438188eea45cSKlaus Jensen     uint64_t units_read;
438288eea45cSKlaus Jensen     uint64_t units_written;
438388eea45cSKlaus Jensen     uint64_t read_commands;
438488eea45cSKlaus Jensen     uint64_t write_commands;
438588eea45cSKlaus Jensen };
438688eea45cSKlaus Jensen 
438788eea45cSKlaus Jensen static void nvme_set_blk_stats(NvmeNamespace *ns, struct nvme_stats *stats)
438888eea45cSKlaus Jensen {
438988eea45cSKlaus Jensen     BlockAcctStats *s = blk_get_stats(ns->blkconf.blk);
439088eea45cSKlaus Jensen 
4391a555af17SJoel Granados     stats->units_read += s->nr_bytes[BLOCK_ACCT_READ];
4392a555af17SJoel Granados     stats->units_written += s->nr_bytes[BLOCK_ACCT_WRITE];
439388eea45cSKlaus Jensen     stats->read_commands += s->nr_ops[BLOCK_ACCT_READ];
439488eea45cSKlaus Jensen     stats->write_commands += s->nr_ops[BLOCK_ACCT_WRITE];
439588eea45cSKlaus Jensen }
439688eea45cSKlaus Jensen 
439788eea45cSKlaus Jensen static uint16_t nvme_smart_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
439888eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
439988eea45cSKlaus Jensen {
440088eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
440188eea45cSKlaus Jensen     struct nvme_stats stats = { 0 };
440288eea45cSKlaus Jensen     NvmeSmartLog smart = { 0 };
440388eea45cSKlaus Jensen     uint32_t trans_len;
440488eea45cSKlaus Jensen     NvmeNamespace *ns;
440588eea45cSKlaus Jensen     time_t current_ms;
4406a555af17SJoel Granados     uint64_t u_read, u_written;
440788eea45cSKlaus Jensen 
440888eea45cSKlaus Jensen     if (off >= sizeof(smart)) {
440988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
441088eea45cSKlaus Jensen     }
441188eea45cSKlaus Jensen 
441288eea45cSKlaus Jensen     if (nsid != 0xffffffff) {
441388eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
441488eea45cSKlaus Jensen         if (!ns) {
441588eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
441688eea45cSKlaus Jensen         }
441788eea45cSKlaus Jensen         nvme_set_blk_stats(ns, &stats);
441888eea45cSKlaus Jensen     } else {
441988eea45cSKlaus Jensen         int i;
442088eea45cSKlaus Jensen 
442188eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
442288eea45cSKlaus Jensen             ns = nvme_ns(n, i);
442388eea45cSKlaus Jensen             if (!ns) {
442488eea45cSKlaus Jensen                 continue;
442588eea45cSKlaus Jensen             }
442688eea45cSKlaus Jensen             nvme_set_blk_stats(ns, &stats);
442788eea45cSKlaus Jensen         }
442888eea45cSKlaus Jensen     }
442988eea45cSKlaus Jensen 
443088eea45cSKlaus Jensen     trans_len = MIN(sizeof(smart) - off, buf_len);
443188eea45cSKlaus Jensen     smart.critical_warning = n->smart_critical_warning;
443288eea45cSKlaus Jensen 
4433a555af17SJoel Granados     u_read = DIV_ROUND_UP(stats.units_read >> BDRV_SECTOR_BITS, 1000);
4434a555af17SJoel Granados     u_written = DIV_ROUND_UP(stats.units_written >> BDRV_SECTOR_BITS, 1000);
4435a555af17SJoel Granados 
4436a555af17SJoel Granados     smart.data_units_read[0] = cpu_to_le64(u_read);
4437a555af17SJoel Granados     smart.data_units_written[0] = cpu_to_le64(u_written);
443888eea45cSKlaus Jensen     smart.host_read_commands[0] = cpu_to_le64(stats.read_commands);
443988eea45cSKlaus Jensen     smart.host_write_commands[0] = cpu_to_le64(stats.write_commands);
444088eea45cSKlaus Jensen 
444188eea45cSKlaus Jensen     smart.temperature = cpu_to_le16(n->temperature);
444288eea45cSKlaus Jensen 
444388eea45cSKlaus Jensen     if ((n->temperature >= n->features.temp_thresh_hi) ||
444488eea45cSKlaus Jensen         (n->temperature <= n->features.temp_thresh_low)) {
444588eea45cSKlaus Jensen         smart.critical_warning |= NVME_SMART_TEMPERATURE;
444688eea45cSKlaus Jensen     }
444788eea45cSKlaus Jensen 
444888eea45cSKlaus Jensen     current_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
444988eea45cSKlaus Jensen     smart.power_on_hours[0] =
445088eea45cSKlaus Jensen         cpu_to_le64((((current_ms - n->starttime_ms) / 1000) / 60) / 60);
445188eea45cSKlaus Jensen 
445288eea45cSKlaus Jensen     if (!rae) {
445388eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_SMART);
445488eea45cSKlaus Jensen     }
445588eea45cSKlaus Jensen 
445688eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &smart + off, trans_len, req);
445788eea45cSKlaus Jensen }
445888eea45cSKlaus Jensen 
4459771dbc3aSKlaus Jensen static uint16_t nvme_endgrp_info(NvmeCtrl *n,  uint8_t rae, uint32_t buf_len,
4460771dbc3aSKlaus Jensen                                  uint64_t off, NvmeRequest *req)
4461771dbc3aSKlaus Jensen {
4462771dbc3aSKlaus Jensen     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
4463771dbc3aSKlaus Jensen     uint16_t endgrpid = (dw11 >> 16) & 0xffff;
4464771dbc3aSKlaus Jensen     struct nvme_stats stats = {};
4465771dbc3aSKlaus Jensen     NvmeEndGrpLog info = {};
4466771dbc3aSKlaus Jensen     int i;
4467771dbc3aSKlaus Jensen 
4468771dbc3aSKlaus Jensen     if (!n->subsys || endgrpid != 0x1) {
4469771dbc3aSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4470771dbc3aSKlaus Jensen     }
4471771dbc3aSKlaus Jensen 
4472771dbc3aSKlaus Jensen     if (off >= sizeof(info)) {
4473771dbc3aSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4474771dbc3aSKlaus Jensen     }
4475771dbc3aSKlaus Jensen 
4476771dbc3aSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
4477771dbc3aSKlaus Jensen         NvmeNamespace *ns = nvme_subsys_ns(n->subsys, i);
4478771dbc3aSKlaus Jensen         if (!ns) {
4479771dbc3aSKlaus Jensen             continue;
4480771dbc3aSKlaus Jensen         }
4481771dbc3aSKlaus Jensen 
4482771dbc3aSKlaus Jensen         nvme_set_blk_stats(ns, &stats);
4483771dbc3aSKlaus Jensen     }
4484771dbc3aSKlaus Jensen 
4485771dbc3aSKlaus Jensen     info.data_units_read[0] =
4486771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_read / 1000000000, 1000000000));
4487771dbc3aSKlaus Jensen     info.data_units_written[0] =
4488771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_written / 1000000000, 1000000000));
4489771dbc3aSKlaus Jensen     info.media_units_written[0] =
4490771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_written / 1000000000, 1000000000));
4491771dbc3aSKlaus Jensen 
4492771dbc3aSKlaus Jensen     info.host_read_commands[0] = cpu_to_le64(stats.read_commands);
4493771dbc3aSKlaus Jensen     info.host_write_commands[0] = cpu_to_le64(stats.write_commands);
4494771dbc3aSKlaus Jensen 
4495771dbc3aSKlaus Jensen     buf_len = MIN(sizeof(info) - off, buf_len);
4496771dbc3aSKlaus Jensen 
4497771dbc3aSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&info + off, buf_len, req);
4498771dbc3aSKlaus Jensen }
4499771dbc3aSKlaus Jensen 
4500771dbc3aSKlaus Jensen 
450188eea45cSKlaus Jensen static uint16_t nvme_fw_log_info(NvmeCtrl *n, uint32_t buf_len, uint64_t off,
450288eea45cSKlaus Jensen                                  NvmeRequest *req)
450388eea45cSKlaus Jensen {
450488eea45cSKlaus Jensen     uint32_t trans_len;
450588eea45cSKlaus Jensen     NvmeFwSlotInfoLog fw_log = {
450688eea45cSKlaus Jensen         .afi = 0x1,
450788eea45cSKlaus Jensen     };
450888eea45cSKlaus Jensen 
450988eea45cSKlaus Jensen     if (off >= sizeof(fw_log)) {
451088eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
451188eea45cSKlaus Jensen     }
451288eea45cSKlaus Jensen 
451388eea45cSKlaus Jensen     strpadcpy((char *)&fw_log.frs1, sizeof(fw_log.frs1), "1.0", ' ');
451488eea45cSKlaus Jensen     trans_len = MIN(sizeof(fw_log) - off, buf_len);
451588eea45cSKlaus Jensen 
451688eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &fw_log + off, trans_len, req);
451788eea45cSKlaus Jensen }
451888eea45cSKlaus Jensen 
451988eea45cSKlaus Jensen static uint16_t nvme_error_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
452088eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
452188eea45cSKlaus Jensen {
452288eea45cSKlaus Jensen     uint32_t trans_len;
452388eea45cSKlaus Jensen     NvmeErrorLog errlog;
452488eea45cSKlaus Jensen 
452588eea45cSKlaus Jensen     if (off >= sizeof(errlog)) {
452688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
452788eea45cSKlaus Jensen     }
452888eea45cSKlaus Jensen 
452988eea45cSKlaus Jensen     if (!rae) {
453088eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_ERROR);
453188eea45cSKlaus Jensen     }
453288eea45cSKlaus Jensen 
453388eea45cSKlaus Jensen     memset(&errlog, 0x0, sizeof(errlog));
453488eea45cSKlaus Jensen     trans_len = MIN(sizeof(errlog) - off, buf_len);
453588eea45cSKlaus Jensen 
453688eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&errlog, trans_len, req);
453788eea45cSKlaus Jensen }
453888eea45cSKlaus Jensen 
453988eea45cSKlaus Jensen static uint16_t nvme_changed_nslist(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
454088eea45cSKlaus Jensen                                     uint64_t off, NvmeRequest *req)
454188eea45cSKlaus Jensen {
454288eea45cSKlaus Jensen     uint32_t nslist[1024];
454388eea45cSKlaus Jensen     uint32_t trans_len;
454488eea45cSKlaus Jensen     int i = 0;
454588eea45cSKlaus Jensen     uint32_t nsid;
454688eea45cSKlaus Jensen 
4547e2c57529SKlaus Jensen     if (off >= sizeof(nslist)) {
4548e2c57529SKlaus Jensen         trace_pci_nvme_err_invalid_log_page_offset(off, sizeof(nslist));
4549e2c57529SKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4550e2c57529SKlaus Jensen     }
4551e2c57529SKlaus Jensen 
455288eea45cSKlaus Jensen     memset(nslist, 0x0, sizeof(nslist));
455388eea45cSKlaus Jensen     trans_len = MIN(sizeof(nslist) - off, buf_len);
455488eea45cSKlaus Jensen 
455588eea45cSKlaus Jensen     while ((nsid = find_first_bit(n->changed_nsids, NVME_CHANGED_NSID_SIZE)) !=
455688eea45cSKlaus Jensen             NVME_CHANGED_NSID_SIZE) {
455788eea45cSKlaus Jensen         /*
455888eea45cSKlaus Jensen          * If more than 1024 namespaces, the first entry in the log page should
455988eea45cSKlaus Jensen          * be set to FFFFFFFFh and the others to 0 as spec.
456088eea45cSKlaus Jensen          */
456188eea45cSKlaus Jensen         if (i == ARRAY_SIZE(nslist)) {
456288eea45cSKlaus Jensen             memset(nslist, 0x0, sizeof(nslist));
456388eea45cSKlaus Jensen             nslist[0] = 0xffffffff;
456488eea45cSKlaus Jensen             break;
456588eea45cSKlaus Jensen         }
456688eea45cSKlaus Jensen 
456788eea45cSKlaus Jensen         nslist[i++] = nsid;
456888eea45cSKlaus Jensen         clear_bit(nsid, n->changed_nsids);
456988eea45cSKlaus Jensen     }
457088eea45cSKlaus Jensen 
457188eea45cSKlaus Jensen     /*
457288eea45cSKlaus Jensen      * Remove all the remaining list entries in case returns directly due to
457388eea45cSKlaus Jensen      * more than 1024 namespaces.
457488eea45cSKlaus Jensen      */
457588eea45cSKlaus Jensen     if (nslist[0] == 0xffffffff) {
457688eea45cSKlaus Jensen         bitmap_zero(n->changed_nsids, NVME_CHANGED_NSID_SIZE);
457788eea45cSKlaus Jensen     }
457888eea45cSKlaus Jensen 
457988eea45cSKlaus Jensen     if (!rae) {
458088eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_NOTICE);
458188eea45cSKlaus Jensen     }
458288eea45cSKlaus Jensen 
458388eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)nslist) + off, trans_len, req);
458488eea45cSKlaus Jensen }
458588eea45cSKlaus Jensen 
458688eea45cSKlaus Jensen static uint16_t nvme_cmd_effects(NvmeCtrl *n, uint8_t csi, uint32_t buf_len,
458788eea45cSKlaus Jensen                                  uint64_t off, NvmeRequest *req)
458888eea45cSKlaus Jensen {
458988eea45cSKlaus Jensen     NvmeEffectsLog log = {};
459088eea45cSKlaus Jensen     const uint32_t *src_iocs = NULL;
459188eea45cSKlaus Jensen     uint32_t trans_len;
459288eea45cSKlaus Jensen 
459388eea45cSKlaus Jensen     if (off >= sizeof(log)) {
459488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page_offset(off, sizeof(log));
459588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
459688eea45cSKlaus Jensen     }
459788eea45cSKlaus Jensen 
459849e03457SKlaus Jensen     switch (NVME_CC_CSS(ldl_le_p(&n->bar.cc))) {
459988eea45cSKlaus Jensen     case NVME_CC_CSS_NVM:
460088eea45cSKlaus Jensen         src_iocs = nvme_cse_iocs_nvm;
460188eea45cSKlaus Jensen         /* fall through */
460288eea45cSKlaus Jensen     case NVME_CC_CSS_ADMIN_ONLY:
460388eea45cSKlaus Jensen         break;
460488eea45cSKlaus Jensen     case NVME_CC_CSS_CSI:
460588eea45cSKlaus Jensen         switch (csi) {
460688eea45cSKlaus Jensen         case NVME_CSI_NVM:
460788eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_nvm;
460888eea45cSKlaus Jensen             break;
460988eea45cSKlaus Jensen         case NVME_CSI_ZONED:
461088eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_zoned;
461188eea45cSKlaus Jensen             break;
461288eea45cSKlaus Jensen         }
461388eea45cSKlaus Jensen     }
461488eea45cSKlaus Jensen 
461588eea45cSKlaus Jensen     memcpy(log.acs, nvme_cse_acs, sizeof(nvme_cse_acs));
461688eea45cSKlaus Jensen 
461788eea45cSKlaus Jensen     if (src_iocs) {
461888eea45cSKlaus Jensen         memcpy(log.iocs, src_iocs, sizeof(log.iocs));
461988eea45cSKlaus Jensen     }
462088eea45cSKlaus Jensen 
462188eea45cSKlaus Jensen     trans_len = MIN(sizeof(log) - off, buf_len);
462288eea45cSKlaus Jensen 
462388eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)&log) + off, trans_len, req);
462488eea45cSKlaus Jensen }
462588eea45cSKlaus Jensen 
462688eea45cSKlaus Jensen static uint16_t nvme_get_log(NvmeCtrl *n, NvmeRequest *req)
462788eea45cSKlaus Jensen {
462888eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
462988eea45cSKlaus Jensen 
463088eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
463188eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
463288eea45cSKlaus Jensen     uint32_t dw12 = le32_to_cpu(cmd->cdw12);
463388eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
463488eea45cSKlaus Jensen     uint8_t  lid = dw10 & 0xff;
463588eea45cSKlaus Jensen     uint8_t  lsp = (dw10 >> 8) & 0xf;
463688eea45cSKlaus Jensen     uint8_t  rae = (dw10 >> 15) & 0x1;
463788eea45cSKlaus Jensen     uint8_t  csi = le32_to_cpu(cmd->cdw14) >> 24;
463888eea45cSKlaus Jensen     uint32_t numdl, numdu;
463988eea45cSKlaus Jensen     uint64_t off, lpol, lpou;
464088eea45cSKlaus Jensen     size_t   len;
464188eea45cSKlaus Jensen     uint16_t status;
464288eea45cSKlaus Jensen 
464388eea45cSKlaus Jensen     numdl = (dw10 >> 16);
464488eea45cSKlaus Jensen     numdu = (dw11 & 0xffff);
464588eea45cSKlaus Jensen     lpol = dw12;
464688eea45cSKlaus Jensen     lpou = dw13;
464788eea45cSKlaus Jensen 
464888eea45cSKlaus Jensen     len = (((numdu << 16) | numdl) + 1) << 2;
464988eea45cSKlaus Jensen     off = (lpou << 32ULL) | lpol;
465088eea45cSKlaus Jensen 
465188eea45cSKlaus Jensen     if (off & 0x3) {
465288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
465388eea45cSKlaus Jensen     }
465488eea45cSKlaus Jensen 
465588eea45cSKlaus Jensen     trace_pci_nvme_get_log(nvme_cid(req), lid, lsp, rae, len, off);
465688eea45cSKlaus Jensen 
465788eea45cSKlaus Jensen     status = nvme_check_mdts(n, len);
465888eea45cSKlaus Jensen     if (status) {
465988eea45cSKlaus Jensen         return status;
466088eea45cSKlaus Jensen     }
466188eea45cSKlaus Jensen 
466288eea45cSKlaus Jensen     switch (lid) {
466388eea45cSKlaus Jensen     case NVME_LOG_ERROR_INFO:
466488eea45cSKlaus Jensen         return nvme_error_info(n, rae, len, off, req);
466588eea45cSKlaus Jensen     case NVME_LOG_SMART_INFO:
466688eea45cSKlaus Jensen         return nvme_smart_info(n, rae, len, off, req);
466788eea45cSKlaus Jensen     case NVME_LOG_FW_SLOT_INFO:
466888eea45cSKlaus Jensen         return nvme_fw_log_info(n, len, off, req);
466988eea45cSKlaus Jensen     case NVME_LOG_CHANGED_NSLIST:
467088eea45cSKlaus Jensen         return nvme_changed_nslist(n, rae, len, off, req);
467188eea45cSKlaus Jensen     case NVME_LOG_CMD_EFFECTS:
467288eea45cSKlaus Jensen         return nvme_cmd_effects(n, csi, len, off, req);
4673771dbc3aSKlaus Jensen     case NVME_LOG_ENDGRP:
4674771dbc3aSKlaus Jensen         return nvme_endgrp_info(n, rae, len, off, req);
467588eea45cSKlaus Jensen     default:
467688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page(nvme_cid(req), lid);
467788eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
467888eea45cSKlaus Jensen     }
467988eea45cSKlaus Jensen }
468088eea45cSKlaus Jensen 
468188eea45cSKlaus Jensen static void nvme_free_cq(NvmeCQueue *cq, NvmeCtrl *n)
468288eea45cSKlaus Jensen {
468348b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
46842e53b0b4SJinhao Fan     uint16_t offset = (cq->cqid << 3) + (1 << 2);
46852e53b0b4SJinhao Fan 
468688eea45cSKlaus Jensen     n->cq[cq->cqid] = NULL;
4687d38cc6fdSKlaus Jensen     qemu_bh_delete(cq->bh);
46882e53b0b4SJinhao Fan     if (cq->ioeventfd_enabled) {
46892e53b0b4SJinhao Fan         memory_region_del_eventfd(&n->iomem,
46902e53b0b4SJinhao Fan                                   0x1000 + offset, 4, false, 0, &cq->notifier);
469104e8da88SKlaus Jensen         event_notifier_set_handler(&cq->notifier, NULL);
46922e53b0b4SJinhao Fan         event_notifier_cleanup(&cq->notifier);
46932e53b0b4SJinhao Fan     }
469448b32c28SKlaus Jensen     if (msix_enabled(pci)) {
469548b32c28SKlaus Jensen         msix_vector_unuse(pci, cq->vector);
469688eea45cSKlaus Jensen     }
469788eea45cSKlaus Jensen     if (cq->cqid) {
469888eea45cSKlaus Jensen         g_free(cq);
469988eea45cSKlaus Jensen     }
470088eea45cSKlaus Jensen }
470188eea45cSKlaus Jensen 
470288eea45cSKlaus Jensen static uint16_t nvme_del_cq(NvmeCtrl *n, NvmeRequest *req)
470388eea45cSKlaus Jensen {
470488eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
470588eea45cSKlaus Jensen     NvmeCQueue *cq;
470688eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
470788eea45cSKlaus Jensen 
470888eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_cqid(n, qid))) {
470988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_cqid(qid);
471088eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
471188eea45cSKlaus Jensen     }
471288eea45cSKlaus Jensen 
471388eea45cSKlaus Jensen     cq = n->cq[qid];
471488eea45cSKlaus Jensen     if (unlikely(!QTAILQ_EMPTY(&cq->sq_list))) {
471588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_notempty(qid);
471688eea45cSKlaus Jensen         return NVME_INVALID_QUEUE_DEL;
471788eea45cSKlaus Jensen     }
471883d7ed5cSKlaus Jensen 
471983d7ed5cSKlaus Jensen     if (cq->irq_enabled && cq->tail != cq->head) {
472083d7ed5cSKlaus Jensen         n->cq_pending--;
472183d7ed5cSKlaus Jensen     }
472283d7ed5cSKlaus Jensen 
472388eea45cSKlaus Jensen     nvme_irq_deassert(n, cq);
472488eea45cSKlaus Jensen     trace_pci_nvme_del_cq(qid);
472588eea45cSKlaus Jensen     nvme_free_cq(cq, n);
472688eea45cSKlaus Jensen     return NVME_SUCCESS;
472788eea45cSKlaus Jensen }
472888eea45cSKlaus Jensen 
472988eea45cSKlaus Jensen static void nvme_init_cq(NvmeCQueue *cq, NvmeCtrl *n, uint64_t dma_addr,
473088eea45cSKlaus Jensen                          uint16_t cqid, uint16_t vector, uint16_t size,
473188eea45cSKlaus Jensen                          uint16_t irq_enabled)
473288eea45cSKlaus Jensen {
473348b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
473448b32c28SKlaus Jensen 
473548b32c28SKlaus Jensen     if (msix_enabled(pci)) {
473648b32c28SKlaus Jensen         msix_vector_use(pci, vector);
473788eea45cSKlaus Jensen     }
473888eea45cSKlaus Jensen     cq->ctrl = n;
473988eea45cSKlaus Jensen     cq->cqid = cqid;
474088eea45cSKlaus Jensen     cq->size = size;
474188eea45cSKlaus Jensen     cq->dma_addr = dma_addr;
474288eea45cSKlaus Jensen     cq->phase = 1;
474388eea45cSKlaus Jensen     cq->irq_enabled = irq_enabled;
474488eea45cSKlaus Jensen     cq->vector = vector;
474588eea45cSKlaus Jensen     cq->head = cq->tail = 0;
474688eea45cSKlaus Jensen     QTAILQ_INIT(&cq->req_list);
474788eea45cSKlaus Jensen     QTAILQ_INIT(&cq->sq_list);
47483f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
47493f7fe8deSJinhao Fan         cq->db_addr = n->dbbuf_dbs + (cqid << 3) + (1 << 2);
47503f7fe8deSJinhao Fan         cq->ei_addr = n->dbbuf_eis + (cqid << 3) + (1 << 2);
47512e53b0b4SJinhao Fan 
47522e53b0b4SJinhao Fan         if (n->params.ioeventfd && cqid != 0) {
47532e53b0b4SJinhao Fan             if (!nvme_init_cq_ioeventfd(cq)) {
47542e53b0b4SJinhao Fan                 cq->ioeventfd_enabled = true;
47552e53b0b4SJinhao Fan             }
47562e53b0b4SJinhao Fan         }
47573f7fe8deSJinhao Fan     }
475888eea45cSKlaus Jensen     n->cq[cqid] = cq;
4759d38cc6fdSKlaus Jensen     cq->bh = qemu_bh_new(nvme_post_cqes, cq);
476088eea45cSKlaus Jensen }
476188eea45cSKlaus Jensen 
476288eea45cSKlaus Jensen static uint16_t nvme_create_cq(NvmeCtrl *n, NvmeRequest *req)
476388eea45cSKlaus Jensen {
476488eea45cSKlaus Jensen     NvmeCQueue *cq;
476588eea45cSKlaus Jensen     NvmeCreateCq *c = (NvmeCreateCq *)&req->cmd;
476688eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
476788eea45cSKlaus Jensen     uint16_t vector = le16_to_cpu(c->irq_vector);
476888eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
476988eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->cq_flags);
477088eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
477188eea45cSKlaus Jensen 
477288eea45cSKlaus Jensen     trace_pci_nvme_create_cq(prp1, cqid, vector, qsize, qflags,
477388eea45cSKlaus Jensen                              NVME_CQ_FLAGS_IEN(qflags) != 0);
477488eea45cSKlaus Jensen 
4775decc0261SŁukasz Gieryk     if (unlikely(!cqid || cqid > n->conf_ioqpairs || n->cq[cqid] != NULL)) {
477688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_cqid(cqid);
477788eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
477888eea45cSKlaus Jensen     }
477949e03457SKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(ldq_le_p(&n->bar.cap)))) {
478088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_size(qsize);
478188eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
478288eea45cSKlaus Jensen     }
478388eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
478488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_addr(prp1);
478588eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
478688eea45cSKlaus Jensen     }
478748b32c28SKlaus Jensen     if (unlikely(!msix_enabled(PCI_DEVICE(n)) && vector)) {
478888eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
478988eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
479088eea45cSKlaus Jensen     }
4791decc0261SŁukasz Gieryk     if (unlikely(vector >= n->conf_msix_qsize)) {
479288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
479388eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
479488eea45cSKlaus Jensen     }
479588eea45cSKlaus Jensen     if (unlikely(!(NVME_CQ_FLAGS_PC(qflags)))) {
479688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_qflags(NVME_CQ_FLAGS_PC(qflags));
479788eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
479888eea45cSKlaus Jensen     }
479988eea45cSKlaus Jensen 
480088eea45cSKlaus Jensen     cq = g_malloc0(sizeof(*cq));
480188eea45cSKlaus Jensen     nvme_init_cq(cq, n, prp1, cqid, vector, qsize + 1,
480288eea45cSKlaus Jensen                  NVME_CQ_FLAGS_IEN(qflags));
480388eea45cSKlaus Jensen 
480488eea45cSKlaus Jensen     /*
480588eea45cSKlaus Jensen      * It is only required to set qs_created when creating a completion queue;
480688eea45cSKlaus Jensen      * creating a submission queue without a matching completion queue will
480788eea45cSKlaus Jensen      * fail.
480888eea45cSKlaus Jensen      */
480988eea45cSKlaus Jensen     n->qs_created = true;
481088eea45cSKlaus Jensen     return NVME_SUCCESS;
481188eea45cSKlaus Jensen }
481288eea45cSKlaus Jensen 
481388eea45cSKlaus Jensen static uint16_t nvme_rpt_empty_id_struct(NvmeCtrl *n, NvmeRequest *req)
481488eea45cSKlaus Jensen {
481588eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
481688eea45cSKlaus Jensen 
481788eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
481888eea45cSKlaus Jensen }
481988eea45cSKlaus Jensen 
482088eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl(NvmeCtrl *n, NvmeRequest *req)
482188eea45cSKlaus Jensen {
482288eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl();
482388eea45cSKlaus Jensen 
482488eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&n->id_ctrl, sizeof(n->id_ctrl), req);
482588eea45cSKlaus Jensen }
482688eea45cSKlaus Jensen 
482788eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl_csi(NvmeCtrl *n, NvmeRequest *req)
482888eea45cSKlaus Jensen {
482988eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
483088eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
483188eea45cSKlaus Jensen     NvmeIdCtrlNvm *id_nvm = (NvmeIdCtrlNvm *)&id;
483288eea45cSKlaus Jensen 
483388eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl_csi(c->csi);
483488eea45cSKlaus Jensen 
483588eea45cSKlaus Jensen     switch (c->csi) {
483688eea45cSKlaus Jensen     case NVME_CSI_NVM:
483788eea45cSKlaus Jensen         id_nvm->vsl = n->params.vsl;
483888eea45cSKlaus Jensen         id_nvm->dmrsl = cpu_to_le32(n->dmrsl);
483988eea45cSKlaus Jensen         break;
484088eea45cSKlaus Jensen 
484188eea45cSKlaus Jensen     case NVME_CSI_ZONED:
484288eea45cSKlaus Jensen         ((NvmeIdCtrlZoned *)&id)->zasl = n->params.zasl;
484388eea45cSKlaus Jensen         break;
484488eea45cSKlaus Jensen 
484588eea45cSKlaus Jensen     default:
484688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
484788eea45cSKlaus Jensen     }
484888eea45cSKlaus Jensen 
484988eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
485088eea45cSKlaus Jensen }
485188eea45cSKlaus Jensen 
485288eea45cSKlaus Jensen static uint16_t nvme_identify_ns(NvmeCtrl *n, NvmeRequest *req, bool active)
485388eea45cSKlaus Jensen {
485488eea45cSKlaus Jensen     NvmeNamespace *ns;
485588eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
485688eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
485788eea45cSKlaus Jensen 
485888eea45cSKlaus Jensen     trace_pci_nvme_identify_ns(nsid);
485988eea45cSKlaus Jensen 
486088eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
486188eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
486288eea45cSKlaus Jensen     }
486388eea45cSKlaus Jensen 
486488eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
486588eea45cSKlaus Jensen     if (unlikely(!ns)) {
486688eea45cSKlaus Jensen         if (!active) {
486788eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
486888eea45cSKlaus Jensen             if (!ns) {
486988eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
487088eea45cSKlaus Jensen             }
487188eea45cSKlaus Jensen         } else {
487288eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
487388eea45cSKlaus Jensen         }
487488eea45cSKlaus Jensen     }
487588eea45cSKlaus Jensen 
48763553c48fSGollu Appalanaidu     if (active || ns->csi == NVME_CSI_NVM) {
487788eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)&ns->id_ns, sizeof(NvmeIdNs), req);
487888eea45cSKlaus Jensen     }
487988eea45cSKlaus Jensen 
488088eea45cSKlaus Jensen     return NVME_INVALID_CMD_SET | NVME_DNR;
488188eea45cSKlaus Jensen }
488288eea45cSKlaus Jensen 
48835f4eb94dSGollu Appalanaidu static uint16_t nvme_identify_ctrl_list(NvmeCtrl *n, NvmeRequest *req,
48845f4eb94dSGollu Appalanaidu                                         bool attached)
488588eea45cSKlaus Jensen {
488688eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
48875f4eb94dSGollu Appalanaidu     uint32_t nsid = le32_to_cpu(c->nsid);
488888eea45cSKlaus Jensen     uint16_t min_id = le16_to_cpu(c->ctrlid);
488988eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
489088eea45cSKlaus Jensen     uint16_t *ids = &list[1];
489188eea45cSKlaus Jensen     NvmeNamespace *ns;
489288eea45cSKlaus Jensen     NvmeCtrl *ctrl;
489388eea45cSKlaus Jensen     int cntlid, nr_ids = 0;
489488eea45cSKlaus Jensen 
48955f4eb94dSGollu Appalanaidu     trace_pci_nvme_identify_ctrl_list(c->cns, min_id);
489688eea45cSKlaus Jensen 
48975f4eb94dSGollu Appalanaidu     if (!n->subsys) {
489888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
489988eea45cSKlaus Jensen     }
490088eea45cSKlaus Jensen 
49015f4eb94dSGollu Appalanaidu     if (attached) {
49025f4eb94dSGollu Appalanaidu         if (nsid == NVME_NSID_BROADCAST) {
49035f4eb94dSGollu Appalanaidu             return NVME_INVALID_FIELD | NVME_DNR;
49045f4eb94dSGollu Appalanaidu         }
49055f4eb94dSGollu Appalanaidu 
49065f4eb94dSGollu Appalanaidu         ns = nvme_subsys_ns(n->subsys, nsid);
490788eea45cSKlaus Jensen         if (!ns) {
490888eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
490988eea45cSKlaus Jensen         }
49105f4eb94dSGollu Appalanaidu     }
491188eea45cSKlaus Jensen 
491288eea45cSKlaus Jensen     for (cntlid = min_id; cntlid < ARRAY_SIZE(n->subsys->ctrls); cntlid++) {
491388eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, cntlid);
491488eea45cSKlaus Jensen         if (!ctrl) {
491588eea45cSKlaus Jensen             continue;
491688eea45cSKlaus Jensen         }
491788eea45cSKlaus Jensen 
49185f4eb94dSGollu Appalanaidu         if (attached && !nvme_ns(ctrl, nsid)) {
491988eea45cSKlaus Jensen             continue;
492088eea45cSKlaus Jensen         }
492188eea45cSKlaus Jensen 
492288eea45cSKlaus Jensen         ids[nr_ids++] = cntlid;
492388eea45cSKlaus Jensen     }
492488eea45cSKlaus Jensen 
492588eea45cSKlaus Jensen     list[0] = nr_ids;
492688eea45cSKlaus Jensen 
492788eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)list, sizeof(list), req);
492888eea45cSKlaus Jensen }
492988eea45cSKlaus Jensen 
49305e6f963fSLukasz Maniak static uint16_t nvme_identify_pri_ctrl_cap(NvmeCtrl *n, NvmeRequest *req)
49315e6f963fSLukasz Maniak {
49325e6f963fSLukasz Maniak     trace_pci_nvme_identify_pri_ctrl_cap(le16_to_cpu(n->pri_ctrl_cap.cntlid));
49335e6f963fSLukasz Maniak 
49345e6f963fSLukasz Maniak     return nvme_c2h(n, (uint8_t *)&n->pri_ctrl_cap,
49355e6f963fSLukasz Maniak                     sizeof(NvmePriCtrlCap), req);
49365e6f963fSLukasz Maniak }
49375e6f963fSLukasz Maniak 
493899f48ae7SLukasz Maniak static uint16_t nvme_identify_sec_ctrl_list(NvmeCtrl *n, NvmeRequest *req)
493999f48ae7SLukasz Maniak {
494099f48ae7SLukasz Maniak     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
494199f48ae7SLukasz Maniak     uint16_t pri_ctrl_id = le16_to_cpu(n->pri_ctrl_cap.cntlid);
494299f48ae7SLukasz Maniak     uint16_t min_id = le16_to_cpu(c->ctrlid);
494399f48ae7SLukasz Maniak     uint8_t num_sec_ctrl = n->sec_ctrl_list.numcntl;
494499f48ae7SLukasz Maniak     NvmeSecCtrlList list = {0};
494599f48ae7SLukasz Maniak     uint8_t i;
494699f48ae7SLukasz Maniak 
494799f48ae7SLukasz Maniak     for (i = 0; i < num_sec_ctrl; i++) {
494899f48ae7SLukasz Maniak         if (n->sec_ctrl_list.sec[i].scid >= min_id) {
494999f48ae7SLukasz Maniak             list.numcntl = num_sec_ctrl - i;
495099f48ae7SLukasz Maniak             memcpy(&list.sec, n->sec_ctrl_list.sec + i,
495199f48ae7SLukasz Maniak                    list.numcntl * sizeof(NvmeSecCtrlEntry));
495299f48ae7SLukasz Maniak             break;
495399f48ae7SLukasz Maniak         }
495499f48ae7SLukasz Maniak     }
495599f48ae7SLukasz Maniak 
495699f48ae7SLukasz Maniak     trace_pci_nvme_identify_sec_ctrl_list(pri_ctrl_id, list.numcntl);
495799f48ae7SLukasz Maniak 
495899f48ae7SLukasz Maniak     return nvme_c2h(n, (uint8_t *)&list, sizeof(list), req);
495999f48ae7SLukasz Maniak }
496099f48ae7SLukasz Maniak 
496188eea45cSKlaus Jensen static uint16_t nvme_identify_ns_csi(NvmeCtrl *n, NvmeRequest *req,
496288eea45cSKlaus Jensen                                      bool active)
496388eea45cSKlaus Jensen {
496488eea45cSKlaus Jensen     NvmeNamespace *ns;
496588eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
496688eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
496788eea45cSKlaus Jensen 
496888eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_csi(nsid, c->csi);
496988eea45cSKlaus Jensen 
497088eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
497188eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
497288eea45cSKlaus Jensen     }
497388eea45cSKlaus Jensen 
497488eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
497588eea45cSKlaus Jensen     if (unlikely(!ns)) {
497688eea45cSKlaus Jensen         if (!active) {
497788eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
497888eea45cSKlaus Jensen             if (!ns) {
497988eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
498088eea45cSKlaus Jensen             }
498188eea45cSKlaus Jensen         } else {
498288eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
498388eea45cSKlaus Jensen         }
498488eea45cSKlaus Jensen     }
498588eea45cSKlaus Jensen 
49863553c48fSGollu Appalanaidu     if (c->csi == NVME_CSI_NVM) {
498744219b60SNaveen Nagar         return nvme_c2h(n, (uint8_t *)&ns->id_ns_nvm, sizeof(NvmeIdNsNvm),
498844219b60SNaveen Nagar                         req);
498988eea45cSKlaus Jensen     } else if (c->csi == NVME_CSI_ZONED && ns->csi == NVME_CSI_ZONED) {
499088eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)ns->id_ns_zoned, sizeof(NvmeIdNsZoned),
499188eea45cSKlaus Jensen                         req);
499288eea45cSKlaus Jensen     }
499388eea45cSKlaus Jensen 
499488eea45cSKlaus Jensen     return NVME_INVALID_FIELD | NVME_DNR;
499588eea45cSKlaus Jensen }
499688eea45cSKlaus Jensen 
499788eea45cSKlaus Jensen static uint16_t nvme_identify_nslist(NvmeCtrl *n, NvmeRequest *req,
499888eea45cSKlaus Jensen                                      bool active)
499988eea45cSKlaus Jensen {
500088eea45cSKlaus Jensen     NvmeNamespace *ns;
500188eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
500288eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
500388eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
500488eea45cSKlaus Jensen     static const int data_len = sizeof(list);
500588eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
500688eea45cSKlaus Jensen     int i, j = 0;
500788eea45cSKlaus Jensen 
500888eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist(min_nsid);
500988eea45cSKlaus Jensen 
501088eea45cSKlaus Jensen     /*
501188eea45cSKlaus Jensen      * Both FFFFFFFFh (NVME_NSID_BROADCAST) and FFFFFFFFEh are invalid values
501288eea45cSKlaus Jensen      * since the Active Namespace ID List should return namespaces with ids
501388eea45cSKlaus Jensen      * *higher* than the NSID specified in the command. This is also specified
501488eea45cSKlaus Jensen      * in the spec (NVM Express v1.3d, Section 5.15.4).
501588eea45cSKlaus Jensen      */
501688eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
501788eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
501888eea45cSKlaus Jensen     }
501988eea45cSKlaus Jensen 
502088eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
502188eea45cSKlaus Jensen         ns = nvme_ns(n, i);
502288eea45cSKlaus Jensen         if (!ns) {
502388eea45cSKlaus Jensen             if (!active) {
502488eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
502588eea45cSKlaus Jensen                 if (!ns) {
502688eea45cSKlaus Jensen                     continue;
502788eea45cSKlaus Jensen                 }
502888eea45cSKlaus Jensen             } else {
502988eea45cSKlaus Jensen                 continue;
503088eea45cSKlaus Jensen             }
503188eea45cSKlaus Jensen         }
503288eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid) {
503388eea45cSKlaus Jensen             continue;
503488eea45cSKlaus Jensen         }
503588eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
503688eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
503788eea45cSKlaus Jensen             break;
503888eea45cSKlaus Jensen         }
503988eea45cSKlaus Jensen     }
504088eea45cSKlaus Jensen 
504188eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
504288eea45cSKlaus Jensen }
504388eea45cSKlaus Jensen 
504488eea45cSKlaus Jensen static uint16_t nvme_identify_nslist_csi(NvmeCtrl *n, NvmeRequest *req,
504588eea45cSKlaus Jensen                                          bool active)
504688eea45cSKlaus Jensen {
504788eea45cSKlaus Jensen     NvmeNamespace *ns;
504888eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
504988eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
505088eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
505188eea45cSKlaus Jensen     static const int data_len = sizeof(list);
505288eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
505388eea45cSKlaus Jensen     int i, j = 0;
505488eea45cSKlaus Jensen 
505588eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist_csi(min_nsid, c->csi);
505688eea45cSKlaus Jensen 
505788eea45cSKlaus Jensen     /*
505888eea45cSKlaus Jensen      * Same as in nvme_identify_nslist(), FFFFFFFFh/FFFFFFFFEh are invalid.
505988eea45cSKlaus Jensen      */
506088eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
506188eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
506288eea45cSKlaus Jensen     }
506388eea45cSKlaus Jensen 
506488eea45cSKlaus Jensen     if (c->csi != NVME_CSI_NVM && c->csi != NVME_CSI_ZONED) {
506588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
506688eea45cSKlaus Jensen     }
506788eea45cSKlaus Jensen 
506888eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
506988eea45cSKlaus Jensen         ns = nvme_ns(n, i);
507088eea45cSKlaus Jensen         if (!ns) {
507188eea45cSKlaus Jensen             if (!active) {
507288eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
507388eea45cSKlaus Jensen                 if (!ns) {
507488eea45cSKlaus Jensen                     continue;
507588eea45cSKlaus Jensen                 }
507688eea45cSKlaus Jensen             } else {
507788eea45cSKlaus Jensen                 continue;
507888eea45cSKlaus Jensen             }
507988eea45cSKlaus Jensen         }
508088eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid || c->csi != ns->csi) {
508188eea45cSKlaus Jensen             continue;
508288eea45cSKlaus Jensen         }
508388eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
508488eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
508588eea45cSKlaus Jensen             break;
508688eea45cSKlaus Jensen         }
508788eea45cSKlaus Jensen     }
508888eea45cSKlaus Jensen 
508988eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
509088eea45cSKlaus Jensen }
509188eea45cSKlaus Jensen 
509288eea45cSKlaus Jensen static uint16_t nvme_identify_ns_descr_list(NvmeCtrl *n, NvmeRequest *req)
509388eea45cSKlaus Jensen {
509488eea45cSKlaus Jensen     NvmeNamespace *ns;
509588eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
509688eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
509788eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
50986870cfb8SHeinrich Schuchardt     uint8_t *pos = list;
509988eea45cSKlaus Jensen     struct {
510088eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
510188eea45cSKlaus Jensen         uint8_t v[NVME_NIDL_UUID];
51025f4884c4SKlaus Jensen     } QEMU_PACKED uuid = {};
51036870cfb8SHeinrich Schuchardt     struct {
51046870cfb8SHeinrich Schuchardt         NvmeIdNsDescr hdr;
51056870cfb8SHeinrich Schuchardt         uint64_t v;
51065f4884c4SKlaus Jensen     } QEMU_PACKED eui64 = {};
510788eea45cSKlaus Jensen     struct {
510888eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
510988eea45cSKlaus Jensen         uint8_t v;
51105f4884c4SKlaus Jensen     } QEMU_PACKED csi = {};
511188eea45cSKlaus Jensen 
511288eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_descr_list(nsid);
511388eea45cSKlaus Jensen 
511488eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
511588eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
511688eea45cSKlaus Jensen     }
511788eea45cSKlaus Jensen 
511888eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
511988eea45cSKlaus Jensen     if (unlikely(!ns)) {
512088eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
512188eea45cSKlaus Jensen     }
512288eea45cSKlaus Jensen 
51239f2e1acfSKlaus Jensen     if (!qemu_uuid_is_null(&ns->params.uuid)) {
51246870cfb8SHeinrich Schuchardt         uuid.hdr.nidt = NVME_NIDT_UUID;
51256870cfb8SHeinrich Schuchardt         uuid.hdr.nidl = NVME_NIDL_UUID;
51266870cfb8SHeinrich Schuchardt         memcpy(uuid.v, ns->params.uuid.data, NVME_NIDL_UUID);
51276870cfb8SHeinrich Schuchardt         memcpy(pos, &uuid, sizeof(uuid));
51286870cfb8SHeinrich Schuchardt         pos += sizeof(uuid);
51299f2e1acfSKlaus Jensen     }
513088eea45cSKlaus Jensen 
51316870cfb8SHeinrich Schuchardt     if (ns->params.eui64) {
51326870cfb8SHeinrich Schuchardt         eui64.hdr.nidt = NVME_NIDT_EUI64;
51336870cfb8SHeinrich Schuchardt         eui64.hdr.nidl = NVME_NIDL_EUI64;
51346870cfb8SHeinrich Schuchardt         eui64.v = cpu_to_be64(ns->params.eui64);
51356870cfb8SHeinrich Schuchardt         memcpy(pos, &eui64, sizeof(eui64));
51366870cfb8SHeinrich Schuchardt         pos += sizeof(eui64);
51376870cfb8SHeinrich Schuchardt     }
51386870cfb8SHeinrich Schuchardt 
51396870cfb8SHeinrich Schuchardt     csi.hdr.nidt = NVME_NIDT_CSI;
51406870cfb8SHeinrich Schuchardt     csi.hdr.nidl = NVME_NIDL_CSI;
51416870cfb8SHeinrich Schuchardt     csi.v = ns->csi;
51426870cfb8SHeinrich Schuchardt     memcpy(pos, &csi, sizeof(csi));
51436870cfb8SHeinrich Schuchardt     pos += sizeof(csi);
514488eea45cSKlaus Jensen 
514588eea45cSKlaus Jensen     return nvme_c2h(n, list, sizeof(list), req);
514688eea45cSKlaus Jensen }
514788eea45cSKlaus Jensen 
514888eea45cSKlaus Jensen static uint16_t nvme_identify_cmd_set(NvmeCtrl *n, NvmeRequest *req)
514988eea45cSKlaus Jensen {
515088eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
515188eea45cSKlaus Jensen     static const int data_len = sizeof(list);
515288eea45cSKlaus Jensen 
515388eea45cSKlaus Jensen     trace_pci_nvme_identify_cmd_set();
515488eea45cSKlaus Jensen 
515588eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_NVM);
515688eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_ZONED);
515788eea45cSKlaus Jensen 
515888eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
515988eea45cSKlaus Jensen }
516088eea45cSKlaus Jensen 
516188eea45cSKlaus Jensen static uint16_t nvme_identify(NvmeCtrl *n, NvmeRequest *req)
516288eea45cSKlaus Jensen {
516388eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
516488eea45cSKlaus Jensen 
516588eea45cSKlaus Jensen     trace_pci_nvme_identify(nvme_cid(req), c->cns, le16_to_cpu(c->ctrlid),
516688eea45cSKlaus Jensen                             c->csi);
516788eea45cSKlaus Jensen 
516888eea45cSKlaus Jensen     switch (c->cns) {
516988eea45cSKlaus Jensen     case NVME_ID_CNS_NS:
517088eea45cSKlaus Jensen         return nvme_identify_ns(n, req, true);
517188eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT:
517288eea45cSKlaus Jensen         return nvme_identify_ns(n, req, false);
517388eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ATTACHED_CTRL_LIST:
51745f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, true);
51755f4eb94dSGollu Appalanaidu     case NVME_ID_CNS_CTRL_LIST:
51765f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, false);
51775e6f963fSLukasz Maniak     case NVME_ID_CNS_PRIMARY_CTRL_CAP:
51785e6f963fSLukasz Maniak         return nvme_identify_pri_ctrl_cap(n, req);
517999f48ae7SLukasz Maniak     case NVME_ID_CNS_SECONDARY_CTRL_LIST:
518099f48ae7SLukasz Maniak         return nvme_identify_sec_ctrl_list(n, req);
518188eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS:
518288eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, true);
518388eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT:
518488eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, false);
518588eea45cSKlaus Jensen     case NVME_ID_CNS_CTRL:
518688eea45cSKlaus Jensen         return nvme_identify_ctrl(n, req);
518788eea45cSKlaus Jensen     case NVME_ID_CNS_CS_CTRL:
518888eea45cSKlaus Jensen         return nvme_identify_ctrl_csi(n, req);
518988eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ACTIVE_LIST:
519088eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, true);
519188eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT_LIST:
519288eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, false);
519388eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_ACTIVE_LIST:
519488eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, true);
519588eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT_LIST:
519688eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, false);
519788eea45cSKlaus Jensen     case NVME_ID_CNS_NS_DESCR_LIST:
519888eea45cSKlaus Jensen         return nvme_identify_ns_descr_list(n, req);
519988eea45cSKlaus Jensen     case NVME_ID_CNS_IO_COMMAND_SET:
520088eea45cSKlaus Jensen         return nvme_identify_cmd_set(n, req);
520188eea45cSKlaus Jensen     default:
520288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_identify_cns(le32_to_cpu(c->cns));
520388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
520488eea45cSKlaus Jensen     }
520588eea45cSKlaus Jensen }
520688eea45cSKlaus Jensen 
520788eea45cSKlaus Jensen static uint16_t nvme_abort(NvmeCtrl *n, NvmeRequest *req)
520888eea45cSKlaus Jensen {
520988eea45cSKlaus Jensen     uint16_t sqid = le32_to_cpu(req->cmd.cdw10) & 0xffff;
521088eea45cSKlaus Jensen 
521188eea45cSKlaus Jensen     req->cqe.result = 1;
521288eea45cSKlaus Jensen     if (nvme_check_sqid(n, sqid)) {
521388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
521488eea45cSKlaus Jensen     }
521588eea45cSKlaus Jensen 
521688eea45cSKlaus Jensen     return NVME_SUCCESS;
521788eea45cSKlaus Jensen }
521888eea45cSKlaus Jensen 
521988eea45cSKlaus Jensen static inline void nvme_set_timestamp(NvmeCtrl *n, uint64_t ts)
522088eea45cSKlaus Jensen {
522188eea45cSKlaus Jensen     trace_pci_nvme_setfeat_timestamp(ts);
522288eea45cSKlaus Jensen 
522388eea45cSKlaus Jensen     n->host_timestamp = le64_to_cpu(ts);
522488eea45cSKlaus Jensen     n->timestamp_set_qemu_clock_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
522588eea45cSKlaus Jensen }
522688eea45cSKlaus Jensen 
522788eea45cSKlaus Jensen static inline uint64_t nvme_get_timestamp(const NvmeCtrl *n)
522888eea45cSKlaus Jensen {
522988eea45cSKlaus Jensen     uint64_t current_time = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
523088eea45cSKlaus Jensen     uint64_t elapsed_time = current_time - n->timestamp_set_qemu_clock_ms;
523188eea45cSKlaus Jensen 
523288eea45cSKlaus Jensen     union nvme_timestamp {
523388eea45cSKlaus Jensen         struct {
523488eea45cSKlaus Jensen             uint64_t timestamp:48;
523588eea45cSKlaus Jensen             uint64_t sync:1;
523688eea45cSKlaus Jensen             uint64_t origin:3;
523788eea45cSKlaus Jensen             uint64_t rsvd1:12;
523888eea45cSKlaus Jensen         };
523988eea45cSKlaus Jensen         uint64_t all;
524088eea45cSKlaus Jensen     };
524188eea45cSKlaus Jensen 
524288eea45cSKlaus Jensen     union nvme_timestamp ts;
524388eea45cSKlaus Jensen     ts.all = 0;
524488eea45cSKlaus Jensen     ts.timestamp = n->host_timestamp + elapsed_time;
524588eea45cSKlaus Jensen 
524688eea45cSKlaus Jensen     /* If the host timestamp is non-zero, set the timestamp origin */
524788eea45cSKlaus Jensen     ts.origin = n->host_timestamp ? 0x01 : 0x00;
524888eea45cSKlaus Jensen 
524988eea45cSKlaus Jensen     trace_pci_nvme_getfeat_timestamp(ts.all);
525088eea45cSKlaus Jensen 
525188eea45cSKlaus Jensen     return cpu_to_le64(ts.all);
525288eea45cSKlaus Jensen }
525388eea45cSKlaus Jensen 
525488eea45cSKlaus Jensen static uint16_t nvme_get_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
525588eea45cSKlaus Jensen {
525688eea45cSKlaus Jensen     uint64_t timestamp = nvme_get_timestamp(n);
525788eea45cSKlaus Jensen 
525888eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
525988eea45cSKlaus Jensen }
526088eea45cSKlaus Jensen 
526188eea45cSKlaus Jensen static uint16_t nvme_get_feature(NvmeCtrl *n, NvmeRequest *req)
526288eea45cSKlaus Jensen {
526388eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
526488eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
526588eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
526688eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
526788eea45cSKlaus Jensen     uint32_t result;
526888eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
526988eea45cSKlaus Jensen     NvmeGetFeatureSelect sel = NVME_GETFEAT_SELECT(dw10);
527088eea45cSKlaus Jensen     uint16_t iv;
527188eea45cSKlaus Jensen     NvmeNamespace *ns;
527288eea45cSKlaus Jensen     int i;
527388eea45cSKlaus Jensen 
527488eea45cSKlaus Jensen     static const uint32_t nvme_feature_default[NVME_FID_MAX] = {
527588eea45cSKlaus Jensen         [NVME_ARBITRATION] = NVME_ARB_AB_NOLIMIT,
527688eea45cSKlaus Jensen     };
527788eea45cSKlaus Jensen 
527888eea45cSKlaus Jensen     trace_pci_nvme_getfeat(nvme_cid(req), nsid, fid, sel, dw11);
527988eea45cSKlaus Jensen 
528088eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
528188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
528288eea45cSKlaus Jensen     }
528388eea45cSKlaus Jensen 
528488eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
528588eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
528688eea45cSKlaus Jensen             /*
528788eea45cSKlaus Jensen              * The Reservation Notification Mask and Reservation Persistence
528888eea45cSKlaus Jensen              * features require a status code of Invalid Field in Command when
528988eea45cSKlaus Jensen              * NSID is FFFFFFFFh. Since the device does not support those
529088eea45cSKlaus Jensen              * features we can always return Invalid Namespace or Format as we
529188eea45cSKlaus Jensen              * should do for all other features.
529288eea45cSKlaus Jensen              */
529388eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
529488eea45cSKlaus Jensen         }
529588eea45cSKlaus Jensen 
529688eea45cSKlaus Jensen         if (!nvme_ns(n, nsid)) {
529788eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
529888eea45cSKlaus Jensen         }
529988eea45cSKlaus Jensen     }
530088eea45cSKlaus Jensen 
530188eea45cSKlaus Jensen     switch (sel) {
530288eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CURRENT:
530388eea45cSKlaus Jensen         break;
530488eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_SAVED:
530588eea45cSKlaus Jensen         /* no features are saveable by the controller; fallthrough */
530688eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_DEFAULT:
530788eea45cSKlaus Jensen         goto defaults;
530888eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CAP:
530988eea45cSKlaus Jensen         result = nvme_feature_cap[fid];
531088eea45cSKlaus Jensen         goto out;
531188eea45cSKlaus Jensen     }
531288eea45cSKlaus Jensen 
531388eea45cSKlaus Jensen     switch (fid) {
531488eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
531588eea45cSKlaus Jensen         result = 0;
531688eea45cSKlaus Jensen 
531788eea45cSKlaus Jensen         /*
531888eea45cSKlaus Jensen          * The controller only implements the Composite Temperature sensor, so
531988eea45cSKlaus Jensen          * return 0 for all other sensors.
532088eea45cSKlaus Jensen          */
532188eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
532288eea45cSKlaus Jensen             goto out;
532388eea45cSKlaus Jensen         }
532488eea45cSKlaus Jensen 
532588eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
532688eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
532788eea45cSKlaus Jensen             result = n->features.temp_thresh_hi;
532888eea45cSKlaus Jensen             goto out;
532988eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
533088eea45cSKlaus Jensen             result = n->features.temp_thresh_low;
533188eea45cSKlaus Jensen             goto out;
533288eea45cSKlaus Jensen         }
533388eea45cSKlaus Jensen 
533488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
533588eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
533688eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
533788eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
533888eea45cSKlaus Jensen         }
533988eea45cSKlaus Jensen 
534088eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
534188eea45cSKlaus Jensen         if (unlikely(!ns)) {
534288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
534388eea45cSKlaus Jensen         }
534488eea45cSKlaus Jensen 
534588eea45cSKlaus Jensen         result = ns->features.err_rec;
534688eea45cSKlaus Jensen         goto out;
534788eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
534888eea45cSKlaus Jensen         result = 0;
534988eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
535088eea45cSKlaus Jensen             ns = nvme_ns(n, i);
535188eea45cSKlaus Jensen             if (!ns) {
535288eea45cSKlaus Jensen                 continue;
535388eea45cSKlaus Jensen             }
535488eea45cSKlaus Jensen 
535588eea45cSKlaus Jensen             result = blk_enable_write_cache(ns->blkconf.blk);
535688eea45cSKlaus Jensen             if (result) {
535788eea45cSKlaus Jensen                 break;
535888eea45cSKlaus Jensen             }
535988eea45cSKlaus Jensen         }
536088eea45cSKlaus Jensen         trace_pci_nvme_getfeat_vwcache(result ? "enabled" : "disabled");
536188eea45cSKlaus Jensen         goto out;
536288eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
536388eea45cSKlaus Jensen         result = n->features.async_config;
536488eea45cSKlaus Jensen         goto out;
536588eea45cSKlaus Jensen     case NVME_TIMESTAMP:
536688eea45cSKlaus Jensen         return nvme_get_feature_timestamp(n, req);
5367d0c0697bSNaveen Nagar     case NVME_HOST_BEHAVIOR_SUPPORT:
5368d0c0697bSNaveen Nagar         return nvme_c2h(n, (uint8_t *)&n->features.hbs,
5369d0c0697bSNaveen Nagar                         sizeof(n->features.hbs), req);
537088eea45cSKlaus Jensen     default:
537188eea45cSKlaus Jensen         break;
537288eea45cSKlaus Jensen     }
537388eea45cSKlaus Jensen 
537488eea45cSKlaus Jensen defaults:
537588eea45cSKlaus Jensen     switch (fid) {
537688eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
537788eea45cSKlaus Jensen         result = 0;
537888eea45cSKlaus Jensen 
537988eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
538088eea45cSKlaus Jensen             break;
538188eea45cSKlaus Jensen         }
538288eea45cSKlaus Jensen 
538388eea45cSKlaus Jensen         if (NVME_TEMP_THSEL(dw11) == NVME_TEMP_THSEL_OVER) {
538488eea45cSKlaus Jensen             result = NVME_TEMPERATURE_WARNING;
538588eea45cSKlaus Jensen         }
538688eea45cSKlaus Jensen 
538788eea45cSKlaus Jensen         break;
538888eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
5389decc0261SŁukasz Gieryk         result = (n->conf_ioqpairs - 1) | ((n->conf_ioqpairs - 1) << 16);
539088eea45cSKlaus Jensen         trace_pci_nvme_getfeat_numq(result);
539188eea45cSKlaus Jensen         break;
539288eea45cSKlaus Jensen     case NVME_INTERRUPT_VECTOR_CONF:
539388eea45cSKlaus Jensen         iv = dw11 & 0xffff;
5394decc0261SŁukasz Gieryk         if (iv >= n->conf_ioqpairs + 1) {
539588eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
539688eea45cSKlaus Jensen         }
539788eea45cSKlaus Jensen 
539888eea45cSKlaus Jensen         result = iv;
539988eea45cSKlaus Jensen         if (iv == n->admin_cq.vector) {
540088eea45cSKlaus Jensen             result |= NVME_INTVC_NOCOALESCING;
540188eea45cSKlaus Jensen         }
540288eea45cSKlaus Jensen         break;
540388eea45cSKlaus Jensen     default:
540488eea45cSKlaus Jensen         result = nvme_feature_default[fid];
540588eea45cSKlaus Jensen         break;
540688eea45cSKlaus Jensen     }
540788eea45cSKlaus Jensen 
540888eea45cSKlaus Jensen out:
540988eea45cSKlaus Jensen     req->cqe.result = cpu_to_le32(result);
541088eea45cSKlaus Jensen     return NVME_SUCCESS;
541188eea45cSKlaus Jensen }
541288eea45cSKlaus Jensen 
541388eea45cSKlaus Jensen static uint16_t nvme_set_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
541488eea45cSKlaus Jensen {
541588eea45cSKlaus Jensen     uint16_t ret;
541688eea45cSKlaus Jensen     uint64_t timestamp;
541788eea45cSKlaus Jensen 
541888eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
541988eea45cSKlaus Jensen     if (ret) {
542088eea45cSKlaus Jensen         return ret;
542188eea45cSKlaus Jensen     }
542288eea45cSKlaus Jensen 
542388eea45cSKlaus Jensen     nvme_set_timestamp(n, timestamp);
542488eea45cSKlaus Jensen 
542588eea45cSKlaus Jensen     return NVME_SUCCESS;
542688eea45cSKlaus Jensen }
542788eea45cSKlaus Jensen 
542888eea45cSKlaus Jensen static uint16_t nvme_set_feature(NvmeCtrl *n, NvmeRequest *req)
542988eea45cSKlaus Jensen {
543088eea45cSKlaus Jensen     NvmeNamespace *ns = NULL;
543188eea45cSKlaus Jensen 
543288eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
543388eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
543488eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
543588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
543688eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
543788eea45cSKlaus Jensen     uint8_t save = NVME_SETFEAT_SAVE(dw10);
5438763c05dfSNaveen Nagar     uint16_t status;
543988eea45cSKlaus Jensen     int i;
544088eea45cSKlaus Jensen 
544188eea45cSKlaus Jensen     trace_pci_nvme_setfeat(nvme_cid(req), nsid, fid, save, dw11);
544288eea45cSKlaus Jensen 
544388eea45cSKlaus Jensen     if (save && !(nvme_feature_cap[fid] & NVME_FEAT_CAP_SAVE)) {
544488eea45cSKlaus Jensen         return NVME_FID_NOT_SAVEABLE | NVME_DNR;
544588eea45cSKlaus Jensen     }
544688eea45cSKlaus Jensen 
544788eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
544888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
544988eea45cSKlaus Jensen     }
545088eea45cSKlaus Jensen 
545188eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
545288eea45cSKlaus Jensen         if (nsid != NVME_NSID_BROADCAST) {
545388eea45cSKlaus Jensen             if (!nvme_nsid_valid(n, nsid)) {
545488eea45cSKlaus Jensen                 return NVME_INVALID_NSID | NVME_DNR;
545588eea45cSKlaus Jensen             }
545688eea45cSKlaus Jensen 
545788eea45cSKlaus Jensen             ns = nvme_ns(n, nsid);
545888eea45cSKlaus Jensen             if (unlikely(!ns)) {
545988eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
546088eea45cSKlaus Jensen             }
546188eea45cSKlaus Jensen         }
546288eea45cSKlaus Jensen     } else if (nsid && nsid != NVME_NSID_BROADCAST) {
546388eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
546488eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
546588eea45cSKlaus Jensen         }
546688eea45cSKlaus Jensen 
546788eea45cSKlaus Jensen         return NVME_FEAT_NOT_NS_SPEC | NVME_DNR;
546888eea45cSKlaus Jensen     }
546988eea45cSKlaus Jensen 
547088eea45cSKlaus Jensen     if (!(nvme_feature_cap[fid] & NVME_FEAT_CAP_CHANGE)) {
547188eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
547288eea45cSKlaus Jensen     }
547388eea45cSKlaus Jensen 
547488eea45cSKlaus Jensen     switch (fid) {
547588eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
547688eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
547788eea45cSKlaus Jensen             break;
547888eea45cSKlaus Jensen         }
547988eea45cSKlaus Jensen 
548088eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
548188eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
548288eea45cSKlaus Jensen             n->features.temp_thresh_hi = NVME_TEMP_TMPTH(dw11);
548388eea45cSKlaus Jensen             break;
548488eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
548588eea45cSKlaus Jensen             n->features.temp_thresh_low = NVME_TEMP_TMPTH(dw11);
548688eea45cSKlaus Jensen             break;
548788eea45cSKlaus Jensen         default:
548888eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
548988eea45cSKlaus Jensen         }
549088eea45cSKlaus Jensen 
549188eea45cSKlaus Jensen         if ((n->temperature >= n->features.temp_thresh_hi) ||
549288eea45cSKlaus Jensen             (n->temperature <= n->features.temp_thresh_low)) {
54939235a72aSKlaus Jensen             nvme_smart_event(n, NVME_SMART_TEMPERATURE);
549488eea45cSKlaus Jensen         }
549588eea45cSKlaus Jensen 
549688eea45cSKlaus Jensen         break;
549788eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
549888eea45cSKlaus Jensen         if (nsid == NVME_NSID_BROADCAST) {
549988eea45cSKlaus Jensen             for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
550088eea45cSKlaus Jensen                 ns = nvme_ns(n, i);
550188eea45cSKlaus Jensen 
550288eea45cSKlaus Jensen                 if (!ns) {
550388eea45cSKlaus Jensen                     continue;
550488eea45cSKlaus Jensen                 }
550588eea45cSKlaus Jensen 
550688eea45cSKlaus Jensen                 if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat)) {
550788eea45cSKlaus Jensen                     ns->features.err_rec = dw11;
550888eea45cSKlaus Jensen                 }
550988eea45cSKlaus Jensen             }
551088eea45cSKlaus Jensen 
551188eea45cSKlaus Jensen             break;
551288eea45cSKlaus Jensen         }
551388eea45cSKlaus Jensen 
551488eea45cSKlaus Jensen         assert(ns);
551588eea45cSKlaus Jensen         if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat))  {
551688eea45cSKlaus Jensen             ns->features.err_rec = dw11;
551788eea45cSKlaus Jensen         }
551888eea45cSKlaus Jensen         break;
551988eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
552088eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
552188eea45cSKlaus Jensen             ns = nvme_ns(n, i);
552288eea45cSKlaus Jensen             if (!ns) {
552388eea45cSKlaus Jensen                 continue;
552488eea45cSKlaus Jensen             }
552588eea45cSKlaus Jensen 
552688eea45cSKlaus Jensen             if (!(dw11 & 0x1) && blk_enable_write_cache(ns->blkconf.blk)) {
552788eea45cSKlaus Jensen                 blk_flush(ns->blkconf.blk);
552888eea45cSKlaus Jensen             }
552988eea45cSKlaus Jensen 
553088eea45cSKlaus Jensen             blk_set_enable_write_cache(ns->blkconf.blk, dw11 & 1);
553188eea45cSKlaus Jensen         }
553288eea45cSKlaus Jensen 
553388eea45cSKlaus Jensen         break;
553488eea45cSKlaus Jensen 
553588eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
553688eea45cSKlaus Jensen         if (n->qs_created) {
553788eea45cSKlaus Jensen             return NVME_CMD_SEQ_ERROR | NVME_DNR;
553888eea45cSKlaus Jensen         }
553988eea45cSKlaus Jensen 
554088eea45cSKlaus Jensen         /*
554188eea45cSKlaus Jensen          * NVMe v1.3, Section 5.21.1.7: FFFFh is not an allowed value for NCQR
554288eea45cSKlaus Jensen          * and NSQR.
554388eea45cSKlaus Jensen          */
554488eea45cSKlaus Jensen         if ((dw11 & 0xffff) == 0xffff || ((dw11 >> 16) & 0xffff) == 0xffff) {
554588eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
554688eea45cSKlaus Jensen         }
554788eea45cSKlaus Jensen 
554888eea45cSKlaus Jensen         trace_pci_nvme_setfeat_numq((dw11 & 0xffff) + 1,
554988eea45cSKlaus Jensen                                     ((dw11 >> 16) & 0xffff) + 1,
5550decc0261SŁukasz Gieryk                                     n->conf_ioqpairs,
5551decc0261SŁukasz Gieryk                                     n->conf_ioqpairs);
5552decc0261SŁukasz Gieryk         req->cqe.result = cpu_to_le32((n->conf_ioqpairs - 1) |
5553decc0261SŁukasz Gieryk                                       ((n->conf_ioqpairs - 1) << 16));
555488eea45cSKlaus Jensen         break;
555588eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
555688eea45cSKlaus Jensen         n->features.async_config = dw11;
555788eea45cSKlaus Jensen         break;
555888eea45cSKlaus Jensen     case NVME_TIMESTAMP:
555988eea45cSKlaus Jensen         return nvme_set_feature_timestamp(n, req);
5560d0c0697bSNaveen Nagar     case NVME_HOST_BEHAVIOR_SUPPORT:
5561763c05dfSNaveen Nagar         status = nvme_h2c(n, (uint8_t *)&n->features.hbs,
5562d0c0697bSNaveen Nagar                           sizeof(n->features.hbs), req);
5563763c05dfSNaveen Nagar         if (status) {
5564763c05dfSNaveen Nagar             return status;
5565763c05dfSNaveen Nagar         }
5566763c05dfSNaveen Nagar 
5567763c05dfSNaveen Nagar         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
5568763c05dfSNaveen Nagar             ns = nvme_ns(n, i);
5569763c05dfSNaveen Nagar 
5570763c05dfSNaveen Nagar             if (!ns) {
5571763c05dfSNaveen Nagar                 continue;
5572763c05dfSNaveen Nagar             }
5573763c05dfSNaveen Nagar 
5574763c05dfSNaveen Nagar             ns->id_ns.nlbaf = ns->nlbaf - 1;
5575763c05dfSNaveen Nagar             if (!n->features.hbs.lbafee) {
5576763c05dfSNaveen Nagar                 ns->id_ns.nlbaf = MIN(ns->id_ns.nlbaf, 15);
5577763c05dfSNaveen Nagar             }
5578763c05dfSNaveen Nagar         }
5579763c05dfSNaveen Nagar 
5580763c05dfSNaveen Nagar         return status;
558188eea45cSKlaus Jensen     case NVME_COMMAND_SET_PROFILE:
558288eea45cSKlaus Jensen         if (dw11 & 0x1ff) {
558388eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_iocsci(dw11 & 0x1ff);
558488eea45cSKlaus Jensen             return NVME_CMD_SET_CMB_REJECTED | NVME_DNR;
558588eea45cSKlaus Jensen         }
558688eea45cSKlaus Jensen         break;
558788eea45cSKlaus Jensen     default:
558888eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
558988eea45cSKlaus Jensen     }
559088eea45cSKlaus Jensen     return NVME_SUCCESS;
559188eea45cSKlaus Jensen }
559288eea45cSKlaus Jensen 
559388eea45cSKlaus Jensen static uint16_t nvme_aer(NvmeCtrl *n, NvmeRequest *req)
559488eea45cSKlaus Jensen {
559588eea45cSKlaus Jensen     trace_pci_nvme_aer(nvme_cid(req));
559688eea45cSKlaus Jensen 
559788eea45cSKlaus Jensen     if (n->outstanding_aers > n->params.aerl) {
559888eea45cSKlaus Jensen         trace_pci_nvme_aer_aerl_exceeded();
559988eea45cSKlaus Jensen         return NVME_AER_LIMIT_EXCEEDED;
560088eea45cSKlaus Jensen     }
560188eea45cSKlaus Jensen 
560288eea45cSKlaus Jensen     n->aer_reqs[n->outstanding_aers] = req;
560388eea45cSKlaus Jensen     n->outstanding_aers++;
560488eea45cSKlaus Jensen 
560588eea45cSKlaus Jensen     if (!QTAILQ_EMPTY(&n->aer_queue)) {
560688eea45cSKlaus Jensen         nvme_process_aers(n);
560788eea45cSKlaus Jensen     }
560888eea45cSKlaus Jensen 
560988eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
561088eea45cSKlaus Jensen }
561188eea45cSKlaus Jensen 
561288eea45cSKlaus Jensen static void nvme_update_dmrsl(NvmeCtrl *n)
561388eea45cSKlaus Jensen {
561488eea45cSKlaus Jensen     int nsid;
561588eea45cSKlaus Jensen 
561688eea45cSKlaus Jensen     for (nsid = 1; nsid <= NVME_MAX_NAMESPACES; nsid++) {
561788eea45cSKlaus Jensen         NvmeNamespace *ns = nvme_ns(n, nsid);
561888eea45cSKlaus Jensen         if (!ns) {
561988eea45cSKlaus Jensen             continue;
562088eea45cSKlaus Jensen         }
562188eea45cSKlaus Jensen 
562288eea45cSKlaus Jensen         n->dmrsl = MIN_NON_ZERO(n->dmrsl,
562388eea45cSKlaus Jensen                                 BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
562488eea45cSKlaus Jensen     }
562588eea45cSKlaus Jensen }
562688eea45cSKlaus Jensen 
562788eea45cSKlaus Jensen static void nvme_select_iocs_ns(NvmeCtrl *n, NvmeNamespace *ns)
562888eea45cSKlaus Jensen {
562949e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
563049e03457SKlaus Jensen 
563188eea45cSKlaus Jensen     ns->iocs = nvme_cse_iocs_none;
563288eea45cSKlaus Jensen     switch (ns->csi) {
563388eea45cSKlaus Jensen     case NVME_CSI_NVM:
563449e03457SKlaus Jensen         if (NVME_CC_CSS(cc) != NVME_CC_CSS_ADMIN_ONLY) {
563588eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
563688eea45cSKlaus Jensen         }
563788eea45cSKlaus Jensen         break;
563888eea45cSKlaus Jensen     case NVME_CSI_ZONED:
563949e03457SKlaus Jensen         if (NVME_CC_CSS(cc) == NVME_CC_CSS_CSI) {
564088eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_zoned;
564149e03457SKlaus Jensen         } else if (NVME_CC_CSS(cc) == NVME_CC_CSS_NVM) {
564288eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
564388eea45cSKlaus Jensen         }
564488eea45cSKlaus Jensen         break;
564588eea45cSKlaus Jensen     }
564688eea45cSKlaus Jensen }
564788eea45cSKlaus Jensen 
564888eea45cSKlaus Jensen static uint16_t nvme_ns_attachment(NvmeCtrl *n, NvmeRequest *req)
564988eea45cSKlaus Jensen {
565088eea45cSKlaus Jensen     NvmeNamespace *ns;
565188eea45cSKlaus Jensen     NvmeCtrl *ctrl;
565288eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
565388eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
565488eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
565507a3dfa7SNaveen Nagar     uint8_t sel = dw10 & 0xf;
565688eea45cSKlaus Jensen     uint16_t *nr_ids = &list[0];
565788eea45cSKlaus Jensen     uint16_t *ids = &list[1];
565888eea45cSKlaus Jensen     uint16_t ret;
565988eea45cSKlaus Jensen     int i;
566088eea45cSKlaus Jensen 
566188eea45cSKlaus Jensen     trace_pci_nvme_ns_attachment(nvme_cid(req), dw10 & 0xf);
566288eea45cSKlaus Jensen 
566388eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid)) {
566488eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
566588eea45cSKlaus Jensen     }
566688eea45cSKlaus Jensen 
566788eea45cSKlaus Jensen     ns = nvme_subsys_ns(n->subsys, nsid);
566888eea45cSKlaus Jensen     if (!ns) {
566988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
567088eea45cSKlaus Jensen     }
567188eea45cSKlaus Jensen 
567288eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)list, 4096, req);
567388eea45cSKlaus Jensen     if (ret) {
567488eea45cSKlaus Jensen         return ret;
567588eea45cSKlaus Jensen     }
567688eea45cSKlaus Jensen 
567788eea45cSKlaus Jensen     if (!*nr_ids) {
567888eea45cSKlaus Jensen         return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
567988eea45cSKlaus Jensen     }
568088eea45cSKlaus Jensen 
568188eea45cSKlaus Jensen     *nr_ids = MIN(*nr_ids, NVME_CONTROLLER_LIST_SIZE - 1);
568288eea45cSKlaus Jensen     for (i = 0; i < *nr_ids; i++) {
568388eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, ids[i]);
568488eea45cSKlaus Jensen         if (!ctrl) {
568588eea45cSKlaus Jensen             return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
568688eea45cSKlaus Jensen         }
568788eea45cSKlaus Jensen 
568807a3dfa7SNaveen Nagar         switch (sel) {
568907a3dfa7SNaveen Nagar         case NVME_NS_ATTACHMENT_ATTACH:
569088eea45cSKlaus Jensen             if (nvme_ns(ctrl, nsid)) {
569188eea45cSKlaus Jensen                 return NVME_NS_ALREADY_ATTACHED | NVME_DNR;
569288eea45cSKlaus Jensen             }
569388eea45cSKlaus Jensen 
569488eea45cSKlaus Jensen             if (ns->attached && !ns->params.shared) {
569588eea45cSKlaus Jensen                 return NVME_NS_PRIVATE | NVME_DNR;
569688eea45cSKlaus Jensen             }
569788eea45cSKlaus Jensen 
569888eea45cSKlaus Jensen             nvme_attach_ns(ctrl, ns);
569988eea45cSKlaus Jensen             nvme_select_iocs_ns(ctrl, ns);
570007a3dfa7SNaveen Nagar 
570107a3dfa7SNaveen Nagar             break;
570207a3dfa7SNaveen Nagar 
570307a3dfa7SNaveen Nagar         case NVME_NS_ATTACHMENT_DETACH:
570488eea45cSKlaus Jensen             if (!nvme_ns(ctrl, nsid)) {
570588eea45cSKlaus Jensen                 return NVME_NS_NOT_ATTACHED | NVME_DNR;
570688eea45cSKlaus Jensen             }
570788eea45cSKlaus Jensen 
570888eea45cSKlaus Jensen             ctrl->namespaces[nsid] = NULL;
570988eea45cSKlaus Jensen             ns->attached--;
571088eea45cSKlaus Jensen 
571188eea45cSKlaus Jensen             nvme_update_dmrsl(ctrl);
571207a3dfa7SNaveen Nagar 
571307a3dfa7SNaveen Nagar             break;
571407a3dfa7SNaveen Nagar 
571507a3dfa7SNaveen Nagar         default:
571607a3dfa7SNaveen Nagar             return NVME_INVALID_FIELD | NVME_DNR;
571788eea45cSKlaus Jensen         }
571888eea45cSKlaus Jensen 
571988eea45cSKlaus Jensen         /*
572088eea45cSKlaus Jensen          * Add namespace id to the changed namespace id list for event clearing
572188eea45cSKlaus Jensen          * via Get Log Page command.
572288eea45cSKlaus Jensen          */
572388eea45cSKlaus Jensen         if (!test_and_set_bit(nsid, ctrl->changed_nsids)) {
572488eea45cSKlaus Jensen             nvme_enqueue_event(ctrl, NVME_AER_TYPE_NOTICE,
572588eea45cSKlaus Jensen                                NVME_AER_INFO_NOTICE_NS_ATTR_CHANGED,
572688eea45cSKlaus Jensen                                NVME_LOG_CHANGED_NSLIST);
572788eea45cSKlaus Jensen         }
572888eea45cSKlaus Jensen     }
572988eea45cSKlaus Jensen 
573088eea45cSKlaus Jensen     return NVME_SUCCESS;
573188eea45cSKlaus Jensen }
573288eea45cSKlaus Jensen 
57333bcf26d3SKlaus Jensen typedef struct NvmeFormatAIOCB {
57343bcf26d3SKlaus Jensen     BlockAIOCB common;
57353bcf26d3SKlaus Jensen     BlockAIOCB *aiocb;
57363bcf26d3SKlaus Jensen     NvmeRequest *req;
57373bcf26d3SKlaus Jensen     int ret;
573888eea45cSKlaus Jensen 
57393bcf26d3SKlaus Jensen     NvmeNamespace *ns;
57403bcf26d3SKlaus Jensen     uint32_t nsid;
57413bcf26d3SKlaus Jensen     bool broadcast;
57423bcf26d3SKlaus Jensen     int64_t offset;
5743a6de6ed5SKlaus Jensen 
5744a6de6ed5SKlaus Jensen     uint8_t lbaf;
5745a6de6ed5SKlaus Jensen     uint8_t mset;
5746a6de6ed5SKlaus Jensen     uint8_t pi;
5747a6de6ed5SKlaus Jensen     uint8_t pil;
57483bcf26d3SKlaus Jensen } NvmeFormatAIOCB;
57493bcf26d3SKlaus Jensen 
57503bcf26d3SKlaus Jensen static void nvme_format_cancel(BlockAIOCB *aiocb)
57513bcf26d3SKlaus Jensen {
57523bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = container_of(aiocb, NvmeFormatAIOCB, common);
57533bcf26d3SKlaus Jensen 
5754433c71e4SKlaus Jensen     iocb->ret = -ECANCELED;
5755433c71e4SKlaus Jensen 
57563bcf26d3SKlaus Jensen     if (iocb->aiocb) {
57573bcf26d3SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
5758433c71e4SKlaus Jensen         iocb->aiocb = NULL;
57593bcf26d3SKlaus Jensen     }
57603bcf26d3SKlaus Jensen }
57613bcf26d3SKlaus Jensen 
57623bcf26d3SKlaus Jensen static const AIOCBInfo nvme_format_aiocb_info = {
57633bcf26d3SKlaus Jensen     .aiocb_size = sizeof(NvmeFormatAIOCB),
57643bcf26d3SKlaus Jensen     .cancel_async = nvme_format_cancel,
57653bcf26d3SKlaus Jensen     .get_aio_context = nvme_get_aio_context,
57663bcf26d3SKlaus Jensen };
57673bcf26d3SKlaus Jensen 
5768a6de6ed5SKlaus Jensen static void nvme_format_set(NvmeNamespace *ns, uint8_t lbaf, uint8_t mset,
5769a6de6ed5SKlaus Jensen                             uint8_t pi, uint8_t pil)
57703bcf26d3SKlaus Jensen {
5771763c05dfSNaveen Nagar     uint8_t lbafl = lbaf & 0xf;
5772763c05dfSNaveen Nagar     uint8_t lbafu = lbaf >> 4;
5773763c05dfSNaveen Nagar 
57743bcf26d3SKlaus Jensen     trace_pci_nvme_format_set(ns->params.nsid, lbaf, mset, pi, pil);
57753bcf26d3SKlaus Jensen 
57763bcf26d3SKlaus Jensen     ns->id_ns.dps = (pil << 3) | pi;
5777763c05dfSNaveen Nagar     ns->id_ns.flbas = (lbafu << 5) | (mset << 4) | lbafl;
57783bcf26d3SKlaus Jensen 
57793bcf26d3SKlaus Jensen     nvme_ns_init_format(ns);
57803bcf26d3SKlaus Jensen }
57813bcf26d3SKlaus Jensen 
5782433c71e4SKlaus Jensen static void nvme_do_format(NvmeFormatAIOCB *iocb);
5783433c71e4SKlaus Jensen 
57843bcf26d3SKlaus Jensen static void nvme_format_ns_cb(void *opaque, int ret)
57853bcf26d3SKlaus Jensen {
57863bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = opaque;
57873bcf26d3SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
57883bcf26d3SKlaus Jensen     int bytes;
57893bcf26d3SKlaus Jensen 
5790433c71e4SKlaus Jensen     if (iocb->ret < 0) {
5791433c71e4SKlaus Jensen         goto done;
5792433c71e4SKlaus Jensen     } else if (ret < 0) {
57933bcf26d3SKlaus Jensen         iocb->ret = ret;
57943bcf26d3SKlaus Jensen         goto done;
57953bcf26d3SKlaus Jensen     }
57963bcf26d3SKlaus Jensen 
57973bcf26d3SKlaus Jensen     assert(ns);
57983bcf26d3SKlaus Jensen 
57993bcf26d3SKlaus Jensen     if (iocb->offset < ns->size) {
58003bcf26d3SKlaus Jensen         bytes = MIN(BDRV_REQUEST_MAX_BYTES, ns->size - iocb->offset);
58013bcf26d3SKlaus Jensen 
58023bcf26d3SKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, iocb->offset,
58033bcf26d3SKlaus Jensen                                             bytes, BDRV_REQ_MAY_UNMAP,
58043bcf26d3SKlaus Jensen                                             nvme_format_ns_cb, iocb);
58053bcf26d3SKlaus Jensen 
58063bcf26d3SKlaus Jensen         iocb->offset += bytes;
58073bcf26d3SKlaus Jensen         return;
58083bcf26d3SKlaus Jensen     }
58093bcf26d3SKlaus Jensen 
5810a6de6ed5SKlaus Jensen     nvme_format_set(ns, iocb->lbaf, iocb->mset, iocb->pi, iocb->pil);
58113bcf26d3SKlaus Jensen     ns->status = 0x0;
58123bcf26d3SKlaus Jensen     iocb->ns = NULL;
58133bcf26d3SKlaus Jensen     iocb->offset = 0;
58143bcf26d3SKlaus Jensen 
58153bcf26d3SKlaus Jensen done:
5816433c71e4SKlaus Jensen     nvme_do_format(iocb);
58173bcf26d3SKlaus Jensen }
58183bcf26d3SKlaus Jensen 
58193bcf26d3SKlaus Jensen static uint16_t nvme_format_check(NvmeNamespace *ns, uint8_t lbaf, uint8_t pi)
58203bcf26d3SKlaus Jensen {
582188eea45cSKlaus Jensen     if (ns->params.zoned) {
582288eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
582388eea45cSKlaus Jensen     }
582488eea45cSKlaus Jensen 
582588eea45cSKlaus Jensen     if (lbaf > ns->id_ns.nlbaf) {
582688eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
582788eea45cSKlaus Jensen     }
582888eea45cSKlaus Jensen 
5829ac0b34c5SKlaus Jensen     if (pi && (ns->id_ns.lbaf[lbaf].ms < nvme_pi_tuple_size(ns))) {
583088eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
583188eea45cSKlaus Jensen     }
583288eea45cSKlaus Jensen 
583388eea45cSKlaus Jensen     if (pi && pi > NVME_ID_NS_DPS_TYPE_3) {
583488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
583588eea45cSKlaus Jensen     }
583688eea45cSKlaus Jensen 
583788eea45cSKlaus Jensen     return NVME_SUCCESS;
583888eea45cSKlaus Jensen }
583988eea45cSKlaus Jensen 
5840433c71e4SKlaus Jensen static void nvme_do_format(NvmeFormatAIOCB *iocb)
584188eea45cSKlaus Jensen {
58423bcf26d3SKlaus Jensen     NvmeRequest *req = iocb->req;
58433bcf26d3SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
584444219b60SNaveen Nagar     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
584544219b60SNaveen Nagar     uint8_t lbaf = dw10 & 0xf;
584644219b60SNaveen Nagar     uint8_t pi = (dw10 >> 5) & 0x7;
584788eea45cSKlaus Jensen     uint16_t status;
584888eea45cSKlaus Jensen     int i;
584988eea45cSKlaus Jensen 
58503bcf26d3SKlaus Jensen     if (iocb->ret < 0) {
58513bcf26d3SKlaus Jensen         goto done;
585288eea45cSKlaus Jensen     }
585388eea45cSKlaus Jensen 
58543bcf26d3SKlaus Jensen     if (iocb->broadcast) {
58553bcf26d3SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
58563bcf26d3SKlaus Jensen             iocb->ns = nvme_ns(n, i);
58573bcf26d3SKlaus Jensen             if (iocb->ns) {
58583bcf26d3SKlaus Jensen                 iocb->nsid = i;
585988eea45cSKlaus Jensen                 break;
586088eea45cSKlaus Jensen             }
586188eea45cSKlaus Jensen         }
586288eea45cSKlaus Jensen     }
586388eea45cSKlaus Jensen 
58643bcf26d3SKlaus Jensen     if (!iocb->ns) {
58653bcf26d3SKlaus Jensen         goto done;
586688eea45cSKlaus Jensen     }
586788eea45cSKlaus Jensen 
586844219b60SNaveen Nagar     status = nvme_format_check(iocb->ns, lbaf, pi);
58693bcf26d3SKlaus Jensen     if (status) {
58703bcf26d3SKlaus Jensen         req->status = status;
58713bcf26d3SKlaus Jensen         goto done;
58723bcf26d3SKlaus Jensen     }
58733bcf26d3SKlaus Jensen 
58743bcf26d3SKlaus Jensen     iocb->ns->status = NVME_FORMAT_IN_PROGRESS;
58753bcf26d3SKlaus Jensen     nvme_format_ns_cb(iocb, 0);
58763bcf26d3SKlaus Jensen     return;
58773bcf26d3SKlaus Jensen 
58783bcf26d3SKlaus Jensen done:
58793bcf26d3SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
58803bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
58813bcf26d3SKlaus Jensen }
58823bcf26d3SKlaus Jensen 
58833bcf26d3SKlaus Jensen static uint16_t nvme_format(NvmeCtrl *n, NvmeRequest *req)
58843bcf26d3SKlaus Jensen {
58853bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb;
58863bcf26d3SKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
5887a6de6ed5SKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
5888a6de6ed5SKlaus Jensen     uint8_t lbaf = dw10 & 0xf;
5889a6de6ed5SKlaus Jensen     uint8_t mset = (dw10 >> 4) & 0x1;
5890a6de6ed5SKlaus Jensen     uint8_t pi = (dw10 >> 5) & 0x7;
5891a6de6ed5SKlaus Jensen     uint8_t pil = (dw10 >> 8) & 0x1;
5892763c05dfSNaveen Nagar     uint8_t lbafu = (dw10 >> 12) & 0x3;
58933bcf26d3SKlaus Jensen     uint16_t status;
58943bcf26d3SKlaus Jensen 
58953bcf26d3SKlaus Jensen     iocb = qemu_aio_get(&nvme_format_aiocb_info, NULL, nvme_misc_cb, req);
58963bcf26d3SKlaus Jensen 
58973bcf26d3SKlaus Jensen     iocb->req = req;
58983bcf26d3SKlaus Jensen     iocb->ret = 0;
58993bcf26d3SKlaus Jensen     iocb->ns = NULL;
59003bcf26d3SKlaus Jensen     iocb->nsid = 0;
5901a6de6ed5SKlaus Jensen     iocb->lbaf = lbaf;
5902a6de6ed5SKlaus Jensen     iocb->mset = mset;
5903a6de6ed5SKlaus Jensen     iocb->pi = pi;
5904a6de6ed5SKlaus Jensen     iocb->pil = pil;
59053bcf26d3SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
59063bcf26d3SKlaus Jensen     iocb->offset = 0;
59073bcf26d3SKlaus Jensen 
5908763c05dfSNaveen Nagar     if (n->features.hbs.lbafee) {
5909763c05dfSNaveen Nagar         iocb->lbaf |= lbafu << 4;
5910763c05dfSNaveen Nagar     }
5911763c05dfSNaveen Nagar 
59123bcf26d3SKlaus Jensen     if (!iocb->broadcast) {
59133bcf26d3SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
59143bcf26d3SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
59153bcf26d3SKlaus Jensen             goto out;
59163bcf26d3SKlaus Jensen         }
59173bcf26d3SKlaus Jensen 
59183bcf26d3SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
59193bcf26d3SKlaus Jensen         if (!iocb->ns) {
59203bcf26d3SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
59213bcf26d3SKlaus Jensen             goto out;
59223bcf26d3SKlaus Jensen         }
59233bcf26d3SKlaus Jensen     }
59243bcf26d3SKlaus Jensen 
59253bcf26d3SKlaus Jensen     req->aiocb = &iocb->common;
5926433c71e4SKlaus Jensen     nvme_do_format(iocb);
59273bcf26d3SKlaus Jensen 
59283bcf26d3SKlaus Jensen     return NVME_NO_COMPLETE;
59293bcf26d3SKlaus Jensen 
59303bcf26d3SKlaus Jensen out:
59313bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
5932433c71e4SKlaus Jensen 
59333bcf26d3SKlaus Jensen     return status;
593488eea45cSKlaus Jensen }
593588eea45cSKlaus Jensen 
593611871f53SŁukasz Gieryk static void nvme_get_virt_res_num(NvmeCtrl *n, uint8_t rt, int *num_total,
593711871f53SŁukasz Gieryk                                   int *num_prim, int *num_sec)
593811871f53SŁukasz Gieryk {
593911871f53SŁukasz Gieryk     *num_total = le32_to_cpu(rt ?
594011871f53SŁukasz Gieryk                              n->pri_ctrl_cap.vifrt : n->pri_ctrl_cap.vqfrt);
594111871f53SŁukasz Gieryk     *num_prim = le16_to_cpu(rt ?
594211871f53SŁukasz Gieryk                             n->pri_ctrl_cap.virfap : n->pri_ctrl_cap.vqrfap);
594311871f53SŁukasz Gieryk     *num_sec = le16_to_cpu(rt ? n->pri_ctrl_cap.virfa : n->pri_ctrl_cap.vqrfa);
594411871f53SŁukasz Gieryk }
594511871f53SŁukasz Gieryk 
594611871f53SŁukasz Gieryk static uint16_t nvme_assign_virt_res_to_prim(NvmeCtrl *n, NvmeRequest *req,
594711871f53SŁukasz Gieryk                                              uint16_t cntlid, uint8_t rt,
594811871f53SŁukasz Gieryk                                              int nr)
594911871f53SŁukasz Gieryk {
595011871f53SŁukasz Gieryk     int num_total, num_prim, num_sec;
595111871f53SŁukasz Gieryk 
595211871f53SŁukasz Gieryk     if (cntlid != n->cntlid) {
595311871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
595411871f53SŁukasz Gieryk     }
595511871f53SŁukasz Gieryk 
595611871f53SŁukasz Gieryk     nvme_get_virt_res_num(n, rt, &num_total, &num_prim, &num_sec);
595711871f53SŁukasz Gieryk 
595811871f53SŁukasz Gieryk     if (nr > num_total) {
595911871f53SŁukasz Gieryk         return NVME_INVALID_NUM_RESOURCES | NVME_DNR;
596011871f53SŁukasz Gieryk     }
596111871f53SŁukasz Gieryk 
596211871f53SŁukasz Gieryk     if (nr > num_total - num_sec) {
596311871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
596411871f53SŁukasz Gieryk     }
596511871f53SŁukasz Gieryk 
596611871f53SŁukasz Gieryk     if (rt) {
596711871f53SŁukasz Gieryk         n->next_pri_ctrl_cap.virfap = cpu_to_le16(nr);
596811871f53SŁukasz Gieryk     } else {
596911871f53SŁukasz Gieryk         n->next_pri_ctrl_cap.vqrfap = cpu_to_le16(nr);
597011871f53SŁukasz Gieryk     }
597111871f53SŁukasz Gieryk 
597211871f53SŁukasz Gieryk     req->cqe.result = cpu_to_le32(nr);
597311871f53SŁukasz Gieryk     return req->status;
597411871f53SŁukasz Gieryk }
597511871f53SŁukasz Gieryk 
597611871f53SŁukasz Gieryk static void nvme_update_virt_res(NvmeCtrl *n, NvmeSecCtrlEntry *sctrl,
597711871f53SŁukasz Gieryk                                  uint8_t rt, int nr)
597811871f53SŁukasz Gieryk {
597911871f53SŁukasz Gieryk     int prev_nr, prev_total;
598011871f53SŁukasz Gieryk 
598111871f53SŁukasz Gieryk     if (rt) {
598211871f53SŁukasz Gieryk         prev_nr = le16_to_cpu(sctrl->nvi);
598311871f53SŁukasz Gieryk         prev_total = le32_to_cpu(n->pri_ctrl_cap.virfa);
598411871f53SŁukasz Gieryk         sctrl->nvi = cpu_to_le16(nr);
598511871f53SŁukasz Gieryk         n->pri_ctrl_cap.virfa = cpu_to_le32(prev_total + nr - prev_nr);
598611871f53SŁukasz Gieryk     } else {
598711871f53SŁukasz Gieryk         prev_nr = le16_to_cpu(sctrl->nvq);
598811871f53SŁukasz Gieryk         prev_total = le32_to_cpu(n->pri_ctrl_cap.vqrfa);
598911871f53SŁukasz Gieryk         sctrl->nvq = cpu_to_le16(nr);
599011871f53SŁukasz Gieryk         n->pri_ctrl_cap.vqrfa = cpu_to_le32(prev_total + nr - prev_nr);
599111871f53SŁukasz Gieryk     }
599211871f53SŁukasz Gieryk }
599311871f53SŁukasz Gieryk 
599411871f53SŁukasz Gieryk static uint16_t nvme_assign_virt_res_to_sec(NvmeCtrl *n, NvmeRequest *req,
599511871f53SŁukasz Gieryk                                             uint16_t cntlid, uint8_t rt, int nr)
599611871f53SŁukasz Gieryk {
599711871f53SŁukasz Gieryk     int num_total, num_prim, num_sec, num_free, diff, limit;
599811871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
599911871f53SŁukasz Gieryk 
600011871f53SŁukasz Gieryk     sctrl = nvme_sctrl_for_cntlid(n, cntlid);
600111871f53SŁukasz Gieryk     if (!sctrl) {
600211871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
600311871f53SŁukasz Gieryk     }
600411871f53SŁukasz Gieryk 
600511871f53SŁukasz Gieryk     if (sctrl->scs) {
600611871f53SŁukasz Gieryk         return NVME_INVALID_SEC_CTRL_STATE | NVME_DNR;
600711871f53SŁukasz Gieryk     }
600811871f53SŁukasz Gieryk 
600911871f53SŁukasz Gieryk     limit = le16_to_cpu(rt ? n->pri_ctrl_cap.vifrsm : n->pri_ctrl_cap.vqfrsm);
601011871f53SŁukasz Gieryk     if (nr > limit) {
601111871f53SŁukasz Gieryk         return NVME_INVALID_NUM_RESOURCES | NVME_DNR;
601211871f53SŁukasz Gieryk     }
601311871f53SŁukasz Gieryk 
601411871f53SŁukasz Gieryk     nvme_get_virt_res_num(n, rt, &num_total, &num_prim, &num_sec);
601511871f53SŁukasz Gieryk     num_free = num_total - num_prim - num_sec;
601611871f53SŁukasz Gieryk     diff = nr - le16_to_cpu(rt ? sctrl->nvi : sctrl->nvq);
601711871f53SŁukasz Gieryk 
601811871f53SŁukasz Gieryk     if (diff > num_free) {
601911871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
602011871f53SŁukasz Gieryk     }
602111871f53SŁukasz Gieryk 
602211871f53SŁukasz Gieryk     nvme_update_virt_res(n, sctrl, rt, nr);
602311871f53SŁukasz Gieryk     req->cqe.result = cpu_to_le32(nr);
602411871f53SŁukasz Gieryk 
602511871f53SŁukasz Gieryk     return req->status;
602611871f53SŁukasz Gieryk }
602711871f53SŁukasz Gieryk 
602811871f53SŁukasz Gieryk static uint16_t nvme_virt_set_state(NvmeCtrl *n, uint16_t cntlid, bool online)
602911871f53SŁukasz Gieryk {
603048b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
603111871f53SŁukasz Gieryk     NvmeCtrl *sn = NULL;
603211871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
603311871f53SŁukasz Gieryk     int vf_index;
603411871f53SŁukasz Gieryk 
603511871f53SŁukasz Gieryk     sctrl = nvme_sctrl_for_cntlid(n, cntlid);
603611871f53SŁukasz Gieryk     if (!sctrl) {
603711871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
603811871f53SŁukasz Gieryk     }
603911871f53SŁukasz Gieryk 
604048b32c28SKlaus Jensen     if (!pci_is_vf(pci)) {
604111871f53SŁukasz Gieryk         vf_index = le16_to_cpu(sctrl->vfn) - 1;
604248b32c28SKlaus Jensen         sn = NVME(pcie_sriov_get_vf_at_index(pci, vf_index));
604311871f53SŁukasz Gieryk     }
604411871f53SŁukasz Gieryk 
604511871f53SŁukasz Gieryk     if (online) {
604611871f53SŁukasz Gieryk         if (!sctrl->nvi || (le16_to_cpu(sctrl->nvq) < 2) || !sn) {
604711871f53SŁukasz Gieryk             return NVME_INVALID_SEC_CTRL_STATE | NVME_DNR;
604811871f53SŁukasz Gieryk         }
604911871f53SŁukasz Gieryk 
605011871f53SŁukasz Gieryk         if (!sctrl->scs) {
605111871f53SŁukasz Gieryk             sctrl->scs = 0x1;
605211871f53SŁukasz Gieryk             nvme_ctrl_reset(sn, NVME_RESET_FUNCTION);
605311871f53SŁukasz Gieryk         }
605411871f53SŁukasz Gieryk     } else {
605511871f53SŁukasz Gieryk         nvme_update_virt_res(n, sctrl, NVME_VIRT_RES_INTERRUPT, 0);
605611871f53SŁukasz Gieryk         nvme_update_virt_res(n, sctrl, NVME_VIRT_RES_QUEUE, 0);
605711871f53SŁukasz Gieryk 
605811871f53SŁukasz Gieryk         if (sctrl->scs) {
605911871f53SŁukasz Gieryk             sctrl->scs = 0x0;
606011871f53SŁukasz Gieryk             if (sn) {
606111871f53SŁukasz Gieryk                 nvme_ctrl_reset(sn, NVME_RESET_FUNCTION);
606211871f53SŁukasz Gieryk             }
606311871f53SŁukasz Gieryk         }
606411871f53SŁukasz Gieryk     }
606511871f53SŁukasz Gieryk 
606611871f53SŁukasz Gieryk     return NVME_SUCCESS;
606711871f53SŁukasz Gieryk }
606811871f53SŁukasz Gieryk 
606911871f53SŁukasz Gieryk static uint16_t nvme_virt_mngmt(NvmeCtrl *n, NvmeRequest *req)
607011871f53SŁukasz Gieryk {
607111871f53SŁukasz Gieryk     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
607211871f53SŁukasz Gieryk     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
607311871f53SŁukasz Gieryk     uint8_t act = dw10 & 0xf;
607411871f53SŁukasz Gieryk     uint8_t rt = (dw10 >> 8) & 0x7;
607511871f53SŁukasz Gieryk     uint16_t cntlid = (dw10 >> 16) & 0xffff;
607611871f53SŁukasz Gieryk     int nr = dw11 & 0xffff;
607711871f53SŁukasz Gieryk 
607811871f53SŁukasz Gieryk     trace_pci_nvme_virt_mngmt(nvme_cid(req), act, cntlid, rt ? "VI" : "VQ", nr);
607911871f53SŁukasz Gieryk 
608011871f53SŁukasz Gieryk     if (rt != NVME_VIRT_RES_QUEUE && rt != NVME_VIRT_RES_INTERRUPT) {
608111871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
608211871f53SŁukasz Gieryk     }
608311871f53SŁukasz Gieryk 
608411871f53SŁukasz Gieryk     switch (act) {
608511871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_ASSIGN:
608611871f53SŁukasz Gieryk         return nvme_assign_virt_res_to_sec(n, req, cntlid, rt, nr);
608711871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_PRM_ALLOC:
608811871f53SŁukasz Gieryk         return nvme_assign_virt_res_to_prim(n, req, cntlid, rt, nr);
608911871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_ONLINE:
609011871f53SŁukasz Gieryk         return nvme_virt_set_state(n, cntlid, true);
609111871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_OFFLINE:
609211871f53SŁukasz Gieryk         return nvme_virt_set_state(n, cntlid, false);
609311871f53SŁukasz Gieryk     default:
609411871f53SŁukasz Gieryk         return NVME_INVALID_FIELD | NVME_DNR;
609511871f53SŁukasz Gieryk     }
609611871f53SŁukasz Gieryk }
609711871f53SŁukasz Gieryk 
60983f7fe8deSJinhao Fan static uint16_t nvme_dbbuf_config(NvmeCtrl *n, const NvmeRequest *req)
60993f7fe8deSJinhao Fan {
610048b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
61013f7fe8deSJinhao Fan     uint64_t dbs_addr = le64_to_cpu(req->cmd.dptr.prp1);
61023f7fe8deSJinhao Fan     uint64_t eis_addr = le64_to_cpu(req->cmd.dptr.prp2);
61033f7fe8deSJinhao Fan     int i;
61043f7fe8deSJinhao Fan 
61053f7fe8deSJinhao Fan     /* Address should be page aligned */
61063f7fe8deSJinhao Fan     if (dbs_addr & (n->page_size - 1) || eis_addr & (n->page_size - 1)) {
61073f7fe8deSJinhao Fan         return NVME_INVALID_FIELD | NVME_DNR;
61083f7fe8deSJinhao Fan     }
61093f7fe8deSJinhao Fan 
61103f7fe8deSJinhao Fan     /* Save shadow buffer base addr for use during queue creation */
61113f7fe8deSJinhao Fan     n->dbbuf_dbs = dbs_addr;
61123f7fe8deSJinhao Fan     n->dbbuf_eis = eis_addr;
61133f7fe8deSJinhao Fan     n->dbbuf_enabled = true;
61143f7fe8deSJinhao Fan 
61153f7fe8deSJinhao Fan     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
61163f7fe8deSJinhao Fan         NvmeSQueue *sq = n->sq[i];
61173f7fe8deSJinhao Fan         NvmeCQueue *cq = n->cq[i];
61183f7fe8deSJinhao Fan 
61193f7fe8deSJinhao Fan         if (sq) {
61203f7fe8deSJinhao Fan             /*
61213f7fe8deSJinhao Fan              * CAP.DSTRD is 0, so offset of ith sq db_addr is (i<<3)
61223f7fe8deSJinhao Fan              * nvme_process_db() uses this hard-coded way to calculate
61233f7fe8deSJinhao Fan              * doorbell offsets. Be consistent with that here.
61243f7fe8deSJinhao Fan              */
61253f7fe8deSJinhao Fan             sq->db_addr = dbs_addr + (i << 3);
61263f7fe8deSJinhao Fan             sq->ei_addr = eis_addr + (i << 3);
612748b32c28SKlaus Jensen             pci_dma_write(pci, sq->db_addr, &sq->tail, sizeof(sq->tail));
61282e53b0b4SJinhao Fan 
61292e53b0b4SJinhao Fan             if (n->params.ioeventfd && sq->sqid != 0) {
61302e53b0b4SJinhao Fan                 if (!nvme_init_sq_ioeventfd(sq)) {
61312e53b0b4SJinhao Fan                     sq->ioeventfd_enabled = true;
61322e53b0b4SJinhao Fan                 }
61332e53b0b4SJinhao Fan             }
61343f7fe8deSJinhao Fan         }
61353f7fe8deSJinhao Fan 
61363f7fe8deSJinhao Fan         if (cq) {
61373f7fe8deSJinhao Fan             /* CAP.DSTRD is 0, so offset of ith cq db_addr is (i<<3)+(1<<2) */
61383f7fe8deSJinhao Fan             cq->db_addr = dbs_addr + (i << 3) + (1 << 2);
61393f7fe8deSJinhao Fan             cq->ei_addr = eis_addr + (i << 3) + (1 << 2);
614048b32c28SKlaus Jensen             pci_dma_write(pci, cq->db_addr, &cq->head, sizeof(cq->head));
61412e53b0b4SJinhao Fan 
61422e53b0b4SJinhao Fan             if (n->params.ioeventfd && cq->cqid != 0) {
61432e53b0b4SJinhao Fan                 if (!nvme_init_cq_ioeventfd(cq)) {
61442e53b0b4SJinhao Fan                     cq->ioeventfd_enabled = true;
61452e53b0b4SJinhao Fan                 }
61462e53b0b4SJinhao Fan             }
61473f7fe8deSJinhao Fan         }
61483f7fe8deSJinhao Fan     }
61493f7fe8deSJinhao Fan 
6150387350d5SJinhao Fan     trace_pci_nvme_dbbuf_config(dbs_addr, eis_addr);
6151387350d5SJinhao Fan 
61523f7fe8deSJinhao Fan     return NVME_SUCCESS;
61533f7fe8deSJinhao Fan }
61543f7fe8deSJinhao Fan 
6155*e181d3daSGollu Appalanaidu static uint16_t nvme_directive_send(NvmeCtrl *n, NvmeRequest *req)
6156*e181d3daSGollu Appalanaidu {
6157*e181d3daSGollu Appalanaidu     return NVME_INVALID_FIELD | NVME_DNR;
6158*e181d3daSGollu Appalanaidu }
6159*e181d3daSGollu Appalanaidu 
6160*e181d3daSGollu Appalanaidu static uint16_t nvme_directive_receive(NvmeCtrl *n, NvmeRequest *req)
6161*e181d3daSGollu Appalanaidu {
6162*e181d3daSGollu Appalanaidu     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
6163*e181d3daSGollu Appalanaidu     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
6164*e181d3daSGollu Appalanaidu     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
6165*e181d3daSGollu Appalanaidu     uint8_t doper, dtype;
6166*e181d3daSGollu Appalanaidu     uint32_t numd, trans_len;
6167*e181d3daSGollu Appalanaidu     NvmeDirectiveIdentify id = {
6168*e181d3daSGollu Appalanaidu         .supported = 1 << NVME_DIRECTIVE_IDENTIFY,
6169*e181d3daSGollu Appalanaidu         .enabled = 1 << NVME_DIRECTIVE_IDENTIFY,
6170*e181d3daSGollu Appalanaidu     };
6171*e181d3daSGollu Appalanaidu 
6172*e181d3daSGollu Appalanaidu     numd = dw10 + 1;
6173*e181d3daSGollu Appalanaidu     doper = dw11 & 0xff;
6174*e181d3daSGollu Appalanaidu     dtype = (dw11 >> 8) & 0xff;
6175*e181d3daSGollu Appalanaidu 
6176*e181d3daSGollu Appalanaidu     trans_len = MIN(sizeof(NvmeDirectiveIdentify), numd << 2);
6177*e181d3daSGollu Appalanaidu 
6178*e181d3daSGollu Appalanaidu     if (nsid == NVME_NSID_BROADCAST || dtype != NVME_DIRECTIVE_IDENTIFY ||
6179*e181d3daSGollu Appalanaidu         doper != NVME_DIRECTIVE_RETURN_PARAMS) {
6180*e181d3daSGollu Appalanaidu         return NVME_INVALID_FIELD | NVME_DNR;
6181*e181d3daSGollu Appalanaidu     }
6182*e181d3daSGollu Appalanaidu 
6183*e181d3daSGollu Appalanaidu     return nvme_c2h(n, (uint8_t *)&id, trans_len, req);
6184*e181d3daSGollu Appalanaidu }
6185*e181d3daSGollu Appalanaidu 
618688eea45cSKlaus Jensen static uint16_t nvme_admin_cmd(NvmeCtrl *n, NvmeRequest *req)
618788eea45cSKlaus Jensen {
618888eea45cSKlaus Jensen     trace_pci_nvme_admin_cmd(nvme_cid(req), nvme_sqid(req), req->cmd.opcode,
618988eea45cSKlaus Jensen                              nvme_adm_opc_str(req->cmd.opcode));
619088eea45cSKlaus Jensen 
619188eea45cSKlaus Jensen     if (!(nvme_cse_acs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
619288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_admin_opc(req->cmd.opcode);
619388eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
619488eea45cSKlaus Jensen     }
619588eea45cSKlaus Jensen 
619688eea45cSKlaus Jensen     /* SGLs shall not be used for Admin commands in NVMe over PCIe */
619788eea45cSKlaus Jensen     if (NVME_CMD_FLAGS_PSDT(req->cmd.flags) != NVME_PSDT_PRP) {
619888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
619988eea45cSKlaus Jensen     }
620088eea45cSKlaus Jensen 
6201c53a9a91SPankaj Raghav     if (NVME_CMD_FLAGS_FUSE(req->cmd.flags)) {
6202c53a9a91SPankaj Raghav         return NVME_INVALID_FIELD;
6203c53a9a91SPankaj Raghav     }
6204c53a9a91SPankaj Raghav 
620588eea45cSKlaus Jensen     switch (req->cmd.opcode) {
620688eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_SQ:
620788eea45cSKlaus Jensen         return nvme_del_sq(n, req);
620888eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_SQ:
620988eea45cSKlaus Jensen         return nvme_create_sq(n, req);
621088eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_LOG_PAGE:
621188eea45cSKlaus Jensen         return nvme_get_log(n, req);
621288eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_CQ:
621388eea45cSKlaus Jensen         return nvme_del_cq(n, req);
621488eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_CQ:
621588eea45cSKlaus Jensen         return nvme_create_cq(n, req);
621688eea45cSKlaus Jensen     case NVME_ADM_CMD_IDENTIFY:
621788eea45cSKlaus Jensen         return nvme_identify(n, req);
621888eea45cSKlaus Jensen     case NVME_ADM_CMD_ABORT:
621988eea45cSKlaus Jensen         return nvme_abort(n, req);
622088eea45cSKlaus Jensen     case NVME_ADM_CMD_SET_FEATURES:
622188eea45cSKlaus Jensen         return nvme_set_feature(n, req);
622288eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_FEATURES:
622388eea45cSKlaus Jensen         return nvme_get_feature(n, req);
622488eea45cSKlaus Jensen     case NVME_ADM_CMD_ASYNC_EV_REQ:
622588eea45cSKlaus Jensen         return nvme_aer(n, req);
622688eea45cSKlaus Jensen     case NVME_ADM_CMD_NS_ATTACHMENT:
622788eea45cSKlaus Jensen         return nvme_ns_attachment(n, req);
622811871f53SŁukasz Gieryk     case NVME_ADM_CMD_VIRT_MNGMT:
622911871f53SŁukasz Gieryk         return nvme_virt_mngmt(n, req);
62303f7fe8deSJinhao Fan     case NVME_ADM_CMD_DBBUF_CONFIG:
62313f7fe8deSJinhao Fan         return nvme_dbbuf_config(n, req);
623288eea45cSKlaus Jensen     case NVME_ADM_CMD_FORMAT_NVM:
623388eea45cSKlaus Jensen         return nvme_format(n, req);
6234*e181d3daSGollu Appalanaidu     case NVME_ADM_CMD_DIRECTIVE_SEND:
6235*e181d3daSGollu Appalanaidu         return nvme_directive_send(n, req);
6236*e181d3daSGollu Appalanaidu     case NVME_ADM_CMD_DIRECTIVE_RECV:
6237*e181d3daSGollu Appalanaidu         return nvme_directive_receive(n, req);
623888eea45cSKlaus Jensen     default:
623988eea45cSKlaus Jensen         assert(false);
624088eea45cSKlaus Jensen     }
624188eea45cSKlaus Jensen 
624288eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
624388eea45cSKlaus Jensen }
624488eea45cSKlaus Jensen 
62453f7fe8deSJinhao Fan static void nvme_update_sq_eventidx(const NvmeSQueue *sq)
62463f7fe8deSJinhao Fan {
62472fda0726SKlaus Jensen     uint32_t v = cpu_to_le32(sq->tail);
62482fda0726SKlaus Jensen 
624947cd3539SKlaus Jensen     trace_pci_nvme_update_sq_eventidx(sq->sqid, sq->tail);
625047cd3539SKlaus Jensen 
62512fda0726SKlaus Jensen     pci_dma_write(PCI_DEVICE(sq->ctrl), sq->ei_addr, &v, sizeof(v));
62523f7fe8deSJinhao Fan }
62533f7fe8deSJinhao Fan 
62543f7fe8deSJinhao Fan static void nvme_update_sq_tail(NvmeSQueue *sq)
62553f7fe8deSJinhao Fan {
62562fda0726SKlaus Jensen     uint32_t v;
62572fda0726SKlaus Jensen 
62582fda0726SKlaus Jensen     pci_dma_read(PCI_DEVICE(sq->ctrl), sq->db_addr, &v, sizeof(v));
62592fda0726SKlaus Jensen 
62602fda0726SKlaus Jensen     sq->tail = le32_to_cpu(v);
626147cd3539SKlaus Jensen 
626247cd3539SKlaus Jensen     trace_pci_nvme_update_sq_tail(sq->sqid, sq->tail);
62633f7fe8deSJinhao Fan }
62643f7fe8deSJinhao Fan 
626588eea45cSKlaus Jensen static void nvme_process_sq(void *opaque)
626688eea45cSKlaus Jensen {
626788eea45cSKlaus Jensen     NvmeSQueue *sq = opaque;
626888eea45cSKlaus Jensen     NvmeCtrl *n = sq->ctrl;
626988eea45cSKlaus Jensen     NvmeCQueue *cq = n->cq[sq->cqid];
627088eea45cSKlaus Jensen 
627188eea45cSKlaus Jensen     uint16_t status;
627288eea45cSKlaus Jensen     hwaddr addr;
627388eea45cSKlaus Jensen     NvmeCmd cmd;
627488eea45cSKlaus Jensen     NvmeRequest *req;
627588eea45cSKlaus Jensen 
62763f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
62773f7fe8deSJinhao Fan         nvme_update_sq_tail(sq);
62783f7fe8deSJinhao Fan     }
62793f7fe8deSJinhao Fan 
628088eea45cSKlaus Jensen     while (!(nvme_sq_empty(sq) || QTAILQ_EMPTY(&sq->req_list))) {
628188eea45cSKlaus Jensen         addr = sq->dma_addr + sq->head * n->sqe_size;
628288eea45cSKlaus Jensen         if (nvme_addr_read(n, addr, (void *)&cmd, sizeof(cmd))) {
628388eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
628488eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
628549e03457SKlaus Jensen             stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
628688eea45cSKlaus Jensen             break;
628788eea45cSKlaus Jensen         }
628888eea45cSKlaus Jensen         nvme_inc_sq_head(sq);
628988eea45cSKlaus Jensen 
629088eea45cSKlaus Jensen         req = QTAILQ_FIRST(&sq->req_list);
629188eea45cSKlaus Jensen         QTAILQ_REMOVE(&sq->req_list, req, entry);
629288eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->out_req_list, req, entry);
629388eea45cSKlaus Jensen         nvme_req_clear(req);
629488eea45cSKlaus Jensen         req->cqe.cid = cmd.cid;
629588eea45cSKlaus Jensen         memcpy(&req->cmd, &cmd, sizeof(NvmeCmd));
629688eea45cSKlaus Jensen 
629788eea45cSKlaus Jensen         status = sq->sqid ? nvme_io_cmd(n, req) :
629888eea45cSKlaus Jensen             nvme_admin_cmd(n, req);
629988eea45cSKlaus Jensen         if (status != NVME_NO_COMPLETE) {
630088eea45cSKlaus Jensen             req->status = status;
630188eea45cSKlaus Jensen             nvme_enqueue_req_completion(cq, req);
630288eea45cSKlaus Jensen         }
63033f7fe8deSJinhao Fan 
63043f7fe8deSJinhao Fan         if (n->dbbuf_enabled) {
63053f7fe8deSJinhao Fan             nvme_update_sq_eventidx(sq);
63063f7fe8deSJinhao Fan             nvme_update_sq_tail(sq);
63073f7fe8deSJinhao Fan         }
630888eea45cSKlaus Jensen     }
630988eea45cSKlaus Jensen }
631088eea45cSKlaus Jensen 
6311decc0261SŁukasz Gieryk static void nvme_update_msixcap_ts(PCIDevice *pci_dev, uint32_t table_size)
6312decc0261SŁukasz Gieryk {
6313decc0261SŁukasz Gieryk     uint8_t *config;
6314decc0261SŁukasz Gieryk 
6315decc0261SŁukasz Gieryk     if (!msix_present(pci_dev)) {
6316decc0261SŁukasz Gieryk         return;
6317decc0261SŁukasz Gieryk     }
6318decc0261SŁukasz Gieryk 
6319decc0261SŁukasz Gieryk     assert(table_size > 0 && table_size <= pci_dev->msix_entries_nr);
6320decc0261SŁukasz Gieryk 
6321decc0261SŁukasz Gieryk     config = pci_dev->config + pci_dev->msix_cap;
6322decc0261SŁukasz Gieryk     pci_set_word_by_mask(config + PCI_MSIX_FLAGS, PCI_MSIX_FLAGS_QSIZE,
6323decc0261SŁukasz Gieryk                          table_size - 1);
6324decc0261SŁukasz Gieryk }
6325decc0261SŁukasz Gieryk 
632611871f53SŁukasz Gieryk static void nvme_activate_virt_res(NvmeCtrl *n)
632711871f53SŁukasz Gieryk {
632848b32c28SKlaus Jensen     PCIDevice *pci_dev = PCI_DEVICE(n);
632911871f53SŁukasz Gieryk     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
633011871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
633111871f53SŁukasz Gieryk 
633211871f53SŁukasz Gieryk     /* -1 to account for the admin queue */
633311871f53SŁukasz Gieryk     if (pci_is_vf(pci_dev)) {
633411871f53SŁukasz Gieryk         sctrl = nvme_sctrl(n);
633511871f53SŁukasz Gieryk         cap->vqprt = sctrl->nvq;
633611871f53SŁukasz Gieryk         cap->viprt = sctrl->nvi;
633711871f53SŁukasz Gieryk         n->conf_ioqpairs = sctrl->nvq ? le16_to_cpu(sctrl->nvq) - 1 : 0;
633811871f53SŁukasz Gieryk         n->conf_msix_qsize = sctrl->nvi ? le16_to_cpu(sctrl->nvi) : 1;
633911871f53SŁukasz Gieryk     } else {
634011871f53SŁukasz Gieryk         cap->vqrfap = n->next_pri_ctrl_cap.vqrfap;
634111871f53SŁukasz Gieryk         cap->virfap = n->next_pri_ctrl_cap.virfap;
634211871f53SŁukasz Gieryk         n->conf_ioqpairs = le16_to_cpu(cap->vqprt) +
634311871f53SŁukasz Gieryk                            le16_to_cpu(cap->vqrfap) - 1;
634411871f53SŁukasz Gieryk         n->conf_msix_qsize = le16_to_cpu(cap->viprt) +
634511871f53SŁukasz Gieryk                              le16_to_cpu(cap->virfap);
634611871f53SŁukasz Gieryk     }
634711871f53SŁukasz Gieryk }
634811871f53SŁukasz Gieryk 
63491e9c685eSŁukasz Gieryk static void nvme_ctrl_reset(NvmeCtrl *n, NvmeResetType rst)
635088eea45cSKlaus Jensen {
635148b32c28SKlaus Jensen     PCIDevice *pci_dev = PCI_DEVICE(n);
635211871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
635388eea45cSKlaus Jensen     NvmeNamespace *ns;
635488eea45cSKlaus Jensen     int i;
635588eea45cSKlaus Jensen 
635688eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
635788eea45cSKlaus Jensen         ns = nvme_ns(n, i);
635888eea45cSKlaus Jensen         if (!ns) {
635988eea45cSKlaus Jensen             continue;
636088eea45cSKlaus Jensen         }
636188eea45cSKlaus Jensen 
636288eea45cSKlaus Jensen         nvme_ns_drain(ns);
636388eea45cSKlaus Jensen     }
636488eea45cSKlaus Jensen 
636588eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
636688eea45cSKlaus Jensen         if (n->sq[i] != NULL) {
636788eea45cSKlaus Jensen             nvme_free_sq(n->sq[i], n);
636888eea45cSKlaus Jensen         }
636988eea45cSKlaus Jensen     }
637088eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
637188eea45cSKlaus Jensen         if (n->cq[i] != NULL) {
637288eea45cSKlaus Jensen             nvme_free_cq(n->cq[i], n);
637388eea45cSKlaus Jensen         }
637488eea45cSKlaus Jensen     }
637588eea45cSKlaus Jensen 
637688eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&n->aer_queue)) {
637788eea45cSKlaus Jensen         NvmeAsyncEvent *event = QTAILQ_FIRST(&n->aer_queue);
637888eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
637988eea45cSKlaus Jensen         g_free(event);
638088eea45cSKlaus Jensen     }
638188eea45cSKlaus Jensen 
638211871f53SŁukasz Gieryk     if (n->params.sriov_max_vfs) {
638311871f53SŁukasz Gieryk         if (!pci_is_vf(pci_dev)) {
638411871f53SŁukasz Gieryk             for (i = 0; i < n->sec_ctrl_list.numcntl; i++) {
638511871f53SŁukasz Gieryk                 sctrl = &n->sec_ctrl_list.sec[i];
638611871f53SŁukasz Gieryk                 nvme_virt_set_state(n, le16_to_cpu(sctrl->scid), false);
638711871f53SŁukasz Gieryk             }
638811871f53SŁukasz Gieryk 
63891e9c685eSŁukasz Gieryk             if (rst != NVME_RESET_CONTROLLER) {
6390decc0261SŁukasz Gieryk                 pcie_sriov_pf_disable_vfs(pci_dev);
639144c2c094SLukasz Maniak             }
63921e9c685eSŁukasz Gieryk         }
639344c2c094SLukasz Maniak 
639411871f53SŁukasz Gieryk         if (rst != NVME_RESET_CONTROLLER) {
639511871f53SŁukasz Gieryk             nvme_activate_virt_res(n);
639611871f53SŁukasz Gieryk         }
639711871f53SŁukasz Gieryk     }
639811871f53SŁukasz Gieryk 
639988eea45cSKlaus Jensen     n->aer_queued = 0;
640098836e8eSKlaus Jensen     n->aer_mask = 0;
640188eea45cSKlaus Jensen     n->outstanding_aers = 0;
640288eea45cSKlaus Jensen     n->qs_created = false;
6403decc0261SŁukasz Gieryk 
6404decc0261SŁukasz Gieryk     nvme_update_msixcap_ts(pci_dev, n->conf_msix_qsize);
640511871f53SŁukasz Gieryk 
640611871f53SŁukasz Gieryk     if (pci_is_vf(pci_dev)) {
640711871f53SŁukasz Gieryk         sctrl = nvme_sctrl(n);
6408cc9bcee2SKlaus Jensen 
640911871f53SŁukasz Gieryk         stl_le_p(&n->bar.csts, sctrl->scs ? 0 : NVME_CSTS_FAILED);
641011871f53SŁukasz Gieryk     } else {
641111871f53SŁukasz Gieryk         stl_le_p(&n->bar.csts, 0);
641211871f53SŁukasz Gieryk     }
6413cc9bcee2SKlaus Jensen 
6414cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.intms, 0);
6415cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.intmc, 0);
6416cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.cc, 0);
64173f7fe8deSJinhao Fan 
64183f7fe8deSJinhao Fan     n->dbbuf_dbs = 0;
64193f7fe8deSJinhao Fan     n->dbbuf_eis = 0;
64203f7fe8deSJinhao Fan     n->dbbuf_enabled = false;
642188eea45cSKlaus Jensen }
642288eea45cSKlaus Jensen 
642388eea45cSKlaus Jensen static void nvme_ctrl_shutdown(NvmeCtrl *n)
642488eea45cSKlaus Jensen {
642588eea45cSKlaus Jensen     NvmeNamespace *ns;
642688eea45cSKlaus Jensen     int i;
642788eea45cSKlaus Jensen 
642888eea45cSKlaus Jensen     if (n->pmr.dev) {
642988eea45cSKlaus Jensen         memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
643088eea45cSKlaus Jensen     }
643188eea45cSKlaus Jensen 
643288eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
643388eea45cSKlaus Jensen         ns = nvme_ns(n, i);
643488eea45cSKlaus Jensen         if (!ns) {
643588eea45cSKlaus Jensen             continue;
643688eea45cSKlaus Jensen         }
643788eea45cSKlaus Jensen 
643888eea45cSKlaus Jensen         nvme_ns_shutdown(ns);
643988eea45cSKlaus Jensen     }
644088eea45cSKlaus Jensen }
644188eea45cSKlaus Jensen 
644288eea45cSKlaus Jensen static void nvme_select_iocs(NvmeCtrl *n)
644388eea45cSKlaus Jensen {
644488eea45cSKlaus Jensen     NvmeNamespace *ns;
644588eea45cSKlaus Jensen     int i;
644688eea45cSKlaus Jensen 
644788eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
644888eea45cSKlaus Jensen         ns = nvme_ns(n, i);
644988eea45cSKlaus Jensen         if (!ns) {
645088eea45cSKlaus Jensen             continue;
645188eea45cSKlaus Jensen         }
645288eea45cSKlaus Jensen 
645388eea45cSKlaus Jensen         nvme_select_iocs_ns(n, ns);
645488eea45cSKlaus Jensen     }
645588eea45cSKlaus Jensen }
645688eea45cSKlaus Jensen 
645788eea45cSKlaus Jensen static int nvme_start_ctrl(NvmeCtrl *n)
645888eea45cSKlaus Jensen {
645949e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
646049e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
646149e03457SKlaus Jensen     uint32_t aqa = ldl_le_p(&n->bar.aqa);
646249e03457SKlaus Jensen     uint64_t asq = ldq_le_p(&n->bar.asq);
646349e03457SKlaus Jensen     uint64_t acq = ldq_le_p(&n->bar.acq);
646449e03457SKlaus Jensen     uint32_t page_bits = NVME_CC_MPS(cc) + 12;
646588eea45cSKlaus Jensen     uint32_t page_size = 1 << page_bits;
646611871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl = nvme_sctrl(n);
646788eea45cSKlaus Jensen 
646848b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !sctrl->scs) {
646911871f53SŁukasz Gieryk         trace_pci_nvme_err_startfail_virt_state(le16_to_cpu(sctrl->nvi),
647011871f53SŁukasz Gieryk                                                 le16_to_cpu(sctrl->nvq),
647111871f53SŁukasz Gieryk                                                 sctrl->scs ? "ONLINE" :
647211871f53SŁukasz Gieryk                                                              "OFFLINE");
647311871f53SŁukasz Gieryk         return -1;
647411871f53SŁukasz Gieryk     }
647588eea45cSKlaus Jensen     if (unlikely(n->cq[0])) {
647688eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cq();
647788eea45cSKlaus Jensen         return -1;
647888eea45cSKlaus Jensen     }
647988eea45cSKlaus Jensen     if (unlikely(n->sq[0])) {
648088eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sq();
648188eea45cSKlaus Jensen         return -1;
648288eea45cSKlaus Jensen     }
648349e03457SKlaus Jensen     if (unlikely(asq & (page_size - 1))) {
648449e03457SKlaus Jensen         trace_pci_nvme_err_startfail_asq_misaligned(asq);
648588eea45cSKlaus Jensen         return -1;
648688eea45cSKlaus Jensen     }
648749e03457SKlaus Jensen     if (unlikely(acq & (page_size - 1))) {
648849e03457SKlaus Jensen         trace_pci_nvme_err_startfail_acq_misaligned(acq);
648988eea45cSKlaus Jensen         return -1;
649088eea45cSKlaus Jensen     }
649149e03457SKlaus Jensen     if (unlikely(!(NVME_CAP_CSS(cap) & (1 << NVME_CC_CSS(cc))))) {
649249e03457SKlaus Jensen         trace_pci_nvme_err_startfail_css(NVME_CC_CSS(cc));
649388eea45cSKlaus Jensen         return -1;
649488eea45cSKlaus Jensen     }
649549e03457SKlaus Jensen     if (unlikely(NVME_CC_MPS(cc) < NVME_CAP_MPSMIN(cap))) {
649688eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_small(
649749e03457SKlaus Jensen                     NVME_CC_MPS(cc),
649849e03457SKlaus Jensen                     NVME_CAP_MPSMIN(cap));
649988eea45cSKlaus Jensen         return -1;
650088eea45cSKlaus Jensen     }
650149e03457SKlaus Jensen     if (unlikely(NVME_CC_MPS(cc) >
650249e03457SKlaus Jensen                  NVME_CAP_MPSMAX(cap))) {
650388eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_large(
650449e03457SKlaus Jensen                     NVME_CC_MPS(cc),
650549e03457SKlaus Jensen                     NVME_CAP_MPSMAX(cap));
650688eea45cSKlaus Jensen         return -1;
650788eea45cSKlaus Jensen     }
650849e03457SKlaus Jensen     if (unlikely(NVME_CC_IOCQES(cc) <
650988eea45cSKlaus Jensen                  NVME_CTRL_CQES_MIN(n->id_ctrl.cqes))) {
651088eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cqent_too_small(
651149e03457SKlaus Jensen                     NVME_CC_IOCQES(cc),
651249e03457SKlaus Jensen                     NVME_CTRL_CQES_MIN(cap));
651388eea45cSKlaus Jensen         return -1;
651488eea45cSKlaus Jensen     }
651549e03457SKlaus Jensen     if (unlikely(NVME_CC_IOCQES(cc) >
651688eea45cSKlaus Jensen                  NVME_CTRL_CQES_MAX(n->id_ctrl.cqes))) {
651788eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cqent_too_large(
651849e03457SKlaus Jensen                     NVME_CC_IOCQES(cc),
651949e03457SKlaus Jensen                     NVME_CTRL_CQES_MAX(cap));
652088eea45cSKlaus Jensen         return -1;
652188eea45cSKlaus Jensen     }
652249e03457SKlaus Jensen     if (unlikely(NVME_CC_IOSQES(cc) <
652388eea45cSKlaus Jensen                  NVME_CTRL_SQES_MIN(n->id_ctrl.sqes))) {
652488eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sqent_too_small(
652549e03457SKlaus Jensen                     NVME_CC_IOSQES(cc),
652649e03457SKlaus Jensen                     NVME_CTRL_SQES_MIN(cap));
652788eea45cSKlaus Jensen         return -1;
652888eea45cSKlaus Jensen     }
652949e03457SKlaus Jensen     if (unlikely(NVME_CC_IOSQES(cc) >
653088eea45cSKlaus Jensen                  NVME_CTRL_SQES_MAX(n->id_ctrl.sqes))) {
653188eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sqent_too_large(
653249e03457SKlaus Jensen                     NVME_CC_IOSQES(cc),
653349e03457SKlaus Jensen                     NVME_CTRL_SQES_MAX(cap));
653488eea45cSKlaus Jensen         return -1;
653588eea45cSKlaus Jensen     }
653649e03457SKlaus Jensen     if (unlikely(!NVME_AQA_ASQS(aqa))) {
653788eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_asqent_sz_zero();
653888eea45cSKlaus Jensen         return -1;
653988eea45cSKlaus Jensen     }
654049e03457SKlaus Jensen     if (unlikely(!NVME_AQA_ACQS(aqa))) {
654188eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_acqent_sz_zero();
654288eea45cSKlaus Jensen         return -1;
654388eea45cSKlaus Jensen     }
654488eea45cSKlaus Jensen 
654588eea45cSKlaus Jensen     n->page_bits = page_bits;
654688eea45cSKlaus Jensen     n->page_size = page_size;
654788eea45cSKlaus Jensen     n->max_prp_ents = n->page_size / sizeof(uint64_t);
654849e03457SKlaus Jensen     n->cqe_size = 1 << NVME_CC_IOCQES(cc);
654949e03457SKlaus Jensen     n->sqe_size = 1 << NVME_CC_IOSQES(cc);
655049e03457SKlaus Jensen     nvme_init_cq(&n->admin_cq, n, acq, 0, 0, NVME_AQA_ACQS(aqa) + 1, 1);
655149e03457SKlaus Jensen     nvme_init_sq(&n->admin_sq, n, asq, 0, 0, NVME_AQA_ASQS(aqa) + 1);
655288eea45cSKlaus Jensen 
655388eea45cSKlaus Jensen     nvme_set_timestamp(n, 0ULL);
655488eea45cSKlaus Jensen 
655588eea45cSKlaus Jensen     nvme_select_iocs(n);
655688eea45cSKlaus Jensen 
655788eea45cSKlaus Jensen     return 0;
655888eea45cSKlaus Jensen }
655988eea45cSKlaus Jensen 
656088eea45cSKlaus Jensen static void nvme_cmb_enable_regs(NvmeCtrl *n)
656188eea45cSKlaus Jensen {
656249e03457SKlaus Jensen     uint32_t cmbloc = ldl_le_p(&n->bar.cmbloc);
656349e03457SKlaus Jensen     uint32_t cmbsz = ldl_le_p(&n->bar.cmbsz);
656488eea45cSKlaus Jensen 
656549e03457SKlaus Jensen     NVME_CMBLOC_SET_CDPCILS(cmbloc, 1);
656649e03457SKlaus Jensen     NVME_CMBLOC_SET_CDPMLS(cmbloc, 1);
656749e03457SKlaus Jensen     NVME_CMBLOC_SET_BIR(cmbloc, NVME_CMB_BIR);
656849e03457SKlaus Jensen     stl_le_p(&n->bar.cmbloc, cmbloc);
656949e03457SKlaus Jensen 
657049e03457SKlaus Jensen     NVME_CMBSZ_SET_SQS(cmbsz, 1);
657149e03457SKlaus Jensen     NVME_CMBSZ_SET_CQS(cmbsz, 0);
657249e03457SKlaus Jensen     NVME_CMBSZ_SET_LISTS(cmbsz, 1);
657349e03457SKlaus Jensen     NVME_CMBSZ_SET_RDS(cmbsz, 1);
657449e03457SKlaus Jensen     NVME_CMBSZ_SET_WDS(cmbsz, 1);
657549e03457SKlaus Jensen     NVME_CMBSZ_SET_SZU(cmbsz, 2); /* MBs */
657649e03457SKlaus Jensen     NVME_CMBSZ_SET_SZ(cmbsz, n->params.cmb_size_mb);
657749e03457SKlaus Jensen     stl_le_p(&n->bar.cmbsz, cmbsz);
657888eea45cSKlaus Jensen }
657988eea45cSKlaus Jensen 
658088eea45cSKlaus Jensen static void nvme_write_bar(NvmeCtrl *n, hwaddr offset, uint64_t data,
658188eea45cSKlaus Jensen                            unsigned size)
658288eea45cSKlaus Jensen {
658348b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
658449e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
658549e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
658649e03457SKlaus Jensen     uint32_t intms = ldl_le_p(&n->bar.intms);
658749e03457SKlaus Jensen     uint32_t csts = ldl_le_p(&n->bar.csts);
658849e03457SKlaus Jensen     uint32_t pmrsts = ldl_le_p(&n->bar.pmrsts);
658949e03457SKlaus Jensen 
659088eea45cSKlaus Jensen     if (unlikely(offset & (sizeof(uint32_t) - 1))) {
659188eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_misaligned32,
659288eea45cSKlaus Jensen                        "MMIO write not 32-bit aligned,"
659388eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", offset);
659488eea45cSKlaus Jensen         /* should be ignored, fall through for now */
659588eea45cSKlaus Jensen     }
659688eea45cSKlaus Jensen 
659788eea45cSKlaus Jensen     if (unlikely(size < sizeof(uint32_t))) {
659888eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_toosmall,
659988eea45cSKlaus Jensen                        "MMIO write smaller than 32-bits,"
660088eea45cSKlaus Jensen                        " offset=0x%"PRIx64", size=%u",
660188eea45cSKlaus Jensen                        offset, size);
660288eea45cSKlaus Jensen         /* should be ignored, fall through for now */
660388eea45cSKlaus Jensen     }
660488eea45cSKlaus Jensen 
660588eea45cSKlaus Jensen     switch (offset) {
6606a316aa50SKlaus Jensen     case NVME_REG_INTMS:
660748b32c28SKlaus Jensen         if (unlikely(msix_enabled(pci))) {
660888eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
660988eea45cSKlaus Jensen                            "undefined access to interrupt mask set"
661088eea45cSKlaus Jensen                            " when MSI-X is enabled");
661188eea45cSKlaus Jensen             /* should be ignored, fall through for now */
661288eea45cSKlaus Jensen         }
661349e03457SKlaus Jensen         intms |= data;
661449e03457SKlaus Jensen         stl_le_p(&n->bar.intms, intms);
661588eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
661649e03457SKlaus Jensen         trace_pci_nvme_mmio_intm_set(data & 0xffffffff, intms);
661788eea45cSKlaus Jensen         nvme_irq_check(n);
661888eea45cSKlaus Jensen         break;
6619a316aa50SKlaus Jensen     case NVME_REG_INTMC:
662048b32c28SKlaus Jensen         if (unlikely(msix_enabled(pci))) {
662188eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
662288eea45cSKlaus Jensen                            "undefined access to interrupt mask clr"
662388eea45cSKlaus Jensen                            " when MSI-X is enabled");
662488eea45cSKlaus Jensen             /* should be ignored, fall through for now */
662588eea45cSKlaus Jensen         }
662649e03457SKlaus Jensen         intms &= ~data;
662749e03457SKlaus Jensen         stl_le_p(&n->bar.intms, intms);
662888eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
662949e03457SKlaus Jensen         trace_pci_nvme_mmio_intm_clr(data & 0xffffffff, intms);
663088eea45cSKlaus Jensen         nvme_irq_check(n);
663188eea45cSKlaus Jensen         break;
6632a316aa50SKlaus Jensen     case NVME_REG_CC:
6633cc9bcee2SKlaus Jensen         stl_le_p(&n->bar.cc, data);
6634cc9bcee2SKlaus Jensen 
663588eea45cSKlaus Jensen         trace_pci_nvme_mmio_cfg(data & 0xffffffff);
663649e03457SKlaus Jensen 
6637cc9bcee2SKlaus Jensen         if (NVME_CC_SHN(data) && !(NVME_CC_SHN(cc))) {
6638cc9bcee2SKlaus Jensen             trace_pci_nvme_mmio_shutdown_set();
6639cc9bcee2SKlaus Jensen             nvme_ctrl_shutdown(n);
6640cc9bcee2SKlaus Jensen             csts &= ~(CSTS_SHST_MASK << CSTS_SHST_SHIFT);
6641cc9bcee2SKlaus Jensen             csts |= NVME_CSTS_SHST_COMPLETE;
6642cc9bcee2SKlaus Jensen         } else if (!NVME_CC_SHN(data) && NVME_CC_SHN(cc)) {
6643cc9bcee2SKlaus Jensen             trace_pci_nvme_mmio_shutdown_cleared();
6644cc9bcee2SKlaus Jensen             csts &= ~(CSTS_SHST_MASK << CSTS_SHST_SHIFT);
664588eea45cSKlaus Jensen         }
664688eea45cSKlaus Jensen 
664749e03457SKlaus Jensen         if (NVME_CC_EN(data) && !NVME_CC_EN(cc)) {
664888eea45cSKlaus Jensen             if (unlikely(nvme_start_ctrl(n))) {
664988eea45cSKlaus Jensen                 trace_pci_nvme_err_startfail();
665049e03457SKlaus Jensen                 csts = NVME_CSTS_FAILED;
665188eea45cSKlaus Jensen             } else {
665288eea45cSKlaus Jensen                 trace_pci_nvme_mmio_start_success();
665349e03457SKlaus Jensen                 csts = NVME_CSTS_READY;
665488eea45cSKlaus Jensen             }
665549e03457SKlaus Jensen         } else if (!NVME_CC_EN(data) && NVME_CC_EN(cc)) {
665688eea45cSKlaus Jensen             trace_pci_nvme_mmio_stopped();
66571e9c685eSŁukasz Gieryk             nvme_ctrl_reset(n, NVME_RESET_CONTROLLER);
6658cc9bcee2SKlaus Jensen 
6659cc9bcee2SKlaus Jensen             break;
666088eea45cSKlaus Jensen         }
666149e03457SKlaus Jensen 
666249e03457SKlaus Jensen         stl_le_p(&n->bar.csts, csts);
666349e03457SKlaus Jensen 
666488eea45cSKlaus Jensen         break;
6665a316aa50SKlaus Jensen     case NVME_REG_CSTS:
666688eea45cSKlaus Jensen         if (data & (1 << 4)) {
666788eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ssreset_w1c_unsupported,
666888eea45cSKlaus Jensen                            "attempted to W1C CSTS.NSSRO"
666988eea45cSKlaus Jensen                            " but CAP.NSSRS is zero (not supported)");
667088eea45cSKlaus Jensen         } else if (data != 0) {
667188eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ro_csts,
667288eea45cSKlaus Jensen                            "attempted to set a read only bit"
667388eea45cSKlaus Jensen                            " of controller status");
667488eea45cSKlaus Jensen         }
667588eea45cSKlaus Jensen         break;
6676a316aa50SKlaus Jensen     case NVME_REG_NSSR:
667788eea45cSKlaus Jensen         if (data == 0x4e564d65) {
667888eea45cSKlaus Jensen             trace_pci_nvme_ub_mmiowr_ssreset_unsupported();
667988eea45cSKlaus Jensen         } else {
668088eea45cSKlaus Jensen             /* The spec says that writes of other values have no effect */
668188eea45cSKlaus Jensen             return;
668288eea45cSKlaus Jensen         }
668388eea45cSKlaus Jensen         break;
6684a316aa50SKlaus Jensen     case NVME_REG_AQA:
668549e03457SKlaus Jensen         stl_le_p(&n->bar.aqa, data);
668688eea45cSKlaus Jensen         trace_pci_nvme_mmio_aqattr(data & 0xffffffff);
668788eea45cSKlaus Jensen         break;
6688a316aa50SKlaus Jensen     case NVME_REG_ASQ:
668949e03457SKlaus Jensen         stn_le_p(&n->bar.asq, size, data);
669088eea45cSKlaus Jensen         trace_pci_nvme_mmio_asqaddr(data);
669188eea45cSKlaus Jensen         break;
6692a316aa50SKlaus Jensen     case NVME_REG_ASQ + 4:
669349e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.asq + 4, data);
669449e03457SKlaus Jensen         trace_pci_nvme_mmio_asqaddr_hi(data, ldq_le_p(&n->bar.asq));
669588eea45cSKlaus Jensen         break;
6696a316aa50SKlaus Jensen     case NVME_REG_ACQ:
669788eea45cSKlaus Jensen         trace_pci_nvme_mmio_acqaddr(data);
669849e03457SKlaus Jensen         stn_le_p(&n->bar.acq, size, data);
669988eea45cSKlaus Jensen         break;
6700a316aa50SKlaus Jensen     case NVME_REG_ACQ + 4:
670149e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.acq + 4, data);
670249e03457SKlaus Jensen         trace_pci_nvme_mmio_acqaddr_hi(data, ldq_le_p(&n->bar.acq));
670388eea45cSKlaus Jensen         break;
6704a316aa50SKlaus Jensen     case NVME_REG_CMBLOC:
670588eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbloc_reserved,
670688eea45cSKlaus Jensen                        "invalid write to reserved CMBLOC"
670788eea45cSKlaus Jensen                        " when CMBSZ is zero, ignored");
670888eea45cSKlaus Jensen         return;
6709a316aa50SKlaus Jensen     case NVME_REG_CMBSZ:
671088eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbsz_readonly,
671188eea45cSKlaus Jensen                        "invalid write to read only CMBSZ, ignored");
671288eea45cSKlaus Jensen         return;
6713a316aa50SKlaus Jensen     case NVME_REG_CMBMSC:
671449e03457SKlaus Jensen         if (!NVME_CAP_CMBS(cap)) {
671588eea45cSKlaus Jensen             return;
671688eea45cSKlaus Jensen         }
671788eea45cSKlaus Jensen 
671849e03457SKlaus Jensen         stn_le_p(&n->bar.cmbmsc, size, data);
671988eea45cSKlaus Jensen         n->cmb.cmse = false;
672088eea45cSKlaus Jensen 
672188eea45cSKlaus Jensen         if (NVME_CMBMSC_CRE(data)) {
672288eea45cSKlaus Jensen             nvme_cmb_enable_regs(n);
672388eea45cSKlaus Jensen 
672488eea45cSKlaus Jensen             if (NVME_CMBMSC_CMSE(data)) {
672549e03457SKlaus Jensen                 uint64_t cmbmsc = ldq_le_p(&n->bar.cmbmsc);
672649e03457SKlaus Jensen                 hwaddr cba = NVME_CMBMSC_CBA(cmbmsc) << CMBMSC_CBA_SHIFT;
672788eea45cSKlaus Jensen                 if (cba + int128_get64(n->cmb.mem.size) < cba) {
672849e03457SKlaus Jensen                     uint32_t cmbsts = ldl_le_p(&n->bar.cmbsts);
672949e03457SKlaus Jensen                     NVME_CMBSTS_SET_CBAI(cmbsts, 1);
673049e03457SKlaus Jensen                     stl_le_p(&n->bar.cmbsts, cmbsts);
673188eea45cSKlaus Jensen                     return;
673288eea45cSKlaus Jensen                 }
673388eea45cSKlaus Jensen 
673488eea45cSKlaus Jensen                 n->cmb.cba = cba;
673588eea45cSKlaus Jensen                 n->cmb.cmse = true;
673688eea45cSKlaus Jensen             }
673788eea45cSKlaus Jensen         } else {
673888eea45cSKlaus Jensen             n->bar.cmbsz = 0;
673988eea45cSKlaus Jensen             n->bar.cmbloc = 0;
674088eea45cSKlaus Jensen         }
674188eea45cSKlaus Jensen 
674288eea45cSKlaus Jensen         return;
6743a316aa50SKlaus Jensen     case NVME_REG_CMBMSC + 4:
674449e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.cmbmsc + 4, data);
674588eea45cSKlaus Jensen         return;
674688eea45cSKlaus Jensen 
6747a316aa50SKlaus Jensen     case NVME_REG_PMRCAP:
674888eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrcap_readonly,
674988eea45cSKlaus Jensen                        "invalid write to PMRCAP register, ignored");
675088eea45cSKlaus Jensen         return;
6751a316aa50SKlaus Jensen     case NVME_REG_PMRCTL:
675249e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
67532b02aabcSKlaus Jensen             return;
67542b02aabcSKlaus Jensen         }
67552b02aabcSKlaus Jensen 
675649e03457SKlaus Jensen         stl_le_p(&n->bar.pmrctl, data);
675788eea45cSKlaus Jensen         if (NVME_PMRCTL_EN(data)) {
675888eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, true);
675949e03457SKlaus Jensen             pmrsts = 0;
676088eea45cSKlaus Jensen         } else {
676188eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, false);
676249e03457SKlaus Jensen             NVME_PMRSTS_SET_NRDY(pmrsts, 1);
676388eea45cSKlaus Jensen             n->pmr.cmse = false;
676488eea45cSKlaus Jensen         }
676549e03457SKlaus Jensen         stl_le_p(&n->bar.pmrsts, pmrsts);
676688eea45cSKlaus Jensen         return;
6767a316aa50SKlaus Jensen     case NVME_REG_PMRSTS:
676888eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrsts_readonly,
676988eea45cSKlaus Jensen                        "invalid write to PMRSTS register, ignored");
677088eea45cSKlaus Jensen         return;
6771a316aa50SKlaus Jensen     case NVME_REG_PMREBS:
677288eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrebs_readonly,
677388eea45cSKlaus Jensen                        "invalid write to PMREBS register, ignored");
677488eea45cSKlaus Jensen         return;
6775a316aa50SKlaus Jensen     case NVME_REG_PMRSWTP:
677688eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrswtp_readonly,
677788eea45cSKlaus Jensen                        "invalid write to PMRSWTP register, ignored");
677888eea45cSKlaus Jensen         return;
6779a316aa50SKlaus Jensen     case NVME_REG_PMRMSCL:
678049e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
678188eea45cSKlaus Jensen             return;
678288eea45cSKlaus Jensen         }
678388eea45cSKlaus Jensen 
678449e03457SKlaus Jensen         stl_le_p(&n->bar.pmrmscl, data);
678588eea45cSKlaus Jensen         n->pmr.cmse = false;
678688eea45cSKlaus Jensen 
678749e03457SKlaus Jensen         if (NVME_PMRMSCL_CMSE(data)) {
678849e03457SKlaus Jensen             uint64_t pmrmscu = ldl_le_p(&n->bar.pmrmscu);
678949e03457SKlaus Jensen             hwaddr cba = pmrmscu << 32 |
679049e03457SKlaus Jensen                 (NVME_PMRMSCL_CBA(data) << PMRMSCL_CBA_SHIFT);
679188eea45cSKlaus Jensen             if (cba + int128_get64(n->pmr.dev->mr.size) < cba) {
679249e03457SKlaus Jensen                 NVME_PMRSTS_SET_CBAI(pmrsts, 1);
679349e03457SKlaus Jensen                 stl_le_p(&n->bar.pmrsts, pmrsts);
679488eea45cSKlaus Jensen                 return;
679588eea45cSKlaus Jensen             }
679688eea45cSKlaus Jensen 
679788eea45cSKlaus Jensen             n->pmr.cmse = true;
679888eea45cSKlaus Jensen             n->pmr.cba = cba;
679988eea45cSKlaus Jensen         }
680088eea45cSKlaus Jensen 
680188eea45cSKlaus Jensen         return;
6802a316aa50SKlaus Jensen     case NVME_REG_PMRMSCU:
680349e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
680488eea45cSKlaus Jensen             return;
680588eea45cSKlaus Jensen         }
680688eea45cSKlaus Jensen 
680749e03457SKlaus Jensen         stl_le_p(&n->bar.pmrmscu, data);
680888eea45cSKlaus Jensen         return;
680988eea45cSKlaus Jensen     default:
681088eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_invalid,
681188eea45cSKlaus Jensen                        "invalid MMIO write,"
681288eea45cSKlaus Jensen                        " offset=0x%"PRIx64", data=%"PRIx64"",
681388eea45cSKlaus Jensen                        offset, data);
681488eea45cSKlaus Jensen         break;
681588eea45cSKlaus Jensen     }
681688eea45cSKlaus Jensen }
681788eea45cSKlaus Jensen 
681888eea45cSKlaus Jensen static uint64_t nvme_mmio_read(void *opaque, hwaddr addr, unsigned size)
681988eea45cSKlaus Jensen {
682088eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
682188eea45cSKlaus Jensen     uint8_t *ptr = (uint8_t *)&n->bar;
682288eea45cSKlaus Jensen 
682388eea45cSKlaus Jensen     trace_pci_nvme_mmio_read(addr, size);
682488eea45cSKlaus Jensen 
682588eea45cSKlaus Jensen     if (unlikely(addr & (sizeof(uint32_t) - 1))) {
682688eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_misaligned32,
682788eea45cSKlaus Jensen                        "MMIO read not 32-bit aligned,"
682888eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
682988eea45cSKlaus Jensen         /* should RAZ, fall through for now */
683088eea45cSKlaus Jensen     } else if (unlikely(size < sizeof(uint32_t))) {
683188eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_toosmall,
683288eea45cSKlaus Jensen                        "MMIO read smaller than 32-bits,"
683388eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
683488eea45cSKlaus Jensen         /* should RAZ, fall through for now */
683588eea45cSKlaus Jensen     }
683688eea45cSKlaus Jensen 
68375029de44SKlaus Jensen     if (addr > sizeof(n->bar) - size) {
68385029de44SKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_invalid_ofs,
68395029de44SKlaus Jensen                        "MMIO read beyond last register,"
68405029de44SKlaus Jensen                        " offset=0x%"PRIx64", returning 0", addr);
68415029de44SKlaus Jensen 
68425029de44SKlaus Jensen         return 0;
68435029de44SKlaus Jensen     }
68445029de44SKlaus Jensen 
684548b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !nvme_sctrl(n)->scs &&
684611871f53SŁukasz Gieryk         addr != NVME_REG_CSTS) {
684711871f53SŁukasz Gieryk         trace_pci_nvme_err_ignored_mmio_vf_offline(addr, size);
684811871f53SŁukasz Gieryk         return 0;
684911871f53SŁukasz Gieryk     }
685011871f53SŁukasz Gieryk 
685188eea45cSKlaus Jensen     /*
685288eea45cSKlaus Jensen      * When PMRWBM bit 1 is set then read from
685388eea45cSKlaus Jensen      * from PMRSTS should ensure prior writes
685488eea45cSKlaus Jensen      * made it to persistent media
685588eea45cSKlaus Jensen      */
6856a316aa50SKlaus Jensen     if (addr == NVME_REG_PMRSTS &&
685749e03457SKlaus Jensen         (NVME_PMRCAP_PMRWBM(ldl_le_p(&n->bar.pmrcap)) & 0x02)) {
685888eea45cSKlaus Jensen         memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
685988eea45cSKlaus Jensen     }
68605029de44SKlaus Jensen 
686149e03457SKlaus Jensen     return ldn_le_p(ptr + addr, size);
686288eea45cSKlaus Jensen }
686388eea45cSKlaus Jensen 
686488eea45cSKlaus Jensen static void nvme_process_db(NvmeCtrl *n, hwaddr addr, int val)
686588eea45cSKlaus Jensen {
686648b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
686788eea45cSKlaus Jensen     uint32_t qid;
686888eea45cSKlaus Jensen 
686988eea45cSKlaus Jensen     if (unlikely(addr & ((1 << 2) - 1))) {
687088eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_db_wr_misaligned,
687188eea45cSKlaus Jensen                        "doorbell write not 32-bit aligned,"
687288eea45cSKlaus Jensen                        " offset=0x%"PRIx64", ignoring", addr);
687388eea45cSKlaus Jensen         return;
687488eea45cSKlaus Jensen     }
687588eea45cSKlaus Jensen 
687688eea45cSKlaus Jensen     if (((addr - 0x1000) >> 2) & 1) {
687788eea45cSKlaus Jensen         /* Completion queue doorbell write */
687888eea45cSKlaus Jensen 
687988eea45cSKlaus Jensen         uint16_t new_head = val & 0xffff;
688088eea45cSKlaus Jensen         int start_sqs;
688188eea45cSKlaus Jensen         NvmeCQueue *cq;
688288eea45cSKlaus Jensen 
688388eea45cSKlaus Jensen         qid = (addr - (0x1000 + (1 << 2))) >> 3;
688488eea45cSKlaus Jensen         if (unlikely(nvme_check_cqid(n, qid))) {
688588eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cq,
688688eea45cSKlaus Jensen                            "completion queue doorbell write"
688788eea45cSKlaus Jensen                            " for nonexistent queue,"
688888eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
688988eea45cSKlaus Jensen 
689088eea45cSKlaus Jensen             /*
689188eea45cSKlaus Jensen              * NVM Express v1.3d, Section 4.1 state: "If host software writes
689288eea45cSKlaus Jensen              * an invalid value to the Submission Queue Tail Doorbell or
689388eea45cSKlaus Jensen              * Completion Queue Head Doorbell regiter and an Asynchronous Event
689488eea45cSKlaus Jensen              * Request command is outstanding, then an asynchronous event is
689588eea45cSKlaus Jensen              * posted to the Admin Completion Queue with a status code of
689688eea45cSKlaus Jensen              * Invalid Doorbell Write Value."
689788eea45cSKlaus Jensen              *
689888eea45cSKlaus Jensen              * Also note that the spec includes the "Invalid Doorbell Register"
689988eea45cSKlaus Jensen              * status code, but nowhere does it specify when to use it.
690088eea45cSKlaus Jensen              * However, it seems reasonable to use it here in a similar
690188eea45cSKlaus Jensen              * fashion.
690288eea45cSKlaus Jensen              */
690388eea45cSKlaus Jensen             if (n->outstanding_aers) {
690488eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
690588eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
690688eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
690788eea45cSKlaus Jensen             }
690888eea45cSKlaus Jensen 
690988eea45cSKlaus Jensen             return;
691088eea45cSKlaus Jensen         }
691188eea45cSKlaus Jensen 
691288eea45cSKlaus Jensen         cq = n->cq[qid];
691388eea45cSKlaus Jensen         if (unlikely(new_head >= cq->size)) {
691488eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cqhead,
691588eea45cSKlaus Jensen                            "completion queue doorbell write value"
691688eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
691788eea45cSKlaus Jensen                            " new_head=%"PRIu16", ignoring",
691888eea45cSKlaus Jensen                            qid, new_head);
691988eea45cSKlaus Jensen 
692088eea45cSKlaus Jensen             if (n->outstanding_aers) {
692188eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
692288eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
692388eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
692488eea45cSKlaus Jensen             }
692588eea45cSKlaus Jensen 
692688eea45cSKlaus Jensen             return;
692788eea45cSKlaus Jensen         }
692888eea45cSKlaus Jensen 
692988eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_cq(cq->cqid, new_head);
693088eea45cSKlaus Jensen 
693188eea45cSKlaus Jensen         start_sqs = nvme_cq_full(cq) ? 1 : 0;
693288eea45cSKlaus Jensen         cq->head = new_head;
69333f7fe8deSJinhao Fan         if (!qid && n->dbbuf_enabled) {
693448b32c28SKlaus Jensen             pci_dma_write(pci, cq->db_addr, &cq->head, sizeof(cq->head));
69353f7fe8deSJinhao Fan         }
693688eea45cSKlaus Jensen         if (start_sqs) {
693788eea45cSKlaus Jensen             NvmeSQueue *sq;
693888eea45cSKlaus Jensen             QTAILQ_FOREACH(sq, &cq->sq_list, entry) {
6939d38cc6fdSKlaus Jensen                 qemu_bh_schedule(sq->bh);
694088eea45cSKlaus Jensen             }
6941d38cc6fdSKlaus Jensen             qemu_bh_schedule(cq->bh);
694288eea45cSKlaus Jensen         }
694388eea45cSKlaus Jensen 
694488eea45cSKlaus Jensen         if (cq->tail == cq->head) {
694583d7ed5cSKlaus Jensen             if (cq->irq_enabled) {
694683d7ed5cSKlaus Jensen                 n->cq_pending--;
694783d7ed5cSKlaus Jensen             }
694883d7ed5cSKlaus Jensen 
694988eea45cSKlaus Jensen             nvme_irq_deassert(n, cq);
695088eea45cSKlaus Jensen         }
695188eea45cSKlaus Jensen     } else {
695288eea45cSKlaus Jensen         /* Submission queue doorbell write */
695388eea45cSKlaus Jensen 
695488eea45cSKlaus Jensen         uint16_t new_tail = val & 0xffff;
695588eea45cSKlaus Jensen         NvmeSQueue *sq;
695688eea45cSKlaus Jensen 
695788eea45cSKlaus Jensen         qid = (addr - 0x1000) >> 3;
695888eea45cSKlaus Jensen         if (unlikely(nvme_check_sqid(n, qid))) {
695988eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sq,
696088eea45cSKlaus Jensen                            "submission queue doorbell write"
696188eea45cSKlaus Jensen                            " for nonexistent queue,"
696288eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
696388eea45cSKlaus Jensen 
696488eea45cSKlaus Jensen             if (n->outstanding_aers) {
696588eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
696688eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
696788eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
696888eea45cSKlaus Jensen             }
696988eea45cSKlaus Jensen 
697088eea45cSKlaus Jensen             return;
697188eea45cSKlaus Jensen         }
697288eea45cSKlaus Jensen 
697388eea45cSKlaus Jensen         sq = n->sq[qid];
697488eea45cSKlaus Jensen         if (unlikely(new_tail >= sq->size)) {
697588eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sqtail,
697688eea45cSKlaus Jensen                            "submission queue doorbell write value"
697788eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
697888eea45cSKlaus Jensen                            " new_tail=%"PRIu16", ignoring",
697988eea45cSKlaus Jensen                            qid, new_tail);
698088eea45cSKlaus Jensen 
698188eea45cSKlaus Jensen             if (n->outstanding_aers) {
698288eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
698388eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
698488eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
698588eea45cSKlaus Jensen             }
698688eea45cSKlaus Jensen 
698788eea45cSKlaus Jensen             return;
698888eea45cSKlaus Jensen         }
698988eea45cSKlaus Jensen 
699088eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_sq(sq->sqid, new_tail);
699188eea45cSKlaus Jensen 
699288eea45cSKlaus Jensen         sq->tail = new_tail;
69933f7fe8deSJinhao Fan         if (!qid && n->dbbuf_enabled) {
69943f7fe8deSJinhao Fan             /*
69953f7fe8deSJinhao Fan              * The spec states "the host shall also update the controller's
69963f7fe8deSJinhao Fan              * corresponding doorbell property to match the value of that entry
69973f7fe8deSJinhao Fan              * in the Shadow Doorbell buffer."
69983f7fe8deSJinhao Fan              *
69993f7fe8deSJinhao Fan              * Since this context is currently a VM trap, we can safely enforce
70003f7fe8deSJinhao Fan              * the requirement from the device side in case the host is
70013f7fe8deSJinhao Fan              * misbehaving.
70023f7fe8deSJinhao Fan              *
70033f7fe8deSJinhao Fan              * Note, we shouldn't have to do this, but various drivers
70043f7fe8deSJinhao Fan              * including ones that run on Linux, are not updating Admin Queues,
70053f7fe8deSJinhao Fan              * so we can't trust reading it for an appropriate sq tail.
70063f7fe8deSJinhao Fan              */
700748b32c28SKlaus Jensen             pci_dma_write(pci, sq->db_addr, &sq->tail, sizeof(sq->tail));
70083f7fe8deSJinhao Fan         }
7009d38cc6fdSKlaus Jensen 
7010d38cc6fdSKlaus Jensen         qemu_bh_schedule(sq->bh);
701188eea45cSKlaus Jensen     }
701288eea45cSKlaus Jensen }
701388eea45cSKlaus Jensen 
701488eea45cSKlaus Jensen static void nvme_mmio_write(void *opaque, hwaddr addr, uint64_t data,
701588eea45cSKlaus Jensen                             unsigned size)
701688eea45cSKlaus Jensen {
701788eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
701888eea45cSKlaus Jensen 
701988eea45cSKlaus Jensen     trace_pci_nvme_mmio_write(addr, data, size);
702088eea45cSKlaus Jensen 
702148b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !nvme_sctrl(n)->scs &&
702211871f53SŁukasz Gieryk         addr != NVME_REG_CSTS) {
702311871f53SŁukasz Gieryk         trace_pci_nvme_err_ignored_mmio_vf_offline(addr, size);
702411871f53SŁukasz Gieryk         return;
702511871f53SŁukasz Gieryk     }
702611871f53SŁukasz Gieryk 
702788eea45cSKlaus Jensen     if (addr < sizeof(n->bar)) {
702888eea45cSKlaus Jensen         nvme_write_bar(n, addr, data, size);
702988eea45cSKlaus Jensen     } else {
703088eea45cSKlaus Jensen         nvme_process_db(n, addr, data);
703188eea45cSKlaus Jensen     }
703288eea45cSKlaus Jensen }
703388eea45cSKlaus Jensen 
703488eea45cSKlaus Jensen static const MemoryRegionOps nvme_mmio_ops = {
703588eea45cSKlaus Jensen     .read = nvme_mmio_read,
703688eea45cSKlaus Jensen     .write = nvme_mmio_write,
703788eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
703888eea45cSKlaus Jensen     .impl = {
703988eea45cSKlaus Jensen         .min_access_size = 2,
704088eea45cSKlaus Jensen         .max_access_size = 8,
704188eea45cSKlaus Jensen     },
704288eea45cSKlaus Jensen };
704388eea45cSKlaus Jensen 
704488eea45cSKlaus Jensen static void nvme_cmb_write(void *opaque, hwaddr addr, uint64_t data,
704588eea45cSKlaus Jensen                            unsigned size)
704688eea45cSKlaus Jensen {
704788eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
704888eea45cSKlaus Jensen     stn_le_p(&n->cmb.buf[addr], size, data);
704988eea45cSKlaus Jensen }
705088eea45cSKlaus Jensen 
705188eea45cSKlaus Jensen static uint64_t nvme_cmb_read(void *opaque, hwaddr addr, unsigned size)
705288eea45cSKlaus Jensen {
705388eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
705488eea45cSKlaus Jensen     return ldn_le_p(&n->cmb.buf[addr], size);
705588eea45cSKlaus Jensen }
705688eea45cSKlaus Jensen 
705788eea45cSKlaus Jensen static const MemoryRegionOps nvme_cmb_ops = {
705888eea45cSKlaus Jensen     .read = nvme_cmb_read,
705988eea45cSKlaus Jensen     .write = nvme_cmb_write,
706088eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
706188eea45cSKlaus Jensen     .impl = {
706288eea45cSKlaus Jensen         .min_access_size = 1,
706388eea45cSKlaus Jensen         .max_access_size = 8,
706488eea45cSKlaus Jensen     },
706588eea45cSKlaus Jensen };
706688eea45cSKlaus Jensen 
7067784fd353SKlaus Jensen static bool nvme_check_params(NvmeCtrl *n, Error **errp)
706888eea45cSKlaus Jensen {
706988eea45cSKlaus Jensen     NvmeParams *params = &n->params;
707088eea45cSKlaus Jensen 
707188eea45cSKlaus Jensen     if (params->num_queues) {
707288eea45cSKlaus Jensen         warn_report("num_queues is deprecated; please use max_ioqpairs "
707388eea45cSKlaus Jensen                     "instead");
707488eea45cSKlaus Jensen 
707588eea45cSKlaus Jensen         params->max_ioqpairs = params->num_queues - 1;
707688eea45cSKlaus Jensen     }
707788eea45cSKlaus Jensen 
707888eea45cSKlaus Jensen     if (n->namespace.blkconf.blk && n->subsys) {
707988eea45cSKlaus Jensen         error_setg(errp, "subsystem support is unavailable with legacy "
708088eea45cSKlaus Jensen                    "namespace ('drive' property)");
7081784fd353SKlaus Jensen         return false;
708288eea45cSKlaus Jensen     }
708388eea45cSKlaus Jensen 
708488eea45cSKlaus Jensen     if (params->max_ioqpairs < 1 ||
708588eea45cSKlaus Jensen         params->max_ioqpairs > NVME_MAX_IOQPAIRS) {
708688eea45cSKlaus Jensen         error_setg(errp, "max_ioqpairs must be between 1 and %d",
708788eea45cSKlaus Jensen                    NVME_MAX_IOQPAIRS);
7088784fd353SKlaus Jensen         return false;
708988eea45cSKlaus Jensen     }
709088eea45cSKlaus Jensen 
709188eea45cSKlaus Jensen     if (params->msix_qsize < 1 ||
709288eea45cSKlaus Jensen         params->msix_qsize > PCI_MSIX_FLAGS_QSIZE + 1) {
709388eea45cSKlaus Jensen         error_setg(errp, "msix_qsize must be between 1 and %d",
709488eea45cSKlaus Jensen                    PCI_MSIX_FLAGS_QSIZE + 1);
7095784fd353SKlaus Jensen         return false;
709688eea45cSKlaus Jensen     }
709788eea45cSKlaus Jensen 
709888eea45cSKlaus Jensen     if (!params->serial) {
709988eea45cSKlaus Jensen         error_setg(errp, "serial property not set");
7100784fd353SKlaus Jensen         return false;
710188eea45cSKlaus Jensen     }
710288eea45cSKlaus Jensen 
710388eea45cSKlaus Jensen     if (n->pmr.dev) {
710488eea45cSKlaus Jensen         if (host_memory_backend_is_mapped(n->pmr.dev)) {
710588eea45cSKlaus Jensen             error_setg(errp, "can't use already busy memdev: %s",
710688eea45cSKlaus Jensen                        object_get_canonical_path_component(OBJECT(n->pmr.dev)));
7107784fd353SKlaus Jensen             return false;
710888eea45cSKlaus Jensen         }
710988eea45cSKlaus Jensen 
711088eea45cSKlaus Jensen         if (!is_power_of_2(n->pmr.dev->size)) {
711188eea45cSKlaus Jensen             error_setg(errp, "pmr backend size needs to be power of 2 in size");
7112784fd353SKlaus Jensen             return false;
711388eea45cSKlaus Jensen         }
711488eea45cSKlaus Jensen 
711588eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, true);
711688eea45cSKlaus Jensen     }
711788eea45cSKlaus Jensen 
711888eea45cSKlaus Jensen     if (n->params.zasl > n->params.mdts) {
711988eea45cSKlaus Jensen         error_setg(errp, "zoned.zasl (Zone Append Size Limit) must be less "
712088eea45cSKlaus Jensen                    "than or equal to mdts (Maximum Data Transfer Size)");
7121784fd353SKlaus Jensen         return false;
712288eea45cSKlaus Jensen     }
712388eea45cSKlaus Jensen 
712488eea45cSKlaus Jensen     if (!n->params.vsl) {
712588eea45cSKlaus Jensen         error_setg(errp, "vsl must be non-zero");
7126784fd353SKlaus Jensen         return false;
712788eea45cSKlaus Jensen     }
712844c2c094SLukasz Maniak 
712944c2c094SLukasz Maniak     if (params->sriov_max_vfs) {
713044c2c094SLukasz Maniak         if (!n->subsys) {
713144c2c094SLukasz Maniak             error_setg(errp, "subsystem is required for the use of SR-IOV");
7132784fd353SKlaus Jensen             return false;
713344c2c094SLukasz Maniak         }
713444c2c094SLukasz Maniak 
713544c2c094SLukasz Maniak         if (params->sriov_max_vfs > NVME_MAX_VFS) {
713644c2c094SLukasz Maniak             error_setg(errp, "sriov_max_vfs must be between 0 and %d",
713744c2c094SLukasz Maniak                        NVME_MAX_VFS);
7138784fd353SKlaus Jensen             return false;
713944c2c094SLukasz Maniak         }
714044c2c094SLukasz Maniak 
714144c2c094SLukasz Maniak         if (params->cmb_size_mb) {
714244c2c094SLukasz Maniak             error_setg(errp, "CMB is not supported with SR-IOV");
7143784fd353SKlaus Jensen             return false;
714444c2c094SLukasz Maniak         }
714544c2c094SLukasz Maniak 
714644c2c094SLukasz Maniak         if (n->pmr.dev) {
714744c2c094SLukasz Maniak             error_setg(errp, "PMR is not supported with SR-IOV");
7148784fd353SKlaus Jensen             return false;
714944c2c094SLukasz Maniak         }
7150746d42b1SŁukasz Gieryk 
7151746d42b1SŁukasz Gieryk         if (!params->sriov_vq_flexible || !params->sriov_vi_flexible) {
7152746d42b1SŁukasz Gieryk             error_setg(errp, "both sriov_vq_flexible and sriov_vi_flexible"
7153746d42b1SŁukasz Gieryk                        " must be set for the use of SR-IOV");
7154784fd353SKlaus Jensen             return false;
7155746d42b1SŁukasz Gieryk         }
7156746d42b1SŁukasz Gieryk 
7157746d42b1SŁukasz Gieryk         if (params->sriov_vq_flexible < params->sriov_max_vfs * 2) {
7158746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_vq_flexible must be greater than or equal"
7159746d42b1SŁukasz Gieryk                        " to %d (sriov_max_vfs * 2)", params->sriov_max_vfs * 2);
7160784fd353SKlaus Jensen             return false;
7161746d42b1SŁukasz Gieryk         }
7162746d42b1SŁukasz Gieryk 
7163746d42b1SŁukasz Gieryk         if (params->max_ioqpairs < params->sriov_vq_flexible + 2) {
7164746d42b1SŁukasz Gieryk             error_setg(errp, "(max_ioqpairs - sriov_vq_flexible) must be"
7165746d42b1SŁukasz Gieryk                        " greater than or equal to 2");
7166784fd353SKlaus Jensen             return false;
7167746d42b1SŁukasz Gieryk         }
7168746d42b1SŁukasz Gieryk 
7169746d42b1SŁukasz Gieryk         if (params->sriov_vi_flexible < params->sriov_max_vfs) {
7170746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_vi_flexible must be greater than or equal"
7171746d42b1SŁukasz Gieryk                        " to %d (sriov_max_vfs)", params->sriov_max_vfs);
7172784fd353SKlaus Jensen             return false;
7173746d42b1SŁukasz Gieryk         }
7174746d42b1SŁukasz Gieryk 
7175746d42b1SŁukasz Gieryk         if (params->msix_qsize < params->sriov_vi_flexible + 1) {
7176746d42b1SŁukasz Gieryk             error_setg(errp, "(msix_qsize - sriov_vi_flexible) must be"
7177746d42b1SŁukasz Gieryk                        " greater than or equal to 1");
7178784fd353SKlaus Jensen             return false;
7179746d42b1SŁukasz Gieryk         }
7180746d42b1SŁukasz Gieryk 
7181746d42b1SŁukasz Gieryk         if (params->sriov_max_vi_per_vf &&
7182746d42b1SŁukasz Gieryk             (params->sriov_max_vi_per_vf - 1) % NVME_VF_RES_GRANULARITY) {
7183746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_max_vi_per_vf must meet:"
7184746d42b1SŁukasz Gieryk                        " (sriov_max_vi_per_vf - 1) %% %d == 0 and"
7185746d42b1SŁukasz Gieryk                        " sriov_max_vi_per_vf >= 1", NVME_VF_RES_GRANULARITY);
7186784fd353SKlaus Jensen             return false;
7187746d42b1SŁukasz Gieryk         }
7188746d42b1SŁukasz Gieryk 
7189746d42b1SŁukasz Gieryk         if (params->sriov_max_vq_per_vf &&
7190746d42b1SŁukasz Gieryk             (params->sriov_max_vq_per_vf < 2 ||
7191746d42b1SŁukasz Gieryk              (params->sriov_max_vq_per_vf - 1) % NVME_VF_RES_GRANULARITY)) {
7192746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_max_vq_per_vf must meet:"
7193746d42b1SŁukasz Gieryk                        " (sriov_max_vq_per_vf - 1) %% %d == 0 and"
7194746d42b1SŁukasz Gieryk                        " sriov_max_vq_per_vf >= 2", NVME_VF_RES_GRANULARITY);
7195784fd353SKlaus Jensen             return false;
7196746d42b1SŁukasz Gieryk         }
719744c2c094SLukasz Maniak     }
7198784fd353SKlaus Jensen 
7199784fd353SKlaus Jensen     return true;
720088eea45cSKlaus Jensen }
720188eea45cSKlaus Jensen 
720288eea45cSKlaus Jensen static void nvme_init_state(NvmeCtrl *n)
720388eea45cSKlaus Jensen {
72045e6f963fSLukasz Maniak     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
720599f48ae7SLukasz Maniak     NvmeSecCtrlList *list = &n->sec_ctrl_list;
720699f48ae7SLukasz Maniak     NvmeSecCtrlEntry *sctrl;
720748b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
7208746d42b1SŁukasz Gieryk     uint8_t max_vfs;
720999f48ae7SLukasz Maniak     int i;
72105e6f963fSLukasz Maniak 
721148b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
7212746d42b1SŁukasz Gieryk         sctrl = nvme_sctrl(n);
7213746d42b1SŁukasz Gieryk         max_vfs = 0;
7214746d42b1SŁukasz Gieryk         n->conf_ioqpairs = sctrl->nvq ? le16_to_cpu(sctrl->nvq) - 1 : 0;
7215746d42b1SŁukasz Gieryk         n->conf_msix_qsize = sctrl->nvi ? le16_to_cpu(sctrl->nvi) : 1;
7216746d42b1SŁukasz Gieryk     } else {
7217746d42b1SŁukasz Gieryk         max_vfs = n->params.sriov_max_vfs;
7218decc0261SŁukasz Gieryk         n->conf_ioqpairs = n->params.max_ioqpairs;
7219decc0261SŁukasz Gieryk         n->conf_msix_qsize = n->params.msix_qsize;
7220746d42b1SŁukasz Gieryk     }
7221decc0261SŁukasz Gieryk 
722288eea45cSKlaus Jensen     n->sq = g_new0(NvmeSQueue *, n->params.max_ioqpairs + 1);
722388eea45cSKlaus Jensen     n->cq = g_new0(NvmeCQueue *, n->params.max_ioqpairs + 1);
722488eea45cSKlaus Jensen     n->temperature = NVME_TEMPERATURE;
722588eea45cSKlaus Jensen     n->features.temp_thresh_hi = NVME_TEMPERATURE_WARNING;
722688eea45cSKlaus Jensen     n->starttime_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
722788eea45cSKlaus Jensen     n->aer_reqs = g_new0(NvmeRequest *, n->params.aerl + 1);
7228b7698b91SŁukasz Gieryk     QTAILQ_INIT(&n->aer_queue);
72295e6f963fSLukasz Maniak 
7230746d42b1SŁukasz Gieryk     list->numcntl = cpu_to_le16(max_vfs);
7231746d42b1SŁukasz Gieryk     for (i = 0; i < max_vfs; i++) {
723299f48ae7SLukasz Maniak         sctrl = &list->sec[i];
723399f48ae7SLukasz Maniak         sctrl->pcid = cpu_to_le16(n->cntlid);
723499f48ae7SLukasz Maniak         sctrl->vfn = cpu_to_le16(i + 1);
723599f48ae7SLukasz Maniak     }
723699f48ae7SLukasz Maniak 
72375e6f963fSLukasz Maniak     cap->cntlid = cpu_to_le16(n->cntlid);
7238746d42b1SŁukasz Gieryk     cap->crt = NVME_CRT_VQ | NVME_CRT_VI;
7239746d42b1SŁukasz Gieryk 
724048b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
7241746d42b1SŁukasz Gieryk         cap->vqprt = cpu_to_le16(1 + n->conf_ioqpairs);
7242746d42b1SŁukasz Gieryk     } else {
7243746d42b1SŁukasz Gieryk         cap->vqprt = cpu_to_le16(1 + n->params.max_ioqpairs -
7244746d42b1SŁukasz Gieryk                                  n->params.sriov_vq_flexible);
7245746d42b1SŁukasz Gieryk         cap->vqfrt = cpu_to_le32(n->params.sriov_vq_flexible);
7246746d42b1SŁukasz Gieryk         cap->vqrfap = cap->vqfrt;
7247746d42b1SŁukasz Gieryk         cap->vqgran = cpu_to_le16(NVME_VF_RES_GRANULARITY);
7248746d42b1SŁukasz Gieryk         cap->vqfrsm = n->params.sriov_max_vq_per_vf ?
7249746d42b1SŁukasz Gieryk                         cpu_to_le16(n->params.sriov_max_vq_per_vf) :
7250746d42b1SŁukasz Gieryk                         cap->vqfrt / MAX(max_vfs, 1);
7251746d42b1SŁukasz Gieryk     }
7252746d42b1SŁukasz Gieryk 
725348b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
7254746d42b1SŁukasz Gieryk         cap->viprt = cpu_to_le16(n->conf_msix_qsize);
7255746d42b1SŁukasz Gieryk     } else {
7256746d42b1SŁukasz Gieryk         cap->viprt = cpu_to_le16(n->params.msix_qsize -
7257746d42b1SŁukasz Gieryk                                  n->params.sriov_vi_flexible);
7258746d42b1SŁukasz Gieryk         cap->vifrt = cpu_to_le32(n->params.sriov_vi_flexible);
7259746d42b1SŁukasz Gieryk         cap->virfap = cap->vifrt;
7260746d42b1SŁukasz Gieryk         cap->vigran = cpu_to_le16(NVME_VF_RES_GRANULARITY);
7261746d42b1SŁukasz Gieryk         cap->vifrsm = n->params.sriov_max_vi_per_vf ?
7262746d42b1SŁukasz Gieryk                         cpu_to_le16(n->params.sriov_max_vi_per_vf) :
7263746d42b1SŁukasz Gieryk                         cap->vifrt / MAX(max_vfs, 1);
7264746d42b1SŁukasz Gieryk     }
726588eea45cSKlaus Jensen }
726688eea45cSKlaus Jensen 
726788eea45cSKlaus Jensen static void nvme_init_cmb(NvmeCtrl *n, PCIDevice *pci_dev)
726888eea45cSKlaus Jensen {
726988eea45cSKlaus Jensen     uint64_t cmb_size = n->params.cmb_size_mb * MiB;
727049e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
727188eea45cSKlaus Jensen 
727288eea45cSKlaus Jensen     n->cmb.buf = g_malloc0(cmb_size);
727388eea45cSKlaus Jensen     memory_region_init_io(&n->cmb.mem, OBJECT(n), &nvme_cmb_ops, n,
727488eea45cSKlaus Jensen                           "nvme-cmb", cmb_size);
727588eea45cSKlaus Jensen     pci_register_bar(pci_dev, NVME_CMB_BIR,
727688eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
727788eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
727888eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->cmb.mem);
727988eea45cSKlaus Jensen 
728049e03457SKlaus Jensen     NVME_CAP_SET_CMBS(cap, 1);
728149e03457SKlaus Jensen     stq_le_p(&n->bar.cap, cap);
728288eea45cSKlaus Jensen 
728388eea45cSKlaus Jensen     if (n->params.legacy_cmb) {
728488eea45cSKlaus Jensen         nvme_cmb_enable_regs(n);
728588eea45cSKlaus Jensen         n->cmb.cmse = true;
728688eea45cSKlaus Jensen     }
728788eea45cSKlaus Jensen }
728888eea45cSKlaus Jensen 
728988eea45cSKlaus Jensen static void nvme_init_pmr(NvmeCtrl *n, PCIDevice *pci_dev)
729088eea45cSKlaus Jensen {
729149e03457SKlaus Jensen     uint32_t pmrcap = ldl_le_p(&n->bar.pmrcap);
729288eea45cSKlaus Jensen 
729349e03457SKlaus Jensen     NVME_PMRCAP_SET_RDS(pmrcap, 1);
729449e03457SKlaus Jensen     NVME_PMRCAP_SET_WDS(pmrcap, 1);
729549e03457SKlaus Jensen     NVME_PMRCAP_SET_BIR(pmrcap, NVME_PMR_BIR);
729649e03457SKlaus Jensen     /* Turn on bit 1 support */
729749e03457SKlaus Jensen     NVME_PMRCAP_SET_PMRWBM(pmrcap, 0x02);
729849e03457SKlaus Jensen     NVME_PMRCAP_SET_CMSS(pmrcap, 1);
729949e03457SKlaus Jensen     stl_le_p(&n->bar.pmrcap, pmrcap);
730049e03457SKlaus Jensen 
730149e03457SKlaus Jensen     pci_register_bar(pci_dev, NVME_PMR_BIR,
730288eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
730388eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
730488eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->pmr.dev->mr);
730588eea45cSKlaus Jensen 
730688eea45cSKlaus Jensen     memory_region_set_enabled(&n->pmr.dev->mr, false);
730788eea45cSKlaus Jensen }
730888eea45cSKlaus Jensen 
7309aa817713SŁukasz Gieryk static uint64_t nvme_bar_size(unsigned total_queues, unsigned total_irqs,
7310aa817713SŁukasz Gieryk                               unsigned *msix_table_offset,
7311aa817713SŁukasz Gieryk                               unsigned *msix_pba_offset)
7312aa817713SŁukasz Gieryk {
7313aa817713SŁukasz Gieryk     uint64_t bar_size, msix_table_size, msix_pba_size;
7314aa817713SŁukasz Gieryk 
7315aa817713SŁukasz Gieryk     bar_size = sizeof(NvmeBar) + 2 * total_queues * NVME_DB_SIZE;
7316aa817713SŁukasz Gieryk     bar_size = QEMU_ALIGN_UP(bar_size, 4 * KiB);
7317aa817713SŁukasz Gieryk 
7318aa817713SŁukasz Gieryk     if (msix_table_offset) {
7319aa817713SŁukasz Gieryk         *msix_table_offset = bar_size;
7320aa817713SŁukasz Gieryk     }
7321aa817713SŁukasz Gieryk 
7322aa817713SŁukasz Gieryk     msix_table_size = PCI_MSIX_ENTRY_SIZE * total_irqs;
7323aa817713SŁukasz Gieryk     bar_size += msix_table_size;
7324aa817713SŁukasz Gieryk     bar_size = QEMU_ALIGN_UP(bar_size, 4 * KiB);
7325aa817713SŁukasz Gieryk 
7326aa817713SŁukasz Gieryk     if (msix_pba_offset) {
7327aa817713SŁukasz Gieryk         *msix_pba_offset = bar_size;
7328aa817713SŁukasz Gieryk     }
7329aa817713SŁukasz Gieryk 
7330aa817713SŁukasz Gieryk     msix_pba_size = QEMU_ALIGN_UP(total_irqs, 64) / 8;
7331aa817713SŁukasz Gieryk     bar_size += msix_pba_size;
7332aa817713SŁukasz Gieryk 
7333aa817713SŁukasz Gieryk     bar_size = pow2ceil(bar_size);
7334aa817713SŁukasz Gieryk     return bar_size;
7335aa817713SŁukasz Gieryk }
7336aa817713SŁukasz Gieryk 
7337746d42b1SŁukasz Gieryk static void nvme_init_sriov(NvmeCtrl *n, PCIDevice *pci_dev, uint16_t offset)
733844c2c094SLukasz Maniak {
733944c2c094SLukasz Maniak     uint16_t vf_dev_id = n->params.use_intel_id ?
734044c2c094SLukasz Maniak                          PCI_DEVICE_ID_INTEL_NVME : PCI_DEVICE_ID_REDHAT_NVME;
7341746d42b1SŁukasz Gieryk     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
7342746d42b1SŁukasz Gieryk     uint64_t bar_size = nvme_bar_size(le16_to_cpu(cap->vqfrsm),
7343746d42b1SŁukasz Gieryk                                       le16_to_cpu(cap->vifrsm),
7344746d42b1SŁukasz Gieryk                                       NULL, NULL);
734544c2c094SLukasz Maniak 
734644c2c094SLukasz Maniak     pcie_sriov_pf_init(pci_dev, offset, "nvme", vf_dev_id,
734744c2c094SLukasz Maniak                        n->params.sriov_max_vfs, n->params.sriov_max_vfs,
734844c2c094SLukasz Maniak                        NVME_VF_OFFSET, NVME_VF_STRIDE);
734944c2c094SLukasz Maniak 
735044c2c094SLukasz Maniak     pcie_sriov_pf_init_vf_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
735144c2c094SLukasz Maniak                               PCI_BASE_ADDRESS_MEM_TYPE_64, bar_size);
735244c2c094SLukasz Maniak }
735344c2c094SLukasz Maniak 
73541e9c685eSŁukasz Gieryk static int nvme_add_pm_capability(PCIDevice *pci_dev, uint8_t offset)
73551e9c685eSŁukasz Gieryk {
73561e9c685eSŁukasz Gieryk     Error *err = NULL;
73571e9c685eSŁukasz Gieryk     int ret;
73581e9c685eSŁukasz Gieryk 
73591e9c685eSŁukasz Gieryk     ret = pci_add_capability(pci_dev, PCI_CAP_ID_PM, offset,
73601e9c685eSŁukasz Gieryk                              PCI_PM_SIZEOF, &err);
73611e9c685eSŁukasz Gieryk     if (err) {
73621e9c685eSŁukasz Gieryk         error_report_err(err);
73631e9c685eSŁukasz Gieryk         return ret;
73641e9c685eSŁukasz Gieryk     }
73651e9c685eSŁukasz Gieryk 
73661e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->config + offset + PCI_PM_PMC,
73671e9c685eSŁukasz Gieryk                  PCI_PM_CAP_VER_1_2);
73681e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->config + offset + PCI_PM_CTRL,
73691e9c685eSŁukasz Gieryk                  PCI_PM_CTRL_NO_SOFT_RESET);
73701e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->wmask + offset + PCI_PM_CTRL,
73711e9c685eSŁukasz Gieryk                  PCI_PM_CTRL_STATE_MASK);
73721e9c685eSŁukasz Gieryk 
73731e9c685eSŁukasz Gieryk     return 0;
73741e9c685eSŁukasz Gieryk }
73751e9c685eSŁukasz Gieryk 
7376973f76cfSKlaus Jensen static bool nvme_init_pci(NvmeCtrl *n, PCIDevice *pci_dev, Error **errp)
737788eea45cSKlaus Jensen {
7378973f76cfSKlaus Jensen     ERRP_GUARD();
737988eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
7380aa817713SŁukasz Gieryk     uint64_t bar_size;
738188eea45cSKlaus Jensen     unsigned msix_table_offset, msix_pba_offset;
738288eea45cSKlaus Jensen     int ret;
738388eea45cSKlaus Jensen 
738488eea45cSKlaus Jensen     pci_conf[PCI_INTERRUPT_PIN] = 1;
738588eea45cSKlaus Jensen     pci_config_set_prog_interface(pci_conf, 0x2);
738688eea45cSKlaus Jensen 
738788eea45cSKlaus Jensen     if (n->params.use_intel_id) {
738888eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_INTEL);
738944c2c094SLukasz Maniak         pci_config_set_device_id(pci_conf, PCI_DEVICE_ID_INTEL_NVME);
739088eea45cSKlaus Jensen     } else {
739188eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_REDHAT);
739288eea45cSKlaus Jensen         pci_config_set_device_id(pci_conf, PCI_DEVICE_ID_REDHAT_NVME);
739388eea45cSKlaus Jensen     }
739488eea45cSKlaus Jensen 
739588eea45cSKlaus Jensen     pci_config_set_class(pci_conf, PCI_CLASS_STORAGE_EXPRESS);
73961e9c685eSŁukasz Gieryk     nvme_add_pm_capability(pci_dev, 0x60);
739788eea45cSKlaus Jensen     pcie_endpoint_cap_init(pci_dev, 0x80);
73981e9c685eSŁukasz Gieryk     pcie_cap_flr_init(pci_dev);
739944c2c094SLukasz Maniak     if (n->params.sriov_max_vfs) {
740044c2c094SLukasz Maniak         pcie_ari_init(pci_dev, 0x100, 1);
740144c2c094SLukasz Maniak     }
740288eea45cSKlaus Jensen 
74033bfcc517SŁukasz Gieryk     /* add one to max_ioqpairs to account for the admin queue pair */
7404aa817713SŁukasz Gieryk     bar_size = nvme_bar_size(n->params.max_ioqpairs + 1, n->params.msix_qsize,
7405aa817713SŁukasz Gieryk                              &msix_table_offset, &msix_pba_offset);
740688eea45cSKlaus Jensen 
740788eea45cSKlaus Jensen     memory_region_init(&n->bar0, OBJECT(n), "nvme-bar0", bar_size);
740888eea45cSKlaus Jensen     memory_region_init_io(&n->iomem, OBJECT(n), &nvme_mmio_ops, n, "nvme",
74093bfcc517SŁukasz Gieryk                           msix_table_offset);
741088eea45cSKlaus Jensen     memory_region_add_subregion(&n->bar0, 0, &n->iomem);
741188eea45cSKlaus Jensen 
741244c2c094SLukasz Maniak     if (pci_is_vf(pci_dev)) {
741344c2c094SLukasz Maniak         pcie_sriov_vf_register_bar(pci_dev, 0, &n->bar0);
741444c2c094SLukasz Maniak     } else {
741588eea45cSKlaus Jensen         pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
741688eea45cSKlaus Jensen                          PCI_BASE_ADDRESS_MEM_TYPE_64, &n->bar0);
741744c2c094SLukasz Maniak     }
741888eea45cSKlaus Jensen     ret = msix_init(pci_dev, n->params.msix_qsize,
741988eea45cSKlaus Jensen                     &n->bar0, 0, msix_table_offset,
7420973f76cfSKlaus Jensen                     &n->bar0, 0, msix_pba_offset, 0, errp);
742188eea45cSKlaus Jensen     if (ret == -ENOTSUP) {
7422973f76cfSKlaus Jensen         /* report that msix is not supported, but do not error out */
7423973f76cfSKlaus Jensen         warn_report_err(*errp);
7424973f76cfSKlaus Jensen         *errp = NULL;
7425973f76cfSKlaus Jensen     } else if (ret < 0) {
7426973f76cfSKlaus Jensen         /* propagate error to caller */
7427973f76cfSKlaus Jensen         return false;
742888eea45cSKlaus Jensen     }
742988eea45cSKlaus Jensen 
7430decc0261SŁukasz Gieryk     nvme_update_msixcap_ts(pci_dev, n->conf_msix_qsize);
7431decc0261SŁukasz Gieryk 
743288eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
743388eea45cSKlaus Jensen         nvme_init_cmb(n, pci_dev);
743488eea45cSKlaus Jensen     }
743588eea45cSKlaus Jensen 
743688eea45cSKlaus Jensen     if (n->pmr.dev) {
743788eea45cSKlaus Jensen         nvme_init_pmr(n, pci_dev);
743888eea45cSKlaus Jensen     }
743988eea45cSKlaus Jensen 
744044c2c094SLukasz Maniak     if (!pci_is_vf(pci_dev) && n->params.sriov_max_vfs) {
7441746d42b1SŁukasz Gieryk         nvme_init_sriov(n, pci_dev, 0x120);
744244c2c094SLukasz Maniak     }
744344c2c094SLukasz Maniak 
7444973f76cfSKlaus Jensen     return true;
744588eea45cSKlaus Jensen }
744688eea45cSKlaus Jensen 
744788eea45cSKlaus Jensen static void nvme_init_subnqn(NvmeCtrl *n)
744888eea45cSKlaus Jensen {
744988eea45cSKlaus Jensen     NvmeSubsystem *subsys = n->subsys;
745088eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
745188eea45cSKlaus Jensen 
745288eea45cSKlaus Jensen     if (!subsys) {
745388eea45cSKlaus Jensen         snprintf((char *)id->subnqn, sizeof(id->subnqn),
745488eea45cSKlaus Jensen                  "nqn.2019-08.org.qemu:%s", n->params.serial);
745588eea45cSKlaus Jensen     } else {
745688eea45cSKlaus Jensen         pstrcpy((char *)id->subnqn, sizeof(id->subnqn), (char*)subsys->subnqn);
745788eea45cSKlaus Jensen     }
745888eea45cSKlaus Jensen }
745988eea45cSKlaus Jensen 
746088eea45cSKlaus Jensen static void nvme_init_ctrl(NvmeCtrl *n, PCIDevice *pci_dev)
746188eea45cSKlaus Jensen {
746288eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
746388eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
746449e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
7465746d42b1SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl = nvme_sctrl(n);
7466771dbc3aSKlaus Jensen     uint32_t ctratt;
746788eea45cSKlaus Jensen 
746888eea45cSKlaus Jensen     id->vid = cpu_to_le16(pci_get_word(pci_conf + PCI_VENDOR_ID));
746988eea45cSKlaus Jensen     id->ssvid = cpu_to_le16(pci_get_word(pci_conf + PCI_SUBSYSTEM_VENDOR_ID));
747088eea45cSKlaus Jensen     strpadcpy((char *)id->mn, sizeof(id->mn), "QEMU NVMe Ctrl", ' ');
7471fbba243bSKlaus Jensen     strpadcpy((char *)id->fr, sizeof(id->fr), QEMU_VERSION, ' ');
747288eea45cSKlaus Jensen     strpadcpy((char *)id->sn, sizeof(id->sn), n->params.serial, ' ');
747388eea45cSKlaus Jensen 
747488eea45cSKlaus Jensen     id->cntlid = cpu_to_le16(n->cntlid);
747588eea45cSKlaus Jensen 
747688eea45cSKlaus Jensen     id->oaes = cpu_to_le32(NVME_OAES_NS_ATTR);
7477771dbc3aSKlaus Jensen     ctratt = NVME_CTRATT_ELBAS;
747888eea45cSKlaus Jensen 
747988eea45cSKlaus Jensen     id->rab = 6;
748088eea45cSKlaus Jensen 
748188eea45cSKlaus Jensen     if (n->params.use_intel_id) {
748288eea45cSKlaus Jensen         id->ieee[0] = 0xb3;
748388eea45cSKlaus Jensen         id->ieee[1] = 0x02;
748488eea45cSKlaus Jensen         id->ieee[2] = 0x00;
748588eea45cSKlaus Jensen     } else {
748688eea45cSKlaus Jensen         id->ieee[0] = 0x00;
748788eea45cSKlaus Jensen         id->ieee[1] = 0x54;
748888eea45cSKlaus Jensen         id->ieee[2] = 0x52;
748988eea45cSKlaus Jensen     }
749088eea45cSKlaus Jensen 
749188eea45cSKlaus Jensen     id->mdts = n->params.mdts;
749288eea45cSKlaus Jensen     id->ver = cpu_to_le32(NVME_SPEC_VER);
74933f7fe8deSJinhao Fan     id->oacs =
7494*e181d3daSGollu Appalanaidu         cpu_to_le16(NVME_OACS_NS_MGMT | NVME_OACS_FORMAT | NVME_OACS_DBBUF |
7495*e181d3daSGollu Appalanaidu                     NVME_OACS_DIRECTIVES);
749688eea45cSKlaus Jensen     id->cntrltype = 0x1;
749788eea45cSKlaus Jensen 
749888eea45cSKlaus Jensen     /*
749988eea45cSKlaus Jensen      * Because the controller always completes the Abort command immediately,
750088eea45cSKlaus Jensen      * there can never be more than one concurrently executing Abort command,
750188eea45cSKlaus Jensen      * so this value is never used for anything. Note that there can easily be
750288eea45cSKlaus Jensen      * many Abort commands in the queues, but they are not considered
750388eea45cSKlaus Jensen      * "executing" until processed by nvme_abort.
750488eea45cSKlaus Jensen      *
750588eea45cSKlaus Jensen      * The specification recommends a value of 3 for Abort Command Limit (four
750688eea45cSKlaus Jensen      * concurrently outstanding Abort commands), so lets use that though it is
750788eea45cSKlaus Jensen      * inconsequential.
750888eea45cSKlaus Jensen      */
750988eea45cSKlaus Jensen     id->acl = 3;
751088eea45cSKlaus Jensen     id->aerl = n->params.aerl;
751188eea45cSKlaus Jensen     id->frmw = (NVME_NUM_FW_SLOTS << 1) | NVME_FRMW_SLOT1_RO;
751288eea45cSKlaus Jensen     id->lpa = NVME_LPA_NS_SMART | NVME_LPA_CSE | NVME_LPA_EXTENDED;
751388eea45cSKlaus Jensen 
751488eea45cSKlaus Jensen     /* recommended default value (~70 C) */
751588eea45cSKlaus Jensen     id->wctemp = cpu_to_le16(NVME_TEMPERATURE_WARNING);
751688eea45cSKlaus Jensen     id->cctemp = cpu_to_le16(NVME_TEMPERATURE_CRITICAL);
751788eea45cSKlaus Jensen 
751888eea45cSKlaus Jensen     id->sqes = (0x6 << 4) | 0x6;
751988eea45cSKlaus Jensen     id->cqes = (0x4 << 4) | 0x4;
752088eea45cSKlaus Jensen     id->nn = cpu_to_le32(NVME_MAX_NAMESPACES);
752188eea45cSKlaus Jensen     id->oncs = cpu_to_le16(NVME_ONCS_WRITE_ZEROES | NVME_ONCS_TIMESTAMP |
752288eea45cSKlaus Jensen                            NVME_ONCS_FEATURES | NVME_ONCS_DSM |
752388eea45cSKlaus Jensen                            NVME_ONCS_COMPARE | NVME_ONCS_COPY);
752488eea45cSKlaus Jensen 
752588eea45cSKlaus Jensen     /*
752688eea45cSKlaus Jensen      * NOTE: If this device ever supports a command set that does NOT use 0x0
752788eea45cSKlaus Jensen      * as a Flush-equivalent operation, support for the broadcast NSID in Flush
752888eea45cSKlaus Jensen      * should probably be removed.
752988eea45cSKlaus Jensen      *
753088eea45cSKlaus Jensen      * See comment in nvme_io_cmd.
753188eea45cSKlaus Jensen      */
753288eea45cSKlaus Jensen     id->vwc = NVME_VWC_NSID_BROADCAST_SUPPORT | NVME_VWC_PRESENT;
753388eea45cSKlaus Jensen 
753444219b60SNaveen Nagar     id->ocfs = cpu_to_le16(NVME_OCFS_COPY_FORMAT_0 | NVME_OCFS_COPY_FORMAT_1);
7535b9147a3aSKlaus Jensen     id->sgls = cpu_to_le32(NVME_CTRL_SGLS_SUPPORT_NO_ALIGN);
753688eea45cSKlaus Jensen 
753788eea45cSKlaus Jensen     nvme_init_subnqn(n);
753888eea45cSKlaus Jensen 
753988eea45cSKlaus Jensen     id->psd[0].mp = cpu_to_le16(0x9c4);
754088eea45cSKlaus Jensen     id->psd[0].enlat = cpu_to_le32(0x10);
754188eea45cSKlaus Jensen     id->psd[0].exlat = cpu_to_le32(0x4);
754288eea45cSKlaus Jensen 
754388eea45cSKlaus Jensen     if (n->subsys) {
754488eea45cSKlaus Jensen         id->cmic |= NVME_CMIC_MULTI_CTRL;
7545771dbc3aSKlaus Jensen         ctratt |= NVME_CTRATT_ENDGRPS;
7546771dbc3aSKlaus Jensen 
7547771dbc3aSKlaus Jensen         id->endgidmax = cpu_to_le16(0x1);
754888eea45cSKlaus Jensen     }
754988eea45cSKlaus Jensen 
7550771dbc3aSKlaus Jensen     id->ctratt = cpu_to_le32(ctratt);
7551771dbc3aSKlaus Jensen 
755249e03457SKlaus Jensen     NVME_CAP_SET_MQES(cap, 0x7ff);
755349e03457SKlaus Jensen     NVME_CAP_SET_CQR(cap, 1);
755449e03457SKlaus Jensen     NVME_CAP_SET_TO(cap, 0xf);
755549e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_NVM);
755649e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_CSI_SUPP);
755749e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_ADMIN_ONLY);
755849e03457SKlaus Jensen     NVME_CAP_SET_MPSMAX(cap, 4);
755949e03457SKlaus Jensen     NVME_CAP_SET_CMBS(cap, n->params.cmb_size_mb ? 1 : 0);
756049e03457SKlaus Jensen     NVME_CAP_SET_PMRS(cap, n->pmr.dev ? 1 : 0);
756149e03457SKlaus Jensen     stq_le_p(&n->bar.cap, cap);
756288eea45cSKlaus Jensen 
756349e03457SKlaus Jensen     stl_le_p(&n->bar.vs, NVME_SPEC_VER);
756488eea45cSKlaus Jensen     n->bar.intmc = n->bar.intms = 0;
7565746d42b1SŁukasz Gieryk 
756648b32c28SKlaus Jensen     if (pci_is_vf(pci_dev) && !sctrl->scs) {
7567746d42b1SŁukasz Gieryk         stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
7568746d42b1SŁukasz Gieryk     }
756988eea45cSKlaus Jensen }
757088eea45cSKlaus Jensen 
757188eea45cSKlaus Jensen static int nvme_init_subsys(NvmeCtrl *n, Error **errp)
757288eea45cSKlaus Jensen {
757388eea45cSKlaus Jensen     int cntlid;
757488eea45cSKlaus Jensen 
757588eea45cSKlaus Jensen     if (!n->subsys) {
757688eea45cSKlaus Jensen         return 0;
757788eea45cSKlaus Jensen     }
757888eea45cSKlaus Jensen 
757988eea45cSKlaus Jensen     cntlid = nvme_subsys_register_ctrl(n, errp);
758088eea45cSKlaus Jensen     if (cntlid < 0) {
758188eea45cSKlaus Jensen         return -1;
758288eea45cSKlaus Jensen     }
758388eea45cSKlaus Jensen 
758488eea45cSKlaus Jensen     n->cntlid = cntlid;
758588eea45cSKlaus Jensen 
758688eea45cSKlaus Jensen     return 0;
758788eea45cSKlaus Jensen }
758888eea45cSKlaus Jensen 
758988eea45cSKlaus Jensen void nvme_attach_ns(NvmeCtrl *n, NvmeNamespace *ns)
759088eea45cSKlaus Jensen {
759188eea45cSKlaus Jensen     uint32_t nsid = ns->params.nsid;
759288eea45cSKlaus Jensen     assert(nsid && nsid <= NVME_MAX_NAMESPACES);
759388eea45cSKlaus Jensen 
759488eea45cSKlaus Jensen     n->namespaces[nsid] = ns;
759588eea45cSKlaus Jensen     ns->attached++;
759688eea45cSKlaus Jensen 
759788eea45cSKlaus Jensen     n->dmrsl = MIN_NON_ZERO(n->dmrsl,
759888eea45cSKlaus Jensen                             BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
759988eea45cSKlaus Jensen }
760088eea45cSKlaus Jensen 
760188eea45cSKlaus Jensen static void nvme_realize(PCIDevice *pci_dev, Error **errp)
760288eea45cSKlaus Jensen {
760388eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
760448b32c28SKlaus Jensen     DeviceState *dev = DEVICE(pci_dev);
760588eea45cSKlaus Jensen     NvmeNamespace *ns;
760644c2c094SLukasz Maniak     NvmeCtrl *pn = NVME(pcie_sriov_get_pf(pci_dev));
760744c2c094SLukasz Maniak 
760844c2c094SLukasz Maniak     if (pci_is_vf(pci_dev)) {
760944c2c094SLukasz Maniak         /*
761044c2c094SLukasz Maniak          * VFs derive settings from the parent. PF's lifespan exceeds
761144c2c094SLukasz Maniak          * that of VF's, so it's safe to share params.serial.
761244c2c094SLukasz Maniak          */
761344c2c094SLukasz Maniak         memcpy(&n->params, &pn->params, sizeof(NvmeParams));
761444c2c094SLukasz Maniak         n->subsys = pn->subsys;
761544c2c094SLukasz Maniak     }
761688eea45cSKlaus Jensen 
7617784fd353SKlaus Jensen     if (!nvme_check_params(n, errp)) {
761888eea45cSKlaus Jensen         return;
761988eea45cSKlaus Jensen     }
762088eea45cSKlaus Jensen 
762148b32c28SKlaus Jensen     qbus_init(&n->bus, sizeof(NvmeBus), TYPE_NVME_BUS, dev, dev->id);
762288eea45cSKlaus Jensen 
762388eea45cSKlaus Jensen     if (nvme_init_subsys(n, errp)) {
762488eea45cSKlaus Jensen         return;
762588eea45cSKlaus Jensen     }
76265e6f963fSLukasz Maniak     nvme_init_state(n);
7627973f76cfSKlaus Jensen     if (!nvme_init_pci(n, pci_dev, errp)) {
76285e6f963fSLukasz Maniak         return;
76295e6f963fSLukasz Maniak     }
763088eea45cSKlaus Jensen     nvme_init_ctrl(n, pci_dev);
763188eea45cSKlaus Jensen 
763288eea45cSKlaus Jensen     /* setup a namespace if the controller drive property was given */
763388eea45cSKlaus Jensen     if (n->namespace.blkconf.blk) {
763488eea45cSKlaus Jensen         ns = &n->namespace;
763588eea45cSKlaus Jensen         ns->params.nsid = 1;
763688eea45cSKlaus Jensen 
76375e4f6bccSKlaus Jensen         if (nvme_ns_setup(ns, errp)) {
763888eea45cSKlaus Jensen             return;
763988eea45cSKlaus Jensen         }
764088eea45cSKlaus Jensen 
764188eea45cSKlaus Jensen         nvme_attach_ns(n, ns);
764288eea45cSKlaus Jensen     }
764388eea45cSKlaus Jensen }
764488eea45cSKlaus Jensen 
764588eea45cSKlaus Jensen static void nvme_exit(PCIDevice *pci_dev)
764688eea45cSKlaus Jensen {
764788eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
764888eea45cSKlaus Jensen     NvmeNamespace *ns;
764988eea45cSKlaus Jensen     int i;
765088eea45cSKlaus Jensen 
76511e9c685eSŁukasz Gieryk     nvme_ctrl_reset(n, NVME_RESET_FUNCTION);
765288eea45cSKlaus Jensen 
76535ffbaeedSKlaus Jensen     if (n->subsys) {
765488eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
765588eea45cSKlaus Jensen             ns = nvme_ns(n, i);
76565ffbaeedSKlaus Jensen             if (ns) {
76575ffbaeedSKlaus Jensen                 ns->attached--;
76585ffbaeedSKlaus Jensen             }
765988eea45cSKlaus Jensen         }
766088eea45cSKlaus Jensen 
7661b0fde9e8SKlaus Jensen         nvme_subsys_unregister_ctrl(n->subsys, n);
7662b0fde9e8SKlaus Jensen     }
7663b0fde9e8SKlaus Jensen 
766488eea45cSKlaus Jensen     g_free(n->cq);
766588eea45cSKlaus Jensen     g_free(n->sq);
766688eea45cSKlaus Jensen     g_free(n->aer_reqs);
766788eea45cSKlaus Jensen 
766888eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
766988eea45cSKlaus Jensen         g_free(n->cmb.buf);
767088eea45cSKlaus Jensen     }
767188eea45cSKlaus Jensen 
767288eea45cSKlaus Jensen     if (n->pmr.dev) {
767388eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, false);
767488eea45cSKlaus Jensen     }
767544c2c094SLukasz Maniak 
767644c2c094SLukasz Maniak     if (!pci_is_vf(pci_dev) && n->params.sriov_max_vfs) {
767744c2c094SLukasz Maniak         pcie_sriov_pf_exit(pci_dev);
767844c2c094SLukasz Maniak     }
767944c2c094SLukasz Maniak 
768088eea45cSKlaus Jensen     msix_uninit(pci_dev, &n->bar0, &n->bar0);
768188eea45cSKlaus Jensen     memory_region_del_subregion(&n->bar0, &n->iomem);
768288eea45cSKlaus Jensen }
768388eea45cSKlaus Jensen 
768488eea45cSKlaus Jensen static Property nvme_props[] = {
768588eea45cSKlaus Jensen     DEFINE_BLOCK_PROPERTIES(NvmeCtrl, namespace.blkconf),
768688eea45cSKlaus Jensen     DEFINE_PROP_LINK("pmrdev", NvmeCtrl, pmr.dev, TYPE_MEMORY_BACKEND,
768788eea45cSKlaus Jensen                      HostMemoryBackend *),
768888eea45cSKlaus Jensen     DEFINE_PROP_LINK("subsys", NvmeCtrl, subsys, TYPE_NVME_SUBSYS,
768988eea45cSKlaus Jensen                      NvmeSubsystem *),
769088eea45cSKlaus Jensen     DEFINE_PROP_STRING("serial", NvmeCtrl, params.serial),
769188eea45cSKlaus Jensen     DEFINE_PROP_UINT32("cmb_size_mb", NvmeCtrl, params.cmb_size_mb, 0),
769288eea45cSKlaus Jensen     DEFINE_PROP_UINT32("num_queues", NvmeCtrl, params.num_queues, 0),
769388eea45cSKlaus Jensen     DEFINE_PROP_UINT32("max_ioqpairs", NvmeCtrl, params.max_ioqpairs, 64),
769488eea45cSKlaus Jensen     DEFINE_PROP_UINT16("msix_qsize", NvmeCtrl, params.msix_qsize, 65),
769588eea45cSKlaus Jensen     DEFINE_PROP_UINT8("aerl", NvmeCtrl, params.aerl, 3),
769688eea45cSKlaus Jensen     DEFINE_PROP_UINT32("aer_max_queued", NvmeCtrl, params.aer_max_queued, 64),
769788eea45cSKlaus Jensen     DEFINE_PROP_UINT8("mdts", NvmeCtrl, params.mdts, 7),
769888eea45cSKlaus Jensen     DEFINE_PROP_UINT8("vsl", NvmeCtrl, params.vsl, 7),
769988eea45cSKlaus Jensen     DEFINE_PROP_BOOL("use-intel-id", NvmeCtrl, params.use_intel_id, false),
770088eea45cSKlaus Jensen     DEFINE_PROP_BOOL("legacy-cmb", NvmeCtrl, params.legacy_cmb, false),
7701e2e137f6SKlaus Jensen     DEFINE_PROP_BOOL("ioeventfd", NvmeCtrl, params.ioeventfd, false),
770288eea45cSKlaus Jensen     DEFINE_PROP_UINT8("zoned.zasl", NvmeCtrl, params.zasl, 0),
7703cccc2651SNiklas Cassel     DEFINE_PROP_BOOL("zoned.auto_transition", NvmeCtrl,
7704cccc2651SNiklas Cassel                      params.auto_transition_zones, true),
770544c2c094SLukasz Maniak     DEFINE_PROP_UINT8("sriov_max_vfs", NvmeCtrl, params.sriov_max_vfs, 0),
7706746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT16("sriov_vq_flexible", NvmeCtrl,
7707746d42b1SŁukasz Gieryk                        params.sriov_vq_flexible, 0),
7708746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT16("sriov_vi_flexible", NvmeCtrl,
7709746d42b1SŁukasz Gieryk                        params.sriov_vi_flexible, 0),
7710746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT8("sriov_max_vi_per_vf", NvmeCtrl,
7711746d42b1SŁukasz Gieryk                       params.sriov_max_vi_per_vf, 0),
7712746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT8("sriov_max_vq_per_vf", NvmeCtrl,
7713746d42b1SŁukasz Gieryk                       params.sriov_max_vq_per_vf, 0),
771488eea45cSKlaus Jensen     DEFINE_PROP_END_OF_LIST(),
771588eea45cSKlaus Jensen };
771688eea45cSKlaus Jensen 
771788eea45cSKlaus Jensen static void nvme_get_smart_warning(Object *obj, Visitor *v, const char *name,
771888eea45cSKlaus Jensen                                    void *opaque, Error **errp)
771988eea45cSKlaus Jensen {
772088eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
772188eea45cSKlaus Jensen     uint8_t value = n->smart_critical_warning;
772288eea45cSKlaus Jensen 
772388eea45cSKlaus Jensen     visit_type_uint8(v, name, &value, errp);
772488eea45cSKlaus Jensen }
772588eea45cSKlaus Jensen 
772688eea45cSKlaus Jensen static void nvme_set_smart_warning(Object *obj, Visitor *v, const char *name,
772788eea45cSKlaus Jensen                                    void *opaque, Error **errp)
772888eea45cSKlaus Jensen {
772988eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
773088eea45cSKlaus Jensen     uint8_t value, old_value, cap = 0, index, event;
773188eea45cSKlaus Jensen 
773288eea45cSKlaus Jensen     if (!visit_type_uint8(v, name, &value, errp)) {
773388eea45cSKlaus Jensen         return;
773488eea45cSKlaus Jensen     }
773588eea45cSKlaus Jensen 
773688eea45cSKlaus Jensen     cap = NVME_SMART_SPARE | NVME_SMART_TEMPERATURE | NVME_SMART_RELIABILITY
773788eea45cSKlaus Jensen           | NVME_SMART_MEDIA_READ_ONLY | NVME_SMART_FAILED_VOLATILE_MEDIA;
773849e03457SKlaus Jensen     if (NVME_CAP_PMRS(ldq_le_p(&n->bar.cap))) {
773988eea45cSKlaus Jensen         cap |= NVME_SMART_PMR_UNRELIABLE;
774088eea45cSKlaus Jensen     }
774188eea45cSKlaus Jensen 
774288eea45cSKlaus Jensen     if ((value & cap) != value) {
774388eea45cSKlaus Jensen         error_setg(errp, "unsupported smart critical warning bits: 0x%x",
774488eea45cSKlaus Jensen                    value & ~cap);
774588eea45cSKlaus Jensen         return;
774688eea45cSKlaus Jensen     }
774788eea45cSKlaus Jensen 
774888eea45cSKlaus Jensen     old_value = n->smart_critical_warning;
774988eea45cSKlaus Jensen     n->smart_critical_warning = value;
775088eea45cSKlaus Jensen 
775188eea45cSKlaus Jensen     /* only inject new bits of smart critical warning */
775288eea45cSKlaus Jensen     for (index = 0; index < NVME_SMART_WARN_MAX; index++) {
775388eea45cSKlaus Jensen         event = 1 << index;
775488eea45cSKlaus Jensen         if (value & ~old_value & event)
775588eea45cSKlaus Jensen             nvme_smart_event(n, event);
775688eea45cSKlaus Jensen     }
775788eea45cSKlaus Jensen }
775888eea45cSKlaus Jensen 
77591e9c685eSŁukasz Gieryk static void nvme_pci_reset(DeviceState *qdev)
77601e9c685eSŁukasz Gieryk {
77611e9c685eSŁukasz Gieryk     PCIDevice *pci_dev = PCI_DEVICE(qdev);
77621e9c685eSŁukasz Gieryk     NvmeCtrl *n = NVME(pci_dev);
77631e9c685eSŁukasz Gieryk 
77641e9c685eSŁukasz Gieryk     trace_pci_nvme_pci_reset();
77651e9c685eSŁukasz Gieryk     nvme_ctrl_reset(n, NVME_RESET_FUNCTION);
77661e9c685eSŁukasz Gieryk }
77671e9c685eSŁukasz Gieryk 
776811871f53SŁukasz Gieryk static void nvme_sriov_pre_write_ctrl(PCIDevice *dev, uint32_t address,
776911871f53SŁukasz Gieryk                                       uint32_t val, int len)
777011871f53SŁukasz Gieryk {
777111871f53SŁukasz Gieryk     NvmeCtrl *n = NVME(dev);
777211871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
777311871f53SŁukasz Gieryk     uint16_t sriov_cap = dev->exp.sriov_cap;
777411871f53SŁukasz Gieryk     uint32_t off = address - sriov_cap;
777511871f53SŁukasz Gieryk     int i, num_vfs;
777611871f53SŁukasz Gieryk 
777711871f53SŁukasz Gieryk     if (!sriov_cap) {
777811871f53SŁukasz Gieryk         return;
777911871f53SŁukasz Gieryk     }
778011871f53SŁukasz Gieryk 
778111871f53SŁukasz Gieryk     if (range_covers_byte(off, len, PCI_SRIOV_CTRL)) {
778211871f53SŁukasz Gieryk         if (!(val & PCI_SRIOV_CTRL_VFE)) {
778311871f53SŁukasz Gieryk             num_vfs = pci_get_word(dev->config + sriov_cap + PCI_SRIOV_NUM_VF);
778411871f53SŁukasz Gieryk             for (i = 0; i < num_vfs; i++) {
778511871f53SŁukasz Gieryk                 sctrl = &n->sec_ctrl_list.sec[i];
778611871f53SŁukasz Gieryk                 nvme_virt_set_state(n, le16_to_cpu(sctrl->scid), false);
778711871f53SŁukasz Gieryk             }
778811871f53SŁukasz Gieryk         }
778911871f53SŁukasz Gieryk     }
779011871f53SŁukasz Gieryk }
779111871f53SŁukasz Gieryk 
77921e9c685eSŁukasz Gieryk static void nvme_pci_write_config(PCIDevice *dev, uint32_t address,
77931e9c685eSŁukasz Gieryk                                   uint32_t val, int len)
77941e9c685eSŁukasz Gieryk {
779511871f53SŁukasz Gieryk     nvme_sriov_pre_write_ctrl(dev, address, val, len);
77961e9c685eSŁukasz Gieryk     pci_default_write_config(dev, address, val, len);
77971e9c685eSŁukasz Gieryk     pcie_cap_flr_write_config(dev, address, val, len);
77981e9c685eSŁukasz Gieryk }
77991e9c685eSŁukasz Gieryk 
780088eea45cSKlaus Jensen static const VMStateDescription nvme_vmstate = {
780188eea45cSKlaus Jensen     .name = "nvme",
780288eea45cSKlaus Jensen     .unmigratable = 1,
780388eea45cSKlaus Jensen };
780488eea45cSKlaus Jensen 
780588eea45cSKlaus Jensen static void nvme_class_init(ObjectClass *oc, void *data)
780688eea45cSKlaus Jensen {
780788eea45cSKlaus Jensen     DeviceClass *dc = DEVICE_CLASS(oc);
780888eea45cSKlaus Jensen     PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc);
780988eea45cSKlaus Jensen 
781088eea45cSKlaus Jensen     pc->realize = nvme_realize;
78111e9c685eSŁukasz Gieryk     pc->config_write = nvme_pci_write_config;
781288eea45cSKlaus Jensen     pc->exit = nvme_exit;
781388eea45cSKlaus Jensen     pc->class_id = PCI_CLASS_STORAGE_EXPRESS;
781488eea45cSKlaus Jensen     pc->revision = 2;
781588eea45cSKlaus Jensen 
781688eea45cSKlaus Jensen     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
781788eea45cSKlaus Jensen     dc->desc = "Non-Volatile Memory Express";
781888eea45cSKlaus Jensen     device_class_set_props(dc, nvme_props);
781988eea45cSKlaus Jensen     dc->vmsd = &nvme_vmstate;
78201e9c685eSŁukasz Gieryk     dc->reset = nvme_pci_reset;
782188eea45cSKlaus Jensen }
782288eea45cSKlaus Jensen 
782388eea45cSKlaus Jensen static void nvme_instance_init(Object *obj)
782488eea45cSKlaus Jensen {
782588eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
782688eea45cSKlaus Jensen 
782788eea45cSKlaus Jensen     device_add_bootindex_property(obj, &n->namespace.blkconf.bootindex,
782888eea45cSKlaus Jensen                                   "bootindex", "/namespace@1,0",
782988eea45cSKlaus Jensen                                   DEVICE(obj));
783088eea45cSKlaus Jensen 
783188eea45cSKlaus Jensen     object_property_add(obj, "smart_critical_warning", "uint8",
783288eea45cSKlaus Jensen                         nvme_get_smart_warning,
783388eea45cSKlaus Jensen                         nvme_set_smart_warning, NULL, NULL);
783488eea45cSKlaus Jensen }
783588eea45cSKlaus Jensen 
783688eea45cSKlaus Jensen static const TypeInfo nvme_info = {
783788eea45cSKlaus Jensen     .name          = TYPE_NVME,
783888eea45cSKlaus Jensen     .parent        = TYPE_PCI_DEVICE,
783988eea45cSKlaus Jensen     .instance_size = sizeof(NvmeCtrl),
784088eea45cSKlaus Jensen     .instance_init = nvme_instance_init,
784188eea45cSKlaus Jensen     .class_init    = nvme_class_init,
784288eea45cSKlaus Jensen     .interfaces = (InterfaceInfo[]) {
784388eea45cSKlaus Jensen         { INTERFACE_PCIE_DEVICE },
784488eea45cSKlaus Jensen         { }
784588eea45cSKlaus Jensen     },
784688eea45cSKlaus Jensen };
784788eea45cSKlaus Jensen 
784888eea45cSKlaus Jensen static const TypeInfo nvme_bus_info = {
784988eea45cSKlaus Jensen     .name = TYPE_NVME_BUS,
785088eea45cSKlaus Jensen     .parent = TYPE_BUS,
785188eea45cSKlaus Jensen     .instance_size = sizeof(NvmeBus),
785288eea45cSKlaus Jensen };
785388eea45cSKlaus Jensen 
785488eea45cSKlaus Jensen static void nvme_register_types(void)
785588eea45cSKlaus Jensen {
785688eea45cSKlaus Jensen     type_register_static(&nvme_info);
785788eea45cSKlaus Jensen     type_register_static(&nvme_bus_info);
785888eea45cSKlaus Jensen }
785988eea45cSKlaus Jensen 
786088eea45cSKlaus Jensen type_init(nvme_register_types)
7861