xref: /openbmc/qemu/hw/nvme/ctrl.c (revision f63192b0)
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,
24173064edfSJesper Devantier     [NVME_FDP_MODE]                 = true,
24273064edfSJesper Devantier     [NVME_FDP_EVENTS]               = true,
24388eea45cSKlaus Jensen };
24488eea45cSKlaus Jensen 
24588eea45cSKlaus Jensen static const uint32_t nvme_feature_cap[NVME_FID_MAX] = {
24688eea45cSKlaus Jensen     [NVME_TEMPERATURE_THRESHOLD]    = NVME_FEAT_CAP_CHANGE,
24788eea45cSKlaus Jensen     [NVME_ERROR_RECOVERY]           = NVME_FEAT_CAP_CHANGE | NVME_FEAT_CAP_NS,
24888eea45cSKlaus Jensen     [NVME_VOLATILE_WRITE_CACHE]     = NVME_FEAT_CAP_CHANGE,
24988eea45cSKlaus Jensen     [NVME_NUMBER_OF_QUEUES]         = NVME_FEAT_CAP_CHANGE,
25088eea45cSKlaus Jensen     [NVME_ASYNCHRONOUS_EVENT_CONF]  = NVME_FEAT_CAP_CHANGE,
25188eea45cSKlaus Jensen     [NVME_TIMESTAMP]                = NVME_FEAT_CAP_CHANGE,
252d0c0697bSNaveen Nagar     [NVME_HOST_BEHAVIOR_SUPPORT]    = NVME_FEAT_CAP_CHANGE,
25388eea45cSKlaus Jensen     [NVME_COMMAND_SET_PROFILE]      = NVME_FEAT_CAP_CHANGE,
25473064edfSJesper Devantier     [NVME_FDP_MODE]                 = NVME_FEAT_CAP_CHANGE,
25573064edfSJesper Devantier     [NVME_FDP_EVENTS]               = NVME_FEAT_CAP_CHANGE | NVME_FEAT_CAP_NS,
25688eea45cSKlaus Jensen };
25788eea45cSKlaus Jensen 
25888eea45cSKlaus Jensen static const uint32_t nvme_cse_acs[256] = {
25988eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_SQ]        = NVME_CMD_EFF_CSUPP,
26088eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_SQ]        = NVME_CMD_EFF_CSUPP,
26188eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_LOG_PAGE]     = NVME_CMD_EFF_CSUPP,
26288eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_CQ]        = NVME_CMD_EFF_CSUPP,
26388eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_CQ]        = NVME_CMD_EFF_CSUPP,
26488eea45cSKlaus Jensen     [NVME_ADM_CMD_IDENTIFY]         = NVME_CMD_EFF_CSUPP,
26588eea45cSKlaus Jensen     [NVME_ADM_CMD_ABORT]            = NVME_CMD_EFF_CSUPP,
26688eea45cSKlaus Jensen     [NVME_ADM_CMD_SET_FEATURES]     = NVME_CMD_EFF_CSUPP,
26788eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_FEATURES]     = NVME_CMD_EFF_CSUPP,
26888eea45cSKlaus Jensen     [NVME_ADM_CMD_ASYNC_EV_REQ]     = NVME_CMD_EFF_CSUPP,
26988eea45cSKlaus Jensen     [NVME_ADM_CMD_NS_ATTACHMENT]    = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_NIC,
27011871f53SŁukasz Gieryk     [NVME_ADM_CMD_VIRT_MNGMT]       = NVME_CMD_EFF_CSUPP,
2713f7fe8deSJinhao Fan     [NVME_ADM_CMD_DBBUF_CONFIG]     = NVME_CMD_EFF_CSUPP,
27288eea45cSKlaus Jensen     [NVME_ADM_CMD_FORMAT_NVM]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
273e181d3daSGollu Appalanaidu     [NVME_ADM_CMD_DIRECTIVE_RECV]   = NVME_CMD_EFF_CSUPP,
274e181d3daSGollu Appalanaidu     [NVME_ADM_CMD_DIRECTIVE_SEND]   = NVME_CMD_EFF_CSUPP,
27588eea45cSKlaus Jensen };
27688eea45cSKlaus Jensen 
27788eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_none[256];
27888eea45cSKlaus Jensen 
27988eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_nvm[256] = {
28088eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28188eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28288eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28388eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
28488eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28588eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
28688eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
28788eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
28873064edfSJesper Devantier     [NVME_CMD_IO_MGMT_RECV]         = NVME_CMD_EFF_CSUPP,
28973064edfSJesper Devantier     [NVME_CMD_IO_MGMT_SEND]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29088eea45cSKlaus Jensen };
29188eea45cSKlaus Jensen 
29288eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_zoned[256] = {
29388eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29488eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29588eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29688eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
29788eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
29888eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
29988eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30088eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
30188eea45cSKlaus Jensen     [NVME_CMD_ZONE_APPEND]          = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30288eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_SEND]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
30388eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_RECV]       = NVME_CMD_EFF_CSUPP,
30488eea45cSKlaus Jensen };
30588eea45cSKlaus Jensen 
30688eea45cSKlaus Jensen static void nvme_process_sq(void *opaque);
30711871f53SŁukasz Gieryk static void nvme_ctrl_reset(NvmeCtrl *n, NvmeResetType rst);
30873064edfSJesper Devantier static inline uint64_t nvme_get_timestamp(const NvmeCtrl *n);
30988eea45cSKlaus Jensen 
31088eea45cSKlaus Jensen static uint16_t nvme_sqid(NvmeRequest *req)
31188eea45cSKlaus Jensen {
31288eea45cSKlaus Jensen     return le16_to_cpu(req->sq->sqid);
31388eea45cSKlaus Jensen }
31488eea45cSKlaus Jensen 
31573064edfSJesper Devantier static inline uint16_t nvme_make_pid(NvmeNamespace *ns, uint16_t rg,
31673064edfSJesper Devantier                                      uint16_t ph)
31773064edfSJesper Devantier {
31873064edfSJesper Devantier     uint16_t rgif = ns->endgrp->fdp.rgif;
31973064edfSJesper Devantier 
32073064edfSJesper Devantier     if (!rgif) {
32173064edfSJesper Devantier         return ph;
32273064edfSJesper Devantier     }
32373064edfSJesper Devantier 
32473064edfSJesper Devantier     return (rg << (16 - rgif)) | ph;
32573064edfSJesper Devantier }
32673064edfSJesper Devantier 
32773064edfSJesper Devantier static inline bool nvme_ph_valid(NvmeNamespace *ns, uint16_t ph)
32873064edfSJesper Devantier {
32973064edfSJesper Devantier     return ph < ns->fdp.nphs;
33073064edfSJesper Devantier }
33173064edfSJesper Devantier 
33273064edfSJesper Devantier static inline bool nvme_rg_valid(NvmeEnduranceGroup *endgrp, uint16_t rg)
33373064edfSJesper Devantier {
33473064edfSJesper Devantier     return rg < endgrp->fdp.nrg;
33573064edfSJesper Devantier }
33673064edfSJesper Devantier 
33773064edfSJesper Devantier static inline uint16_t nvme_pid2ph(NvmeNamespace *ns, uint16_t pid)
33873064edfSJesper Devantier {
33973064edfSJesper Devantier     uint16_t rgif = ns->endgrp->fdp.rgif;
34073064edfSJesper Devantier 
34173064edfSJesper Devantier     if (!rgif) {
34273064edfSJesper Devantier         return pid;
34373064edfSJesper Devantier     }
34473064edfSJesper Devantier 
34573064edfSJesper Devantier     return pid & ((1 << (15 - rgif)) - 1);
34673064edfSJesper Devantier }
34773064edfSJesper Devantier 
34873064edfSJesper Devantier static inline uint16_t nvme_pid2rg(NvmeNamespace *ns, uint16_t pid)
34973064edfSJesper Devantier {
35073064edfSJesper Devantier     uint16_t rgif = ns->endgrp->fdp.rgif;
35173064edfSJesper Devantier 
35273064edfSJesper Devantier     if (!rgif) {
35373064edfSJesper Devantier         return 0;
35473064edfSJesper Devantier     }
35573064edfSJesper Devantier 
35673064edfSJesper Devantier     return pid >> (16 - rgif);
35773064edfSJesper Devantier }
35873064edfSJesper Devantier 
35973064edfSJesper Devantier static inline bool nvme_parse_pid(NvmeNamespace *ns, uint16_t pid,
36073064edfSJesper Devantier                                   uint16_t *ph, uint16_t *rg)
36173064edfSJesper Devantier {
36273064edfSJesper Devantier     *rg = nvme_pid2rg(ns, pid);
36373064edfSJesper Devantier     *ph = nvme_pid2ph(ns, pid);
36473064edfSJesper Devantier 
36573064edfSJesper Devantier     return nvme_ph_valid(ns, *ph) && nvme_rg_valid(ns->endgrp, *rg);
36673064edfSJesper Devantier }
36773064edfSJesper Devantier 
36888eea45cSKlaus Jensen static void nvme_assign_zone_state(NvmeNamespace *ns, NvmeZone *zone,
36988eea45cSKlaus Jensen                                    NvmeZoneState state)
37088eea45cSKlaus Jensen {
37188eea45cSKlaus Jensen     if (QTAILQ_IN_USE(zone, entry)) {
37288eea45cSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
37388eea45cSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
37488eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->exp_open_zones, zone, entry);
37588eea45cSKlaus Jensen             break;
37688eea45cSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
37788eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
37888eea45cSKlaus Jensen             break;
37988eea45cSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
38088eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->closed_zones, zone, entry);
38188eea45cSKlaus Jensen             break;
38288eea45cSKlaus Jensen         case NVME_ZONE_STATE_FULL:
38388eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->full_zones, zone, entry);
38488eea45cSKlaus Jensen         default:
38588eea45cSKlaus Jensen             ;
38688eea45cSKlaus Jensen         }
38788eea45cSKlaus Jensen     }
38888eea45cSKlaus Jensen 
38988eea45cSKlaus Jensen     nvme_set_zone_state(zone, state);
39088eea45cSKlaus Jensen 
39188eea45cSKlaus Jensen     switch (state) {
39288eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
39388eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->exp_open_zones, zone, entry);
39488eea45cSKlaus Jensen         break;
39588eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
39688eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->imp_open_zones, zone, entry);
39788eea45cSKlaus Jensen         break;
39888eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
39988eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->closed_zones, zone, entry);
40088eea45cSKlaus Jensen         break;
40188eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
40288eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->full_zones, zone, entry);
40388eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
40488eea45cSKlaus Jensen         break;
40588eea45cSKlaus Jensen     default:
40688eea45cSKlaus Jensen         zone->d.za = 0;
40788eea45cSKlaus Jensen     }
40888eea45cSKlaus Jensen }
40988eea45cSKlaus Jensen 
410e321b4cdSKlaus Jensen static uint16_t nvme_zns_check_resources(NvmeNamespace *ns, uint32_t act,
411e321b4cdSKlaus Jensen                                          uint32_t opn, uint32_t zrwa)
41288eea45cSKlaus Jensen {
41388eea45cSKlaus Jensen     if (ns->params.max_active_zones != 0 &&
41488eea45cSKlaus Jensen         ns->nr_active_zones + act > ns->params.max_active_zones) {
41588eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_active_res(ns->params.max_active_zones);
41688eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_ACTIVE | NVME_DNR;
41788eea45cSKlaus Jensen     }
418e321b4cdSKlaus Jensen 
41988eea45cSKlaus Jensen     if (ns->params.max_open_zones != 0 &&
42088eea45cSKlaus Jensen         ns->nr_open_zones + opn > ns->params.max_open_zones) {
42188eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_open_res(ns->params.max_open_zones);
42288eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_OPEN | NVME_DNR;
42388eea45cSKlaus Jensen     }
42488eea45cSKlaus Jensen 
425e321b4cdSKlaus Jensen     if (zrwa > ns->zns.numzrwa) {
426e321b4cdSKlaus Jensen         return NVME_NOZRWA | NVME_DNR;
427e321b4cdSKlaus Jensen     }
428e321b4cdSKlaus Jensen 
42988eea45cSKlaus Jensen     return NVME_SUCCESS;
43088eea45cSKlaus Jensen }
43188eea45cSKlaus Jensen 
432e321b4cdSKlaus Jensen /*
433e321b4cdSKlaus Jensen  * Check if we can open a zone without exceeding open/active limits.
434e321b4cdSKlaus Jensen  * AOR stands for "Active and Open Resources" (see TP 4053 section 2.5).
435e321b4cdSKlaus Jensen  */
436e321b4cdSKlaus Jensen static uint16_t nvme_aor_check(NvmeNamespace *ns, uint32_t act, uint32_t opn)
437e321b4cdSKlaus Jensen {
438e321b4cdSKlaus Jensen     return nvme_zns_check_resources(ns, act, opn, 0);
439e321b4cdSKlaus Jensen }
440e321b4cdSKlaus Jensen 
44173064edfSJesper Devantier static NvmeFdpEvent *nvme_fdp_alloc_event(NvmeCtrl *n, NvmeFdpEventBuffer *ebuf)
44273064edfSJesper Devantier {
44373064edfSJesper Devantier     NvmeFdpEvent *ret = NULL;
44473064edfSJesper Devantier     bool is_full = ebuf->next == ebuf->start && ebuf->nelems;
44573064edfSJesper Devantier 
44673064edfSJesper Devantier     ret = &ebuf->events[ebuf->next++];
44773064edfSJesper Devantier     if (unlikely(ebuf->next == NVME_FDP_MAX_EVENTS)) {
44873064edfSJesper Devantier         ebuf->next = 0;
44973064edfSJesper Devantier     }
45073064edfSJesper Devantier     if (is_full) {
45173064edfSJesper Devantier         ebuf->start = ebuf->next;
45273064edfSJesper Devantier     } else {
45373064edfSJesper Devantier         ebuf->nelems++;
45473064edfSJesper Devantier     }
45573064edfSJesper Devantier 
45673064edfSJesper Devantier     memset(ret, 0, sizeof(NvmeFdpEvent));
45773064edfSJesper Devantier     ret->timestamp = nvme_get_timestamp(n);
45873064edfSJesper Devantier 
45973064edfSJesper Devantier     return ret;
46073064edfSJesper Devantier }
46173064edfSJesper Devantier 
46273064edfSJesper Devantier static inline int log_event(NvmeRuHandle *ruh, uint8_t event_type)
46373064edfSJesper Devantier {
46473064edfSJesper Devantier     return (ruh->event_filter >> nvme_fdp_evf_shifts[event_type]) & 0x1;
46573064edfSJesper Devantier }
46673064edfSJesper Devantier 
46773064edfSJesper Devantier static bool nvme_update_ruh(NvmeCtrl *n, NvmeNamespace *ns, uint16_t pid)
46873064edfSJesper Devantier {
46973064edfSJesper Devantier     NvmeEnduranceGroup *endgrp = ns->endgrp;
47073064edfSJesper Devantier     NvmeRuHandle *ruh;
47173064edfSJesper Devantier     NvmeReclaimUnit *ru;
47273064edfSJesper Devantier     NvmeFdpEvent *e = NULL;
47373064edfSJesper Devantier     uint16_t ph, rg, ruhid;
47473064edfSJesper Devantier 
47573064edfSJesper Devantier     if (!nvme_parse_pid(ns, pid, &ph, &rg)) {
47673064edfSJesper Devantier         return false;
47773064edfSJesper Devantier     }
47873064edfSJesper Devantier 
47973064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
48073064edfSJesper Devantier 
48173064edfSJesper Devantier     ruh = &endgrp->fdp.ruhs[ruhid];
48273064edfSJesper Devantier     ru = &ruh->rus[rg];
48373064edfSJesper Devantier 
48473064edfSJesper Devantier     if (ru->ruamw) {
48573064edfSJesper Devantier         if (log_event(ruh, FDP_EVT_RU_NOT_FULLY_WRITTEN)) {
48673064edfSJesper Devantier             e = nvme_fdp_alloc_event(n, &endgrp->fdp.host_events);
48773064edfSJesper Devantier             e->type = FDP_EVT_RU_NOT_FULLY_WRITTEN;
48873064edfSJesper Devantier             e->flags = FDPEF_PIV | FDPEF_NSIDV | FDPEF_LV;
48973064edfSJesper Devantier             e->pid = cpu_to_le16(pid);
49073064edfSJesper Devantier             e->nsid = cpu_to_le32(ns->params.nsid);
49173064edfSJesper Devantier             e->rgid = cpu_to_le16(rg);
49273064edfSJesper Devantier             e->ruhid = cpu_to_le16(ruhid);
49373064edfSJesper Devantier         }
49473064edfSJesper Devantier 
49573064edfSJesper Devantier         /* log (eventual) GC overhead of prematurely swapping the RU */
49673064edfSJesper Devantier         nvme_fdp_stat_inc(&endgrp->fdp.mbmw, nvme_l2b(ns, ru->ruamw));
49773064edfSJesper Devantier     }
49873064edfSJesper Devantier 
49973064edfSJesper Devantier     ru->ruamw = ruh->ruamw;
50073064edfSJesper Devantier 
50173064edfSJesper Devantier     return true;
50273064edfSJesper Devantier }
50373064edfSJesper Devantier 
50488eea45cSKlaus Jensen static bool nvme_addr_is_cmb(NvmeCtrl *n, hwaddr addr)
50588eea45cSKlaus Jensen {
50688eea45cSKlaus Jensen     hwaddr hi, lo;
50788eea45cSKlaus Jensen 
50888eea45cSKlaus Jensen     if (!n->cmb.cmse) {
50988eea45cSKlaus Jensen         return false;
51088eea45cSKlaus Jensen     }
51188eea45cSKlaus Jensen 
51288eea45cSKlaus Jensen     lo = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
51388eea45cSKlaus Jensen     hi = lo + int128_get64(n->cmb.mem.size);
51488eea45cSKlaus Jensen 
51588eea45cSKlaus Jensen     return addr >= lo && addr < hi;
51688eea45cSKlaus Jensen }
51788eea45cSKlaus Jensen 
51888eea45cSKlaus Jensen static inline void *nvme_addr_to_cmb(NvmeCtrl *n, hwaddr addr)
51988eea45cSKlaus Jensen {
52088eea45cSKlaus Jensen     hwaddr base = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
52188eea45cSKlaus Jensen     return &n->cmb.buf[addr - base];
52288eea45cSKlaus Jensen }
52388eea45cSKlaus Jensen 
52488eea45cSKlaus Jensen static bool nvme_addr_is_pmr(NvmeCtrl *n, hwaddr addr)
52588eea45cSKlaus Jensen {
52688eea45cSKlaus Jensen     hwaddr hi;
52788eea45cSKlaus Jensen 
52888eea45cSKlaus Jensen     if (!n->pmr.cmse) {
52988eea45cSKlaus Jensen         return false;
53088eea45cSKlaus Jensen     }
53188eea45cSKlaus Jensen 
53288eea45cSKlaus Jensen     hi = n->pmr.cba + int128_get64(n->pmr.dev->mr.size);
53388eea45cSKlaus Jensen 
53488eea45cSKlaus Jensen     return addr >= n->pmr.cba && addr < hi;
53588eea45cSKlaus Jensen }
53688eea45cSKlaus Jensen 
53788eea45cSKlaus Jensen static inline void *nvme_addr_to_pmr(NvmeCtrl *n, hwaddr addr)
53888eea45cSKlaus Jensen {
53988eea45cSKlaus Jensen     return memory_region_get_ram_ptr(&n->pmr.dev->mr) + (addr - n->pmr.cba);
54088eea45cSKlaus Jensen }
54188eea45cSKlaus Jensen 
542736b0164SKlaus Jensen static inline bool nvme_addr_is_iomem(NvmeCtrl *n, hwaddr addr)
543736b0164SKlaus Jensen {
544736b0164SKlaus Jensen     hwaddr hi, lo;
545736b0164SKlaus Jensen 
546736b0164SKlaus Jensen     /*
547736b0164SKlaus Jensen      * The purpose of this check is to guard against invalid "local" access to
548736b0164SKlaus Jensen      * the iomem (i.e. controller registers). Thus, we check against the range
549736b0164SKlaus Jensen      * covered by the 'bar0' MemoryRegion since that is currently composed of
550736b0164SKlaus Jensen      * two subregions (the NVMe "MBAR" and the MSI-X table/pba). Note, however,
551736b0164SKlaus Jensen      * that if the device model is ever changed to allow the CMB to be located
552736b0164SKlaus Jensen      * in BAR0 as well, then this must be changed.
553736b0164SKlaus Jensen      */
554736b0164SKlaus Jensen     lo = n->bar0.addr;
555736b0164SKlaus Jensen     hi = lo + int128_get64(n->bar0.size);
556736b0164SKlaus Jensen 
557736b0164SKlaus Jensen     return addr >= lo && addr < hi;
558736b0164SKlaus Jensen }
559736b0164SKlaus Jensen 
56088eea45cSKlaus Jensen static int nvme_addr_read(NvmeCtrl *n, hwaddr addr, void *buf, int size)
56188eea45cSKlaus Jensen {
56288eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
56388eea45cSKlaus Jensen     if (hi < addr) {
56488eea45cSKlaus Jensen         return 1;
56588eea45cSKlaus Jensen     }
56688eea45cSKlaus Jensen 
56788eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
56888eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_cmb(n, addr), size);
56988eea45cSKlaus Jensen         return 0;
57088eea45cSKlaus Jensen     }
57188eea45cSKlaus Jensen 
57288eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
57388eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_pmr(n, addr), size);
57488eea45cSKlaus Jensen         return 0;
57588eea45cSKlaus Jensen     }
57688eea45cSKlaus Jensen 
57748b32c28SKlaus Jensen     return pci_dma_read(PCI_DEVICE(n), addr, buf, size);
57888eea45cSKlaus Jensen }
57988eea45cSKlaus Jensen 
580e080ce86SPhilippe Mathieu-Daudé static int nvme_addr_write(NvmeCtrl *n, hwaddr addr, const void *buf, int size)
58188eea45cSKlaus Jensen {
58288eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
58388eea45cSKlaus Jensen     if (hi < addr) {
58488eea45cSKlaus Jensen         return 1;
58588eea45cSKlaus Jensen     }
58688eea45cSKlaus Jensen 
58788eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
58888eea45cSKlaus Jensen         memcpy(nvme_addr_to_cmb(n, addr), buf, size);
58988eea45cSKlaus Jensen         return 0;
59088eea45cSKlaus Jensen     }
59188eea45cSKlaus Jensen 
59288eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
59388eea45cSKlaus Jensen         memcpy(nvme_addr_to_pmr(n, addr), buf, size);
59488eea45cSKlaus Jensen         return 0;
59588eea45cSKlaus Jensen     }
59688eea45cSKlaus Jensen 
59748b32c28SKlaus Jensen     return pci_dma_write(PCI_DEVICE(n), addr, buf, size);
59888eea45cSKlaus Jensen }
59988eea45cSKlaus Jensen 
60088eea45cSKlaus Jensen static bool nvme_nsid_valid(NvmeCtrl *n, uint32_t nsid)
60188eea45cSKlaus Jensen {
60288eea45cSKlaus Jensen     return nsid &&
60388eea45cSKlaus Jensen         (nsid == NVME_NSID_BROADCAST || nsid <= NVME_MAX_NAMESPACES);
60488eea45cSKlaus Jensen }
60588eea45cSKlaus Jensen 
60688eea45cSKlaus Jensen static int nvme_check_sqid(NvmeCtrl *n, uint16_t sqid)
60788eea45cSKlaus Jensen {
608decc0261SŁukasz Gieryk     return sqid < n->conf_ioqpairs + 1 && n->sq[sqid] != NULL ? 0 : -1;
60988eea45cSKlaus Jensen }
61088eea45cSKlaus Jensen 
61188eea45cSKlaus Jensen static int nvme_check_cqid(NvmeCtrl *n, uint16_t cqid)
61288eea45cSKlaus Jensen {
613decc0261SŁukasz Gieryk     return cqid < n->conf_ioqpairs + 1 && n->cq[cqid] != NULL ? 0 : -1;
61488eea45cSKlaus Jensen }
61588eea45cSKlaus Jensen 
61688eea45cSKlaus Jensen static void nvme_inc_cq_tail(NvmeCQueue *cq)
61788eea45cSKlaus Jensen {
61888eea45cSKlaus Jensen     cq->tail++;
61988eea45cSKlaus Jensen     if (cq->tail >= cq->size) {
62088eea45cSKlaus Jensen         cq->tail = 0;
62188eea45cSKlaus Jensen         cq->phase = !cq->phase;
62288eea45cSKlaus Jensen     }
62388eea45cSKlaus Jensen }
62488eea45cSKlaus Jensen 
62588eea45cSKlaus Jensen static void nvme_inc_sq_head(NvmeSQueue *sq)
62688eea45cSKlaus Jensen {
62788eea45cSKlaus Jensen     sq->head = (sq->head + 1) % sq->size;
62888eea45cSKlaus Jensen }
62988eea45cSKlaus Jensen 
63088eea45cSKlaus Jensen static uint8_t nvme_cq_full(NvmeCQueue *cq)
63188eea45cSKlaus Jensen {
63288eea45cSKlaus Jensen     return (cq->tail + 1) % cq->size == cq->head;
63388eea45cSKlaus Jensen }
63488eea45cSKlaus Jensen 
63588eea45cSKlaus Jensen static uint8_t nvme_sq_empty(NvmeSQueue *sq)
63688eea45cSKlaus Jensen {
63788eea45cSKlaus Jensen     return sq->head == sq->tail;
63888eea45cSKlaus Jensen }
63988eea45cSKlaus Jensen 
64088eea45cSKlaus Jensen static void nvme_irq_check(NvmeCtrl *n)
64188eea45cSKlaus Jensen {
64248b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
64349e03457SKlaus Jensen     uint32_t intms = ldl_le_p(&n->bar.intms);
64449e03457SKlaus Jensen 
64548b32c28SKlaus Jensen     if (msix_enabled(pci)) {
64688eea45cSKlaus Jensen         return;
64788eea45cSKlaus Jensen     }
64849e03457SKlaus Jensen     if (~intms & n->irq_status) {
64948b32c28SKlaus Jensen         pci_irq_assert(pci);
65088eea45cSKlaus Jensen     } else {
65148b32c28SKlaus Jensen         pci_irq_deassert(pci);
65288eea45cSKlaus Jensen     }
65388eea45cSKlaus Jensen }
65488eea45cSKlaus Jensen 
65588eea45cSKlaus Jensen static void nvme_irq_assert(NvmeCtrl *n, NvmeCQueue *cq)
65688eea45cSKlaus Jensen {
65748b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
65848b32c28SKlaus Jensen 
65988eea45cSKlaus Jensen     if (cq->irq_enabled) {
66048b32c28SKlaus Jensen         if (msix_enabled(pci)) {
66188eea45cSKlaus Jensen             trace_pci_nvme_irq_msix(cq->vector);
66248b32c28SKlaus Jensen             msix_notify(pci, cq->vector);
66388eea45cSKlaus Jensen         } else {
66488eea45cSKlaus Jensen             trace_pci_nvme_irq_pin();
66588eea45cSKlaus Jensen             assert(cq->vector < 32);
66688eea45cSKlaus Jensen             n->irq_status |= 1 << cq->vector;
66788eea45cSKlaus Jensen             nvme_irq_check(n);
66888eea45cSKlaus Jensen         }
66988eea45cSKlaus Jensen     } else {
67088eea45cSKlaus Jensen         trace_pci_nvme_irq_masked();
67188eea45cSKlaus Jensen     }
67288eea45cSKlaus Jensen }
67388eea45cSKlaus Jensen 
67488eea45cSKlaus Jensen static void nvme_irq_deassert(NvmeCtrl *n, NvmeCQueue *cq)
67588eea45cSKlaus Jensen {
67688eea45cSKlaus Jensen     if (cq->irq_enabled) {
67748b32c28SKlaus Jensen         if (msix_enabled(PCI_DEVICE(n))) {
67888eea45cSKlaus Jensen             return;
67988eea45cSKlaus Jensen         } else {
68088eea45cSKlaus Jensen             assert(cq->vector < 32);
68183d7ed5cSKlaus Jensen             if (!n->cq_pending) {
68288eea45cSKlaus Jensen                 n->irq_status &= ~(1 << cq->vector);
68383d7ed5cSKlaus Jensen             }
68488eea45cSKlaus Jensen             nvme_irq_check(n);
68588eea45cSKlaus Jensen         }
68688eea45cSKlaus Jensen     }
68788eea45cSKlaus Jensen }
68888eea45cSKlaus Jensen 
68988eea45cSKlaus Jensen static void nvme_req_clear(NvmeRequest *req)
69088eea45cSKlaus Jensen {
69188eea45cSKlaus Jensen     req->ns = NULL;
69288eea45cSKlaus Jensen     req->opaque = NULL;
69388eea45cSKlaus Jensen     req->aiocb = NULL;
69488eea45cSKlaus Jensen     memset(&req->cqe, 0x0, sizeof(req->cqe));
69588eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
69688eea45cSKlaus Jensen }
69788eea45cSKlaus Jensen 
69888eea45cSKlaus Jensen static inline void nvme_sg_init(NvmeCtrl *n, NvmeSg *sg, bool dma)
69988eea45cSKlaus Jensen {
70088eea45cSKlaus Jensen     if (dma) {
70148b32c28SKlaus Jensen         pci_dma_sglist_init(&sg->qsg, PCI_DEVICE(n), 0);
70288eea45cSKlaus Jensen         sg->flags = NVME_SG_DMA;
70388eea45cSKlaus Jensen     } else {
70488eea45cSKlaus Jensen         qemu_iovec_init(&sg->iov, 0);
70588eea45cSKlaus Jensen     }
70688eea45cSKlaus Jensen 
70788eea45cSKlaus Jensen     sg->flags |= NVME_SG_ALLOC;
70888eea45cSKlaus Jensen }
70988eea45cSKlaus Jensen 
71088eea45cSKlaus Jensen static inline void nvme_sg_unmap(NvmeSg *sg)
71188eea45cSKlaus Jensen {
71288eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_ALLOC)) {
71388eea45cSKlaus Jensen         return;
71488eea45cSKlaus Jensen     }
71588eea45cSKlaus Jensen 
71688eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
71788eea45cSKlaus Jensen         qemu_sglist_destroy(&sg->qsg);
71888eea45cSKlaus Jensen     } else {
71988eea45cSKlaus Jensen         qemu_iovec_destroy(&sg->iov);
72088eea45cSKlaus Jensen     }
72188eea45cSKlaus Jensen 
72288eea45cSKlaus Jensen     memset(sg, 0x0, sizeof(*sg));
72388eea45cSKlaus Jensen }
72488eea45cSKlaus Jensen 
72588eea45cSKlaus Jensen /*
72688eea45cSKlaus Jensen  * When metadata is transfered as extended LBAs, the DPTR mapped into `sg`
72788eea45cSKlaus Jensen  * holds both data and metadata. This function splits the data and metadata
72888eea45cSKlaus Jensen  * into two separate QSG/IOVs.
72988eea45cSKlaus Jensen  */
73088eea45cSKlaus Jensen static void nvme_sg_split(NvmeSg *sg, NvmeNamespace *ns, NvmeSg *data,
73188eea45cSKlaus Jensen                           NvmeSg *mdata)
73288eea45cSKlaus Jensen {
73388eea45cSKlaus Jensen     NvmeSg *dst = data;
73488eea45cSKlaus Jensen     uint32_t trans_len, count = ns->lbasz;
73588eea45cSKlaus Jensen     uint64_t offset = 0;
73688eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
73788eea45cSKlaus Jensen     size_t sge_len;
73888eea45cSKlaus Jensen     size_t sg_len = dma ? sg->qsg.size : sg->iov.size;
73988eea45cSKlaus Jensen     int sg_idx = 0;
74088eea45cSKlaus Jensen 
74188eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
74288eea45cSKlaus Jensen 
74388eea45cSKlaus Jensen     while (sg_len) {
74488eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
74588eea45cSKlaus Jensen 
74688eea45cSKlaus Jensen         trans_len = MIN(sg_len, count);
74788eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
74888eea45cSKlaus Jensen 
74988eea45cSKlaus Jensen         if (dst) {
75088eea45cSKlaus Jensen             if (dma) {
75188eea45cSKlaus Jensen                 qemu_sglist_add(&dst->qsg, sg->qsg.sg[sg_idx].base + offset,
75288eea45cSKlaus Jensen                                 trans_len);
75388eea45cSKlaus Jensen             } else {
75488eea45cSKlaus Jensen                 qemu_iovec_add(&dst->iov,
75588eea45cSKlaus Jensen                                sg->iov.iov[sg_idx].iov_base + offset,
75688eea45cSKlaus Jensen                                trans_len);
75788eea45cSKlaus Jensen             }
75888eea45cSKlaus Jensen         }
75988eea45cSKlaus Jensen 
76088eea45cSKlaus Jensen         sg_len -= trans_len;
76188eea45cSKlaus Jensen         count -= trans_len;
76288eea45cSKlaus Jensen         offset += trans_len;
76388eea45cSKlaus Jensen 
76488eea45cSKlaus Jensen         if (count == 0) {
76588eea45cSKlaus Jensen             dst = (dst == data) ? mdata : data;
76688eea45cSKlaus Jensen             count = (dst == data) ? ns->lbasz : ns->lbaf.ms;
76788eea45cSKlaus Jensen         }
76888eea45cSKlaus Jensen 
76988eea45cSKlaus Jensen         if (sge_len == offset) {
77088eea45cSKlaus Jensen             offset = 0;
77188eea45cSKlaus Jensen             sg_idx++;
77288eea45cSKlaus Jensen         }
77388eea45cSKlaus Jensen     }
77488eea45cSKlaus Jensen }
77588eea45cSKlaus Jensen 
77688eea45cSKlaus Jensen static uint16_t nvme_map_addr_cmb(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
77788eea45cSKlaus Jensen                                   size_t len)
77888eea45cSKlaus Jensen {
77988eea45cSKlaus Jensen     if (!len) {
78088eea45cSKlaus Jensen         return NVME_SUCCESS;
78188eea45cSKlaus Jensen     }
78288eea45cSKlaus Jensen 
78388eea45cSKlaus Jensen     trace_pci_nvme_map_addr_cmb(addr, len);
78488eea45cSKlaus Jensen 
78588eea45cSKlaus Jensen     if (!nvme_addr_is_cmb(n, addr) || !nvme_addr_is_cmb(n, addr + len - 1)) {
78688eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
78788eea45cSKlaus Jensen     }
78888eea45cSKlaus Jensen 
78988eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_cmb(n, addr), len);
79088eea45cSKlaus Jensen 
79188eea45cSKlaus Jensen     return NVME_SUCCESS;
79288eea45cSKlaus Jensen }
79388eea45cSKlaus Jensen 
79488eea45cSKlaus Jensen static uint16_t nvme_map_addr_pmr(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
79588eea45cSKlaus Jensen                                   size_t len)
79688eea45cSKlaus Jensen {
79788eea45cSKlaus Jensen     if (!len) {
79888eea45cSKlaus Jensen         return NVME_SUCCESS;
79988eea45cSKlaus Jensen     }
80088eea45cSKlaus Jensen 
80188eea45cSKlaus Jensen     if (!nvme_addr_is_pmr(n, addr) || !nvme_addr_is_pmr(n, addr + len - 1)) {
80288eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
80388eea45cSKlaus Jensen     }
80488eea45cSKlaus Jensen 
80588eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_pmr(n, addr), len);
80688eea45cSKlaus Jensen 
80788eea45cSKlaus Jensen     return NVME_SUCCESS;
80888eea45cSKlaus Jensen }
80988eea45cSKlaus Jensen 
81088eea45cSKlaus Jensen static uint16_t nvme_map_addr(NvmeCtrl *n, NvmeSg *sg, hwaddr addr, size_t len)
81188eea45cSKlaus Jensen {
81288eea45cSKlaus Jensen     bool cmb = false, pmr = false;
81388eea45cSKlaus Jensen 
81488eea45cSKlaus Jensen     if (!len) {
81588eea45cSKlaus Jensen         return NVME_SUCCESS;
81688eea45cSKlaus Jensen     }
81788eea45cSKlaus Jensen 
81888eea45cSKlaus Jensen     trace_pci_nvme_map_addr(addr, len);
81988eea45cSKlaus Jensen 
820736b0164SKlaus Jensen     if (nvme_addr_is_iomem(n, addr)) {
821736b0164SKlaus Jensen         return NVME_DATA_TRAS_ERROR;
822736b0164SKlaus Jensen     }
823736b0164SKlaus Jensen 
82488eea45cSKlaus Jensen     if (nvme_addr_is_cmb(n, addr)) {
82588eea45cSKlaus Jensen         cmb = true;
82688eea45cSKlaus Jensen     } else if (nvme_addr_is_pmr(n, addr)) {
82788eea45cSKlaus Jensen         pmr = true;
82888eea45cSKlaus Jensen     }
82988eea45cSKlaus Jensen 
83088eea45cSKlaus Jensen     if (cmb || pmr) {
83188eea45cSKlaus Jensen         if (sg->flags & NVME_SG_DMA) {
83288eea45cSKlaus Jensen             return NVME_INVALID_USE_OF_CMB | NVME_DNR;
83388eea45cSKlaus Jensen         }
83488eea45cSKlaus Jensen 
83523421473SPadmakar Kalghatgi         if (sg->iov.niov + 1 > IOV_MAX) {
83623421473SPadmakar Kalghatgi             goto max_mappings_exceeded;
83723421473SPadmakar Kalghatgi         }
83823421473SPadmakar Kalghatgi 
83988eea45cSKlaus Jensen         if (cmb) {
84088eea45cSKlaus Jensen             return nvme_map_addr_cmb(n, &sg->iov, addr, len);
84188eea45cSKlaus Jensen         } else {
84288eea45cSKlaus Jensen             return nvme_map_addr_pmr(n, &sg->iov, addr, len);
84388eea45cSKlaus Jensen         }
84488eea45cSKlaus Jensen     }
84588eea45cSKlaus Jensen 
84688eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_DMA)) {
84788eea45cSKlaus Jensen         return NVME_INVALID_USE_OF_CMB | NVME_DNR;
84888eea45cSKlaus Jensen     }
84988eea45cSKlaus Jensen 
85023421473SPadmakar Kalghatgi     if (sg->qsg.nsg + 1 > IOV_MAX) {
85123421473SPadmakar Kalghatgi         goto max_mappings_exceeded;
85223421473SPadmakar Kalghatgi     }
85323421473SPadmakar Kalghatgi 
85488eea45cSKlaus Jensen     qemu_sglist_add(&sg->qsg, addr, len);
85588eea45cSKlaus Jensen 
85688eea45cSKlaus Jensen     return NVME_SUCCESS;
85723421473SPadmakar Kalghatgi 
85823421473SPadmakar Kalghatgi max_mappings_exceeded:
85923421473SPadmakar Kalghatgi     NVME_GUEST_ERR(pci_nvme_ub_too_many_mappings,
86023421473SPadmakar Kalghatgi                    "number of mappings exceed 1024");
86123421473SPadmakar Kalghatgi     return NVME_INTERNAL_DEV_ERROR | NVME_DNR;
86288eea45cSKlaus Jensen }
86388eea45cSKlaus Jensen 
86488eea45cSKlaus Jensen static inline bool nvme_addr_is_dma(NvmeCtrl *n, hwaddr addr)
86588eea45cSKlaus Jensen {
86688eea45cSKlaus Jensen     return !(nvme_addr_is_cmb(n, addr) || nvme_addr_is_pmr(n, addr));
86788eea45cSKlaus Jensen }
86888eea45cSKlaus Jensen 
86988eea45cSKlaus Jensen static uint16_t nvme_map_prp(NvmeCtrl *n, NvmeSg *sg, uint64_t prp1,
87088eea45cSKlaus Jensen                              uint64_t prp2, uint32_t len)
87188eea45cSKlaus Jensen {
87288eea45cSKlaus Jensen     hwaddr trans_len = n->page_size - (prp1 % n->page_size);
87388eea45cSKlaus Jensen     trans_len = MIN(len, trans_len);
87488eea45cSKlaus Jensen     int num_prps = (len >> n->page_bits) + 1;
87588eea45cSKlaus Jensen     uint16_t status;
87688eea45cSKlaus Jensen     int ret;
87788eea45cSKlaus Jensen 
87888eea45cSKlaus Jensen     trace_pci_nvme_map_prp(trans_len, len, prp1, prp2, num_prps);
87988eea45cSKlaus Jensen 
88088eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, prp1));
88188eea45cSKlaus Jensen 
88288eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, prp1, trans_len);
88388eea45cSKlaus Jensen     if (status) {
88488eea45cSKlaus Jensen         goto unmap;
88588eea45cSKlaus Jensen     }
88688eea45cSKlaus Jensen 
88788eea45cSKlaus Jensen     len -= trans_len;
88888eea45cSKlaus Jensen     if (len) {
88988eea45cSKlaus Jensen         if (len > n->page_size) {
89088eea45cSKlaus Jensen             uint64_t prp_list[n->max_prp_ents];
89188eea45cSKlaus Jensen             uint32_t nents, prp_trans;
89288eea45cSKlaus Jensen             int i = 0;
89388eea45cSKlaus Jensen 
89488eea45cSKlaus Jensen             /*
89588eea45cSKlaus Jensen              * The first PRP list entry, pointed to by PRP2 may contain offset.
89688eea45cSKlaus Jensen              * Hence, we need to calculate the number of entries in based on
89788eea45cSKlaus Jensen              * that offset.
89888eea45cSKlaus Jensen              */
89988eea45cSKlaus Jensen             nents = (n->page_size - (prp2 & (n->page_size - 1))) >> 3;
90088eea45cSKlaus Jensen             prp_trans = MIN(n->max_prp_ents, nents) * sizeof(uint64_t);
90188eea45cSKlaus Jensen             ret = nvme_addr_read(n, prp2, (void *)prp_list, prp_trans);
90288eea45cSKlaus Jensen             if (ret) {
90388eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(prp2);
90488eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
90588eea45cSKlaus Jensen                 goto unmap;
90688eea45cSKlaus Jensen             }
90788eea45cSKlaus Jensen             while (len != 0) {
90888eea45cSKlaus Jensen                 uint64_t prp_ent = le64_to_cpu(prp_list[i]);
90988eea45cSKlaus Jensen 
91088eea45cSKlaus Jensen                 if (i == nents - 1 && len > n->page_size) {
91188eea45cSKlaus Jensen                     if (unlikely(prp_ent & (n->page_size - 1))) {
91288eea45cSKlaus Jensen                         trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
91388eea45cSKlaus Jensen                         status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
91488eea45cSKlaus Jensen                         goto unmap;
91588eea45cSKlaus Jensen                     }
91688eea45cSKlaus Jensen 
91788eea45cSKlaus Jensen                     i = 0;
91888eea45cSKlaus Jensen                     nents = (len + n->page_size - 1) >> n->page_bits;
91988eea45cSKlaus Jensen                     nents = MIN(nents, n->max_prp_ents);
92088eea45cSKlaus Jensen                     prp_trans = nents * sizeof(uint64_t);
92188eea45cSKlaus Jensen                     ret = nvme_addr_read(n, prp_ent, (void *)prp_list,
92288eea45cSKlaus Jensen                                          prp_trans);
92388eea45cSKlaus Jensen                     if (ret) {
92488eea45cSKlaus Jensen                         trace_pci_nvme_err_addr_read(prp_ent);
92588eea45cSKlaus Jensen                         status = NVME_DATA_TRAS_ERROR;
92688eea45cSKlaus Jensen                         goto unmap;
92788eea45cSKlaus Jensen                     }
92888eea45cSKlaus Jensen                     prp_ent = le64_to_cpu(prp_list[i]);
92988eea45cSKlaus Jensen                 }
93088eea45cSKlaus Jensen 
93188eea45cSKlaus Jensen                 if (unlikely(prp_ent & (n->page_size - 1))) {
93288eea45cSKlaus Jensen                     trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
93388eea45cSKlaus Jensen                     status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
93488eea45cSKlaus Jensen                     goto unmap;
93588eea45cSKlaus Jensen                 }
93688eea45cSKlaus Jensen 
93788eea45cSKlaus Jensen                 trans_len = MIN(len, n->page_size);
93888eea45cSKlaus Jensen                 status = nvme_map_addr(n, sg, prp_ent, trans_len);
93988eea45cSKlaus Jensen                 if (status) {
94088eea45cSKlaus Jensen                     goto unmap;
94188eea45cSKlaus Jensen                 }
94288eea45cSKlaus Jensen 
94388eea45cSKlaus Jensen                 len -= trans_len;
94488eea45cSKlaus Jensen                 i++;
94588eea45cSKlaus Jensen             }
94688eea45cSKlaus Jensen         } else {
94788eea45cSKlaus Jensen             if (unlikely(prp2 & (n->page_size - 1))) {
94888eea45cSKlaus Jensen                 trace_pci_nvme_err_invalid_prp2_align(prp2);
94988eea45cSKlaus Jensen                 status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
95088eea45cSKlaus Jensen                 goto unmap;
95188eea45cSKlaus Jensen             }
95288eea45cSKlaus Jensen             status = nvme_map_addr(n, sg, prp2, len);
95388eea45cSKlaus Jensen             if (status) {
95488eea45cSKlaus Jensen                 goto unmap;
95588eea45cSKlaus Jensen             }
95688eea45cSKlaus Jensen         }
95788eea45cSKlaus Jensen     }
95888eea45cSKlaus Jensen 
95988eea45cSKlaus Jensen     return NVME_SUCCESS;
96088eea45cSKlaus Jensen 
96188eea45cSKlaus Jensen unmap:
96288eea45cSKlaus Jensen     nvme_sg_unmap(sg);
96388eea45cSKlaus Jensen     return status;
96488eea45cSKlaus Jensen }
96588eea45cSKlaus Jensen 
96688eea45cSKlaus Jensen /*
96788eea45cSKlaus Jensen  * Map 'nsgld' data descriptors from 'segment'. The function will subtract the
96888eea45cSKlaus Jensen  * number of bytes mapped in len.
96988eea45cSKlaus Jensen  */
97088eea45cSKlaus Jensen static uint16_t nvme_map_sgl_data(NvmeCtrl *n, NvmeSg *sg,
97188eea45cSKlaus Jensen                                   NvmeSglDescriptor *segment, uint64_t nsgld,
97288eea45cSKlaus Jensen                                   size_t *len, NvmeCmd *cmd)
97388eea45cSKlaus Jensen {
97488eea45cSKlaus Jensen     dma_addr_t addr, trans_len;
97588eea45cSKlaus Jensen     uint32_t dlen;
97688eea45cSKlaus Jensen     uint16_t status;
97788eea45cSKlaus Jensen 
97888eea45cSKlaus Jensen     for (int i = 0; i < nsgld; i++) {
97988eea45cSKlaus Jensen         uint8_t type = NVME_SGL_TYPE(segment[i].type);
98088eea45cSKlaus Jensen 
98188eea45cSKlaus Jensen         switch (type) {
98288eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_DATA_BLOCK:
98388eea45cSKlaus Jensen             break;
98488eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
98588eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
98688eea45cSKlaus Jensen             return NVME_INVALID_NUM_SGL_DESCRS | NVME_DNR;
98788eea45cSKlaus Jensen         default:
98888eea45cSKlaus Jensen             return NVME_SGL_DESCR_TYPE_INVALID | NVME_DNR;
98988eea45cSKlaus Jensen         }
99088eea45cSKlaus Jensen 
99188eea45cSKlaus Jensen         dlen = le32_to_cpu(segment[i].len);
99288eea45cSKlaus Jensen 
99388eea45cSKlaus Jensen         if (!dlen) {
99488eea45cSKlaus Jensen             continue;
99588eea45cSKlaus Jensen         }
99688eea45cSKlaus Jensen 
99788eea45cSKlaus Jensen         if (*len == 0) {
99888eea45cSKlaus Jensen             /*
99988eea45cSKlaus Jensen              * All data has been mapped, but the SGL contains additional
100088eea45cSKlaus Jensen              * segments and/or descriptors. The controller might accept
100188eea45cSKlaus Jensen              * ignoring the rest of the SGL.
100288eea45cSKlaus Jensen              */
100388eea45cSKlaus Jensen             uint32_t sgls = le32_to_cpu(n->id_ctrl.sgls);
100488eea45cSKlaus Jensen             if (sgls & NVME_CTRL_SGLS_EXCESS_LENGTH) {
100588eea45cSKlaus Jensen                 break;
100688eea45cSKlaus Jensen             }
100788eea45cSKlaus Jensen 
100888eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_sgl_excess_length(dlen);
100988eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
101088eea45cSKlaus Jensen         }
101188eea45cSKlaus Jensen 
101288eea45cSKlaus Jensen         trans_len = MIN(*len, dlen);
101388eea45cSKlaus Jensen 
101488eea45cSKlaus Jensen         addr = le64_to_cpu(segment[i].addr);
101588eea45cSKlaus Jensen 
101688eea45cSKlaus Jensen         if (UINT64_MAX - addr < dlen) {
101788eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
101888eea45cSKlaus Jensen         }
101988eea45cSKlaus Jensen 
102088eea45cSKlaus Jensen         status = nvme_map_addr(n, sg, addr, trans_len);
102188eea45cSKlaus Jensen         if (status) {
102288eea45cSKlaus Jensen             return status;
102388eea45cSKlaus Jensen         }
102488eea45cSKlaus Jensen 
102588eea45cSKlaus Jensen         *len -= trans_len;
102688eea45cSKlaus Jensen     }
102788eea45cSKlaus Jensen 
102888eea45cSKlaus Jensen     return NVME_SUCCESS;
102988eea45cSKlaus Jensen }
103088eea45cSKlaus Jensen 
103188eea45cSKlaus Jensen static uint16_t nvme_map_sgl(NvmeCtrl *n, NvmeSg *sg, NvmeSglDescriptor sgl,
103288eea45cSKlaus Jensen                              size_t len, NvmeCmd *cmd)
103388eea45cSKlaus Jensen {
103488eea45cSKlaus Jensen     /*
103588eea45cSKlaus Jensen      * Read the segment in chunks of 256 descriptors (one 4k page) to avoid
103688eea45cSKlaus Jensen      * dynamically allocating a potentially huge SGL. The spec allows the SGL
103788eea45cSKlaus Jensen      * to be larger (as in number of bytes required to describe the SGL
103888eea45cSKlaus Jensen      * descriptors and segment chain) than the command transfer size, so it is
103988eea45cSKlaus Jensen      * not bounded by MDTS.
104088eea45cSKlaus Jensen      */
104188eea45cSKlaus Jensen     const int SEG_CHUNK_SIZE = 256;
104288eea45cSKlaus Jensen 
104388eea45cSKlaus Jensen     NvmeSglDescriptor segment[SEG_CHUNK_SIZE], *sgld, *last_sgld;
104488eea45cSKlaus Jensen     uint64_t nsgld;
104588eea45cSKlaus Jensen     uint32_t seg_len;
104688eea45cSKlaus Jensen     uint16_t status;
104788eea45cSKlaus Jensen     hwaddr addr;
104888eea45cSKlaus Jensen     int ret;
104988eea45cSKlaus Jensen 
105088eea45cSKlaus Jensen     sgld = &sgl;
105188eea45cSKlaus Jensen     addr = le64_to_cpu(sgl.addr);
105288eea45cSKlaus Jensen 
105388eea45cSKlaus Jensen     trace_pci_nvme_map_sgl(NVME_SGL_TYPE(sgl.type), len);
105488eea45cSKlaus Jensen 
105588eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, addr));
105688eea45cSKlaus Jensen 
105788eea45cSKlaus Jensen     /*
105888eea45cSKlaus Jensen      * If the entire transfer can be described with a single data block it can
105988eea45cSKlaus Jensen      * be mapped directly.
106088eea45cSKlaus Jensen      */
106188eea45cSKlaus Jensen     if (NVME_SGL_TYPE(sgl.type) == NVME_SGL_DESCR_TYPE_DATA_BLOCK) {
106288eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, sgld, 1, &len, cmd);
106388eea45cSKlaus Jensen         if (status) {
106488eea45cSKlaus Jensen             goto unmap;
106588eea45cSKlaus Jensen         }
106688eea45cSKlaus Jensen 
106788eea45cSKlaus Jensen         goto out;
106888eea45cSKlaus Jensen     }
106988eea45cSKlaus Jensen 
107088eea45cSKlaus Jensen     for (;;) {
107188eea45cSKlaus Jensen         switch (NVME_SGL_TYPE(sgld->type)) {
107288eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
107388eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
107488eea45cSKlaus Jensen             break;
107588eea45cSKlaus Jensen         default:
107688eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
107788eea45cSKlaus Jensen         }
107888eea45cSKlaus Jensen 
107988eea45cSKlaus Jensen         seg_len = le32_to_cpu(sgld->len);
108088eea45cSKlaus Jensen 
108188eea45cSKlaus Jensen         /* check the length of the (Last) Segment descriptor */
1082b9147a3aSKlaus Jensen         if (!seg_len || seg_len & 0xf) {
108388eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
108488eea45cSKlaus Jensen         }
108588eea45cSKlaus Jensen 
108688eea45cSKlaus Jensen         if (UINT64_MAX - addr < seg_len) {
108788eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
108888eea45cSKlaus Jensen         }
108988eea45cSKlaus Jensen 
109088eea45cSKlaus Jensen         nsgld = seg_len / sizeof(NvmeSglDescriptor);
109188eea45cSKlaus Jensen 
109288eea45cSKlaus Jensen         while (nsgld > SEG_CHUNK_SIZE) {
109388eea45cSKlaus Jensen             if (nvme_addr_read(n, addr, segment, sizeof(segment))) {
109488eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(addr);
109588eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
109688eea45cSKlaus Jensen                 goto unmap;
109788eea45cSKlaus Jensen             }
109888eea45cSKlaus Jensen 
109988eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, SEG_CHUNK_SIZE,
110088eea45cSKlaus Jensen                                        &len, cmd);
110188eea45cSKlaus Jensen             if (status) {
110288eea45cSKlaus Jensen                 goto unmap;
110388eea45cSKlaus Jensen             }
110488eea45cSKlaus Jensen 
110588eea45cSKlaus Jensen             nsgld -= SEG_CHUNK_SIZE;
110688eea45cSKlaus Jensen             addr += SEG_CHUNK_SIZE * sizeof(NvmeSglDescriptor);
110788eea45cSKlaus Jensen         }
110888eea45cSKlaus Jensen 
110988eea45cSKlaus Jensen         ret = nvme_addr_read(n, addr, segment, nsgld *
111088eea45cSKlaus Jensen                              sizeof(NvmeSglDescriptor));
111188eea45cSKlaus Jensen         if (ret) {
111288eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
111388eea45cSKlaus Jensen             status = NVME_DATA_TRAS_ERROR;
111488eea45cSKlaus Jensen             goto unmap;
111588eea45cSKlaus Jensen         }
111688eea45cSKlaus Jensen 
111788eea45cSKlaus Jensen         last_sgld = &segment[nsgld - 1];
111888eea45cSKlaus Jensen 
111988eea45cSKlaus Jensen         /*
1120b9147a3aSKlaus Jensen          * If the segment ends with a Data Block, then we are done.
112188eea45cSKlaus Jensen          */
1122b9147a3aSKlaus Jensen         if (NVME_SGL_TYPE(last_sgld->type) == NVME_SGL_DESCR_TYPE_DATA_BLOCK) {
112388eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, nsgld, &len, cmd);
112488eea45cSKlaus Jensen             if (status) {
112588eea45cSKlaus Jensen                 goto unmap;
112688eea45cSKlaus Jensen             }
112788eea45cSKlaus Jensen 
112888eea45cSKlaus Jensen             goto out;
112988eea45cSKlaus Jensen         }
113088eea45cSKlaus Jensen 
113188eea45cSKlaus Jensen         /*
1132b9147a3aSKlaus Jensen          * If the last descriptor was not a Data Block, then the current
1133b9147a3aSKlaus Jensen          * segment must not be a Last Segment.
113488eea45cSKlaus Jensen          */
113588eea45cSKlaus Jensen         if (NVME_SGL_TYPE(sgld->type) == NVME_SGL_DESCR_TYPE_LAST_SEGMENT) {
113688eea45cSKlaus Jensen             status = NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
113788eea45cSKlaus Jensen             goto unmap;
113888eea45cSKlaus Jensen         }
113988eea45cSKlaus Jensen 
114088eea45cSKlaus Jensen         sgld = last_sgld;
114188eea45cSKlaus Jensen         addr = le64_to_cpu(sgld->addr);
114288eea45cSKlaus Jensen 
114388eea45cSKlaus Jensen         /*
114488eea45cSKlaus Jensen          * Do not map the last descriptor; it will be a Segment or Last Segment
114588eea45cSKlaus Jensen          * descriptor and is handled by the next iteration.
114688eea45cSKlaus Jensen          */
114788eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, segment, nsgld - 1, &len, cmd);
114888eea45cSKlaus Jensen         if (status) {
114988eea45cSKlaus Jensen             goto unmap;
115088eea45cSKlaus Jensen         }
115188eea45cSKlaus Jensen     }
115288eea45cSKlaus Jensen 
115388eea45cSKlaus Jensen out:
115488eea45cSKlaus Jensen     /* if there is any residual left in len, the SGL was too short */
115588eea45cSKlaus Jensen     if (len) {
115688eea45cSKlaus Jensen         status = NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
115788eea45cSKlaus Jensen         goto unmap;
115888eea45cSKlaus Jensen     }
115988eea45cSKlaus Jensen 
116088eea45cSKlaus Jensen     return NVME_SUCCESS;
116188eea45cSKlaus Jensen 
116288eea45cSKlaus Jensen unmap:
116388eea45cSKlaus Jensen     nvme_sg_unmap(sg);
116488eea45cSKlaus Jensen     return status;
116588eea45cSKlaus Jensen }
116688eea45cSKlaus Jensen 
116788eea45cSKlaus Jensen uint16_t nvme_map_dptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
116888eea45cSKlaus Jensen                        NvmeCmd *cmd)
116988eea45cSKlaus Jensen {
117088eea45cSKlaus Jensen     uint64_t prp1, prp2;
117188eea45cSKlaus Jensen 
117288eea45cSKlaus Jensen     switch (NVME_CMD_FLAGS_PSDT(cmd->flags)) {
117388eea45cSKlaus Jensen     case NVME_PSDT_PRP:
117488eea45cSKlaus Jensen         prp1 = le64_to_cpu(cmd->dptr.prp1);
117588eea45cSKlaus Jensen         prp2 = le64_to_cpu(cmd->dptr.prp2);
117688eea45cSKlaus Jensen 
117788eea45cSKlaus Jensen         return nvme_map_prp(n, sg, prp1, prp2, len);
117888eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_CONTIGUOUS:
117988eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_SGL:
118088eea45cSKlaus Jensen         return nvme_map_sgl(n, sg, cmd->dptr.sgl, len, cmd);
118188eea45cSKlaus Jensen     default:
118288eea45cSKlaus Jensen         return NVME_INVALID_FIELD;
118388eea45cSKlaus Jensen     }
118488eea45cSKlaus Jensen }
118588eea45cSKlaus Jensen 
118688eea45cSKlaus Jensen static uint16_t nvme_map_mptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
118788eea45cSKlaus Jensen                               NvmeCmd *cmd)
118888eea45cSKlaus Jensen {
118988eea45cSKlaus Jensen     int psdt = NVME_CMD_FLAGS_PSDT(cmd->flags);
119088eea45cSKlaus Jensen     hwaddr mptr = le64_to_cpu(cmd->mptr);
119188eea45cSKlaus Jensen     uint16_t status;
119288eea45cSKlaus Jensen 
119388eea45cSKlaus Jensen     if (psdt == NVME_PSDT_SGL_MPTR_SGL) {
119488eea45cSKlaus Jensen         NvmeSglDescriptor sgl;
119588eea45cSKlaus Jensen 
119688eea45cSKlaus Jensen         if (nvme_addr_read(n, mptr, &sgl, sizeof(sgl))) {
119788eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
119888eea45cSKlaus Jensen         }
119988eea45cSKlaus Jensen 
120088eea45cSKlaus Jensen         status = nvme_map_sgl(n, sg, sgl, len, cmd);
120188eea45cSKlaus Jensen         if (status && (status & 0x7ff) == NVME_DATA_SGL_LEN_INVALID) {
120288eea45cSKlaus Jensen             status = NVME_MD_SGL_LEN_INVALID | NVME_DNR;
120388eea45cSKlaus Jensen         }
120488eea45cSKlaus Jensen 
120588eea45cSKlaus Jensen         return status;
120688eea45cSKlaus Jensen     }
120788eea45cSKlaus Jensen 
120888eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, mptr));
120988eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, mptr, len);
121088eea45cSKlaus Jensen     if (status) {
121188eea45cSKlaus Jensen         nvme_sg_unmap(sg);
121288eea45cSKlaus Jensen     }
121388eea45cSKlaus Jensen 
121488eea45cSKlaus Jensen     return status;
121588eea45cSKlaus Jensen }
121688eea45cSKlaus Jensen 
121788eea45cSKlaus Jensen static uint16_t nvme_map_data(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
121888eea45cSKlaus Jensen {
121988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
122088eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
12212a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
12222a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
122388eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
122488eea45cSKlaus Jensen     uint16_t status;
122588eea45cSKlaus Jensen 
1226ac0b34c5SKlaus Jensen     if (nvme_ns_ext(ns) &&
1227ac0b34c5SKlaus Jensen         !(pi && pract && ns->lbaf.ms == nvme_pi_tuple_size(ns))) {
122888eea45cSKlaus Jensen         NvmeSg sg;
122988eea45cSKlaus Jensen 
123088eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
123188eea45cSKlaus Jensen 
123288eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
123388eea45cSKlaus Jensen         if (status) {
123488eea45cSKlaus Jensen             return status;
123588eea45cSKlaus Jensen         }
123688eea45cSKlaus Jensen 
123788eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
123888eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, &req->sg, NULL);
123988eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
124088eea45cSKlaus Jensen 
124188eea45cSKlaus Jensen         return NVME_SUCCESS;
124288eea45cSKlaus Jensen     }
124388eea45cSKlaus Jensen 
124488eea45cSKlaus Jensen     return nvme_map_dptr(n, &req->sg, len, &req->cmd);
124588eea45cSKlaus Jensen }
124688eea45cSKlaus Jensen 
124788eea45cSKlaus Jensen static uint16_t nvme_map_mdata(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
124888eea45cSKlaus Jensen {
124988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
125088eea45cSKlaus Jensen     size_t len = nvme_m2b(ns, nlb);
125188eea45cSKlaus Jensen     uint16_t status;
125288eea45cSKlaus Jensen 
125388eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
125488eea45cSKlaus Jensen         NvmeSg sg;
125588eea45cSKlaus Jensen 
125688eea45cSKlaus Jensen         len += nvme_l2b(ns, nlb);
125788eea45cSKlaus Jensen 
125888eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
125988eea45cSKlaus Jensen         if (status) {
126088eea45cSKlaus Jensen             return status;
126188eea45cSKlaus Jensen         }
126288eea45cSKlaus Jensen 
126388eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
126488eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, NULL, &req->sg);
126588eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
126688eea45cSKlaus Jensen 
126788eea45cSKlaus Jensen         return NVME_SUCCESS;
126888eea45cSKlaus Jensen     }
126988eea45cSKlaus Jensen 
127088eea45cSKlaus Jensen     return nvme_map_mptr(n, &req->sg, len, &req->cmd);
127188eea45cSKlaus Jensen }
127288eea45cSKlaus Jensen 
127388eea45cSKlaus Jensen static uint16_t nvme_tx_interleaved(NvmeCtrl *n, NvmeSg *sg, uint8_t *ptr,
127488eea45cSKlaus Jensen                                     uint32_t len, uint32_t bytes,
127588eea45cSKlaus Jensen                                     int32_t skip_bytes, int64_t offset,
127688eea45cSKlaus Jensen                                     NvmeTxDirection dir)
127788eea45cSKlaus Jensen {
127888eea45cSKlaus Jensen     hwaddr addr;
127988eea45cSKlaus Jensen     uint32_t trans_len, count = bytes;
128088eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
128188eea45cSKlaus Jensen     int64_t sge_len;
128288eea45cSKlaus Jensen     int sg_idx = 0;
128388eea45cSKlaus Jensen     int ret;
128488eea45cSKlaus Jensen 
128588eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
128688eea45cSKlaus Jensen 
128788eea45cSKlaus Jensen     while (len) {
128888eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
128988eea45cSKlaus Jensen 
129088eea45cSKlaus Jensen         if (sge_len - offset < 0) {
129188eea45cSKlaus Jensen             offset -= sge_len;
129288eea45cSKlaus Jensen             sg_idx++;
129388eea45cSKlaus Jensen             continue;
129488eea45cSKlaus Jensen         }
129588eea45cSKlaus Jensen 
129688eea45cSKlaus Jensen         if (sge_len == offset) {
129788eea45cSKlaus Jensen             offset = 0;
129888eea45cSKlaus Jensen             sg_idx++;
129988eea45cSKlaus Jensen             continue;
130088eea45cSKlaus Jensen         }
130188eea45cSKlaus Jensen 
130288eea45cSKlaus Jensen         trans_len = MIN(len, count);
130388eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
130488eea45cSKlaus Jensen 
130588eea45cSKlaus Jensen         if (dma) {
130688eea45cSKlaus Jensen             addr = sg->qsg.sg[sg_idx].base + offset;
130788eea45cSKlaus Jensen         } else {
130888eea45cSKlaus Jensen             addr = (hwaddr)(uintptr_t)sg->iov.iov[sg_idx].iov_base + offset;
130988eea45cSKlaus Jensen         }
131088eea45cSKlaus Jensen 
131188eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
131288eea45cSKlaus Jensen             ret = nvme_addr_read(n, addr, ptr, trans_len);
131388eea45cSKlaus Jensen         } else {
131488eea45cSKlaus Jensen             ret = nvme_addr_write(n, addr, ptr, trans_len);
131588eea45cSKlaus Jensen         }
131688eea45cSKlaus Jensen 
131788eea45cSKlaus Jensen         if (ret) {
131888eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
131988eea45cSKlaus Jensen         }
132088eea45cSKlaus Jensen 
132188eea45cSKlaus Jensen         ptr += trans_len;
132288eea45cSKlaus Jensen         len -= trans_len;
132388eea45cSKlaus Jensen         count -= trans_len;
132488eea45cSKlaus Jensen         offset += trans_len;
132588eea45cSKlaus Jensen 
132688eea45cSKlaus Jensen         if (count == 0) {
132788eea45cSKlaus Jensen             count = bytes;
132888eea45cSKlaus Jensen             offset += skip_bytes;
132988eea45cSKlaus Jensen         }
133088eea45cSKlaus Jensen     }
133188eea45cSKlaus Jensen 
133288eea45cSKlaus Jensen     return NVME_SUCCESS;
133388eea45cSKlaus Jensen }
133488eea45cSKlaus Jensen 
13358d3a17beSPhilippe Mathieu-Daudé static uint16_t nvme_tx(NvmeCtrl *n, NvmeSg *sg, void *ptr, uint32_t len,
133688eea45cSKlaus Jensen                         NvmeTxDirection dir)
133788eea45cSKlaus Jensen {
133888eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
133988eea45cSKlaus Jensen 
134088eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
1341392e48afSPhilippe Mathieu-Daudé         const MemTxAttrs attrs = MEMTXATTRS_UNSPECIFIED;
1342bfa30f39SPhilippe Mathieu-Daudé         dma_addr_t residual;
134388eea45cSKlaus Jensen 
134488eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
1345f02b664aSPhilippe Mathieu-Daudé             dma_buf_write(ptr, len, &residual, &sg->qsg, attrs);
134688eea45cSKlaus Jensen         } else {
1347f02b664aSPhilippe Mathieu-Daudé             dma_buf_read(ptr, len, &residual, &sg->qsg, attrs);
134888eea45cSKlaus Jensen         }
134988eea45cSKlaus Jensen 
135088eea45cSKlaus Jensen         if (unlikely(residual)) {
135188eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
135288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
135388eea45cSKlaus Jensen         }
135488eea45cSKlaus Jensen     } else {
135588eea45cSKlaus Jensen         size_t bytes;
135688eea45cSKlaus Jensen 
135788eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
135888eea45cSKlaus Jensen             bytes = qemu_iovec_to_buf(&sg->iov, 0, ptr, len);
135988eea45cSKlaus Jensen         } else {
136088eea45cSKlaus Jensen             bytes = qemu_iovec_from_buf(&sg->iov, 0, ptr, len);
136188eea45cSKlaus Jensen         }
136288eea45cSKlaus Jensen 
136388eea45cSKlaus Jensen         if (unlikely(bytes != len)) {
136488eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
136588eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
136688eea45cSKlaus Jensen         }
136788eea45cSKlaus Jensen     }
136888eea45cSKlaus Jensen 
136988eea45cSKlaus Jensen     return NVME_SUCCESS;
137088eea45cSKlaus Jensen }
137188eea45cSKlaus Jensen 
13728d3a17beSPhilippe Mathieu-Daudé static inline uint16_t nvme_c2h(NvmeCtrl *n, void *ptr, uint32_t len,
137388eea45cSKlaus Jensen                                 NvmeRequest *req)
137488eea45cSKlaus Jensen {
137588eea45cSKlaus Jensen     uint16_t status;
137688eea45cSKlaus Jensen 
137788eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
137888eea45cSKlaus Jensen     if (status) {
137988eea45cSKlaus Jensen         return status;
138088eea45cSKlaus Jensen     }
138188eea45cSKlaus Jensen 
138288eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_FROM_DEVICE);
138388eea45cSKlaus Jensen }
138488eea45cSKlaus Jensen 
13858d3a17beSPhilippe Mathieu-Daudé static inline uint16_t nvme_h2c(NvmeCtrl *n, void *ptr, uint32_t len,
138688eea45cSKlaus Jensen                                 NvmeRequest *req)
138788eea45cSKlaus Jensen {
138888eea45cSKlaus Jensen     uint16_t status;
138988eea45cSKlaus Jensen 
139088eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
139188eea45cSKlaus Jensen     if (status) {
139288eea45cSKlaus Jensen         return status;
139388eea45cSKlaus Jensen     }
139488eea45cSKlaus Jensen 
139588eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_TO_DEVICE);
139688eea45cSKlaus Jensen }
139788eea45cSKlaus Jensen 
13988d3a17beSPhilippe Mathieu-Daudé uint16_t nvme_bounce_data(NvmeCtrl *n, void *ptr, uint32_t len,
139988eea45cSKlaus Jensen                           NvmeTxDirection dir, NvmeRequest *req)
140088eea45cSKlaus Jensen {
140188eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
140288eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
14032a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
14042a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
140588eea45cSKlaus Jensen 
1406ac0b34c5SKlaus Jensen     if (nvme_ns_ext(ns) &&
1407ac0b34c5SKlaus Jensen         !(pi && pract && ns->lbaf.ms == nvme_pi_tuple_size(ns))) {
140888eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbasz,
140988eea45cSKlaus Jensen                                    ns->lbaf.ms, 0, dir);
141088eea45cSKlaus Jensen     }
141188eea45cSKlaus Jensen 
141288eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
141388eea45cSKlaus Jensen }
141488eea45cSKlaus Jensen 
14158d3a17beSPhilippe Mathieu-Daudé uint16_t nvme_bounce_mdata(NvmeCtrl *n, void *ptr, uint32_t len,
141688eea45cSKlaus Jensen                            NvmeTxDirection dir, NvmeRequest *req)
141788eea45cSKlaus Jensen {
141888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
141988eea45cSKlaus Jensen     uint16_t status;
142088eea45cSKlaus Jensen 
142188eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
142288eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbaf.ms,
142388eea45cSKlaus Jensen                                    ns->lbasz, ns->lbasz, dir);
142488eea45cSKlaus Jensen     }
142588eea45cSKlaus Jensen 
142688eea45cSKlaus Jensen     nvme_sg_unmap(&req->sg);
142788eea45cSKlaus Jensen 
142888eea45cSKlaus Jensen     status = nvme_map_mptr(n, &req->sg, len, &req->cmd);
142988eea45cSKlaus Jensen     if (status) {
143088eea45cSKlaus Jensen         return status;
143188eea45cSKlaus Jensen     }
143288eea45cSKlaus Jensen 
143388eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
143488eea45cSKlaus Jensen }
143588eea45cSKlaus Jensen 
143688eea45cSKlaus Jensen static inline void nvme_blk_read(BlockBackend *blk, int64_t offset,
14379b4f0181SMateusz Kozlowski                                  uint32_t align, BlockCompletionFunc *cb,
14389b4f0181SMateusz Kozlowski                                  NvmeRequest *req)
143988eea45cSKlaus Jensen {
144088eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
144188eea45cSKlaus Jensen 
144288eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
14439b4f0181SMateusz Kozlowski         req->aiocb = dma_blk_read(blk, &req->sg.qsg, offset, align, cb, req);
144488eea45cSKlaus Jensen     } else {
144588eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &req->sg.iov, 0, cb, req);
144688eea45cSKlaus Jensen     }
144788eea45cSKlaus Jensen }
144888eea45cSKlaus Jensen 
144988eea45cSKlaus Jensen static inline void nvme_blk_write(BlockBackend *blk, int64_t offset,
14509b4f0181SMateusz Kozlowski                                   uint32_t align, BlockCompletionFunc *cb,
14519b4f0181SMateusz Kozlowski                                   NvmeRequest *req)
145288eea45cSKlaus Jensen {
145388eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
145488eea45cSKlaus Jensen 
145588eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
14569b4f0181SMateusz Kozlowski         req->aiocb = dma_blk_write(blk, &req->sg.qsg, offset, align, cb, req);
145788eea45cSKlaus Jensen     } else {
145888eea45cSKlaus Jensen         req->aiocb = blk_aio_pwritev(blk, offset, &req->sg.iov, 0, cb, req);
145988eea45cSKlaus Jensen     }
146088eea45cSKlaus Jensen }
146188eea45cSKlaus Jensen 
1462fa5db2aaSKlaus Jensen static void nvme_update_cq_eventidx(const NvmeCQueue *cq)
1463fa5db2aaSKlaus Jensen {
1464fa5db2aaSKlaus Jensen     uint32_t v = cpu_to_le32(cq->head);
1465fa5db2aaSKlaus Jensen 
1466fa5db2aaSKlaus Jensen     trace_pci_nvme_update_cq_eventidx(cq->cqid, cq->head);
1467fa5db2aaSKlaus Jensen 
1468fa5db2aaSKlaus Jensen     pci_dma_write(PCI_DEVICE(cq->ctrl), cq->ei_addr, &v, sizeof(v));
1469fa5db2aaSKlaus Jensen }
1470fa5db2aaSKlaus Jensen 
14713f7fe8deSJinhao Fan static void nvme_update_cq_head(NvmeCQueue *cq)
14723f7fe8deSJinhao Fan {
14732fda0726SKlaus Jensen     uint32_t v;
14742fda0726SKlaus Jensen 
14752fda0726SKlaus Jensen     pci_dma_read(PCI_DEVICE(cq->ctrl), cq->db_addr, &v, sizeof(v));
14762fda0726SKlaus Jensen 
14772fda0726SKlaus Jensen     cq->head = le32_to_cpu(v);
147847cd3539SKlaus Jensen 
147947cd3539SKlaus Jensen     trace_pci_nvme_update_cq_head(cq->cqid, cq->head);
14803f7fe8deSJinhao Fan }
14813f7fe8deSJinhao Fan 
148288eea45cSKlaus Jensen static void nvme_post_cqes(void *opaque)
148388eea45cSKlaus Jensen {
148488eea45cSKlaus Jensen     NvmeCQueue *cq = opaque;
148588eea45cSKlaus Jensen     NvmeCtrl *n = cq->ctrl;
148688eea45cSKlaus Jensen     NvmeRequest *req, *next;
148783d7ed5cSKlaus Jensen     bool pending = cq->head != cq->tail;
148888eea45cSKlaus Jensen     int ret;
148988eea45cSKlaus Jensen 
149088eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(req, &cq->req_list, entry, next) {
149188eea45cSKlaus Jensen         NvmeSQueue *sq;
149288eea45cSKlaus Jensen         hwaddr addr;
149388eea45cSKlaus Jensen 
14943f7fe8deSJinhao Fan         if (n->dbbuf_enabled) {
1495fa5db2aaSKlaus Jensen             nvme_update_cq_eventidx(cq);
14963f7fe8deSJinhao Fan             nvme_update_cq_head(cq);
14973f7fe8deSJinhao Fan         }
14983f7fe8deSJinhao Fan 
149988eea45cSKlaus Jensen         if (nvme_cq_full(cq)) {
150088eea45cSKlaus Jensen             break;
150188eea45cSKlaus Jensen         }
150288eea45cSKlaus Jensen 
150388eea45cSKlaus Jensen         sq = req->sq;
150488eea45cSKlaus Jensen         req->cqe.status = cpu_to_le16((req->status << 1) | cq->phase);
150588eea45cSKlaus Jensen         req->cqe.sq_id = cpu_to_le16(sq->sqid);
150688eea45cSKlaus Jensen         req->cqe.sq_head = cpu_to_le16(sq->head);
150788eea45cSKlaus Jensen         addr = cq->dma_addr + cq->tail * n->cqe_size;
150848b32c28SKlaus Jensen         ret = pci_dma_write(PCI_DEVICE(n), addr, (void *)&req->cqe,
150988eea45cSKlaus Jensen                             sizeof(req->cqe));
151088eea45cSKlaus Jensen         if (ret) {
151188eea45cSKlaus Jensen             trace_pci_nvme_err_addr_write(addr);
151288eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
151349e03457SKlaus Jensen             stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
151488eea45cSKlaus Jensen             break;
151588eea45cSKlaus Jensen         }
151688eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->req_list, req, entry);
151788eea45cSKlaus Jensen         nvme_inc_cq_tail(cq);
151888eea45cSKlaus Jensen         nvme_sg_unmap(&req->sg);
151988eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->req_list, req, entry);
152088eea45cSKlaus Jensen     }
152188eea45cSKlaus Jensen     if (cq->tail != cq->head) {
152283d7ed5cSKlaus Jensen         if (cq->irq_enabled && !pending) {
152383d7ed5cSKlaus Jensen             n->cq_pending++;
152483d7ed5cSKlaus Jensen         }
152583d7ed5cSKlaus Jensen 
152688eea45cSKlaus Jensen         nvme_irq_assert(n, cq);
152788eea45cSKlaus Jensen     }
152888eea45cSKlaus Jensen }
152988eea45cSKlaus Jensen 
153088eea45cSKlaus Jensen static void nvme_enqueue_req_completion(NvmeCQueue *cq, NvmeRequest *req)
153188eea45cSKlaus Jensen {
153288eea45cSKlaus Jensen     assert(cq->cqid == req->sq->cqid);
153388eea45cSKlaus Jensen     trace_pci_nvme_enqueue_req_completion(nvme_cid(req), cq->cqid,
1534f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.result),
1535f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.dw1),
153688eea45cSKlaus Jensen                                           req->status);
153788eea45cSKlaus Jensen 
153888eea45cSKlaus Jensen     if (req->status) {
153988eea45cSKlaus Jensen         trace_pci_nvme_err_req_status(nvme_cid(req), nvme_nsid(req->ns),
154088eea45cSKlaus Jensen                                       req->status, req->cmd.opcode);
154188eea45cSKlaus Jensen     }
154288eea45cSKlaus Jensen 
154388eea45cSKlaus Jensen     QTAILQ_REMOVE(&req->sq->out_req_list, req, entry);
154488eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&cq->req_list, req, entry);
15452e53b0b4SJinhao Fan 
1546d38cc6fdSKlaus Jensen     qemu_bh_schedule(cq->bh);
15472e53b0b4SJinhao Fan }
154888eea45cSKlaus Jensen 
154988eea45cSKlaus Jensen static void nvme_process_aers(void *opaque)
155088eea45cSKlaus Jensen {
155188eea45cSKlaus Jensen     NvmeCtrl *n = opaque;
155288eea45cSKlaus Jensen     NvmeAsyncEvent *event, *next;
155388eea45cSKlaus Jensen 
155488eea45cSKlaus Jensen     trace_pci_nvme_process_aers(n->aer_queued);
155588eea45cSKlaus Jensen 
155688eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(event, &n->aer_queue, entry, next) {
155788eea45cSKlaus Jensen         NvmeRequest *req;
155888eea45cSKlaus Jensen         NvmeAerResult *result;
155988eea45cSKlaus Jensen 
156088eea45cSKlaus Jensen         /* can't post cqe if there is nothing to complete */
156188eea45cSKlaus Jensen         if (!n->outstanding_aers) {
156288eea45cSKlaus Jensen             trace_pci_nvme_no_outstanding_aers();
156388eea45cSKlaus Jensen             break;
156488eea45cSKlaus Jensen         }
156588eea45cSKlaus Jensen 
156688eea45cSKlaus Jensen         /* ignore if masked (cqe posted, but event not cleared) */
156788eea45cSKlaus Jensen         if (n->aer_mask & (1 << event->result.event_type)) {
156888eea45cSKlaus Jensen             trace_pci_nvme_aer_masked(event->result.event_type, n->aer_mask);
156988eea45cSKlaus Jensen             continue;
157088eea45cSKlaus Jensen         }
157188eea45cSKlaus Jensen 
157288eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
157388eea45cSKlaus Jensen         n->aer_queued--;
157488eea45cSKlaus Jensen 
157588eea45cSKlaus Jensen         n->aer_mask |= 1 << event->result.event_type;
157688eea45cSKlaus Jensen         n->outstanding_aers--;
157788eea45cSKlaus Jensen 
157888eea45cSKlaus Jensen         req = n->aer_reqs[n->outstanding_aers];
157988eea45cSKlaus Jensen 
158088eea45cSKlaus Jensen         result = (NvmeAerResult *) &req->cqe.result;
158188eea45cSKlaus Jensen         result->event_type = event->result.event_type;
158288eea45cSKlaus Jensen         result->event_info = event->result.event_info;
158388eea45cSKlaus Jensen         result->log_page = event->result.log_page;
158488eea45cSKlaus Jensen         g_free(event);
158588eea45cSKlaus Jensen 
158688eea45cSKlaus Jensen         trace_pci_nvme_aer_post_cqe(result->event_type, result->event_info,
158788eea45cSKlaus Jensen                                     result->log_page);
158888eea45cSKlaus Jensen 
158988eea45cSKlaus Jensen         nvme_enqueue_req_completion(&n->admin_cq, req);
159088eea45cSKlaus Jensen     }
159188eea45cSKlaus Jensen }
159288eea45cSKlaus Jensen 
159388eea45cSKlaus Jensen static void nvme_enqueue_event(NvmeCtrl *n, uint8_t event_type,
159488eea45cSKlaus Jensen                                uint8_t event_info, uint8_t log_page)
159588eea45cSKlaus Jensen {
159688eea45cSKlaus Jensen     NvmeAsyncEvent *event;
159788eea45cSKlaus Jensen 
159888eea45cSKlaus Jensen     trace_pci_nvme_enqueue_event(event_type, event_info, log_page);
159988eea45cSKlaus Jensen 
160088eea45cSKlaus Jensen     if (n->aer_queued == n->params.aer_max_queued) {
160188eea45cSKlaus Jensen         trace_pci_nvme_enqueue_event_noqueue(n->aer_queued);
160288eea45cSKlaus Jensen         return;
160388eea45cSKlaus Jensen     }
160488eea45cSKlaus Jensen 
160588eea45cSKlaus Jensen     event = g_new(NvmeAsyncEvent, 1);
160688eea45cSKlaus Jensen     event->result = (NvmeAerResult) {
160788eea45cSKlaus Jensen         .event_type = event_type,
160888eea45cSKlaus Jensen         .event_info = event_info,
160988eea45cSKlaus Jensen         .log_page   = log_page,
161088eea45cSKlaus Jensen     };
161188eea45cSKlaus Jensen 
161288eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&n->aer_queue, event, entry);
161388eea45cSKlaus Jensen     n->aer_queued++;
161488eea45cSKlaus Jensen 
161588eea45cSKlaus Jensen     nvme_process_aers(n);
161688eea45cSKlaus Jensen }
161788eea45cSKlaus Jensen 
161888eea45cSKlaus Jensen static void nvme_smart_event(NvmeCtrl *n, uint8_t event)
161988eea45cSKlaus Jensen {
162088eea45cSKlaus Jensen     uint8_t aer_info;
162188eea45cSKlaus Jensen 
162288eea45cSKlaus Jensen     /* Ref SPEC <Asynchronous Event Information 0x2013 SMART / Health Status> */
162388eea45cSKlaus Jensen     if (!(NVME_AEC_SMART(n->features.async_config) & event)) {
162488eea45cSKlaus Jensen         return;
162588eea45cSKlaus Jensen     }
162688eea45cSKlaus Jensen 
162788eea45cSKlaus Jensen     switch (event) {
162888eea45cSKlaus Jensen     case NVME_SMART_SPARE:
162988eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_SPARE_THRESH;
163088eea45cSKlaus Jensen         break;
163188eea45cSKlaus Jensen     case NVME_SMART_TEMPERATURE:
163288eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_TEMP_THRESH;
163388eea45cSKlaus Jensen         break;
163488eea45cSKlaus Jensen     case NVME_SMART_RELIABILITY:
163588eea45cSKlaus Jensen     case NVME_SMART_MEDIA_READ_ONLY:
163688eea45cSKlaus Jensen     case NVME_SMART_FAILED_VOLATILE_MEDIA:
163788eea45cSKlaus Jensen     case NVME_SMART_PMR_UNRELIABLE:
163888eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_RELIABILITY;
163988eea45cSKlaus Jensen         break;
164088eea45cSKlaus Jensen     default:
164188eea45cSKlaus Jensen         return;
164288eea45cSKlaus Jensen     }
164388eea45cSKlaus Jensen 
164488eea45cSKlaus Jensen     nvme_enqueue_event(n, NVME_AER_TYPE_SMART, aer_info, NVME_LOG_SMART_INFO);
164588eea45cSKlaus Jensen }
164688eea45cSKlaus Jensen 
164788eea45cSKlaus Jensen static void nvme_clear_events(NvmeCtrl *n, uint8_t event_type)
164888eea45cSKlaus Jensen {
164988eea45cSKlaus Jensen     n->aer_mask &= ~(1 << event_type);
165088eea45cSKlaus Jensen     if (!QTAILQ_EMPTY(&n->aer_queue)) {
165188eea45cSKlaus Jensen         nvme_process_aers(n);
165288eea45cSKlaus Jensen     }
165388eea45cSKlaus Jensen }
165488eea45cSKlaus Jensen 
165588eea45cSKlaus Jensen static inline uint16_t nvme_check_mdts(NvmeCtrl *n, size_t len)
165688eea45cSKlaus Jensen {
165788eea45cSKlaus Jensen     uint8_t mdts = n->params.mdts;
165888eea45cSKlaus Jensen 
165988eea45cSKlaus Jensen     if (mdts && len > n->page_size << mdts) {
166088eea45cSKlaus Jensen         trace_pci_nvme_err_mdts(len);
166188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
166288eea45cSKlaus Jensen     }
166388eea45cSKlaus Jensen 
166488eea45cSKlaus Jensen     return NVME_SUCCESS;
166588eea45cSKlaus Jensen }
166688eea45cSKlaus Jensen 
166788eea45cSKlaus Jensen static inline uint16_t nvme_check_bounds(NvmeNamespace *ns, uint64_t slba,
166888eea45cSKlaus Jensen                                          uint32_t nlb)
166988eea45cSKlaus Jensen {
167088eea45cSKlaus Jensen     uint64_t nsze = le64_to_cpu(ns->id_ns.nsze);
167188eea45cSKlaus Jensen 
167288eea45cSKlaus Jensen     if (unlikely(UINT64_MAX - slba < nlb || slba + nlb > nsze)) {
167388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb, nsze);
167488eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
167588eea45cSKlaus Jensen     }
167688eea45cSKlaus Jensen 
167788eea45cSKlaus Jensen     return NVME_SUCCESS;
167888eea45cSKlaus Jensen }
167988eea45cSKlaus Jensen 
1680ff0ac2c8SKlaus Jensen static int nvme_block_status_all(NvmeNamespace *ns, uint64_t slba,
1681ff0ac2c8SKlaus Jensen                                  uint32_t nlb, int flags)
168288eea45cSKlaus Jensen {
168388eea45cSKlaus Jensen     BlockDriverState *bs = blk_bs(ns->blkconf.blk);
168488eea45cSKlaus Jensen 
168588eea45cSKlaus Jensen     int64_t pnum = 0, bytes = nvme_l2b(ns, nlb);
168688eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
168788eea45cSKlaus Jensen     int ret;
168888eea45cSKlaus Jensen 
168988eea45cSKlaus Jensen     /*
169088eea45cSKlaus Jensen      * `pnum` holds the number of bytes after offset that shares the same
169188eea45cSKlaus Jensen      * allocation status as the byte at offset. If `pnum` is different from
169288eea45cSKlaus Jensen      * `bytes`, we should check the allocation status of the next range and
169388eea45cSKlaus Jensen      * continue this until all bytes have been checked.
169488eea45cSKlaus Jensen      */
169588eea45cSKlaus Jensen     do {
169688eea45cSKlaus Jensen         bytes -= pnum;
169788eea45cSKlaus Jensen 
169888eea45cSKlaus Jensen         ret = bdrv_block_status(bs, offset, bytes, &pnum, NULL, NULL);
169988eea45cSKlaus Jensen         if (ret < 0) {
1700ff0ac2c8SKlaus Jensen             return ret;
170188eea45cSKlaus Jensen         }
170288eea45cSKlaus Jensen 
170388eea45cSKlaus Jensen 
1704ff0ac2c8SKlaus Jensen         trace_pci_nvme_block_status(offset, bytes, pnum, ret,
1705ff0ac2c8SKlaus Jensen                                     !!(ret & BDRV_BLOCK_ZERO));
170688eea45cSKlaus Jensen 
1707ff0ac2c8SKlaus Jensen         if (!(ret & flags)) {
1708ff0ac2c8SKlaus Jensen             return 1;
170988eea45cSKlaus Jensen         }
171088eea45cSKlaus Jensen 
171188eea45cSKlaus Jensen         offset += pnum;
171288eea45cSKlaus Jensen     } while (pnum != bytes);
171388eea45cSKlaus Jensen 
1714ff0ac2c8SKlaus Jensen     return 0;
1715ff0ac2c8SKlaus Jensen }
1716ff0ac2c8SKlaus Jensen 
1717ff0ac2c8SKlaus Jensen static uint16_t nvme_check_dulbe(NvmeNamespace *ns, uint64_t slba,
1718ff0ac2c8SKlaus Jensen                                  uint32_t nlb)
1719ff0ac2c8SKlaus Jensen {
1720ff0ac2c8SKlaus Jensen     int ret;
1721ff0ac2c8SKlaus Jensen     Error *err = NULL;
1722ff0ac2c8SKlaus Jensen 
1723ff0ac2c8SKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_DATA);
1724ff0ac2c8SKlaus Jensen     if (ret) {
1725ff0ac2c8SKlaus Jensen         if (ret < 0) {
1726ff0ac2c8SKlaus Jensen             error_setg_errno(&err, -ret, "unable to get block status");
1727ff0ac2c8SKlaus Jensen             error_report_err(err);
1728ff0ac2c8SKlaus Jensen 
1729ff0ac2c8SKlaus Jensen             return NVME_INTERNAL_DEV_ERROR;
1730ff0ac2c8SKlaus Jensen         }
1731ff0ac2c8SKlaus Jensen 
1732ff0ac2c8SKlaus Jensen         return NVME_DULB;
1733ff0ac2c8SKlaus Jensen     }
1734ff0ac2c8SKlaus Jensen 
173588eea45cSKlaus Jensen     return NVME_SUCCESS;
173688eea45cSKlaus Jensen }
173788eea45cSKlaus Jensen 
173888eea45cSKlaus Jensen static void nvme_aio_err(NvmeRequest *req, int ret)
173988eea45cSKlaus Jensen {
174088eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
174188eea45cSKlaus Jensen     Error *local_err = NULL;
174288eea45cSKlaus Jensen 
174388eea45cSKlaus Jensen     switch (req->cmd.opcode) {
174488eea45cSKlaus Jensen     case NVME_CMD_READ:
174588eea45cSKlaus Jensen         status = NVME_UNRECOVERED_READ;
174688eea45cSKlaus Jensen         break;
174788eea45cSKlaus Jensen     case NVME_CMD_FLUSH:
174888eea45cSKlaus Jensen     case NVME_CMD_WRITE:
174988eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
175088eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
175188eea45cSKlaus Jensen         status = NVME_WRITE_FAULT;
175288eea45cSKlaus Jensen         break;
175388eea45cSKlaus Jensen     default:
175488eea45cSKlaus Jensen         status = NVME_INTERNAL_DEV_ERROR;
175588eea45cSKlaus Jensen         break;
175688eea45cSKlaus Jensen     }
175788eea45cSKlaus Jensen 
175888eea45cSKlaus Jensen     trace_pci_nvme_err_aio(nvme_cid(req), strerror(-ret), status);
175988eea45cSKlaus Jensen 
176088eea45cSKlaus Jensen     error_setg_errno(&local_err, -ret, "aio failed");
176188eea45cSKlaus Jensen     error_report_err(local_err);
176288eea45cSKlaus Jensen 
176388eea45cSKlaus Jensen     /*
176488eea45cSKlaus Jensen      * Set the command status code to the first encountered error but allow a
176588eea45cSKlaus Jensen      * subsequent Internal Device Error to trump it.
176688eea45cSKlaus Jensen      */
176788eea45cSKlaus Jensen     if (req->status && status != NVME_INTERNAL_DEV_ERROR) {
176888eea45cSKlaus Jensen         return;
176988eea45cSKlaus Jensen     }
177088eea45cSKlaus Jensen 
177188eea45cSKlaus Jensen     req->status = status;
177288eea45cSKlaus Jensen }
177388eea45cSKlaus Jensen 
177488eea45cSKlaus Jensen static inline uint32_t nvme_zone_idx(NvmeNamespace *ns, uint64_t slba)
177588eea45cSKlaus Jensen {
177688eea45cSKlaus Jensen     return ns->zone_size_log2 > 0 ? slba >> ns->zone_size_log2 :
177788eea45cSKlaus Jensen                                     slba / ns->zone_size;
177888eea45cSKlaus Jensen }
177988eea45cSKlaus Jensen 
178088eea45cSKlaus Jensen static inline NvmeZone *nvme_get_zone_by_slba(NvmeNamespace *ns, uint64_t slba)
178188eea45cSKlaus Jensen {
178288eea45cSKlaus Jensen     uint32_t zone_idx = nvme_zone_idx(ns, slba);
178388eea45cSKlaus Jensen 
1784189a8bf7SKlaus Jensen     if (zone_idx >= ns->num_zones) {
1785189a8bf7SKlaus Jensen         return NULL;
1786189a8bf7SKlaus Jensen     }
1787189a8bf7SKlaus Jensen 
178888eea45cSKlaus Jensen     return &ns->zone_array[zone_idx];
178988eea45cSKlaus Jensen }
179088eea45cSKlaus Jensen 
179188eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_write(NvmeZone *zone)
179288eea45cSKlaus Jensen {
179388eea45cSKlaus Jensen     uint64_t zslba = zone->d.zslba;
179488eea45cSKlaus Jensen 
179588eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
179688eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
179788eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
179888eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
179988eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
180088eea45cSKlaus Jensen         return NVME_SUCCESS;
180188eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
180288eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_full(zslba);
180388eea45cSKlaus Jensen         return NVME_ZONE_FULL;
180488eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
180588eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zslba);
180688eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
180788eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
180888eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_read_only(zslba);
180988eea45cSKlaus Jensen         return NVME_ZONE_READ_ONLY;
181088eea45cSKlaus Jensen     default:
181188eea45cSKlaus Jensen         assert(false);
181288eea45cSKlaus Jensen     }
181388eea45cSKlaus Jensen 
181488eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
181588eea45cSKlaus Jensen }
181688eea45cSKlaus Jensen 
181788eea45cSKlaus Jensen static uint16_t nvme_check_zone_write(NvmeNamespace *ns, NvmeZone *zone,
181888eea45cSKlaus Jensen                                       uint64_t slba, uint32_t nlb)
181988eea45cSKlaus Jensen {
182088eea45cSKlaus Jensen     uint64_t zcap = nvme_zone_wr_boundary(zone);
182188eea45cSKlaus Jensen     uint16_t status;
182288eea45cSKlaus Jensen 
182388eea45cSKlaus Jensen     status = nvme_check_zone_state_for_write(zone);
182488eea45cSKlaus Jensen     if (status) {
182588eea45cSKlaus Jensen         return status;
182688eea45cSKlaus Jensen     }
182788eea45cSKlaus Jensen 
1828e321b4cdSKlaus Jensen     if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1829e321b4cdSKlaus Jensen         uint64_t ezrwa = zone->w_ptr + 2 * ns->zns.zrwas;
1830e321b4cdSKlaus Jensen 
1831e321b4cdSKlaus Jensen         if (slba < zone->w_ptr || slba + nlb > ezrwa) {
1832e321b4cdSKlaus Jensen             trace_pci_nvme_err_zone_invalid_write(slba, zone->w_ptr);
183388eea45cSKlaus Jensen             return NVME_ZONE_INVALID_WRITE;
183488eea45cSKlaus Jensen         }
1835e321b4cdSKlaus Jensen     } else {
1836e321b4cdSKlaus Jensen         if (unlikely(slba != zone->w_ptr)) {
1837e321b4cdSKlaus Jensen             trace_pci_nvme_err_write_not_at_wp(slba, zone->d.zslba,
1838e321b4cdSKlaus Jensen                                                zone->w_ptr);
1839e321b4cdSKlaus Jensen             return NVME_ZONE_INVALID_WRITE;
1840e321b4cdSKlaus Jensen         }
1841e321b4cdSKlaus Jensen     }
184288eea45cSKlaus Jensen 
184388eea45cSKlaus Jensen     if (unlikely((slba + nlb) > zcap)) {
184488eea45cSKlaus Jensen         trace_pci_nvme_err_zone_boundary(slba, nlb, zcap);
184588eea45cSKlaus Jensen         return NVME_ZONE_BOUNDARY_ERROR;
184688eea45cSKlaus Jensen     }
184788eea45cSKlaus Jensen 
184888eea45cSKlaus Jensen     return NVME_SUCCESS;
184988eea45cSKlaus Jensen }
185088eea45cSKlaus Jensen 
185188eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_read(NvmeZone *zone)
185288eea45cSKlaus Jensen {
185388eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
185488eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
185588eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
185688eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
185788eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
185888eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
185988eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
186088eea45cSKlaus Jensen         return NVME_SUCCESS;
186188eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
186288eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zone->d.zslba);
186388eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
186488eea45cSKlaus Jensen     default:
186588eea45cSKlaus Jensen         assert(false);
186688eea45cSKlaus Jensen     }
186788eea45cSKlaus Jensen 
186888eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
186988eea45cSKlaus Jensen }
187088eea45cSKlaus Jensen 
187188eea45cSKlaus Jensen static uint16_t nvme_check_zone_read(NvmeNamespace *ns, uint64_t slba,
187288eea45cSKlaus Jensen                                      uint32_t nlb)
187388eea45cSKlaus Jensen {
1874189a8bf7SKlaus Jensen     NvmeZone *zone;
1875189a8bf7SKlaus Jensen     uint64_t bndry, end;
187688eea45cSKlaus Jensen     uint16_t status;
187788eea45cSKlaus Jensen 
1878189a8bf7SKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
1879189a8bf7SKlaus Jensen     assert(zone);
1880189a8bf7SKlaus Jensen 
1881189a8bf7SKlaus Jensen     bndry = nvme_zone_rd_boundary(ns, zone);
1882189a8bf7SKlaus Jensen     end = slba + nlb;
1883189a8bf7SKlaus Jensen 
188488eea45cSKlaus Jensen     status = nvme_check_zone_state_for_read(zone);
188588eea45cSKlaus Jensen     if (status) {
188688eea45cSKlaus Jensen         ;
188788eea45cSKlaus Jensen     } else if (unlikely(end > bndry)) {
188888eea45cSKlaus Jensen         if (!ns->params.cross_zone_read) {
188988eea45cSKlaus Jensen             status = NVME_ZONE_BOUNDARY_ERROR;
189088eea45cSKlaus Jensen         } else {
189188eea45cSKlaus Jensen             /*
189288eea45cSKlaus Jensen              * Read across zone boundary - check that all subsequent
189388eea45cSKlaus Jensen              * zones that are being read have an appropriate state.
189488eea45cSKlaus Jensen              */
189588eea45cSKlaus Jensen             do {
189688eea45cSKlaus Jensen                 zone++;
189788eea45cSKlaus Jensen                 status = nvme_check_zone_state_for_read(zone);
189888eea45cSKlaus Jensen                 if (status) {
189988eea45cSKlaus Jensen                     break;
190088eea45cSKlaus Jensen                 }
190188eea45cSKlaus Jensen             } while (end > nvme_zone_rd_boundary(ns, zone));
190288eea45cSKlaus Jensen         }
190388eea45cSKlaus Jensen     }
190488eea45cSKlaus Jensen 
190588eea45cSKlaus Jensen     return status;
190688eea45cSKlaus Jensen }
190788eea45cSKlaus Jensen 
190888eea45cSKlaus Jensen static uint16_t nvme_zrm_finish(NvmeNamespace *ns, NvmeZone *zone)
190988eea45cSKlaus Jensen {
191088eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
191188eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
191288eea45cSKlaus Jensen         return NVME_SUCCESS;
191388eea45cSKlaus Jensen 
191488eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
191588eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
191688eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
191788eea45cSKlaus Jensen         /* fallthrough */
191888eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
191988eea45cSKlaus Jensen         nvme_aor_dec_active(ns);
1920e321b4cdSKlaus Jensen 
1921e321b4cdSKlaus Jensen         if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1922e321b4cdSKlaus Jensen             zone->d.za &= ~NVME_ZA_ZRWA_VALID;
1923e321b4cdSKlaus Jensen             if (ns->params.numzrwa) {
1924e321b4cdSKlaus Jensen                 ns->zns.numzrwa++;
1925e321b4cdSKlaus Jensen             }
1926e321b4cdSKlaus Jensen         }
1927e321b4cdSKlaus Jensen 
192888eea45cSKlaus Jensen         /* fallthrough */
192988eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
193088eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_FULL);
193188eea45cSKlaus Jensen         return NVME_SUCCESS;
193288eea45cSKlaus Jensen 
193388eea45cSKlaus Jensen     default:
193488eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
193588eea45cSKlaus Jensen     }
193688eea45cSKlaus Jensen }
193788eea45cSKlaus Jensen 
193888eea45cSKlaus Jensen static uint16_t nvme_zrm_close(NvmeNamespace *ns, NvmeZone *zone)
193988eea45cSKlaus Jensen {
194088eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
194188eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
194288eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
194388eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
194488eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
194588eea45cSKlaus Jensen         /* fall through */
194688eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
194788eea45cSKlaus Jensen         return NVME_SUCCESS;
194888eea45cSKlaus Jensen 
194988eea45cSKlaus Jensen     default:
195088eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
195188eea45cSKlaus Jensen     }
195288eea45cSKlaus Jensen }
195388eea45cSKlaus Jensen 
195463d96e4fSKlaus Jensen static uint16_t nvme_zrm_reset(NvmeNamespace *ns, NvmeZone *zone)
195563d96e4fSKlaus Jensen {
195663d96e4fSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
195763d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
195863d96e4fSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
195963d96e4fSKlaus Jensen         nvme_aor_dec_open(ns);
196063d96e4fSKlaus Jensen         /* fallthrough */
196163d96e4fSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
196263d96e4fSKlaus Jensen         nvme_aor_dec_active(ns);
1963e321b4cdSKlaus Jensen 
1964e321b4cdSKlaus Jensen         if (zone->d.za & NVME_ZA_ZRWA_VALID) {
1965e321b4cdSKlaus Jensen             if (ns->params.numzrwa) {
1966e321b4cdSKlaus Jensen                 ns->zns.numzrwa++;
1967e321b4cdSKlaus Jensen             }
1968e321b4cdSKlaus Jensen         }
1969e321b4cdSKlaus Jensen 
197063d96e4fSKlaus Jensen         /* fallthrough */
197163d96e4fSKlaus Jensen     case NVME_ZONE_STATE_FULL:
197263d96e4fSKlaus Jensen         zone->w_ptr = zone->d.zslba;
197363d96e4fSKlaus Jensen         zone->d.wp = zone->w_ptr;
197463d96e4fSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EMPTY);
197563d96e4fSKlaus Jensen         /* fallthrough */
197663d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
197763d96e4fSKlaus Jensen         return NVME_SUCCESS;
197863d96e4fSKlaus Jensen 
197963d96e4fSKlaus Jensen     default:
198063d96e4fSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
198163d96e4fSKlaus Jensen     }
198263d96e4fSKlaus Jensen }
198363d96e4fSKlaus Jensen 
198488eea45cSKlaus Jensen static void nvme_zrm_auto_transition_zone(NvmeNamespace *ns)
198588eea45cSKlaus Jensen {
198688eea45cSKlaus Jensen     NvmeZone *zone;
198788eea45cSKlaus Jensen 
198888eea45cSKlaus Jensen     if (ns->params.max_open_zones &&
198988eea45cSKlaus Jensen         ns->nr_open_zones == ns->params.max_open_zones) {
199088eea45cSKlaus Jensen         zone = QTAILQ_FIRST(&ns->imp_open_zones);
199188eea45cSKlaus Jensen         if (zone) {
199288eea45cSKlaus Jensen             /*
199388eea45cSKlaus Jensen              * Automatically close this implicitly open zone.
199488eea45cSKlaus Jensen              */
199588eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
199688eea45cSKlaus Jensen             nvme_zrm_close(ns, zone);
199788eea45cSKlaus Jensen         }
199888eea45cSKlaus Jensen     }
199988eea45cSKlaus Jensen }
200088eea45cSKlaus Jensen 
200188eea45cSKlaus Jensen enum {
200288eea45cSKlaus Jensen     NVME_ZRM_AUTO = 1 << 0,
2003e321b4cdSKlaus Jensen     NVME_ZRM_ZRWA = 1 << 1,
200488eea45cSKlaus Jensen };
200588eea45cSKlaus Jensen 
2006cccc2651SNiklas Cassel static uint16_t nvme_zrm_open_flags(NvmeCtrl *n, NvmeNamespace *ns,
2007cccc2651SNiklas Cassel                                     NvmeZone *zone, int flags)
200888eea45cSKlaus Jensen {
200988eea45cSKlaus Jensen     int act = 0;
201088eea45cSKlaus Jensen     uint16_t status;
201188eea45cSKlaus Jensen 
201288eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
201388eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
201488eea45cSKlaus Jensen         act = 1;
201588eea45cSKlaus Jensen 
201688eea45cSKlaus Jensen         /* fallthrough */
201788eea45cSKlaus Jensen 
201888eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
2019cccc2651SNiklas Cassel         if (n->params.auto_transition_zones) {
202088eea45cSKlaus Jensen             nvme_zrm_auto_transition_zone(ns);
2021cccc2651SNiklas Cassel         }
2022e321b4cdSKlaus Jensen         status = nvme_zns_check_resources(ns, act, 1,
2023e321b4cdSKlaus Jensen                                           (flags & NVME_ZRM_ZRWA) ? 1 : 0);
202488eea45cSKlaus Jensen         if (status) {
202588eea45cSKlaus Jensen             return status;
202688eea45cSKlaus Jensen         }
202788eea45cSKlaus Jensen 
202888eea45cSKlaus Jensen         if (act) {
202988eea45cSKlaus Jensen             nvme_aor_inc_active(ns);
203088eea45cSKlaus Jensen         }
203188eea45cSKlaus Jensen 
203288eea45cSKlaus Jensen         nvme_aor_inc_open(ns);
203388eea45cSKlaus Jensen 
203488eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
203588eea45cSKlaus Jensen             nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_IMPLICITLY_OPEN);
203688eea45cSKlaus Jensen             return NVME_SUCCESS;
203788eea45cSKlaus Jensen         }
203888eea45cSKlaus Jensen 
203988eea45cSKlaus Jensen         /* fallthrough */
204088eea45cSKlaus Jensen 
204188eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
204288eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
204388eea45cSKlaus Jensen             return NVME_SUCCESS;
204488eea45cSKlaus Jensen         }
204588eea45cSKlaus Jensen 
204688eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EXPLICITLY_OPEN);
204788eea45cSKlaus Jensen 
204888eea45cSKlaus Jensen         /* fallthrough */
204988eea45cSKlaus Jensen 
205088eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
2051e321b4cdSKlaus Jensen         if (flags & NVME_ZRM_ZRWA) {
2052e321b4cdSKlaus Jensen             ns->zns.numzrwa--;
2053e321b4cdSKlaus Jensen 
2054e321b4cdSKlaus Jensen             zone->d.za |= NVME_ZA_ZRWA_VALID;
2055e321b4cdSKlaus Jensen         }
2056e321b4cdSKlaus Jensen 
205788eea45cSKlaus Jensen         return NVME_SUCCESS;
205888eea45cSKlaus Jensen 
205988eea45cSKlaus Jensen     default:
206088eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
206188eea45cSKlaus Jensen     }
206288eea45cSKlaus Jensen }
206388eea45cSKlaus Jensen 
2064cccc2651SNiklas Cassel static inline uint16_t nvme_zrm_auto(NvmeCtrl *n, NvmeNamespace *ns,
2065cccc2651SNiklas Cassel                                      NvmeZone *zone)
206688eea45cSKlaus Jensen {
2067cccc2651SNiklas Cassel     return nvme_zrm_open_flags(n, ns, zone, NVME_ZRM_AUTO);
206888eea45cSKlaus Jensen }
206988eea45cSKlaus Jensen 
207088eea45cSKlaus Jensen static void nvme_advance_zone_wp(NvmeNamespace *ns, NvmeZone *zone,
207188eea45cSKlaus Jensen                                  uint32_t nlb)
207288eea45cSKlaus Jensen {
207388eea45cSKlaus Jensen     zone->d.wp += nlb;
207488eea45cSKlaus Jensen 
207588eea45cSKlaus Jensen     if (zone->d.wp == nvme_zone_wr_boundary(zone)) {
207688eea45cSKlaus Jensen         nvme_zrm_finish(ns, zone);
207788eea45cSKlaus Jensen     }
207888eea45cSKlaus Jensen }
207988eea45cSKlaus Jensen 
2080e321b4cdSKlaus Jensen static void nvme_zoned_zrwa_implicit_flush(NvmeNamespace *ns, NvmeZone *zone,
2081e321b4cdSKlaus Jensen                                            uint32_t nlbc)
2082e321b4cdSKlaus Jensen {
2083e321b4cdSKlaus Jensen     uint16_t nzrwafgs = DIV_ROUND_UP(nlbc, ns->zns.zrwafg);
2084e321b4cdSKlaus Jensen 
2085e321b4cdSKlaus Jensen     nlbc = nzrwafgs * ns->zns.zrwafg;
2086e321b4cdSKlaus Jensen 
2087e321b4cdSKlaus Jensen     trace_pci_nvme_zoned_zrwa_implicit_flush(zone->d.zslba, nlbc);
2088e321b4cdSKlaus Jensen 
2089e321b4cdSKlaus Jensen     zone->w_ptr += nlbc;
2090e321b4cdSKlaus Jensen 
2091e321b4cdSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlbc);
2092e321b4cdSKlaus Jensen }
2093e321b4cdSKlaus Jensen 
209488eea45cSKlaus Jensen static void nvme_finalize_zoned_write(NvmeNamespace *ns, NvmeRequest *req)
209588eea45cSKlaus Jensen {
209688eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
209788eea45cSKlaus Jensen     NvmeZone *zone;
209888eea45cSKlaus Jensen     uint64_t slba;
209988eea45cSKlaus Jensen     uint32_t nlb;
210088eea45cSKlaus Jensen 
210188eea45cSKlaus Jensen     slba = le64_to_cpu(rw->slba);
210288eea45cSKlaus Jensen     nlb = le16_to_cpu(rw->nlb) + 1;
210388eea45cSKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
2104189a8bf7SKlaus Jensen     assert(zone);
210588eea45cSKlaus Jensen 
2106e321b4cdSKlaus Jensen     if (zone->d.za & NVME_ZA_ZRWA_VALID) {
2107e321b4cdSKlaus Jensen         uint64_t ezrwa = zone->w_ptr + ns->zns.zrwas - 1;
2108e321b4cdSKlaus Jensen         uint64_t elba = slba + nlb - 1;
2109e321b4cdSKlaus Jensen 
2110e321b4cdSKlaus Jensen         if (elba > ezrwa) {
2111e321b4cdSKlaus Jensen             nvme_zoned_zrwa_implicit_flush(ns, zone, elba - ezrwa);
2112e321b4cdSKlaus Jensen         }
2113e321b4cdSKlaus Jensen 
2114e321b4cdSKlaus Jensen         return;
2115e321b4cdSKlaus Jensen     }
2116e321b4cdSKlaus Jensen 
211788eea45cSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlb);
211888eea45cSKlaus Jensen }
211988eea45cSKlaus Jensen 
212088eea45cSKlaus Jensen static inline bool nvme_is_write(NvmeRequest *req)
212188eea45cSKlaus Jensen {
212288eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
212388eea45cSKlaus Jensen 
212488eea45cSKlaus Jensen     return rw->opcode == NVME_CMD_WRITE ||
212588eea45cSKlaus Jensen            rw->opcode == NVME_CMD_ZONE_APPEND ||
212688eea45cSKlaus Jensen            rw->opcode == NVME_CMD_WRITE_ZEROES;
212788eea45cSKlaus Jensen }
212888eea45cSKlaus Jensen 
212938f4ac65SKlaus Jensen static AioContext *nvme_get_aio_context(BlockAIOCB *acb)
213038f4ac65SKlaus Jensen {
213138f4ac65SKlaus Jensen     return qemu_get_aio_context();
213238f4ac65SKlaus Jensen }
213338f4ac65SKlaus Jensen 
213488eea45cSKlaus Jensen static void nvme_misc_cb(void *opaque, int ret)
213588eea45cSKlaus Jensen {
213688eea45cSKlaus Jensen     NvmeRequest *req = opaque;
213788eea45cSKlaus Jensen 
213838f4ac65SKlaus Jensen     trace_pci_nvme_misc_cb(nvme_cid(req));
213988eea45cSKlaus Jensen 
214088eea45cSKlaus Jensen     if (ret) {
214188eea45cSKlaus Jensen         nvme_aio_err(req, ret);
214288eea45cSKlaus Jensen     }
214388eea45cSKlaus Jensen 
214488eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
214588eea45cSKlaus Jensen }
214688eea45cSKlaus Jensen 
214788eea45cSKlaus Jensen void nvme_rw_complete_cb(void *opaque, int ret)
214888eea45cSKlaus Jensen {
214988eea45cSKlaus Jensen     NvmeRequest *req = opaque;
215088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
215188eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
215288eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
215388eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
215488eea45cSKlaus Jensen 
215588eea45cSKlaus Jensen     trace_pci_nvme_rw_complete_cb(nvme_cid(req), blk_name(blk));
215688eea45cSKlaus Jensen 
215788eea45cSKlaus Jensen     if (ret) {
215888eea45cSKlaus Jensen         block_acct_failed(stats, acct);
215988eea45cSKlaus Jensen         nvme_aio_err(req, ret);
216088eea45cSKlaus Jensen     } else {
216188eea45cSKlaus Jensen         block_acct_done(stats, acct);
216288eea45cSKlaus Jensen     }
216388eea45cSKlaus Jensen 
216488eea45cSKlaus Jensen     if (ns->params.zoned && nvme_is_write(req)) {
216588eea45cSKlaus Jensen         nvme_finalize_zoned_write(ns, req);
216688eea45cSKlaus Jensen     }
216788eea45cSKlaus Jensen 
216888eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
216988eea45cSKlaus Jensen }
217088eea45cSKlaus Jensen 
217188eea45cSKlaus Jensen static void nvme_rw_cb(void *opaque, int ret)
217288eea45cSKlaus Jensen {
217388eea45cSKlaus Jensen     NvmeRequest *req = opaque;
217488eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
217588eea45cSKlaus Jensen 
217688eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
217788eea45cSKlaus Jensen 
217888eea45cSKlaus Jensen     trace_pci_nvme_rw_cb(nvme_cid(req), blk_name(blk));
217988eea45cSKlaus Jensen 
218088eea45cSKlaus Jensen     if (ret) {
218188eea45cSKlaus Jensen         goto out;
218288eea45cSKlaus Jensen     }
218388eea45cSKlaus Jensen 
218488eea45cSKlaus Jensen     if (ns->lbaf.ms) {
218588eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
218688eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
218788eea45cSKlaus Jensen         uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
218888eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
218988eea45cSKlaus Jensen 
219088eea45cSKlaus Jensen         if (req->cmd.opcode == NVME_CMD_WRITE_ZEROES) {
219188eea45cSKlaus Jensen             size_t mlen = nvme_m2b(ns, nlb);
219288eea45cSKlaus Jensen 
219388eea45cSKlaus Jensen             req->aiocb = blk_aio_pwrite_zeroes(blk, offset, mlen,
219488eea45cSKlaus Jensen                                                BDRV_REQ_MAY_UNMAP,
219588eea45cSKlaus Jensen                                                nvme_rw_complete_cb, req);
219688eea45cSKlaus Jensen             return;
219788eea45cSKlaus Jensen         }
219888eea45cSKlaus Jensen 
219988eea45cSKlaus Jensen         if (nvme_ns_ext(ns) || req->cmd.mptr) {
220088eea45cSKlaus Jensen             uint16_t status;
220188eea45cSKlaus Jensen 
220288eea45cSKlaus Jensen             nvme_sg_unmap(&req->sg);
220388eea45cSKlaus Jensen             status = nvme_map_mdata(nvme_ctrl(req), nlb, req);
220488eea45cSKlaus Jensen             if (status) {
220588eea45cSKlaus Jensen                 ret = -EFAULT;
220688eea45cSKlaus Jensen                 goto out;
220788eea45cSKlaus Jensen             }
220888eea45cSKlaus Jensen 
220988eea45cSKlaus Jensen             if (req->cmd.opcode == NVME_CMD_READ) {
22109b4f0181SMateusz Kozlowski                 return nvme_blk_read(blk, offset, 1, nvme_rw_complete_cb, req);
221188eea45cSKlaus Jensen             }
221288eea45cSKlaus Jensen 
22139b4f0181SMateusz Kozlowski             return nvme_blk_write(blk, offset, 1, nvme_rw_complete_cb, req);
221488eea45cSKlaus Jensen         }
221588eea45cSKlaus Jensen     }
221688eea45cSKlaus Jensen 
221788eea45cSKlaus Jensen out:
221888eea45cSKlaus Jensen     nvme_rw_complete_cb(req, ret);
221988eea45cSKlaus Jensen }
222088eea45cSKlaus Jensen 
222188eea45cSKlaus Jensen static void nvme_verify_cb(void *opaque, int ret)
222288eea45cSKlaus Jensen {
222388eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
222488eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
222588eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
222688eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
222788eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
222888eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
222988eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
223088eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
22312a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
223288eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
223388eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
223444219b60SNaveen Nagar     uint64_t reftag = le32_to_cpu(rw->reftag);
223544219b60SNaveen Nagar     uint64_t cdw3 = le32_to_cpu(rw->cdw3);
223688eea45cSKlaus Jensen     uint16_t status;
223788eea45cSKlaus Jensen 
223844219b60SNaveen Nagar     reftag |= cdw3 << 32;
223944219b60SNaveen Nagar 
22402a132309SKlaus Jensen     trace_pci_nvme_verify_cb(nvme_cid(req), prinfo, apptag, appmask, reftag);
224188eea45cSKlaus Jensen 
224288eea45cSKlaus Jensen     if (ret) {
224388eea45cSKlaus Jensen         block_acct_failed(stats, acct);
224488eea45cSKlaus Jensen         nvme_aio_err(req, ret);
224588eea45cSKlaus Jensen         goto out;
224688eea45cSKlaus Jensen     }
224788eea45cSKlaus Jensen 
224888eea45cSKlaus Jensen     block_acct_done(stats, acct);
224988eea45cSKlaus Jensen 
225088eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
225188eea45cSKlaus Jensen         status = nvme_dif_mangle_mdata(ns, ctx->mdata.bounce,
225288eea45cSKlaus Jensen                                        ctx->mdata.iov.size, slba);
225388eea45cSKlaus Jensen         if (status) {
225488eea45cSKlaus Jensen             req->status = status;
225588eea45cSKlaus Jensen             goto out;
225688eea45cSKlaus Jensen         }
225788eea45cSKlaus Jensen 
225888eea45cSKlaus Jensen         req->status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
225988eea45cSKlaus Jensen                                      ctx->mdata.bounce, ctx->mdata.iov.size,
22602a132309SKlaus Jensen                                      prinfo, slba, apptag, appmask, &reftag);
226188eea45cSKlaus Jensen     }
226288eea45cSKlaus Jensen 
226388eea45cSKlaus Jensen out:
226488eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
226588eea45cSKlaus Jensen     g_free(ctx->data.bounce);
226688eea45cSKlaus Jensen 
226788eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
226888eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
226988eea45cSKlaus Jensen 
227088eea45cSKlaus Jensen     g_free(ctx);
227188eea45cSKlaus Jensen 
227288eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
227388eea45cSKlaus Jensen }
227488eea45cSKlaus Jensen 
227588eea45cSKlaus Jensen 
227688eea45cSKlaus Jensen static void nvme_verify_mdata_in_cb(void *opaque, int ret)
227788eea45cSKlaus Jensen {
227888eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
227988eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
228088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
228188eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
228288eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
228388eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
228488eea45cSKlaus Jensen     size_t mlen = nvme_m2b(ns, nlb);
228588eea45cSKlaus Jensen     uint64_t offset = nvme_moff(ns, slba);
228688eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
228788eea45cSKlaus Jensen 
228888eea45cSKlaus Jensen     trace_pci_nvme_verify_mdata_in_cb(nvme_cid(req), blk_name(blk));
228988eea45cSKlaus Jensen 
229088eea45cSKlaus Jensen     if (ret) {
229188eea45cSKlaus Jensen         goto out;
229288eea45cSKlaus Jensen     }
229388eea45cSKlaus Jensen 
229488eea45cSKlaus Jensen     ctx->mdata.bounce = g_malloc(mlen);
229588eea45cSKlaus Jensen 
229688eea45cSKlaus Jensen     qemu_iovec_reset(&ctx->mdata.iov);
229788eea45cSKlaus Jensen     qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
229888eea45cSKlaus Jensen 
229988eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
230088eea45cSKlaus Jensen                                 nvme_verify_cb, ctx);
230188eea45cSKlaus Jensen     return;
230288eea45cSKlaus Jensen 
230388eea45cSKlaus Jensen out:
230488eea45cSKlaus Jensen     nvme_verify_cb(ctx, ret);
230588eea45cSKlaus Jensen }
230688eea45cSKlaus Jensen 
230788eea45cSKlaus Jensen struct nvme_compare_ctx {
230888eea45cSKlaus Jensen     struct {
230988eea45cSKlaus Jensen         QEMUIOVector iov;
231088eea45cSKlaus Jensen         uint8_t *bounce;
231188eea45cSKlaus Jensen     } data;
231288eea45cSKlaus Jensen 
231388eea45cSKlaus Jensen     struct {
231488eea45cSKlaus Jensen         QEMUIOVector iov;
231588eea45cSKlaus Jensen         uint8_t *bounce;
231688eea45cSKlaus Jensen     } mdata;
231788eea45cSKlaus Jensen };
231888eea45cSKlaus Jensen 
231988eea45cSKlaus Jensen static void nvme_compare_mdata_cb(void *opaque, int ret)
232088eea45cSKlaus Jensen {
232188eea45cSKlaus Jensen     NvmeRequest *req = opaque;
232288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
232388eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
232488eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
23252a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
232688eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
232788eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
232844219b60SNaveen Nagar     uint64_t reftag = le32_to_cpu(rw->reftag);
232944219b60SNaveen Nagar     uint64_t cdw3 = le32_to_cpu(rw->cdw3);
233088eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
233188eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
233288eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
233388eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
233488eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
233588eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
233688eea45cSKlaus Jensen 
233744219b60SNaveen Nagar     reftag |= cdw3 << 32;
233844219b60SNaveen Nagar 
233988eea45cSKlaus Jensen     trace_pci_nvme_compare_mdata_cb(nvme_cid(req));
234088eea45cSKlaus Jensen 
234188eea45cSKlaus Jensen     if (ret) {
234288eea45cSKlaus Jensen         block_acct_failed(stats, acct);
234388eea45cSKlaus Jensen         nvme_aio_err(req, ret);
234488eea45cSKlaus Jensen         goto out;
234588eea45cSKlaus Jensen     }
234688eea45cSKlaus Jensen 
234788eea45cSKlaus Jensen     buf = g_malloc(ctx->mdata.iov.size);
234888eea45cSKlaus Jensen 
234988eea45cSKlaus Jensen     status = nvme_bounce_mdata(n, buf, ctx->mdata.iov.size,
235088eea45cSKlaus Jensen                                NVME_TX_DIRECTION_TO_DEVICE, req);
235188eea45cSKlaus Jensen     if (status) {
235288eea45cSKlaus Jensen         req->status = status;
235388eea45cSKlaus Jensen         goto out;
235488eea45cSKlaus Jensen     }
235588eea45cSKlaus Jensen 
235688eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
235788eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
235888eea45cSKlaus Jensen         uint8_t *bufp;
235988eea45cSKlaus Jensen         uint8_t *mbufp = ctx->mdata.bounce;
236088eea45cSKlaus Jensen         uint8_t *end = mbufp + ctx->mdata.iov.size;
236188eea45cSKlaus Jensen         int16_t pil = 0;
236288eea45cSKlaus Jensen 
236388eea45cSKlaus Jensen         status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
23642a132309SKlaus Jensen                                 ctx->mdata.bounce, ctx->mdata.iov.size, prinfo,
23650ca5c3ccSKlaus Jensen                                 slba, apptag, appmask, &reftag);
236688eea45cSKlaus Jensen         if (status) {
236788eea45cSKlaus Jensen             req->status = status;
236888eea45cSKlaus Jensen             goto out;
236988eea45cSKlaus Jensen         }
237088eea45cSKlaus Jensen 
237188eea45cSKlaus Jensen         /*
237288eea45cSKlaus Jensen          * When formatted with protection information, do not compare the DIF
237388eea45cSKlaus Jensen          * tuple.
237488eea45cSKlaus Jensen          */
237588eea45cSKlaus Jensen         if (!(ns->id_ns.dps & NVME_ID_NS_DPS_FIRST_EIGHT)) {
2376ac0b34c5SKlaus Jensen             pil = ns->lbaf.ms - nvme_pi_tuple_size(ns);
237788eea45cSKlaus Jensen         }
237888eea45cSKlaus Jensen 
237988eea45cSKlaus Jensen         for (bufp = buf; mbufp < end; bufp += ns->lbaf.ms, mbufp += ns->lbaf.ms) {
238088eea45cSKlaus Jensen             if (memcmp(bufp + pil, mbufp + pil, ns->lbaf.ms - pil)) {
2381ca2a0918SKlaus Jensen                 req->status = NVME_CMP_FAILURE | NVME_DNR;
238288eea45cSKlaus Jensen                 goto out;
238388eea45cSKlaus Jensen             }
238488eea45cSKlaus Jensen         }
238588eea45cSKlaus Jensen 
238688eea45cSKlaus Jensen         goto out;
238788eea45cSKlaus Jensen     }
238888eea45cSKlaus Jensen 
238988eea45cSKlaus Jensen     if (memcmp(buf, ctx->mdata.bounce, ctx->mdata.iov.size)) {
2390ca2a0918SKlaus Jensen         req->status = NVME_CMP_FAILURE | NVME_DNR;
239188eea45cSKlaus Jensen         goto out;
239288eea45cSKlaus Jensen     }
239388eea45cSKlaus Jensen 
239488eea45cSKlaus Jensen     block_acct_done(stats, acct);
239588eea45cSKlaus Jensen 
239688eea45cSKlaus Jensen out:
239788eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
239888eea45cSKlaus Jensen     g_free(ctx->data.bounce);
239988eea45cSKlaus Jensen 
240088eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
240188eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
240288eea45cSKlaus Jensen 
240388eea45cSKlaus Jensen     g_free(ctx);
240488eea45cSKlaus Jensen 
240588eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
240688eea45cSKlaus Jensen }
240788eea45cSKlaus Jensen 
240888eea45cSKlaus Jensen static void nvme_compare_data_cb(void *opaque, int ret)
240988eea45cSKlaus Jensen {
241088eea45cSKlaus Jensen     NvmeRequest *req = opaque;
241188eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
241288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
241388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
241488eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
241588eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
241688eea45cSKlaus Jensen 
241788eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
241888eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
241988eea45cSKlaus Jensen     uint16_t status;
242088eea45cSKlaus Jensen 
242188eea45cSKlaus Jensen     trace_pci_nvme_compare_data_cb(nvme_cid(req));
242288eea45cSKlaus Jensen 
242388eea45cSKlaus Jensen     if (ret) {
242488eea45cSKlaus Jensen         block_acct_failed(stats, acct);
242588eea45cSKlaus Jensen         nvme_aio_err(req, ret);
242688eea45cSKlaus Jensen         goto out;
242788eea45cSKlaus Jensen     }
242888eea45cSKlaus Jensen 
242988eea45cSKlaus Jensen     buf = g_malloc(ctx->data.iov.size);
243088eea45cSKlaus Jensen 
243188eea45cSKlaus Jensen     status = nvme_bounce_data(n, buf, ctx->data.iov.size,
243288eea45cSKlaus Jensen                               NVME_TX_DIRECTION_TO_DEVICE, req);
243388eea45cSKlaus Jensen     if (status) {
243488eea45cSKlaus Jensen         req->status = status;
243588eea45cSKlaus Jensen         goto out;
243688eea45cSKlaus Jensen     }
243788eea45cSKlaus Jensen 
243888eea45cSKlaus Jensen     if (memcmp(buf, ctx->data.bounce, ctx->data.iov.size)) {
2439ca2a0918SKlaus Jensen         req->status = NVME_CMP_FAILURE | NVME_DNR;
244088eea45cSKlaus Jensen         goto out;
244188eea45cSKlaus Jensen     }
244288eea45cSKlaus Jensen 
244388eea45cSKlaus Jensen     if (ns->lbaf.ms) {
244488eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
244588eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
244688eea45cSKlaus Jensen         uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
244788eea45cSKlaus Jensen         size_t mlen = nvme_m2b(ns, nlb);
244888eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
244988eea45cSKlaus Jensen 
245088eea45cSKlaus Jensen         ctx->mdata.bounce = g_malloc(mlen);
245188eea45cSKlaus Jensen 
245288eea45cSKlaus Jensen         qemu_iovec_init(&ctx->mdata.iov, 1);
245388eea45cSKlaus Jensen         qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
245488eea45cSKlaus Jensen 
245588eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
245688eea45cSKlaus Jensen                                     nvme_compare_mdata_cb, req);
245788eea45cSKlaus Jensen         return;
245888eea45cSKlaus Jensen     }
245988eea45cSKlaus Jensen 
246088eea45cSKlaus Jensen     block_acct_done(stats, acct);
246188eea45cSKlaus Jensen 
246288eea45cSKlaus Jensen out:
246388eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
246488eea45cSKlaus Jensen     g_free(ctx->data.bounce);
246588eea45cSKlaus Jensen     g_free(ctx);
246688eea45cSKlaus Jensen 
246788eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
246888eea45cSKlaus Jensen }
246988eea45cSKlaus Jensen 
2470d7d1474fSKlaus Jensen typedef struct NvmeDSMAIOCB {
2471d7d1474fSKlaus Jensen     BlockAIOCB common;
2472d7d1474fSKlaus Jensen     BlockAIOCB *aiocb;
2473d7d1474fSKlaus Jensen     NvmeRequest *req;
2474d7d1474fSKlaus Jensen     int ret;
2475d7d1474fSKlaus Jensen 
2476d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2477d7d1474fSKlaus Jensen     unsigned int nr;
2478d7d1474fSKlaus Jensen     unsigned int idx;
2479d7d1474fSKlaus Jensen } NvmeDSMAIOCB;
2480d7d1474fSKlaus Jensen 
2481d7d1474fSKlaus Jensen static void nvme_dsm_cancel(BlockAIOCB *aiocb)
2482d7d1474fSKlaus Jensen {
2483d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = container_of(aiocb, NvmeDSMAIOCB, common);
2484d7d1474fSKlaus Jensen 
2485d7d1474fSKlaus Jensen     /* break nvme_dsm_cb loop */
2486d7d1474fSKlaus Jensen     iocb->idx = iocb->nr;
2487d7d1474fSKlaus Jensen     iocb->ret = -ECANCELED;
2488d7d1474fSKlaus Jensen 
2489d7d1474fSKlaus Jensen     if (iocb->aiocb) {
2490d7d1474fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2491d7d1474fSKlaus Jensen         iocb->aiocb = NULL;
2492d7d1474fSKlaus Jensen     } else {
2493d7d1474fSKlaus Jensen         /*
2494d7d1474fSKlaus Jensen          * We only reach this if nvme_dsm_cancel() has already been called or
2495818b9b8fSKlaus Jensen          * the command ran to completion.
2496d7d1474fSKlaus Jensen          */
2497d7d1474fSKlaus Jensen         assert(iocb->idx == iocb->nr);
2498d7d1474fSKlaus Jensen     }
2499d7d1474fSKlaus Jensen }
2500d7d1474fSKlaus Jensen 
2501d7d1474fSKlaus Jensen static const AIOCBInfo nvme_dsm_aiocb_info = {
2502d7d1474fSKlaus Jensen     .aiocb_size   = sizeof(NvmeDSMAIOCB),
2503d7d1474fSKlaus Jensen     .cancel_async = nvme_dsm_cancel,
2504d7d1474fSKlaus Jensen };
2505d7d1474fSKlaus Jensen 
2506d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret);
2507d7d1474fSKlaus Jensen 
2508d7d1474fSKlaus Jensen static void nvme_dsm_md_cb(void *opaque, int ret)
2509d7d1474fSKlaus Jensen {
2510d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2511d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2512d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2513d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2514d7d1474fSKlaus Jensen     uint64_t slba;
2515d7d1474fSKlaus Jensen     uint32_t nlb;
2516d7d1474fSKlaus Jensen 
2517818b9b8fSKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
2518d7d1474fSKlaus Jensen         goto done;
2519d7d1474fSKlaus Jensen     }
2520d7d1474fSKlaus Jensen 
2521d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx - 1];
2522d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2523d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2524d7d1474fSKlaus Jensen 
2525d7d1474fSKlaus Jensen     /*
2526d7d1474fSKlaus Jensen      * Check that all block were discarded (zeroed); otherwise we do not zero
2527d7d1474fSKlaus Jensen      * the metadata.
2528d7d1474fSKlaus Jensen      */
2529d7d1474fSKlaus Jensen 
2530d7d1474fSKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_ZERO);
2531d7d1474fSKlaus Jensen     if (ret) {
2532d7d1474fSKlaus Jensen         if (ret < 0) {
2533d7d1474fSKlaus Jensen             goto done;
2534d7d1474fSKlaus Jensen         }
2535d7d1474fSKlaus Jensen 
2536d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
253751c45326SDmitry Tikhov         return;
2538d7d1474fSKlaus Jensen     }
2539d7d1474fSKlaus Jensen 
2540d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, nvme_moff(ns, slba),
2541d7d1474fSKlaus Jensen                                         nvme_m2b(ns, nlb), BDRV_REQ_MAY_UNMAP,
2542d7d1474fSKlaus Jensen                                         nvme_dsm_cb, iocb);
2543d7d1474fSKlaus Jensen     return;
2544d7d1474fSKlaus Jensen 
2545d7d1474fSKlaus Jensen done:
2546818b9b8fSKlaus Jensen     nvme_dsm_cb(iocb, ret);
2547d7d1474fSKlaus Jensen }
2548d7d1474fSKlaus Jensen 
2549d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret)
2550d7d1474fSKlaus Jensen {
2551d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2552d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2553d7d1474fSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
2554d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2555d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2556d7d1474fSKlaus Jensen     uint64_t slba;
2557d7d1474fSKlaus Jensen     uint32_t nlb;
2558d7d1474fSKlaus Jensen 
2559818b9b8fSKlaus Jensen     if (iocb->ret < 0) {
2560818b9b8fSKlaus Jensen         goto done;
2561818b9b8fSKlaus Jensen     } else if (ret < 0) {
2562d7d1474fSKlaus Jensen         iocb->ret = ret;
2563d7d1474fSKlaus Jensen         goto done;
2564d7d1474fSKlaus Jensen     }
2565d7d1474fSKlaus Jensen 
2566d7d1474fSKlaus Jensen next:
2567d7d1474fSKlaus Jensen     if (iocb->idx == iocb->nr) {
2568d7d1474fSKlaus Jensen         goto done;
2569d7d1474fSKlaus Jensen     }
2570d7d1474fSKlaus Jensen 
2571d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx++];
2572d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2573d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2574d7d1474fSKlaus Jensen 
2575d7d1474fSKlaus Jensen     trace_pci_nvme_dsm_deallocate(slba, nlb);
2576d7d1474fSKlaus Jensen 
2577d7d1474fSKlaus Jensen     if (nlb > n->dmrsl) {
2578d7d1474fSKlaus Jensen         trace_pci_nvme_dsm_single_range_limit_exceeded(nlb, n->dmrsl);
2579d7d1474fSKlaus Jensen         goto next;
2580d7d1474fSKlaus Jensen     }
2581d7d1474fSKlaus Jensen 
2582d7d1474fSKlaus Jensen     if (nvme_check_bounds(ns, slba, nlb)) {
2583d7d1474fSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb,
2584d7d1474fSKlaus Jensen                                              ns->id_ns.nsze);
2585d7d1474fSKlaus Jensen         goto next;
2586d7d1474fSKlaus Jensen     }
2587d7d1474fSKlaus Jensen 
2588d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pdiscard(ns->blkconf.blk, nvme_l2b(ns, slba),
2589d7d1474fSKlaus Jensen                                    nvme_l2b(ns, nlb),
2590d7d1474fSKlaus Jensen                                    nvme_dsm_md_cb, iocb);
2591d7d1474fSKlaus Jensen     return;
2592d7d1474fSKlaus Jensen 
2593d7d1474fSKlaus Jensen done:
2594d7d1474fSKlaus Jensen     iocb->aiocb = NULL;
2595818b9b8fSKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2596818b9b8fSKlaus Jensen     qemu_aio_unref(iocb);
2597d7d1474fSKlaus Jensen }
2598d7d1474fSKlaus Jensen 
259988eea45cSKlaus Jensen static uint16_t nvme_dsm(NvmeCtrl *n, NvmeRequest *req)
260088eea45cSKlaus Jensen {
260188eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
260288eea45cSKlaus Jensen     NvmeDsmCmd *dsm = (NvmeDsmCmd *) &req->cmd;
260388eea45cSKlaus Jensen     uint32_t attr = le32_to_cpu(dsm->attributes);
260488eea45cSKlaus Jensen     uint32_t nr = (le32_to_cpu(dsm->nr) & 0xff) + 1;
260588eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
260688eea45cSKlaus Jensen 
2607d7d1474fSKlaus Jensen     trace_pci_nvme_dsm(nr, attr);
260888eea45cSKlaus Jensen 
260988eea45cSKlaus Jensen     if (attr & NVME_DSMGMT_AD) {
2610d7d1474fSKlaus Jensen         NvmeDSMAIOCB *iocb = blk_aio_get(&nvme_dsm_aiocb_info, ns->blkconf.blk,
2611d7d1474fSKlaus Jensen                                          nvme_misc_cb, req);
261288eea45cSKlaus Jensen 
2613d7d1474fSKlaus Jensen         iocb->req = req;
2614d7d1474fSKlaus Jensen         iocb->ret = 0;
2615d7d1474fSKlaus Jensen         iocb->range = g_new(NvmeDsmRange, nr);
2616d7d1474fSKlaus Jensen         iocb->nr = nr;
2617d7d1474fSKlaus Jensen         iocb->idx = 0;
2618d7d1474fSKlaus Jensen 
2619d7d1474fSKlaus Jensen         status = nvme_h2c(n, (uint8_t *)iocb->range, sizeof(NvmeDsmRange) * nr,
2620d7d1474fSKlaus Jensen                           req);
262188eea45cSKlaus Jensen         if (status) {
26224b32319cSKlaus Jensen             g_free(iocb->range);
26234b32319cSKlaus Jensen             qemu_aio_unref(iocb);
26244b32319cSKlaus Jensen 
262588eea45cSKlaus Jensen             return status;
262688eea45cSKlaus Jensen         }
262788eea45cSKlaus Jensen 
2628d7d1474fSKlaus Jensen         req->aiocb = &iocb->common;
2629d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
263088eea45cSKlaus Jensen 
2631d7d1474fSKlaus Jensen         return NVME_NO_COMPLETE;
263288eea45cSKlaus Jensen     }
263388eea45cSKlaus Jensen 
263488eea45cSKlaus Jensen     return status;
263588eea45cSKlaus Jensen }
263688eea45cSKlaus Jensen 
263788eea45cSKlaus Jensen static uint16_t nvme_verify(NvmeCtrl *n, NvmeRequest *req)
263888eea45cSKlaus Jensen {
263988eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
264088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
264188eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
264288eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
264388eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
264488eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
264588eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
26462a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
264788eea45cSKlaus Jensen     uint32_t reftag = le32_to_cpu(rw->reftag);
264888eea45cSKlaus Jensen     NvmeBounceContext *ctx = NULL;
264988eea45cSKlaus Jensen     uint16_t status;
265088eea45cSKlaus Jensen 
265188eea45cSKlaus Jensen     trace_pci_nvme_verify(nvme_cid(req), nvme_nsid(ns), slba, nlb);
265288eea45cSKlaus Jensen 
265388eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
26542a132309SKlaus Jensen         status = nvme_check_prinfo(ns, prinfo, slba, reftag);
265588eea45cSKlaus Jensen         if (status) {
265688eea45cSKlaus Jensen             return status;
265788eea45cSKlaus Jensen         }
265888eea45cSKlaus Jensen 
26592a132309SKlaus Jensen         if (prinfo & NVME_PRINFO_PRACT) {
266088eea45cSKlaus Jensen             return NVME_INVALID_PROT_INFO | NVME_DNR;
266188eea45cSKlaus Jensen         }
266288eea45cSKlaus Jensen     }
266388eea45cSKlaus Jensen 
266488eea45cSKlaus Jensen     if (len > n->page_size << n->params.vsl) {
266588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
266688eea45cSKlaus Jensen     }
266788eea45cSKlaus Jensen 
266888eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
266988eea45cSKlaus Jensen     if (status) {
267088eea45cSKlaus Jensen         return status;
267188eea45cSKlaus Jensen     }
267288eea45cSKlaus Jensen 
267388eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
267488eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
267588eea45cSKlaus Jensen         if (status) {
267688eea45cSKlaus Jensen             return status;
267788eea45cSKlaus Jensen         }
267888eea45cSKlaus Jensen     }
267988eea45cSKlaus Jensen 
268088eea45cSKlaus Jensen     ctx = g_new0(NvmeBounceContext, 1);
268188eea45cSKlaus Jensen     ctx->req = req;
268288eea45cSKlaus Jensen 
268388eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(len);
268488eea45cSKlaus Jensen 
268588eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
268688eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, len);
268788eea45cSKlaus Jensen 
268888eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, ctx->data.iov.size,
268988eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
269088eea45cSKlaus Jensen 
269188eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(ns->blkconf.blk, offset, &ctx->data.iov, 0,
269288eea45cSKlaus Jensen                                 nvme_verify_mdata_in_cb, ctx);
269388eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
269488eea45cSKlaus Jensen }
269588eea45cSKlaus Jensen 
2696796d2068SKlaus Jensen typedef struct NvmeCopyAIOCB {
2697796d2068SKlaus Jensen     BlockAIOCB common;
2698796d2068SKlaus Jensen     BlockAIOCB *aiocb;
2699796d2068SKlaus Jensen     NvmeRequest *req;
2700796d2068SKlaus Jensen     int ret;
2701796d2068SKlaus Jensen 
270244219b60SNaveen Nagar     void *ranges;
270344219b60SNaveen Nagar     unsigned int format;
2704796d2068SKlaus Jensen     int nr;
2705796d2068SKlaus Jensen     int idx;
2706796d2068SKlaus Jensen 
2707796d2068SKlaus Jensen     uint8_t *bounce;
2708796d2068SKlaus Jensen     QEMUIOVector iov;
2709796d2068SKlaus Jensen     struct {
2710796d2068SKlaus Jensen         BlockAcctCookie read;
2711796d2068SKlaus Jensen         BlockAcctCookie write;
2712796d2068SKlaus Jensen     } acct;
2713796d2068SKlaus Jensen 
271444219b60SNaveen Nagar     uint64_t reftag;
2715796d2068SKlaus Jensen     uint64_t slba;
2716796d2068SKlaus Jensen 
2717796d2068SKlaus Jensen     NvmeZone *zone;
2718796d2068SKlaus Jensen } NvmeCopyAIOCB;
2719796d2068SKlaus Jensen 
2720796d2068SKlaus Jensen static void nvme_copy_cancel(BlockAIOCB *aiocb)
272188eea45cSKlaus Jensen {
2722796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = container_of(aiocb, NvmeCopyAIOCB, common);
2723796d2068SKlaus Jensen 
2724796d2068SKlaus Jensen     iocb->ret = -ECANCELED;
2725796d2068SKlaus Jensen 
2726796d2068SKlaus Jensen     if (iocb->aiocb) {
2727796d2068SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2728796d2068SKlaus Jensen         iocb->aiocb = NULL;
2729796d2068SKlaus Jensen     }
2730796d2068SKlaus Jensen }
2731796d2068SKlaus Jensen 
2732796d2068SKlaus Jensen static const AIOCBInfo nvme_copy_aiocb_info = {
2733796d2068SKlaus Jensen     .aiocb_size   = sizeof(NvmeCopyAIOCB),
2734796d2068SKlaus Jensen     .cancel_async = nvme_copy_cancel,
2735796d2068SKlaus Jensen };
2736796d2068SKlaus Jensen 
273783f56ac3SKlaus Jensen static void nvme_copy_done(NvmeCopyAIOCB *iocb)
2738796d2068SKlaus Jensen {
2739796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
274088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
2741796d2068SKlaus Jensen     BlockAcctStats *stats = blk_get_stats(ns->blkconf.blk);
2742796d2068SKlaus Jensen 
2743796d2068SKlaus Jensen     if (iocb->idx != iocb->nr) {
2744796d2068SKlaus Jensen         req->cqe.result = cpu_to_le32(iocb->idx);
2745796d2068SKlaus Jensen     }
2746796d2068SKlaus Jensen 
2747796d2068SKlaus Jensen     qemu_iovec_destroy(&iocb->iov);
2748796d2068SKlaus Jensen     g_free(iocb->bounce);
2749796d2068SKlaus Jensen 
2750796d2068SKlaus Jensen     if (iocb->ret < 0) {
2751796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.read);
2752796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.write);
2753796d2068SKlaus Jensen     } else {
2754796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.read);
2755796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.write);
2756796d2068SKlaus Jensen     }
2757796d2068SKlaus Jensen 
2758796d2068SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2759796d2068SKlaus Jensen     qemu_aio_unref(iocb);
2760796d2068SKlaus Jensen }
2761796d2068SKlaus Jensen 
276283f56ac3SKlaus Jensen static void nvme_do_copy(NvmeCopyAIOCB *iocb);
2763796d2068SKlaus Jensen 
276444219b60SNaveen Nagar static void nvme_copy_source_range_parse_format0(void *ranges, int idx,
276544219b60SNaveen Nagar                                                  uint64_t *slba, uint32_t *nlb,
276644219b60SNaveen Nagar                                                  uint16_t *apptag,
276744219b60SNaveen Nagar                                                  uint16_t *appmask,
276844219b60SNaveen Nagar                                                  uint64_t *reftag)
276944219b60SNaveen Nagar {
277044219b60SNaveen Nagar     NvmeCopySourceRangeFormat0 *_ranges = ranges;
277144219b60SNaveen Nagar 
277244219b60SNaveen Nagar     if (slba) {
277344219b60SNaveen Nagar         *slba = le64_to_cpu(_ranges[idx].slba);
277444219b60SNaveen Nagar     }
277544219b60SNaveen Nagar 
277644219b60SNaveen Nagar     if (nlb) {
277744219b60SNaveen Nagar         *nlb = le16_to_cpu(_ranges[idx].nlb) + 1;
277844219b60SNaveen Nagar     }
277944219b60SNaveen Nagar 
278044219b60SNaveen Nagar     if (apptag) {
278144219b60SNaveen Nagar         *apptag = le16_to_cpu(_ranges[idx].apptag);
278244219b60SNaveen Nagar     }
278344219b60SNaveen Nagar 
278444219b60SNaveen Nagar     if (appmask) {
278544219b60SNaveen Nagar         *appmask = le16_to_cpu(_ranges[idx].appmask);
278644219b60SNaveen Nagar     }
278744219b60SNaveen Nagar 
278844219b60SNaveen Nagar     if (reftag) {
278944219b60SNaveen Nagar         *reftag = le32_to_cpu(_ranges[idx].reftag);
279044219b60SNaveen Nagar     }
279144219b60SNaveen Nagar }
279244219b60SNaveen Nagar 
279344219b60SNaveen Nagar static void nvme_copy_source_range_parse_format1(void *ranges, int idx,
279444219b60SNaveen Nagar                                                  uint64_t *slba, uint32_t *nlb,
279544219b60SNaveen Nagar                                                  uint16_t *apptag,
279644219b60SNaveen Nagar                                                  uint16_t *appmask,
279744219b60SNaveen Nagar                                                  uint64_t *reftag)
279844219b60SNaveen Nagar {
279944219b60SNaveen Nagar     NvmeCopySourceRangeFormat1 *_ranges = ranges;
280044219b60SNaveen Nagar 
280144219b60SNaveen Nagar     if (slba) {
280244219b60SNaveen Nagar         *slba = le64_to_cpu(_ranges[idx].slba);
280344219b60SNaveen Nagar     }
280444219b60SNaveen Nagar 
280544219b60SNaveen Nagar     if (nlb) {
280644219b60SNaveen Nagar         *nlb = le16_to_cpu(_ranges[idx].nlb) + 1;
280744219b60SNaveen Nagar     }
280844219b60SNaveen Nagar 
280944219b60SNaveen Nagar     if (apptag) {
281044219b60SNaveen Nagar         *apptag = le16_to_cpu(_ranges[idx].apptag);
281144219b60SNaveen Nagar     }
281244219b60SNaveen Nagar 
281344219b60SNaveen Nagar     if (appmask) {
281444219b60SNaveen Nagar         *appmask = le16_to_cpu(_ranges[idx].appmask);
281544219b60SNaveen Nagar     }
281644219b60SNaveen Nagar 
281744219b60SNaveen Nagar     if (reftag) {
281844219b60SNaveen Nagar         *reftag = 0;
281944219b60SNaveen Nagar 
282044219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[4] << 40;
282144219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[5] << 32;
282244219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[6] << 24;
282344219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[7] << 16;
282444219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[8] << 8;
282544219b60SNaveen Nagar         *reftag |= (uint64_t)_ranges[idx].sr[9];
282644219b60SNaveen Nagar     }
282744219b60SNaveen Nagar }
282844219b60SNaveen Nagar 
282944219b60SNaveen Nagar static void nvme_copy_source_range_parse(void *ranges, int idx, uint8_t format,
283044219b60SNaveen Nagar                                          uint64_t *slba, uint32_t *nlb,
283144219b60SNaveen Nagar                                          uint16_t *apptag, uint16_t *appmask,
283244219b60SNaveen Nagar                                          uint64_t *reftag)
283344219b60SNaveen Nagar {
283444219b60SNaveen Nagar     switch (format) {
283544219b60SNaveen Nagar     case NVME_COPY_FORMAT_0:
283644219b60SNaveen Nagar         nvme_copy_source_range_parse_format0(ranges, idx, slba, nlb, apptag,
283744219b60SNaveen Nagar                                              appmask, reftag);
283844219b60SNaveen Nagar         break;
283944219b60SNaveen Nagar 
284044219b60SNaveen Nagar     case NVME_COPY_FORMAT_1:
284144219b60SNaveen Nagar         nvme_copy_source_range_parse_format1(ranges, idx, slba, nlb, apptag,
284244219b60SNaveen Nagar                                              appmask, reftag);
284344219b60SNaveen Nagar         break;
284444219b60SNaveen Nagar 
284544219b60SNaveen Nagar     default:
284644219b60SNaveen Nagar         abort();
284744219b60SNaveen Nagar     }
284844219b60SNaveen Nagar }
284944219b60SNaveen Nagar 
2850796d2068SKlaus Jensen static void nvme_copy_out_completed_cb(void *opaque, int ret)
2851796d2068SKlaus Jensen {
2852796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2853796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2854796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
285544219b60SNaveen Nagar     uint32_t nlb;
285644219b60SNaveen Nagar 
285744219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, NULL,
285844219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
2859796d2068SKlaus Jensen 
2860796d2068SKlaus Jensen     if (ret < 0) {
2861796d2068SKlaus Jensen         iocb->ret = ret;
2862796d2068SKlaus Jensen         goto out;
2863796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2864796d2068SKlaus Jensen         goto out;
2865796d2068SKlaus Jensen     }
2866796d2068SKlaus Jensen 
2867796d2068SKlaus Jensen     if (ns->params.zoned) {
2868796d2068SKlaus Jensen         nvme_advance_zone_wp(ns, iocb->zone, nlb);
2869796d2068SKlaus Jensen     }
2870796d2068SKlaus Jensen 
2871796d2068SKlaus Jensen     iocb->idx++;
2872796d2068SKlaus Jensen     iocb->slba += nlb;
2873796d2068SKlaus Jensen out:
287483f56ac3SKlaus Jensen     nvme_do_copy(iocb);
2875796d2068SKlaus Jensen }
2876796d2068SKlaus Jensen 
2877796d2068SKlaus Jensen static void nvme_copy_out_cb(void *opaque, int ret)
2878796d2068SKlaus Jensen {
2879796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2880796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2881796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2882796d2068SKlaus Jensen     uint32_t nlb;
2883796d2068SKlaus Jensen     size_t mlen;
2884796d2068SKlaus Jensen     uint8_t *mbounce;
2885796d2068SKlaus Jensen 
288683f56ac3SKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
2887796d2068SKlaus Jensen         goto out;
2888796d2068SKlaus Jensen     }
2889796d2068SKlaus Jensen 
289044219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, NULL,
289144219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
2892796d2068SKlaus Jensen 
2893796d2068SKlaus Jensen     mlen = nvme_m2b(ns, nlb);
2894796d2068SKlaus Jensen     mbounce = iocb->bounce + nvme_l2b(ns, nlb);
2895796d2068SKlaus Jensen 
2896796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2897796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, mbounce, mlen);
2898796d2068SKlaus Jensen 
2899796d2068SKlaus Jensen     iocb->aiocb = blk_aio_pwritev(ns->blkconf.blk, nvme_moff(ns, iocb->slba),
2900796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_completed_cb,
2901796d2068SKlaus Jensen                                   iocb);
2902796d2068SKlaus Jensen 
2903796d2068SKlaus Jensen     return;
2904796d2068SKlaus Jensen 
2905796d2068SKlaus Jensen out:
290683f56ac3SKlaus Jensen     nvme_copy_out_completed_cb(iocb, ret);
2907796d2068SKlaus Jensen }
2908796d2068SKlaus Jensen 
2909796d2068SKlaus Jensen static void nvme_copy_in_completed_cb(void *opaque, int ret)
2910796d2068SKlaus Jensen {
2911796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2912796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2913796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2914796d2068SKlaus Jensen     uint32_t nlb;
291544219b60SNaveen Nagar     uint64_t slba;
291644219b60SNaveen Nagar     uint16_t apptag, appmask;
291744219b60SNaveen Nagar     uint64_t reftag;
2918796d2068SKlaus Jensen     size_t len;
2919796d2068SKlaus Jensen     uint16_t status;
2920796d2068SKlaus Jensen 
2921796d2068SKlaus Jensen     if (ret < 0) {
2922796d2068SKlaus Jensen         iocb->ret = ret;
2923796d2068SKlaus Jensen         goto out;
2924796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2925796d2068SKlaus Jensen         goto out;
2926796d2068SKlaus Jensen     }
2927796d2068SKlaus Jensen 
292844219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
292944219b60SNaveen Nagar                                  &nlb, &apptag, &appmask, &reftag);
2930796d2068SKlaus Jensen     len = nvme_l2b(ns, nlb);
2931796d2068SKlaus Jensen 
2932796d2068SKlaus Jensen     trace_pci_nvme_copy_out(iocb->slba, nlb);
2933796d2068SKlaus Jensen 
2934796d2068SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
293588eea45cSKlaus Jensen         NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
293688eea45cSKlaus Jensen 
2937796d2068SKlaus Jensen         uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
2938796d2068SKlaus Jensen         uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
293988eea45cSKlaus Jensen 
2940796d2068SKlaus Jensen         size_t mlen = nvme_m2b(ns, nlb);
2941796d2068SKlaus Jensen         uint8_t *mbounce = iocb->bounce + nvme_l2b(ns, nlb);
2942796d2068SKlaus Jensen 
29432e8f952aSDmitry Tikhov         status = nvme_dif_mangle_mdata(ns, mbounce, mlen, slba);
29442e8f952aSDmitry Tikhov         if (status) {
29452e8f952aSDmitry Tikhov             goto invalid;
29462e8f952aSDmitry Tikhov         }
2947796d2068SKlaus Jensen         status = nvme_dif_check(ns, iocb->bounce, len, mbounce, mlen, prinfor,
2948796d2068SKlaus Jensen                                 slba, apptag, appmask, &reftag);
2949796d2068SKlaus Jensen         if (status) {
2950796d2068SKlaus Jensen             goto invalid;
2951796d2068SKlaus Jensen         }
2952796d2068SKlaus Jensen 
2953796d2068SKlaus Jensen         apptag = le16_to_cpu(copy->apptag);
2954796d2068SKlaus Jensen         appmask = le16_to_cpu(copy->appmask);
2955796d2068SKlaus Jensen 
2956796d2068SKlaus Jensen         if (prinfow & NVME_PRINFO_PRACT) {
2957796d2068SKlaus Jensen             status = nvme_check_prinfo(ns, prinfow, iocb->slba, iocb->reftag);
2958796d2068SKlaus Jensen             if (status) {
2959796d2068SKlaus Jensen                 goto invalid;
2960796d2068SKlaus Jensen             }
2961796d2068SKlaus Jensen 
2962796d2068SKlaus Jensen             nvme_dif_pract_generate_dif(ns, iocb->bounce, len, mbounce, mlen,
2963796d2068SKlaus Jensen                                         apptag, &iocb->reftag);
2964796d2068SKlaus Jensen         } else {
2965796d2068SKlaus Jensen             status = nvme_dif_check(ns, iocb->bounce, len, mbounce, mlen,
2966796d2068SKlaus Jensen                                     prinfow, iocb->slba, apptag, appmask,
2967796d2068SKlaus Jensen                                     &iocb->reftag);
2968796d2068SKlaus Jensen             if (status) {
2969796d2068SKlaus Jensen                 goto invalid;
2970796d2068SKlaus Jensen             }
2971796d2068SKlaus Jensen         }
2972796d2068SKlaus Jensen     }
2973796d2068SKlaus Jensen 
2974796d2068SKlaus Jensen     status = nvme_check_bounds(ns, iocb->slba, nlb);
2975796d2068SKlaus Jensen     if (status) {
2976796d2068SKlaus Jensen         goto invalid;
2977796d2068SKlaus Jensen     }
2978796d2068SKlaus Jensen 
2979796d2068SKlaus Jensen     if (ns->params.zoned) {
2980796d2068SKlaus Jensen         status = nvme_check_zone_write(ns, iocb->zone, iocb->slba, nlb);
2981796d2068SKlaus Jensen         if (status) {
2982796d2068SKlaus Jensen             goto invalid;
2983796d2068SKlaus Jensen         }
2984796d2068SKlaus Jensen 
2985e321b4cdSKlaus Jensen         if (!(iocb->zone->d.za & NVME_ZA_ZRWA_VALID)) {
2986796d2068SKlaus Jensen             iocb->zone->w_ptr += nlb;
2987796d2068SKlaus Jensen         }
2988e321b4cdSKlaus Jensen     }
2989796d2068SKlaus Jensen 
2990796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2991796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
2992796d2068SKlaus Jensen 
2993796d2068SKlaus Jensen     iocb->aiocb = blk_aio_pwritev(ns->blkconf.blk, nvme_l2b(ns, iocb->slba),
2994796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_cb, iocb);
2995796d2068SKlaus Jensen 
2996796d2068SKlaus Jensen     return;
2997796d2068SKlaus Jensen 
2998796d2068SKlaus Jensen invalid:
2999796d2068SKlaus Jensen     req->status = status;
300083f56ac3SKlaus Jensen     iocb->ret = -1;
3001796d2068SKlaus Jensen out:
300283f56ac3SKlaus Jensen     nvme_do_copy(iocb);
3003796d2068SKlaus Jensen }
3004796d2068SKlaus Jensen 
3005796d2068SKlaus Jensen static void nvme_copy_in_cb(void *opaque, int ret)
3006796d2068SKlaus Jensen {
3007796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
3008796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
3009796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
3010796d2068SKlaus Jensen     uint64_t slba;
3011796d2068SKlaus Jensen     uint32_t nlb;
3012796d2068SKlaus Jensen 
301383f56ac3SKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
3014796d2068SKlaus Jensen         goto out;
3015796d2068SKlaus Jensen     }
3016796d2068SKlaus Jensen 
301744219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
301844219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
3019796d2068SKlaus Jensen 
3020796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
3021796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce + nvme_l2b(ns, nlb),
3022796d2068SKlaus Jensen                    nvme_m2b(ns, nlb));
3023796d2068SKlaus Jensen 
3024796d2068SKlaus Jensen     iocb->aiocb = blk_aio_preadv(ns->blkconf.blk, nvme_moff(ns, slba),
3025796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_completed_cb,
3026796d2068SKlaus Jensen                                  iocb);
3027796d2068SKlaus Jensen     return;
3028796d2068SKlaus Jensen 
3029796d2068SKlaus Jensen out:
303083f56ac3SKlaus Jensen     nvme_copy_in_completed_cb(iocb, ret);
3031796d2068SKlaus Jensen }
3032796d2068SKlaus Jensen 
303383f56ac3SKlaus Jensen static void nvme_do_copy(NvmeCopyAIOCB *iocb)
3034796d2068SKlaus Jensen {
3035796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
3036796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
3037796d2068SKlaus Jensen     uint64_t slba;
3038796d2068SKlaus Jensen     uint32_t nlb;
3039796d2068SKlaus Jensen     size_t len;
304088eea45cSKlaus Jensen     uint16_t status;
304188eea45cSKlaus Jensen 
304283f56ac3SKlaus Jensen     if (iocb->ret < 0) {
3043796d2068SKlaus Jensen         goto done;
304488eea45cSKlaus Jensen     }
304588eea45cSKlaus Jensen 
3046796d2068SKlaus Jensen     if (iocb->idx == iocb->nr) {
3047796d2068SKlaus Jensen         goto done;
304888eea45cSKlaus Jensen     }
304988eea45cSKlaus Jensen 
305044219b60SNaveen Nagar     nvme_copy_source_range_parse(iocb->ranges, iocb->idx, iocb->format, &slba,
305144219b60SNaveen Nagar                                  &nlb, NULL, NULL, NULL);
3052796d2068SKlaus Jensen     len = nvme_l2b(ns, nlb);
305388eea45cSKlaus Jensen 
3054796d2068SKlaus Jensen     trace_pci_nvme_copy_source_range(slba, nlb);
305588eea45cSKlaus Jensen 
3056796d2068SKlaus Jensen     if (nlb > le16_to_cpu(ns->id_ns.mssrl)) {
305788eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
3058796d2068SKlaus Jensen         goto invalid;
305988eea45cSKlaus Jensen     }
306088eea45cSKlaus Jensen 
3061796d2068SKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
306288eea45cSKlaus Jensen     if (status) {
3063796d2068SKlaus Jensen         goto invalid;
306488eea45cSKlaus Jensen     }
306588eea45cSKlaus Jensen 
306688eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
3067796d2068SKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
306888eea45cSKlaus Jensen         if (status) {
3069796d2068SKlaus Jensen             goto invalid;
307088eea45cSKlaus Jensen         }
307188eea45cSKlaus Jensen     }
307288eea45cSKlaus Jensen 
307388eea45cSKlaus Jensen     if (ns->params.zoned) {
3074796d2068SKlaus Jensen         status = nvme_check_zone_read(ns, slba, nlb);
307588eea45cSKlaus Jensen         if (status) {
3076796d2068SKlaus Jensen             goto invalid;
307788eea45cSKlaus Jensen         }
307888eea45cSKlaus Jensen     }
307988eea45cSKlaus Jensen 
3080796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
3081796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
3082796d2068SKlaus Jensen 
3083796d2068SKlaus Jensen     iocb->aiocb = blk_aio_preadv(ns->blkconf.blk, nvme_l2b(ns, slba),
3084796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_cb, iocb);
3085796d2068SKlaus Jensen     return;
3086796d2068SKlaus Jensen 
3087796d2068SKlaus Jensen invalid:
3088796d2068SKlaus Jensen     req->status = status;
308983f56ac3SKlaus Jensen     iocb->ret = -1;
3090796d2068SKlaus Jensen done:
309183f56ac3SKlaus Jensen     nvme_copy_done(iocb);
3092796d2068SKlaus Jensen }
3093796d2068SKlaus Jensen 
3094796d2068SKlaus Jensen static uint16_t nvme_copy(NvmeCtrl *n, NvmeRequest *req)
3095796d2068SKlaus Jensen {
3096796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
3097796d2068SKlaus Jensen     NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
3098796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = blk_aio_get(&nvme_copy_aiocb_info, ns->blkconf.blk,
3099796d2068SKlaus Jensen                                       nvme_misc_cb, req);
3100796d2068SKlaus Jensen     uint16_t nr = copy->nr + 1;
3101796d2068SKlaus Jensen     uint8_t format = copy->control[0] & 0xf;
3102796d2068SKlaus Jensen     uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
3103796d2068SKlaus Jensen     uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
310444219b60SNaveen Nagar     size_t len = sizeof(NvmeCopySourceRangeFormat0);
3105796d2068SKlaus Jensen 
3106796d2068SKlaus Jensen     uint16_t status;
3107796d2068SKlaus Jensen 
3108796d2068SKlaus Jensen     trace_pci_nvme_copy(nvme_cid(req), nvme_nsid(ns), nr, format);
3109796d2068SKlaus Jensen 
3110796d2068SKlaus Jensen     iocb->ranges = NULL;
3111796d2068SKlaus Jensen     iocb->zone = NULL;
3112796d2068SKlaus Jensen 
3113796d2068SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps) &&
3114796d2068SKlaus Jensen         ((prinfor & NVME_PRINFO_PRACT) != (prinfow & NVME_PRINFO_PRACT))) {
3115796d2068SKlaus Jensen         status = NVME_INVALID_FIELD | NVME_DNR;
3116796d2068SKlaus Jensen         goto invalid;
3117796d2068SKlaus Jensen     }
3118796d2068SKlaus Jensen 
3119796d2068SKlaus Jensen     if (!(n->id_ctrl.ocfs & (1 << format))) {
3120796d2068SKlaus Jensen         trace_pci_nvme_err_copy_invalid_format(format);
3121796d2068SKlaus Jensen         status = NVME_INVALID_FIELD | NVME_DNR;
3122796d2068SKlaus Jensen         goto invalid;
3123796d2068SKlaus Jensen     }
3124796d2068SKlaus Jensen 
3125796d2068SKlaus Jensen     if (nr > ns->id_ns.msrc + 1) {
312688eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
3127796d2068SKlaus Jensen         goto invalid;
312888eea45cSKlaus Jensen     }
312988eea45cSKlaus Jensen 
3130632cb6cfSFrancis Pravin Antony Michael Raj     if ((ns->pif == 0x0 && format != 0x0) ||
3131632cb6cfSFrancis Pravin Antony Michael Raj         (ns->pif != 0x0 && format != 0x1)) {
313244219b60SNaveen Nagar         status = NVME_INVALID_FORMAT | NVME_DNR;
313344219b60SNaveen Nagar         goto invalid;
313444219b60SNaveen Nagar     }
3135796d2068SKlaus Jensen 
313644219b60SNaveen Nagar     if (ns->pif) {
313744219b60SNaveen Nagar         len = sizeof(NvmeCopySourceRangeFormat1);
313844219b60SNaveen Nagar     }
313944219b60SNaveen Nagar 
314044219b60SNaveen Nagar     iocb->format = format;
314144219b60SNaveen Nagar     iocb->ranges = g_malloc_n(nr, len);
314244219b60SNaveen Nagar     status = nvme_h2c(n, (uint8_t *)iocb->ranges, len * nr, req);
3143796d2068SKlaus Jensen     if (status) {
3144796d2068SKlaus Jensen         goto invalid;
314588eea45cSKlaus Jensen     }
314688eea45cSKlaus Jensen 
3147796d2068SKlaus Jensen     iocb->slba = le64_to_cpu(copy->sdlba);
3148796d2068SKlaus Jensen 
3149796d2068SKlaus Jensen     if (ns->params.zoned) {
3150796d2068SKlaus Jensen         iocb->zone = nvme_get_zone_by_slba(ns, iocb->slba);
3151796d2068SKlaus Jensen         if (!iocb->zone) {
3152796d2068SKlaus Jensen             status = NVME_LBA_RANGE | NVME_DNR;
3153796d2068SKlaus Jensen             goto invalid;
3154796d2068SKlaus Jensen         }
3155796d2068SKlaus Jensen 
3156796d2068SKlaus Jensen         status = nvme_zrm_auto(n, ns, iocb->zone);
3157796d2068SKlaus Jensen         if (status) {
3158796d2068SKlaus Jensen             goto invalid;
3159796d2068SKlaus Jensen         }
3160796d2068SKlaus Jensen     }
3161796d2068SKlaus Jensen 
3162796d2068SKlaus Jensen     iocb->req = req;
3163796d2068SKlaus Jensen     iocb->ret = 0;
3164796d2068SKlaus Jensen     iocb->nr = nr;
3165796d2068SKlaus Jensen     iocb->idx = 0;
3166796d2068SKlaus Jensen     iocb->reftag = le32_to_cpu(copy->reftag);
316744219b60SNaveen Nagar     iocb->reftag |= (uint64_t)le32_to_cpu(copy->cdw3) << 32;
3168796d2068SKlaus Jensen     iocb->bounce = g_malloc_n(le16_to_cpu(ns->id_ns.mssrl),
3169796d2068SKlaus Jensen                               ns->lbasz + ns->lbaf.ms);
3170796d2068SKlaus Jensen 
3171796d2068SKlaus Jensen     qemu_iovec_init(&iocb->iov, 1);
3172796d2068SKlaus Jensen 
3173796d2068SKlaus Jensen     block_acct_start(blk_get_stats(ns->blkconf.blk), &iocb->acct.read, 0,
317488eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
3175796d2068SKlaus Jensen     block_acct_start(blk_get_stats(ns->blkconf.blk), &iocb->acct.write, 0,
3176796d2068SKlaus Jensen                      BLOCK_ACCT_WRITE);
317788eea45cSKlaus Jensen 
3178796d2068SKlaus Jensen     req->aiocb = &iocb->common;
317983f56ac3SKlaus Jensen     nvme_do_copy(iocb);
318088eea45cSKlaus Jensen 
318188eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
318288eea45cSKlaus Jensen 
3183796d2068SKlaus Jensen invalid:
3184796d2068SKlaus Jensen     g_free(iocb->ranges);
3185796d2068SKlaus Jensen     qemu_aio_unref(iocb);
318688eea45cSKlaus Jensen     return status;
318788eea45cSKlaus Jensen }
318888eea45cSKlaus Jensen 
318988eea45cSKlaus Jensen static uint16_t nvme_compare(NvmeCtrl *n, NvmeRequest *req)
319088eea45cSKlaus Jensen {
319188eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
319288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
319388eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
319488eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
319588eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
31962a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
319788eea45cSKlaus Jensen     size_t data_len = nvme_l2b(ns, nlb);
319888eea45cSKlaus Jensen     size_t len = data_len;
319988eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
320088eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = NULL;
320188eea45cSKlaus Jensen     uint16_t status;
320288eea45cSKlaus Jensen 
320388eea45cSKlaus Jensen     trace_pci_nvme_compare(nvme_cid(req), nvme_nsid(ns), slba, nlb);
320488eea45cSKlaus Jensen 
32052a132309SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps) && (prinfo & NVME_PRINFO_PRACT)) {
320688eea45cSKlaus Jensen         return NVME_INVALID_PROT_INFO | NVME_DNR;
320788eea45cSKlaus Jensen     }
320888eea45cSKlaus Jensen 
320988eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
321088eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
321188eea45cSKlaus Jensen     }
321288eea45cSKlaus Jensen 
321388eea45cSKlaus Jensen     status = nvme_check_mdts(n, len);
321488eea45cSKlaus Jensen     if (status) {
321588eea45cSKlaus Jensen         return status;
321688eea45cSKlaus Jensen     }
321788eea45cSKlaus Jensen 
321888eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
321988eea45cSKlaus Jensen     if (status) {
322088eea45cSKlaus Jensen         return status;
322188eea45cSKlaus Jensen     }
322288eea45cSKlaus Jensen 
322388eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
322488eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
322588eea45cSKlaus Jensen         if (status) {
322688eea45cSKlaus Jensen             return status;
322788eea45cSKlaus Jensen         }
322888eea45cSKlaus Jensen     }
322988eea45cSKlaus Jensen 
323088eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
323188eea45cSKlaus Jensen     if (status) {
323288eea45cSKlaus Jensen         return status;
323388eea45cSKlaus Jensen     }
323488eea45cSKlaus Jensen 
323588eea45cSKlaus Jensen     ctx = g_new(struct nvme_compare_ctx, 1);
323688eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(data_len);
323788eea45cSKlaus Jensen 
323888eea45cSKlaus Jensen     req->opaque = ctx;
323988eea45cSKlaus Jensen 
324088eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
324188eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, data_len);
324288eea45cSKlaus Jensen 
324388eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_len,
324488eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
324588eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->data.iov, 0,
324688eea45cSKlaus Jensen                                 nvme_compare_data_cb, req);
324788eea45cSKlaus Jensen 
324888eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
324988eea45cSKlaus Jensen }
325088eea45cSKlaus Jensen 
325138f4ac65SKlaus Jensen typedef struct NvmeFlushAIOCB {
325238f4ac65SKlaus Jensen     BlockAIOCB common;
325338f4ac65SKlaus Jensen     BlockAIOCB *aiocb;
325438f4ac65SKlaus Jensen     NvmeRequest *req;
325538f4ac65SKlaus Jensen     int ret;
325638f4ac65SKlaus Jensen 
325738f4ac65SKlaus Jensen     NvmeNamespace *ns;
325838f4ac65SKlaus Jensen     uint32_t nsid;
325938f4ac65SKlaus Jensen     bool broadcast;
326038f4ac65SKlaus Jensen } NvmeFlushAIOCB;
326138f4ac65SKlaus Jensen 
326238f4ac65SKlaus Jensen static void nvme_flush_cancel(BlockAIOCB *acb)
326338f4ac65SKlaus Jensen {
326438f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = container_of(acb, NvmeFlushAIOCB, common);
326538f4ac65SKlaus Jensen 
326638f4ac65SKlaus Jensen     iocb->ret = -ECANCELED;
326738f4ac65SKlaus Jensen 
326838f4ac65SKlaus Jensen     if (iocb->aiocb) {
326938f4ac65SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
32703dbc1708SKlaus Jensen         iocb->aiocb = NULL;
327138f4ac65SKlaus Jensen     }
327238f4ac65SKlaus Jensen }
327338f4ac65SKlaus Jensen 
327438f4ac65SKlaus Jensen static const AIOCBInfo nvme_flush_aiocb_info = {
327538f4ac65SKlaus Jensen     .aiocb_size = sizeof(NvmeFlushAIOCB),
327638f4ac65SKlaus Jensen     .cancel_async = nvme_flush_cancel,
327738f4ac65SKlaus Jensen     .get_aio_context = nvme_get_aio_context,
327838f4ac65SKlaus Jensen };
327938f4ac65SKlaus Jensen 
32803dbc1708SKlaus Jensen static void nvme_do_flush(NvmeFlushAIOCB *iocb);
32813dbc1708SKlaus Jensen 
328238f4ac65SKlaus Jensen static void nvme_flush_ns_cb(void *opaque, int ret)
328338f4ac65SKlaus Jensen {
328438f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = opaque;
328538f4ac65SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
328638f4ac65SKlaus Jensen 
328738f4ac65SKlaus Jensen     if (ret < 0) {
328838f4ac65SKlaus Jensen         iocb->ret = ret;
328938f4ac65SKlaus Jensen         goto out;
329038f4ac65SKlaus Jensen     } else if (iocb->ret < 0) {
329138f4ac65SKlaus Jensen         goto out;
329238f4ac65SKlaus Jensen     }
329338f4ac65SKlaus Jensen 
329438f4ac65SKlaus Jensen     if (ns) {
329538f4ac65SKlaus Jensen         trace_pci_nvme_flush_ns(iocb->nsid);
329638f4ac65SKlaus Jensen 
329738f4ac65SKlaus Jensen         iocb->ns = NULL;
329838f4ac65SKlaus Jensen         iocb->aiocb = blk_aio_flush(ns->blkconf.blk, nvme_flush_ns_cb, iocb);
329938f4ac65SKlaus Jensen         return;
330038f4ac65SKlaus Jensen     }
330138f4ac65SKlaus Jensen 
330238f4ac65SKlaus Jensen out:
33033dbc1708SKlaus Jensen     nvme_do_flush(iocb);
330438f4ac65SKlaus Jensen }
330538f4ac65SKlaus Jensen 
33063dbc1708SKlaus Jensen static void nvme_do_flush(NvmeFlushAIOCB *iocb)
330738f4ac65SKlaus Jensen {
330838f4ac65SKlaus Jensen     NvmeRequest *req = iocb->req;
330938f4ac65SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
331038f4ac65SKlaus Jensen     int i;
331138f4ac65SKlaus Jensen 
331238f4ac65SKlaus Jensen     if (iocb->ret < 0) {
331338f4ac65SKlaus Jensen         goto done;
331438f4ac65SKlaus Jensen     }
331538f4ac65SKlaus Jensen 
331638f4ac65SKlaus Jensen     if (iocb->broadcast) {
331738f4ac65SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
331838f4ac65SKlaus Jensen             iocb->ns = nvme_ns(n, i);
331938f4ac65SKlaus Jensen             if (iocb->ns) {
332038f4ac65SKlaus Jensen                 iocb->nsid = i;
332138f4ac65SKlaus Jensen                 break;
332238f4ac65SKlaus Jensen             }
332338f4ac65SKlaus Jensen         }
332438f4ac65SKlaus Jensen     }
332538f4ac65SKlaus Jensen 
332638f4ac65SKlaus Jensen     if (!iocb->ns) {
332738f4ac65SKlaus Jensen         goto done;
332838f4ac65SKlaus Jensen     }
332938f4ac65SKlaus Jensen 
333038f4ac65SKlaus Jensen     nvme_flush_ns_cb(iocb, 0);
333138f4ac65SKlaus Jensen     return;
333238f4ac65SKlaus Jensen 
333338f4ac65SKlaus Jensen done:
333438f4ac65SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
333538f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
333638f4ac65SKlaus Jensen }
333738f4ac65SKlaus Jensen 
333888eea45cSKlaus Jensen static uint16_t nvme_flush(NvmeCtrl *n, NvmeRequest *req)
333988eea45cSKlaus Jensen {
334038f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb;
334188eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
334288eea45cSKlaus Jensen     uint16_t status;
334388eea45cSKlaus Jensen 
334438f4ac65SKlaus Jensen     iocb = qemu_aio_get(&nvme_flush_aiocb_info, NULL, nvme_misc_cb, req);
334588eea45cSKlaus Jensen 
334638f4ac65SKlaus Jensen     iocb->req = req;
334738f4ac65SKlaus Jensen     iocb->ret = 0;
334838f4ac65SKlaus Jensen     iocb->ns = NULL;
334938f4ac65SKlaus Jensen     iocb->nsid = 0;
335038f4ac65SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
335138f4ac65SKlaus Jensen 
335238f4ac65SKlaus Jensen     if (!iocb->broadcast) {
335338f4ac65SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
335438f4ac65SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
335538f4ac65SKlaus Jensen             goto out;
335688eea45cSKlaus Jensen         }
335788eea45cSKlaus Jensen 
335838f4ac65SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
335938f4ac65SKlaus Jensen         if (!iocb->ns) {
336038f4ac65SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
336138f4ac65SKlaus Jensen             goto out;
336238f4ac65SKlaus Jensen         }
336338f4ac65SKlaus Jensen 
336438f4ac65SKlaus Jensen         iocb->nsid = nsid;
336538f4ac65SKlaus Jensen     }
336638f4ac65SKlaus Jensen 
336738f4ac65SKlaus Jensen     req->aiocb = &iocb->common;
33683dbc1708SKlaus Jensen     nvme_do_flush(iocb);
336938f4ac65SKlaus Jensen 
337088eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
337188eea45cSKlaus Jensen 
337238f4ac65SKlaus Jensen out:
337338f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
337488eea45cSKlaus Jensen 
337588eea45cSKlaus Jensen     return status;
337688eea45cSKlaus Jensen }
337788eea45cSKlaus Jensen 
337888eea45cSKlaus Jensen static uint16_t nvme_read(NvmeCtrl *n, NvmeRequest *req)
337988eea45cSKlaus Jensen {
338088eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
338188eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
338288eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
338388eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
33842a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
338588eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
338688eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
338788eea45cSKlaus Jensen     uint64_t data_offset;
338888eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
338988eea45cSKlaus Jensen     uint16_t status;
339088eea45cSKlaus Jensen 
339188eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
339288eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
339388eea45cSKlaus Jensen 
339488eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
33952a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
339688eea45cSKlaus Jensen 
3397ac0b34c5SKlaus Jensen             if (pract && ns->lbaf.ms == nvme_pi_tuple_size(ns)) {
339888eea45cSKlaus Jensen                 mapped_size = data_size;
339988eea45cSKlaus Jensen             }
340088eea45cSKlaus Jensen         }
340188eea45cSKlaus Jensen     }
340288eea45cSKlaus Jensen 
340388eea45cSKlaus Jensen     trace_pci_nvme_read(nvme_cid(req), nvme_nsid(ns), nlb, mapped_size, slba);
340488eea45cSKlaus Jensen 
340588eea45cSKlaus Jensen     status = nvme_check_mdts(n, mapped_size);
340688eea45cSKlaus Jensen     if (status) {
340788eea45cSKlaus Jensen         goto invalid;
340888eea45cSKlaus Jensen     }
340988eea45cSKlaus Jensen 
341088eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
341188eea45cSKlaus Jensen     if (status) {
341288eea45cSKlaus Jensen         goto invalid;
341388eea45cSKlaus Jensen     }
341488eea45cSKlaus Jensen 
341588eea45cSKlaus Jensen     if (ns->params.zoned) {
341688eea45cSKlaus Jensen         status = nvme_check_zone_read(ns, slba, nlb);
341788eea45cSKlaus Jensen         if (status) {
341888eea45cSKlaus Jensen             trace_pci_nvme_err_zone_read_not_ok(slba, nlb, status);
341988eea45cSKlaus Jensen             goto invalid;
342088eea45cSKlaus Jensen         }
342188eea45cSKlaus Jensen     }
342288eea45cSKlaus Jensen 
342388eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
342488eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
342588eea45cSKlaus Jensen         if (status) {
342688eea45cSKlaus Jensen             goto invalid;
342788eea45cSKlaus Jensen         }
342888eea45cSKlaus Jensen     }
342988eea45cSKlaus Jensen 
343088eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
343188eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
343288eea45cSKlaus Jensen     }
343388eea45cSKlaus Jensen 
343488eea45cSKlaus Jensen     status = nvme_map_data(n, nlb, req);
343588eea45cSKlaus Jensen     if (status) {
343688eea45cSKlaus Jensen         goto invalid;
343788eea45cSKlaus Jensen     }
343888eea45cSKlaus Jensen 
343988eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
344088eea45cSKlaus Jensen 
344188eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_size,
344288eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
34439b4f0181SMateusz Kozlowski     nvme_blk_read(blk, data_offset, BDRV_SECTOR_SIZE, nvme_rw_cb, req);
344488eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
344588eea45cSKlaus Jensen 
344688eea45cSKlaus Jensen invalid:
344788eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_READ);
344888eea45cSKlaus Jensen     return status | NVME_DNR;
344988eea45cSKlaus Jensen }
345088eea45cSKlaus Jensen 
345173064edfSJesper Devantier static void nvme_do_write_fdp(NvmeCtrl *n, NvmeRequest *req, uint64_t slba,
345273064edfSJesper Devantier                               uint32_t nlb)
345373064edfSJesper Devantier {
345473064edfSJesper Devantier     NvmeNamespace *ns = req->ns;
345573064edfSJesper Devantier     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
345673064edfSJesper Devantier     uint64_t data_size = nvme_l2b(ns, nlb);
345773064edfSJesper Devantier     uint32_t dw12 = le32_to_cpu(req->cmd.cdw12);
345873064edfSJesper Devantier     uint8_t dtype = (dw12 >> 20) & 0xf;
345973064edfSJesper Devantier     uint16_t pid = le16_to_cpu(rw->dspec);
346073064edfSJesper Devantier     uint16_t ph, rg, ruhid;
346173064edfSJesper Devantier     NvmeReclaimUnit *ru;
346273064edfSJesper Devantier 
346373064edfSJesper Devantier     if (dtype != NVME_DIRECTIVE_DATA_PLACEMENT ||
346473064edfSJesper Devantier         !nvme_parse_pid(ns, pid, &ph, &rg)) {
346573064edfSJesper Devantier         ph = 0;
346673064edfSJesper Devantier         rg = 0;
346773064edfSJesper Devantier     }
346873064edfSJesper Devantier 
346973064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
347073064edfSJesper Devantier     ru = &ns->endgrp->fdp.ruhs[ruhid].rus[rg];
347173064edfSJesper Devantier 
347273064edfSJesper Devantier     nvme_fdp_stat_inc(&ns->endgrp->fdp.hbmw, data_size);
347373064edfSJesper Devantier     nvme_fdp_stat_inc(&ns->endgrp->fdp.mbmw, data_size);
347473064edfSJesper Devantier 
347573064edfSJesper Devantier     while (nlb) {
347673064edfSJesper Devantier         if (nlb < ru->ruamw) {
347773064edfSJesper Devantier             ru->ruamw -= nlb;
347873064edfSJesper Devantier             break;
347973064edfSJesper Devantier         }
348073064edfSJesper Devantier 
348173064edfSJesper Devantier         nlb -= ru->ruamw;
348273064edfSJesper Devantier         nvme_update_ruh(n, ns, pid);
348373064edfSJesper Devantier     }
348473064edfSJesper Devantier }
348573064edfSJesper Devantier 
348688eea45cSKlaus Jensen static uint16_t nvme_do_write(NvmeCtrl *n, NvmeRequest *req, bool append,
348788eea45cSKlaus Jensen                               bool wrz)
348888eea45cSKlaus Jensen {
348988eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
349088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
349188eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
349288eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
349388eea45cSKlaus Jensen     uint16_t ctrl = le16_to_cpu(rw->control);
34942a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(ctrl);
349588eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
349688eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
349788eea45cSKlaus Jensen     uint64_t data_offset;
349888eea45cSKlaus Jensen     NvmeZone *zone;
349988eea45cSKlaus Jensen     NvmeZonedResult *res = (NvmeZonedResult *)&req->cqe;
350088eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
350188eea45cSKlaus Jensen     uint16_t status;
350288eea45cSKlaus Jensen 
350388eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
350488eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
350588eea45cSKlaus Jensen 
350688eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
35072a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
350888eea45cSKlaus Jensen 
3509ac0b34c5SKlaus Jensen             if (pract && ns->lbaf.ms == nvme_pi_tuple_size(ns)) {
351088eea45cSKlaus Jensen                 mapped_size -= nvme_m2b(ns, nlb);
351188eea45cSKlaus Jensen             }
351288eea45cSKlaus Jensen         }
351388eea45cSKlaus Jensen     }
351488eea45cSKlaus Jensen 
351588eea45cSKlaus Jensen     trace_pci_nvme_write(nvme_cid(req), nvme_io_opc_str(rw->opcode),
351688eea45cSKlaus Jensen                          nvme_nsid(ns), nlb, mapped_size, slba);
351788eea45cSKlaus Jensen 
351888eea45cSKlaus Jensen     if (!wrz) {
351988eea45cSKlaus Jensen         status = nvme_check_mdts(n, mapped_size);
352088eea45cSKlaus Jensen         if (status) {
352188eea45cSKlaus Jensen             goto invalid;
352288eea45cSKlaus Jensen         }
352388eea45cSKlaus Jensen     }
352488eea45cSKlaus Jensen 
352588eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
352688eea45cSKlaus Jensen     if (status) {
352788eea45cSKlaus Jensen         goto invalid;
352888eea45cSKlaus Jensen     }
352988eea45cSKlaus Jensen 
353088eea45cSKlaus Jensen     if (ns->params.zoned) {
353188eea45cSKlaus Jensen         zone = nvme_get_zone_by_slba(ns, slba);
3532189a8bf7SKlaus Jensen         assert(zone);
353388eea45cSKlaus Jensen 
353488eea45cSKlaus Jensen         if (append) {
353588eea45cSKlaus Jensen             bool piremap = !!(ctrl & NVME_RW_PIREMAP);
353688eea45cSKlaus Jensen 
3537e321b4cdSKlaus Jensen             if (unlikely(zone->d.za & NVME_ZA_ZRWA_VALID)) {
3538e321b4cdSKlaus Jensen                 return NVME_INVALID_ZONE_OP | NVME_DNR;
3539e321b4cdSKlaus Jensen             }
3540e321b4cdSKlaus Jensen 
354188eea45cSKlaus Jensen             if (unlikely(slba != zone->d.zslba)) {
354288eea45cSKlaus Jensen                 trace_pci_nvme_err_append_not_at_start(slba, zone->d.zslba);
354388eea45cSKlaus Jensen                 status = NVME_INVALID_FIELD;
354488eea45cSKlaus Jensen                 goto invalid;
354588eea45cSKlaus Jensen             }
354688eea45cSKlaus Jensen 
354788eea45cSKlaus Jensen             if (n->params.zasl &&
354888eea45cSKlaus Jensen                 data_size > (uint64_t)n->page_size << n->params.zasl) {
354988eea45cSKlaus Jensen                 trace_pci_nvme_err_zasl(data_size);
355088eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
355188eea45cSKlaus Jensen             }
355288eea45cSKlaus Jensen 
355388eea45cSKlaus Jensen             slba = zone->w_ptr;
355488eea45cSKlaus Jensen             rw->slba = cpu_to_le64(slba);
355588eea45cSKlaus Jensen             res->slba = cpu_to_le64(slba);
355688eea45cSKlaus Jensen 
355788eea45cSKlaus Jensen             switch (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
355888eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_1:
355988eea45cSKlaus Jensen                 if (!piremap) {
356088eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
356188eea45cSKlaus Jensen                 }
356288eea45cSKlaus Jensen 
356388eea45cSKlaus Jensen                 /* fallthrough */
356488eea45cSKlaus Jensen 
356588eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_2:
356688eea45cSKlaus Jensen                 if (piremap) {
356788eea45cSKlaus Jensen                     uint32_t reftag = le32_to_cpu(rw->reftag);
356888eea45cSKlaus Jensen                     rw->reftag = cpu_to_le32(reftag + (slba - zone->d.zslba));
356988eea45cSKlaus Jensen                 }
357088eea45cSKlaus Jensen 
357188eea45cSKlaus Jensen                 break;
357288eea45cSKlaus Jensen 
357388eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_3:
357488eea45cSKlaus Jensen                 if (piremap) {
357588eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
357688eea45cSKlaus Jensen                 }
357788eea45cSKlaus Jensen 
357888eea45cSKlaus Jensen                 break;
357988eea45cSKlaus Jensen             }
358088eea45cSKlaus Jensen         }
358188eea45cSKlaus Jensen 
358288eea45cSKlaus Jensen         status = nvme_check_zone_write(ns, zone, slba, nlb);
358388eea45cSKlaus Jensen         if (status) {
358488eea45cSKlaus Jensen             goto invalid;
358588eea45cSKlaus Jensen         }
358688eea45cSKlaus Jensen 
3587cccc2651SNiklas Cassel         status = nvme_zrm_auto(n, ns, zone);
358888eea45cSKlaus Jensen         if (status) {
358988eea45cSKlaus Jensen             goto invalid;
359088eea45cSKlaus Jensen         }
359188eea45cSKlaus Jensen 
3592e321b4cdSKlaus Jensen         if (!(zone->d.za & NVME_ZA_ZRWA_VALID)) {
359388eea45cSKlaus Jensen             zone->w_ptr += nlb;
359488eea45cSKlaus Jensen         }
359573064edfSJesper Devantier     } else if (ns->endgrp && ns->endgrp->fdp.enabled) {
359673064edfSJesper Devantier         nvme_do_write_fdp(n, req, slba, nlb);
3597e321b4cdSKlaus Jensen     }
359888eea45cSKlaus Jensen 
359988eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
360088eea45cSKlaus Jensen 
360188eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
360288eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
360388eea45cSKlaus Jensen     }
360488eea45cSKlaus Jensen 
360588eea45cSKlaus Jensen     if (!wrz) {
360688eea45cSKlaus Jensen         status = nvme_map_data(n, nlb, req);
360788eea45cSKlaus Jensen         if (status) {
360888eea45cSKlaus Jensen             goto invalid;
360988eea45cSKlaus Jensen         }
361088eea45cSKlaus Jensen 
361188eea45cSKlaus Jensen         block_acct_start(blk_get_stats(blk), &req->acct, data_size,
361288eea45cSKlaus Jensen                          BLOCK_ACCT_WRITE);
36139b4f0181SMateusz Kozlowski         nvme_blk_write(blk, data_offset, BDRV_SECTOR_SIZE, nvme_rw_cb, req);
361488eea45cSKlaus Jensen     } else {
361588eea45cSKlaus Jensen         req->aiocb = blk_aio_pwrite_zeroes(blk, data_offset, data_size,
361688eea45cSKlaus Jensen                                            BDRV_REQ_MAY_UNMAP, nvme_rw_cb,
361788eea45cSKlaus Jensen                                            req);
361888eea45cSKlaus Jensen     }
361988eea45cSKlaus Jensen 
362088eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
362188eea45cSKlaus Jensen 
362288eea45cSKlaus Jensen invalid:
362388eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_WRITE);
362488eea45cSKlaus Jensen     return status | NVME_DNR;
362588eea45cSKlaus Jensen }
362688eea45cSKlaus Jensen 
362788eea45cSKlaus Jensen static inline uint16_t nvme_write(NvmeCtrl *n, NvmeRequest *req)
362888eea45cSKlaus Jensen {
362988eea45cSKlaus Jensen     return nvme_do_write(n, req, false, false);
363088eea45cSKlaus Jensen }
363188eea45cSKlaus Jensen 
363288eea45cSKlaus Jensen static inline uint16_t nvme_write_zeroes(NvmeCtrl *n, NvmeRequest *req)
363388eea45cSKlaus Jensen {
363488eea45cSKlaus Jensen     return nvme_do_write(n, req, false, true);
363588eea45cSKlaus Jensen }
363688eea45cSKlaus Jensen 
363788eea45cSKlaus Jensen static inline uint16_t nvme_zone_append(NvmeCtrl *n, NvmeRequest *req)
363888eea45cSKlaus Jensen {
363988eea45cSKlaus Jensen     return nvme_do_write(n, req, true, false);
364088eea45cSKlaus Jensen }
364188eea45cSKlaus Jensen 
364288eea45cSKlaus Jensen static uint16_t nvme_get_mgmt_zone_slba_idx(NvmeNamespace *ns, NvmeCmd *c,
364388eea45cSKlaus Jensen                                             uint64_t *slba, uint32_t *zone_idx)
364488eea45cSKlaus Jensen {
364588eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(c->cdw10);
364688eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(c->cdw11);
364788eea45cSKlaus Jensen 
364888eea45cSKlaus Jensen     if (!ns->params.zoned) {
364988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(c->opcode);
365088eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
365188eea45cSKlaus Jensen     }
365288eea45cSKlaus Jensen 
365388eea45cSKlaus Jensen     *slba = ((uint64_t)dw11) << 32 | dw10;
365488eea45cSKlaus Jensen     if (unlikely(*slba >= ns->id_ns.nsze)) {
365588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(*slba, 0, ns->id_ns.nsze);
365688eea45cSKlaus Jensen         *slba = 0;
365788eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
365888eea45cSKlaus Jensen     }
365988eea45cSKlaus Jensen 
366088eea45cSKlaus Jensen     *zone_idx = nvme_zone_idx(ns, *slba);
366188eea45cSKlaus Jensen     assert(*zone_idx < ns->num_zones);
366288eea45cSKlaus Jensen 
366388eea45cSKlaus Jensen     return NVME_SUCCESS;
366488eea45cSKlaus Jensen }
366588eea45cSKlaus Jensen 
366688eea45cSKlaus Jensen typedef uint16_t (*op_handler_t)(NvmeNamespace *, NvmeZone *, NvmeZoneState,
366788eea45cSKlaus Jensen                                  NvmeRequest *);
366888eea45cSKlaus Jensen 
366988eea45cSKlaus Jensen enum NvmeZoneProcessingMask {
367088eea45cSKlaus Jensen     NVME_PROC_CURRENT_ZONE    = 0,
367188eea45cSKlaus Jensen     NVME_PROC_OPENED_ZONES    = 1 << 0,
367288eea45cSKlaus Jensen     NVME_PROC_CLOSED_ZONES    = 1 << 1,
367388eea45cSKlaus Jensen     NVME_PROC_READ_ONLY_ZONES = 1 << 2,
367488eea45cSKlaus Jensen     NVME_PROC_FULL_ZONES      = 1 << 3,
367588eea45cSKlaus Jensen };
367688eea45cSKlaus Jensen 
367788eea45cSKlaus Jensen static uint16_t nvme_open_zone(NvmeNamespace *ns, NvmeZone *zone,
367888eea45cSKlaus Jensen                                NvmeZoneState state, NvmeRequest *req)
367988eea45cSKlaus Jensen {
3680e321b4cdSKlaus Jensen     NvmeZoneSendCmd *cmd = (NvmeZoneSendCmd *)&req->cmd;
3681e321b4cdSKlaus Jensen     int flags = 0;
3682e321b4cdSKlaus Jensen 
3683e321b4cdSKlaus Jensen     if (cmd->zsflags & NVME_ZSFLAG_ZRWA_ALLOC) {
3684e321b4cdSKlaus Jensen         uint16_t ozcs = le16_to_cpu(ns->id_ns_zoned->ozcs);
3685e321b4cdSKlaus Jensen 
3686e321b4cdSKlaus Jensen         if (!(ozcs & NVME_ID_NS_ZONED_OZCS_ZRWASUP)) {
3687e321b4cdSKlaus Jensen             return NVME_INVALID_ZONE_OP | NVME_DNR;
3688e321b4cdSKlaus Jensen         }
3689e321b4cdSKlaus Jensen 
3690e321b4cdSKlaus Jensen         if (zone->w_ptr % ns->zns.zrwafg) {
3691e321b4cdSKlaus Jensen             return NVME_NOZRWA | NVME_DNR;
3692e321b4cdSKlaus Jensen         }
3693e321b4cdSKlaus Jensen 
3694e321b4cdSKlaus Jensen         flags = NVME_ZRM_ZRWA;
3695e321b4cdSKlaus Jensen     }
3696e321b4cdSKlaus Jensen 
3697e321b4cdSKlaus Jensen     return nvme_zrm_open_flags(nvme_ctrl(req), ns, zone, flags);
369888eea45cSKlaus Jensen }
369988eea45cSKlaus Jensen 
370088eea45cSKlaus Jensen static uint16_t nvme_close_zone(NvmeNamespace *ns, NvmeZone *zone,
370188eea45cSKlaus Jensen                                 NvmeZoneState state, NvmeRequest *req)
370288eea45cSKlaus Jensen {
370388eea45cSKlaus Jensen     return nvme_zrm_close(ns, zone);
370488eea45cSKlaus Jensen }
370588eea45cSKlaus Jensen 
370688eea45cSKlaus Jensen static uint16_t nvme_finish_zone(NvmeNamespace *ns, NvmeZone *zone,
370788eea45cSKlaus Jensen                                  NvmeZoneState state, NvmeRequest *req)
370888eea45cSKlaus Jensen {
370988eea45cSKlaus Jensen     return nvme_zrm_finish(ns, zone);
371088eea45cSKlaus Jensen }
371188eea45cSKlaus Jensen 
371288eea45cSKlaus Jensen static uint16_t nvme_offline_zone(NvmeNamespace *ns, NvmeZone *zone,
371388eea45cSKlaus Jensen                                   NvmeZoneState state, NvmeRequest *req)
371488eea45cSKlaus Jensen {
371588eea45cSKlaus Jensen     switch (state) {
371688eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
371788eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_OFFLINE);
371888eea45cSKlaus Jensen         /* fall through */
371988eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
372088eea45cSKlaus Jensen         return NVME_SUCCESS;
372188eea45cSKlaus Jensen     default:
372288eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
372388eea45cSKlaus Jensen     }
372488eea45cSKlaus Jensen }
372588eea45cSKlaus Jensen 
372688eea45cSKlaus Jensen static uint16_t nvme_set_zd_ext(NvmeNamespace *ns, NvmeZone *zone)
372788eea45cSKlaus Jensen {
372888eea45cSKlaus Jensen     uint16_t status;
372988eea45cSKlaus Jensen     uint8_t state = nvme_get_zone_state(zone);
373088eea45cSKlaus Jensen 
373188eea45cSKlaus Jensen     if (state == NVME_ZONE_STATE_EMPTY) {
373288eea45cSKlaus Jensen         status = nvme_aor_check(ns, 1, 0);
373388eea45cSKlaus Jensen         if (status) {
373488eea45cSKlaus Jensen             return status;
373588eea45cSKlaus Jensen         }
373688eea45cSKlaus Jensen         nvme_aor_inc_active(ns);
373788eea45cSKlaus Jensen         zone->d.za |= NVME_ZA_ZD_EXT_VALID;
373888eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
373988eea45cSKlaus Jensen         return NVME_SUCCESS;
374088eea45cSKlaus Jensen     }
374188eea45cSKlaus Jensen 
374288eea45cSKlaus Jensen     return NVME_ZONE_INVAL_TRANSITION;
374388eea45cSKlaus Jensen }
374488eea45cSKlaus Jensen 
374588eea45cSKlaus Jensen static uint16_t nvme_bulk_proc_zone(NvmeNamespace *ns, NvmeZone *zone,
374688eea45cSKlaus Jensen                                     enum NvmeZoneProcessingMask proc_mask,
374788eea45cSKlaus Jensen                                     op_handler_t op_hndlr, NvmeRequest *req)
374888eea45cSKlaus Jensen {
374988eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
375088eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zone);
375188eea45cSKlaus Jensen     bool proc_zone;
375288eea45cSKlaus Jensen 
375388eea45cSKlaus Jensen     switch (zs) {
375488eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
375588eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
375688eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_OPENED_ZONES;
375788eea45cSKlaus Jensen         break;
375888eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
375988eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_CLOSED_ZONES;
376088eea45cSKlaus Jensen         break;
376188eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
376288eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_READ_ONLY_ZONES;
376388eea45cSKlaus Jensen         break;
376488eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
376588eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_FULL_ZONES;
376688eea45cSKlaus Jensen         break;
376788eea45cSKlaus Jensen     default:
376888eea45cSKlaus Jensen         proc_zone = false;
376988eea45cSKlaus Jensen     }
377088eea45cSKlaus Jensen 
377188eea45cSKlaus Jensen     if (proc_zone) {
377288eea45cSKlaus Jensen         status = op_hndlr(ns, zone, zs, req);
377388eea45cSKlaus Jensen     }
377488eea45cSKlaus Jensen 
377588eea45cSKlaus Jensen     return status;
377688eea45cSKlaus Jensen }
377788eea45cSKlaus Jensen 
377888eea45cSKlaus Jensen static uint16_t nvme_do_zone_op(NvmeNamespace *ns, NvmeZone *zone,
377988eea45cSKlaus Jensen                                 enum NvmeZoneProcessingMask proc_mask,
378088eea45cSKlaus Jensen                                 op_handler_t op_hndlr, NvmeRequest *req)
378188eea45cSKlaus Jensen {
378288eea45cSKlaus Jensen     NvmeZone *next;
378388eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
378488eea45cSKlaus Jensen     int i;
378588eea45cSKlaus Jensen 
378688eea45cSKlaus Jensen     if (!proc_mask) {
378788eea45cSKlaus Jensen         status = op_hndlr(ns, zone, nvme_get_zone_state(zone), req);
378888eea45cSKlaus Jensen     } else {
378988eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_CLOSED_ZONES) {
379088eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->closed_zones, entry, next) {
379188eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
379288eea45cSKlaus Jensen                                              req);
379388eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
379488eea45cSKlaus Jensen                     goto out;
379588eea45cSKlaus Jensen                 }
379688eea45cSKlaus Jensen             }
379788eea45cSKlaus Jensen         }
379888eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_OPENED_ZONES) {
379988eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->imp_open_zones, entry, next) {
380088eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
380188eea45cSKlaus Jensen                                              req);
380288eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
380388eea45cSKlaus Jensen                     goto out;
380488eea45cSKlaus Jensen                 }
380588eea45cSKlaus Jensen             }
380688eea45cSKlaus Jensen 
380788eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->exp_open_zones, entry, next) {
380888eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
380988eea45cSKlaus Jensen                                              req);
381088eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
381188eea45cSKlaus Jensen                     goto out;
381288eea45cSKlaus Jensen                 }
381388eea45cSKlaus Jensen             }
381488eea45cSKlaus Jensen         }
381588eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_FULL_ZONES) {
381688eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->full_zones, entry, next) {
381788eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
381888eea45cSKlaus Jensen                                              req);
381988eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
382088eea45cSKlaus Jensen                     goto out;
382188eea45cSKlaus Jensen                 }
382288eea45cSKlaus Jensen             }
382388eea45cSKlaus Jensen         }
382488eea45cSKlaus Jensen 
382588eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_READ_ONLY_ZONES) {
382688eea45cSKlaus Jensen             for (i = 0; i < ns->num_zones; i++, zone++) {
382788eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
382888eea45cSKlaus Jensen                                              req);
382988eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
383088eea45cSKlaus Jensen                     goto out;
383188eea45cSKlaus Jensen                 }
383288eea45cSKlaus Jensen             }
383388eea45cSKlaus Jensen         }
383488eea45cSKlaus Jensen     }
383588eea45cSKlaus Jensen 
383688eea45cSKlaus Jensen out:
383788eea45cSKlaus Jensen     return status;
383888eea45cSKlaus Jensen }
383988eea45cSKlaus Jensen 
384063d96e4fSKlaus Jensen typedef struct NvmeZoneResetAIOCB {
384163d96e4fSKlaus Jensen     BlockAIOCB common;
384263d96e4fSKlaus Jensen     BlockAIOCB *aiocb;
384363d96e4fSKlaus Jensen     NvmeRequest *req;
384463d96e4fSKlaus Jensen     int ret;
384563d96e4fSKlaus Jensen 
384663d96e4fSKlaus Jensen     bool all;
384763d96e4fSKlaus Jensen     int idx;
384863d96e4fSKlaus Jensen     NvmeZone *zone;
384963d96e4fSKlaus Jensen } NvmeZoneResetAIOCB;
385063d96e4fSKlaus Jensen 
385163d96e4fSKlaus Jensen static void nvme_zone_reset_cancel(BlockAIOCB *aiocb)
385263d96e4fSKlaus Jensen {
385363d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = container_of(aiocb, NvmeZoneResetAIOCB, common);
385463d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
385563d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
385663d96e4fSKlaus Jensen 
385763d96e4fSKlaus Jensen     iocb->idx = ns->num_zones;
385863d96e4fSKlaus Jensen 
385963d96e4fSKlaus Jensen     iocb->ret = -ECANCELED;
386063d96e4fSKlaus Jensen 
386163d96e4fSKlaus Jensen     if (iocb->aiocb) {
386263d96e4fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
386363d96e4fSKlaus Jensen         iocb->aiocb = NULL;
386463d96e4fSKlaus Jensen     }
386563d96e4fSKlaus Jensen }
386663d96e4fSKlaus Jensen 
386763d96e4fSKlaus Jensen static const AIOCBInfo nvme_zone_reset_aiocb_info = {
386863d96e4fSKlaus Jensen     .aiocb_size = sizeof(NvmeZoneResetAIOCB),
386963d96e4fSKlaus Jensen     .cancel_async = nvme_zone_reset_cancel,
387063d96e4fSKlaus Jensen };
387163d96e4fSKlaus Jensen 
387263d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret);
387363d96e4fSKlaus Jensen 
387463d96e4fSKlaus Jensen static void nvme_zone_reset_epilogue_cb(void *opaque, int ret)
387563d96e4fSKlaus Jensen {
387663d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
387763d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
387863d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
387963d96e4fSKlaus Jensen     int64_t moff;
388063d96e4fSKlaus Jensen     int count;
388163d96e4fSKlaus Jensen 
388236a251c3SKlaus Jensen     if (ret < 0 || iocb->ret < 0 || !ns->lbaf.ms) {
388336a251c3SKlaus Jensen         goto out;
388463d96e4fSKlaus Jensen     }
388563d96e4fSKlaus Jensen 
388663d96e4fSKlaus Jensen     moff = nvme_moff(ns, iocb->zone->d.zslba);
388763d96e4fSKlaus Jensen     count = nvme_m2b(ns, ns->zone_size);
388863d96e4fSKlaus Jensen 
388963d96e4fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, moff, count,
389063d96e4fSKlaus Jensen                                         BDRV_REQ_MAY_UNMAP,
389163d96e4fSKlaus Jensen                                         nvme_zone_reset_cb, iocb);
389263d96e4fSKlaus Jensen     return;
389336a251c3SKlaus Jensen 
389436a251c3SKlaus Jensen out:
389536a251c3SKlaus Jensen     nvme_zone_reset_cb(iocb, ret);
389663d96e4fSKlaus Jensen }
389763d96e4fSKlaus Jensen 
389863d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret)
389963d96e4fSKlaus Jensen {
390063d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
390163d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
390263d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
390363d96e4fSKlaus Jensen 
390436a251c3SKlaus Jensen     if (iocb->ret < 0) {
390536a251c3SKlaus Jensen         goto done;
390636a251c3SKlaus Jensen     } else if (ret < 0) {
390763d96e4fSKlaus Jensen         iocb->ret = ret;
390863d96e4fSKlaus Jensen         goto done;
390963d96e4fSKlaus Jensen     }
391063d96e4fSKlaus Jensen 
391163d96e4fSKlaus Jensen     if (iocb->zone) {
391263d96e4fSKlaus Jensen         nvme_zrm_reset(ns, iocb->zone);
391363d96e4fSKlaus Jensen 
391463d96e4fSKlaus Jensen         if (!iocb->all) {
391563d96e4fSKlaus Jensen             goto done;
391663d96e4fSKlaus Jensen         }
391763d96e4fSKlaus Jensen     }
391863d96e4fSKlaus Jensen 
391963d96e4fSKlaus Jensen     while (iocb->idx < ns->num_zones) {
392063d96e4fSKlaus Jensen         NvmeZone *zone = &ns->zone_array[iocb->idx++];
392163d96e4fSKlaus Jensen 
392263d96e4fSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
392363d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EMPTY:
392463d96e4fSKlaus Jensen             if (!iocb->all) {
392563d96e4fSKlaus Jensen                 goto done;
392663d96e4fSKlaus Jensen             }
392763d96e4fSKlaus Jensen 
392863d96e4fSKlaus Jensen             continue;
392963d96e4fSKlaus Jensen 
393063d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
393163d96e4fSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
393263d96e4fSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
393363d96e4fSKlaus Jensen         case NVME_ZONE_STATE_FULL:
393463d96e4fSKlaus Jensen             iocb->zone = zone;
393563d96e4fSKlaus Jensen             break;
393663d96e4fSKlaus Jensen 
393763d96e4fSKlaus Jensen         default:
393863d96e4fSKlaus Jensen             continue;
393963d96e4fSKlaus Jensen         }
394063d96e4fSKlaus Jensen 
394163d96e4fSKlaus Jensen         trace_pci_nvme_zns_zone_reset(zone->d.zslba);
394263d96e4fSKlaus Jensen 
394363d96e4fSKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk,
394463d96e4fSKlaus Jensen                                             nvme_l2b(ns, zone->d.zslba),
394563d96e4fSKlaus Jensen                                             nvme_l2b(ns, ns->zone_size),
394663d96e4fSKlaus Jensen                                             BDRV_REQ_MAY_UNMAP,
394763d96e4fSKlaus Jensen                                             nvme_zone_reset_epilogue_cb,
394863d96e4fSKlaus Jensen                                             iocb);
394963d96e4fSKlaus Jensen         return;
395063d96e4fSKlaus Jensen     }
395163d96e4fSKlaus Jensen 
395263d96e4fSKlaus Jensen done:
395363d96e4fSKlaus Jensen     iocb->aiocb = NULL;
395436a251c3SKlaus Jensen 
395536a251c3SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
395636a251c3SKlaus Jensen     qemu_aio_unref(iocb);
395763d96e4fSKlaus Jensen }
395863d96e4fSKlaus Jensen 
3959e321b4cdSKlaus Jensen static uint16_t nvme_zone_mgmt_send_zrwa_flush(NvmeCtrl *n, NvmeZone *zone,
3960e321b4cdSKlaus Jensen                                                uint64_t elba, NvmeRequest *req)
3961e321b4cdSKlaus Jensen {
3962e321b4cdSKlaus Jensen     NvmeNamespace *ns = req->ns;
3963e321b4cdSKlaus Jensen     uint16_t ozcs = le16_to_cpu(ns->id_ns_zoned->ozcs);
3964e321b4cdSKlaus Jensen     uint64_t wp = zone->d.wp;
3965e321b4cdSKlaus Jensen     uint32_t nlb = elba - wp + 1;
3966e321b4cdSKlaus Jensen     uint16_t status;
3967e321b4cdSKlaus Jensen 
3968e321b4cdSKlaus Jensen 
3969e321b4cdSKlaus Jensen     if (!(ozcs & NVME_ID_NS_ZONED_OZCS_ZRWASUP)) {
3970e321b4cdSKlaus Jensen         return NVME_INVALID_ZONE_OP | NVME_DNR;
3971e321b4cdSKlaus Jensen     }
3972e321b4cdSKlaus Jensen 
3973e321b4cdSKlaus Jensen     if (!(zone->d.za & NVME_ZA_ZRWA_VALID)) {
3974e321b4cdSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
3975e321b4cdSKlaus Jensen     }
3976e321b4cdSKlaus Jensen 
3977e321b4cdSKlaus Jensen     if (elba < wp || elba > wp + ns->zns.zrwas) {
3978e321b4cdSKlaus Jensen         return NVME_ZONE_BOUNDARY_ERROR | NVME_DNR;
3979e321b4cdSKlaus Jensen     }
3980e321b4cdSKlaus Jensen 
3981e321b4cdSKlaus Jensen     if (nlb % ns->zns.zrwafg) {
3982e321b4cdSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
3983e321b4cdSKlaus Jensen     }
3984e321b4cdSKlaus Jensen 
3985e321b4cdSKlaus Jensen     status = nvme_zrm_auto(n, ns, zone);
3986e321b4cdSKlaus Jensen     if (status) {
3987e321b4cdSKlaus Jensen         return status;
3988e321b4cdSKlaus Jensen     }
3989e321b4cdSKlaus Jensen 
3990e321b4cdSKlaus Jensen     zone->w_ptr += nlb;
3991e321b4cdSKlaus Jensen 
3992e321b4cdSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlb);
3993e321b4cdSKlaus Jensen 
3994e321b4cdSKlaus Jensen     return NVME_SUCCESS;
3995e321b4cdSKlaus Jensen }
3996e321b4cdSKlaus Jensen 
399788eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_send(NvmeCtrl *n, NvmeRequest *req)
399888eea45cSKlaus Jensen {
39996190d92fSKlaus Jensen     NvmeZoneSendCmd *cmd = (NvmeZoneSendCmd *)&req->cmd;
400088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
400188eea45cSKlaus Jensen     NvmeZone *zone;
400263d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb;
400388eea45cSKlaus Jensen     uint8_t *zd_ext;
400488eea45cSKlaus Jensen     uint64_t slba = 0;
400588eea45cSKlaus Jensen     uint32_t zone_idx = 0;
400688eea45cSKlaus Jensen     uint16_t status;
40076190d92fSKlaus Jensen     uint8_t action = cmd->zsa;
400888eea45cSKlaus Jensen     bool all;
400988eea45cSKlaus Jensen     enum NvmeZoneProcessingMask proc_mask = NVME_PROC_CURRENT_ZONE;
401088eea45cSKlaus Jensen 
40116190d92fSKlaus Jensen     all = cmd->zsflags & NVME_ZSFLAG_SELECT_ALL;
401288eea45cSKlaus Jensen 
401388eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
401488eea45cSKlaus Jensen 
401588eea45cSKlaus Jensen     if (!all) {
40166190d92fSKlaus Jensen         status = nvme_get_mgmt_zone_slba_idx(ns, &req->cmd, &slba, &zone_idx);
401788eea45cSKlaus Jensen         if (status) {
401888eea45cSKlaus Jensen             return status;
401988eea45cSKlaus Jensen         }
402088eea45cSKlaus Jensen     }
402188eea45cSKlaus Jensen 
402288eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
4023e321b4cdSKlaus Jensen     if (slba != zone->d.zslba && action != NVME_ZONE_ACTION_ZRWA_FLUSH) {
402488eea45cSKlaus Jensen         trace_pci_nvme_err_unaligned_zone_cmd(action, slba, zone->d.zslba);
402588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
402688eea45cSKlaus Jensen     }
402788eea45cSKlaus Jensen 
402888eea45cSKlaus Jensen     switch (action) {
402988eea45cSKlaus Jensen 
403088eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OPEN:
403188eea45cSKlaus Jensen         if (all) {
403288eea45cSKlaus Jensen             proc_mask = NVME_PROC_CLOSED_ZONES;
403388eea45cSKlaus Jensen         }
403488eea45cSKlaus Jensen         trace_pci_nvme_open_zone(slba, zone_idx, all);
403588eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_open_zone, req);
403688eea45cSKlaus Jensen         break;
403788eea45cSKlaus Jensen 
403888eea45cSKlaus Jensen     case NVME_ZONE_ACTION_CLOSE:
403988eea45cSKlaus Jensen         if (all) {
404088eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES;
404188eea45cSKlaus Jensen         }
404288eea45cSKlaus Jensen         trace_pci_nvme_close_zone(slba, zone_idx, all);
404388eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_close_zone, req);
404488eea45cSKlaus Jensen         break;
404588eea45cSKlaus Jensen 
404688eea45cSKlaus Jensen     case NVME_ZONE_ACTION_FINISH:
404788eea45cSKlaus Jensen         if (all) {
404888eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES | NVME_PROC_CLOSED_ZONES;
404988eea45cSKlaus Jensen         }
405088eea45cSKlaus Jensen         trace_pci_nvme_finish_zone(slba, zone_idx, all);
405188eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_finish_zone, req);
405288eea45cSKlaus Jensen         break;
405388eea45cSKlaus Jensen 
405488eea45cSKlaus Jensen     case NVME_ZONE_ACTION_RESET:
405588eea45cSKlaus Jensen         trace_pci_nvme_reset_zone(slba, zone_idx, all);
405688eea45cSKlaus Jensen 
405763d96e4fSKlaus Jensen         iocb = blk_aio_get(&nvme_zone_reset_aiocb_info, ns->blkconf.blk,
405863d96e4fSKlaus Jensen                            nvme_misc_cb, req);
405988eea45cSKlaus Jensen 
406063d96e4fSKlaus Jensen         iocb->req = req;
406163d96e4fSKlaus Jensen         iocb->ret = 0;
406263d96e4fSKlaus Jensen         iocb->all = all;
406363d96e4fSKlaus Jensen         iocb->idx = zone_idx;
406463d96e4fSKlaus Jensen         iocb->zone = NULL;
406588eea45cSKlaus Jensen 
406663d96e4fSKlaus Jensen         req->aiocb = &iocb->common;
406763d96e4fSKlaus Jensen         nvme_zone_reset_cb(iocb, 0);
406888eea45cSKlaus Jensen 
406963d96e4fSKlaus Jensen         return NVME_NO_COMPLETE;
407088eea45cSKlaus Jensen 
407188eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OFFLINE:
407288eea45cSKlaus Jensen         if (all) {
407388eea45cSKlaus Jensen             proc_mask = NVME_PROC_READ_ONLY_ZONES;
407488eea45cSKlaus Jensen         }
407588eea45cSKlaus Jensen         trace_pci_nvme_offline_zone(slba, zone_idx, all);
407688eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_offline_zone, req);
407788eea45cSKlaus Jensen         break;
407888eea45cSKlaus Jensen 
407988eea45cSKlaus Jensen     case NVME_ZONE_ACTION_SET_ZD_EXT:
408088eea45cSKlaus Jensen         trace_pci_nvme_set_descriptor_extension(slba, zone_idx);
408188eea45cSKlaus Jensen         if (all || !ns->params.zd_extension_size) {
408288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
408388eea45cSKlaus Jensen         }
408488eea45cSKlaus Jensen         zd_ext = nvme_get_zd_extension(ns, zone_idx);
408588eea45cSKlaus Jensen         status = nvme_h2c(n, zd_ext, ns->params.zd_extension_size, req);
408688eea45cSKlaus Jensen         if (status) {
408788eea45cSKlaus Jensen             trace_pci_nvme_err_zd_extension_map_error(zone_idx);
408888eea45cSKlaus Jensen             return status;
408988eea45cSKlaus Jensen         }
409088eea45cSKlaus Jensen 
409188eea45cSKlaus Jensen         status = nvme_set_zd_ext(ns, zone);
409288eea45cSKlaus Jensen         if (status == NVME_SUCCESS) {
409388eea45cSKlaus Jensen             trace_pci_nvme_zd_extension_set(zone_idx);
409488eea45cSKlaus Jensen             return status;
409588eea45cSKlaus Jensen         }
409688eea45cSKlaus Jensen         break;
409788eea45cSKlaus Jensen 
4098e321b4cdSKlaus Jensen     case NVME_ZONE_ACTION_ZRWA_FLUSH:
4099e321b4cdSKlaus Jensen         if (all) {
4100e321b4cdSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
4101e321b4cdSKlaus Jensen         }
4102e321b4cdSKlaus Jensen 
4103e321b4cdSKlaus Jensen         return nvme_zone_mgmt_send_zrwa_flush(n, zone, slba, req);
4104e321b4cdSKlaus Jensen 
410588eea45cSKlaus Jensen     default:
410688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_mgmt_action(action);
410788eea45cSKlaus Jensen         status = NVME_INVALID_FIELD;
410888eea45cSKlaus Jensen     }
410988eea45cSKlaus Jensen 
411088eea45cSKlaus Jensen     if (status == NVME_ZONE_INVAL_TRANSITION) {
411188eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_zone_state_transition(action, slba,
411288eea45cSKlaus Jensen                                                          zone->d.za);
411388eea45cSKlaus Jensen     }
411488eea45cSKlaus Jensen     if (status) {
411588eea45cSKlaus Jensen         status |= NVME_DNR;
411688eea45cSKlaus Jensen     }
411788eea45cSKlaus Jensen 
411888eea45cSKlaus Jensen     return status;
411988eea45cSKlaus Jensen }
412088eea45cSKlaus Jensen 
412188eea45cSKlaus Jensen static bool nvme_zone_matches_filter(uint32_t zafs, NvmeZone *zl)
412288eea45cSKlaus Jensen {
412388eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zl);
412488eea45cSKlaus Jensen 
412588eea45cSKlaus Jensen     switch (zafs) {
412688eea45cSKlaus Jensen     case NVME_ZONE_REPORT_ALL:
412788eea45cSKlaus Jensen         return true;
412888eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EMPTY:
412988eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EMPTY;
413088eea45cSKlaus Jensen     case NVME_ZONE_REPORT_IMPLICITLY_OPEN:
413188eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_IMPLICITLY_OPEN;
413288eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EXPLICITLY_OPEN:
413388eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EXPLICITLY_OPEN;
413488eea45cSKlaus Jensen     case NVME_ZONE_REPORT_CLOSED:
413588eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_CLOSED;
413688eea45cSKlaus Jensen     case NVME_ZONE_REPORT_FULL:
413788eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_FULL;
413888eea45cSKlaus Jensen     case NVME_ZONE_REPORT_READ_ONLY:
413988eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_READ_ONLY;
414088eea45cSKlaus Jensen     case NVME_ZONE_REPORT_OFFLINE:
414188eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_OFFLINE;
414288eea45cSKlaus Jensen     default:
414388eea45cSKlaus Jensen         return false;
414488eea45cSKlaus Jensen     }
414588eea45cSKlaus Jensen }
414688eea45cSKlaus Jensen 
414788eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_recv(NvmeCtrl *n, NvmeRequest *req)
414888eea45cSKlaus Jensen {
414988eea45cSKlaus Jensen     NvmeCmd *cmd = (NvmeCmd *)&req->cmd;
415088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
415188eea45cSKlaus Jensen     /* cdw12 is zero-based number of dwords to return. Convert to bytes */
415288eea45cSKlaus Jensen     uint32_t data_size = (le32_to_cpu(cmd->cdw12) + 1) << 2;
415388eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
415488eea45cSKlaus Jensen     uint32_t zone_idx, zra, zrasf, partial;
415588eea45cSKlaus Jensen     uint64_t max_zones, nr_zones = 0;
415688eea45cSKlaus Jensen     uint16_t status;
415788eea45cSKlaus Jensen     uint64_t slba;
415888eea45cSKlaus Jensen     NvmeZoneDescr *z;
415988eea45cSKlaus Jensen     NvmeZone *zone;
416088eea45cSKlaus Jensen     NvmeZoneReportHeader *header;
416188eea45cSKlaus Jensen     void *buf, *buf_p;
416288eea45cSKlaus Jensen     size_t zone_entry_sz;
416388eea45cSKlaus Jensen     int i;
416488eea45cSKlaus Jensen 
416588eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
416688eea45cSKlaus Jensen 
416788eea45cSKlaus Jensen     status = nvme_get_mgmt_zone_slba_idx(ns, cmd, &slba, &zone_idx);
416888eea45cSKlaus Jensen     if (status) {
416988eea45cSKlaus Jensen         return status;
417088eea45cSKlaus Jensen     }
417188eea45cSKlaus Jensen 
417288eea45cSKlaus Jensen     zra = dw13 & 0xff;
417388eea45cSKlaus Jensen     if (zra != NVME_ZONE_REPORT && zra != NVME_ZONE_REPORT_EXTENDED) {
417488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
417588eea45cSKlaus Jensen     }
417688eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED && !ns->params.zd_extension_size) {
417788eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
417888eea45cSKlaus Jensen     }
417988eea45cSKlaus Jensen 
418088eea45cSKlaus Jensen     zrasf = (dw13 >> 8) & 0xff;
418188eea45cSKlaus Jensen     if (zrasf > NVME_ZONE_REPORT_OFFLINE) {
418288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
418388eea45cSKlaus Jensen     }
418488eea45cSKlaus Jensen 
418588eea45cSKlaus Jensen     if (data_size < sizeof(NvmeZoneReportHeader)) {
418688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
418788eea45cSKlaus Jensen     }
418888eea45cSKlaus Jensen 
418988eea45cSKlaus Jensen     status = nvme_check_mdts(n, data_size);
419088eea45cSKlaus Jensen     if (status) {
419188eea45cSKlaus Jensen         return status;
419288eea45cSKlaus Jensen     }
419388eea45cSKlaus Jensen 
419488eea45cSKlaus Jensen     partial = (dw13 >> 16) & 0x01;
419588eea45cSKlaus Jensen 
419688eea45cSKlaus Jensen     zone_entry_sz = sizeof(NvmeZoneDescr);
419788eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED) {
419888eea45cSKlaus Jensen         zone_entry_sz += ns->params.zd_extension_size;
419988eea45cSKlaus Jensen     }
420088eea45cSKlaus Jensen 
420188eea45cSKlaus Jensen     max_zones = (data_size - sizeof(NvmeZoneReportHeader)) / zone_entry_sz;
420288eea45cSKlaus Jensen     buf = g_malloc0(data_size);
420388eea45cSKlaus Jensen 
420488eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
420588eea45cSKlaus Jensen     for (i = zone_idx; i < ns->num_zones; i++) {
420688eea45cSKlaus Jensen         if (partial && nr_zones >= max_zones) {
420788eea45cSKlaus Jensen             break;
420888eea45cSKlaus Jensen         }
420988eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone++)) {
421088eea45cSKlaus Jensen             nr_zones++;
421188eea45cSKlaus Jensen         }
421288eea45cSKlaus Jensen     }
42133d558330SMarkus Armbruster     header = buf;
421488eea45cSKlaus Jensen     header->nr_zones = cpu_to_le64(nr_zones);
421588eea45cSKlaus Jensen 
421688eea45cSKlaus Jensen     buf_p = buf + sizeof(NvmeZoneReportHeader);
421788eea45cSKlaus Jensen     for (; zone_idx < ns->num_zones && max_zones > 0; zone_idx++) {
421888eea45cSKlaus Jensen         zone = &ns->zone_array[zone_idx];
421988eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone)) {
42203d558330SMarkus Armbruster             z = buf_p;
422188eea45cSKlaus Jensen             buf_p += sizeof(NvmeZoneDescr);
422288eea45cSKlaus Jensen 
422388eea45cSKlaus Jensen             z->zt = zone->d.zt;
422488eea45cSKlaus Jensen             z->zs = zone->d.zs;
422588eea45cSKlaus Jensen             z->zcap = cpu_to_le64(zone->d.zcap);
422688eea45cSKlaus Jensen             z->zslba = cpu_to_le64(zone->d.zslba);
422788eea45cSKlaus Jensen             z->za = zone->d.za;
422888eea45cSKlaus Jensen 
422988eea45cSKlaus Jensen             if (nvme_wp_is_valid(zone)) {
423088eea45cSKlaus Jensen                 z->wp = cpu_to_le64(zone->d.wp);
423188eea45cSKlaus Jensen             } else {
423288eea45cSKlaus Jensen                 z->wp = cpu_to_le64(~0ULL);
423388eea45cSKlaus Jensen             }
423488eea45cSKlaus Jensen 
423588eea45cSKlaus Jensen             if (zra == NVME_ZONE_REPORT_EXTENDED) {
423688eea45cSKlaus Jensen                 if (zone->d.za & NVME_ZA_ZD_EXT_VALID) {
423788eea45cSKlaus Jensen                     memcpy(buf_p, nvme_get_zd_extension(ns, zone_idx),
423888eea45cSKlaus Jensen                            ns->params.zd_extension_size);
423988eea45cSKlaus Jensen                 }
424088eea45cSKlaus Jensen                 buf_p += ns->params.zd_extension_size;
424188eea45cSKlaus Jensen             }
424288eea45cSKlaus Jensen 
424388eea45cSKlaus Jensen             max_zones--;
424488eea45cSKlaus Jensen         }
424588eea45cSKlaus Jensen     }
424688eea45cSKlaus Jensen 
424788eea45cSKlaus Jensen     status = nvme_c2h(n, (uint8_t *)buf, data_size, req);
424888eea45cSKlaus Jensen 
424988eea45cSKlaus Jensen     g_free(buf);
425088eea45cSKlaus Jensen 
425188eea45cSKlaus Jensen     return status;
425288eea45cSKlaus Jensen }
425388eea45cSKlaus Jensen 
425473064edfSJesper Devantier static uint16_t nvme_io_mgmt_recv_ruhs(NvmeCtrl *n, NvmeRequest *req,
425573064edfSJesper Devantier                                        size_t len)
425673064edfSJesper Devantier {
425773064edfSJesper Devantier     NvmeNamespace *ns = req->ns;
425873064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
425973064edfSJesper Devantier     NvmeRuhStatus *hdr;
426073064edfSJesper Devantier     NvmeRuhStatusDescr *ruhsd;
426173064edfSJesper Devantier     unsigned int nruhsd;
426273064edfSJesper Devantier     uint16_t rg, ph, *ruhid;
426373064edfSJesper Devantier     size_t trans_len;
426473064edfSJesper Devantier     g_autofree uint8_t *buf = NULL;
426573064edfSJesper Devantier 
426673064edfSJesper Devantier     if (!n->subsys) {
426773064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
426873064edfSJesper Devantier     }
426973064edfSJesper Devantier 
427073064edfSJesper Devantier     if (ns->params.nsid == 0 || ns->params.nsid == 0xffffffff) {
427173064edfSJesper Devantier         return NVME_INVALID_NSID | NVME_DNR;
427273064edfSJesper Devantier     }
427373064edfSJesper Devantier 
427473064edfSJesper Devantier     if (!n->subsys->endgrp.fdp.enabled) {
427573064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
427673064edfSJesper Devantier     }
427773064edfSJesper Devantier 
427873064edfSJesper Devantier     endgrp = ns->endgrp;
427973064edfSJesper Devantier 
428073064edfSJesper Devantier     nruhsd = ns->fdp.nphs * endgrp->fdp.nrg;
428173064edfSJesper Devantier     trans_len = sizeof(NvmeRuhStatus) + nruhsd * sizeof(NvmeRuhStatusDescr);
428273064edfSJesper Devantier     buf = g_malloc(trans_len);
428373064edfSJesper Devantier 
428473064edfSJesper Devantier     trans_len = MIN(trans_len, len);
428573064edfSJesper Devantier 
428673064edfSJesper Devantier     hdr = (NvmeRuhStatus *)buf;
428773064edfSJesper Devantier     ruhsd = (NvmeRuhStatusDescr *)(buf + sizeof(NvmeRuhStatus));
428873064edfSJesper Devantier 
428973064edfSJesper Devantier     hdr->nruhsd = cpu_to_le16(nruhsd);
429073064edfSJesper Devantier 
429173064edfSJesper Devantier     ruhid = ns->fdp.phs;
429273064edfSJesper Devantier 
429373064edfSJesper Devantier     for (ph = 0; ph < ns->fdp.nphs; ph++, ruhid++) {
429473064edfSJesper Devantier         NvmeRuHandle *ruh = &endgrp->fdp.ruhs[*ruhid];
429573064edfSJesper Devantier 
429673064edfSJesper Devantier         for (rg = 0; rg < endgrp->fdp.nrg; rg++, ruhsd++) {
429773064edfSJesper Devantier             uint16_t pid = nvme_make_pid(ns, rg, ph);
429873064edfSJesper Devantier 
429973064edfSJesper Devantier             ruhsd->pid = cpu_to_le16(pid);
430073064edfSJesper Devantier             ruhsd->ruhid = *ruhid;
430173064edfSJesper Devantier             ruhsd->earutr = 0;
430273064edfSJesper Devantier             ruhsd->ruamw = cpu_to_le64(ruh->rus[rg].ruamw);
430373064edfSJesper Devantier         }
430473064edfSJesper Devantier     }
430573064edfSJesper Devantier 
430673064edfSJesper Devantier     return nvme_c2h(n, buf, trans_len, req);
430773064edfSJesper Devantier }
430873064edfSJesper Devantier 
430973064edfSJesper Devantier static uint16_t nvme_io_mgmt_recv(NvmeCtrl *n, NvmeRequest *req)
431073064edfSJesper Devantier {
431173064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
431273064edfSJesper Devantier     uint32_t cdw10 = le32_to_cpu(cmd->cdw10);
431373064edfSJesper Devantier     uint32_t numd = le32_to_cpu(cmd->cdw11);
431473064edfSJesper Devantier     uint8_t mo = (cdw10 & 0xff);
431573064edfSJesper Devantier     size_t len = (numd + 1) << 2;
431673064edfSJesper Devantier 
431773064edfSJesper Devantier     switch (mo) {
431873064edfSJesper Devantier     case NVME_IOMR_MO_NOP:
431973064edfSJesper Devantier         return 0;
432073064edfSJesper Devantier     case NVME_IOMR_MO_RUH_STATUS:
432173064edfSJesper Devantier         return nvme_io_mgmt_recv_ruhs(n, req, len);
432273064edfSJesper Devantier     default:
432373064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
432473064edfSJesper Devantier     };
432573064edfSJesper Devantier }
432673064edfSJesper Devantier 
432773064edfSJesper Devantier static uint16_t nvme_io_mgmt_send_ruh_update(NvmeCtrl *n, NvmeRequest *req)
432873064edfSJesper Devantier {
432973064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
433073064edfSJesper Devantier     NvmeNamespace *ns = req->ns;
433173064edfSJesper Devantier     uint32_t cdw10 = le32_to_cpu(cmd->cdw10);
433273064edfSJesper Devantier     uint16_t ret = NVME_SUCCESS;
433373064edfSJesper Devantier     uint32_t npid = (cdw10 >> 1) + 1;
433473064edfSJesper Devantier     unsigned int i = 0;
433573064edfSJesper Devantier     g_autofree uint16_t *pids = NULL;
433673064edfSJesper Devantier     uint32_t maxnpid = n->subsys->endgrp.fdp.nrg * n->subsys->endgrp.fdp.nruh;
433773064edfSJesper Devantier 
433873064edfSJesper Devantier     if (unlikely(npid >= MIN(NVME_FDP_MAXPIDS, maxnpid))) {
433973064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
434073064edfSJesper Devantier     }
434173064edfSJesper Devantier 
434273064edfSJesper Devantier     pids = g_new(uint16_t, npid);
434373064edfSJesper Devantier 
434473064edfSJesper Devantier     ret = nvme_h2c(n, pids, npid * sizeof(uint16_t), req);
434573064edfSJesper Devantier     if (ret) {
434673064edfSJesper Devantier         return ret;
434773064edfSJesper Devantier     }
434873064edfSJesper Devantier 
434973064edfSJesper Devantier     for (; i < npid; i++) {
435073064edfSJesper Devantier         if (!nvme_update_ruh(n, ns, pids[i])) {
435173064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
435273064edfSJesper Devantier         }
435373064edfSJesper Devantier     }
435473064edfSJesper Devantier 
435573064edfSJesper Devantier     return ret;
435673064edfSJesper Devantier }
435773064edfSJesper Devantier 
435873064edfSJesper Devantier static uint16_t nvme_io_mgmt_send(NvmeCtrl *n, NvmeRequest *req)
435973064edfSJesper Devantier {
436073064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
436173064edfSJesper Devantier     uint32_t cdw10 = le32_to_cpu(cmd->cdw10);
436273064edfSJesper Devantier     uint8_t mo = (cdw10 & 0xff);
436373064edfSJesper Devantier 
436473064edfSJesper Devantier     switch (mo) {
436573064edfSJesper Devantier     case NVME_IOMS_MO_NOP:
436673064edfSJesper Devantier         return 0;
436773064edfSJesper Devantier     case NVME_IOMS_MO_RUH_UPDATE:
436873064edfSJesper Devantier         return nvme_io_mgmt_send_ruh_update(n, req);
436973064edfSJesper Devantier     default:
437073064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
437173064edfSJesper Devantier     };
437273064edfSJesper Devantier }
437373064edfSJesper Devantier 
437488eea45cSKlaus Jensen static uint16_t nvme_io_cmd(NvmeCtrl *n, NvmeRequest *req)
437588eea45cSKlaus Jensen {
437688eea45cSKlaus Jensen     NvmeNamespace *ns;
437788eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
437888eea45cSKlaus Jensen 
437988eea45cSKlaus Jensen     trace_pci_nvme_io_cmd(nvme_cid(req), nsid, nvme_sqid(req),
438088eea45cSKlaus Jensen                           req->cmd.opcode, nvme_io_opc_str(req->cmd.opcode));
438188eea45cSKlaus Jensen 
438288eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid)) {
438388eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
438488eea45cSKlaus Jensen     }
438588eea45cSKlaus Jensen 
438688eea45cSKlaus Jensen     /*
438788eea45cSKlaus Jensen      * In the base NVM command set, Flush may apply to all namespaces
438888eea45cSKlaus Jensen      * (indicated by NSID being set to FFFFFFFFh). But if that feature is used
438988eea45cSKlaus Jensen      * along with TP 4056 (Namespace Types), it may be pretty screwed up.
439088eea45cSKlaus Jensen      *
439188eea45cSKlaus Jensen      * If NSID is indeed set to FFFFFFFFh, we simply cannot associate the
439288eea45cSKlaus Jensen      * opcode with a specific command since we cannot determine a unique I/O
439388eea45cSKlaus Jensen      * command set. Opcode 0h could have any other meaning than something
439488eea45cSKlaus Jensen      * equivalent to flushing and say it DOES have completely different
439588eea45cSKlaus Jensen      * semantics in some other command set - does an NSID of FFFFFFFFh then
439688eea45cSKlaus Jensen      * mean "for all namespaces, apply whatever command set specific command
439788eea45cSKlaus Jensen      * that uses the 0h opcode?" Or does it mean "for all namespaces, apply
439888eea45cSKlaus Jensen      * whatever command that uses the 0h opcode if, and only if, it allows NSID
439988eea45cSKlaus Jensen      * to be FFFFFFFFh"?
440088eea45cSKlaus Jensen      *
440188eea45cSKlaus Jensen      * Anyway (and luckily), for now, we do not care about this since the
440288eea45cSKlaus Jensen      * device only supports namespace types that includes the NVM Flush command
440388eea45cSKlaus Jensen      * (NVM and Zoned), so always do an NVM Flush.
440488eea45cSKlaus Jensen      */
440588eea45cSKlaus Jensen     if (req->cmd.opcode == NVME_CMD_FLUSH) {
440688eea45cSKlaus Jensen         return nvme_flush(n, req);
440788eea45cSKlaus Jensen     }
440888eea45cSKlaus Jensen 
440988eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
441088eea45cSKlaus Jensen     if (unlikely(!ns)) {
441188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
441288eea45cSKlaus Jensen     }
441388eea45cSKlaus Jensen 
441488eea45cSKlaus Jensen     if (!(ns->iocs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
441588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(req->cmd.opcode);
441688eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
441788eea45cSKlaus Jensen     }
441888eea45cSKlaus Jensen 
441988eea45cSKlaus Jensen     if (ns->status) {
442088eea45cSKlaus Jensen         return ns->status;
442188eea45cSKlaus Jensen     }
442288eea45cSKlaus Jensen 
4423c53a9a91SPankaj Raghav     if (NVME_CMD_FLAGS_FUSE(req->cmd.flags)) {
4424c53a9a91SPankaj Raghav         return NVME_INVALID_FIELD;
4425c53a9a91SPankaj Raghav     }
4426c53a9a91SPankaj Raghav 
442788eea45cSKlaus Jensen     req->ns = ns;
442888eea45cSKlaus Jensen 
442988eea45cSKlaus Jensen     switch (req->cmd.opcode) {
443088eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
443188eea45cSKlaus Jensen         return nvme_write_zeroes(n, req);
443288eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
443388eea45cSKlaus Jensen         return nvme_zone_append(n, req);
443488eea45cSKlaus Jensen     case NVME_CMD_WRITE:
443588eea45cSKlaus Jensen         return nvme_write(n, req);
443688eea45cSKlaus Jensen     case NVME_CMD_READ:
443788eea45cSKlaus Jensen         return nvme_read(n, req);
443888eea45cSKlaus Jensen     case NVME_CMD_COMPARE:
443988eea45cSKlaus Jensen         return nvme_compare(n, req);
444088eea45cSKlaus Jensen     case NVME_CMD_DSM:
444188eea45cSKlaus Jensen         return nvme_dsm(n, req);
444288eea45cSKlaus Jensen     case NVME_CMD_VERIFY:
444388eea45cSKlaus Jensen         return nvme_verify(n, req);
444488eea45cSKlaus Jensen     case NVME_CMD_COPY:
444588eea45cSKlaus Jensen         return nvme_copy(n, req);
444688eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_SEND:
444788eea45cSKlaus Jensen         return nvme_zone_mgmt_send(n, req);
444888eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_RECV:
444988eea45cSKlaus Jensen         return nvme_zone_mgmt_recv(n, req);
445073064edfSJesper Devantier     case NVME_CMD_IO_MGMT_RECV:
445173064edfSJesper Devantier         return nvme_io_mgmt_recv(n, req);
445273064edfSJesper Devantier     case NVME_CMD_IO_MGMT_SEND:
445373064edfSJesper Devantier         return nvme_io_mgmt_send(n, req);
445488eea45cSKlaus Jensen     default:
445588eea45cSKlaus Jensen         assert(false);
445688eea45cSKlaus Jensen     }
445788eea45cSKlaus Jensen 
445888eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
445988eea45cSKlaus Jensen }
446088eea45cSKlaus Jensen 
44612e53b0b4SJinhao Fan static void nvme_cq_notifier(EventNotifier *e)
44622e53b0b4SJinhao Fan {
44632e53b0b4SJinhao Fan     NvmeCQueue *cq = container_of(e, NvmeCQueue, notifier);
44642e53b0b4SJinhao Fan     NvmeCtrl *n = cq->ctrl;
44652e53b0b4SJinhao Fan 
4466a2da7377SKlaus Jensen     if (!event_notifier_test_and_clear(e)) {
4467a2da7377SKlaus Jensen         return;
4468a2da7377SKlaus Jensen     }
44692e53b0b4SJinhao Fan 
44702e53b0b4SJinhao Fan     nvme_update_cq_head(cq);
44712e53b0b4SJinhao Fan 
44722e53b0b4SJinhao Fan     if (cq->tail == cq->head) {
44732e53b0b4SJinhao Fan         if (cq->irq_enabled) {
44742e53b0b4SJinhao Fan             n->cq_pending--;
44752e53b0b4SJinhao Fan         }
44762e53b0b4SJinhao Fan 
44772e53b0b4SJinhao Fan         nvme_irq_deassert(n, cq);
44782e53b0b4SJinhao Fan     }
44792e53b0b4SJinhao Fan 
4480d38cc6fdSKlaus Jensen     qemu_bh_schedule(cq->bh);
44812e53b0b4SJinhao Fan }
44822e53b0b4SJinhao Fan 
44832e53b0b4SJinhao Fan static int nvme_init_cq_ioeventfd(NvmeCQueue *cq)
44842e53b0b4SJinhao Fan {
44852e53b0b4SJinhao Fan     NvmeCtrl *n = cq->ctrl;
44862e53b0b4SJinhao Fan     uint16_t offset = (cq->cqid << 3) + (1 << 2);
44872e53b0b4SJinhao Fan     int ret;
44882e53b0b4SJinhao Fan 
44892e53b0b4SJinhao Fan     ret = event_notifier_init(&cq->notifier, 0);
44902e53b0b4SJinhao Fan     if (ret < 0) {
44912e53b0b4SJinhao Fan         return ret;
44922e53b0b4SJinhao Fan     }
44932e53b0b4SJinhao Fan 
44942e53b0b4SJinhao Fan     event_notifier_set_handler(&cq->notifier, nvme_cq_notifier);
44952e53b0b4SJinhao Fan     memory_region_add_eventfd(&n->iomem,
44962e53b0b4SJinhao Fan                               0x1000 + offset, 4, false, 0, &cq->notifier);
44972e53b0b4SJinhao Fan 
44982e53b0b4SJinhao Fan     return 0;
44992e53b0b4SJinhao Fan }
45002e53b0b4SJinhao Fan 
45012e53b0b4SJinhao Fan static void nvme_sq_notifier(EventNotifier *e)
45022e53b0b4SJinhao Fan {
45032e53b0b4SJinhao Fan     NvmeSQueue *sq = container_of(e, NvmeSQueue, notifier);
45042e53b0b4SJinhao Fan 
4505a2da7377SKlaus Jensen     if (!event_notifier_test_and_clear(e)) {
4506a2da7377SKlaus Jensen         return;
4507a2da7377SKlaus Jensen     }
45082e53b0b4SJinhao Fan 
45092e53b0b4SJinhao Fan     nvme_process_sq(sq);
45102e53b0b4SJinhao Fan }
45112e53b0b4SJinhao Fan 
45122e53b0b4SJinhao Fan static int nvme_init_sq_ioeventfd(NvmeSQueue *sq)
45132e53b0b4SJinhao Fan {
45142e53b0b4SJinhao Fan     NvmeCtrl *n = sq->ctrl;
45152e53b0b4SJinhao Fan     uint16_t offset = sq->sqid << 3;
45162e53b0b4SJinhao Fan     int ret;
45172e53b0b4SJinhao Fan 
45182e53b0b4SJinhao Fan     ret = event_notifier_init(&sq->notifier, 0);
45192e53b0b4SJinhao Fan     if (ret < 0) {
45202e53b0b4SJinhao Fan         return ret;
45212e53b0b4SJinhao Fan     }
45222e53b0b4SJinhao Fan 
45232e53b0b4SJinhao Fan     event_notifier_set_handler(&sq->notifier, nvme_sq_notifier);
45242e53b0b4SJinhao Fan     memory_region_add_eventfd(&n->iomem,
45252e53b0b4SJinhao Fan                               0x1000 + offset, 4, false, 0, &sq->notifier);
45262e53b0b4SJinhao Fan 
45272e53b0b4SJinhao Fan     return 0;
45282e53b0b4SJinhao Fan }
45292e53b0b4SJinhao Fan 
453088eea45cSKlaus Jensen static void nvme_free_sq(NvmeSQueue *sq, NvmeCtrl *n)
453188eea45cSKlaus Jensen {
45322e53b0b4SJinhao Fan     uint16_t offset = sq->sqid << 3;
45332e53b0b4SJinhao Fan 
453488eea45cSKlaus Jensen     n->sq[sq->sqid] = NULL;
4535d38cc6fdSKlaus Jensen     qemu_bh_delete(sq->bh);
45362e53b0b4SJinhao Fan     if (sq->ioeventfd_enabled) {
45372e53b0b4SJinhao Fan         memory_region_del_eventfd(&n->iomem,
45382e53b0b4SJinhao Fan                                   0x1000 + offset, 4, false, 0, &sq->notifier);
453904e8da88SKlaus Jensen         event_notifier_set_handler(&sq->notifier, NULL);
45402e53b0b4SJinhao Fan         event_notifier_cleanup(&sq->notifier);
45412e53b0b4SJinhao Fan     }
454288eea45cSKlaus Jensen     g_free(sq->io_req);
454388eea45cSKlaus Jensen     if (sq->sqid) {
454488eea45cSKlaus Jensen         g_free(sq);
454588eea45cSKlaus Jensen     }
454688eea45cSKlaus Jensen }
454788eea45cSKlaus Jensen 
454888eea45cSKlaus Jensen static uint16_t nvme_del_sq(NvmeCtrl *n, NvmeRequest *req)
454988eea45cSKlaus Jensen {
455088eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
455188eea45cSKlaus Jensen     NvmeRequest *r, *next;
455288eea45cSKlaus Jensen     NvmeSQueue *sq;
455388eea45cSKlaus Jensen     NvmeCQueue *cq;
455488eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
455588eea45cSKlaus Jensen 
455688eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_sqid(n, qid))) {
455788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_sq(qid);
455888eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
455988eea45cSKlaus Jensen     }
456088eea45cSKlaus Jensen 
456188eea45cSKlaus Jensen     trace_pci_nvme_del_sq(qid);
456288eea45cSKlaus Jensen 
456388eea45cSKlaus Jensen     sq = n->sq[qid];
456488eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&sq->out_req_list)) {
456588eea45cSKlaus Jensen         r = QTAILQ_FIRST(&sq->out_req_list);
4566e76fb260SKlaus Jensen         assert(r->aiocb);
456788eea45cSKlaus Jensen         blk_aio_cancel(r->aiocb);
456888eea45cSKlaus Jensen     }
456988eea45cSKlaus Jensen 
457088eea45cSKlaus Jensen     assert(QTAILQ_EMPTY(&sq->out_req_list));
457188eea45cSKlaus Jensen 
457288eea45cSKlaus Jensen     if (!nvme_check_cqid(n, sq->cqid)) {
457388eea45cSKlaus Jensen         cq = n->cq[sq->cqid];
457488eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->sq_list, sq, entry);
457588eea45cSKlaus Jensen 
457688eea45cSKlaus Jensen         nvme_post_cqes(cq);
457788eea45cSKlaus Jensen         QTAILQ_FOREACH_SAFE(r, &cq->req_list, entry, next) {
457888eea45cSKlaus Jensen             if (r->sq == sq) {
457988eea45cSKlaus Jensen                 QTAILQ_REMOVE(&cq->req_list, r, entry);
458088eea45cSKlaus Jensen                 QTAILQ_INSERT_TAIL(&sq->req_list, r, entry);
458188eea45cSKlaus Jensen             }
458288eea45cSKlaus Jensen         }
458388eea45cSKlaus Jensen     }
458488eea45cSKlaus Jensen 
458588eea45cSKlaus Jensen     nvme_free_sq(sq, n);
458688eea45cSKlaus Jensen     return NVME_SUCCESS;
458788eea45cSKlaus Jensen }
458888eea45cSKlaus Jensen 
458988eea45cSKlaus Jensen static void nvme_init_sq(NvmeSQueue *sq, NvmeCtrl *n, uint64_t dma_addr,
459088eea45cSKlaus Jensen                          uint16_t sqid, uint16_t cqid, uint16_t size)
459188eea45cSKlaus Jensen {
459288eea45cSKlaus Jensen     int i;
459388eea45cSKlaus Jensen     NvmeCQueue *cq;
459488eea45cSKlaus Jensen 
459588eea45cSKlaus Jensen     sq->ctrl = n;
459688eea45cSKlaus Jensen     sq->dma_addr = dma_addr;
459788eea45cSKlaus Jensen     sq->sqid = sqid;
459888eea45cSKlaus Jensen     sq->size = size;
459988eea45cSKlaus Jensen     sq->cqid = cqid;
460088eea45cSKlaus Jensen     sq->head = sq->tail = 0;
460188eea45cSKlaus Jensen     sq->io_req = g_new0(NvmeRequest, sq->size);
460288eea45cSKlaus Jensen 
460388eea45cSKlaus Jensen     QTAILQ_INIT(&sq->req_list);
460488eea45cSKlaus Jensen     QTAILQ_INIT(&sq->out_req_list);
460588eea45cSKlaus Jensen     for (i = 0; i < sq->size; i++) {
460688eea45cSKlaus Jensen         sq->io_req[i].sq = sq;
460788eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&(sq->req_list), &sq->io_req[i], entry);
460888eea45cSKlaus Jensen     }
4609d38cc6fdSKlaus Jensen 
4610*f63192b0SAlexander Bulekov     sq->bh = qemu_bh_new_guarded(nvme_process_sq, sq,
4611*f63192b0SAlexander Bulekov                                  &DEVICE(sq->ctrl)->mem_reentrancy_guard);
461288eea45cSKlaus Jensen 
46133f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
46143f7fe8deSJinhao Fan         sq->db_addr = n->dbbuf_dbs + (sqid << 3);
46153f7fe8deSJinhao Fan         sq->ei_addr = n->dbbuf_eis + (sqid << 3);
46162e53b0b4SJinhao Fan 
46172e53b0b4SJinhao Fan         if (n->params.ioeventfd && sq->sqid != 0) {
46182e53b0b4SJinhao Fan             if (!nvme_init_sq_ioeventfd(sq)) {
46192e53b0b4SJinhao Fan                 sq->ioeventfd_enabled = true;
46202e53b0b4SJinhao Fan             }
46212e53b0b4SJinhao Fan         }
46223f7fe8deSJinhao Fan     }
46233f7fe8deSJinhao Fan 
462488eea45cSKlaus Jensen     assert(n->cq[cqid]);
462588eea45cSKlaus Jensen     cq = n->cq[cqid];
462688eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&(cq->sq_list), sq, entry);
462788eea45cSKlaus Jensen     n->sq[sqid] = sq;
462888eea45cSKlaus Jensen }
462988eea45cSKlaus Jensen 
463088eea45cSKlaus Jensen static uint16_t nvme_create_sq(NvmeCtrl *n, NvmeRequest *req)
463188eea45cSKlaus Jensen {
463288eea45cSKlaus Jensen     NvmeSQueue *sq;
463388eea45cSKlaus Jensen     NvmeCreateSq *c = (NvmeCreateSq *)&req->cmd;
463488eea45cSKlaus Jensen 
463588eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
463688eea45cSKlaus Jensen     uint16_t sqid = le16_to_cpu(c->sqid);
463788eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
463888eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->sq_flags);
463988eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
464088eea45cSKlaus Jensen 
464188eea45cSKlaus Jensen     trace_pci_nvme_create_sq(prp1, sqid, cqid, qsize, qflags);
464288eea45cSKlaus Jensen 
464388eea45cSKlaus Jensen     if (unlikely(!cqid || nvme_check_cqid(n, cqid))) {
464488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_cqid(cqid);
464588eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
464688eea45cSKlaus Jensen     }
4647decc0261SŁukasz Gieryk     if (unlikely(!sqid || sqid > n->conf_ioqpairs || n->sq[sqid] != NULL)) {
464888eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_sqid(sqid);
464988eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
465088eea45cSKlaus Jensen     }
465149e03457SKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(ldq_le_p(&n->bar.cap)))) {
465288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_size(qsize);
465388eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
465488eea45cSKlaus Jensen     }
465588eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
465688eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_addr(prp1);
465788eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
465888eea45cSKlaus Jensen     }
465988eea45cSKlaus Jensen     if (unlikely(!(NVME_SQ_FLAGS_PC(qflags)))) {
466088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_qflags(NVME_SQ_FLAGS_PC(qflags));
466188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
466288eea45cSKlaus Jensen     }
466388eea45cSKlaus Jensen     sq = g_malloc0(sizeof(*sq));
466488eea45cSKlaus Jensen     nvme_init_sq(sq, n, prp1, sqid, cqid, qsize + 1);
466588eea45cSKlaus Jensen     return NVME_SUCCESS;
466688eea45cSKlaus Jensen }
466788eea45cSKlaus Jensen 
466888eea45cSKlaus Jensen struct nvme_stats {
466988eea45cSKlaus Jensen     uint64_t units_read;
467088eea45cSKlaus Jensen     uint64_t units_written;
467188eea45cSKlaus Jensen     uint64_t read_commands;
467288eea45cSKlaus Jensen     uint64_t write_commands;
467388eea45cSKlaus Jensen };
467488eea45cSKlaus Jensen 
467588eea45cSKlaus Jensen static void nvme_set_blk_stats(NvmeNamespace *ns, struct nvme_stats *stats)
467688eea45cSKlaus Jensen {
467788eea45cSKlaus Jensen     BlockAcctStats *s = blk_get_stats(ns->blkconf.blk);
467888eea45cSKlaus Jensen 
4679a555af17SJoel Granados     stats->units_read += s->nr_bytes[BLOCK_ACCT_READ];
4680a555af17SJoel Granados     stats->units_written += s->nr_bytes[BLOCK_ACCT_WRITE];
468188eea45cSKlaus Jensen     stats->read_commands += s->nr_ops[BLOCK_ACCT_READ];
468288eea45cSKlaus Jensen     stats->write_commands += s->nr_ops[BLOCK_ACCT_WRITE];
468388eea45cSKlaus Jensen }
468488eea45cSKlaus Jensen 
468588eea45cSKlaus Jensen static uint16_t nvme_smart_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
468688eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
468788eea45cSKlaus Jensen {
468888eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
468988eea45cSKlaus Jensen     struct nvme_stats stats = { 0 };
469088eea45cSKlaus Jensen     NvmeSmartLog smart = { 0 };
469188eea45cSKlaus Jensen     uint32_t trans_len;
469288eea45cSKlaus Jensen     NvmeNamespace *ns;
469388eea45cSKlaus Jensen     time_t current_ms;
4694a555af17SJoel Granados     uint64_t u_read, u_written;
469588eea45cSKlaus Jensen 
469688eea45cSKlaus Jensen     if (off >= sizeof(smart)) {
469788eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
469888eea45cSKlaus Jensen     }
469988eea45cSKlaus Jensen 
470088eea45cSKlaus Jensen     if (nsid != 0xffffffff) {
470188eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
470288eea45cSKlaus Jensen         if (!ns) {
470388eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
470488eea45cSKlaus Jensen         }
470588eea45cSKlaus Jensen         nvme_set_blk_stats(ns, &stats);
470688eea45cSKlaus Jensen     } else {
470788eea45cSKlaus Jensen         int i;
470888eea45cSKlaus Jensen 
470988eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
471088eea45cSKlaus Jensen             ns = nvme_ns(n, i);
471188eea45cSKlaus Jensen             if (!ns) {
471288eea45cSKlaus Jensen                 continue;
471388eea45cSKlaus Jensen             }
471488eea45cSKlaus Jensen             nvme_set_blk_stats(ns, &stats);
471588eea45cSKlaus Jensen         }
471688eea45cSKlaus Jensen     }
471788eea45cSKlaus Jensen 
471888eea45cSKlaus Jensen     trans_len = MIN(sizeof(smart) - off, buf_len);
471988eea45cSKlaus Jensen     smart.critical_warning = n->smart_critical_warning;
472088eea45cSKlaus Jensen 
4721a555af17SJoel Granados     u_read = DIV_ROUND_UP(stats.units_read >> BDRV_SECTOR_BITS, 1000);
4722a555af17SJoel Granados     u_written = DIV_ROUND_UP(stats.units_written >> BDRV_SECTOR_BITS, 1000);
4723a555af17SJoel Granados 
4724a555af17SJoel Granados     smart.data_units_read[0] = cpu_to_le64(u_read);
4725a555af17SJoel Granados     smart.data_units_written[0] = cpu_to_le64(u_written);
472688eea45cSKlaus Jensen     smart.host_read_commands[0] = cpu_to_le64(stats.read_commands);
472788eea45cSKlaus Jensen     smart.host_write_commands[0] = cpu_to_le64(stats.write_commands);
472888eea45cSKlaus Jensen 
472988eea45cSKlaus Jensen     smart.temperature = cpu_to_le16(n->temperature);
473088eea45cSKlaus Jensen 
473188eea45cSKlaus Jensen     if ((n->temperature >= n->features.temp_thresh_hi) ||
473288eea45cSKlaus Jensen         (n->temperature <= n->features.temp_thresh_low)) {
473388eea45cSKlaus Jensen         smart.critical_warning |= NVME_SMART_TEMPERATURE;
473488eea45cSKlaus Jensen     }
473588eea45cSKlaus Jensen 
473688eea45cSKlaus Jensen     current_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
473788eea45cSKlaus Jensen     smart.power_on_hours[0] =
473888eea45cSKlaus Jensen         cpu_to_le64((((current_ms - n->starttime_ms) / 1000) / 60) / 60);
473988eea45cSKlaus Jensen 
474088eea45cSKlaus Jensen     if (!rae) {
474188eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_SMART);
474288eea45cSKlaus Jensen     }
474388eea45cSKlaus Jensen 
474488eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &smart + off, trans_len, req);
474588eea45cSKlaus Jensen }
474688eea45cSKlaus Jensen 
4747771dbc3aSKlaus Jensen static uint16_t nvme_endgrp_info(NvmeCtrl *n,  uint8_t rae, uint32_t buf_len,
4748771dbc3aSKlaus Jensen                                  uint64_t off, NvmeRequest *req)
4749771dbc3aSKlaus Jensen {
4750771dbc3aSKlaus Jensen     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
4751771dbc3aSKlaus Jensen     uint16_t endgrpid = (dw11 >> 16) & 0xffff;
4752771dbc3aSKlaus Jensen     struct nvme_stats stats = {};
4753771dbc3aSKlaus Jensen     NvmeEndGrpLog info = {};
4754771dbc3aSKlaus Jensen     int i;
4755771dbc3aSKlaus Jensen 
4756771dbc3aSKlaus Jensen     if (!n->subsys || endgrpid != 0x1) {
4757771dbc3aSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4758771dbc3aSKlaus Jensen     }
4759771dbc3aSKlaus Jensen 
4760771dbc3aSKlaus Jensen     if (off >= sizeof(info)) {
4761771dbc3aSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4762771dbc3aSKlaus Jensen     }
4763771dbc3aSKlaus Jensen 
4764771dbc3aSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
4765771dbc3aSKlaus Jensen         NvmeNamespace *ns = nvme_subsys_ns(n->subsys, i);
4766771dbc3aSKlaus Jensen         if (!ns) {
4767771dbc3aSKlaus Jensen             continue;
4768771dbc3aSKlaus Jensen         }
4769771dbc3aSKlaus Jensen 
4770771dbc3aSKlaus Jensen         nvme_set_blk_stats(ns, &stats);
4771771dbc3aSKlaus Jensen     }
4772771dbc3aSKlaus Jensen 
4773771dbc3aSKlaus Jensen     info.data_units_read[0] =
4774771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_read / 1000000000, 1000000000));
4775771dbc3aSKlaus Jensen     info.data_units_written[0] =
4776771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_written / 1000000000, 1000000000));
4777771dbc3aSKlaus Jensen     info.media_units_written[0] =
4778771dbc3aSKlaus Jensen         cpu_to_le64(DIV_ROUND_UP(stats.units_written / 1000000000, 1000000000));
4779771dbc3aSKlaus Jensen 
4780771dbc3aSKlaus Jensen     info.host_read_commands[0] = cpu_to_le64(stats.read_commands);
4781771dbc3aSKlaus Jensen     info.host_write_commands[0] = cpu_to_le64(stats.write_commands);
4782771dbc3aSKlaus Jensen 
4783771dbc3aSKlaus Jensen     buf_len = MIN(sizeof(info) - off, buf_len);
4784771dbc3aSKlaus Jensen 
4785771dbc3aSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&info + off, buf_len, req);
4786771dbc3aSKlaus Jensen }
4787771dbc3aSKlaus Jensen 
4788771dbc3aSKlaus Jensen 
478988eea45cSKlaus Jensen static uint16_t nvme_fw_log_info(NvmeCtrl *n, uint32_t buf_len, uint64_t off,
479088eea45cSKlaus Jensen                                  NvmeRequest *req)
479188eea45cSKlaus Jensen {
479288eea45cSKlaus Jensen     uint32_t trans_len;
479388eea45cSKlaus Jensen     NvmeFwSlotInfoLog fw_log = {
479488eea45cSKlaus Jensen         .afi = 0x1,
479588eea45cSKlaus Jensen     };
479688eea45cSKlaus Jensen 
479788eea45cSKlaus Jensen     if (off >= sizeof(fw_log)) {
479888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
479988eea45cSKlaus Jensen     }
480088eea45cSKlaus Jensen 
480188eea45cSKlaus Jensen     strpadcpy((char *)&fw_log.frs1, sizeof(fw_log.frs1), "1.0", ' ');
480288eea45cSKlaus Jensen     trans_len = MIN(sizeof(fw_log) - off, buf_len);
480388eea45cSKlaus Jensen 
480488eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &fw_log + off, trans_len, req);
480588eea45cSKlaus Jensen }
480688eea45cSKlaus Jensen 
480788eea45cSKlaus Jensen static uint16_t nvme_error_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
480888eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
480988eea45cSKlaus Jensen {
481088eea45cSKlaus Jensen     uint32_t trans_len;
481188eea45cSKlaus Jensen     NvmeErrorLog errlog;
481288eea45cSKlaus Jensen 
481388eea45cSKlaus Jensen     if (off >= sizeof(errlog)) {
481488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
481588eea45cSKlaus Jensen     }
481688eea45cSKlaus Jensen 
481788eea45cSKlaus Jensen     if (!rae) {
481888eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_ERROR);
481988eea45cSKlaus Jensen     }
482088eea45cSKlaus Jensen 
482188eea45cSKlaus Jensen     memset(&errlog, 0x0, sizeof(errlog));
482288eea45cSKlaus Jensen     trans_len = MIN(sizeof(errlog) - off, buf_len);
482388eea45cSKlaus Jensen 
482488eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&errlog, trans_len, req);
482588eea45cSKlaus Jensen }
482688eea45cSKlaus Jensen 
482788eea45cSKlaus Jensen static uint16_t nvme_changed_nslist(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
482888eea45cSKlaus Jensen                                     uint64_t off, NvmeRequest *req)
482988eea45cSKlaus Jensen {
483088eea45cSKlaus Jensen     uint32_t nslist[1024];
483188eea45cSKlaus Jensen     uint32_t trans_len;
483288eea45cSKlaus Jensen     int i = 0;
483388eea45cSKlaus Jensen     uint32_t nsid;
483488eea45cSKlaus Jensen 
4835e2c57529SKlaus Jensen     if (off >= sizeof(nslist)) {
4836e2c57529SKlaus Jensen         trace_pci_nvme_err_invalid_log_page_offset(off, sizeof(nslist));
4837e2c57529SKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
4838e2c57529SKlaus Jensen     }
4839e2c57529SKlaus Jensen 
484088eea45cSKlaus Jensen     memset(nslist, 0x0, sizeof(nslist));
484188eea45cSKlaus Jensen     trans_len = MIN(sizeof(nslist) - off, buf_len);
484288eea45cSKlaus Jensen 
484388eea45cSKlaus Jensen     while ((nsid = find_first_bit(n->changed_nsids, NVME_CHANGED_NSID_SIZE)) !=
484488eea45cSKlaus Jensen             NVME_CHANGED_NSID_SIZE) {
484588eea45cSKlaus Jensen         /*
484688eea45cSKlaus Jensen          * If more than 1024 namespaces, the first entry in the log page should
484788eea45cSKlaus Jensen          * be set to FFFFFFFFh and the others to 0 as spec.
484888eea45cSKlaus Jensen          */
484988eea45cSKlaus Jensen         if (i == ARRAY_SIZE(nslist)) {
485088eea45cSKlaus Jensen             memset(nslist, 0x0, sizeof(nslist));
485188eea45cSKlaus Jensen             nslist[0] = 0xffffffff;
485288eea45cSKlaus Jensen             break;
485388eea45cSKlaus Jensen         }
485488eea45cSKlaus Jensen 
485588eea45cSKlaus Jensen         nslist[i++] = nsid;
485688eea45cSKlaus Jensen         clear_bit(nsid, n->changed_nsids);
485788eea45cSKlaus Jensen     }
485888eea45cSKlaus Jensen 
485988eea45cSKlaus Jensen     /*
486088eea45cSKlaus Jensen      * Remove all the remaining list entries in case returns directly due to
486188eea45cSKlaus Jensen      * more than 1024 namespaces.
486288eea45cSKlaus Jensen      */
486388eea45cSKlaus Jensen     if (nslist[0] == 0xffffffff) {
486488eea45cSKlaus Jensen         bitmap_zero(n->changed_nsids, NVME_CHANGED_NSID_SIZE);
486588eea45cSKlaus Jensen     }
486688eea45cSKlaus Jensen 
486788eea45cSKlaus Jensen     if (!rae) {
486888eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_NOTICE);
486988eea45cSKlaus Jensen     }
487088eea45cSKlaus Jensen 
487188eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)nslist) + off, trans_len, req);
487288eea45cSKlaus Jensen }
487388eea45cSKlaus Jensen 
487488eea45cSKlaus Jensen static uint16_t nvme_cmd_effects(NvmeCtrl *n, uint8_t csi, uint32_t buf_len,
487588eea45cSKlaus Jensen                                  uint64_t off, NvmeRequest *req)
487688eea45cSKlaus Jensen {
487788eea45cSKlaus Jensen     NvmeEffectsLog log = {};
487888eea45cSKlaus Jensen     const uint32_t *src_iocs = NULL;
487988eea45cSKlaus Jensen     uint32_t trans_len;
488088eea45cSKlaus Jensen 
488188eea45cSKlaus Jensen     if (off >= sizeof(log)) {
488288eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page_offset(off, sizeof(log));
488388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
488488eea45cSKlaus Jensen     }
488588eea45cSKlaus Jensen 
488649e03457SKlaus Jensen     switch (NVME_CC_CSS(ldl_le_p(&n->bar.cc))) {
488788eea45cSKlaus Jensen     case NVME_CC_CSS_NVM:
488888eea45cSKlaus Jensen         src_iocs = nvme_cse_iocs_nvm;
488988eea45cSKlaus Jensen         /* fall through */
489088eea45cSKlaus Jensen     case NVME_CC_CSS_ADMIN_ONLY:
489188eea45cSKlaus Jensen         break;
489288eea45cSKlaus Jensen     case NVME_CC_CSS_CSI:
489388eea45cSKlaus Jensen         switch (csi) {
489488eea45cSKlaus Jensen         case NVME_CSI_NVM:
489588eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_nvm;
489688eea45cSKlaus Jensen             break;
489788eea45cSKlaus Jensen         case NVME_CSI_ZONED:
489888eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_zoned;
489988eea45cSKlaus Jensen             break;
490088eea45cSKlaus Jensen         }
490188eea45cSKlaus Jensen     }
490288eea45cSKlaus Jensen 
490388eea45cSKlaus Jensen     memcpy(log.acs, nvme_cse_acs, sizeof(nvme_cse_acs));
490488eea45cSKlaus Jensen 
490588eea45cSKlaus Jensen     if (src_iocs) {
490688eea45cSKlaus Jensen         memcpy(log.iocs, src_iocs, sizeof(log.iocs));
490788eea45cSKlaus Jensen     }
490888eea45cSKlaus Jensen 
490988eea45cSKlaus Jensen     trans_len = MIN(sizeof(log) - off, buf_len);
491088eea45cSKlaus Jensen 
491188eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)&log) + off, trans_len, req);
491288eea45cSKlaus Jensen }
491388eea45cSKlaus Jensen 
491473064edfSJesper Devantier static size_t sizeof_fdp_conf_descr(size_t nruh, size_t vss)
491573064edfSJesper Devantier {
491673064edfSJesper Devantier     size_t entry_siz = sizeof(NvmeFdpDescrHdr) + nruh * sizeof(NvmeRuhDescr)
491773064edfSJesper Devantier                        + vss;
491873064edfSJesper Devantier     return ROUND_UP(entry_siz, 8);
491973064edfSJesper Devantier }
492073064edfSJesper Devantier 
492173064edfSJesper Devantier static uint16_t nvme_fdp_confs(NvmeCtrl *n, uint32_t endgrpid, uint32_t buf_len,
492273064edfSJesper Devantier                                uint64_t off, NvmeRequest *req)
492373064edfSJesper Devantier {
492473064edfSJesper Devantier     uint32_t log_size, trans_len;
492573064edfSJesper Devantier     g_autofree uint8_t *buf = NULL;
492673064edfSJesper Devantier     NvmeFdpDescrHdr *hdr;
492773064edfSJesper Devantier     NvmeRuhDescr *ruhd;
492873064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
492973064edfSJesper Devantier     NvmeFdpConfsHdr *log;
493073064edfSJesper Devantier     size_t nruh, fdp_descr_size;
493173064edfSJesper Devantier     int i;
493273064edfSJesper Devantier 
493373064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
493473064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
493573064edfSJesper Devantier     }
493673064edfSJesper Devantier 
493773064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
493873064edfSJesper Devantier 
493973064edfSJesper Devantier     if (endgrp->fdp.enabled) {
494073064edfSJesper Devantier         nruh = endgrp->fdp.nruh;
494173064edfSJesper Devantier     } else {
494273064edfSJesper Devantier         nruh = 1;
494373064edfSJesper Devantier     }
494473064edfSJesper Devantier 
494573064edfSJesper Devantier     fdp_descr_size = sizeof_fdp_conf_descr(nruh, FDPVSS);
494673064edfSJesper Devantier     log_size = sizeof(NvmeFdpConfsHdr) + fdp_descr_size;
494773064edfSJesper Devantier 
494873064edfSJesper Devantier     if (off >= log_size) {
494973064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
495073064edfSJesper Devantier     }
495173064edfSJesper Devantier 
495273064edfSJesper Devantier     trans_len = MIN(log_size - off, buf_len);
495373064edfSJesper Devantier 
495473064edfSJesper Devantier     buf = g_malloc0(log_size);
495573064edfSJesper Devantier     log = (NvmeFdpConfsHdr *)buf;
495673064edfSJesper Devantier     hdr = (NvmeFdpDescrHdr *)(log + 1);
495773064edfSJesper Devantier     ruhd = (NvmeRuhDescr *)(buf + sizeof(*log) + sizeof(*hdr));
495873064edfSJesper Devantier 
495973064edfSJesper Devantier     log->num_confs = cpu_to_le16(0);
496073064edfSJesper Devantier     log->size = cpu_to_le32(log_size);
496173064edfSJesper Devantier 
496273064edfSJesper Devantier     hdr->descr_size = cpu_to_le16(fdp_descr_size);
496373064edfSJesper Devantier     if (endgrp->fdp.enabled) {
496473064edfSJesper Devantier         hdr->fdpa = FIELD_DP8(hdr->fdpa, FDPA, VALID, 1);
496573064edfSJesper Devantier         hdr->fdpa = FIELD_DP8(hdr->fdpa, FDPA, RGIF, endgrp->fdp.rgif);
496673064edfSJesper Devantier         hdr->nrg = cpu_to_le16(endgrp->fdp.nrg);
496773064edfSJesper Devantier         hdr->nruh = cpu_to_le16(endgrp->fdp.nruh);
496873064edfSJesper Devantier         hdr->maxpids = cpu_to_le16(NVME_FDP_MAXPIDS - 1);
496973064edfSJesper Devantier         hdr->nnss = cpu_to_le32(NVME_MAX_NAMESPACES);
497073064edfSJesper Devantier         hdr->runs = cpu_to_le64(endgrp->fdp.runs);
497173064edfSJesper Devantier 
497273064edfSJesper Devantier         for (i = 0; i < nruh; i++) {
497373064edfSJesper Devantier             ruhd->ruht = NVME_RUHT_INITIALLY_ISOLATED;
497473064edfSJesper Devantier             ruhd++;
497573064edfSJesper Devantier         }
497673064edfSJesper Devantier     } else {
497773064edfSJesper Devantier         /* 1 bit for RUH in PIF -> 2 RUHs max. */
497873064edfSJesper Devantier         hdr->nrg = cpu_to_le16(1);
497973064edfSJesper Devantier         hdr->nruh = cpu_to_le16(1);
498073064edfSJesper Devantier         hdr->maxpids = cpu_to_le16(NVME_FDP_MAXPIDS - 1);
498173064edfSJesper Devantier         hdr->nnss = cpu_to_le32(1);
498273064edfSJesper Devantier         hdr->runs = cpu_to_le64(96 * MiB);
498373064edfSJesper Devantier 
498473064edfSJesper Devantier         ruhd->ruht = NVME_RUHT_INITIALLY_ISOLATED;
498573064edfSJesper Devantier     }
498673064edfSJesper Devantier 
498773064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)buf + off, trans_len, req);
498873064edfSJesper Devantier }
498973064edfSJesper Devantier 
499073064edfSJesper Devantier static uint16_t nvme_fdp_ruh_usage(NvmeCtrl *n, uint32_t endgrpid,
499173064edfSJesper Devantier                                    uint32_t dw10, uint32_t dw12,
499273064edfSJesper Devantier                                    uint32_t buf_len, uint64_t off,
499373064edfSJesper Devantier                                    NvmeRequest *req)
499473064edfSJesper Devantier {
499573064edfSJesper Devantier     NvmeRuHandle *ruh;
499673064edfSJesper Devantier     NvmeRuhuLog *hdr;
499773064edfSJesper Devantier     NvmeRuhuDescr *ruhud;
499873064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
499973064edfSJesper Devantier     g_autofree uint8_t *buf = NULL;
500073064edfSJesper Devantier     uint32_t log_size, trans_len;
500173064edfSJesper Devantier     uint16_t i;
500273064edfSJesper Devantier 
500373064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
500473064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
500573064edfSJesper Devantier     }
500673064edfSJesper Devantier 
500773064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
500873064edfSJesper Devantier 
500973064edfSJesper Devantier     if (!endgrp->fdp.enabled) {
501073064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
501173064edfSJesper Devantier     }
501273064edfSJesper Devantier 
501373064edfSJesper Devantier     log_size = sizeof(NvmeRuhuLog) + endgrp->fdp.nruh * sizeof(NvmeRuhuDescr);
501473064edfSJesper Devantier 
501573064edfSJesper Devantier     if (off >= log_size) {
501673064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
501773064edfSJesper Devantier     }
501873064edfSJesper Devantier 
501973064edfSJesper Devantier     trans_len = MIN(log_size - off, buf_len);
502073064edfSJesper Devantier 
502173064edfSJesper Devantier     buf = g_malloc0(log_size);
502273064edfSJesper Devantier     hdr = (NvmeRuhuLog *)buf;
502373064edfSJesper Devantier     ruhud = (NvmeRuhuDescr *)(hdr + 1);
502473064edfSJesper Devantier 
502573064edfSJesper Devantier     ruh = endgrp->fdp.ruhs;
502673064edfSJesper Devantier     hdr->nruh = cpu_to_le16(endgrp->fdp.nruh);
502773064edfSJesper Devantier 
502873064edfSJesper Devantier     for (i = 0; i < endgrp->fdp.nruh; i++, ruhud++, ruh++) {
502973064edfSJesper Devantier         ruhud->ruha = ruh->ruha;
503073064edfSJesper Devantier     }
503173064edfSJesper Devantier 
503273064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)buf + off, trans_len, req);
503373064edfSJesper Devantier }
503473064edfSJesper Devantier 
503573064edfSJesper Devantier static uint16_t nvme_fdp_stats(NvmeCtrl *n, uint32_t endgrpid, uint32_t buf_len,
503673064edfSJesper Devantier                                uint64_t off, NvmeRequest *req)
503773064edfSJesper Devantier {
503873064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
503973064edfSJesper Devantier     NvmeFdpStatsLog log = {};
504073064edfSJesper Devantier     uint32_t trans_len;
504173064edfSJesper Devantier 
504273064edfSJesper Devantier     if (off >= sizeof(NvmeFdpStatsLog)) {
504373064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
504473064edfSJesper Devantier     }
504573064edfSJesper Devantier 
504673064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
504773064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
504873064edfSJesper Devantier     }
504973064edfSJesper Devantier 
505073064edfSJesper Devantier     if (!n->subsys->endgrp.fdp.enabled) {
505173064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
505273064edfSJesper Devantier     }
505373064edfSJesper Devantier 
505473064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
505573064edfSJesper Devantier 
505673064edfSJesper Devantier     trans_len = MIN(sizeof(log) - off, buf_len);
505773064edfSJesper Devantier 
505873064edfSJesper Devantier     /* spec value is 128 bit, we only use 64 bit */
505973064edfSJesper Devantier     log.hbmw[0] = cpu_to_le64(endgrp->fdp.hbmw);
506073064edfSJesper Devantier     log.mbmw[0] = cpu_to_le64(endgrp->fdp.mbmw);
506173064edfSJesper Devantier     log.mbe[0] = cpu_to_le64(endgrp->fdp.mbe);
506273064edfSJesper Devantier 
506373064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)&log + off, trans_len, req);
506473064edfSJesper Devantier }
506573064edfSJesper Devantier 
506673064edfSJesper Devantier static uint16_t nvme_fdp_events(NvmeCtrl *n, uint32_t endgrpid,
506773064edfSJesper Devantier                                 uint32_t buf_len, uint64_t off,
506873064edfSJesper Devantier                                 NvmeRequest *req)
506973064edfSJesper Devantier {
507073064edfSJesper Devantier     NvmeEnduranceGroup *endgrp;
507173064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
507273064edfSJesper Devantier     bool host_events = (cmd->cdw10 >> 8) & 0x1;
507373064edfSJesper Devantier     uint32_t log_size, trans_len;
507473064edfSJesper Devantier     NvmeFdpEventBuffer *ebuf;
507573064edfSJesper Devantier     g_autofree NvmeFdpEventsLog *elog = NULL;
507673064edfSJesper Devantier     NvmeFdpEvent *event;
507773064edfSJesper Devantier 
507873064edfSJesper Devantier     if (endgrpid != 1 || !n->subsys) {
507973064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
508073064edfSJesper Devantier     }
508173064edfSJesper Devantier 
508273064edfSJesper Devantier     endgrp = &n->subsys->endgrp;
508373064edfSJesper Devantier 
508473064edfSJesper Devantier     if (!endgrp->fdp.enabled) {
508573064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
508673064edfSJesper Devantier     }
508773064edfSJesper Devantier 
508873064edfSJesper Devantier     if (host_events) {
508973064edfSJesper Devantier         ebuf = &endgrp->fdp.host_events;
509073064edfSJesper Devantier     } else {
509173064edfSJesper Devantier         ebuf = &endgrp->fdp.ctrl_events;
509273064edfSJesper Devantier     }
509373064edfSJesper Devantier 
509473064edfSJesper Devantier     log_size = sizeof(NvmeFdpEventsLog) + ebuf->nelems * sizeof(NvmeFdpEvent);
509573064edfSJesper Devantier     trans_len = MIN(log_size - off, buf_len);
509673064edfSJesper Devantier     elog = g_malloc0(log_size);
509773064edfSJesper Devantier     elog->num_events = cpu_to_le32(ebuf->nelems);
509873064edfSJesper Devantier     event = (NvmeFdpEvent *)(elog + 1);
509973064edfSJesper Devantier 
510073064edfSJesper Devantier     if (ebuf->nelems && ebuf->start == ebuf->next) {
510173064edfSJesper Devantier         unsigned int nelems = (NVME_FDP_MAX_EVENTS - ebuf->start);
510273064edfSJesper Devantier         /* wrap over, copy [start;NVME_FDP_MAX_EVENTS[ and [0; next[ */
510373064edfSJesper Devantier         memcpy(event, &ebuf->events[ebuf->start],
510473064edfSJesper Devantier                sizeof(NvmeFdpEvent) * nelems);
510573064edfSJesper Devantier         memcpy(event + nelems, ebuf->events,
510673064edfSJesper Devantier                sizeof(NvmeFdpEvent) * ebuf->next);
510773064edfSJesper Devantier     } else if (ebuf->start < ebuf->next) {
510873064edfSJesper Devantier         memcpy(event, &ebuf->events[ebuf->start],
510973064edfSJesper Devantier                sizeof(NvmeFdpEvent) * (ebuf->next - ebuf->start));
511073064edfSJesper Devantier     }
511173064edfSJesper Devantier 
511273064edfSJesper Devantier     return nvme_c2h(n, (uint8_t *)elog + off, trans_len, req);
511373064edfSJesper Devantier }
511473064edfSJesper Devantier 
511588eea45cSKlaus Jensen static uint16_t nvme_get_log(NvmeCtrl *n, NvmeRequest *req)
511688eea45cSKlaus Jensen {
511788eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
511888eea45cSKlaus Jensen 
511988eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
512088eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
512188eea45cSKlaus Jensen     uint32_t dw12 = le32_to_cpu(cmd->cdw12);
512288eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
512388eea45cSKlaus Jensen     uint8_t  lid = dw10 & 0xff;
512488eea45cSKlaus Jensen     uint8_t  lsp = (dw10 >> 8) & 0xf;
512588eea45cSKlaus Jensen     uint8_t  rae = (dw10 >> 15) & 0x1;
512688eea45cSKlaus Jensen     uint8_t  csi = le32_to_cpu(cmd->cdw14) >> 24;
512773064edfSJesper Devantier     uint32_t numdl, numdu, lspi;
512888eea45cSKlaus Jensen     uint64_t off, lpol, lpou;
512988eea45cSKlaus Jensen     size_t   len;
513088eea45cSKlaus Jensen     uint16_t status;
513188eea45cSKlaus Jensen 
513288eea45cSKlaus Jensen     numdl = (dw10 >> 16);
513388eea45cSKlaus Jensen     numdu = (dw11 & 0xffff);
513473064edfSJesper Devantier     lspi = (dw11 >> 16);
513588eea45cSKlaus Jensen     lpol = dw12;
513688eea45cSKlaus Jensen     lpou = dw13;
513788eea45cSKlaus Jensen 
513888eea45cSKlaus Jensen     len = (((numdu << 16) | numdl) + 1) << 2;
513988eea45cSKlaus Jensen     off = (lpou << 32ULL) | lpol;
514088eea45cSKlaus Jensen 
514188eea45cSKlaus Jensen     if (off & 0x3) {
514288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
514388eea45cSKlaus Jensen     }
514488eea45cSKlaus Jensen 
514588eea45cSKlaus Jensen     trace_pci_nvme_get_log(nvme_cid(req), lid, lsp, rae, len, off);
514688eea45cSKlaus Jensen 
514788eea45cSKlaus Jensen     status = nvme_check_mdts(n, len);
514888eea45cSKlaus Jensen     if (status) {
514988eea45cSKlaus Jensen         return status;
515088eea45cSKlaus Jensen     }
515188eea45cSKlaus Jensen 
515288eea45cSKlaus Jensen     switch (lid) {
515388eea45cSKlaus Jensen     case NVME_LOG_ERROR_INFO:
515488eea45cSKlaus Jensen         return nvme_error_info(n, rae, len, off, req);
515588eea45cSKlaus Jensen     case NVME_LOG_SMART_INFO:
515688eea45cSKlaus Jensen         return nvme_smart_info(n, rae, len, off, req);
515788eea45cSKlaus Jensen     case NVME_LOG_FW_SLOT_INFO:
515888eea45cSKlaus Jensen         return nvme_fw_log_info(n, len, off, req);
515988eea45cSKlaus Jensen     case NVME_LOG_CHANGED_NSLIST:
516088eea45cSKlaus Jensen         return nvme_changed_nslist(n, rae, len, off, req);
516188eea45cSKlaus Jensen     case NVME_LOG_CMD_EFFECTS:
516288eea45cSKlaus Jensen         return nvme_cmd_effects(n, csi, len, off, req);
5163771dbc3aSKlaus Jensen     case NVME_LOG_ENDGRP:
5164771dbc3aSKlaus Jensen         return nvme_endgrp_info(n, rae, len, off, req);
516573064edfSJesper Devantier     case NVME_LOG_FDP_CONFS:
516673064edfSJesper Devantier         return nvme_fdp_confs(n, lspi, len, off, req);
516773064edfSJesper Devantier     case NVME_LOG_FDP_RUH_USAGE:
516873064edfSJesper Devantier         return nvme_fdp_ruh_usage(n, lspi, dw10, dw12, len, off, req);
516973064edfSJesper Devantier     case NVME_LOG_FDP_STATS:
517073064edfSJesper Devantier         return nvme_fdp_stats(n, lspi, len, off, req);
517173064edfSJesper Devantier     case NVME_LOG_FDP_EVENTS:
517273064edfSJesper Devantier         return nvme_fdp_events(n, lspi, len, off, req);
517388eea45cSKlaus Jensen     default:
517488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page(nvme_cid(req), lid);
517588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
517688eea45cSKlaus Jensen     }
517788eea45cSKlaus Jensen }
517888eea45cSKlaus Jensen 
517988eea45cSKlaus Jensen static void nvme_free_cq(NvmeCQueue *cq, NvmeCtrl *n)
518088eea45cSKlaus Jensen {
518148b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
51822e53b0b4SJinhao Fan     uint16_t offset = (cq->cqid << 3) + (1 << 2);
51832e53b0b4SJinhao Fan 
518488eea45cSKlaus Jensen     n->cq[cq->cqid] = NULL;
5185d38cc6fdSKlaus Jensen     qemu_bh_delete(cq->bh);
51862e53b0b4SJinhao Fan     if (cq->ioeventfd_enabled) {
51872e53b0b4SJinhao Fan         memory_region_del_eventfd(&n->iomem,
51882e53b0b4SJinhao Fan                                   0x1000 + offset, 4, false, 0, &cq->notifier);
518904e8da88SKlaus Jensen         event_notifier_set_handler(&cq->notifier, NULL);
51902e53b0b4SJinhao Fan         event_notifier_cleanup(&cq->notifier);
51912e53b0b4SJinhao Fan     }
519248b32c28SKlaus Jensen     if (msix_enabled(pci)) {
519348b32c28SKlaus Jensen         msix_vector_unuse(pci, cq->vector);
519488eea45cSKlaus Jensen     }
519588eea45cSKlaus Jensen     if (cq->cqid) {
519688eea45cSKlaus Jensen         g_free(cq);
519788eea45cSKlaus Jensen     }
519888eea45cSKlaus Jensen }
519988eea45cSKlaus Jensen 
520088eea45cSKlaus Jensen static uint16_t nvme_del_cq(NvmeCtrl *n, NvmeRequest *req)
520188eea45cSKlaus Jensen {
520288eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
520388eea45cSKlaus Jensen     NvmeCQueue *cq;
520488eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
520588eea45cSKlaus Jensen 
520688eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_cqid(n, qid))) {
520788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_cqid(qid);
520888eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
520988eea45cSKlaus Jensen     }
521088eea45cSKlaus Jensen 
521188eea45cSKlaus Jensen     cq = n->cq[qid];
521288eea45cSKlaus Jensen     if (unlikely(!QTAILQ_EMPTY(&cq->sq_list))) {
521388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_notempty(qid);
521488eea45cSKlaus Jensen         return NVME_INVALID_QUEUE_DEL;
521588eea45cSKlaus Jensen     }
521683d7ed5cSKlaus Jensen 
521783d7ed5cSKlaus Jensen     if (cq->irq_enabled && cq->tail != cq->head) {
521883d7ed5cSKlaus Jensen         n->cq_pending--;
521983d7ed5cSKlaus Jensen     }
522083d7ed5cSKlaus Jensen 
522188eea45cSKlaus Jensen     nvme_irq_deassert(n, cq);
522288eea45cSKlaus Jensen     trace_pci_nvme_del_cq(qid);
522388eea45cSKlaus Jensen     nvme_free_cq(cq, n);
522488eea45cSKlaus Jensen     return NVME_SUCCESS;
522588eea45cSKlaus Jensen }
522688eea45cSKlaus Jensen 
522788eea45cSKlaus Jensen static void nvme_init_cq(NvmeCQueue *cq, NvmeCtrl *n, uint64_t dma_addr,
522888eea45cSKlaus Jensen                          uint16_t cqid, uint16_t vector, uint16_t size,
522988eea45cSKlaus Jensen                          uint16_t irq_enabled)
523088eea45cSKlaus Jensen {
523148b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
523248b32c28SKlaus Jensen 
523348b32c28SKlaus Jensen     if (msix_enabled(pci)) {
523448b32c28SKlaus Jensen         msix_vector_use(pci, vector);
523588eea45cSKlaus Jensen     }
523688eea45cSKlaus Jensen     cq->ctrl = n;
523788eea45cSKlaus Jensen     cq->cqid = cqid;
523888eea45cSKlaus Jensen     cq->size = size;
523988eea45cSKlaus Jensen     cq->dma_addr = dma_addr;
524088eea45cSKlaus Jensen     cq->phase = 1;
524188eea45cSKlaus Jensen     cq->irq_enabled = irq_enabled;
524288eea45cSKlaus Jensen     cq->vector = vector;
524388eea45cSKlaus Jensen     cq->head = cq->tail = 0;
524488eea45cSKlaus Jensen     QTAILQ_INIT(&cq->req_list);
524588eea45cSKlaus Jensen     QTAILQ_INIT(&cq->sq_list);
52463f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
52473f7fe8deSJinhao Fan         cq->db_addr = n->dbbuf_dbs + (cqid << 3) + (1 << 2);
52483f7fe8deSJinhao Fan         cq->ei_addr = n->dbbuf_eis + (cqid << 3) + (1 << 2);
52492e53b0b4SJinhao Fan 
52502e53b0b4SJinhao Fan         if (n->params.ioeventfd && cqid != 0) {
52512e53b0b4SJinhao Fan             if (!nvme_init_cq_ioeventfd(cq)) {
52522e53b0b4SJinhao Fan                 cq->ioeventfd_enabled = true;
52532e53b0b4SJinhao Fan             }
52542e53b0b4SJinhao Fan         }
52553f7fe8deSJinhao Fan     }
525688eea45cSKlaus Jensen     n->cq[cqid] = cq;
5257*f63192b0SAlexander Bulekov     cq->bh = qemu_bh_new_guarded(nvme_post_cqes, cq,
5258*f63192b0SAlexander Bulekov                                  &DEVICE(cq->ctrl)->mem_reentrancy_guard);
525988eea45cSKlaus Jensen }
526088eea45cSKlaus Jensen 
526188eea45cSKlaus Jensen static uint16_t nvme_create_cq(NvmeCtrl *n, NvmeRequest *req)
526288eea45cSKlaus Jensen {
526388eea45cSKlaus Jensen     NvmeCQueue *cq;
526488eea45cSKlaus Jensen     NvmeCreateCq *c = (NvmeCreateCq *)&req->cmd;
526588eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
526688eea45cSKlaus Jensen     uint16_t vector = le16_to_cpu(c->irq_vector);
526788eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
526888eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->cq_flags);
526988eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
527088eea45cSKlaus Jensen 
527188eea45cSKlaus Jensen     trace_pci_nvme_create_cq(prp1, cqid, vector, qsize, qflags,
527288eea45cSKlaus Jensen                              NVME_CQ_FLAGS_IEN(qflags) != 0);
527388eea45cSKlaus Jensen 
5274decc0261SŁukasz Gieryk     if (unlikely(!cqid || cqid > n->conf_ioqpairs || n->cq[cqid] != NULL)) {
527588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_cqid(cqid);
527688eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
527788eea45cSKlaus Jensen     }
527849e03457SKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(ldq_le_p(&n->bar.cap)))) {
527988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_size(qsize);
528088eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
528188eea45cSKlaus Jensen     }
528288eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
528388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_addr(prp1);
528488eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
528588eea45cSKlaus Jensen     }
528648b32c28SKlaus Jensen     if (unlikely(!msix_enabled(PCI_DEVICE(n)) && vector)) {
528788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
528888eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
528988eea45cSKlaus Jensen     }
5290decc0261SŁukasz Gieryk     if (unlikely(vector >= n->conf_msix_qsize)) {
529188eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
529288eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
529388eea45cSKlaus Jensen     }
529488eea45cSKlaus Jensen     if (unlikely(!(NVME_CQ_FLAGS_PC(qflags)))) {
529588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_qflags(NVME_CQ_FLAGS_PC(qflags));
529688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
529788eea45cSKlaus Jensen     }
529888eea45cSKlaus Jensen 
529988eea45cSKlaus Jensen     cq = g_malloc0(sizeof(*cq));
530088eea45cSKlaus Jensen     nvme_init_cq(cq, n, prp1, cqid, vector, qsize + 1,
530188eea45cSKlaus Jensen                  NVME_CQ_FLAGS_IEN(qflags));
530288eea45cSKlaus Jensen 
530388eea45cSKlaus Jensen     /*
530488eea45cSKlaus Jensen      * It is only required to set qs_created when creating a completion queue;
530588eea45cSKlaus Jensen      * creating a submission queue without a matching completion queue will
530688eea45cSKlaus Jensen      * fail.
530788eea45cSKlaus Jensen      */
530888eea45cSKlaus Jensen     n->qs_created = true;
530988eea45cSKlaus Jensen     return NVME_SUCCESS;
531088eea45cSKlaus Jensen }
531188eea45cSKlaus Jensen 
531288eea45cSKlaus Jensen static uint16_t nvme_rpt_empty_id_struct(NvmeCtrl *n, NvmeRequest *req)
531388eea45cSKlaus Jensen {
531488eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
531588eea45cSKlaus Jensen 
531688eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
531788eea45cSKlaus Jensen }
531888eea45cSKlaus Jensen 
531988eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl(NvmeCtrl *n, NvmeRequest *req)
532088eea45cSKlaus Jensen {
532188eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl();
532288eea45cSKlaus Jensen 
532388eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&n->id_ctrl, sizeof(n->id_ctrl), req);
532488eea45cSKlaus Jensen }
532588eea45cSKlaus Jensen 
532688eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl_csi(NvmeCtrl *n, NvmeRequest *req)
532788eea45cSKlaus Jensen {
532888eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
532988eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
533088eea45cSKlaus Jensen     NvmeIdCtrlNvm *id_nvm = (NvmeIdCtrlNvm *)&id;
533188eea45cSKlaus Jensen 
533288eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl_csi(c->csi);
533388eea45cSKlaus Jensen 
533488eea45cSKlaus Jensen     switch (c->csi) {
533588eea45cSKlaus Jensen     case NVME_CSI_NVM:
533688eea45cSKlaus Jensen         id_nvm->vsl = n->params.vsl;
533788eea45cSKlaus Jensen         id_nvm->dmrsl = cpu_to_le32(n->dmrsl);
533888eea45cSKlaus Jensen         break;
533988eea45cSKlaus Jensen 
534088eea45cSKlaus Jensen     case NVME_CSI_ZONED:
534188eea45cSKlaus Jensen         ((NvmeIdCtrlZoned *)&id)->zasl = n->params.zasl;
534288eea45cSKlaus Jensen         break;
534388eea45cSKlaus Jensen 
534488eea45cSKlaus Jensen     default:
534588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
534688eea45cSKlaus Jensen     }
534788eea45cSKlaus Jensen 
534888eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
534988eea45cSKlaus Jensen }
535088eea45cSKlaus Jensen 
535188eea45cSKlaus Jensen static uint16_t nvme_identify_ns(NvmeCtrl *n, NvmeRequest *req, bool active)
535288eea45cSKlaus Jensen {
535388eea45cSKlaus Jensen     NvmeNamespace *ns;
535488eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
535588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
535688eea45cSKlaus Jensen 
535788eea45cSKlaus Jensen     trace_pci_nvme_identify_ns(nsid);
535888eea45cSKlaus Jensen 
535988eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
536088eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
536188eea45cSKlaus Jensen     }
536288eea45cSKlaus Jensen 
536388eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
536488eea45cSKlaus Jensen     if (unlikely(!ns)) {
536588eea45cSKlaus Jensen         if (!active) {
536688eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
536788eea45cSKlaus Jensen             if (!ns) {
536888eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
536988eea45cSKlaus Jensen             }
537088eea45cSKlaus Jensen         } else {
537188eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
537288eea45cSKlaus Jensen         }
537388eea45cSKlaus Jensen     }
537488eea45cSKlaus Jensen 
53753553c48fSGollu Appalanaidu     if (active || ns->csi == NVME_CSI_NVM) {
537688eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)&ns->id_ns, sizeof(NvmeIdNs), req);
537788eea45cSKlaus Jensen     }
537888eea45cSKlaus Jensen 
537988eea45cSKlaus Jensen     return NVME_INVALID_CMD_SET | NVME_DNR;
538088eea45cSKlaus Jensen }
538188eea45cSKlaus Jensen 
53825f4eb94dSGollu Appalanaidu static uint16_t nvme_identify_ctrl_list(NvmeCtrl *n, NvmeRequest *req,
53835f4eb94dSGollu Appalanaidu                                         bool attached)
538488eea45cSKlaus Jensen {
538588eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
53865f4eb94dSGollu Appalanaidu     uint32_t nsid = le32_to_cpu(c->nsid);
538788eea45cSKlaus Jensen     uint16_t min_id = le16_to_cpu(c->ctrlid);
538888eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
538988eea45cSKlaus Jensen     uint16_t *ids = &list[1];
539088eea45cSKlaus Jensen     NvmeNamespace *ns;
539188eea45cSKlaus Jensen     NvmeCtrl *ctrl;
539288eea45cSKlaus Jensen     int cntlid, nr_ids = 0;
539388eea45cSKlaus Jensen 
53945f4eb94dSGollu Appalanaidu     trace_pci_nvme_identify_ctrl_list(c->cns, min_id);
539588eea45cSKlaus Jensen 
53965f4eb94dSGollu Appalanaidu     if (!n->subsys) {
539788eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
539888eea45cSKlaus Jensen     }
539988eea45cSKlaus Jensen 
54005f4eb94dSGollu Appalanaidu     if (attached) {
54015f4eb94dSGollu Appalanaidu         if (nsid == NVME_NSID_BROADCAST) {
54025f4eb94dSGollu Appalanaidu             return NVME_INVALID_FIELD | NVME_DNR;
54035f4eb94dSGollu Appalanaidu         }
54045f4eb94dSGollu Appalanaidu 
54055f4eb94dSGollu Appalanaidu         ns = nvme_subsys_ns(n->subsys, nsid);
540688eea45cSKlaus Jensen         if (!ns) {
540788eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
540888eea45cSKlaus Jensen         }
54095f4eb94dSGollu Appalanaidu     }
541088eea45cSKlaus Jensen 
541188eea45cSKlaus Jensen     for (cntlid = min_id; cntlid < ARRAY_SIZE(n->subsys->ctrls); cntlid++) {
541288eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, cntlid);
541388eea45cSKlaus Jensen         if (!ctrl) {
541488eea45cSKlaus Jensen             continue;
541588eea45cSKlaus Jensen         }
541688eea45cSKlaus Jensen 
54175f4eb94dSGollu Appalanaidu         if (attached && !nvme_ns(ctrl, nsid)) {
541888eea45cSKlaus Jensen             continue;
541988eea45cSKlaus Jensen         }
542088eea45cSKlaus Jensen 
542188eea45cSKlaus Jensen         ids[nr_ids++] = cntlid;
542288eea45cSKlaus Jensen     }
542388eea45cSKlaus Jensen 
542488eea45cSKlaus Jensen     list[0] = nr_ids;
542588eea45cSKlaus Jensen 
542688eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)list, sizeof(list), req);
542788eea45cSKlaus Jensen }
542888eea45cSKlaus Jensen 
54295e6f963fSLukasz Maniak static uint16_t nvme_identify_pri_ctrl_cap(NvmeCtrl *n, NvmeRequest *req)
54305e6f963fSLukasz Maniak {
54315e6f963fSLukasz Maniak     trace_pci_nvme_identify_pri_ctrl_cap(le16_to_cpu(n->pri_ctrl_cap.cntlid));
54325e6f963fSLukasz Maniak 
54335e6f963fSLukasz Maniak     return nvme_c2h(n, (uint8_t *)&n->pri_ctrl_cap,
54345e6f963fSLukasz Maniak                     sizeof(NvmePriCtrlCap), req);
54355e6f963fSLukasz Maniak }
54365e6f963fSLukasz Maniak 
543799f48ae7SLukasz Maniak static uint16_t nvme_identify_sec_ctrl_list(NvmeCtrl *n, NvmeRequest *req)
543899f48ae7SLukasz Maniak {
543999f48ae7SLukasz Maniak     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
544099f48ae7SLukasz Maniak     uint16_t pri_ctrl_id = le16_to_cpu(n->pri_ctrl_cap.cntlid);
544199f48ae7SLukasz Maniak     uint16_t min_id = le16_to_cpu(c->ctrlid);
544299f48ae7SLukasz Maniak     uint8_t num_sec_ctrl = n->sec_ctrl_list.numcntl;
544399f48ae7SLukasz Maniak     NvmeSecCtrlList list = {0};
544499f48ae7SLukasz Maniak     uint8_t i;
544599f48ae7SLukasz Maniak 
544699f48ae7SLukasz Maniak     for (i = 0; i < num_sec_ctrl; i++) {
544799f48ae7SLukasz Maniak         if (n->sec_ctrl_list.sec[i].scid >= min_id) {
544899f48ae7SLukasz Maniak             list.numcntl = num_sec_ctrl - i;
544999f48ae7SLukasz Maniak             memcpy(&list.sec, n->sec_ctrl_list.sec + i,
545099f48ae7SLukasz Maniak                    list.numcntl * sizeof(NvmeSecCtrlEntry));
545199f48ae7SLukasz Maniak             break;
545299f48ae7SLukasz Maniak         }
545399f48ae7SLukasz Maniak     }
545499f48ae7SLukasz Maniak 
545599f48ae7SLukasz Maniak     trace_pci_nvme_identify_sec_ctrl_list(pri_ctrl_id, list.numcntl);
545699f48ae7SLukasz Maniak 
545799f48ae7SLukasz Maniak     return nvme_c2h(n, (uint8_t *)&list, sizeof(list), req);
545899f48ae7SLukasz Maniak }
545999f48ae7SLukasz Maniak 
546088eea45cSKlaus Jensen static uint16_t nvme_identify_ns_csi(NvmeCtrl *n, NvmeRequest *req,
546188eea45cSKlaus Jensen                                      bool active)
546288eea45cSKlaus Jensen {
546388eea45cSKlaus Jensen     NvmeNamespace *ns;
546488eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
546588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
546688eea45cSKlaus Jensen 
546788eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_csi(nsid, c->csi);
546888eea45cSKlaus Jensen 
546988eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
547088eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
547188eea45cSKlaus Jensen     }
547288eea45cSKlaus Jensen 
547388eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
547488eea45cSKlaus Jensen     if (unlikely(!ns)) {
547588eea45cSKlaus Jensen         if (!active) {
547688eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
547788eea45cSKlaus Jensen             if (!ns) {
547888eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
547988eea45cSKlaus Jensen             }
548088eea45cSKlaus Jensen         } else {
548188eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
548288eea45cSKlaus Jensen         }
548388eea45cSKlaus Jensen     }
548488eea45cSKlaus Jensen 
54853553c48fSGollu Appalanaidu     if (c->csi == NVME_CSI_NVM) {
548644219b60SNaveen Nagar         return nvme_c2h(n, (uint8_t *)&ns->id_ns_nvm, sizeof(NvmeIdNsNvm),
548744219b60SNaveen Nagar                         req);
548888eea45cSKlaus Jensen     } else if (c->csi == NVME_CSI_ZONED && ns->csi == NVME_CSI_ZONED) {
548988eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)ns->id_ns_zoned, sizeof(NvmeIdNsZoned),
549088eea45cSKlaus Jensen                         req);
549188eea45cSKlaus Jensen     }
549288eea45cSKlaus Jensen 
549388eea45cSKlaus Jensen     return NVME_INVALID_FIELD | NVME_DNR;
549488eea45cSKlaus Jensen }
549588eea45cSKlaus Jensen 
549688eea45cSKlaus Jensen static uint16_t nvme_identify_nslist(NvmeCtrl *n, NvmeRequest *req,
549788eea45cSKlaus Jensen                                      bool active)
549888eea45cSKlaus Jensen {
549988eea45cSKlaus Jensen     NvmeNamespace *ns;
550088eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
550188eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
550288eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
550388eea45cSKlaus Jensen     static const int data_len = sizeof(list);
550488eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
550588eea45cSKlaus Jensen     int i, j = 0;
550688eea45cSKlaus Jensen 
550788eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist(min_nsid);
550888eea45cSKlaus Jensen 
550988eea45cSKlaus Jensen     /*
551088eea45cSKlaus Jensen      * Both FFFFFFFFh (NVME_NSID_BROADCAST) and FFFFFFFFEh are invalid values
551188eea45cSKlaus Jensen      * since the Active Namespace ID List should return namespaces with ids
551288eea45cSKlaus Jensen      * *higher* than the NSID specified in the command. This is also specified
551388eea45cSKlaus Jensen      * in the spec (NVM Express v1.3d, Section 5.15.4).
551488eea45cSKlaus Jensen      */
551588eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
551688eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
551788eea45cSKlaus Jensen     }
551888eea45cSKlaus Jensen 
551988eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
552088eea45cSKlaus Jensen         ns = nvme_ns(n, i);
552188eea45cSKlaus Jensen         if (!ns) {
552288eea45cSKlaus Jensen             if (!active) {
552388eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
552488eea45cSKlaus Jensen                 if (!ns) {
552588eea45cSKlaus Jensen                     continue;
552688eea45cSKlaus Jensen                 }
552788eea45cSKlaus Jensen             } else {
552888eea45cSKlaus Jensen                 continue;
552988eea45cSKlaus Jensen             }
553088eea45cSKlaus Jensen         }
553188eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid) {
553288eea45cSKlaus Jensen             continue;
553388eea45cSKlaus Jensen         }
553488eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
553588eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
553688eea45cSKlaus Jensen             break;
553788eea45cSKlaus Jensen         }
553888eea45cSKlaus Jensen     }
553988eea45cSKlaus Jensen 
554088eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
554188eea45cSKlaus Jensen }
554288eea45cSKlaus Jensen 
554388eea45cSKlaus Jensen static uint16_t nvme_identify_nslist_csi(NvmeCtrl *n, NvmeRequest *req,
554488eea45cSKlaus Jensen                                          bool active)
554588eea45cSKlaus Jensen {
554688eea45cSKlaus Jensen     NvmeNamespace *ns;
554788eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
554888eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
554988eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
555088eea45cSKlaus Jensen     static const int data_len = sizeof(list);
555188eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
555288eea45cSKlaus Jensen     int i, j = 0;
555388eea45cSKlaus Jensen 
555488eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist_csi(min_nsid, c->csi);
555588eea45cSKlaus Jensen 
555688eea45cSKlaus Jensen     /*
555788eea45cSKlaus Jensen      * Same as in nvme_identify_nslist(), FFFFFFFFh/FFFFFFFFEh are invalid.
555888eea45cSKlaus Jensen      */
555988eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
556088eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
556188eea45cSKlaus Jensen     }
556288eea45cSKlaus Jensen 
556388eea45cSKlaus Jensen     if (c->csi != NVME_CSI_NVM && c->csi != NVME_CSI_ZONED) {
556488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
556588eea45cSKlaus Jensen     }
556688eea45cSKlaus Jensen 
556788eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
556888eea45cSKlaus Jensen         ns = nvme_ns(n, i);
556988eea45cSKlaus Jensen         if (!ns) {
557088eea45cSKlaus Jensen             if (!active) {
557188eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
557288eea45cSKlaus Jensen                 if (!ns) {
557388eea45cSKlaus Jensen                     continue;
557488eea45cSKlaus Jensen                 }
557588eea45cSKlaus Jensen             } else {
557688eea45cSKlaus Jensen                 continue;
557788eea45cSKlaus Jensen             }
557888eea45cSKlaus Jensen         }
557988eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid || c->csi != ns->csi) {
558088eea45cSKlaus Jensen             continue;
558188eea45cSKlaus Jensen         }
558288eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
558388eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
558488eea45cSKlaus Jensen             break;
558588eea45cSKlaus Jensen         }
558688eea45cSKlaus Jensen     }
558788eea45cSKlaus Jensen 
558888eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
558988eea45cSKlaus Jensen }
559088eea45cSKlaus Jensen 
559188eea45cSKlaus Jensen static uint16_t nvme_identify_ns_descr_list(NvmeCtrl *n, NvmeRequest *req)
559288eea45cSKlaus Jensen {
559388eea45cSKlaus Jensen     NvmeNamespace *ns;
559488eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
559588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
559688eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
55976870cfb8SHeinrich Schuchardt     uint8_t *pos = list;
559888eea45cSKlaus Jensen     struct {
559988eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
560088eea45cSKlaus Jensen         uint8_t v[NVME_NIDL_UUID];
56015f4884c4SKlaus Jensen     } QEMU_PACKED uuid = {};
56026870cfb8SHeinrich Schuchardt     struct {
56036870cfb8SHeinrich Schuchardt         NvmeIdNsDescr hdr;
56046870cfb8SHeinrich Schuchardt         uint64_t v;
56055f4884c4SKlaus Jensen     } QEMU_PACKED eui64 = {};
560688eea45cSKlaus Jensen     struct {
560788eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
560888eea45cSKlaus Jensen         uint8_t v;
56095f4884c4SKlaus Jensen     } QEMU_PACKED csi = {};
561088eea45cSKlaus Jensen 
561188eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_descr_list(nsid);
561288eea45cSKlaus Jensen 
561388eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
561488eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
561588eea45cSKlaus Jensen     }
561688eea45cSKlaus Jensen 
561788eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
561888eea45cSKlaus Jensen     if (unlikely(!ns)) {
561988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
562088eea45cSKlaus Jensen     }
562188eea45cSKlaus Jensen 
56229f2e1acfSKlaus Jensen     if (!qemu_uuid_is_null(&ns->params.uuid)) {
56236870cfb8SHeinrich Schuchardt         uuid.hdr.nidt = NVME_NIDT_UUID;
56246870cfb8SHeinrich Schuchardt         uuid.hdr.nidl = NVME_NIDL_UUID;
56256870cfb8SHeinrich Schuchardt         memcpy(uuid.v, ns->params.uuid.data, NVME_NIDL_UUID);
56266870cfb8SHeinrich Schuchardt         memcpy(pos, &uuid, sizeof(uuid));
56276870cfb8SHeinrich Schuchardt         pos += sizeof(uuid);
56289f2e1acfSKlaus Jensen     }
562988eea45cSKlaus Jensen 
56306870cfb8SHeinrich Schuchardt     if (ns->params.eui64) {
56316870cfb8SHeinrich Schuchardt         eui64.hdr.nidt = NVME_NIDT_EUI64;
56326870cfb8SHeinrich Schuchardt         eui64.hdr.nidl = NVME_NIDL_EUI64;
56336870cfb8SHeinrich Schuchardt         eui64.v = cpu_to_be64(ns->params.eui64);
56346870cfb8SHeinrich Schuchardt         memcpy(pos, &eui64, sizeof(eui64));
56356870cfb8SHeinrich Schuchardt         pos += sizeof(eui64);
56366870cfb8SHeinrich Schuchardt     }
56376870cfb8SHeinrich Schuchardt 
56386870cfb8SHeinrich Schuchardt     csi.hdr.nidt = NVME_NIDT_CSI;
56396870cfb8SHeinrich Schuchardt     csi.hdr.nidl = NVME_NIDL_CSI;
56406870cfb8SHeinrich Schuchardt     csi.v = ns->csi;
56416870cfb8SHeinrich Schuchardt     memcpy(pos, &csi, sizeof(csi));
56426870cfb8SHeinrich Schuchardt     pos += sizeof(csi);
564388eea45cSKlaus Jensen 
564488eea45cSKlaus Jensen     return nvme_c2h(n, list, sizeof(list), req);
564588eea45cSKlaus Jensen }
564688eea45cSKlaus Jensen 
564788eea45cSKlaus Jensen static uint16_t nvme_identify_cmd_set(NvmeCtrl *n, NvmeRequest *req)
564888eea45cSKlaus Jensen {
564988eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
565088eea45cSKlaus Jensen     static const int data_len = sizeof(list);
565188eea45cSKlaus Jensen 
565288eea45cSKlaus Jensen     trace_pci_nvme_identify_cmd_set();
565388eea45cSKlaus Jensen 
565488eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_NVM);
565588eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_ZONED);
565688eea45cSKlaus Jensen 
565788eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
565888eea45cSKlaus Jensen }
565988eea45cSKlaus Jensen 
566088eea45cSKlaus Jensen static uint16_t nvme_identify(NvmeCtrl *n, NvmeRequest *req)
566188eea45cSKlaus Jensen {
566288eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
566388eea45cSKlaus Jensen 
566488eea45cSKlaus Jensen     trace_pci_nvme_identify(nvme_cid(req), c->cns, le16_to_cpu(c->ctrlid),
566588eea45cSKlaus Jensen                             c->csi);
566688eea45cSKlaus Jensen 
566788eea45cSKlaus Jensen     switch (c->cns) {
566888eea45cSKlaus Jensen     case NVME_ID_CNS_NS:
566988eea45cSKlaus Jensen         return nvme_identify_ns(n, req, true);
567088eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT:
567188eea45cSKlaus Jensen         return nvme_identify_ns(n, req, false);
567288eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ATTACHED_CTRL_LIST:
56735f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, true);
56745f4eb94dSGollu Appalanaidu     case NVME_ID_CNS_CTRL_LIST:
56755f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, false);
56765e6f963fSLukasz Maniak     case NVME_ID_CNS_PRIMARY_CTRL_CAP:
56775e6f963fSLukasz Maniak         return nvme_identify_pri_ctrl_cap(n, req);
567899f48ae7SLukasz Maniak     case NVME_ID_CNS_SECONDARY_CTRL_LIST:
567999f48ae7SLukasz Maniak         return nvme_identify_sec_ctrl_list(n, req);
568088eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS:
568188eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, true);
568288eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT:
568388eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, false);
568488eea45cSKlaus Jensen     case NVME_ID_CNS_CTRL:
568588eea45cSKlaus Jensen         return nvme_identify_ctrl(n, req);
568688eea45cSKlaus Jensen     case NVME_ID_CNS_CS_CTRL:
568788eea45cSKlaus Jensen         return nvme_identify_ctrl_csi(n, req);
568888eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ACTIVE_LIST:
568988eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, true);
569088eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT_LIST:
569188eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, false);
569288eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_ACTIVE_LIST:
569388eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, true);
569488eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT_LIST:
569588eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, false);
569688eea45cSKlaus Jensen     case NVME_ID_CNS_NS_DESCR_LIST:
569788eea45cSKlaus Jensen         return nvme_identify_ns_descr_list(n, req);
569888eea45cSKlaus Jensen     case NVME_ID_CNS_IO_COMMAND_SET:
569988eea45cSKlaus Jensen         return nvme_identify_cmd_set(n, req);
570088eea45cSKlaus Jensen     default:
570188eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_identify_cns(le32_to_cpu(c->cns));
570288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
570388eea45cSKlaus Jensen     }
570488eea45cSKlaus Jensen }
570588eea45cSKlaus Jensen 
570688eea45cSKlaus Jensen static uint16_t nvme_abort(NvmeCtrl *n, NvmeRequest *req)
570788eea45cSKlaus Jensen {
570888eea45cSKlaus Jensen     uint16_t sqid = le32_to_cpu(req->cmd.cdw10) & 0xffff;
570988eea45cSKlaus Jensen 
571088eea45cSKlaus Jensen     req->cqe.result = 1;
571188eea45cSKlaus Jensen     if (nvme_check_sqid(n, sqid)) {
571288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
571388eea45cSKlaus Jensen     }
571488eea45cSKlaus Jensen 
571588eea45cSKlaus Jensen     return NVME_SUCCESS;
571688eea45cSKlaus Jensen }
571788eea45cSKlaus Jensen 
571888eea45cSKlaus Jensen static inline void nvme_set_timestamp(NvmeCtrl *n, uint64_t ts)
571988eea45cSKlaus Jensen {
572088eea45cSKlaus Jensen     trace_pci_nvme_setfeat_timestamp(ts);
572188eea45cSKlaus Jensen 
572288eea45cSKlaus Jensen     n->host_timestamp = le64_to_cpu(ts);
572388eea45cSKlaus Jensen     n->timestamp_set_qemu_clock_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
572488eea45cSKlaus Jensen }
572588eea45cSKlaus Jensen 
572688eea45cSKlaus Jensen static inline uint64_t nvme_get_timestamp(const NvmeCtrl *n)
572788eea45cSKlaus Jensen {
572888eea45cSKlaus Jensen     uint64_t current_time = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
572988eea45cSKlaus Jensen     uint64_t elapsed_time = current_time - n->timestamp_set_qemu_clock_ms;
573088eea45cSKlaus Jensen 
573188eea45cSKlaus Jensen     union nvme_timestamp {
573288eea45cSKlaus Jensen         struct {
573388eea45cSKlaus Jensen             uint64_t timestamp:48;
573488eea45cSKlaus Jensen             uint64_t sync:1;
573588eea45cSKlaus Jensen             uint64_t origin:3;
573688eea45cSKlaus Jensen             uint64_t rsvd1:12;
573788eea45cSKlaus Jensen         };
573888eea45cSKlaus Jensen         uint64_t all;
573988eea45cSKlaus Jensen     };
574088eea45cSKlaus Jensen 
574188eea45cSKlaus Jensen     union nvme_timestamp ts;
574288eea45cSKlaus Jensen     ts.all = 0;
574388eea45cSKlaus Jensen     ts.timestamp = n->host_timestamp + elapsed_time;
574488eea45cSKlaus Jensen 
574588eea45cSKlaus Jensen     /* If the host timestamp is non-zero, set the timestamp origin */
574688eea45cSKlaus Jensen     ts.origin = n->host_timestamp ? 0x01 : 0x00;
574788eea45cSKlaus Jensen 
574888eea45cSKlaus Jensen     trace_pci_nvme_getfeat_timestamp(ts.all);
574988eea45cSKlaus Jensen 
575088eea45cSKlaus Jensen     return cpu_to_le64(ts.all);
575188eea45cSKlaus Jensen }
575288eea45cSKlaus Jensen 
575388eea45cSKlaus Jensen static uint16_t nvme_get_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
575488eea45cSKlaus Jensen {
575588eea45cSKlaus Jensen     uint64_t timestamp = nvme_get_timestamp(n);
575688eea45cSKlaus Jensen 
575788eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
575888eea45cSKlaus Jensen }
575988eea45cSKlaus Jensen 
576073064edfSJesper Devantier static int nvme_get_feature_fdp(NvmeCtrl *n, uint32_t endgrpid,
576173064edfSJesper Devantier                                 uint32_t *result)
576273064edfSJesper Devantier {
576373064edfSJesper Devantier     *result = 0;
576473064edfSJesper Devantier 
576573064edfSJesper Devantier     if (!n->subsys || !n->subsys->endgrp.fdp.enabled) {
576673064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
576773064edfSJesper Devantier     }
576873064edfSJesper Devantier 
576973064edfSJesper Devantier     *result = FIELD_DP16(0, FEAT_FDP, FDPE, 1);
577073064edfSJesper Devantier     *result = FIELD_DP16(*result, FEAT_FDP, CONF_NDX, 0);
577173064edfSJesper Devantier 
577273064edfSJesper Devantier     return NVME_SUCCESS;
577373064edfSJesper Devantier }
577473064edfSJesper Devantier 
577573064edfSJesper Devantier static uint16_t nvme_get_feature_fdp_events(NvmeCtrl *n, NvmeNamespace *ns,
577673064edfSJesper Devantier                                             NvmeRequest *req, uint32_t *result)
577773064edfSJesper Devantier {
577873064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
577973064edfSJesper Devantier     uint32_t cdw11 = le32_to_cpu(cmd->cdw11);
578073064edfSJesper Devantier     uint16_t ph = cdw11 & 0xffff;
578173064edfSJesper Devantier     uint8_t noet = (cdw11 >> 16) & 0xff;
578273064edfSJesper Devantier     uint16_t ruhid, ret;
578373064edfSJesper Devantier     uint32_t nentries = 0;
578473064edfSJesper Devantier     uint8_t s_events_ndx = 0;
578573064edfSJesper Devantier     size_t s_events_siz = sizeof(NvmeFdpEventDescr) * noet;
578673064edfSJesper Devantier     g_autofree NvmeFdpEventDescr *s_events = g_malloc0(s_events_siz);
578773064edfSJesper Devantier     NvmeRuHandle *ruh;
578873064edfSJesper Devantier     NvmeFdpEventDescr *s_event;
578973064edfSJesper Devantier 
579073064edfSJesper Devantier     if (!n->subsys || !n->subsys->endgrp.fdp.enabled) {
579173064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
579273064edfSJesper Devantier     }
579373064edfSJesper Devantier 
579473064edfSJesper Devantier     if (!nvme_ph_valid(ns, ph)) {
579573064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
579673064edfSJesper Devantier     }
579773064edfSJesper Devantier 
579873064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
579973064edfSJesper Devantier     ruh = &n->subsys->endgrp.fdp.ruhs[ruhid];
580073064edfSJesper Devantier 
580173064edfSJesper Devantier     assert(ruh);
580273064edfSJesper Devantier 
580373064edfSJesper Devantier     if (unlikely(noet == 0)) {
580473064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
580573064edfSJesper Devantier     }
580673064edfSJesper Devantier 
580773064edfSJesper Devantier     for (uint8_t event_type = 0; event_type < FDP_EVT_MAX; event_type++) {
580873064edfSJesper Devantier         uint8_t shift = nvme_fdp_evf_shifts[event_type];
580973064edfSJesper Devantier         if (!shift && event_type) {
581073064edfSJesper Devantier             /*
581173064edfSJesper Devantier              * only first entry (event_type == 0) has a shift value of 0
581273064edfSJesper Devantier              * other entries are simply unpopulated.
581373064edfSJesper Devantier              */
581473064edfSJesper Devantier             continue;
581573064edfSJesper Devantier         }
581673064edfSJesper Devantier 
581773064edfSJesper Devantier         nentries++;
581873064edfSJesper Devantier 
581973064edfSJesper Devantier         s_event = &s_events[s_events_ndx];
582073064edfSJesper Devantier         s_event->evt = event_type;
582173064edfSJesper Devantier         s_event->evta = (ruh->event_filter >> shift) & 0x1;
582273064edfSJesper Devantier 
582373064edfSJesper Devantier         /* break if all `noet` entries are filled */
582473064edfSJesper Devantier         if ((++s_events_ndx) == noet) {
582573064edfSJesper Devantier             break;
582673064edfSJesper Devantier         }
582773064edfSJesper Devantier     }
582873064edfSJesper Devantier 
582973064edfSJesper Devantier     ret = nvme_c2h(n, s_events, s_events_siz, req);
583073064edfSJesper Devantier     if (ret) {
583173064edfSJesper Devantier         return ret;
583273064edfSJesper Devantier     }
583373064edfSJesper Devantier 
583473064edfSJesper Devantier     *result = nentries;
583573064edfSJesper Devantier     return NVME_SUCCESS;
583673064edfSJesper Devantier }
583773064edfSJesper Devantier 
583888eea45cSKlaus Jensen static uint16_t nvme_get_feature(NvmeCtrl *n, NvmeRequest *req)
583988eea45cSKlaus Jensen {
584088eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
584188eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
584288eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
584388eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
584488eea45cSKlaus Jensen     uint32_t result;
584588eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
584688eea45cSKlaus Jensen     NvmeGetFeatureSelect sel = NVME_GETFEAT_SELECT(dw10);
584788eea45cSKlaus Jensen     uint16_t iv;
584888eea45cSKlaus Jensen     NvmeNamespace *ns;
584988eea45cSKlaus Jensen     int i;
585073064edfSJesper Devantier     uint16_t endgrpid = 0, ret = NVME_SUCCESS;
585188eea45cSKlaus Jensen 
585288eea45cSKlaus Jensen     static const uint32_t nvme_feature_default[NVME_FID_MAX] = {
585388eea45cSKlaus Jensen         [NVME_ARBITRATION] = NVME_ARB_AB_NOLIMIT,
585488eea45cSKlaus Jensen     };
585588eea45cSKlaus Jensen 
585688eea45cSKlaus Jensen     trace_pci_nvme_getfeat(nvme_cid(req), nsid, fid, sel, dw11);
585788eea45cSKlaus Jensen 
585888eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
585988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
586088eea45cSKlaus Jensen     }
586188eea45cSKlaus Jensen 
586288eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
586388eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
586488eea45cSKlaus Jensen             /*
586588eea45cSKlaus Jensen              * The Reservation Notification Mask and Reservation Persistence
586688eea45cSKlaus Jensen              * features require a status code of Invalid Field in Command when
586788eea45cSKlaus Jensen              * NSID is FFFFFFFFh. Since the device does not support those
586888eea45cSKlaus Jensen              * features we can always return Invalid Namespace or Format as we
586988eea45cSKlaus Jensen              * should do for all other features.
587088eea45cSKlaus Jensen              */
587188eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
587288eea45cSKlaus Jensen         }
587388eea45cSKlaus Jensen 
587488eea45cSKlaus Jensen         if (!nvme_ns(n, nsid)) {
587588eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
587688eea45cSKlaus Jensen         }
587788eea45cSKlaus Jensen     }
587888eea45cSKlaus Jensen 
587988eea45cSKlaus Jensen     switch (sel) {
588088eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CURRENT:
588188eea45cSKlaus Jensen         break;
588288eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_SAVED:
588388eea45cSKlaus Jensen         /* no features are saveable by the controller; fallthrough */
588488eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_DEFAULT:
588588eea45cSKlaus Jensen         goto defaults;
588688eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CAP:
588788eea45cSKlaus Jensen         result = nvme_feature_cap[fid];
588888eea45cSKlaus Jensen         goto out;
588988eea45cSKlaus Jensen     }
589088eea45cSKlaus Jensen 
589188eea45cSKlaus Jensen     switch (fid) {
589288eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
589388eea45cSKlaus Jensen         result = 0;
589488eea45cSKlaus Jensen 
589588eea45cSKlaus Jensen         /*
589688eea45cSKlaus Jensen          * The controller only implements the Composite Temperature sensor, so
589788eea45cSKlaus Jensen          * return 0 for all other sensors.
589888eea45cSKlaus Jensen          */
589988eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
590088eea45cSKlaus Jensen             goto out;
590188eea45cSKlaus Jensen         }
590288eea45cSKlaus Jensen 
590388eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
590488eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
590588eea45cSKlaus Jensen             result = n->features.temp_thresh_hi;
590688eea45cSKlaus Jensen             goto out;
590788eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
590888eea45cSKlaus Jensen             result = n->features.temp_thresh_low;
590988eea45cSKlaus Jensen             goto out;
591088eea45cSKlaus Jensen         }
591188eea45cSKlaus Jensen 
591288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
591388eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
591488eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
591588eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
591688eea45cSKlaus Jensen         }
591788eea45cSKlaus Jensen 
591888eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
591988eea45cSKlaus Jensen         if (unlikely(!ns)) {
592088eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
592188eea45cSKlaus Jensen         }
592288eea45cSKlaus Jensen 
592388eea45cSKlaus Jensen         result = ns->features.err_rec;
592488eea45cSKlaus Jensen         goto out;
592588eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
592688eea45cSKlaus Jensen         result = 0;
592788eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
592888eea45cSKlaus Jensen             ns = nvme_ns(n, i);
592988eea45cSKlaus Jensen             if (!ns) {
593088eea45cSKlaus Jensen                 continue;
593188eea45cSKlaus Jensen             }
593288eea45cSKlaus Jensen 
593388eea45cSKlaus Jensen             result = blk_enable_write_cache(ns->blkconf.blk);
593488eea45cSKlaus Jensen             if (result) {
593588eea45cSKlaus Jensen                 break;
593688eea45cSKlaus Jensen             }
593788eea45cSKlaus Jensen         }
593888eea45cSKlaus Jensen         trace_pci_nvme_getfeat_vwcache(result ? "enabled" : "disabled");
593988eea45cSKlaus Jensen         goto out;
594088eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
594188eea45cSKlaus Jensen         result = n->features.async_config;
594288eea45cSKlaus Jensen         goto out;
594388eea45cSKlaus Jensen     case NVME_TIMESTAMP:
594488eea45cSKlaus Jensen         return nvme_get_feature_timestamp(n, req);
5945d0c0697bSNaveen Nagar     case NVME_HOST_BEHAVIOR_SUPPORT:
5946d0c0697bSNaveen Nagar         return nvme_c2h(n, (uint8_t *)&n->features.hbs,
5947d0c0697bSNaveen Nagar                         sizeof(n->features.hbs), req);
594873064edfSJesper Devantier     case NVME_FDP_MODE:
594973064edfSJesper Devantier         endgrpid = dw11 & 0xff;
595073064edfSJesper Devantier 
595173064edfSJesper Devantier         if (endgrpid != 0x1) {
595273064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
595373064edfSJesper Devantier         }
595473064edfSJesper Devantier 
595573064edfSJesper Devantier         ret = nvme_get_feature_fdp(n, endgrpid, &result);
595673064edfSJesper Devantier         if (ret) {
595773064edfSJesper Devantier             return ret;
595873064edfSJesper Devantier         }
595973064edfSJesper Devantier         goto out;
596073064edfSJesper Devantier     case NVME_FDP_EVENTS:
596173064edfSJesper Devantier         if (!nvme_nsid_valid(n, nsid)) {
596273064edfSJesper Devantier             return NVME_INVALID_NSID | NVME_DNR;
596373064edfSJesper Devantier         }
596473064edfSJesper Devantier 
596573064edfSJesper Devantier         ns = nvme_ns(n, nsid);
596673064edfSJesper Devantier         if (unlikely(!ns)) {
596773064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
596873064edfSJesper Devantier         }
596973064edfSJesper Devantier 
597073064edfSJesper Devantier         ret = nvme_get_feature_fdp_events(n, ns, req, &result);
597173064edfSJesper Devantier         if (ret) {
597273064edfSJesper Devantier             return ret;
597373064edfSJesper Devantier         }
597473064edfSJesper Devantier         goto out;
597588eea45cSKlaus Jensen     default:
597688eea45cSKlaus Jensen         break;
597788eea45cSKlaus Jensen     }
597888eea45cSKlaus Jensen 
597988eea45cSKlaus Jensen defaults:
598088eea45cSKlaus Jensen     switch (fid) {
598188eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
598288eea45cSKlaus Jensen         result = 0;
598388eea45cSKlaus Jensen 
598488eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
598588eea45cSKlaus Jensen             break;
598688eea45cSKlaus Jensen         }
598788eea45cSKlaus Jensen 
598888eea45cSKlaus Jensen         if (NVME_TEMP_THSEL(dw11) == NVME_TEMP_THSEL_OVER) {
598988eea45cSKlaus Jensen             result = NVME_TEMPERATURE_WARNING;
599088eea45cSKlaus Jensen         }
599188eea45cSKlaus Jensen 
599288eea45cSKlaus Jensen         break;
599388eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
5994decc0261SŁukasz Gieryk         result = (n->conf_ioqpairs - 1) | ((n->conf_ioqpairs - 1) << 16);
599588eea45cSKlaus Jensen         trace_pci_nvme_getfeat_numq(result);
599688eea45cSKlaus Jensen         break;
599788eea45cSKlaus Jensen     case NVME_INTERRUPT_VECTOR_CONF:
599888eea45cSKlaus Jensen         iv = dw11 & 0xffff;
5999decc0261SŁukasz Gieryk         if (iv >= n->conf_ioqpairs + 1) {
600088eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
600188eea45cSKlaus Jensen         }
600288eea45cSKlaus Jensen 
600388eea45cSKlaus Jensen         result = iv;
600488eea45cSKlaus Jensen         if (iv == n->admin_cq.vector) {
600588eea45cSKlaus Jensen             result |= NVME_INTVC_NOCOALESCING;
600688eea45cSKlaus Jensen         }
600788eea45cSKlaus Jensen         break;
600873064edfSJesper Devantier     case NVME_FDP_MODE:
600973064edfSJesper Devantier         endgrpid = dw11 & 0xff;
601073064edfSJesper Devantier 
601173064edfSJesper Devantier         if (endgrpid != 0x1) {
601273064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
601373064edfSJesper Devantier         }
601473064edfSJesper Devantier 
601573064edfSJesper Devantier         ret = nvme_get_feature_fdp(n, endgrpid, &result);
601673064edfSJesper Devantier         if (ret) {
601773064edfSJesper Devantier             return ret;
601873064edfSJesper Devantier         }
601973064edfSJesper Devantier         goto out;
602073064edfSJesper Devantier 
602173064edfSJesper Devantier         break;
602288eea45cSKlaus Jensen     default:
602388eea45cSKlaus Jensen         result = nvme_feature_default[fid];
602488eea45cSKlaus Jensen         break;
602588eea45cSKlaus Jensen     }
602688eea45cSKlaus Jensen 
602788eea45cSKlaus Jensen out:
602888eea45cSKlaus Jensen     req->cqe.result = cpu_to_le32(result);
602973064edfSJesper Devantier     return ret;
603088eea45cSKlaus Jensen }
603188eea45cSKlaus Jensen 
603288eea45cSKlaus Jensen static uint16_t nvme_set_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
603388eea45cSKlaus Jensen {
603488eea45cSKlaus Jensen     uint16_t ret;
603588eea45cSKlaus Jensen     uint64_t timestamp;
603688eea45cSKlaus Jensen 
603788eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
603888eea45cSKlaus Jensen     if (ret) {
603988eea45cSKlaus Jensen         return ret;
604088eea45cSKlaus Jensen     }
604188eea45cSKlaus Jensen 
604288eea45cSKlaus Jensen     nvme_set_timestamp(n, timestamp);
604388eea45cSKlaus Jensen 
604488eea45cSKlaus Jensen     return NVME_SUCCESS;
604588eea45cSKlaus Jensen }
604688eea45cSKlaus Jensen 
604773064edfSJesper Devantier static uint16_t nvme_set_feature_fdp_events(NvmeCtrl *n, NvmeNamespace *ns,
604873064edfSJesper Devantier                                             NvmeRequest *req)
604973064edfSJesper Devantier {
605073064edfSJesper Devantier     NvmeCmd *cmd = &req->cmd;
605173064edfSJesper Devantier     uint32_t cdw11 = le32_to_cpu(cmd->cdw11);
605273064edfSJesper Devantier     uint16_t ph = cdw11 & 0xffff;
605373064edfSJesper Devantier     uint8_t noet = (cdw11 >> 16) & 0xff;
605473064edfSJesper Devantier     uint16_t ret, ruhid;
605573064edfSJesper Devantier     uint8_t enable = le32_to_cpu(cmd->cdw12) & 0x1;
605673064edfSJesper Devantier     uint8_t event_mask = 0;
605773064edfSJesper Devantier     unsigned int i;
605873064edfSJesper Devantier     g_autofree uint8_t *events = g_malloc0(noet);
605973064edfSJesper Devantier     NvmeRuHandle *ruh = NULL;
606073064edfSJesper Devantier 
606173064edfSJesper Devantier     assert(ns);
606273064edfSJesper Devantier 
606373064edfSJesper Devantier     if (!n->subsys || !n->subsys->endgrp.fdp.enabled) {
606473064edfSJesper Devantier         return NVME_FDP_DISABLED | NVME_DNR;
606573064edfSJesper Devantier     }
606673064edfSJesper Devantier 
606773064edfSJesper Devantier     if (!nvme_ph_valid(ns, ph)) {
606873064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
606973064edfSJesper Devantier     }
607073064edfSJesper Devantier 
607173064edfSJesper Devantier     ruhid = ns->fdp.phs[ph];
607273064edfSJesper Devantier     ruh = &n->subsys->endgrp.fdp.ruhs[ruhid];
607373064edfSJesper Devantier 
607473064edfSJesper Devantier     ret = nvme_h2c(n, events, noet, req);
607573064edfSJesper Devantier     if (ret) {
607673064edfSJesper Devantier         return ret;
607773064edfSJesper Devantier     }
607873064edfSJesper Devantier 
607973064edfSJesper Devantier     for (i = 0; i < noet; i++) {
608073064edfSJesper Devantier         event_mask |= (1 << nvme_fdp_evf_shifts[events[i]]);
608173064edfSJesper Devantier     }
608273064edfSJesper Devantier 
608373064edfSJesper Devantier     if (enable) {
608473064edfSJesper Devantier         ruh->event_filter |= event_mask;
608573064edfSJesper Devantier     } else {
608673064edfSJesper Devantier         ruh->event_filter = ruh->event_filter & ~event_mask;
608773064edfSJesper Devantier     }
608873064edfSJesper Devantier 
608973064edfSJesper Devantier     return NVME_SUCCESS;
609073064edfSJesper Devantier }
609173064edfSJesper Devantier 
609288eea45cSKlaus Jensen static uint16_t nvme_set_feature(NvmeCtrl *n, NvmeRequest *req)
609388eea45cSKlaus Jensen {
609488eea45cSKlaus Jensen     NvmeNamespace *ns = NULL;
609588eea45cSKlaus Jensen 
609688eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
609788eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
609888eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
609988eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
610088eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
610188eea45cSKlaus Jensen     uint8_t save = NVME_SETFEAT_SAVE(dw10);
6102763c05dfSNaveen Nagar     uint16_t status;
610388eea45cSKlaus Jensen     int i;
610488eea45cSKlaus Jensen 
610588eea45cSKlaus Jensen     trace_pci_nvme_setfeat(nvme_cid(req), nsid, fid, save, dw11);
610688eea45cSKlaus Jensen 
610788eea45cSKlaus Jensen     if (save && !(nvme_feature_cap[fid] & NVME_FEAT_CAP_SAVE)) {
610888eea45cSKlaus Jensen         return NVME_FID_NOT_SAVEABLE | NVME_DNR;
610988eea45cSKlaus Jensen     }
611088eea45cSKlaus Jensen 
611188eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
611288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
611388eea45cSKlaus Jensen     }
611488eea45cSKlaus Jensen 
611588eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
611688eea45cSKlaus Jensen         if (nsid != NVME_NSID_BROADCAST) {
611788eea45cSKlaus Jensen             if (!nvme_nsid_valid(n, nsid)) {
611888eea45cSKlaus Jensen                 return NVME_INVALID_NSID | NVME_DNR;
611988eea45cSKlaus Jensen             }
612088eea45cSKlaus Jensen 
612188eea45cSKlaus Jensen             ns = nvme_ns(n, nsid);
612288eea45cSKlaus Jensen             if (unlikely(!ns)) {
612388eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
612488eea45cSKlaus Jensen             }
612588eea45cSKlaus Jensen         }
612688eea45cSKlaus Jensen     } else if (nsid && nsid != NVME_NSID_BROADCAST) {
612788eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
612888eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
612988eea45cSKlaus Jensen         }
613088eea45cSKlaus Jensen 
613188eea45cSKlaus Jensen         return NVME_FEAT_NOT_NS_SPEC | NVME_DNR;
613288eea45cSKlaus Jensen     }
613388eea45cSKlaus Jensen 
613488eea45cSKlaus Jensen     if (!(nvme_feature_cap[fid] & NVME_FEAT_CAP_CHANGE)) {
613588eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
613688eea45cSKlaus Jensen     }
613788eea45cSKlaus Jensen 
613888eea45cSKlaus Jensen     switch (fid) {
613988eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
614088eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
614188eea45cSKlaus Jensen             break;
614288eea45cSKlaus Jensen         }
614388eea45cSKlaus Jensen 
614488eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
614588eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
614688eea45cSKlaus Jensen             n->features.temp_thresh_hi = NVME_TEMP_TMPTH(dw11);
614788eea45cSKlaus Jensen             break;
614888eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
614988eea45cSKlaus Jensen             n->features.temp_thresh_low = NVME_TEMP_TMPTH(dw11);
615088eea45cSKlaus Jensen             break;
615188eea45cSKlaus Jensen         default:
615288eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
615388eea45cSKlaus Jensen         }
615488eea45cSKlaus Jensen 
615588eea45cSKlaus Jensen         if ((n->temperature >= n->features.temp_thresh_hi) ||
615688eea45cSKlaus Jensen             (n->temperature <= n->features.temp_thresh_low)) {
61579235a72aSKlaus Jensen             nvme_smart_event(n, NVME_SMART_TEMPERATURE);
615888eea45cSKlaus Jensen         }
615988eea45cSKlaus Jensen 
616088eea45cSKlaus Jensen         break;
616188eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
616288eea45cSKlaus Jensen         if (nsid == NVME_NSID_BROADCAST) {
616388eea45cSKlaus Jensen             for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
616488eea45cSKlaus Jensen                 ns = nvme_ns(n, i);
616588eea45cSKlaus Jensen 
616688eea45cSKlaus Jensen                 if (!ns) {
616788eea45cSKlaus Jensen                     continue;
616888eea45cSKlaus Jensen                 }
616988eea45cSKlaus Jensen 
617088eea45cSKlaus Jensen                 if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat)) {
617188eea45cSKlaus Jensen                     ns->features.err_rec = dw11;
617288eea45cSKlaus Jensen                 }
617388eea45cSKlaus Jensen             }
617488eea45cSKlaus Jensen 
617588eea45cSKlaus Jensen             break;
617688eea45cSKlaus Jensen         }
617788eea45cSKlaus Jensen 
617888eea45cSKlaus Jensen         assert(ns);
617988eea45cSKlaus Jensen         if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat))  {
618088eea45cSKlaus Jensen             ns->features.err_rec = dw11;
618188eea45cSKlaus Jensen         }
618288eea45cSKlaus Jensen         break;
618388eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
618488eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
618588eea45cSKlaus Jensen             ns = nvme_ns(n, i);
618688eea45cSKlaus Jensen             if (!ns) {
618788eea45cSKlaus Jensen                 continue;
618888eea45cSKlaus Jensen             }
618988eea45cSKlaus Jensen 
619088eea45cSKlaus Jensen             if (!(dw11 & 0x1) && blk_enable_write_cache(ns->blkconf.blk)) {
619188eea45cSKlaus Jensen                 blk_flush(ns->blkconf.blk);
619288eea45cSKlaus Jensen             }
619388eea45cSKlaus Jensen 
619488eea45cSKlaus Jensen             blk_set_enable_write_cache(ns->blkconf.blk, dw11 & 1);
619588eea45cSKlaus Jensen         }
619688eea45cSKlaus Jensen 
619788eea45cSKlaus Jensen         break;
619888eea45cSKlaus Jensen 
619988eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
620088eea45cSKlaus Jensen         if (n->qs_created) {
620188eea45cSKlaus Jensen             return NVME_CMD_SEQ_ERROR | NVME_DNR;
620288eea45cSKlaus Jensen         }
620388eea45cSKlaus Jensen 
620488eea45cSKlaus Jensen         /*
620588eea45cSKlaus Jensen          * NVMe v1.3, Section 5.21.1.7: FFFFh is not an allowed value for NCQR
620688eea45cSKlaus Jensen          * and NSQR.
620788eea45cSKlaus Jensen          */
620888eea45cSKlaus Jensen         if ((dw11 & 0xffff) == 0xffff || ((dw11 >> 16) & 0xffff) == 0xffff) {
620988eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
621088eea45cSKlaus Jensen         }
621188eea45cSKlaus Jensen 
621288eea45cSKlaus Jensen         trace_pci_nvme_setfeat_numq((dw11 & 0xffff) + 1,
621388eea45cSKlaus Jensen                                     ((dw11 >> 16) & 0xffff) + 1,
6214decc0261SŁukasz Gieryk                                     n->conf_ioqpairs,
6215decc0261SŁukasz Gieryk                                     n->conf_ioqpairs);
6216decc0261SŁukasz Gieryk         req->cqe.result = cpu_to_le32((n->conf_ioqpairs - 1) |
6217decc0261SŁukasz Gieryk                                       ((n->conf_ioqpairs - 1) << 16));
621888eea45cSKlaus Jensen         break;
621988eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
622088eea45cSKlaus Jensen         n->features.async_config = dw11;
622188eea45cSKlaus Jensen         break;
622288eea45cSKlaus Jensen     case NVME_TIMESTAMP:
622388eea45cSKlaus Jensen         return nvme_set_feature_timestamp(n, req);
6224d0c0697bSNaveen Nagar     case NVME_HOST_BEHAVIOR_SUPPORT:
6225763c05dfSNaveen Nagar         status = nvme_h2c(n, (uint8_t *)&n->features.hbs,
6226d0c0697bSNaveen Nagar                           sizeof(n->features.hbs), req);
6227763c05dfSNaveen Nagar         if (status) {
6228763c05dfSNaveen Nagar             return status;
6229763c05dfSNaveen Nagar         }
6230763c05dfSNaveen Nagar 
6231763c05dfSNaveen Nagar         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
6232763c05dfSNaveen Nagar             ns = nvme_ns(n, i);
6233763c05dfSNaveen Nagar 
6234763c05dfSNaveen Nagar             if (!ns) {
6235763c05dfSNaveen Nagar                 continue;
6236763c05dfSNaveen Nagar             }
6237763c05dfSNaveen Nagar 
6238763c05dfSNaveen Nagar             ns->id_ns.nlbaf = ns->nlbaf - 1;
6239763c05dfSNaveen Nagar             if (!n->features.hbs.lbafee) {
6240763c05dfSNaveen Nagar                 ns->id_ns.nlbaf = MIN(ns->id_ns.nlbaf, 15);
6241763c05dfSNaveen Nagar             }
6242763c05dfSNaveen Nagar         }
6243763c05dfSNaveen Nagar 
6244763c05dfSNaveen Nagar         return status;
624588eea45cSKlaus Jensen     case NVME_COMMAND_SET_PROFILE:
624688eea45cSKlaus Jensen         if (dw11 & 0x1ff) {
624788eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_iocsci(dw11 & 0x1ff);
624888eea45cSKlaus Jensen             return NVME_CMD_SET_CMB_REJECTED | NVME_DNR;
624988eea45cSKlaus Jensen         }
625088eea45cSKlaus Jensen         break;
625173064edfSJesper Devantier     case NVME_FDP_MODE:
625273064edfSJesper Devantier         /* spec: abort with cmd seq err if there's one or more NS' in endgrp */
625373064edfSJesper Devantier         return NVME_CMD_SEQ_ERROR | NVME_DNR;
625473064edfSJesper Devantier     case NVME_FDP_EVENTS:
625573064edfSJesper Devantier         return nvme_set_feature_fdp_events(n, ns, req);
625688eea45cSKlaus Jensen     default:
625788eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
625888eea45cSKlaus Jensen     }
625988eea45cSKlaus Jensen     return NVME_SUCCESS;
626088eea45cSKlaus Jensen }
626188eea45cSKlaus Jensen 
626288eea45cSKlaus Jensen static uint16_t nvme_aer(NvmeCtrl *n, NvmeRequest *req)
626388eea45cSKlaus Jensen {
626488eea45cSKlaus Jensen     trace_pci_nvme_aer(nvme_cid(req));
626588eea45cSKlaus Jensen 
626688eea45cSKlaus Jensen     if (n->outstanding_aers > n->params.aerl) {
626788eea45cSKlaus Jensen         trace_pci_nvme_aer_aerl_exceeded();
626888eea45cSKlaus Jensen         return NVME_AER_LIMIT_EXCEEDED;
626988eea45cSKlaus Jensen     }
627088eea45cSKlaus Jensen 
627188eea45cSKlaus Jensen     n->aer_reqs[n->outstanding_aers] = req;
627288eea45cSKlaus Jensen     n->outstanding_aers++;
627388eea45cSKlaus Jensen 
627488eea45cSKlaus Jensen     if (!QTAILQ_EMPTY(&n->aer_queue)) {
627588eea45cSKlaus Jensen         nvme_process_aers(n);
627688eea45cSKlaus Jensen     }
627788eea45cSKlaus Jensen 
627888eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
627988eea45cSKlaus Jensen }
628088eea45cSKlaus Jensen 
628188eea45cSKlaus Jensen static void nvme_update_dmrsl(NvmeCtrl *n)
628288eea45cSKlaus Jensen {
628388eea45cSKlaus Jensen     int nsid;
628488eea45cSKlaus Jensen 
628588eea45cSKlaus Jensen     for (nsid = 1; nsid <= NVME_MAX_NAMESPACES; nsid++) {
628688eea45cSKlaus Jensen         NvmeNamespace *ns = nvme_ns(n, nsid);
628788eea45cSKlaus Jensen         if (!ns) {
628888eea45cSKlaus Jensen             continue;
628988eea45cSKlaus Jensen         }
629088eea45cSKlaus Jensen 
629188eea45cSKlaus Jensen         n->dmrsl = MIN_NON_ZERO(n->dmrsl,
629288eea45cSKlaus Jensen                                 BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
629388eea45cSKlaus Jensen     }
629488eea45cSKlaus Jensen }
629588eea45cSKlaus Jensen 
629688eea45cSKlaus Jensen static void nvme_select_iocs_ns(NvmeCtrl *n, NvmeNamespace *ns)
629788eea45cSKlaus Jensen {
629849e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
629949e03457SKlaus Jensen 
630088eea45cSKlaus Jensen     ns->iocs = nvme_cse_iocs_none;
630188eea45cSKlaus Jensen     switch (ns->csi) {
630288eea45cSKlaus Jensen     case NVME_CSI_NVM:
630349e03457SKlaus Jensen         if (NVME_CC_CSS(cc) != NVME_CC_CSS_ADMIN_ONLY) {
630488eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
630588eea45cSKlaus Jensen         }
630688eea45cSKlaus Jensen         break;
630788eea45cSKlaus Jensen     case NVME_CSI_ZONED:
630849e03457SKlaus Jensen         if (NVME_CC_CSS(cc) == NVME_CC_CSS_CSI) {
630988eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_zoned;
631049e03457SKlaus Jensen         } else if (NVME_CC_CSS(cc) == NVME_CC_CSS_NVM) {
631188eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
631288eea45cSKlaus Jensen         }
631388eea45cSKlaus Jensen         break;
631488eea45cSKlaus Jensen     }
631588eea45cSKlaus Jensen }
631688eea45cSKlaus Jensen 
631788eea45cSKlaus Jensen static uint16_t nvme_ns_attachment(NvmeCtrl *n, NvmeRequest *req)
631888eea45cSKlaus Jensen {
631988eea45cSKlaus Jensen     NvmeNamespace *ns;
632088eea45cSKlaus Jensen     NvmeCtrl *ctrl;
632188eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
632288eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
632388eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
632407a3dfa7SNaveen Nagar     uint8_t sel = dw10 & 0xf;
632588eea45cSKlaus Jensen     uint16_t *nr_ids = &list[0];
632688eea45cSKlaus Jensen     uint16_t *ids = &list[1];
632788eea45cSKlaus Jensen     uint16_t ret;
632888eea45cSKlaus Jensen     int i;
632988eea45cSKlaus Jensen 
633088eea45cSKlaus Jensen     trace_pci_nvme_ns_attachment(nvme_cid(req), dw10 & 0xf);
633188eea45cSKlaus Jensen 
633288eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid)) {
633388eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
633488eea45cSKlaus Jensen     }
633588eea45cSKlaus Jensen 
633688eea45cSKlaus Jensen     ns = nvme_subsys_ns(n->subsys, nsid);
633788eea45cSKlaus Jensen     if (!ns) {
633888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
633988eea45cSKlaus Jensen     }
634088eea45cSKlaus Jensen 
634188eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)list, 4096, req);
634288eea45cSKlaus Jensen     if (ret) {
634388eea45cSKlaus Jensen         return ret;
634488eea45cSKlaus Jensen     }
634588eea45cSKlaus Jensen 
634688eea45cSKlaus Jensen     if (!*nr_ids) {
634788eea45cSKlaus Jensen         return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
634888eea45cSKlaus Jensen     }
634988eea45cSKlaus Jensen 
635088eea45cSKlaus Jensen     *nr_ids = MIN(*nr_ids, NVME_CONTROLLER_LIST_SIZE - 1);
635188eea45cSKlaus Jensen     for (i = 0; i < *nr_ids; i++) {
635288eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, ids[i]);
635388eea45cSKlaus Jensen         if (!ctrl) {
635488eea45cSKlaus Jensen             return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
635588eea45cSKlaus Jensen         }
635688eea45cSKlaus Jensen 
635707a3dfa7SNaveen Nagar         switch (sel) {
635807a3dfa7SNaveen Nagar         case NVME_NS_ATTACHMENT_ATTACH:
635988eea45cSKlaus Jensen             if (nvme_ns(ctrl, nsid)) {
636088eea45cSKlaus Jensen                 return NVME_NS_ALREADY_ATTACHED | NVME_DNR;
636188eea45cSKlaus Jensen             }
636288eea45cSKlaus Jensen 
636388eea45cSKlaus Jensen             if (ns->attached && !ns->params.shared) {
636488eea45cSKlaus Jensen                 return NVME_NS_PRIVATE | NVME_DNR;
636588eea45cSKlaus Jensen             }
636688eea45cSKlaus Jensen 
636788eea45cSKlaus Jensen             nvme_attach_ns(ctrl, ns);
636888eea45cSKlaus Jensen             nvme_select_iocs_ns(ctrl, ns);
636907a3dfa7SNaveen Nagar 
637007a3dfa7SNaveen Nagar             break;
637107a3dfa7SNaveen Nagar 
637207a3dfa7SNaveen Nagar         case NVME_NS_ATTACHMENT_DETACH:
637388eea45cSKlaus Jensen             if (!nvme_ns(ctrl, nsid)) {
637488eea45cSKlaus Jensen                 return NVME_NS_NOT_ATTACHED | NVME_DNR;
637588eea45cSKlaus Jensen             }
637688eea45cSKlaus Jensen 
637788eea45cSKlaus Jensen             ctrl->namespaces[nsid] = NULL;
637888eea45cSKlaus Jensen             ns->attached--;
637988eea45cSKlaus Jensen 
638088eea45cSKlaus Jensen             nvme_update_dmrsl(ctrl);
638107a3dfa7SNaveen Nagar 
638207a3dfa7SNaveen Nagar             break;
638307a3dfa7SNaveen Nagar 
638407a3dfa7SNaveen Nagar         default:
638507a3dfa7SNaveen Nagar             return NVME_INVALID_FIELD | NVME_DNR;
638688eea45cSKlaus Jensen         }
638788eea45cSKlaus Jensen 
638888eea45cSKlaus Jensen         /*
638988eea45cSKlaus Jensen          * Add namespace id to the changed namespace id list for event clearing
639088eea45cSKlaus Jensen          * via Get Log Page command.
639188eea45cSKlaus Jensen          */
639288eea45cSKlaus Jensen         if (!test_and_set_bit(nsid, ctrl->changed_nsids)) {
639388eea45cSKlaus Jensen             nvme_enqueue_event(ctrl, NVME_AER_TYPE_NOTICE,
639488eea45cSKlaus Jensen                                NVME_AER_INFO_NOTICE_NS_ATTR_CHANGED,
639588eea45cSKlaus Jensen                                NVME_LOG_CHANGED_NSLIST);
639688eea45cSKlaus Jensen         }
639788eea45cSKlaus Jensen     }
639888eea45cSKlaus Jensen 
639988eea45cSKlaus Jensen     return NVME_SUCCESS;
640088eea45cSKlaus Jensen }
640188eea45cSKlaus Jensen 
64023bcf26d3SKlaus Jensen typedef struct NvmeFormatAIOCB {
64033bcf26d3SKlaus Jensen     BlockAIOCB common;
64043bcf26d3SKlaus Jensen     BlockAIOCB *aiocb;
64053bcf26d3SKlaus Jensen     NvmeRequest *req;
64063bcf26d3SKlaus Jensen     int ret;
640788eea45cSKlaus Jensen 
64083bcf26d3SKlaus Jensen     NvmeNamespace *ns;
64093bcf26d3SKlaus Jensen     uint32_t nsid;
64103bcf26d3SKlaus Jensen     bool broadcast;
64113bcf26d3SKlaus Jensen     int64_t offset;
6412a6de6ed5SKlaus Jensen 
6413a6de6ed5SKlaus Jensen     uint8_t lbaf;
6414a6de6ed5SKlaus Jensen     uint8_t mset;
6415a6de6ed5SKlaus Jensen     uint8_t pi;
6416a6de6ed5SKlaus Jensen     uint8_t pil;
64173bcf26d3SKlaus Jensen } NvmeFormatAIOCB;
64183bcf26d3SKlaus Jensen 
64193bcf26d3SKlaus Jensen static void nvme_format_cancel(BlockAIOCB *aiocb)
64203bcf26d3SKlaus Jensen {
64213bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = container_of(aiocb, NvmeFormatAIOCB, common);
64223bcf26d3SKlaus Jensen 
6423433c71e4SKlaus Jensen     iocb->ret = -ECANCELED;
6424433c71e4SKlaus Jensen 
64253bcf26d3SKlaus Jensen     if (iocb->aiocb) {
64263bcf26d3SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
6427433c71e4SKlaus Jensen         iocb->aiocb = NULL;
64283bcf26d3SKlaus Jensen     }
64293bcf26d3SKlaus Jensen }
64303bcf26d3SKlaus Jensen 
64313bcf26d3SKlaus Jensen static const AIOCBInfo nvme_format_aiocb_info = {
64323bcf26d3SKlaus Jensen     .aiocb_size = sizeof(NvmeFormatAIOCB),
64333bcf26d3SKlaus Jensen     .cancel_async = nvme_format_cancel,
64343bcf26d3SKlaus Jensen     .get_aio_context = nvme_get_aio_context,
64353bcf26d3SKlaus Jensen };
64363bcf26d3SKlaus Jensen 
6437a6de6ed5SKlaus Jensen static void nvme_format_set(NvmeNamespace *ns, uint8_t lbaf, uint8_t mset,
6438a6de6ed5SKlaus Jensen                             uint8_t pi, uint8_t pil)
64393bcf26d3SKlaus Jensen {
6440763c05dfSNaveen Nagar     uint8_t lbafl = lbaf & 0xf;
6441763c05dfSNaveen Nagar     uint8_t lbafu = lbaf >> 4;
6442763c05dfSNaveen Nagar 
64433bcf26d3SKlaus Jensen     trace_pci_nvme_format_set(ns->params.nsid, lbaf, mset, pi, pil);
64443bcf26d3SKlaus Jensen 
64453bcf26d3SKlaus Jensen     ns->id_ns.dps = (pil << 3) | pi;
6446763c05dfSNaveen Nagar     ns->id_ns.flbas = (lbafu << 5) | (mset << 4) | lbafl;
64473bcf26d3SKlaus Jensen 
64483bcf26d3SKlaus Jensen     nvme_ns_init_format(ns);
64493bcf26d3SKlaus Jensen }
64503bcf26d3SKlaus Jensen 
6451433c71e4SKlaus Jensen static void nvme_do_format(NvmeFormatAIOCB *iocb);
6452433c71e4SKlaus Jensen 
64533bcf26d3SKlaus Jensen static void nvme_format_ns_cb(void *opaque, int ret)
64543bcf26d3SKlaus Jensen {
64553bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = opaque;
64563bcf26d3SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
64573bcf26d3SKlaus Jensen     int bytes;
64583bcf26d3SKlaus Jensen 
6459433c71e4SKlaus Jensen     if (iocb->ret < 0) {
6460433c71e4SKlaus Jensen         goto done;
6461433c71e4SKlaus Jensen     } else if (ret < 0) {
64623bcf26d3SKlaus Jensen         iocb->ret = ret;
64633bcf26d3SKlaus Jensen         goto done;
64643bcf26d3SKlaus Jensen     }
64653bcf26d3SKlaus Jensen 
64663bcf26d3SKlaus Jensen     assert(ns);
64673bcf26d3SKlaus Jensen 
64683bcf26d3SKlaus Jensen     if (iocb->offset < ns->size) {
64693bcf26d3SKlaus Jensen         bytes = MIN(BDRV_REQUEST_MAX_BYTES, ns->size - iocb->offset);
64703bcf26d3SKlaus Jensen 
64713bcf26d3SKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, iocb->offset,
64723bcf26d3SKlaus Jensen                                             bytes, BDRV_REQ_MAY_UNMAP,
64733bcf26d3SKlaus Jensen                                             nvme_format_ns_cb, iocb);
64743bcf26d3SKlaus Jensen 
64753bcf26d3SKlaus Jensen         iocb->offset += bytes;
64763bcf26d3SKlaus Jensen         return;
64773bcf26d3SKlaus Jensen     }
64783bcf26d3SKlaus Jensen 
6479a6de6ed5SKlaus Jensen     nvme_format_set(ns, iocb->lbaf, iocb->mset, iocb->pi, iocb->pil);
64803bcf26d3SKlaus Jensen     ns->status = 0x0;
64813bcf26d3SKlaus Jensen     iocb->ns = NULL;
64823bcf26d3SKlaus Jensen     iocb->offset = 0;
64833bcf26d3SKlaus Jensen 
64843bcf26d3SKlaus Jensen done:
6485433c71e4SKlaus Jensen     nvme_do_format(iocb);
64863bcf26d3SKlaus Jensen }
64873bcf26d3SKlaus Jensen 
64883bcf26d3SKlaus Jensen static uint16_t nvme_format_check(NvmeNamespace *ns, uint8_t lbaf, uint8_t pi)
64893bcf26d3SKlaus Jensen {
649088eea45cSKlaus Jensen     if (ns->params.zoned) {
649188eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
649288eea45cSKlaus Jensen     }
649388eea45cSKlaus Jensen 
649488eea45cSKlaus Jensen     if (lbaf > ns->id_ns.nlbaf) {
649588eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
649688eea45cSKlaus Jensen     }
649788eea45cSKlaus Jensen 
6498ac0b34c5SKlaus Jensen     if (pi && (ns->id_ns.lbaf[lbaf].ms < nvme_pi_tuple_size(ns))) {
649988eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
650088eea45cSKlaus Jensen     }
650188eea45cSKlaus Jensen 
650288eea45cSKlaus Jensen     if (pi && pi > NVME_ID_NS_DPS_TYPE_3) {
650388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
650488eea45cSKlaus Jensen     }
650588eea45cSKlaus Jensen 
650688eea45cSKlaus Jensen     return NVME_SUCCESS;
650788eea45cSKlaus Jensen }
650888eea45cSKlaus Jensen 
6509433c71e4SKlaus Jensen static void nvme_do_format(NvmeFormatAIOCB *iocb)
651088eea45cSKlaus Jensen {
65113bcf26d3SKlaus Jensen     NvmeRequest *req = iocb->req;
65123bcf26d3SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
651344219b60SNaveen Nagar     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
651444219b60SNaveen Nagar     uint8_t lbaf = dw10 & 0xf;
651544219b60SNaveen Nagar     uint8_t pi = (dw10 >> 5) & 0x7;
651688eea45cSKlaus Jensen     uint16_t status;
651788eea45cSKlaus Jensen     int i;
651888eea45cSKlaus Jensen 
65193bcf26d3SKlaus Jensen     if (iocb->ret < 0) {
65203bcf26d3SKlaus Jensen         goto done;
652188eea45cSKlaus Jensen     }
652288eea45cSKlaus Jensen 
65233bcf26d3SKlaus Jensen     if (iocb->broadcast) {
65243bcf26d3SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
65253bcf26d3SKlaus Jensen             iocb->ns = nvme_ns(n, i);
65263bcf26d3SKlaus Jensen             if (iocb->ns) {
65273bcf26d3SKlaus Jensen                 iocb->nsid = i;
652888eea45cSKlaus Jensen                 break;
652988eea45cSKlaus Jensen             }
653088eea45cSKlaus Jensen         }
653188eea45cSKlaus Jensen     }
653288eea45cSKlaus Jensen 
65333bcf26d3SKlaus Jensen     if (!iocb->ns) {
65343bcf26d3SKlaus Jensen         goto done;
653588eea45cSKlaus Jensen     }
653688eea45cSKlaus Jensen 
653744219b60SNaveen Nagar     status = nvme_format_check(iocb->ns, lbaf, pi);
65383bcf26d3SKlaus Jensen     if (status) {
65393bcf26d3SKlaus Jensen         req->status = status;
65403bcf26d3SKlaus Jensen         goto done;
65413bcf26d3SKlaus Jensen     }
65423bcf26d3SKlaus Jensen 
65433bcf26d3SKlaus Jensen     iocb->ns->status = NVME_FORMAT_IN_PROGRESS;
65443bcf26d3SKlaus Jensen     nvme_format_ns_cb(iocb, 0);
65453bcf26d3SKlaus Jensen     return;
65463bcf26d3SKlaus Jensen 
65473bcf26d3SKlaus Jensen done:
65483bcf26d3SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
65493bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
65503bcf26d3SKlaus Jensen }
65513bcf26d3SKlaus Jensen 
65523bcf26d3SKlaus Jensen static uint16_t nvme_format(NvmeCtrl *n, NvmeRequest *req)
65533bcf26d3SKlaus Jensen {
65543bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb;
65553bcf26d3SKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
6556a6de6ed5SKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
6557a6de6ed5SKlaus Jensen     uint8_t lbaf = dw10 & 0xf;
6558a6de6ed5SKlaus Jensen     uint8_t mset = (dw10 >> 4) & 0x1;
6559a6de6ed5SKlaus Jensen     uint8_t pi = (dw10 >> 5) & 0x7;
6560a6de6ed5SKlaus Jensen     uint8_t pil = (dw10 >> 8) & 0x1;
6561763c05dfSNaveen Nagar     uint8_t lbafu = (dw10 >> 12) & 0x3;
65623bcf26d3SKlaus Jensen     uint16_t status;
65633bcf26d3SKlaus Jensen 
65643bcf26d3SKlaus Jensen     iocb = qemu_aio_get(&nvme_format_aiocb_info, NULL, nvme_misc_cb, req);
65653bcf26d3SKlaus Jensen 
65663bcf26d3SKlaus Jensen     iocb->req = req;
65673bcf26d3SKlaus Jensen     iocb->ret = 0;
65683bcf26d3SKlaus Jensen     iocb->ns = NULL;
65693bcf26d3SKlaus Jensen     iocb->nsid = 0;
6570a6de6ed5SKlaus Jensen     iocb->lbaf = lbaf;
6571a6de6ed5SKlaus Jensen     iocb->mset = mset;
6572a6de6ed5SKlaus Jensen     iocb->pi = pi;
6573a6de6ed5SKlaus Jensen     iocb->pil = pil;
65743bcf26d3SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
65753bcf26d3SKlaus Jensen     iocb->offset = 0;
65763bcf26d3SKlaus Jensen 
6577763c05dfSNaveen Nagar     if (n->features.hbs.lbafee) {
6578763c05dfSNaveen Nagar         iocb->lbaf |= lbafu << 4;
6579763c05dfSNaveen Nagar     }
6580763c05dfSNaveen Nagar 
65813bcf26d3SKlaus Jensen     if (!iocb->broadcast) {
65823bcf26d3SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
65833bcf26d3SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
65843bcf26d3SKlaus Jensen             goto out;
65853bcf26d3SKlaus Jensen         }
65863bcf26d3SKlaus Jensen 
65873bcf26d3SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
65883bcf26d3SKlaus Jensen         if (!iocb->ns) {
65893bcf26d3SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
65903bcf26d3SKlaus Jensen             goto out;
65913bcf26d3SKlaus Jensen         }
65923bcf26d3SKlaus Jensen     }
65933bcf26d3SKlaus Jensen 
65943bcf26d3SKlaus Jensen     req->aiocb = &iocb->common;
6595433c71e4SKlaus Jensen     nvme_do_format(iocb);
65963bcf26d3SKlaus Jensen 
65973bcf26d3SKlaus Jensen     return NVME_NO_COMPLETE;
65983bcf26d3SKlaus Jensen 
65993bcf26d3SKlaus Jensen out:
66003bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
6601433c71e4SKlaus Jensen 
66023bcf26d3SKlaus Jensen     return status;
660388eea45cSKlaus Jensen }
660488eea45cSKlaus Jensen 
660511871f53SŁukasz Gieryk static void nvme_get_virt_res_num(NvmeCtrl *n, uint8_t rt, int *num_total,
660611871f53SŁukasz Gieryk                                   int *num_prim, int *num_sec)
660711871f53SŁukasz Gieryk {
660811871f53SŁukasz Gieryk     *num_total = le32_to_cpu(rt ?
660911871f53SŁukasz Gieryk                              n->pri_ctrl_cap.vifrt : n->pri_ctrl_cap.vqfrt);
661011871f53SŁukasz Gieryk     *num_prim = le16_to_cpu(rt ?
661111871f53SŁukasz Gieryk                             n->pri_ctrl_cap.virfap : n->pri_ctrl_cap.vqrfap);
661211871f53SŁukasz Gieryk     *num_sec = le16_to_cpu(rt ? n->pri_ctrl_cap.virfa : n->pri_ctrl_cap.vqrfa);
661311871f53SŁukasz Gieryk }
661411871f53SŁukasz Gieryk 
661511871f53SŁukasz Gieryk static uint16_t nvme_assign_virt_res_to_prim(NvmeCtrl *n, NvmeRequest *req,
661611871f53SŁukasz Gieryk                                              uint16_t cntlid, uint8_t rt,
661711871f53SŁukasz Gieryk                                              int nr)
661811871f53SŁukasz Gieryk {
661911871f53SŁukasz Gieryk     int num_total, num_prim, num_sec;
662011871f53SŁukasz Gieryk 
662111871f53SŁukasz Gieryk     if (cntlid != n->cntlid) {
662211871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
662311871f53SŁukasz Gieryk     }
662411871f53SŁukasz Gieryk 
662511871f53SŁukasz Gieryk     nvme_get_virt_res_num(n, rt, &num_total, &num_prim, &num_sec);
662611871f53SŁukasz Gieryk 
662711871f53SŁukasz Gieryk     if (nr > num_total) {
662811871f53SŁukasz Gieryk         return NVME_INVALID_NUM_RESOURCES | NVME_DNR;
662911871f53SŁukasz Gieryk     }
663011871f53SŁukasz Gieryk 
663111871f53SŁukasz Gieryk     if (nr > num_total - num_sec) {
663211871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
663311871f53SŁukasz Gieryk     }
663411871f53SŁukasz Gieryk 
663511871f53SŁukasz Gieryk     if (rt) {
663611871f53SŁukasz Gieryk         n->next_pri_ctrl_cap.virfap = cpu_to_le16(nr);
663711871f53SŁukasz Gieryk     } else {
663811871f53SŁukasz Gieryk         n->next_pri_ctrl_cap.vqrfap = cpu_to_le16(nr);
663911871f53SŁukasz Gieryk     }
664011871f53SŁukasz Gieryk 
664111871f53SŁukasz Gieryk     req->cqe.result = cpu_to_le32(nr);
664211871f53SŁukasz Gieryk     return req->status;
664311871f53SŁukasz Gieryk }
664411871f53SŁukasz Gieryk 
664511871f53SŁukasz Gieryk static void nvme_update_virt_res(NvmeCtrl *n, NvmeSecCtrlEntry *sctrl,
664611871f53SŁukasz Gieryk                                  uint8_t rt, int nr)
664711871f53SŁukasz Gieryk {
664811871f53SŁukasz Gieryk     int prev_nr, prev_total;
664911871f53SŁukasz Gieryk 
665011871f53SŁukasz Gieryk     if (rt) {
665111871f53SŁukasz Gieryk         prev_nr = le16_to_cpu(sctrl->nvi);
665211871f53SŁukasz Gieryk         prev_total = le32_to_cpu(n->pri_ctrl_cap.virfa);
665311871f53SŁukasz Gieryk         sctrl->nvi = cpu_to_le16(nr);
665411871f53SŁukasz Gieryk         n->pri_ctrl_cap.virfa = cpu_to_le32(prev_total + nr - prev_nr);
665511871f53SŁukasz Gieryk     } else {
665611871f53SŁukasz Gieryk         prev_nr = le16_to_cpu(sctrl->nvq);
665711871f53SŁukasz Gieryk         prev_total = le32_to_cpu(n->pri_ctrl_cap.vqrfa);
665811871f53SŁukasz Gieryk         sctrl->nvq = cpu_to_le16(nr);
665911871f53SŁukasz Gieryk         n->pri_ctrl_cap.vqrfa = cpu_to_le32(prev_total + nr - prev_nr);
666011871f53SŁukasz Gieryk     }
666111871f53SŁukasz Gieryk }
666211871f53SŁukasz Gieryk 
666311871f53SŁukasz Gieryk static uint16_t nvme_assign_virt_res_to_sec(NvmeCtrl *n, NvmeRequest *req,
666411871f53SŁukasz Gieryk                                             uint16_t cntlid, uint8_t rt, int nr)
666511871f53SŁukasz Gieryk {
666611871f53SŁukasz Gieryk     int num_total, num_prim, num_sec, num_free, diff, limit;
666711871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
666811871f53SŁukasz Gieryk 
666911871f53SŁukasz Gieryk     sctrl = nvme_sctrl_for_cntlid(n, cntlid);
667011871f53SŁukasz Gieryk     if (!sctrl) {
667111871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
667211871f53SŁukasz Gieryk     }
667311871f53SŁukasz Gieryk 
667411871f53SŁukasz Gieryk     if (sctrl->scs) {
667511871f53SŁukasz Gieryk         return NVME_INVALID_SEC_CTRL_STATE | NVME_DNR;
667611871f53SŁukasz Gieryk     }
667711871f53SŁukasz Gieryk 
667811871f53SŁukasz Gieryk     limit = le16_to_cpu(rt ? n->pri_ctrl_cap.vifrsm : n->pri_ctrl_cap.vqfrsm);
667911871f53SŁukasz Gieryk     if (nr > limit) {
668011871f53SŁukasz Gieryk         return NVME_INVALID_NUM_RESOURCES | NVME_DNR;
668111871f53SŁukasz Gieryk     }
668211871f53SŁukasz Gieryk 
668311871f53SŁukasz Gieryk     nvme_get_virt_res_num(n, rt, &num_total, &num_prim, &num_sec);
668411871f53SŁukasz Gieryk     num_free = num_total - num_prim - num_sec;
668511871f53SŁukasz Gieryk     diff = nr - le16_to_cpu(rt ? sctrl->nvi : sctrl->nvq);
668611871f53SŁukasz Gieryk 
668711871f53SŁukasz Gieryk     if (diff > num_free) {
668811871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
668911871f53SŁukasz Gieryk     }
669011871f53SŁukasz Gieryk 
669111871f53SŁukasz Gieryk     nvme_update_virt_res(n, sctrl, rt, nr);
669211871f53SŁukasz Gieryk     req->cqe.result = cpu_to_le32(nr);
669311871f53SŁukasz Gieryk 
669411871f53SŁukasz Gieryk     return req->status;
669511871f53SŁukasz Gieryk }
669611871f53SŁukasz Gieryk 
669711871f53SŁukasz Gieryk static uint16_t nvme_virt_set_state(NvmeCtrl *n, uint16_t cntlid, bool online)
669811871f53SŁukasz Gieryk {
669948b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
670011871f53SŁukasz Gieryk     NvmeCtrl *sn = NULL;
670111871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
670211871f53SŁukasz Gieryk     int vf_index;
670311871f53SŁukasz Gieryk 
670411871f53SŁukasz Gieryk     sctrl = nvme_sctrl_for_cntlid(n, cntlid);
670511871f53SŁukasz Gieryk     if (!sctrl) {
670611871f53SŁukasz Gieryk         return NVME_INVALID_CTRL_ID | NVME_DNR;
670711871f53SŁukasz Gieryk     }
670811871f53SŁukasz Gieryk 
670948b32c28SKlaus Jensen     if (!pci_is_vf(pci)) {
671011871f53SŁukasz Gieryk         vf_index = le16_to_cpu(sctrl->vfn) - 1;
671148b32c28SKlaus Jensen         sn = NVME(pcie_sriov_get_vf_at_index(pci, vf_index));
671211871f53SŁukasz Gieryk     }
671311871f53SŁukasz Gieryk 
671411871f53SŁukasz Gieryk     if (online) {
671511871f53SŁukasz Gieryk         if (!sctrl->nvi || (le16_to_cpu(sctrl->nvq) < 2) || !sn) {
671611871f53SŁukasz Gieryk             return NVME_INVALID_SEC_CTRL_STATE | NVME_DNR;
671711871f53SŁukasz Gieryk         }
671811871f53SŁukasz Gieryk 
671911871f53SŁukasz Gieryk         if (!sctrl->scs) {
672011871f53SŁukasz Gieryk             sctrl->scs = 0x1;
672111871f53SŁukasz Gieryk             nvme_ctrl_reset(sn, NVME_RESET_FUNCTION);
672211871f53SŁukasz Gieryk         }
672311871f53SŁukasz Gieryk     } else {
672411871f53SŁukasz Gieryk         nvme_update_virt_res(n, sctrl, NVME_VIRT_RES_INTERRUPT, 0);
672511871f53SŁukasz Gieryk         nvme_update_virt_res(n, sctrl, NVME_VIRT_RES_QUEUE, 0);
672611871f53SŁukasz Gieryk 
672711871f53SŁukasz Gieryk         if (sctrl->scs) {
672811871f53SŁukasz Gieryk             sctrl->scs = 0x0;
672911871f53SŁukasz Gieryk             if (sn) {
673011871f53SŁukasz Gieryk                 nvme_ctrl_reset(sn, NVME_RESET_FUNCTION);
673111871f53SŁukasz Gieryk             }
673211871f53SŁukasz Gieryk         }
673311871f53SŁukasz Gieryk     }
673411871f53SŁukasz Gieryk 
673511871f53SŁukasz Gieryk     return NVME_SUCCESS;
673611871f53SŁukasz Gieryk }
673711871f53SŁukasz Gieryk 
673811871f53SŁukasz Gieryk static uint16_t nvme_virt_mngmt(NvmeCtrl *n, NvmeRequest *req)
673911871f53SŁukasz Gieryk {
674011871f53SŁukasz Gieryk     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
674111871f53SŁukasz Gieryk     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
674211871f53SŁukasz Gieryk     uint8_t act = dw10 & 0xf;
674311871f53SŁukasz Gieryk     uint8_t rt = (dw10 >> 8) & 0x7;
674411871f53SŁukasz Gieryk     uint16_t cntlid = (dw10 >> 16) & 0xffff;
674511871f53SŁukasz Gieryk     int nr = dw11 & 0xffff;
674611871f53SŁukasz Gieryk 
674711871f53SŁukasz Gieryk     trace_pci_nvme_virt_mngmt(nvme_cid(req), act, cntlid, rt ? "VI" : "VQ", nr);
674811871f53SŁukasz Gieryk 
674911871f53SŁukasz Gieryk     if (rt != NVME_VIRT_RES_QUEUE && rt != NVME_VIRT_RES_INTERRUPT) {
675011871f53SŁukasz Gieryk         return NVME_INVALID_RESOURCE_ID | NVME_DNR;
675111871f53SŁukasz Gieryk     }
675211871f53SŁukasz Gieryk 
675311871f53SŁukasz Gieryk     switch (act) {
675411871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_ASSIGN:
675511871f53SŁukasz Gieryk         return nvme_assign_virt_res_to_sec(n, req, cntlid, rt, nr);
675611871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_PRM_ALLOC:
675711871f53SŁukasz Gieryk         return nvme_assign_virt_res_to_prim(n, req, cntlid, rt, nr);
675811871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_ONLINE:
675911871f53SŁukasz Gieryk         return nvme_virt_set_state(n, cntlid, true);
676011871f53SŁukasz Gieryk     case NVME_VIRT_MNGMT_ACTION_SEC_OFFLINE:
676111871f53SŁukasz Gieryk         return nvme_virt_set_state(n, cntlid, false);
676211871f53SŁukasz Gieryk     default:
676311871f53SŁukasz Gieryk         return NVME_INVALID_FIELD | NVME_DNR;
676411871f53SŁukasz Gieryk     }
676511871f53SŁukasz Gieryk }
676611871f53SŁukasz Gieryk 
67673f7fe8deSJinhao Fan static uint16_t nvme_dbbuf_config(NvmeCtrl *n, const NvmeRequest *req)
67683f7fe8deSJinhao Fan {
676948b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
67703f7fe8deSJinhao Fan     uint64_t dbs_addr = le64_to_cpu(req->cmd.dptr.prp1);
67713f7fe8deSJinhao Fan     uint64_t eis_addr = le64_to_cpu(req->cmd.dptr.prp2);
67723f7fe8deSJinhao Fan     int i;
67733f7fe8deSJinhao Fan 
67743f7fe8deSJinhao Fan     /* Address should be page aligned */
67753f7fe8deSJinhao Fan     if (dbs_addr & (n->page_size - 1) || eis_addr & (n->page_size - 1)) {
67763f7fe8deSJinhao Fan         return NVME_INVALID_FIELD | NVME_DNR;
67773f7fe8deSJinhao Fan     }
67783f7fe8deSJinhao Fan 
67793f7fe8deSJinhao Fan     /* Save shadow buffer base addr for use during queue creation */
67803f7fe8deSJinhao Fan     n->dbbuf_dbs = dbs_addr;
67813f7fe8deSJinhao Fan     n->dbbuf_eis = eis_addr;
67823f7fe8deSJinhao Fan     n->dbbuf_enabled = true;
67833f7fe8deSJinhao Fan 
67843f7fe8deSJinhao Fan     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
67853f7fe8deSJinhao Fan         NvmeSQueue *sq = n->sq[i];
67863f7fe8deSJinhao Fan         NvmeCQueue *cq = n->cq[i];
67873f7fe8deSJinhao Fan 
67883f7fe8deSJinhao Fan         if (sq) {
67893f7fe8deSJinhao Fan             /*
67903f7fe8deSJinhao Fan              * CAP.DSTRD is 0, so offset of ith sq db_addr is (i<<3)
67913f7fe8deSJinhao Fan              * nvme_process_db() uses this hard-coded way to calculate
67923f7fe8deSJinhao Fan              * doorbell offsets. Be consistent with that here.
67933f7fe8deSJinhao Fan              */
67943f7fe8deSJinhao Fan             sq->db_addr = dbs_addr + (i << 3);
67953f7fe8deSJinhao Fan             sq->ei_addr = eis_addr + (i << 3);
679648b32c28SKlaus Jensen             pci_dma_write(pci, sq->db_addr, &sq->tail, sizeof(sq->tail));
67972e53b0b4SJinhao Fan 
67982e53b0b4SJinhao Fan             if (n->params.ioeventfd && sq->sqid != 0) {
67992e53b0b4SJinhao Fan                 if (!nvme_init_sq_ioeventfd(sq)) {
68002e53b0b4SJinhao Fan                     sq->ioeventfd_enabled = true;
68012e53b0b4SJinhao Fan                 }
68022e53b0b4SJinhao Fan             }
68033f7fe8deSJinhao Fan         }
68043f7fe8deSJinhao Fan 
68053f7fe8deSJinhao Fan         if (cq) {
68063f7fe8deSJinhao Fan             /* CAP.DSTRD is 0, so offset of ith cq db_addr is (i<<3)+(1<<2) */
68073f7fe8deSJinhao Fan             cq->db_addr = dbs_addr + (i << 3) + (1 << 2);
68083f7fe8deSJinhao Fan             cq->ei_addr = eis_addr + (i << 3) + (1 << 2);
680948b32c28SKlaus Jensen             pci_dma_write(pci, cq->db_addr, &cq->head, sizeof(cq->head));
68102e53b0b4SJinhao Fan 
68112e53b0b4SJinhao Fan             if (n->params.ioeventfd && cq->cqid != 0) {
68122e53b0b4SJinhao Fan                 if (!nvme_init_cq_ioeventfd(cq)) {
68132e53b0b4SJinhao Fan                     cq->ioeventfd_enabled = true;
68142e53b0b4SJinhao Fan                 }
68152e53b0b4SJinhao Fan             }
68163f7fe8deSJinhao Fan         }
68173f7fe8deSJinhao Fan     }
68183f7fe8deSJinhao Fan 
6819387350d5SJinhao Fan     trace_pci_nvme_dbbuf_config(dbs_addr, eis_addr);
6820387350d5SJinhao Fan 
68213f7fe8deSJinhao Fan     return NVME_SUCCESS;
68223f7fe8deSJinhao Fan }
68233f7fe8deSJinhao Fan 
6824e181d3daSGollu Appalanaidu static uint16_t nvme_directive_send(NvmeCtrl *n, NvmeRequest *req)
6825e181d3daSGollu Appalanaidu {
6826e181d3daSGollu Appalanaidu     return NVME_INVALID_FIELD | NVME_DNR;
6827e181d3daSGollu Appalanaidu }
6828e181d3daSGollu Appalanaidu 
6829e181d3daSGollu Appalanaidu static uint16_t nvme_directive_receive(NvmeCtrl *n, NvmeRequest *req)
6830e181d3daSGollu Appalanaidu {
683173064edfSJesper Devantier     NvmeNamespace *ns;
6832e181d3daSGollu Appalanaidu     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
6833e181d3daSGollu Appalanaidu     uint32_t dw11 = le32_to_cpu(req->cmd.cdw11);
6834e181d3daSGollu Appalanaidu     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
6835e181d3daSGollu Appalanaidu     uint8_t doper, dtype;
6836e181d3daSGollu Appalanaidu     uint32_t numd, trans_len;
6837e181d3daSGollu Appalanaidu     NvmeDirectiveIdentify id = {
6838e181d3daSGollu Appalanaidu         .supported = 1 << NVME_DIRECTIVE_IDENTIFY,
6839e181d3daSGollu Appalanaidu         .enabled = 1 << NVME_DIRECTIVE_IDENTIFY,
6840e181d3daSGollu Appalanaidu     };
6841e181d3daSGollu Appalanaidu 
6842e181d3daSGollu Appalanaidu     numd = dw10 + 1;
6843e181d3daSGollu Appalanaidu     doper = dw11 & 0xff;
6844e181d3daSGollu Appalanaidu     dtype = (dw11 >> 8) & 0xff;
6845e181d3daSGollu Appalanaidu 
6846e181d3daSGollu Appalanaidu     trans_len = MIN(sizeof(NvmeDirectiveIdentify), numd << 2);
6847e181d3daSGollu Appalanaidu 
6848e181d3daSGollu Appalanaidu     if (nsid == NVME_NSID_BROADCAST || dtype != NVME_DIRECTIVE_IDENTIFY ||
6849e181d3daSGollu Appalanaidu         doper != NVME_DIRECTIVE_RETURN_PARAMS) {
6850e181d3daSGollu Appalanaidu         return NVME_INVALID_FIELD | NVME_DNR;
6851e181d3daSGollu Appalanaidu     }
6852e181d3daSGollu Appalanaidu 
685373064edfSJesper Devantier     ns = nvme_ns(n, nsid);
685473064edfSJesper Devantier     if (!ns) {
685573064edfSJesper Devantier         return NVME_INVALID_FIELD | NVME_DNR;
685673064edfSJesper Devantier     }
685773064edfSJesper Devantier 
685873064edfSJesper Devantier     switch (dtype) {
685973064edfSJesper Devantier     case NVME_DIRECTIVE_IDENTIFY:
686073064edfSJesper Devantier         switch (doper) {
686173064edfSJesper Devantier         case NVME_DIRECTIVE_RETURN_PARAMS:
686273064edfSJesper Devantier             if (ns->endgrp->fdp.enabled) {
686373064edfSJesper Devantier                 id.supported |= 1 << NVME_DIRECTIVE_DATA_PLACEMENT;
686473064edfSJesper Devantier                 id.enabled |= 1 << NVME_DIRECTIVE_DATA_PLACEMENT;
686573064edfSJesper Devantier                 id.persistent |= 1 << NVME_DIRECTIVE_DATA_PLACEMENT;
686673064edfSJesper Devantier             }
686773064edfSJesper Devantier 
6868e181d3daSGollu Appalanaidu             return nvme_c2h(n, (uint8_t *)&id, trans_len, req);
686973064edfSJesper Devantier 
687073064edfSJesper Devantier         default:
687173064edfSJesper Devantier             return NVME_INVALID_FIELD | NVME_DNR;
687273064edfSJesper Devantier         }
687373064edfSJesper Devantier 
687473064edfSJesper Devantier     default:
687573064edfSJesper Devantier         return NVME_INVALID_FIELD;
687673064edfSJesper Devantier     }
6877e181d3daSGollu Appalanaidu }
6878e181d3daSGollu Appalanaidu 
687988eea45cSKlaus Jensen static uint16_t nvme_admin_cmd(NvmeCtrl *n, NvmeRequest *req)
688088eea45cSKlaus Jensen {
688188eea45cSKlaus Jensen     trace_pci_nvme_admin_cmd(nvme_cid(req), nvme_sqid(req), req->cmd.opcode,
688288eea45cSKlaus Jensen                              nvme_adm_opc_str(req->cmd.opcode));
688388eea45cSKlaus Jensen 
688488eea45cSKlaus Jensen     if (!(nvme_cse_acs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
688588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_admin_opc(req->cmd.opcode);
688688eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
688788eea45cSKlaus Jensen     }
688888eea45cSKlaus Jensen 
688988eea45cSKlaus Jensen     /* SGLs shall not be used for Admin commands in NVMe over PCIe */
689088eea45cSKlaus Jensen     if (NVME_CMD_FLAGS_PSDT(req->cmd.flags) != NVME_PSDT_PRP) {
689188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
689288eea45cSKlaus Jensen     }
689388eea45cSKlaus Jensen 
6894c53a9a91SPankaj Raghav     if (NVME_CMD_FLAGS_FUSE(req->cmd.flags)) {
6895c53a9a91SPankaj Raghav         return NVME_INVALID_FIELD;
6896c53a9a91SPankaj Raghav     }
6897c53a9a91SPankaj Raghav 
689888eea45cSKlaus Jensen     switch (req->cmd.opcode) {
689988eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_SQ:
690088eea45cSKlaus Jensen         return nvme_del_sq(n, req);
690188eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_SQ:
690288eea45cSKlaus Jensen         return nvme_create_sq(n, req);
690388eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_LOG_PAGE:
690488eea45cSKlaus Jensen         return nvme_get_log(n, req);
690588eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_CQ:
690688eea45cSKlaus Jensen         return nvme_del_cq(n, req);
690788eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_CQ:
690888eea45cSKlaus Jensen         return nvme_create_cq(n, req);
690988eea45cSKlaus Jensen     case NVME_ADM_CMD_IDENTIFY:
691088eea45cSKlaus Jensen         return nvme_identify(n, req);
691188eea45cSKlaus Jensen     case NVME_ADM_CMD_ABORT:
691288eea45cSKlaus Jensen         return nvme_abort(n, req);
691388eea45cSKlaus Jensen     case NVME_ADM_CMD_SET_FEATURES:
691488eea45cSKlaus Jensen         return nvme_set_feature(n, req);
691588eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_FEATURES:
691688eea45cSKlaus Jensen         return nvme_get_feature(n, req);
691788eea45cSKlaus Jensen     case NVME_ADM_CMD_ASYNC_EV_REQ:
691888eea45cSKlaus Jensen         return nvme_aer(n, req);
691988eea45cSKlaus Jensen     case NVME_ADM_CMD_NS_ATTACHMENT:
692088eea45cSKlaus Jensen         return nvme_ns_attachment(n, req);
692111871f53SŁukasz Gieryk     case NVME_ADM_CMD_VIRT_MNGMT:
692211871f53SŁukasz Gieryk         return nvme_virt_mngmt(n, req);
69233f7fe8deSJinhao Fan     case NVME_ADM_CMD_DBBUF_CONFIG:
69243f7fe8deSJinhao Fan         return nvme_dbbuf_config(n, req);
692588eea45cSKlaus Jensen     case NVME_ADM_CMD_FORMAT_NVM:
692688eea45cSKlaus Jensen         return nvme_format(n, req);
6927e181d3daSGollu Appalanaidu     case NVME_ADM_CMD_DIRECTIVE_SEND:
6928e181d3daSGollu Appalanaidu         return nvme_directive_send(n, req);
6929e181d3daSGollu Appalanaidu     case NVME_ADM_CMD_DIRECTIVE_RECV:
6930e181d3daSGollu Appalanaidu         return nvme_directive_receive(n, req);
693188eea45cSKlaus Jensen     default:
693288eea45cSKlaus Jensen         assert(false);
693388eea45cSKlaus Jensen     }
693488eea45cSKlaus Jensen 
693588eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
693688eea45cSKlaus Jensen }
693788eea45cSKlaus Jensen 
69383f7fe8deSJinhao Fan static void nvme_update_sq_eventidx(const NvmeSQueue *sq)
69393f7fe8deSJinhao Fan {
69402fda0726SKlaus Jensen     uint32_t v = cpu_to_le32(sq->tail);
69412fda0726SKlaus Jensen 
694247cd3539SKlaus Jensen     trace_pci_nvme_update_sq_eventidx(sq->sqid, sq->tail);
694347cd3539SKlaus Jensen 
69442fda0726SKlaus Jensen     pci_dma_write(PCI_DEVICE(sq->ctrl), sq->ei_addr, &v, sizeof(v));
69453f7fe8deSJinhao Fan }
69463f7fe8deSJinhao Fan 
69473f7fe8deSJinhao Fan static void nvme_update_sq_tail(NvmeSQueue *sq)
69483f7fe8deSJinhao Fan {
69492fda0726SKlaus Jensen     uint32_t v;
69502fda0726SKlaus Jensen 
69512fda0726SKlaus Jensen     pci_dma_read(PCI_DEVICE(sq->ctrl), sq->db_addr, &v, sizeof(v));
69522fda0726SKlaus Jensen 
69532fda0726SKlaus Jensen     sq->tail = le32_to_cpu(v);
695447cd3539SKlaus Jensen 
695547cd3539SKlaus Jensen     trace_pci_nvme_update_sq_tail(sq->sqid, sq->tail);
69563f7fe8deSJinhao Fan }
69573f7fe8deSJinhao Fan 
695888eea45cSKlaus Jensen static void nvme_process_sq(void *opaque)
695988eea45cSKlaus Jensen {
696088eea45cSKlaus Jensen     NvmeSQueue *sq = opaque;
696188eea45cSKlaus Jensen     NvmeCtrl *n = sq->ctrl;
696288eea45cSKlaus Jensen     NvmeCQueue *cq = n->cq[sq->cqid];
696388eea45cSKlaus Jensen 
696488eea45cSKlaus Jensen     uint16_t status;
696588eea45cSKlaus Jensen     hwaddr addr;
696688eea45cSKlaus Jensen     NvmeCmd cmd;
696788eea45cSKlaus Jensen     NvmeRequest *req;
696888eea45cSKlaus Jensen 
69693f7fe8deSJinhao Fan     if (n->dbbuf_enabled) {
69703f7fe8deSJinhao Fan         nvme_update_sq_tail(sq);
69713f7fe8deSJinhao Fan     }
69723f7fe8deSJinhao Fan 
697388eea45cSKlaus Jensen     while (!(nvme_sq_empty(sq) || QTAILQ_EMPTY(&sq->req_list))) {
697488eea45cSKlaus Jensen         addr = sq->dma_addr + sq->head * n->sqe_size;
697588eea45cSKlaus Jensen         if (nvme_addr_read(n, addr, (void *)&cmd, sizeof(cmd))) {
697688eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
697788eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
697849e03457SKlaus Jensen             stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
697988eea45cSKlaus Jensen             break;
698088eea45cSKlaus Jensen         }
698188eea45cSKlaus Jensen         nvme_inc_sq_head(sq);
698288eea45cSKlaus Jensen 
698388eea45cSKlaus Jensen         req = QTAILQ_FIRST(&sq->req_list);
698488eea45cSKlaus Jensen         QTAILQ_REMOVE(&sq->req_list, req, entry);
698588eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->out_req_list, req, entry);
698688eea45cSKlaus Jensen         nvme_req_clear(req);
698788eea45cSKlaus Jensen         req->cqe.cid = cmd.cid;
698888eea45cSKlaus Jensen         memcpy(&req->cmd, &cmd, sizeof(NvmeCmd));
698988eea45cSKlaus Jensen 
699088eea45cSKlaus Jensen         status = sq->sqid ? nvme_io_cmd(n, req) :
699188eea45cSKlaus Jensen             nvme_admin_cmd(n, req);
699288eea45cSKlaus Jensen         if (status != NVME_NO_COMPLETE) {
699388eea45cSKlaus Jensen             req->status = status;
699488eea45cSKlaus Jensen             nvme_enqueue_req_completion(cq, req);
699588eea45cSKlaus Jensen         }
69963f7fe8deSJinhao Fan 
69973f7fe8deSJinhao Fan         if (n->dbbuf_enabled) {
69983f7fe8deSJinhao Fan             nvme_update_sq_eventidx(sq);
69993f7fe8deSJinhao Fan             nvme_update_sq_tail(sq);
70003f7fe8deSJinhao Fan         }
700188eea45cSKlaus Jensen     }
700288eea45cSKlaus Jensen }
700388eea45cSKlaus Jensen 
7004decc0261SŁukasz Gieryk static void nvme_update_msixcap_ts(PCIDevice *pci_dev, uint32_t table_size)
7005decc0261SŁukasz Gieryk {
7006decc0261SŁukasz Gieryk     uint8_t *config;
7007decc0261SŁukasz Gieryk 
7008decc0261SŁukasz Gieryk     if (!msix_present(pci_dev)) {
7009decc0261SŁukasz Gieryk         return;
7010decc0261SŁukasz Gieryk     }
7011decc0261SŁukasz Gieryk 
7012decc0261SŁukasz Gieryk     assert(table_size > 0 && table_size <= pci_dev->msix_entries_nr);
7013decc0261SŁukasz Gieryk 
7014decc0261SŁukasz Gieryk     config = pci_dev->config + pci_dev->msix_cap;
7015decc0261SŁukasz Gieryk     pci_set_word_by_mask(config + PCI_MSIX_FLAGS, PCI_MSIX_FLAGS_QSIZE,
7016decc0261SŁukasz Gieryk                          table_size - 1);
7017decc0261SŁukasz Gieryk }
7018decc0261SŁukasz Gieryk 
701911871f53SŁukasz Gieryk static void nvme_activate_virt_res(NvmeCtrl *n)
702011871f53SŁukasz Gieryk {
702148b32c28SKlaus Jensen     PCIDevice *pci_dev = PCI_DEVICE(n);
702211871f53SŁukasz Gieryk     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
702311871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
702411871f53SŁukasz Gieryk 
702511871f53SŁukasz Gieryk     /* -1 to account for the admin queue */
702611871f53SŁukasz Gieryk     if (pci_is_vf(pci_dev)) {
702711871f53SŁukasz Gieryk         sctrl = nvme_sctrl(n);
702811871f53SŁukasz Gieryk         cap->vqprt = sctrl->nvq;
702911871f53SŁukasz Gieryk         cap->viprt = sctrl->nvi;
703011871f53SŁukasz Gieryk         n->conf_ioqpairs = sctrl->nvq ? le16_to_cpu(sctrl->nvq) - 1 : 0;
703111871f53SŁukasz Gieryk         n->conf_msix_qsize = sctrl->nvi ? le16_to_cpu(sctrl->nvi) : 1;
703211871f53SŁukasz Gieryk     } else {
703311871f53SŁukasz Gieryk         cap->vqrfap = n->next_pri_ctrl_cap.vqrfap;
703411871f53SŁukasz Gieryk         cap->virfap = n->next_pri_ctrl_cap.virfap;
703511871f53SŁukasz Gieryk         n->conf_ioqpairs = le16_to_cpu(cap->vqprt) +
703611871f53SŁukasz Gieryk                            le16_to_cpu(cap->vqrfap) - 1;
703711871f53SŁukasz Gieryk         n->conf_msix_qsize = le16_to_cpu(cap->viprt) +
703811871f53SŁukasz Gieryk                              le16_to_cpu(cap->virfap);
703911871f53SŁukasz Gieryk     }
704011871f53SŁukasz Gieryk }
704111871f53SŁukasz Gieryk 
70421e9c685eSŁukasz Gieryk static void nvme_ctrl_reset(NvmeCtrl *n, NvmeResetType rst)
704388eea45cSKlaus Jensen {
704448b32c28SKlaus Jensen     PCIDevice *pci_dev = PCI_DEVICE(n);
704511871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
704688eea45cSKlaus Jensen     NvmeNamespace *ns;
704788eea45cSKlaus Jensen     int i;
704888eea45cSKlaus Jensen 
704988eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
705088eea45cSKlaus Jensen         ns = nvme_ns(n, i);
705188eea45cSKlaus Jensen         if (!ns) {
705288eea45cSKlaus Jensen             continue;
705388eea45cSKlaus Jensen         }
705488eea45cSKlaus Jensen 
705588eea45cSKlaus Jensen         nvme_ns_drain(ns);
705688eea45cSKlaus Jensen     }
705788eea45cSKlaus Jensen 
705888eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
705988eea45cSKlaus Jensen         if (n->sq[i] != NULL) {
706088eea45cSKlaus Jensen             nvme_free_sq(n->sq[i], n);
706188eea45cSKlaus Jensen         }
706288eea45cSKlaus Jensen     }
706388eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
706488eea45cSKlaus Jensen         if (n->cq[i] != NULL) {
706588eea45cSKlaus Jensen             nvme_free_cq(n->cq[i], n);
706688eea45cSKlaus Jensen         }
706788eea45cSKlaus Jensen     }
706888eea45cSKlaus Jensen 
706988eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&n->aer_queue)) {
707088eea45cSKlaus Jensen         NvmeAsyncEvent *event = QTAILQ_FIRST(&n->aer_queue);
707188eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
707288eea45cSKlaus Jensen         g_free(event);
707388eea45cSKlaus Jensen     }
707488eea45cSKlaus Jensen 
707511871f53SŁukasz Gieryk     if (n->params.sriov_max_vfs) {
707611871f53SŁukasz Gieryk         if (!pci_is_vf(pci_dev)) {
707711871f53SŁukasz Gieryk             for (i = 0; i < n->sec_ctrl_list.numcntl; i++) {
707811871f53SŁukasz Gieryk                 sctrl = &n->sec_ctrl_list.sec[i];
707911871f53SŁukasz Gieryk                 nvme_virt_set_state(n, le16_to_cpu(sctrl->scid), false);
708011871f53SŁukasz Gieryk             }
708111871f53SŁukasz Gieryk 
70821e9c685eSŁukasz Gieryk             if (rst != NVME_RESET_CONTROLLER) {
7083decc0261SŁukasz Gieryk                 pcie_sriov_pf_disable_vfs(pci_dev);
708444c2c094SLukasz Maniak             }
70851e9c685eSŁukasz Gieryk         }
708644c2c094SLukasz Maniak 
708711871f53SŁukasz Gieryk         if (rst != NVME_RESET_CONTROLLER) {
708811871f53SŁukasz Gieryk             nvme_activate_virt_res(n);
708911871f53SŁukasz Gieryk         }
709011871f53SŁukasz Gieryk     }
709111871f53SŁukasz Gieryk 
709288eea45cSKlaus Jensen     n->aer_queued = 0;
709398836e8eSKlaus Jensen     n->aer_mask = 0;
709488eea45cSKlaus Jensen     n->outstanding_aers = 0;
709588eea45cSKlaus Jensen     n->qs_created = false;
7096decc0261SŁukasz Gieryk 
7097decc0261SŁukasz Gieryk     nvme_update_msixcap_ts(pci_dev, n->conf_msix_qsize);
709811871f53SŁukasz Gieryk 
709911871f53SŁukasz Gieryk     if (pci_is_vf(pci_dev)) {
710011871f53SŁukasz Gieryk         sctrl = nvme_sctrl(n);
7101cc9bcee2SKlaus Jensen 
710211871f53SŁukasz Gieryk         stl_le_p(&n->bar.csts, sctrl->scs ? 0 : NVME_CSTS_FAILED);
710311871f53SŁukasz Gieryk     } else {
710411871f53SŁukasz Gieryk         stl_le_p(&n->bar.csts, 0);
710511871f53SŁukasz Gieryk     }
7106cc9bcee2SKlaus Jensen 
7107cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.intms, 0);
7108cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.intmc, 0);
7109cc9bcee2SKlaus Jensen     stl_le_p(&n->bar.cc, 0);
71103f7fe8deSJinhao Fan 
71113f7fe8deSJinhao Fan     n->dbbuf_dbs = 0;
71123f7fe8deSJinhao Fan     n->dbbuf_eis = 0;
71133f7fe8deSJinhao Fan     n->dbbuf_enabled = false;
711488eea45cSKlaus Jensen }
711588eea45cSKlaus Jensen 
711688eea45cSKlaus Jensen static void nvme_ctrl_shutdown(NvmeCtrl *n)
711788eea45cSKlaus Jensen {
711888eea45cSKlaus Jensen     NvmeNamespace *ns;
711988eea45cSKlaus Jensen     int i;
712088eea45cSKlaus Jensen 
712188eea45cSKlaus Jensen     if (n->pmr.dev) {
712288eea45cSKlaus Jensen         memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
712388eea45cSKlaus Jensen     }
712488eea45cSKlaus Jensen 
712588eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
712688eea45cSKlaus Jensen         ns = nvme_ns(n, i);
712788eea45cSKlaus Jensen         if (!ns) {
712888eea45cSKlaus Jensen             continue;
712988eea45cSKlaus Jensen         }
713088eea45cSKlaus Jensen 
713188eea45cSKlaus Jensen         nvme_ns_shutdown(ns);
713288eea45cSKlaus Jensen     }
713388eea45cSKlaus Jensen }
713488eea45cSKlaus Jensen 
713588eea45cSKlaus Jensen static void nvme_select_iocs(NvmeCtrl *n)
713688eea45cSKlaus Jensen {
713788eea45cSKlaus Jensen     NvmeNamespace *ns;
713888eea45cSKlaus Jensen     int i;
713988eea45cSKlaus Jensen 
714088eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
714188eea45cSKlaus Jensen         ns = nvme_ns(n, i);
714288eea45cSKlaus Jensen         if (!ns) {
714388eea45cSKlaus Jensen             continue;
714488eea45cSKlaus Jensen         }
714588eea45cSKlaus Jensen 
714688eea45cSKlaus Jensen         nvme_select_iocs_ns(n, ns);
714788eea45cSKlaus Jensen     }
714888eea45cSKlaus Jensen }
714988eea45cSKlaus Jensen 
715088eea45cSKlaus Jensen static int nvme_start_ctrl(NvmeCtrl *n)
715188eea45cSKlaus Jensen {
715249e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
715349e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
715449e03457SKlaus Jensen     uint32_t aqa = ldl_le_p(&n->bar.aqa);
715549e03457SKlaus Jensen     uint64_t asq = ldq_le_p(&n->bar.asq);
715649e03457SKlaus Jensen     uint64_t acq = ldq_le_p(&n->bar.acq);
715749e03457SKlaus Jensen     uint32_t page_bits = NVME_CC_MPS(cc) + 12;
715888eea45cSKlaus Jensen     uint32_t page_size = 1 << page_bits;
715911871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl = nvme_sctrl(n);
716088eea45cSKlaus Jensen 
716148b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !sctrl->scs) {
716211871f53SŁukasz Gieryk         trace_pci_nvme_err_startfail_virt_state(le16_to_cpu(sctrl->nvi),
71633488fc32SPaolo Bonzini                                                 le16_to_cpu(sctrl->nvq));
716411871f53SŁukasz Gieryk         return -1;
716511871f53SŁukasz Gieryk     }
716688eea45cSKlaus Jensen     if (unlikely(n->cq[0])) {
716788eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cq();
716888eea45cSKlaus Jensen         return -1;
716988eea45cSKlaus Jensen     }
717088eea45cSKlaus Jensen     if (unlikely(n->sq[0])) {
717188eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sq();
717288eea45cSKlaus Jensen         return -1;
717388eea45cSKlaus Jensen     }
717449e03457SKlaus Jensen     if (unlikely(asq & (page_size - 1))) {
717549e03457SKlaus Jensen         trace_pci_nvme_err_startfail_asq_misaligned(asq);
717688eea45cSKlaus Jensen         return -1;
717788eea45cSKlaus Jensen     }
717849e03457SKlaus Jensen     if (unlikely(acq & (page_size - 1))) {
717949e03457SKlaus Jensen         trace_pci_nvme_err_startfail_acq_misaligned(acq);
718088eea45cSKlaus Jensen         return -1;
718188eea45cSKlaus Jensen     }
718249e03457SKlaus Jensen     if (unlikely(!(NVME_CAP_CSS(cap) & (1 << NVME_CC_CSS(cc))))) {
718349e03457SKlaus Jensen         trace_pci_nvme_err_startfail_css(NVME_CC_CSS(cc));
718488eea45cSKlaus Jensen         return -1;
718588eea45cSKlaus Jensen     }
718649e03457SKlaus Jensen     if (unlikely(NVME_CC_MPS(cc) < NVME_CAP_MPSMIN(cap))) {
718788eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_small(
718849e03457SKlaus Jensen                     NVME_CC_MPS(cc),
718949e03457SKlaus Jensen                     NVME_CAP_MPSMIN(cap));
719088eea45cSKlaus Jensen         return -1;
719188eea45cSKlaus Jensen     }
719249e03457SKlaus Jensen     if (unlikely(NVME_CC_MPS(cc) >
719349e03457SKlaus Jensen                  NVME_CAP_MPSMAX(cap))) {
719488eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_large(
719549e03457SKlaus Jensen                     NVME_CC_MPS(cc),
719649e03457SKlaus Jensen                     NVME_CAP_MPSMAX(cap));
719788eea45cSKlaus Jensen         return -1;
719888eea45cSKlaus Jensen     }
719949e03457SKlaus Jensen     if (unlikely(NVME_CC_IOCQES(cc) <
720088eea45cSKlaus Jensen                  NVME_CTRL_CQES_MIN(n->id_ctrl.cqes))) {
720188eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cqent_too_small(
720249e03457SKlaus Jensen                     NVME_CC_IOCQES(cc),
720349e03457SKlaus Jensen                     NVME_CTRL_CQES_MIN(cap));
720488eea45cSKlaus Jensen         return -1;
720588eea45cSKlaus Jensen     }
720649e03457SKlaus Jensen     if (unlikely(NVME_CC_IOCQES(cc) >
720788eea45cSKlaus Jensen                  NVME_CTRL_CQES_MAX(n->id_ctrl.cqes))) {
720888eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cqent_too_large(
720949e03457SKlaus Jensen                     NVME_CC_IOCQES(cc),
721049e03457SKlaus Jensen                     NVME_CTRL_CQES_MAX(cap));
721188eea45cSKlaus Jensen         return -1;
721288eea45cSKlaus Jensen     }
721349e03457SKlaus Jensen     if (unlikely(NVME_CC_IOSQES(cc) <
721488eea45cSKlaus Jensen                  NVME_CTRL_SQES_MIN(n->id_ctrl.sqes))) {
721588eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sqent_too_small(
721649e03457SKlaus Jensen                     NVME_CC_IOSQES(cc),
721749e03457SKlaus Jensen                     NVME_CTRL_SQES_MIN(cap));
721888eea45cSKlaus Jensen         return -1;
721988eea45cSKlaus Jensen     }
722049e03457SKlaus Jensen     if (unlikely(NVME_CC_IOSQES(cc) >
722188eea45cSKlaus Jensen                  NVME_CTRL_SQES_MAX(n->id_ctrl.sqes))) {
722288eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sqent_too_large(
722349e03457SKlaus Jensen                     NVME_CC_IOSQES(cc),
722449e03457SKlaus Jensen                     NVME_CTRL_SQES_MAX(cap));
722588eea45cSKlaus Jensen         return -1;
722688eea45cSKlaus Jensen     }
722749e03457SKlaus Jensen     if (unlikely(!NVME_AQA_ASQS(aqa))) {
722888eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_asqent_sz_zero();
722988eea45cSKlaus Jensen         return -1;
723088eea45cSKlaus Jensen     }
723149e03457SKlaus Jensen     if (unlikely(!NVME_AQA_ACQS(aqa))) {
723288eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_acqent_sz_zero();
723388eea45cSKlaus Jensen         return -1;
723488eea45cSKlaus Jensen     }
723588eea45cSKlaus Jensen 
723688eea45cSKlaus Jensen     n->page_bits = page_bits;
723788eea45cSKlaus Jensen     n->page_size = page_size;
723888eea45cSKlaus Jensen     n->max_prp_ents = n->page_size / sizeof(uint64_t);
723949e03457SKlaus Jensen     n->cqe_size = 1 << NVME_CC_IOCQES(cc);
724049e03457SKlaus Jensen     n->sqe_size = 1 << NVME_CC_IOSQES(cc);
724149e03457SKlaus Jensen     nvme_init_cq(&n->admin_cq, n, acq, 0, 0, NVME_AQA_ACQS(aqa) + 1, 1);
724249e03457SKlaus Jensen     nvme_init_sq(&n->admin_sq, n, asq, 0, 0, NVME_AQA_ASQS(aqa) + 1);
724388eea45cSKlaus Jensen 
724488eea45cSKlaus Jensen     nvme_set_timestamp(n, 0ULL);
724588eea45cSKlaus Jensen 
724688eea45cSKlaus Jensen     nvme_select_iocs(n);
724788eea45cSKlaus Jensen 
724888eea45cSKlaus Jensen     return 0;
724988eea45cSKlaus Jensen }
725088eea45cSKlaus Jensen 
725188eea45cSKlaus Jensen static void nvme_cmb_enable_regs(NvmeCtrl *n)
725288eea45cSKlaus Jensen {
725349e03457SKlaus Jensen     uint32_t cmbloc = ldl_le_p(&n->bar.cmbloc);
725449e03457SKlaus Jensen     uint32_t cmbsz = ldl_le_p(&n->bar.cmbsz);
725588eea45cSKlaus Jensen 
725649e03457SKlaus Jensen     NVME_CMBLOC_SET_CDPCILS(cmbloc, 1);
725749e03457SKlaus Jensen     NVME_CMBLOC_SET_CDPMLS(cmbloc, 1);
725849e03457SKlaus Jensen     NVME_CMBLOC_SET_BIR(cmbloc, NVME_CMB_BIR);
725949e03457SKlaus Jensen     stl_le_p(&n->bar.cmbloc, cmbloc);
726049e03457SKlaus Jensen 
726149e03457SKlaus Jensen     NVME_CMBSZ_SET_SQS(cmbsz, 1);
726249e03457SKlaus Jensen     NVME_CMBSZ_SET_CQS(cmbsz, 0);
726349e03457SKlaus Jensen     NVME_CMBSZ_SET_LISTS(cmbsz, 1);
726449e03457SKlaus Jensen     NVME_CMBSZ_SET_RDS(cmbsz, 1);
726549e03457SKlaus Jensen     NVME_CMBSZ_SET_WDS(cmbsz, 1);
726649e03457SKlaus Jensen     NVME_CMBSZ_SET_SZU(cmbsz, 2); /* MBs */
726749e03457SKlaus Jensen     NVME_CMBSZ_SET_SZ(cmbsz, n->params.cmb_size_mb);
726849e03457SKlaus Jensen     stl_le_p(&n->bar.cmbsz, cmbsz);
726988eea45cSKlaus Jensen }
727088eea45cSKlaus Jensen 
727188eea45cSKlaus Jensen static void nvme_write_bar(NvmeCtrl *n, hwaddr offset, uint64_t data,
727288eea45cSKlaus Jensen                            unsigned size)
727388eea45cSKlaus Jensen {
727448b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
727549e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
727649e03457SKlaus Jensen     uint32_t cc = ldl_le_p(&n->bar.cc);
727749e03457SKlaus Jensen     uint32_t intms = ldl_le_p(&n->bar.intms);
727849e03457SKlaus Jensen     uint32_t csts = ldl_le_p(&n->bar.csts);
727949e03457SKlaus Jensen     uint32_t pmrsts = ldl_le_p(&n->bar.pmrsts);
728049e03457SKlaus Jensen 
728188eea45cSKlaus Jensen     if (unlikely(offset & (sizeof(uint32_t) - 1))) {
728288eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_misaligned32,
728388eea45cSKlaus Jensen                        "MMIO write not 32-bit aligned,"
728488eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", offset);
728588eea45cSKlaus Jensen         /* should be ignored, fall through for now */
728688eea45cSKlaus Jensen     }
728788eea45cSKlaus Jensen 
728888eea45cSKlaus Jensen     if (unlikely(size < sizeof(uint32_t))) {
728988eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_toosmall,
729088eea45cSKlaus Jensen                        "MMIO write smaller than 32-bits,"
729188eea45cSKlaus Jensen                        " offset=0x%"PRIx64", size=%u",
729288eea45cSKlaus Jensen                        offset, size);
729388eea45cSKlaus Jensen         /* should be ignored, fall through for now */
729488eea45cSKlaus Jensen     }
729588eea45cSKlaus Jensen 
729688eea45cSKlaus Jensen     switch (offset) {
7297a316aa50SKlaus Jensen     case NVME_REG_INTMS:
729848b32c28SKlaus Jensen         if (unlikely(msix_enabled(pci))) {
729988eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
730088eea45cSKlaus Jensen                            "undefined access to interrupt mask set"
730188eea45cSKlaus Jensen                            " when MSI-X is enabled");
730288eea45cSKlaus Jensen             /* should be ignored, fall through for now */
730388eea45cSKlaus Jensen         }
730449e03457SKlaus Jensen         intms |= data;
730549e03457SKlaus Jensen         stl_le_p(&n->bar.intms, intms);
730688eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
730749e03457SKlaus Jensen         trace_pci_nvme_mmio_intm_set(data & 0xffffffff, intms);
730888eea45cSKlaus Jensen         nvme_irq_check(n);
730988eea45cSKlaus Jensen         break;
7310a316aa50SKlaus Jensen     case NVME_REG_INTMC:
731148b32c28SKlaus Jensen         if (unlikely(msix_enabled(pci))) {
731288eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
731388eea45cSKlaus Jensen                            "undefined access to interrupt mask clr"
731488eea45cSKlaus Jensen                            " when MSI-X is enabled");
731588eea45cSKlaus Jensen             /* should be ignored, fall through for now */
731688eea45cSKlaus Jensen         }
731749e03457SKlaus Jensen         intms &= ~data;
731849e03457SKlaus Jensen         stl_le_p(&n->bar.intms, intms);
731988eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
732049e03457SKlaus Jensen         trace_pci_nvme_mmio_intm_clr(data & 0xffffffff, intms);
732188eea45cSKlaus Jensen         nvme_irq_check(n);
732288eea45cSKlaus Jensen         break;
7323a316aa50SKlaus Jensen     case NVME_REG_CC:
7324cc9bcee2SKlaus Jensen         stl_le_p(&n->bar.cc, data);
7325cc9bcee2SKlaus Jensen 
732688eea45cSKlaus Jensen         trace_pci_nvme_mmio_cfg(data & 0xffffffff);
732749e03457SKlaus Jensen 
7328cc9bcee2SKlaus Jensen         if (NVME_CC_SHN(data) && !(NVME_CC_SHN(cc))) {
7329cc9bcee2SKlaus Jensen             trace_pci_nvme_mmio_shutdown_set();
7330cc9bcee2SKlaus Jensen             nvme_ctrl_shutdown(n);
7331cc9bcee2SKlaus Jensen             csts &= ~(CSTS_SHST_MASK << CSTS_SHST_SHIFT);
7332cc9bcee2SKlaus Jensen             csts |= NVME_CSTS_SHST_COMPLETE;
7333cc9bcee2SKlaus Jensen         } else if (!NVME_CC_SHN(data) && NVME_CC_SHN(cc)) {
7334cc9bcee2SKlaus Jensen             trace_pci_nvme_mmio_shutdown_cleared();
7335cc9bcee2SKlaus Jensen             csts &= ~(CSTS_SHST_MASK << CSTS_SHST_SHIFT);
733688eea45cSKlaus Jensen         }
733788eea45cSKlaus Jensen 
733849e03457SKlaus Jensen         if (NVME_CC_EN(data) && !NVME_CC_EN(cc)) {
733988eea45cSKlaus Jensen             if (unlikely(nvme_start_ctrl(n))) {
734088eea45cSKlaus Jensen                 trace_pci_nvme_err_startfail();
734149e03457SKlaus Jensen                 csts = NVME_CSTS_FAILED;
734288eea45cSKlaus Jensen             } else {
734388eea45cSKlaus Jensen                 trace_pci_nvme_mmio_start_success();
734449e03457SKlaus Jensen                 csts = NVME_CSTS_READY;
734588eea45cSKlaus Jensen             }
734649e03457SKlaus Jensen         } else if (!NVME_CC_EN(data) && NVME_CC_EN(cc)) {
734788eea45cSKlaus Jensen             trace_pci_nvme_mmio_stopped();
73481e9c685eSŁukasz Gieryk             nvme_ctrl_reset(n, NVME_RESET_CONTROLLER);
7349cc9bcee2SKlaus Jensen 
7350cc9bcee2SKlaus Jensen             break;
735188eea45cSKlaus Jensen         }
735249e03457SKlaus Jensen 
735349e03457SKlaus Jensen         stl_le_p(&n->bar.csts, csts);
735449e03457SKlaus Jensen 
735588eea45cSKlaus Jensen         break;
7356a316aa50SKlaus Jensen     case NVME_REG_CSTS:
735788eea45cSKlaus Jensen         if (data & (1 << 4)) {
735888eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ssreset_w1c_unsupported,
735988eea45cSKlaus Jensen                            "attempted to W1C CSTS.NSSRO"
736088eea45cSKlaus Jensen                            " but CAP.NSSRS is zero (not supported)");
736188eea45cSKlaus Jensen         } else if (data != 0) {
736288eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ro_csts,
736388eea45cSKlaus Jensen                            "attempted to set a read only bit"
736488eea45cSKlaus Jensen                            " of controller status");
736588eea45cSKlaus Jensen         }
736688eea45cSKlaus Jensen         break;
7367a316aa50SKlaus Jensen     case NVME_REG_NSSR:
736888eea45cSKlaus Jensen         if (data == 0x4e564d65) {
736988eea45cSKlaus Jensen             trace_pci_nvme_ub_mmiowr_ssreset_unsupported();
737088eea45cSKlaus Jensen         } else {
737188eea45cSKlaus Jensen             /* The spec says that writes of other values have no effect */
737288eea45cSKlaus Jensen             return;
737388eea45cSKlaus Jensen         }
737488eea45cSKlaus Jensen         break;
7375a316aa50SKlaus Jensen     case NVME_REG_AQA:
737649e03457SKlaus Jensen         stl_le_p(&n->bar.aqa, data);
737788eea45cSKlaus Jensen         trace_pci_nvme_mmio_aqattr(data & 0xffffffff);
737888eea45cSKlaus Jensen         break;
7379a316aa50SKlaus Jensen     case NVME_REG_ASQ:
738049e03457SKlaus Jensen         stn_le_p(&n->bar.asq, size, data);
738188eea45cSKlaus Jensen         trace_pci_nvme_mmio_asqaddr(data);
738288eea45cSKlaus Jensen         break;
7383a316aa50SKlaus Jensen     case NVME_REG_ASQ + 4:
738449e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.asq + 4, data);
738549e03457SKlaus Jensen         trace_pci_nvme_mmio_asqaddr_hi(data, ldq_le_p(&n->bar.asq));
738688eea45cSKlaus Jensen         break;
7387a316aa50SKlaus Jensen     case NVME_REG_ACQ:
738888eea45cSKlaus Jensen         trace_pci_nvme_mmio_acqaddr(data);
738949e03457SKlaus Jensen         stn_le_p(&n->bar.acq, size, data);
739088eea45cSKlaus Jensen         break;
7391a316aa50SKlaus Jensen     case NVME_REG_ACQ + 4:
739249e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.acq + 4, data);
739349e03457SKlaus Jensen         trace_pci_nvme_mmio_acqaddr_hi(data, ldq_le_p(&n->bar.acq));
739488eea45cSKlaus Jensen         break;
7395a316aa50SKlaus Jensen     case NVME_REG_CMBLOC:
739688eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbloc_reserved,
739788eea45cSKlaus Jensen                        "invalid write to reserved CMBLOC"
739888eea45cSKlaus Jensen                        " when CMBSZ is zero, ignored");
739988eea45cSKlaus Jensen         return;
7400a316aa50SKlaus Jensen     case NVME_REG_CMBSZ:
740188eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbsz_readonly,
740288eea45cSKlaus Jensen                        "invalid write to read only CMBSZ, ignored");
740388eea45cSKlaus Jensen         return;
7404a316aa50SKlaus Jensen     case NVME_REG_CMBMSC:
740549e03457SKlaus Jensen         if (!NVME_CAP_CMBS(cap)) {
740688eea45cSKlaus Jensen             return;
740788eea45cSKlaus Jensen         }
740888eea45cSKlaus Jensen 
740949e03457SKlaus Jensen         stn_le_p(&n->bar.cmbmsc, size, data);
741088eea45cSKlaus Jensen         n->cmb.cmse = false;
741188eea45cSKlaus Jensen 
741288eea45cSKlaus Jensen         if (NVME_CMBMSC_CRE(data)) {
741388eea45cSKlaus Jensen             nvme_cmb_enable_regs(n);
741488eea45cSKlaus Jensen 
741588eea45cSKlaus Jensen             if (NVME_CMBMSC_CMSE(data)) {
741649e03457SKlaus Jensen                 uint64_t cmbmsc = ldq_le_p(&n->bar.cmbmsc);
741749e03457SKlaus Jensen                 hwaddr cba = NVME_CMBMSC_CBA(cmbmsc) << CMBMSC_CBA_SHIFT;
741888eea45cSKlaus Jensen                 if (cba + int128_get64(n->cmb.mem.size) < cba) {
741949e03457SKlaus Jensen                     uint32_t cmbsts = ldl_le_p(&n->bar.cmbsts);
742049e03457SKlaus Jensen                     NVME_CMBSTS_SET_CBAI(cmbsts, 1);
742149e03457SKlaus Jensen                     stl_le_p(&n->bar.cmbsts, cmbsts);
742288eea45cSKlaus Jensen                     return;
742388eea45cSKlaus Jensen                 }
742488eea45cSKlaus Jensen 
742588eea45cSKlaus Jensen                 n->cmb.cba = cba;
742688eea45cSKlaus Jensen                 n->cmb.cmse = true;
742788eea45cSKlaus Jensen             }
742888eea45cSKlaus Jensen         } else {
742988eea45cSKlaus Jensen             n->bar.cmbsz = 0;
743088eea45cSKlaus Jensen             n->bar.cmbloc = 0;
743188eea45cSKlaus Jensen         }
743288eea45cSKlaus Jensen 
743388eea45cSKlaus Jensen         return;
7434a316aa50SKlaus Jensen     case NVME_REG_CMBMSC + 4:
743549e03457SKlaus Jensen         stl_le_p((uint8_t *)&n->bar.cmbmsc + 4, data);
743688eea45cSKlaus Jensen         return;
743788eea45cSKlaus Jensen 
7438a316aa50SKlaus Jensen     case NVME_REG_PMRCAP:
743988eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrcap_readonly,
744088eea45cSKlaus Jensen                        "invalid write to PMRCAP register, ignored");
744188eea45cSKlaus Jensen         return;
7442a316aa50SKlaus Jensen     case NVME_REG_PMRCTL:
744349e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
74442b02aabcSKlaus Jensen             return;
74452b02aabcSKlaus Jensen         }
74462b02aabcSKlaus Jensen 
744749e03457SKlaus Jensen         stl_le_p(&n->bar.pmrctl, data);
744888eea45cSKlaus Jensen         if (NVME_PMRCTL_EN(data)) {
744988eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, true);
745049e03457SKlaus Jensen             pmrsts = 0;
745188eea45cSKlaus Jensen         } else {
745288eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, false);
745349e03457SKlaus Jensen             NVME_PMRSTS_SET_NRDY(pmrsts, 1);
745488eea45cSKlaus Jensen             n->pmr.cmse = false;
745588eea45cSKlaus Jensen         }
745649e03457SKlaus Jensen         stl_le_p(&n->bar.pmrsts, pmrsts);
745788eea45cSKlaus Jensen         return;
7458a316aa50SKlaus Jensen     case NVME_REG_PMRSTS:
745988eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrsts_readonly,
746088eea45cSKlaus Jensen                        "invalid write to PMRSTS register, ignored");
746188eea45cSKlaus Jensen         return;
7462a316aa50SKlaus Jensen     case NVME_REG_PMREBS:
746388eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrebs_readonly,
746488eea45cSKlaus Jensen                        "invalid write to PMREBS register, ignored");
746588eea45cSKlaus Jensen         return;
7466a316aa50SKlaus Jensen     case NVME_REG_PMRSWTP:
746788eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrswtp_readonly,
746888eea45cSKlaus Jensen                        "invalid write to PMRSWTP register, ignored");
746988eea45cSKlaus Jensen         return;
7470a316aa50SKlaus Jensen     case NVME_REG_PMRMSCL:
747149e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
747288eea45cSKlaus Jensen             return;
747388eea45cSKlaus Jensen         }
747488eea45cSKlaus Jensen 
747549e03457SKlaus Jensen         stl_le_p(&n->bar.pmrmscl, data);
747688eea45cSKlaus Jensen         n->pmr.cmse = false;
747788eea45cSKlaus Jensen 
747849e03457SKlaus Jensen         if (NVME_PMRMSCL_CMSE(data)) {
747949e03457SKlaus Jensen             uint64_t pmrmscu = ldl_le_p(&n->bar.pmrmscu);
748049e03457SKlaus Jensen             hwaddr cba = pmrmscu << 32 |
748149e03457SKlaus Jensen                 (NVME_PMRMSCL_CBA(data) << PMRMSCL_CBA_SHIFT);
748288eea45cSKlaus Jensen             if (cba + int128_get64(n->pmr.dev->mr.size) < cba) {
748349e03457SKlaus Jensen                 NVME_PMRSTS_SET_CBAI(pmrsts, 1);
748449e03457SKlaus Jensen                 stl_le_p(&n->bar.pmrsts, pmrsts);
748588eea45cSKlaus Jensen                 return;
748688eea45cSKlaus Jensen             }
748788eea45cSKlaus Jensen 
748888eea45cSKlaus Jensen             n->pmr.cmse = true;
748988eea45cSKlaus Jensen             n->pmr.cba = cba;
749088eea45cSKlaus Jensen         }
749188eea45cSKlaus Jensen 
749288eea45cSKlaus Jensen         return;
7493a316aa50SKlaus Jensen     case NVME_REG_PMRMSCU:
749449e03457SKlaus Jensen         if (!NVME_CAP_PMRS(cap)) {
749588eea45cSKlaus Jensen             return;
749688eea45cSKlaus Jensen         }
749788eea45cSKlaus Jensen 
749849e03457SKlaus Jensen         stl_le_p(&n->bar.pmrmscu, data);
749988eea45cSKlaus Jensen         return;
750088eea45cSKlaus Jensen     default:
750188eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_invalid,
750288eea45cSKlaus Jensen                        "invalid MMIO write,"
750388eea45cSKlaus Jensen                        " offset=0x%"PRIx64", data=%"PRIx64"",
750488eea45cSKlaus Jensen                        offset, data);
750588eea45cSKlaus Jensen         break;
750688eea45cSKlaus Jensen     }
750788eea45cSKlaus Jensen }
750888eea45cSKlaus Jensen 
750988eea45cSKlaus Jensen static uint64_t nvme_mmio_read(void *opaque, hwaddr addr, unsigned size)
751088eea45cSKlaus Jensen {
751188eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
751288eea45cSKlaus Jensen     uint8_t *ptr = (uint8_t *)&n->bar;
751388eea45cSKlaus Jensen 
751488eea45cSKlaus Jensen     trace_pci_nvme_mmio_read(addr, size);
751588eea45cSKlaus Jensen 
751688eea45cSKlaus Jensen     if (unlikely(addr & (sizeof(uint32_t) - 1))) {
751788eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_misaligned32,
751888eea45cSKlaus Jensen                        "MMIO read not 32-bit aligned,"
751988eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
752088eea45cSKlaus Jensen         /* should RAZ, fall through for now */
752188eea45cSKlaus Jensen     } else if (unlikely(size < sizeof(uint32_t))) {
752288eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_toosmall,
752388eea45cSKlaus Jensen                        "MMIO read smaller than 32-bits,"
752488eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
752588eea45cSKlaus Jensen         /* should RAZ, fall through for now */
752688eea45cSKlaus Jensen     }
752788eea45cSKlaus Jensen 
75285029de44SKlaus Jensen     if (addr > sizeof(n->bar) - size) {
75295029de44SKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_invalid_ofs,
75305029de44SKlaus Jensen                        "MMIO read beyond last register,"
75315029de44SKlaus Jensen                        " offset=0x%"PRIx64", returning 0", addr);
75325029de44SKlaus Jensen 
75335029de44SKlaus Jensen         return 0;
75345029de44SKlaus Jensen     }
75355029de44SKlaus Jensen 
753648b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !nvme_sctrl(n)->scs &&
753711871f53SŁukasz Gieryk         addr != NVME_REG_CSTS) {
753811871f53SŁukasz Gieryk         trace_pci_nvme_err_ignored_mmio_vf_offline(addr, size);
753911871f53SŁukasz Gieryk         return 0;
754011871f53SŁukasz Gieryk     }
754111871f53SŁukasz Gieryk 
754288eea45cSKlaus Jensen     /*
754388eea45cSKlaus Jensen      * When PMRWBM bit 1 is set then read from
754488eea45cSKlaus Jensen      * from PMRSTS should ensure prior writes
754588eea45cSKlaus Jensen      * made it to persistent media
754688eea45cSKlaus Jensen      */
7547a316aa50SKlaus Jensen     if (addr == NVME_REG_PMRSTS &&
754849e03457SKlaus Jensen         (NVME_PMRCAP_PMRWBM(ldl_le_p(&n->bar.pmrcap)) & 0x02)) {
754988eea45cSKlaus Jensen         memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
755088eea45cSKlaus Jensen     }
75515029de44SKlaus Jensen 
755249e03457SKlaus Jensen     return ldn_le_p(ptr + addr, size);
755388eea45cSKlaus Jensen }
755488eea45cSKlaus Jensen 
755588eea45cSKlaus Jensen static void nvme_process_db(NvmeCtrl *n, hwaddr addr, int val)
755688eea45cSKlaus Jensen {
755748b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
755888eea45cSKlaus Jensen     uint32_t qid;
755988eea45cSKlaus Jensen 
756088eea45cSKlaus Jensen     if (unlikely(addr & ((1 << 2) - 1))) {
756188eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_db_wr_misaligned,
756288eea45cSKlaus Jensen                        "doorbell write not 32-bit aligned,"
756388eea45cSKlaus Jensen                        " offset=0x%"PRIx64", ignoring", addr);
756488eea45cSKlaus Jensen         return;
756588eea45cSKlaus Jensen     }
756688eea45cSKlaus Jensen 
756788eea45cSKlaus Jensen     if (((addr - 0x1000) >> 2) & 1) {
756888eea45cSKlaus Jensen         /* Completion queue doorbell write */
756988eea45cSKlaus Jensen 
757088eea45cSKlaus Jensen         uint16_t new_head = val & 0xffff;
757188eea45cSKlaus Jensen         int start_sqs;
757288eea45cSKlaus Jensen         NvmeCQueue *cq;
757388eea45cSKlaus Jensen 
757488eea45cSKlaus Jensen         qid = (addr - (0x1000 + (1 << 2))) >> 3;
757588eea45cSKlaus Jensen         if (unlikely(nvme_check_cqid(n, qid))) {
757688eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cq,
757788eea45cSKlaus Jensen                            "completion queue doorbell write"
757888eea45cSKlaus Jensen                            " for nonexistent queue,"
757988eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
758088eea45cSKlaus Jensen 
758188eea45cSKlaus Jensen             /*
758288eea45cSKlaus Jensen              * NVM Express v1.3d, Section 4.1 state: "If host software writes
758388eea45cSKlaus Jensen              * an invalid value to the Submission Queue Tail Doorbell or
758488eea45cSKlaus Jensen              * Completion Queue Head Doorbell regiter and an Asynchronous Event
758588eea45cSKlaus Jensen              * Request command is outstanding, then an asynchronous event is
758688eea45cSKlaus Jensen              * posted to the Admin Completion Queue with a status code of
758788eea45cSKlaus Jensen              * Invalid Doorbell Write Value."
758888eea45cSKlaus Jensen              *
758988eea45cSKlaus Jensen              * Also note that the spec includes the "Invalid Doorbell Register"
759088eea45cSKlaus Jensen              * status code, but nowhere does it specify when to use it.
759188eea45cSKlaus Jensen              * However, it seems reasonable to use it here in a similar
759288eea45cSKlaus Jensen              * fashion.
759388eea45cSKlaus Jensen              */
759488eea45cSKlaus Jensen             if (n->outstanding_aers) {
759588eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
759688eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
759788eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
759888eea45cSKlaus Jensen             }
759988eea45cSKlaus Jensen 
760088eea45cSKlaus Jensen             return;
760188eea45cSKlaus Jensen         }
760288eea45cSKlaus Jensen 
760388eea45cSKlaus Jensen         cq = n->cq[qid];
760488eea45cSKlaus Jensen         if (unlikely(new_head >= cq->size)) {
760588eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cqhead,
760688eea45cSKlaus Jensen                            "completion queue doorbell write value"
760788eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
760888eea45cSKlaus Jensen                            " new_head=%"PRIu16", ignoring",
760988eea45cSKlaus Jensen                            qid, new_head);
761088eea45cSKlaus Jensen 
761188eea45cSKlaus Jensen             if (n->outstanding_aers) {
761288eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
761388eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
761488eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
761588eea45cSKlaus Jensen             }
761688eea45cSKlaus Jensen 
761788eea45cSKlaus Jensen             return;
761888eea45cSKlaus Jensen         }
761988eea45cSKlaus Jensen 
762088eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_cq(cq->cqid, new_head);
762188eea45cSKlaus Jensen 
762288eea45cSKlaus Jensen         start_sqs = nvme_cq_full(cq) ? 1 : 0;
762388eea45cSKlaus Jensen         cq->head = new_head;
76243f7fe8deSJinhao Fan         if (!qid && n->dbbuf_enabled) {
762548b32c28SKlaus Jensen             pci_dma_write(pci, cq->db_addr, &cq->head, sizeof(cq->head));
76263f7fe8deSJinhao Fan         }
762788eea45cSKlaus Jensen         if (start_sqs) {
762888eea45cSKlaus Jensen             NvmeSQueue *sq;
762988eea45cSKlaus Jensen             QTAILQ_FOREACH(sq, &cq->sq_list, entry) {
7630d38cc6fdSKlaus Jensen                 qemu_bh_schedule(sq->bh);
763188eea45cSKlaus Jensen             }
7632d38cc6fdSKlaus Jensen             qemu_bh_schedule(cq->bh);
763388eea45cSKlaus Jensen         }
763488eea45cSKlaus Jensen 
763588eea45cSKlaus Jensen         if (cq->tail == cq->head) {
763683d7ed5cSKlaus Jensen             if (cq->irq_enabled) {
763783d7ed5cSKlaus Jensen                 n->cq_pending--;
763883d7ed5cSKlaus Jensen             }
763983d7ed5cSKlaus Jensen 
764088eea45cSKlaus Jensen             nvme_irq_deassert(n, cq);
764188eea45cSKlaus Jensen         }
764288eea45cSKlaus Jensen     } else {
764388eea45cSKlaus Jensen         /* Submission queue doorbell write */
764488eea45cSKlaus Jensen 
764588eea45cSKlaus Jensen         uint16_t new_tail = val & 0xffff;
764688eea45cSKlaus Jensen         NvmeSQueue *sq;
764788eea45cSKlaus Jensen 
764888eea45cSKlaus Jensen         qid = (addr - 0x1000) >> 3;
764988eea45cSKlaus Jensen         if (unlikely(nvme_check_sqid(n, qid))) {
765088eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sq,
765188eea45cSKlaus Jensen                            "submission queue doorbell write"
765288eea45cSKlaus Jensen                            " for nonexistent queue,"
765388eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
765488eea45cSKlaus Jensen 
765588eea45cSKlaus Jensen             if (n->outstanding_aers) {
765688eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
765788eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
765888eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
765988eea45cSKlaus Jensen             }
766088eea45cSKlaus Jensen 
766188eea45cSKlaus Jensen             return;
766288eea45cSKlaus Jensen         }
766388eea45cSKlaus Jensen 
766488eea45cSKlaus Jensen         sq = n->sq[qid];
766588eea45cSKlaus Jensen         if (unlikely(new_tail >= sq->size)) {
766688eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sqtail,
766788eea45cSKlaus Jensen                            "submission queue doorbell write value"
766888eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
766988eea45cSKlaus Jensen                            " new_tail=%"PRIu16", ignoring",
767088eea45cSKlaus Jensen                            qid, new_tail);
767188eea45cSKlaus Jensen 
767288eea45cSKlaus Jensen             if (n->outstanding_aers) {
767388eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
767488eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
767588eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
767688eea45cSKlaus Jensen             }
767788eea45cSKlaus Jensen 
767888eea45cSKlaus Jensen             return;
767988eea45cSKlaus Jensen         }
768088eea45cSKlaus Jensen 
768188eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_sq(sq->sqid, new_tail);
768288eea45cSKlaus Jensen 
768388eea45cSKlaus Jensen         sq->tail = new_tail;
76843f7fe8deSJinhao Fan         if (!qid && n->dbbuf_enabled) {
76853f7fe8deSJinhao Fan             /*
76863f7fe8deSJinhao Fan              * The spec states "the host shall also update the controller's
76873f7fe8deSJinhao Fan              * corresponding doorbell property to match the value of that entry
76883f7fe8deSJinhao Fan              * in the Shadow Doorbell buffer."
76893f7fe8deSJinhao Fan              *
76903f7fe8deSJinhao Fan              * Since this context is currently a VM trap, we can safely enforce
76913f7fe8deSJinhao Fan              * the requirement from the device side in case the host is
76923f7fe8deSJinhao Fan              * misbehaving.
76933f7fe8deSJinhao Fan              *
76943f7fe8deSJinhao Fan              * Note, we shouldn't have to do this, but various drivers
76953f7fe8deSJinhao Fan              * including ones that run on Linux, are not updating Admin Queues,
76963f7fe8deSJinhao Fan              * so we can't trust reading it for an appropriate sq tail.
76973f7fe8deSJinhao Fan              */
769848b32c28SKlaus Jensen             pci_dma_write(pci, sq->db_addr, &sq->tail, sizeof(sq->tail));
76993f7fe8deSJinhao Fan         }
7700d38cc6fdSKlaus Jensen 
7701d38cc6fdSKlaus Jensen         qemu_bh_schedule(sq->bh);
770288eea45cSKlaus Jensen     }
770388eea45cSKlaus Jensen }
770488eea45cSKlaus Jensen 
770588eea45cSKlaus Jensen static void nvme_mmio_write(void *opaque, hwaddr addr, uint64_t data,
770688eea45cSKlaus Jensen                             unsigned size)
770788eea45cSKlaus Jensen {
770888eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
770988eea45cSKlaus Jensen 
771088eea45cSKlaus Jensen     trace_pci_nvme_mmio_write(addr, data, size);
771188eea45cSKlaus Jensen 
771248b32c28SKlaus Jensen     if (pci_is_vf(PCI_DEVICE(n)) && !nvme_sctrl(n)->scs &&
771311871f53SŁukasz Gieryk         addr != NVME_REG_CSTS) {
771411871f53SŁukasz Gieryk         trace_pci_nvme_err_ignored_mmio_vf_offline(addr, size);
771511871f53SŁukasz Gieryk         return;
771611871f53SŁukasz Gieryk     }
771711871f53SŁukasz Gieryk 
771888eea45cSKlaus Jensen     if (addr < sizeof(n->bar)) {
771988eea45cSKlaus Jensen         nvme_write_bar(n, addr, data, size);
772088eea45cSKlaus Jensen     } else {
772188eea45cSKlaus Jensen         nvme_process_db(n, addr, data);
772288eea45cSKlaus Jensen     }
772388eea45cSKlaus Jensen }
772488eea45cSKlaus Jensen 
772588eea45cSKlaus Jensen static const MemoryRegionOps nvme_mmio_ops = {
772688eea45cSKlaus Jensen     .read = nvme_mmio_read,
772788eea45cSKlaus Jensen     .write = nvme_mmio_write,
772888eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
772988eea45cSKlaus Jensen     .impl = {
773088eea45cSKlaus Jensen         .min_access_size = 2,
773188eea45cSKlaus Jensen         .max_access_size = 8,
773288eea45cSKlaus Jensen     },
773388eea45cSKlaus Jensen };
773488eea45cSKlaus Jensen 
773588eea45cSKlaus Jensen static void nvme_cmb_write(void *opaque, hwaddr addr, uint64_t data,
773688eea45cSKlaus Jensen                            unsigned size)
773788eea45cSKlaus Jensen {
773888eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
773988eea45cSKlaus Jensen     stn_le_p(&n->cmb.buf[addr], size, data);
774088eea45cSKlaus Jensen }
774188eea45cSKlaus Jensen 
774288eea45cSKlaus Jensen static uint64_t nvme_cmb_read(void *opaque, hwaddr addr, unsigned size)
774388eea45cSKlaus Jensen {
774488eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
774588eea45cSKlaus Jensen     return ldn_le_p(&n->cmb.buf[addr], size);
774688eea45cSKlaus Jensen }
774788eea45cSKlaus Jensen 
774888eea45cSKlaus Jensen static const MemoryRegionOps nvme_cmb_ops = {
774988eea45cSKlaus Jensen     .read = nvme_cmb_read,
775088eea45cSKlaus Jensen     .write = nvme_cmb_write,
775188eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
775288eea45cSKlaus Jensen     .impl = {
775388eea45cSKlaus Jensen         .min_access_size = 1,
775488eea45cSKlaus Jensen         .max_access_size = 8,
775588eea45cSKlaus Jensen     },
775688eea45cSKlaus Jensen };
775788eea45cSKlaus Jensen 
7758784fd353SKlaus Jensen static bool nvme_check_params(NvmeCtrl *n, Error **errp)
775988eea45cSKlaus Jensen {
776088eea45cSKlaus Jensen     NvmeParams *params = &n->params;
776188eea45cSKlaus Jensen 
776288eea45cSKlaus Jensen     if (params->num_queues) {
776388eea45cSKlaus Jensen         warn_report("num_queues is deprecated; please use max_ioqpairs "
776488eea45cSKlaus Jensen                     "instead");
776588eea45cSKlaus Jensen 
776688eea45cSKlaus Jensen         params->max_ioqpairs = params->num_queues - 1;
776788eea45cSKlaus Jensen     }
776888eea45cSKlaus Jensen 
776988eea45cSKlaus Jensen     if (n->namespace.blkconf.blk && n->subsys) {
777088eea45cSKlaus Jensen         error_setg(errp, "subsystem support is unavailable with legacy "
777188eea45cSKlaus Jensen                    "namespace ('drive' property)");
7772784fd353SKlaus Jensen         return false;
777388eea45cSKlaus Jensen     }
777488eea45cSKlaus Jensen 
777588eea45cSKlaus Jensen     if (params->max_ioqpairs < 1 ||
777688eea45cSKlaus Jensen         params->max_ioqpairs > NVME_MAX_IOQPAIRS) {
777788eea45cSKlaus Jensen         error_setg(errp, "max_ioqpairs must be between 1 and %d",
777888eea45cSKlaus Jensen                    NVME_MAX_IOQPAIRS);
7779784fd353SKlaus Jensen         return false;
778088eea45cSKlaus Jensen     }
778188eea45cSKlaus Jensen 
778288eea45cSKlaus Jensen     if (params->msix_qsize < 1 ||
778388eea45cSKlaus Jensen         params->msix_qsize > PCI_MSIX_FLAGS_QSIZE + 1) {
778488eea45cSKlaus Jensen         error_setg(errp, "msix_qsize must be between 1 and %d",
778588eea45cSKlaus Jensen                    PCI_MSIX_FLAGS_QSIZE + 1);
7786784fd353SKlaus Jensen         return false;
778788eea45cSKlaus Jensen     }
778888eea45cSKlaus Jensen 
778988eea45cSKlaus Jensen     if (!params->serial) {
779088eea45cSKlaus Jensen         error_setg(errp, "serial property not set");
7791784fd353SKlaus Jensen         return false;
779288eea45cSKlaus Jensen     }
779388eea45cSKlaus Jensen 
779488eea45cSKlaus Jensen     if (n->pmr.dev) {
779588eea45cSKlaus Jensen         if (host_memory_backend_is_mapped(n->pmr.dev)) {
779688eea45cSKlaus Jensen             error_setg(errp, "can't use already busy memdev: %s",
779788eea45cSKlaus Jensen                        object_get_canonical_path_component(OBJECT(n->pmr.dev)));
7798784fd353SKlaus Jensen             return false;
779988eea45cSKlaus Jensen         }
780088eea45cSKlaus Jensen 
780188eea45cSKlaus Jensen         if (!is_power_of_2(n->pmr.dev->size)) {
780288eea45cSKlaus Jensen             error_setg(errp, "pmr backend size needs to be power of 2 in size");
7803784fd353SKlaus Jensen             return false;
780488eea45cSKlaus Jensen         }
780588eea45cSKlaus Jensen 
780688eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, true);
780788eea45cSKlaus Jensen     }
780888eea45cSKlaus Jensen 
780988eea45cSKlaus Jensen     if (n->params.zasl > n->params.mdts) {
781088eea45cSKlaus Jensen         error_setg(errp, "zoned.zasl (Zone Append Size Limit) must be less "
781188eea45cSKlaus Jensen                    "than or equal to mdts (Maximum Data Transfer Size)");
7812784fd353SKlaus Jensen         return false;
781388eea45cSKlaus Jensen     }
781488eea45cSKlaus Jensen 
781588eea45cSKlaus Jensen     if (!n->params.vsl) {
781688eea45cSKlaus Jensen         error_setg(errp, "vsl must be non-zero");
7817784fd353SKlaus Jensen         return false;
781888eea45cSKlaus Jensen     }
781944c2c094SLukasz Maniak 
782044c2c094SLukasz Maniak     if (params->sriov_max_vfs) {
782144c2c094SLukasz Maniak         if (!n->subsys) {
782244c2c094SLukasz Maniak             error_setg(errp, "subsystem is required for the use of SR-IOV");
7823784fd353SKlaus Jensen             return false;
782444c2c094SLukasz Maniak         }
782544c2c094SLukasz Maniak 
782644c2c094SLukasz Maniak         if (params->sriov_max_vfs > NVME_MAX_VFS) {
782744c2c094SLukasz Maniak             error_setg(errp, "sriov_max_vfs must be between 0 and %d",
782844c2c094SLukasz Maniak                        NVME_MAX_VFS);
7829784fd353SKlaus Jensen             return false;
783044c2c094SLukasz Maniak         }
783144c2c094SLukasz Maniak 
783244c2c094SLukasz Maniak         if (params->cmb_size_mb) {
783344c2c094SLukasz Maniak             error_setg(errp, "CMB is not supported with SR-IOV");
7834784fd353SKlaus Jensen             return false;
783544c2c094SLukasz Maniak         }
783644c2c094SLukasz Maniak 
783744c2c094SLukasz Maniak         if (n->pmr.dev) {
783844c2c094SLukasz Maniak             error_setg(errp, "PMR is not supported with SR-IOV");
7839784fd353SKlaus Jensen             return false;
784044c2c094SLukasz Maniak         }
7841746d42b1SŁukasz Gieryk 
7842746d42b1SŁukasz Gieryk         if (!params->sriov_vq_flexible || !params->sriov_vi_flexible) {
7843746d42b1SŁukasz Gieryk             error_setg(errp, "both sriov_vq_flexible and sriov_vi_flexible"
7844746d42b1SŁukasz Gieryk                        " must be set for the use of SR-IOV");
7845784fd353SKlaus Jensen             return false;
7846746d42b1SŁukasz Gieryk         }
7847746d42b1SŁukasz Gieryk 
7848746d42b1SŁukasz Gieryk         if (params->sriov_vq_flexible < params->sriov_max_vfs * 2) {
7849746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_vq_flexible must be greater than or equal"
7850746d42b1SŁukasz Gieryk                        " to %d (sriov_max_vfs * 2)", params->sriov_max_vfs * 2);
7851784fd353SKlaus Jensen             return false;
7852746d42b1SŁukasz Gieryk         }
7853746d42b1SŁukasz Gieryk 
7854746d42b1SŁukasz Gieryk         if (params->max_ioqpairs < params->sriov_vq_flexible + 2) {
7855746d42b1SŁukasz Gieryk             error_setg(errp, "(max_ioqpairs - sriov_vq_flexible) must be"
7856746d42b1SŁukasz Gieryk                        " greater than or equal to 2");
7857784fd353SKlaus Jensen             return false;
7858746d42b1SŁukasz Gieryk         }
7859746d42b1SŁukasz Gieryk 
7860746d42b1SŁukasz Gieryk         if (params->sriov_vi_flexible < params->sriov_max_vfs) {
7861746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_vi_flexible must be greater than or equal"
7862746d42b1SŁukasz Gieryk                        " to %d (sriov_max_vfs)", params->sriov_max_vfs);
7863784fd353SKlaus Jensen             return false;
7864746d42b1SŁukasz Gieryk         }
7865746d42b1SŁukasz Gieryk 
7866746d42b1SŁukasz Gieryk         if (params->msix_qsize < params->sriov_vi_flexible + 1) {
7867746d42b1SŁukasz Gieryk             error_setg(errp, "(msix_qsize - sriov_vi_flexible) must be"
7868746d42b1SŁukasz Gieryk                        " greater than or equal to 1");
7869784fd353SKlaus Jensen             return false;
7870746d42b1SŁukasz Gieryk         }
7871746d42b1SŁukasz Gieryk 
7872746d42b1SŁukasz Gieryk         if (params->sriov_max_vi_per_vf &&
7873746d42b1SŁukasz Gieryk             (params->sriov_max_vi_per_vf - 1) % NVME_VF_RES_GRANULARITY) {
7874746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_max_vi_per_vf must meet:"
7875746d42b1SŁukasz Gieryk                        " (sriov_max_vi_per_vf - 1) %% %d == 0 and"
7876746d42b1SŁukasz Gieryk                        " sriov_max_vi_per_vf >= 1", NVME_VF_RES_GRANULARITY);
7877784fd353SKlaus Jensen             return false;
7878746d42b1SŁukasz Gieryk         }
7879746d42b1SŁukasz Gieryk 
7880746d42b1SŁukasz Gieryk         if (params->sriov_max_vq_per_vf &&
7881746d42b1SŁukasz Gieryk             (params->sriov_max_vq_per_vf < 2 ||
7882746d42b1SŁukasz Gieryk              (params->sriov_max_vq_per_vf - 1) % NVME_VF_RES_GRANULARITY)) {
7883746d42b1SŁukasz Gieryk             error_setg(errp, "sriov_max_vq_per_vf must meet:"
7884746d42b1SŁukasz Gieryk                        " (sriov_max_vq_per_vf - 1) %% %d == 0 and"
7885746d42b1SŁukasz Gieryk                        " sriov_max_vq_per_vf >= 2", NVME_VF_RES_GRANULARITY);
7886784fd353SKlaus Jensen             return false;
7887746d42b1SŁukasz Gieryk         }
788844c2c094SLukasz Maniak     }
7889784fd353SKlaus Jensen 
7890784fd353SKlaus Jensen     return true;
789188eea45cSKlaus Jensen }
789288eea45cSKlaus Jensen 
789388eea45cSKlaus Jensen static void nvme_init_state(NvmeCtrl *n)
789488eea45cSKlaus Jensen {
78955e6f963fSLukasz Maniak     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
789699f48ae7SLukasz Maniak     NvmeSecCtrlList *list = &n->sec_ctrl_list;
789799f48ae7SLukasz Maniak     NvmeSecCtrlEntry *sctrl;
789848b32c28SKlaus Jensen     PCIDevice *pci = PCI_DEVICE(n);
7899746d42b1SŁukasz Gieryk     uint8_t max_vfs;
790099f48ae7SLukasz Maniak     int i;
79015e6f963fSLukasz Maniak 
790248b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
7903746d42b1SŁukasz Gieryk         sctrl = nvme_sctrl(n);
7904746d42b1SŁukasz Gieryk         max_vfs = 0;
7905746d42b1SŁukasz Gieryk         n->conf_ioqpairs = sctrl->nvq ? le16_to_cpu(sctrl->nvq) - 1 : 0;
7906746d42b1SŁukasz Gieryk         n->conf_msix_qsize = sctrl->nvi ? le16_to_cpu(sctrl->nvi) : 1;
7907746d42b1SŁukasz Gieryk     } else {
7908746d42b1SŁukasz Gieryk         max_vfs = n->params.sriov_max_vfs;
7909decc0261SŁukasz Gieryk         n->conf_ioqpairs = n->params.max_ioqpairs;
7910decc0261SŁukasz Gieryk         n->conf_msix_qsize = n->params.msix_qsize;
7911746d42b1SŁukasz Gieryk     }
7912decc0261SŁukasz Gieryk 
791388eea45cSKlaus Jensen     n->sq = g_new0(NvmeSQueue *, n->params.max_ioqpairs + 1);
791488eea45cSKlaus Jensen     n->cq = g_new0(NvmeCQueue *, n->params.max_ioqpairs + 1);
791588eea45cSKlaus Jensen     n->temperature = NVME_TEMPERATURE;
791688eea45cSKlaus Jensen     n->features.temp_thresh_hi = NVME_TEMPERATURE_WARNING;
791788eea45cSKlaus Jensen     n->starttime_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
791888eea45cSKlaus Jensen     n->aer_reqs = g_new0(NvmeRequest *, n->params.aerl + 1);
7919b7698b91SŁukasz Gieryk     QTAILQ_INIT(&n->aer_queue);
79205e6f963fSLukasz Maniak 
7921746d42b1SŁukasz Gieryk     list->numcntl = cpu_to_le16(max_vfs);
7922746d42b1SŁukasz Gieryk     for (i = 0; i < max_vfs; i++) {
792399f48ae7SLukasz Maniak         sctrl = &list->sec[i];
792499f48ae7SLukasz Maniak         sctrl->pcid = cpu_to_le16(n->cntlid);
792599f48ae7SLukasz Maniak         sctrl->vfn = cpu_to_le16(i + 1);
792699f48ae7SLukasz Maniak     }
792799f48ae7SLukasz Maniak 
79285e6f963fSLukasz Maniak     cap->cntlid = cpu_to_le16(n->cntlid);
7929746d42b1SŁukasz Gieryk     cap->crt = NVME_CRT_VQ | NVME_CRT_VI;
7930746d42b1SŁukasz Gieryk 
793148b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
7932746d42b1SŁukasz Gieryk         cap->vqprt = cpu_to_le16(1 + n->conf_ioqpairs);
7933746d42b1SŁukasz Gieryk     } else {
7934746d42b1SŁukasz Gieryk         cap->vqprt = cpu_to_le16(1 + n->params.max_ioqpairs -
7935746d42b1SŁukasz Gieryk                                  n->params.sriov_vq_flexible);
7936746d42b1SŁukasz Gieryk         cap->vqfrt = cpu_to_le32(n->params.sriov_vq_flexible);
7937746d42b1SŁukasz Gieryk         cap->vqrfap = cap->vqfrt;
7938746d42b1SŁukasz Gieryk         cap->vqgran = cpu_to_le16(NVME_VF_RES_GRANULARITY);
7939746d42b1SŁukasz Gieryk         cap->vqfrsm = n->params.sriov_max_vq_per_vf ?
7940746d42b1SŁukasz Gieryk                         cpu_to_le16(n->params.sriov_max_vq_per_vf) :
7941746d42b1SŁukasz Gieryk                         cap->vqfrt / MAX(max_vfs, 1);
7942746d42b1SŁukasz Gieryk     }
7943746d42b1SŁukasz Gieryk 
794448b32c28SKlaus Jensen     if (pci_is_vf(pci)) {
7945746d42b1SŁukasz Gieryk         cap->viprt = cpu_to_le16(n->conf_msix_qsize);
7946746d42b1SŁukasz Gieryk     } else {
7947746d42b1SŁukasz Gieryk         cap->viprt = cpu_to_le16(n->params.msix_qsize -
7948746d42b1SŁukasz Gieryk                                  n->params.sriov_vi_flexible);
7949746d42b1SŁukasz Gieryk         cap->vifrt = cpu_to_le32(n->params.sriov_vi_flexible);
7950746d42b1SŁukasz Gieryk         cap->virfap = cap->vifrt;
7951746d42b1SŁukasz Gieryk         cap->vigran = cpu_to_le16(NVME_VF_RES_GRANULARITY);
7952746d42b1SŁukasz Gieryk         cap->vifrsm = n->params.sriov_max_vi_per_vf ?
7953746d42b1SŁukasz Gieryk                         cpu_to_le16(n->params.sriov_max_vi_per_vf) :
7954746d42b1SŁukasz Gieryk                         cap->vifrt / MAX(max_vfs, 1);
7955746d42b1SŁukasz Gieryk     }
795688eea45cSKlaus Jensen }
795788eea45cSKlaus Jensen 
795888eea45cSKlaus Jensen static void nvme_init_cmb(NvmeCtrl *n, PCIDevice *pci_dev)
795988eea45cSKlaus Jensen {
796088eea45cSKlaus Jensen     uint64_t cmb_size = n->params.cmb_size_mb * MiB;
796149e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
796288eea45cSKlaus Jensen 
796388eea45cSKlaus Jensen     n->cmb.buf = g_malloc0(cmb_size);
796488eea45cSKlaus Jensen     memory_region_init_io(&n->cmb.mem, OBJECT(n), &nvme_cmb_ops, n,
796588eea45cSKlaus Jensen                           "nvme-cmb", cmb_size);
796688eea45cSKlaus Jensen     pci_register_bar(pci_dev, NVME_CMB_BIR,
796788eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
796888eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
796988eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->cmb.mem);
797088eea45cSKlaus Jensen 
797149e03457SKlaus Jensen     NVME_CAP_SET_CMBS(cap, 1);
797249e03457SKlaus Jensen     stq_le_p(&n->bar.cap, cap);
797388eea45cSKlaus Jensen 
797488eea45cSKlaus Jensen     if (n->params.legacy_cmb) {
797588eea45cSKlaus Jensen         nvme_cmb_enable_regs(n);
797688eea45cSKlaus Jensen         n->cmb.cmse = true;
797788eea45cSKlaus Jensen     }
797888eea45cSKlaus Jensen }
797988eea45cSKlaus Jensen 
798088eea45cSKlaus Jensen static void nvme_init_pmr(NvmeCtrl *n, PCIDevice *pci_dev)
798188eea45cSKlaus Jensen {
798249e03457SKlaus Jensen     uint32_t pmrcap = ldl_le_p(&n->bar.pmrcap);
798388eea45cSKlaus Jensen 
798449e03457SKlaus Jensen     NVME_PMRCAP_SET_RDS(pmrcap, 1);
798549e03457SKlaus Jensen     NVME_PMRCAP_SET_WDS(pmrcap, 1);
798649e03457SKlaus Jensen     NVME_PMRCAP_SET_BIR(pmrcap, NVME_PMR_BIR);
798749e03457SKlaus Jensen     /* Turn on bit 1 support */
798849e03457SKlaus Jensen     NVME_PMRCAP_SET_PMRWBM(pmrcap, 0x02);
798949e03457SKlaus Jensen     NVME_PMRCAP_SET_CMSS(pmrcap, 1);
799049e03457SKlaus Jensen     stl_le_p(&n->bar.pmrcap, pmrcap);
799149e03457SKlaus Jensen 
799249e03457SKlaus Jensen     pci_register_bar(pci_dev, NVME_PMR_BIR,
799388eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
799488eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
799588eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->pmr.dev->mr);
799688eea45cSKlaus Jensen 
799788eea45cSKlaus Jensen     memory_region_set_enabled(&n->pmr.dev->mr, false);
799888eea45cSKlaus Jensen }
799988eea45cSKlaus Jensen 
8000aa817713SŁukasz Gieryk static uint64_t nvme_bar_size(unsigned total_queues, unsigned total_irqs,
8001aa817713SŁukasz Gieryk                               unsigned *msix_table_offset,
8002aa817713SŁukasz Gieryk                               unsigned *msix_pba_offset)
8003aa817713SŁukasz Gieryk {
8004aa817713SŁukasz Gieryk     uint64_t bar_size, msix_table_size, msix_pba_size;
8005aa817713SŁukasz Gieryk 
8006aa817713SŁukasz Gieryk     bar_size = sizeof(NvmeBar) + 2 * total_queues * NVME_DB_SIZE;
8007aa817713SŁukasz Gieryk     bar_size = QEMU_ALIGN_UP(bar_size, 4 * KiB);
8008aa817713SŁukasz Gieryk 
8009aa817713SŁukasz Gieryk     if (msix_table_offset) {
8010aa817713SŁukasz Gieryk         *msix_table_offset = bar_size;
8011aa817713SŁukasz Gieryk     }
8012aa817713SŁukasz Gieryk 
8013aa817713SŁukasz Gieryk     msix_table_size = PCI_MSIX_ENTRY_SIZE * total_irqs;
8014aa817713SŁukasz Gieryk     bar_size += msix_table_size;
8015aa817713SŁukasz Gieryk     bar_size = QEMU_ALIGN_UP(bar_size, 4 * KiB);
8016aa817713SŁukasz Gieryk 
8017aa817713SŁukasz Gieryk     if (msix_pba_offset) {
8018aa817713SŁukasz Gieryk         *msix_pba_offset = bar_size;
8019aa817713SŁukasz Gieryk     }
8020aa817713SŁukasz Gieryk 
8021aa817713SŁukasz Gieryk     msix_pba_size = QEMU_ALIGN_UP(total_irqs, 64) / 8;
8022aa817713SŁukasz Gieryk     bar_size += msix_pba_size;
8023aa817713SŁukasz Gieryk 
8024aa817713SŁukasz Gieryk     bar_size = pow2ceil(bar_size);
8025aa817713SŁukasz Gieryk     return bar_size;
8026aa817713SŁukasz Gieryk }
8027aa817713SŁukasz Gieryk 
8028746d42b1SŁukasz Gieryk static void nvme_init_sriov(NvmeCtrl *n, PCIDevice *pci_dev, uint16_t offset)
802944c2c094SLukasz Maniak {
803044c2c094SLukasz Maniak     uint16_t vf_dev_id = n->params.use_intel_id ?
803144c2c094SLukasz Maniak                          PCI_DEVICE_ID_INTEL_NVME : PCI_DEVICE_ID_REDHAT_NVME;
8032746d42b1SŁukasz Gieryk     NvmePriCtrlCap *cap = &n->pri_ctrl_cap;
8033746d42b1SŁukasz Gieryk     uint64_t bar_size = nvme_bar_size(le16_to_cpu(cap->vqfrsm),
8034746d42b1SŁukasz Gieryk                                       le16_to_cpu(cap->vifrsm),
8035746d42b1SŁukasz Gieryk                                       NULL, NULL);
803644c2c094SLukasz Maniak 
803744c2c094SLukasz Maniak     pcie_sriov_pf_init(pci_dev, offset, "nvme", vf_dev_id,
803844c2c094SLukasz Maniak                        n->params.sriov_max_vfs, n->params.sriov_max_vfs,
803944c2c094SLukasz Maniak                        NVME_VF_OFFSET, NVME_VF_STRIDE);
804044c2c094SLukasz Maniak 
804144c2c094SLukasz Maniak     pcie_sriov_pf_init_vf_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
804244c2c094SLukasz Maniak                               PCI_BASE_ADDRESS_MEM_TYPE_64, bar_size);
804344c2c094SLukasz Maniak }
804444c2c094SLukasz Maniak 
80451e9c685eSŁukasz Gieryk static int nvme_add_pm_capability(PCIDevice *pci_dev, uint8_t offset)
80461e9c685eSŁukasz Gieryk {
80471e9c685eSŁukasz Gieryk     Error *err = NULL;
80481e9c685eSŁukasz Gieryk     int ret;
80491e9c685eSŁukasz Gieryk 
80501e9c685eSŁukasz Gieryk     ret = pci_add_capability(pci_dev, PCI_CAP_ID_PM, offset,
80511e9c685eSŁukasz Gieryk                              PCI_PM_SIZEOF, &err);
80521e9c685eSŁukasz Gieryk     if (err) {
80531e9c685eSŁukasz Gieryk         error_report_err(err);
80541e9c685eSŁukasz Gieryk         return ret;
80551e9c685eSŁukasz Gieryk     }
80561e9c685eSŁukasz Gieryk 
80571e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->config + offset + PCI_PM_PMC,
80581e9c685eSŁukasz Gieryk                  PCI_PM_CAP_VER_1_2);
80591e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->config + offset + PCI_PM_CTRL,
80601e9c685eSŁukasz Gieryk                  PCI_PM_CTRL_NO_SOFT_RESET);
80611e9c685eSŁukasz Gieryk     pci_set_word(pci_dev->wmask + offset + PCI_PM_CTRL,
80621e9c685eSŁukasz Gieryk                  PCI_PM_CTRL_STATE_MASK);
80631e9c685eSŁukasz Gieryk 
80641e9c685eSŁukasz Gieryk     return 0;
80651e9c685eSŁukasz Gieryk }
80661e9c685eSŁukasz Gieryk 
8067973f76cfSKlaus Jensen static bool nvme_init_pci(NvmeCtrl *n, PCIDevice *pci_dev, Error **errp)
806888eea45cSKlaus Jensen {
8069973f76cfSKlaus Jensen     ERRP_GUARD();
807088eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
8071aa817713SŁukasz Gieryk     uint64_t bar_size;
807288eea45cSKlaus Jensen     unsigned msix_table_offset, msix_pba_offset;
807388eea45cSKlaus Jensen     int ret;
807488eea45cSKlaus Jensen 
807588eea45cSKlaus Jensen     pci_conf[PCI_INTERRUPT_PIN] = 1;
807688eea45cSKlaus Jensen     pci_config_set_prog_interface(pci_conf, 0x2);
807788eea45cSKlaus Jensen 
807888eea45cSKlaus Jensen     if (n->params.use_intel_id) {
807988eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_INTEL);
808044c2c094SLukasz Maniak         pci_config_set_device_id(pci_conf, PCI_DEVICE_ID_INTEL_NVME);
808188eea45cSKlaus Jensen     } else {
808288eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_REDHAT);
808388eea45cSKlaus Jensen         pci_config_set_device_id(pci_conf, PCI_DEVICE_ID_REDHAT_NVME);
808488eea45cSKlaus Jensen     }
808588eea45cSKlaus Jensen 
808688eea45cSKlaus Jensen     pci_config_set_class(pci_conf, PCI_CLASS_STORAGE_EXPRESS);
80871e9c685eSŁukasz Gieryk     nvme_add_pm_capability(pci_dev, 0x60);
808888eea45cSKlaus Jensen     pcie_endpoint_cap_init(pci_dev, 0x80);
80891e9c685eSŁukasz Gieryk     pcie_cap_flr_init(pci_dev);
809044c2c094SLukasz Maniak     if (n->params.sriov_max_vfs) {
809144c2c094SLukasz Maniak         pcie_ari_init(pci_dev, 0x100, 1);
809244c2c094SLukasz Maniak     }
809388eea45cSKlaus Jensen 
80943bfcc517SŁukasz Gieryk     /* add one to max_ioqpairs to account for the admin queue pair */
8095aa817713SŁukasz Gieryk     bar_size = nvme_bar_size(n->params.max_ioqpairs + 1, n->params.msix_qsize,
8096aa817713SŁukasz Gieryk                              &msix_table_offset, &msix_pba_offset);
809788eea45cSKlaus Jensen 
809888eea45cSKlaus Jensen     memory_region_init(&n->bar0, OBJECT(n), "nvme-bar0", bar_size);
809988eea45cSKlaus Jensen     memory_region_init_io(&n->iomem, OBJECT(n), &nvme_mmio_ops, n, "nvme",
81003bfcc517SŁukasz Gieryk                           msix_table_offset);
810188eea45cSKlaus Jensen     memory_region_add_subregion(&n->bar0, 0, &n->iomem);
810288eea45cSKlaus Jensen 
810344c2c094SLukasz Maniak     if (pci_is_vf(pci_dev)) {
810444c2c094SLukasz Maniak         pcie_sriov_vf_register_bar(pci_dev, 0, &n->bar0);
810544c2c094SLukasz Maniak     } else {
810688eea45cSKlaus Jensen         pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
810788eea45cSKlaus Jensen                          PCI_BASE_ADDRESS_MEM_TYPE_64, &n->bar0);
810844c2c094SLukasz Maniak     }
810988eea45cSKlaus Jensen     ret = msix_init(pci_dev, n->params.msix_qsize,
811088eea45cSKlaus Jensen                     &n->bar0, 0, msix_table_offset,
8111973f76cfSKlaus Jensen                     &n->bar0, 0, msix_pba_offset, 0, errp);
811288eea45cSKlaus Jensen     if (ret == -ENOTSUP) {
8113973f76cfSKlaus Jensen         /* report that msix is not supported, but do not error out */
8114973f76cfSKlaus Jensen         warn_report_err(*errp);
8115973f76cfSKlaus Jensen         *errp = NULL;
8116973f76cfSKlaus Jensen     } else if (ret < 0) {
8117973f76cfSKlaus Jensen         /* propagate error to caller */
8118973f76cfSKlaus Jensen         return false;
811988eea45cSKlaus Jensen     }
812088eea45cSKlaus Jensen 
8121decc0261SŁukasz Gieryk     nvme_update_msixcap_ts(pci_dev, n->conf_msix_qsize);
8122decc0261SŁukasz Gieryk 
812388eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
812488eea45cSKlaus Jensen         nvme_init_cmb(n, pci_dev);
812588eea45cSKlaus Jensen     }
812688eea45cSKlaus Jensen 
812788eea45cSKlaus Jensen     if (n->pmr.dev) {
812888eea45cSKlaus Jensen         nvme_init_pmr(n, pci_dev);
812988eea45cSKlaus Jensen     }
813088eea45cSKlaus Jensen 
813144c2c094SLukasz Maniak     if (!pci_is_vf(pci_dev) && n->params.sriov_max_vfs) {
8132746d42b1SŁukasz Gieryk         nvme_init_sriov(n, pci_dev, 0x120);
813344c2c094SLukasz Maniak     }
813444c2c094SLukasz Maniak 
8135973f76cfSKlaus Jensen     return true;
813688eea45cSKlaus Jensen }
813788eea45cSKlaus Jensen 
813888eea45cSKlaus Jensen static void nvme_init_subnqn(NvmeCtrl *n)
813988eea45cSKlaus Jensen {
814088eea45cSKlaus Jensen     NvmeSubsystem *subsys = n->subsys;
814188eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
814288eea45cSKlaus Jensen 
814388eea45cSKlaus Jensen     if (!subsys) {
814488eea45cSKlaus Jensen         snprintf((char *)id->subnqn, sizeof(id->subnqn),
814588eea45cSKlaus Jensen                  "nqn.2019-08.org.qemu:%s", n->params.serial);
814688eea45cSKlaus Jensen     } else {
814788eea45cSKlaus Jensen         pstrcpy((char *)id->subnqn, sizeof(id->subnqn), (char*)subsys->subnqn);
814888eea45cSKlaus Jensen     }
814988eea45cSKlaus Jensen }
815088eea45cSKlaus Jensen 
815188eea45cSKlaus Jensen static void nvme_init_ctrl(NvmeCtrl *n, PCIDevice *pci_dev)
815288eea45cSKlaus Jensen {
815388eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
815488eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
815549e03457SKlaus Jensen     uint64_t cap = ldq_le_p(&n->bar.cap);
8156746d42b1SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl = nvme_sctrl(n);
8157771dbc3aSKlaus Jensen     uint32_t ctratt;
815888eea45cSKlaus Jensen 
815988eea45cSKlaus Jensen     id->vid = cpu_to_le16(pci_get_word(pci_conf + PCI_VENDOR_ID));
816088eea45cSKlaus Jensen     id->ssvid = cpu_to_le16(pci_get_word(pci_conf + PCI_SUBSYSTEM_VENDOR_ID));
816188eea45cSKlaus Jensen     strpadcpy((char *)id->mn, sizeof(id->mn), "QEMU NVMe Ctrl", ' ');
8162fbba243bSKlaus Jensen     strpadcpy((char *)id->fr, sizeof(id->fr), QEMU_VERSION, ' ');
816388eea45cSKlaus Jensen     strpadcpy((char *)id->sn, sizeof(id->sn), n->params.serial, ' ');
816488eea45cSKlaus Jensen 
816588eea45cSKlaus Jensen     id->cntlid = cpu_to_le16(n->cntlid);
816688eea45cSKlaus Jensen 
816788eea45cSKlaus Jensen     id->oaes = cpu_to_le32(NVME_OAES_NS_ATTR);
8168771dbc3aSKlaus Jensen     ctratt = NVME_CTRATT_ELBAS;
816988eea45cSKlaus Jensen 
817088eea45cSKlaus Jensen     id->rab = 6;
817188eea45cSKlaus Jensen 
817288eea45cSKlaus Jensen     if (n->params.use_intel_id) {
817388eea45cSKlaus Jensen         id->ieee[0] = 0xb3;
817488eea45cSKlaus Jensen         id->ieee[1] = 0x02;
817588eea45cSKlaus Jensen         id->ieee[2] = 0x00;
817688eea45cSKlaus Jensen     } else {
817788eea45cSKlaus Jensen         id->ieee[0] = 0x00;
817888eea45cSKlaus Jensen         id->ieee[1] = 0x54;
817988eea45cSKlaus Jensen         id->ieee[2] = 0x52;
818088eea45cSKlaus Jensen     }
818188eea45cSKlaus Jensen 
818288eea45cSKlaus Jensen     id->mdts = n->params.mdts;
818388eea45cSKlaus Jensen     id->ver = cpu_to_le32(NVME_SPEC_VER);
81843f7fe8deSJinhao Fan     id->oacs =
8185e181d3daSGollu Appalanaidu         cpu_to_le16(NVME_OACS_NS_MGMT | NVME_OACS_FORMAT | NVME_OACS_DBBUF |
8186e181d3daSGollu Appalanaidu                     NVME_OACS_DIRECTIVES);
818788eea45cSKlaus Jensen     id->cntrltype = 0x1;
818888eea45cSKlaus Jensen 
818988eea45cSKlaus Jensen     /*
819088eea45cSKlaus Jensen      * Because the controller always completes the Abort command immediately,
819188eea45cSKlaus Jensen      * there can never be more than one concurrently executing Abort command,
819288eea45cSKlaus Jensen      * so this value is never used for anything. Note that there can easily be
819388eea45cSKlaus Jensen      * many Abort commands in the queues, but they are not considered
819488eea45cSKlaus Jensen      * "executing" until processed by nvme_abort.
819588eea45cSKlaus Jensen      *
819688eea45cSKlaus Jensen      * The specification recommends a value of 3 for Abort Command Limit (four
819788eea45cSKlaus Jensen      * concurrently outstanding Abort commands), so lets use that though it is
819888eea45cSKlaus Jensen      * inconsequential.
819988eea45cSKlaus Jensen      */
820088eea45cSKlaus Jensen     id->acl = 3;
820188eea45cSKlaus Jensen     id->aerl = n->params.aerl;
820288eea45cSKlaus Jensen     id->frmw = (NVME_NUM_FW_SLOTS << 1) | NVME_FRMW_SLOT1_RO;
820388eea45cSKlaus Jensen     id->lpa = NVME_LPA_NS_SMART | NVME_LPA_CSE | NVME_LPA_EXTENDED;
820488eea45cSKlaus Jensen 
820588eea45cSKlaus Jensen     /* recommended default value (~70 C) */
820688eea45cSKlaus Jensen     id->wctemp = cpu_to_le16(NVME_TEMPERATURE_WARNING);
820788eea45cSKlaus Jensen     id->cctemp = cpu_to_le16(NVME_TEMPERATURE_CRITICAL);
820888eea45cSKlaus Jensen 
820988eea45cSKlaus Jensen     id->sqes = (0x6 << 4) | 0x6;
821088eea45cSKlaus Jensen     id->cqes = (0x4 << 4) | 0x4;
821188eea45cSKlaus Jensen     id->nn = cpu_to_le32(NVME_MAX_NAMESPACES);
821288eea45cSKlaus Jensen     id->oncs = cpu_to_le16(NVME_ONCS_WRITE_ZEROES | NVME_ONCS_TIMESTAMP |
821388eea45cSKlaus Jensen                            NVME_ONCS_FEATURES | NVME_ONCS_DSM |
821488eea45cSKlaus Jensen                            NVME_ONCS_COMPARE | NVME_ONCS_COPY);
821588eea45cSKlaus Jensen 
821688eea45cSKlaus Jensen     /*
821788eea45cSKlaus Jensen      * NOTE: If this device ever supports a command set that does NOT use 0x0
821888eea45cSKlaus Jensen      * as a Flush-equivalent operation, support for the broadcast NSID in Flush
821988eea45cSKlaus Jensen      * should probably be removed.
822088eea45cSKlaus Jensen      *
822188eea45cSKlaus Jensen      * See comment in nvme_io_cmd.
822288eea45cSKlaus Jensen      */
822388eea45cSKlaus Jensen     id->vwc = NVME_VWC_NSID_BROADCAST_SUPPORT | NVME_VWC_PRESENT;
822488eea45cSKlaus Jensen 
822544219b60SNaveen Nagar     id->ocfs = cpu_to_le16(NVME_OCFS_COPY_FORMAT_0 | NVME_OCFS_COPY_FORMAT_1);
8226b9147a3aSKlaus Jensen     id->sgls = cpu_to_le32(NVME_CTRL_SGLS_SUPPORT_NO_ALIGN);
822788eea45cSKlaus Jensen 
822888eea45cSKlaus Jensen     nvme_init_subnqn(n);
822988eea45cSKlaus Jensen 
823088eea45cSKlaus Jensen     id->psd[0].mp = cpu_to_le16(0x9c4);
823188eea45cSKlaus Jensen     id->psd[0].enlat = cpu_to_le32(0x10);
823288eea45cSKlaus Jensen     id->psd[0].exlat = cpu_to_le32(0x4);
823388eea45cSKlaus Jensen 
823488eea45cSKlaus Jensen     if (n->subsys) {
823588eea45cSKlaus Jensen         id->cmic |= NVME_CMIC_MULTI_CTRL;
8236771dbc3aSKlaus Jensen         ctratt |= NVME_CTRATT_ENDGRPS;
8237771dbc3aSKlaus Jensen 
8238771dbc3aSKlaus Jensen         id->endgidmax = cpu_to_le16(0x1);
823973064edfSJesper Devantier 
824073064edfSJesper Devantier         if (n->subsys->endgrp.fdp.enabled) {
824173064edfSJesper Devantier             ctratt |= NVME_CTRATT_FDPS;
824273064edfSJesper Devantier         }
824388eea45cSKlaus Jensen     }
824488eea45cSKlaus Jensen 
8245771dbc3aSKlaus Jensen     id->ctratt = cpu_to_le32(ctratt);
8246771dbc3aSKlaus Jensen 
824749e03457SKlaus Jensen     NVME_CAP_SET_MQES(cap, 0x7ff);
824849e03457SKlaus Jensen     NVME_CAP_SET_CQR(cap, 1);
824949e03457SKlaus Jensen     NVME_CAP_SET_TO(cap, 0xf);
825049e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_NVM);
825149e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_CSI_SUPP);
825249e03457SKlaus Jensen     NVME_CAP_SET_CSS(cap, NVME_CAP_CSS_ADMIN_ONLY);
825349e03457SKlaus Jensen     NVME_CAP_SET_MPSMAX(cap, 4);
825449e03457SKlaus Jensen     NVME_CAP_SET_CMBS(cap, n->params.cmb_size_mb ? 1 : 0);
825549e03457SKlaus Jensen     NVME_CAP_SET_PMRS(cap, n->pmr.dev ? 1 : 0);
825649e03457SKlaus Jensen     stq_le_p(&n->bar.cap, cap);
825788eea45cSKlaus Jensen 
825849e03457SKlaus Jensen     stl_le_p(&n->bar.vs, NVME_SPEC_VER);
825988eea45cSKlaus Jensen     n->bar.intmc = n->bar.intms = 0;
8260746d42b1SŁukasz Gieryk 
826148b32c28SKlaus Jensen     if (pci_is_vf(pci_dev) && !sctrl->scs) {
8262746d42b1SŁukasz Gieryk         stl_le_p(&n->bar.csts, NVME_CSTS_FAILED);
8263746d42b1SŁukasz Gieryk     }
826488eea45cSKlaus Jensen }
826588eea45cSKlaus Jensen 
826688eea45cSKlaus Jensen static int nvme_init_subsys(NvmeCtrl *n, Error **errp)
826788eea45cSKlaus Jensen {
826888eea45cSKlaus Jensen     int cntlid;
826988eea45cSKlaus Jensen 
827088eea45cSKlaus Jensen     if (!n->subsys) {
827188eea45cSKlaus Jensen         return 0;
827288eea45cSKlaus Jensen     }
827388eea45cSKlaus Jensen 
827488eea45cSKlaus Jensen     cntlid = nvme_subsys_register_ctrl(n, errp);
827588eea45cSKlaus Jensen     if (cntlid < 0) {
827688eea45cSKlaus Jensen         return -1;
827788eea45cSKlaus Jensen     }
827888eea45cSKlaus Jensen 
827988eea45cSKlaus Jensen     n->cntlid = cntlid;
828088eea45cSKlaus Jensen 
828188eea45cSKlaus Jensen     return 0;
828288eea45cSKlaus Jensen }
828388eea45cSKlaus Jensen 
828488eea45cSKlaus Jensen void nvme_attach_ns(NvmeCtrl *n, NvmeNamespace *ns)
828588eea45cSKlaus Jensen {
828688eea45cSKlaus Jensen     uint32_t nsid = ns->params.nsid;
828788eea45cSKlaus Jensen     assert(nsid && nsid <= NVME_MAX_NAMESPACES);
828888eea45cSKlaus Jensen 
828988eea45cSKlaus Jensen     n->namespaces[nsid] = ns;
829088eea45cSKlaus Jensen     ns->attached++;
829188eea45cSKlaus Jensen 
829288eea45cSKlaus Jensen     n->dmrsl = MIN_NON_ZERO(n->dmrsl,
829388eea45cSKlaus Jensen                             BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
829488eea45cSKlaus Jensen }
829588eea45cSKlaus Jensen 
829688eea45cSKlaus Jensen static void nvme_realize(PCIDevice *pci_dev, Error **errp)
829788eea45cSKlaus Jensen {
829888eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
829948b32c28SKlaus Jensen     DeviceState *dev = DEVICE(pci_dev);
830088eea45cSKlaus Jensen     NvmeNamespace *ns;
830144c2c094SLukasz Maniak     NvmeCtrl *pn = NVME(pcie_sriov_get_pf(pci_dev));
830244c2c094SLukasz Maniak 
830344c2c094SLukasz Maniak     if (pci_is_vf(pci_dev)) {
830444c2c094SLukasz Maniak         /*
830544c2c094SLukasz Maniak          * VFs derive settings from the parent. PF's lifespan exceeds
830644c2c094SLukasz Maniak          * that of VF's, so it's safe to share params.serial.
830744c2c094SLukasz Maniak          */
830844c2c094SLukasz Maniak         memcpy(&n->params, &pn->params, sizeof(NvmeParams));
830944c2c094SLukasz Maniak         n->subsys = pn->subsys;
831044c2c094SLukasz Maniak     }
831188eea45cSKlaus Jensen 
8312784fd353SKlaus Jensen     if (!nvme_check_params(n, errp)) {
831388eea45cSKlaus Jensen         return;
831488eea45cSKlaus Jensen     }
831588eea45cSKlaus Jensen 
831648b32c28SKlaus Jensen     qbus_init(&n->bus, sizeof(NvmeBus), TYPE_NVME_BUS, dev, dev->id);
831788eea45cSKlaus Jensen 
831888eea45cSKlaus Jensen     if (nvme_init_subsys(n, errp)) {
831988eea45cSKlaus Jensen         return;
832088eea45cSKlaus Jensen     }
83215e6f963fSLukasz Maniak     nvme_init_state(n);
8322973f76cfSKlaus Jensen     if (!nvme_init_pci(n, pci_dev, errp)) {
83235e6f963fSLukasz Maniak         return;
83245e6f963fSLukasz Maniak     }
832588eea45cSKlaus Jensen     nvme_init_ctrl(n, pci_dev);
832688eea45cSKlaus Jensen 
832788eea45cSKlaus Jensen     /* setup a namespace if the controller drive property was given */
832888eea45cSKlaus Jensen     if (n->namespace.blkconf.blk) {
832988eea45cSKlaus Jensen         ns = &n->namespace;
833088eea45cSKlaus Jensen         ns->params.nsid = 1;
833188eea45cSKlaus Jensen 
83325e4f6bccSKlaus Jensen         if (nvme_ns_setup(ns, errp)) {
833388eea45cSKlaus Jensen             return;
833488eea45cSKlaus Jensen         }
833588eea45cSKlaus Jensen 
833688eea45cSKlaus Jensen         nvme_attach_ns(n, ns);
833788eea45cSKlaus Jensen     }
833888eea45cSKlaus Jensen }
833988eea45cSKlaus Jensen 
834088eea45cSKlaus Jensen static void nvme_exit(PCIDevice *pci_dev)
834188eea45cSKlaus Jensen {
834288eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
834388eea45cSKlaus Jensen     NvmeNamespace *ns;
834488eea45cSKlaus Jensen     int i;
834588eea45cSKlaus Jensen 
83461e9c685eSŁukasz Gieryk     nvme_ctrl_reset(n, NVME_RESET_FUNCTION);
834788eea45cSKlaus Jensen 
83485ffbaeedSKlaus Jensen     if (n->subsys) {
834988eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
835088eea45cSKlaus Jensen             ns = nvme_ns(n, i);
83515ffbaeedSKlaus Jensen             if (ns) {
83525ffbaeedSKlaus Jensen                 ns->attached--;
83535ffbaeedSKlaus Jensen             }
835488eea45cSKlaus Jensen         }
835588eea45cSKlaus Jensen 
8356b0fde9e8SKlaus Jensen         nvme_subsys_unregister_ctrl(n->subsys, n);
8357b0fde9e8SKlaus Jensen     }
8358b0fde9e8SKlaus Jensen 
835988eea45cSKlaus Jensen     g_free(n->cq);
836088eea45cSKlaus Jensen     g_free(n->sq);
836188eea45cSKlaus Jensen     g_free(n->aer_reqs);
836288eea45cSKlaus Jensen 
836388eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
836488eea45cSKlaus Jensen         g_free(n->cmb.buf);
836588eea45cSKlaus Jensen     }
836688eea45cSKlaus Jensen 
836788eea45cSKlaus Jensen     if (n->pmr.dev) {
836888eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, false);
836988eea45cSKlaus Jensen     }
837044c2c094SLukasz Maniak 
837144c2c094SLukasz Maniak     if (!pci_is_vf(pci_dev) && n->params.sriov_max_vfs) {
837244c2c094SLukasz Maniak         pcie_sriov_pf_exit(pci_dev);
837344c2c094SLukasz Maniak     }
837444c2c094SLukasz Maniak 
837588eea45cSKlaus Jensen     msix_uninit(pci_dev, &n->bar0, &n->bar0);
837688eea45cSKlaus Jensen     memory_region_del_subregion(&n->bar0, &n->iomem);
837788eea45cSKlaus Jensen }
837888eea45cSKlaus Jensen 
837988eea45cSKlaus Jensen static Property nvme_props[] = {
838088eea45cSKlaus Jensen     DEFINE_BLOCK_PROPERTIES(NvmeCtrl, namespace.blkconf),
838188eea45cSKlaus Jensen     DEFINE_PROP_LINK("pmrdev", NvmeCtrl, pmr.dev, TYPE_MEMORY_BACKEND,
838288eea45cSKlaus Jensen                      HostMemoryBackend *),
838388eea45cSKlaus Jensen     DEFINE_PROP_LINK("subsys", NvmeCtrl, subsys, TYPE_NVME_SUBSYS,
838488eea45cSKlaus Jensen                      NvmeSubsystem *),
838588eea45cSKlaus Jensen     DEFINE_PROP_STRING("serial", NvmeCtrl, params.serial),
838688eea45cSKlaus Jensen     DEFINE_PROP_UINT32("cmb_size_mb", NvmeCtrl, params.cmb_size_mb, 0),
838788eea45cSKlaus Jensen     DEFINE_PROP_UINT32("num_queues", NvmeCtrl, params.num_queues, 0),
838888eea45cSKlaus Jensen     DEFINE_PROP_UINT32("max_ioqpairs", NvmeCtrl, params.max_ioqpairs, 64),
838988eea45cSKlaus Jensen     DEFINE_PROP_UINT16("msix_qsize", NvmeCtrl, params.msix_qsize, 65),
839088eea45cSKlaus Jensen     DEFINE_PROP_UINT8("aerl", NvmeCtrl, params.aerl, 3),
839188eea45cSKlaus Jensen     DEFINE_PROP_UINT32("aer_max_queued", NvmeCtrl, params.aer_max_queued, 64),
839288eea45cSKlaus Jensen     DEFINE_PROP_UINT8("mdts", NvmeCtrl, params.mdts, 7),
839388eea45cSKlaus Jensen     DEFINE_PROP_UINT8("vsl", NvmeCtrl, params.vsl, 7),
839488eea45cSKlaus Jensen     DEFINE_PROP_BOOL("use-intel-id", NvmeCtrl, params.use_intel_id, false),
839588eea45cSKlaus Jensen     DEFINE_PROP_BOOL("legacy-cmb", NvmeCtrl, params.legacy_cmb, false),
8396e2e137f6SKlaus Jensen     DEFINE_PROP_BOOL("ioeventfd", NvmeCtrl, params.ioeventfd, false),
839788eea45cSKlaus Jensen     DEFINE_PROP_UINT8("zoned.zasl", NvmeCtrl, params.zasl, 0),
8398cccc2651SNiklas Cassel     DEFINE_PROP_BOOL("zoned.auto_transition", NvmeCtrl,
8399cccc2651SNiklas Cassel                      params.auto_transition_zones, true),
840044c2c094SLukasz Maniak     DEFINE_PROP_UINT8("sriov_max_vfs", NvmeCtrl, params.sriov_max_vfs, 0),
8401746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT16("sriov_vq_flexible", NvmeCtrl,
8402746d42b1SŁukasz Gieryk                        params.sriov_vq_flexible, 0),
8403746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT16("sriov_vi_flexible", NvmeCtrl,
8404746d42b1SŁukasz Gieryk                        params.sriov_vi_flexible, 0),
8405746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT8("sriov_max_vi_per_vf", NvmeCtrl,
8406746d42b1SŁukasz Gieryk                       params.sriov_max_vi_per_vf, 0),
8407746d42b1SŁukasz Gieryk     DEFINE_PROP_UINT8("sriov_max_vq_per_vf", NvmeCtrl,
8408746d42b1SŁukasz Gieryk                       params.sriov_max_vq_per_vf, 0),
840988eea45cSKlaus Jensen     DEFINE_PROP_END_OF_LIST(),
841088eea45cSKlaus Jensen };
841188eea45cSKlaus Jensen 
841288eea45cSKlaus Jensen static void nvme_get_smart_warning(Object *obj, Visitor *v, const char *name,
841388eea45cSKlaus Jensen                                    void *opaque, Error **errp)
841488eea45cSKlaus Jensen {
841588eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
841688eea45cSKlaus Jensen     uint8_t value = n->smart_critical_warning;
841788eea45cSKlaus Jensen 
841888eea45cSKlaus Jensen     visit_type_uint8(v, name, &value, errp);
841988eea45cSKlaus Jensen }
842088eea45cSKlaus Jensen 
842188eea45cSKlaus Jensen static void nvme_set_smart_warning(Object *obj, Visitor *v, const char *name,
842288eea45cSKlaus Jensen                                    void *opaque, Error **errp)
842388eea45cSKlaus Jensen {
842488eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
842588eea45cSKlaus Jensen     uint8_t value, old_value, cap = 0, index, event;
842688eea45cSKlaus Jensen 
842788eea45cSKlaus Jensen     if (!visit_type_uint8(v, name, &value, errp)) {
842888eea45cSKlaus Jensen         return;
842988eea45cSKlaus Jensen     }
843088eea45cSKlaus Jensen 
843188eea45cSKlaus Jensen     cap = NVME_SMART_SPARE | NVME_SMART_TEMPERATURE | NVME_SMART_RELIABILITY
843288eea45cSKlaus Jensen           | NVME_SMART_MEDIA_READ_ONLY | NVME_SMART_FAILED_VOLATILE_MEDIA;
843349e03457SKlaus Jensen     if (NVME_CAP_PMRS(ldq_le_p(&n->bar.cap))) {
843488eea45cSKlaus Jensen         cap |= NVME_SMART_PMR_UNRELIABLE;
843588eea45cSKlaus Jensen     }
843688eea45cSKlaus Jensen 
843788eea45cSKlaus Jensen     if ((value & cap) != value) {
843888eea45cSKlaus Jensen         error_setg(errp, "unsupported smart critical warning bits: 0x%x",
843988eea45cSKlaus Jensen                    value & ~cap);
844088eea45cSKlaus Jensen         return;
844188eea45cSKlaus Jensen     }
844288eea45cSKlaus Jensen 
844388eea45cSKlaus Jensen     old_value = n->smart_critical_warning;
844488eea45cSKlaus Jensen     n->smart_critical_warning = value;
844588eea45cSKlaus Jensen 
844688eea45cSKlaus Jensen     /* only inject new bits of smart critical warning */
844788eea45cSKlaus Jensen     for (index = 0; index < NVME_SMART_WARN_MAX; index++) {
844888eea45cSKlaus Jensen         event = 1 << index;
844988eea45cSKlaus Jensen         if (value & ~old_value & event)
845088eea45cSKlaus Jensen             nvme_smart_event(n, event);
845188eea45cSKlaus Jensen     }
845288eea45cSKlaus Jensen }
845388eea45cSKlaus Jensen 
84541e9c685eSŁukasz Gieryk static void nvme_pci_reset(DeviceState *qdev)
84551e9c685eSŁukasz Gieryk {
84561e9c685eSŁukasz Gieryk     PCIDevice *pci_dev = PCI_DEVICE(qdev);
84571e9c685eSŁukasz Gieryk     NvmeCtrl *n = NVME(pci_dev);
84581e9c685eSŁukasz Gieryk 
84591e9c685eSŁukasz Gieryk     trace_pci_nvme_pci_reset();
84601e9c685eSŁukasz Gieryk     nvme_ctrl_reset(n, NVME_RESET_FUNCTION);
84611e9c685eSŁukasz Gieryk }
84621e9c685eSŁukasz Gieryk 
846311871f53SŁukasz Gieryk static void nvme_sriov_pre_write_ctrl(PCIDevice *dev, uint32_t address,
846411871f53SŁukasz Gieryk                                       uint32_t val, int len)
846511871f53SŁukasz Gieryk {
846611871f53SŁukasz Gieryk     NvmeCtrl *n = NVME(dev);
846711871f53SŁukasz Gieryk     NvmeSecCtrlEntry *sctrl;
846811871f53SŁukasz Gieryk     uint16_t sriov_cap = dev->exp.sriov_cap;
846911871f53SŁukasz Gieryk     uint32_t off = address - sriov_cap;
847011871f53SŁukasz Gieryk     int i, num_vfs;
847111871f53SŁukasz Gieryk 
847211871f53SŁukasz Gieryk     if (!sriov_cap) {
847311871f53SŁukasz Gieryk         return;
847411871f53SŁukasz Gieryk     }
847511871f53SŁukasz Gieryk 
847611871f53SŁukasz Gieryk     if (range_covers_byte(off, len, PCI_SRIOV_CTRL)) {
847711871f53SŁukasz Gieryk         if (!(val & PCI_SRIOV_CTRL_VFE)) {
847811871f53SŁukasz Gieryk             num_vfs = pci_get_word(dev->config + sriov_cap + PCI_SRIOV_NUM_VF);
847911871f53SŁukasz Gieryk             for (i = 0; i < num_vfs; i++) {
848011871f53SŁukasz Gieryk                 sctrl = &n->sec_ctrl_list.sec[i];
848111871f53SŁukasz Gieryk                 nvme_virt_set_state(n, le16_to_cpu(sctrl->scid), false);
848211871f53SŁukasz Gieryk             }
848311871f53SŁukasz Gieryk         }
848411871f53SŁukasz Gieryk     }
848511871f53SŁukasz Gieryk }
848611871f53SŁukasz Gieryk 
84871e9c685eSŁukasz Gieryk static void nvme_pci_write_config(PCIDevice *dev, uint32_t address,
84881e9c685eSŁukasz Gieryk                                   uint32_t val, int len)
84891e9c685eSŁukasz Gieryk {
849011871f53SŁukasz Gieryk     nvme_sriov_pre_write_ctrl(dev, address, val, len);
84911e9c685eSŁukasz Gieryk     pci_default_write_config(dev, address, val, len);
84921e9c685eSŁukasz Gieryk     pcie_cap_flr_write_config(dev, address, val, len);
84931e9c685eSŁukasz Gieryk }
84941e9c685eSŁukasz Gieryk 
849588eea45cSKlaus Jensen static const VMStateDescription nvme_vmstate = {
849688eea45cSKlaus Jensen     .name = "nvme",
849788eea45cSKlaus Jensen     .unmigratable = 1,
849888eea45cSKlaus Jensen };
849988eea45cSKlaus Jensen 
850088eea45cSKlaus Jensen static void nvme_class_init(ObjectClass *oc, void *data)
850188eea45cSKlaus Jensen {
850288eea45cSKlaus Jensen     DeviceClass *dc = DEVICE_CLASS(oc);
850388eea45cSKlaus Jensen     PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc);
850488eea45cSKlaus Jensen 
850588eea45cSKlaus Jensen     pc->realize = nvme_realize;
85061e9c685eSŁukasz Gieryk     pc->config_write = nvme_pci_write_config;
850788eea45cSKlaus Jensen     pc->exit = nvme_exit;
850888eea45cSKlaus Jensen     pc->class_id = PCI_CLASS_STORAGE_EXPRESS;
850988eea45cSKlaus Jensen     pc->revision = 2;
851088eea45cSKlaus Jensen 
851188eea45cSKlaus Jensen     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
851288eea45cSKlaus Jensen     dc->desc = "Non-Volatile Memory Express";
851388eea45cSKlaus Jensen     device_class_set_props(dc, nvme_props);
851488eea45cSKlaus Jensen     dc->vmsd = &nvme_vmstate;
85151e9c685eSŁukasz Gieryk     dc->reset = nvme_pci_reset;
851688eea45cSKlaus Jensen }
851788eea45cSKlaus Jensen 
851888eea45cSKlaus Jensen static void nvme_instance_init(Object *obj)
851988eea45cSKlaus Jensen {
852088eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
852188eea45cSKlaus Jensen 
852288eea45cSKlaus Jensen     device_add_bootindex_property(obj, &n->namespace.blkconf.bootindex,
852388eea45cSKlaus Jensen                                   "bootindex", "/namespace@1,0",
852488eea45cSKlaus Jensen                                   DEVICE(obj));
852588eea45cSKlaus Jensen 
852688eea45cSKlaus Jensen     object_property_add(obj, "smart_critical_warning", "uint8",
852788eea45cSKlaus Jensen                         nvme_get_smart_warning,
852888eea45cSKlaus Jensen                         nvme_set_smart_warning, NULL, NULL);
852988eea45cSKlaus Jensen }
853088eea45cSKlaus Jensen 
853188eea45cSKlaus Jensen static const TypeInfo nvme_info = {
853288eea45cSKlaus Jensen     .name          = TYPE_NVME,
853388eea45cSKlaus Jensen     .parent        = TYPE_PCI_DEVICE,
853488eea45cSKlaus Jensen     .instance_size = sizeof(NvmeCtrl),
853588eea45cSKlaus Jensen     .instance_init = nvme_instance_init,
853688eea45cSKlaus Jensen     .class_init    = nvme_class_init,
853788eea45cSKlaus Jensen     .interfaces = (InterfaceInfo[]) {
853888eea45cSKlaus Jensen         { INTERFACE_PCIE_DEVICE },
853988eea45cSKlaus Jensen         { }
854088eea45cSKlaus Jensen     },
854188eea45cSKlaus Jensen };
854288eea45cSKlaus Jensen 
854388eea45cSKlaus Jensen static const TypeInfo nvme_bus_info = {
854488eea45cSKlaus Jensen     .name = TYPE_NVME_BUS,
854588eea45cSKlaus Jensen     .parent = TYPE_BUS,
854688eea45cSKlaus Jensen     .instance_size = sizeof(NvmeBus),
854788eea45cSKlaus Jensen };
854888eea45cSKlaus Jensen 
854988eea45cSKlaus Jensen static void nvme_register_types(void)
855088eea45cSKlaus Jensen {
855188eea45cSKlaus Jensen     type_register_static(&nvme_info);
855288eea45cSKlaus Jensen     type_register_static(&nvme_bus_info);
855388eea45cSKlaus Jensen }
855488eea45cSKlaus Jensen 
855588eea45cSKlaus Jensen type_init(nvme_register_types)
8556