xref: /openbmc/qemu/hw/nvme/ctrl.c (revision b0fde9e8)
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]>, \
3888eea45cSKlaus Jensen  *              subsys=<subsys_id>
3988eea45cSKlaus Jensen  *      -device nvme-ns,drive=<drive_id>,bus=<bus_name>,nsid=<nsid>,\
4088eea45cSKlaus Jensen  *              zoned=<true|false[optional]>, \
4188eea45cSKlaus Jensen  *              subsys=<subsys_id>,detached=<true|false[optional]>
4288eea45cSKlaus Jensen  *
4388eea45cSKlaus Jensen  * Note cmb_size_mb denotes size of CMB in MB. CMB is assumed to be at
4488eea45cSKlaus Jensen  * offset 0 in BAR2 and supports only WDS, RDS and SQS for now. By default, the
4588eea45cSKlaus Jensen  * device will use the "v1.4 CMB scheme" - use the `legacy-cmb` parameter to
4688eea45cSKlaus Jensen  * always enable the CMBLOC and CMBSZ registers (v1.3 behavior).
4788eea45cSKlaus Jensen  *
4888eea45cSKlaus Jensen  * Enabling pmr emulation can be achieved by pointing to memory-backend-file.
4988eea45cSKlaus Jensen  * For example:
5088eea45cSKlaus Jensen  * -object memory-backend-file,id=<mem_id>,share=on,mem-path=<file_path>, \
5188eea45cSKlaus Jensen  *  size=<size> .... -device nvme,...,pmrdev=<mem_id>
5288eea45cSKlaus Jensen  *
5388eea45cSKlaus Jensen  * The PMR will use BAR 4/5 exclusively.
5488eea45cSKlaus Jensen  *
5588eea45cSKlaus Jensen  * To place controller(s) and namespace(s) to a subsystem, then provide
5688eea45cSKlaus Jensen  * nvme-subsys device as above.
5788eea45cSKlaus Jensen  *
5888eea45cSKlaus Jensen  * nvme subsystem device parameters
5988eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
6088eea45cSKlaus Jensen  * - `nqn`
6188eea45cSKlaus Jensen  *   This parameter provides the `<nqn_id>` part of the string
6288eea45cSKlaus Jensen  *   `nqn.2019-08.org.qemu:<nqn_id>` which will be reported in the SUBNQN field
6388eea45cSKlaus Jensen  *   of subsystem controllers. Note that `<nqn_id>` should be unique per
6488eea45cSKlaus Jensen  *   subsystem, but this is not enforced by QEMU. If not specified, it will
6588eea45cSKlaus Jensen  *   default to the value of the `id` parameter (`<subsys_id>`).
6688eea45cSKlaus Jensen  *
6788eea45cSKlaus Jensen  * nvme device parameters
6888eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~
6988eea45cSKlaus Jensen  * - `subsys`
7088eea45cSKlaus Jensen  *   Specifying this parameter attaches the controller to the subsystem and
7188eea45cSKlaus Jensen  *   the SUBNQN field in the controller will report the NQN of the subsystem
7288eea45cSKlaus Jensen  *   device. This also enables multi controller capability represented in
7388eea45cSKlaus Jensen  *   Identify Controller data structure in CMIC (Controller Multi-path I/O and
7488eea45cSKlaus Jensen  *   Namesapce Sharing Capabilities).
7588eea45cSKlaus Jensen  *
7688eea45cSKlaus Jensen  * - `aerl`
7788eea45cSKlaus Jensen  *   The Asynchronous Event Request Limit (AERL). Indicates the maximum number
7888eea45cSKlaus Jensen  *   of concurrently outstanding Asynchronous Event Request commands support
7988eea45cSKlaus Jensen  *   by the controller. This is a 0's based value.
8088eea45cSKlaus Jensen  *
8188eea45cSKlaus Jensen  * - `aer_max_queued`
8288eea45cSKlaus Jensen  *   This is the maximum number of events that the device will enqueue for
8388eea45cSKlaus Jensen  *   completion when there are no outstanding AERs. When the maximum number of
8488eea45cSKlaus Jensen  *   enqueued events are reached, subsequent events will be dropped.
8588eea45cSKlaus Jensen  *
8688eea45cSKlaus Jensen  * - `mdts`
8788eea45cSKlaus Jensen  *   Indicates the maximum data transfer size for a command that transfers data
8888eea45cSKlaus Jensen  *   between host-accessible memory and the controller. The value is specified
8988eea45cSKlaus Jensen  *   as a power of two (2^n) and is in units of the minimum memory page size
9088eea45cSKlaus Jensen  *   (CAP.MPSMIN). The default value is 7 (i.e. 512 KiB).
9188eea45cSKlaus Jensen  *
9288eea45cSKlaus Jensen  * - `vsl`
9388eea45cSKlaus Jensen  *   Indicates the maximum data size limit for the Verify command. Like `mdts`,
9488eea45cSKlaus Jensen  *   this value is specified as a power of two (2^n) and is in units of the
9588eea45cSKlaus Jensen  *   minimum memory page size (CAP.MPSMIN). The default value is 7 (i.e. 512
9688eea45cSKlaus Jensen  *   KiB).
9788eea45cSKlaus Jensen  *
9888eea45cSKlaus Jensen  * - `zoned.zasl`
9988eea45cSKlaus Jensen  *   Indicates the maximum data transfer size for the Zone Append command. Like
10088eea45cSKlaus Jensen  *   `mdts`, the value is specified as a power of two (2^n) and is in units of
10188eea45cSKlaus Jensen  *   the minimum memory page size (CAP.MPSMIN). The default value is 0 (i.e.
10288eea45cSKlaus Jensen  *   defaulting to the value of `mdts`).
10388eea45cSKlaus Jensen  *
104cccc2651SNiklas Cassel  * - `zoned.auto_transition`
105cccc2651SNiklas Cassel  *   Indicates if zones in zone state implicitly opened can be automatically
106cccc2651SNiklas Cassel  *   transitioned to zone state closed for resource management purposes.
107cccc2651SNiklas Cassel  *   Defaults to 'on'.
108cccc2651SNiklas Cassel  *
10988eea45cSKlaus Jensen  * nvme namespace device parameters
11088eea45cSKlaus Jensen  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
11188eea45cSKlaus Jensen  * - `shared`
11288eea45cSKlaus Jensen  *   When the parent nvme device (as defined explicitly by the 'bus' parameter
11388eea45cSKlaus Jensen  *   or implicitly by the most recently defined NvmeBus) is linked to an
11488eea45cSKlaus Jensen  *   nvme-subsys device, the namespace will be attached to all controllers in
11588eea45cSKlaus Jensen  *   the subsystem. If set to 'off' (the default), the namespace will remain a
11688eea45cSKlaus Jensen  *   private namespace and may only be attached to a single controller at a
11788eea45cSKlaus Jensen  *   time.
11888eea45cSKlaus Jensen  *
11988eea45cSKlaus Jensen  * - `detached`
12088eea45cSKlaus Jensen  *   This parameter is only valid together with the `subsys` parameter. If left
12188eea45cSKlaus Jensen  *   at the default value (`false/off`), the namespace will be attached to all
12288eea45cSKlaus Jensen  *   controllers in the NVMe subsystem at boot-up. If set to `true/on`, the
123eeef4329SGollu Appalanaidu  *   namespace will be available in the subsystem but not attached to any
12488eea45cSKlaus Jensen  *   controllers.
12588eea45cSKlaus Jensen  *
12688eea45cSKlaus Jensen  * Setting `zoned` to true selects Zoned Command Set at the namespace.
12788eea45cSKlaus Jensen  * In this case, the following namespace properties are available to configure
12888eea45cSKlaus Jensen  * zoned operation:
12988eea45cSKlaus Jensen  *     zoned.zone_size=<zone size in bytes, default: 128MiB>
13088eea45cSKlaus Jensen  *         The number may be followed by K, M, G as in kilo-, mega- or giga-.
13188eea45cSKlaus Jensen  *
13288eea45cSKlaus Jensen  *     zoned.zone_capacity=<zone capacity in bytes, default: zone size>
13388eea45cSKlaus Jensen  *         The value 0 (default) forces zone capacity to be the same as zone
13488eea45cSKlaus Jensen  *         size. The value of this property may not exceed zone size.
13588eea45cSKlaus Jensen  *
13688eea45cSKlaus Jensen  *     zoned.descr_ext_size=<zone descriptor extension size, default 0>
13788eea45cSKlaus Jensen  *         This value needs to be specified in 64B units. If it is zero,
13888eea45cSKlaus Jensen  *         namespace(s) will not support zone descriptor extensions.
13988eea45cSKlaus Jensen  *
14088eea45cSKlaus Jensen  *     zoned.max_active=<Maximum Active Resources (zones), default: 0>
14188eea45cSKlaus Jensen  *         The default value means there is no limit to the number of
14288eea45cSKlaus Jensen  *         concurrently active zones.
14388eea45cSKlaus Jensen  *
14488eea45cSKlaus Jensen  *     zoned.max_open=<Maximum Open Resources (zones), default: 0>
14588eea45cSKlaus Jensen  *         The default value means there is no limit to the number of
14688eea45cSKlaus Jensen  *         concurrently open zones.
14788eea45cSKlaus Jensen  *
14888eea45cSKlaus Jensen  *     zoned.cross_read=<enable RAZB, default: false>
14988eea45cSKlaus Jensen  *         Setting this property to true enables Read Across Zone Boundaries.
15088eea45cSKlaus Jensen  */
15188eea45cSKlaus Jensen 
15288eea45cSKlaus Jensen #include "qemu/osdep.h"
15388eea45cSKlaus Jensen #include "qemu/cutils.h"
15488eea45cSKlaus Jensen #include "qemu/error-report.h"
15588eea45cSKlaus Jensen #include "qemu/log.h"
15688eea45cSKlaus Jensen #include "qemu/units.h"
15788eea45cSKlaus Jensen #include "qapi/error.h"
15888eea45cSKlaus Jensen #include "qapi/visitor.h"
15988eea45cSKlaus Jensen #include "sysemu/sysemu.h"
16088eea45cSKlaus Jensen #include "sysemu/block-backend.h"
16188eea45cSKlaus Jensen #include "sysemu/hostmem.h"
16288eea45cSKlaus Jensen #include "hw/pci/msix.h"
16388eea45cSKlaus Jensen #include "migration/vmstate.h"
16488eea45cSKlaus Jensen 
16588eea45cSKlaus Jensen #include "nvme.h"
16688eea45cSKlaus Jensen #include "trace.h"
16788eea45cSKlaus Jensen 
16888eea45cSKlaus Jensen #define NVME_MAX_IOQPAIRS 0xffff
16988eea45cSKlaus Jensen #define NVME_DB_SIZE  4
17088eea45cSKlaus Jensen #define NVME_SPEC_VER 0x00010400
17188eea45cSKlaus Jensen #define NVME_CMB_BIR 2
17288eea45cSKlaus Jensen #define NVME_PMR_BIR 4
17388eea45cSKlaus Jensen #define NVME_TEMPERATURE 0x143
17488eea45cSKlaus Jensen #define NVME_TEMPERATURE_WARNING 0x157
17588eea45cSKlaus Jensen #define NVME_TEMPERATURE_CRITICAL 0x175
17688eea45cSKlaus Jensen #define NVME_NUM_FW_SLOTS 1
17788eea45cSKlaus Jensen #define NVME_DEFAULT_MAX_ZA_SIZE (128 * KiB)
17888eea45cSKlaus Jensen 
17988eea45cSKlaus Jensen #define NVME_GUEST_ERR(trace, fmt, ...) \
18088eea45cSKlaus Jensen     do { \
18188eea45cSKlaus Jensen         (trace_##trace)(__VA_ARGS__); \
18288eea45cSKlaus Jensen         qemu_log_mask(LOG_GUEST_ERROR, #trace \
18388eea45cSKlaus Jensen             " in %s: " fmt "\n", __func__, ## __VA_ARGS__); \
18488eea45cSKlaus Jensen     } while (0)
18588eea45cSKlaus Jensen 
18688eea45cSKlaus Jensen static const bool nvme_feature_support[NVME_FID_MAX] = {
18788eea45cSKlaus Jensen     [NVME_ARBITRATION]              = true,
18888eea45cSKlaus Jensen     [NVME_POWER_MANAGEMENT]         = true,
18988eea45cSKlaus Jensen     [NVME_TEMPERATURE_THRESHOLD]    = true,
19088eea45cSKlaus Jensen     [NVME_ERROR_RECOVERY]           = true,
19188eea45cSKlaus Jensen     [NVME_VOLATILE_WRITE_CACHE]     = true,
19288eea45cSKlaus Jensen     [NVME_NUMBER_OF_QUEUES]         = true,
19388eea45cSKlaus Jensen     [NVME_INTERRUPT_COALESCING]     = true,
19488eea45cSKlaus Jensen     [NVME_INTERRUPT_VECTOR_CONF]    = true,
19588eea45cSKlaus Jensen     [NVME_WRITE_ATOMICITY]          = true,
19688eea45cSKlaus Jensen     [NVME_ASYNCHRONOUS_EVENT_CONF]  = true,
19788eea45cSKlaus Jensen     [NVME_TIMESTAMP]                = true,
19888eea45cSKlaus Jensen     [NVME_COMMAND_SET_PROFILE]      = true,
19988eea45cSKlaus Jensen };
20088eea45cSKlaus Jensen 
20188eea45cSKlaus Jensen static const uint32_t nvme_feature_cap[NVME_FID_MAX] = {
20288eea45cSKlaus Jensen     [NVME_TEMPERATURE_THRESHOLD]    = NVME_FEAT_CAP_CHANGE,
20388eea45cSKlaus Jensen     [NVME_ERROR_RECOVERY]           = NVME_FEAT_CAP_CHANGE | NVME_FEAT_CAP_NS,
20488eea45cSKlaus Jensen     [NVME_VOLATILE_WRITE_CACHE]     = NVME_FEAT_CAP_CHANGE,
20588eea45cSKlaus Jensen     [NVME_NUMBER_OF_QUEUES]         = NVME_FEAT_CAP_CHANGE,
20688eea45cSKlaus Jensen     [NVME_ASYNCHRONOUS_EVENT_CONF]  = NVME_FEAT_CAP_CHANGE,
20788eea45cSKlaus Jensen     [NVME_TIMESTAMP]                = NVME_FEAT_CAP_CHANGE,
20888eea45cSKlaus Jensen     [NVME_COMMAND_SET_PROFILE]      = NVME_FEAT_CAP_CHANGE,
20988eea45cSKlaus Jensen };
21088eea45cSKlaus Jensen 
21188eea45cSKlaus Jensen static const uint32_t nvme_cse_acs[256] = {
21288eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_SQ]        = NVME_CMD_EFF_CSUPP,
21388eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_SQ]        = NVME_CMD_EFF_CSUPP,
21488eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_LOG_PAGE]     = NVME_CMD_EFF_CSUPP,
21588eea45cSKlaus Jensen     [NVME_ADM_CMD_DELETE_CQ]        = NVME_CMD_EFF_CSUPP,
21688eea45cSKlaus Jensen     [NVME_ADM_CMD_CREATE_CQ]        = NVME_CMD_EFF_CSUPP,
21788eea45cSKlaus Jensen     [NVME_ADM_CMD_IDENTIFY]         = NVME_CMD_EFF_CSUPP,
21888eea45cSKlaus Jensen     [NVME_ADM_CMD_ABORT]            = NVME_CMD_EFF_CSUPP,
21988eea45cSKlaus Jensen     [NVME_ADM_CMD_SET_FEATURES]     = NVME_CMD_EFF_CSUPP,
22088eea45cSKlaus Jensen     [NVME_ADM_CMD_GET_FEATURES]     = NVME_CMD_EFF_CSUPP,
22188eea45cSKlaus Jensen     [NVME_ADM_CMD_ASYNC_EV_REQ]     = NVME_CMD_EFF_CSUPP,
22288eea45cSKlaus Jensen     [NVME_ADM_CMD_NS_ATTACHMENT]    = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_NIC,
22388eea45cSKlaus Jensen     [NVME_ADM_CMD_FORMAT_NVM]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
22488eea45cSKlaus Jensen };
22588eea45cSKlaus Jensen 
22688eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_none[256];
22788eea45cSKlaus Jensen 
22888eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_nvm[256] = {
22988eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
23088eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
23188eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
23288eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
23388eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
23488eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
23588eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
23688eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
23788eea45cSKlaus Jensen };
23888eea45cSKlaus Jensen 
23988eea45cSKlaus Jensen static const uint32_t nvme_cse_iocs_zoned[256] = {
24088eea45cSKlaus Jensen     [NVME_CMD_FLUSH]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
24188eea45cSKlaus Jensen     [NVME_CMD_WRITE_ZEROES]         = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
24288eea45cSKlaus Jensen     [NVME_CMD_WRITE]                = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
24388eea45cSKlaus Jensen     [NVME_CMD_READ]                 = NVME_CMD_EFF_CSUPP,
24488eea45cSKlaus Jensen     [NVME_CMD_DSM]                  = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
24588eea45cSKlaus Jensen     [NVME_CMD_VERIFY]               = NVME_CMD_EFF_CSUPP,
24688eea45cSKlaus Jensen     [NVME_CMD_COPY]                 = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
24788eea45cSKlaus Jensen     [NVME_CMD_COMPARE]              = NVME_CMD_EFF_CSUPP,
24888eea45cSKlaus Jensen     [NVME_CMD_ZONE_APPEND]          = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
24988eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_SEND]       = NVME_CMD_EFF_CSUPP | NVME_CMD_EFF_LBCC,
25088eea45cSKlaus Jensen     [NVME_CMD_ZONE_MGMT_RECV]       = NVME_CMD_EFF_CSUPP,
25188eea45cSKlaus Jensen };
25288eea45cSKlaus Jensen 
25388eea45cSKlaus Jensen static void nvme_process_sq(void *opaque);
25488eea45cSKlaus Jensen 
25588eea45cSKlaus Jensen static uint16_t nvme_sqid(NvmeRequest *req)
25688eea45cSKlaus Jensen {
25788eea45cSKlaus Jensen     return le16_to_cpu(req->sq->sqid);
25888eea45cSKlaus Jensen }
25988eea45cSKlaus Jensen 
26088eea45cSKlaus Jensen static void nvme_assign_zone_state(NvmeNamespace *ns, NvmeZone *zone,
26188eea45cSKlaus Jensen                                    NvmeZoneState state)
26288eea45cSKlaus Jensen {
26388eea45cSKlaus Jensen     if (QTAILQ_IN_USE(zone, entry)) {
26488eea45cSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
26588eea45cSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
26688eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->exp_open_zones, zone, entry);
26788eea45cSKlaus Jensen             break;
26888eea45cSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
26988eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
27088eea45cSKlaus Jensen             break;
27188eea45cSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
27288eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->closed_zones, zone, entry);
27388eea45cSKlaus Jensen             break;
27488eea45cSKlaus Jensen         case NVME_ZONE_STATE_FULL:
27588eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->full_zones, zone, entry);
27688eea45cSKlaus Jensen         default:
27788eea45cSKlaus Jensen             ;
27888eea45cSKlaus Jensen         }
27988eea45cSKlaus Jensen     }
28088eea45cSKlaus Jensen 
28188eea45cSKlaus Jensen     nvme_set_zone_state(zone, state);
28288eea45cSKlaus Jensen 
28388eea45cSKlaus Jensen     switch (state) {
28488eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
28588eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->exp_open_zones, zone, entry);
28688eea45cSKlaus Jensen         break;
28788eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
28888eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->imp_open_zones, zone, entry);
28988eea45cSKlaus Jensen         break;
29088eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
29188eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->closed_zones, zone, entry);
29288eea45cSKlaus Jensen         break;
29388eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
29488eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&ns->full_zones, zone, entry);
29588eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
29688eea45cSKlaus Jensen         break;
29788eea45cSKlaus Jensen     default:
29888eea45cSKlaus Jensen         zone->d.za = 0;
29988eea45cSKlaus Jensen     }
30088eea45cSKlaus Jensen }
30188eea45cSKlaus Jensen 
30288eea45cSKlaus Jensen /*
30388eea45cSKlaus Jensen  * Check if we can open a zone without exceeding open/active limits.
30488eea45cSKlaus Jensen  * AOR stands for "Active and Open Resources" (see TP 4053 section 2.5).
30588eea45cSKlaus Jensen  */
30688eea45cSKlaus Jensen static int nvme_aor_check(NvmeNamespace *ns, uint32_t act, uint32_t opn)
30788eea45cSKlaus Jensen {
30888eea45cSKlaus Jensen     if (ns->params.max_active_zones != 0 &&
30988eea45cSKlaus Jensen         ns->nr_active_zones + act > ns->params.max_active_zones) {
31088eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_active_res(ns->params.max_active_zones);
31188eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_ACTIVE | NVME_DNR;
31288eea45cSKlaus Jensen     }
31388eea45cSKlaus Jensen     if (ns->params.max_open_zones != 0 &&
31488eea45cSKlaus Jensen         ns->nr_open_zones + opn > ns->params.max_open_zones) {
31588eea45cSKlaus Jensen         trace_pci_nvme_err_insuff_open_res(ns->params.max_open_zones);
31688eea45cSKlaus Jensen         return NVME_ZONE_TOO_MANY_OPEN | NVME_DNR;
31788eea45cSKlaus Jensen     }
31888eea45cSKlaus Jensen 
31988eea45cSKlaus Jensen     return NVME_SUCCESS;
32088eea45cSKlaus Jensen }
32188eea45cSKlaus Jensen 
32288eea45cSKlaus Jensen static bool nvme_addr_is_cmb(NvmeCtrl *n, hwaddr addr)
32388eea45cSKlaus Jensen {
32488eea45cSKlaus Jensen     hwaddr hi, lo;
32588eea45cSKlaus Jensen 
32688eea45cSKlaus Jensen     if (!n->cmb.cmse) {
32788eea45cSKlaus Jensen         return false;
32888eea45cSKlaus Jensen     }
32988eea45cSKlaus Jensen 
33088eea45cSKlaus Jensen     lo = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
33188eea45cSKlaus Jensen     hi = lo + int128_get64(n->cmb.mem.size);
33288eea45cSKlaus Jensen 
33388eea45cSKlaus Jensen     return addr >= lo && addr < hi;
33488eea45cSKlaus Jensen }
33588eea45cSKlaus Jensen 
33688eea45cSKlaus Jensen static inline void *nvme_addr_to_cmb(NvmeCtrl *n, hwaddr addr)
33788eea45cSKlaus Jensen {
33888eea45cSKlaus Jensen     hwaddr base = n->params.legacy_cmb ? n->cmb.mem.addr : n->cmb.cba;
33988eea45cSKlaus Jensen     return &n->cmb.buf[addr - base];
34088eea45cSKlaus Jensen }
34188eea45cSKlaus Jensen 
34288eea45cSKlaus Jensen static bool nvme_addr_is_pmr(NvmeCtrl *n, hwaddr addr)
34388eea45cSKlaus Jensen {
34488eea45cSKlaus Jensen     hwaddr hi;
34588eea45cSKlaus Jensen 
34688eea45cSKlaus Jensen     if (!n->pmr.cmse) {
34788eea45cSKlaus Jensen         return false;
34888eea45cSKlaus Jensen     }
34988eea45cSKlaus Jensen 
35088eea45cSKlaus Jensen     hi = n->pmr.cba + int128_get64(n->pmr.dev->mr.size);
35188eea45cSKlaus Jensen 
35288eea45cSKlaus Jensen     return addr >= n->pmr.cba && addr < hi;
35388eea45cSKlaus Jensen }
35488eea45cSKlaus Jensen 
35588eea45cSKlaus Jensen static inline void *nvme_addr_to_pmr(NvmeCtrl *n, hwaddr addr)
35688eea45cSKlaus Jensen {
35788eea45cSKlaus Jensen     return memory_region_get_ram_ptr(&n->pmr.dev->mr) + (addr - n->pmr.cba);
35888eea45cSKlaus Jensen }
35988eea45cSKlaus Jensen 
36088eea45cSKlaus Jensen static int nvme_addr_read(NvmeCtrl *n, hwaddr addr, void *buf, int size)
36188eea45cSKlaus Jensen {
36288eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
36388eea45cSKlaus Jensen     if (hi < addr) {
36488eea45cSKlaus Jensen         return 1;
36588eea45cSKlaus Jensen     }
36688eea45cSKlaus Jensen 
36788eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
36888eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_cmb(n, addr), size);
36988eea45cSKlaus Jensen         return 0;
37088eea45cSKlaus Jensen     }
37188eea45cSKlaus Jensen 
37288eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
37388eea45cSKlaus Jensen         memcpy(buf, nvme_addr_to_pmr(n, addr), size);
37488eea45cSKlaus Jensen         return 0;
37588eea45cSKlaus Jensen     }
37688eea45cSKlaus Jensen 
37788eea45cSKlaus Jensen     return pci_dma_read(&n->parent_obj, addr, buf, size);
37888eea45cSKlaus Jensen }
37988eea45cSKlaus Jensen 
38088eea45cSKlaus Jensen static int nvme_addr_write(NvmeCtrl *n, hwaddr addr, void *buf, int size)
38188eea45cSKlaus Jensen {
38288eea45cSKlaus Jensen     hwaddr hi = addr + size - 1;
38388eea45cSKlaus Jensen     if (hi < addr) {
38488eea45cSKlaus Jensen         return 1;
38588eea45cSKlaus Jensen     }
38688eea45cSKlaus Jensen 
38788eea45cSKlaus Jensen     if (n->bar.cmbsz && nvme_addr_is_cmb(n, addr) && nvme_addr_is_cmb(n, hi)) {
38888eea45cSKlaus Jensen         memcpy(nvme_addr_to_cmb(n, addr), buf, size);
38988eea45cSKlaus Jensen         return 0;
39088eea45cSKlaus Jensen     }
39188eea45cSKlaus Jensen 
39288eea45cSKlaus Jensen     if (nvme_addr_is_pmr(n, addr) && nvme_addr_is_pmr(n, hi)) {
39388eea45cSKlaus Jensen         memcpy(nvme_addr_to_pmr(n, addr), buf, size);
39488eea45cSKlaus Jensen         return 0;
39588eea45cSKlaus Jensen     }
39688eea45cSKlaus Jensen 
39788eea45cSKlaus Jensen     return pci_dma_write(&n->parent_obj, addr, buf, size);
39888eea45cSKlaus Jensen }
39988eea45cSKlaus Jensen 
40088eea45cSKlaus Jensen static bool nvme_nsid_valid(NvmeCtrl *n, uint32_t nsid)
40188eea45cSKlaus Jensen {
40288eea45cSKlaus Jensen     return nsid &&
40388eea45cSKlaus Jensen         (nsid == NVME_NSID_BROADCAST || nsid <= NVME_MAX_NAMESPACES);
40488eea45cSKlaus Jensen }
40588eea45cSKlaus Jensen 
40688eea45cSKlaus Jensen static int nvme_check_sqid(NvmeCtrl *n, uint16_t sqid)
40788eea45cSKlaus Jensen {
40888eea45cSKlaus Jensen     return sqid < n->params.max_ioqpairs + 1 && n->sq[sqid] != NULL ? 0 : -1;
40988eea45cSKlaus Jensen }
41088eea45cSKlaus Jensen 
41188eea45cSKlaus Jensen static int nvme_check_cqid(NvmeCtrl *n, uint16_t cqid)
41288eea45cSKlaus Jensen {
41388eea45cSKlaus Jensen     return cqid < n->params.max_ioqpairs + 1 && n->cq[cqid] != NULL ? 0 : -1;
41488eea45cSKlaus Jensen }
41588eea45cSKlaus Jensen 
41688eea45cSKlaus Jensen static void nvme_inc_cq_tail(NvmeCQueue *cq)
41788eea45cSKlaus Jensen {
41888eea45cSKlaus Jensen     cq->tail++;
41988eea45cSKlaus Jensen     if (cq->tail >= cq->size) {
42088eea45cSKlaus Jensen         cq->tail = 0;
42188eea45cSKlaus Jensen         cq->phase = !cq->phase;
42288eea45cSKlaus Jensen     }
42388eea45cSKlaus Jensen }
42488eea45cSKlaus Jensen 
42588eea45cSKlaus Jensen static void nvme_inc_sq_head(NvmeSQueue *sq)
42688eea45cSKlaus Jensen {
42788eea45cSKlaus Jensen     sq->head = (sq->head + 1) % sq->size;
42888eea45cSKlaus Jensen }
42988eea45cSKlaus Jensen 
43088eea45cSKlaus Jensen static uint8_t nvme_cq_full(NvmeCQueue *cq)
43188eea45cSKlaus Jensen {
43288eea45cSKlaus Jensen     return (cq->tail + 1) % cq->size == cq->head;
43388eea45cSKlaus Jensen }
43488eea45cSKlaus Jensen 
43588eea45cSKlaus Jensen static uint8_t nvme_sq_empty(NvmeSQueue *sq)
43688eea45cSKlaus Jensen {
43788eea45cSKlaus Jensen     return sq->head == sq->tail;
43888eea45cSKlaus Jensen }
43988eea45cSKlaus Jensen 
44088eea45cSKlaus Jensen static void nvme_irq_check(NvmeCtrl *n)
44188eea45cSKlaus Jensen {
44288eea45cSKlaus Jensen     if (msix_enabled(&(n->parent_obj))) {
44388eea45cSKlaus Jensen         return;
44488eea45cSKlaus Jensen     }
44588eea45cSKlaus Jensen     if (~n->bar.intms & n->irq_status) {
44688eea45cSKlaus Jensen         pci_irq_assert(&n->parent_obj);
44788eea45cSKlaus Jensen     } else {
44888eea45cSKlaus Jensen         pci_irq_deassert(&n->parent_obj);
44988eea45cSKlaus Jensen     }
45088eea45cSKlaus Jensen }
45188eea45cSKlaus Jensen 
45288eea45cSKlaus Jensen static void nvme_irq_assert(NvmeCtrl *n, NvmeCQueue *cq)
45388eea45cSKlaus Jensen {
45488eea45cSKlaus Jensen     if (cq->irq_enabled) {
45588eea45cSKlaus Jensen         if (msix_enabled(&(n->parent_obj))) {
45688eea45cSKlaus Jensen             trace_pci_nvme_irq_msix(cq->vector);
45788eea45cSKlaus Jensen             msix_notify(&(n->parent_obj), cq->vector);
45888eea45cSKlaus Jensen         } else {
45988eea45cSKlaus Jensen             trace_pci_nvme_irq_pin();
46088eea45cSKlaus Jensen             assert(cq->vector < 32);
46188eea45cSKlaus Jensen             n->irq_status |= 1 << cq->vector;
46288eea45cSKlaus Jensen             nvme_irq_check(n);
46388eea45cSKlaus Jensen         }
46488eea45cSKlaus Jensen     } else {
46588eea45cSKlaus Jensen         trace_pci_nvme_irq_masked();
46688eea45cSKlaus Jensen     }
46788eea45cSKlaus Jensen }
46888eea45cSKlaus Jensen 
46988eea45cSKlaus Jensen static void nvme_irq_deassert(NvmeCtrl *n, NvmeCQueue *cq)
47088eea45cSKlaus Jensen {
47188eea45cSKlaus Jensen     if (cq->irq_enabled) {
47288eea45cSKlaus Jensen         if (msix_enabled(&(n->parent_obj))) {
47388eea45cSKlaus Jensen             return;
47488eea45cSKlaus Jensen         } else {
47588eea45cSKlaus Jensen             assert(cq->vector < 32);
47683d7ed5cSKlaus Jensen             if (!n->cq_pending) {
47788eea45cSKlaus Jensen                 n->irq_status &= ~(1 << cq->vector);
47883d7ed5cSKlaus Jensen             }
47988eea45cSKlaus Jensen             nvme_irq_check(n);
48088eea45cSKlaus Jensen         }
48188eea45cSKlaus Jensen     }
48288eea45cSKlaus Jensen }
48388eea45cSKlaus Jensen 
48488eea45cSKlaus Jensen static void nvme_req_clear(NvmeRequest *req)
48588eea45cSKlaus Jensen {
48688eea45cSKlaus Jensen     req->ns = NULL;
48788eea45cSKlaus Jensen     req->opaque = NULL;
48888eea45cSKlaus Jensen     req->aiocb = NULL;
48988eea45cSKlaus Jensen     memset(&req->cqe, 0x0, sizeof(req->cqe));
49088eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
49188eea45cSKlaus Jensen }
49288eea45cSKlaus Jensen 
49388eea45cSKlaus Jensen static inline void nvme_sg_init(NvmeCtrl *n, NvmeSg *sg, bool dma)
49488eea45cSKlaus Jensen {
49588eea45cSKlaus Jensen     if (dma) {
49688eea45cSKlaus Jensen         pci_dma_sglist_init(&sg->qsg, &n->parent_obj, 0);
49788eea45cSKlaus Jensen         sg->flags = NVME_SG_DMA;
49888eea45cSKlaus Jensen     } else {
49988eea45cSKlaus Jensen         qemu_iovec_init(&sg->iov, 0);
50088eea45cSKlaus Jensen     }
50188eea45cSKlaus Jensen 
50288eea45cSKlaus Jensen     sg->flags |= NVME_SG_ALLOC;
50388eea45cSKlaus Jensen }
50488eea45cSKlaus Jensen 
50588eea45cSKlaus Jensen static inline void nvme_sg_unmap(NvmeSg *sg)
50688eea45cSKlaus Jensen {
50788eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_ALLOC)) {
50888eea45cSKlaus Jensen         return;
50988eea45cSKlaus Jensen     }
51088eea45cSKlaus Jensen 
51188eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
51288eea45cSKlaus Jensen         qemu_sglist_destroy(&sg->qsg);
51388eea45cSKlaus Jensen     } else {
51488eea45cSKlaus Jensen         qemu_iovec_destroy(&sg->iov);
51588eea45cSKlaus Jensen     }
51688eea45cSKlaus Jensen 
51788eea45cSKlaus Jensen     memset(sg, 0x0, sizeof(*sg));
51888eea45cSKlaus Jensen }
51988eea45cSKlaus Jensen 
52088eea45cSKlaus Jensen /*
52188eea45cSKlaus Jensen  * When metadata is transfered as extended LBAs, the DPTR mapped into `sg`
52288eea45cSKlaus Jensen  * holds both data and metadata. This function splits the data and metadata
52388eea45cSKlaus Jensen  * into two separate QSG/IOVs.
52488eea45cSKlaus Jensen  */
52588eea45cSKlaus Jensen static void nvme_sg_split(NvmeSg *sg, NvmeNamespace *ns, NvmeSg *data,
52688eea45cSKlaus Jensen                           NvmeSg *mdata)
52788eea45cSKlaus Jensen {
52888eea45cSKlaus Jensen     NvmeSg *dst = data;
52988eea45cSKlaus Jensen     uint32_t trans_len, count = ns->lbasz;
53088eea45cSKlaus Jensen     uint64_t offset = 0;
53188eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
53288eea45cSKlaus Jensen     size_t sge_len;
53388eea45cSKlaus Jensen     size_t sg_len = dma ? sg->qsg.size : sg->iov.size;
53488eea45cSKlaus Jensen     int sg_idx = 0;
53588eea45cSKlaus Jensen 
53688eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
53788eea45cSKlaus Jensen 
53888eea45cSKlaus Jensen     while (sg_len) {
53988eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
54088eea45cSKlaus Jensen 
54188eea45cSKlaus Jensen         trans_len = MIN(sg_len, count);
54288eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
54388eea45cSKlaus Jensen 
54488eea45cSKlaus Jensen         if (dst) {
54588eea45cSKlaus Jensen             if (dma) {
54688eea45cSKlaus Jensen                 qemu_sglist_add(&dst->qsg, sg->qsg.sg[sg_idx].base + offset,
54788eea45cSKlaus Jensen                                 trans_len);
54888eea45cSKlaus Jensen             } else {
54988eea45cSKlaus Jensen                 qemu_iovec_add(&dst->iov,
55088eea45cSKlaus Jensen                                sg->iov.iov[sg_idx].iov_base + offset,
55188eea45cSKlaus Jensen                                trans_len);
55288eea45cSKlaus Jensen             }
55388eea45cSKlaus Jensen         }
55488eea45cSKlaus Jensen 
55588eea45cSKlaus Jensen         sg_len -= trans_len;
55688eea45cSKlaus Jensen         count -= trans_len;
55788eea45cSKlaus Jensen         offset += trans_len;
55888eea45cSKlaus Jensen 
55988eea45cSKlaus Jensen         if (count == 0) {
56088eea45cSKlaus Jensen             dst = (dst == data) ? mdata : data;
56188eea45cSKlaus Jensen             count = (dst == data) ? ns->lbasz : ns->lbaf.ms;
56288eea45cSKlaus Jensen         }
56388eea45cSKlaus Jensen 
56488eea45cSKlaus Jensen         if (sge_len == offset) {
56588eea45cSKlaus Jensen             offset = 0;
56688eea45cSKlaus Jensen             sg_idx++;
56788eea45cSKlaus Jensen         }
56888eea45cSKlaus Jensen     }
56988eea45cSKlaus Jensen }
57088eea45cSKlaus Jensen 
57188eea45cSKlaus Jensen static uint16_t nvme_map_addr_cmb(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
57288eea45cSKlaus Jensen                                   size_t len)
57388eea45cSKlaus Jensen {
57488eea45cSKlaus Jensen     if (!len) {
57588eea45cSKlaus Jensen         return NVME_SUCCESS;
57688eea45cSKlaus Jensen     }
57788eea45cSKlaus Jensen 
57888eea45cSKlaus Jensen     trace_pci_nvme_map_addr_cmb(addr, len);
57988eea45cSKlaus Jensen 
58088eea45cSKlaus Jensen     if (!nvme_addr_is_cmb(n, addr) || !nvme_addr_is_cmb(n, addr + len - 1)) {
58188eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
58288eea45cSKlaus Jensen     }
58388eea45cSKlaus Jensen 
58488eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_cmb(n, addr), len);
58588eea45cSKlaus Jensen 
58688eea45cSKlaus Jensen     return NVME_SUCCESS;
58788eea45cSKlaus Jensen }
58888eea45cSKlaus Jensen 
58988eea45cSKlaus Jensen static uint16_t nvme_map_addr_pmr(NvmeCtrl *n, QEMUIOVector *iov, hwaddr addr,
59088eea45cSKlaus Jensen                                   size_t len)
59188eea45cSKlaus Jensen {
59288eea45cSKlaus Jensen     if (!len) {
59388eea45cSKlaus Jensen         return NVME_SUCCESS;
59488eea45cSKlaus Jensen     }
59588eea45cSKlaus Jensen 
59688eea45cSKlaus Jensen     if (!nvme_addr_is_pmr(n, addr) || !nvme_addr_is_pmr(n, addr + len - 1)) {
59788eea45cSKlaus Jensen         return NVME_DATA_TRAS_ERROR;
59888eea45cSKlaus Jensen     }
59988eea45cSKlaus Jensen 
60088eea45cSKlaus Jensen     qemu_iovec_add(iov, nvme_addr_to_pmr(n, addr), len);
60188eea45cSKlaus Jensen 
60288eea45cSKlaus Jensen     return NVME_SUCCESS;
60388eea45cSKlaus Jensen }
60488eea45cSKlaus Jensen 
60588eea45cSKlaus Jensen static uint16_t nvme_map_addr(NvmeCtrl *n, NvmeSg *sg, hwaddr addr, size_t len)
60688eea45cSKlaus Jensen {
60788eea45cSKlaus Jensen     bool cmb = false, pmr = false;
60888eea45cSKlaus Jensen 
60988eea45cSKlaus Jensen     if (!len) {
61088eea45cSKlaus Jensen         return NVME_SUCCESS;
61188eea45cSKlaus Jensen     }
61288eea45cSKlaus Jensen 
61388eea45cSKlaus Jensen     trace_pci_nvme_map_addr(addr, len);
61488eea45cSKlaus Jensen 
61588eea45cSKlaus Jensen     if (nvme_addr_is_cmb(n, addr)) {
61688eea45cSKlaus Jensen         cmb = true;
61788eea45cSKlaus Jensen     } else if (nvme_addr_is_pmr(n, addr)) {
61888eea45cSKlaus Jensen         pmr = true;
61988eea45cSKlaus Jensen     }
62088eea45cSKlaus Jensen 
62188eea45cSKlaus Jensen     if (cmb || pmr) {
62288eea45cSKlaus Jensen         if (sg->flags & NVME_SG_DMA) {
62388eea45cSKlaus Jensen             return NVME_INVALID_USE_OF_CMB | NVME_DNR;
62488eea45cSKlaus Jensen         }
62588eea45cSKlaus Jensen 
62688eea45cSKlaus Jensen         if (cmb) {
62788eea45cSKlaus Jensen             return nvme_map_addr_cmb(n, &sg->iov, addr, len);
62888eea45cSKlaus Jensen         } else {
62988eea45cSKlaus Jensen             return nvme_map_addr_pmr(n, &sg->iov, addr, len);
63088eea45cSKlaus Jensen         }
63188eea45cSKlaus Jensen     }
63288eea45cSKlaus Jensen 
63388eea45cSKlaus Jensen     if (!(sg->flags & NVME_SG_DMA)) {
63488eea45cSKlaus Jensen         return NVME_INVALID_USE_OF_CMB | NVME_DNR;
63588eea45cSKlaus Jensen     }
63688eea45cSKlaus Jensen 
63788eea45cSKlaus Jensen     qemu_sglist_add(&sg->qsg, addr, len);
63888eea45cSKlaus Jensen 
63988eea45cSKlaus Jensen     return NVME_SUCCESS;
64088eea45cSKlaus Jensen }
64188eea45cSKlaus Jensen 
64288eea45cSKlaus Jensen static inline bool nvme_addr_is_dma(NvmeCtrl *n, hwaddr addr)
64388eea45cSKlaus Jensen {
64488eea45cSKlaus Jensen     return !(nvme_addr_is_cmb(n, addr) || nvme_addr_is_pmr(n, addr));
64588eea45cSKlaus Jensen }
64688eea45cSKlaus Jensen 
64788eea45cSKlaus Jensen static uint16_t nvme_map_prp(NvmeCtrl *n, NvmeSg *sg, uint64_t prp1,
64888eea45cSKlaus Jensen                              uint64_t prp2, uint32_t len)
64988eea45cSKlaus Jensen {
65088eea45cSKlaus Jensen     hwaddr trans_len = n->page_size - (prp1 % n->page_size);
65188eea45cSKlaus Jensen     trans_len = MIN(len, trans_len);
65288eea45cSKlaus Jensen     int num_prps = (len >> n->page_bits) + 1;
65388eea45cSKlaus Jensen     uint16_t status;
65488eea45cSKlaus Jensen     int ret;
65588eea45cSKlaus Jensen 
65688eea45cSKlaus Jensen     trace_pci_nvme_map_prp(trans_len, len, prp1, prp2, num_prps);
65788eea45cSKlaus Jensen 
65888eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, prp1));
65988eea45cSKlaus Jensen 
66088eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, prp1, trans_len);
66188eea45cSKlaus Jensen     if (status) {
66288eea45cSKlaus Jensen         goto unmap;
66388eea45cSKlaus Jensen     }
66488eea45cSKlaus Jensen 
66588eea45cSKlaus Jensen     len -= trans_len;
66688eea45cSKlaus Jensen     if (len) {
66788eea45cSKlaus Jensen         if (len > n->page_size) {
66888eea45cSKlaus Jensen             uint64_t prp_list[n->max_prp_ents];
66988eea45cSKlaus Jensen             uint32_t nents, prp_trans;
67088eea45cSKlaus Jensen             int i = 0;
67188eea45cSKlaus Jensen 
67288eea45cSKlaus Jensen             /*
67388eea45cSKlaus Jensen              * The first PRP list entry, pointed to by PRP2 may contain offset.
67488eea45cSKlaus Jensen              * Hence, we need to calculate the number of entries in based on
67588eea45cSKlaus Jensen              * that offset.
67688eea45cSKlaus Jensen              */
67788eea45cSKlaus Jensen             nents = (n->page_size - (prp2 & (n->page_size - 1))) >> 3;
67888eea45cSKlaus Jensen             prp_trans = MIN(n->max_prp_ents, nents) * sizeof(uint64_t);
67988eea45cSKlaus Jensen             ret = nvme_addr_read(n, prp2, (void *)prp_list, prp_trans);
68088eea45cSKlaus Jensen             if (ret) {
68188eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(prp2);
68288eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
68388eea45cSKlaus Jensen                 goto unmap;
68488eea45cSKlaus Jensen             }
68588eea45cSKlaus Jensen             while (len != 0) {
68688eea45cSKlaus Jensen                 uint64_t prp_ent = le64_to_cpu(prp_list[i]);
68788eea45cSKlaus Jensen 
68888eea45cSKlaus Jensen                 if (i == nents - 1 && len > n->page_size) {
68988eea45cSKlaus Jensen                     if (unlikely(prp_ent & (n->page_size - 1))) {
69088eea45cSKlaus Jensen                         trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
69188eea45cSKlaus Jensen                         status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
69288eea45cSKlaus Jensen                         goto unmap;
69388eea45cSKlaus Jensen                     }
69488eea45cSKlaus Jensen 
69588eea45cSKlaus Jensen                     i = 0;
69688eea45cSKlaus Jensen                     nents = (len + n->page_size - 1) >> n->page_bits;
69788eea45cSKlaus Jensen                     nents = MIN(nents, n->max_prp_ents);
69888eea45cSKlaus Jensen                     prp_trans = nents * sizeof(uint64_t);
69988eea45cSKlaus Jensen                     ret = nvme_addr_read(n, prp_ent, (void *)prp_list,
70088eea45cSKlaus Jensen                                          prp_trans);
70188eea45cSKlaus Jensen                     if (ret) {
70288eea45cSKlaus Jensen                         trace_pci_nvme_err_addr_read(prp_ent);
70388eea45cSKlaus Jensen                         status = NVME_DATA_TRAS_ERROR;
70488eea45cSKlaus Jensen                         goto unmap;
70588eea45cSKlaus Jensen                     }
70688eea45cSKlaus Jensen                     prp_ent = le64_to_cpu(prp_list[i]);
70788eea45cSKlaus Jensen                 }
70888eea45cSKlaus Jensen 
70988eea45cSKlaus Jensen                 if (unlikely(prp_ent & (n->page_size - 1))) {
71088eea45cSKlaus Jensen                     trace_pci_nvme_err_invalid_prplist_ent(prp_ent);
71188eea45cSKlaus Jensen                     status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
71288eea45cSKlaus Jensen                     goto unmap;
71388eea45cSKlaus Jensen                 }
71488eea45cSKlaus Jensen 
71588eea45cSKlaus Jensen                 trans_len = MIN(len, n->page_size);
71688eea45cSKlaus Jensen                 status = nvme_map_addr(n, sg, prp_ent, trans_len);
71788eea45cSKlaus Jensen                 if (status) {
71888eea45cSKlaus Jensen                     goto unmap;
71988eea45cSKlaus Jensen                 }
72088eea45cSKlaus Jensen 
72188eea45cSKlaus Jensen                 len -= trans_len;
72288eea45cSKlaus Jensen                 i++;
72388eea45cSKlaus Jensen             }
72488eea45cSKlaus Jensen         } else {
72588eea45cSKlaus Jensen             if (unlikely(prp2 & (n->page_size - 1))) {
72688eea45cSKlaus Jensen                 trace_pci_nvme_err_invalid_prp2_align(prp2);
72788eea45cSKlaus Jensen                 status = NVME_INVALID_PRP_OFFSET | NVME_DNR;
72888eea45cSKlaus Jensen                 goto unmap;
72988eea45cSKlaus Jensen             }
73088eea45cSKlaus Jensen             status = nvme_map_addr(n, sg, prp2, len);
73188eea45cSKlaus Jensen             if (status) {
73288eea45cSKlaus Jensen                 goto unmap;
73388eea45cSKlaus Jensen             }
73488eea45cSKlaus Jensen         }
73588eea45cSKlaus Jensen     }
73688eea45cSKlaus Jensen 
73788eea45cSKlaus Jensen     return NVME_SUCCESS;
73888eea45cSKlaus Jensen 
73988eea45cSKlaus Jensen unmap:
74088eea45cSKlaus Jensen     nvme_sg_unmap(sg);
74188eea45cSKlaus Jensen     return status;
74288eea45cSKlaus Jensen }
74388eea45cSKlaus Jensen 
74488eea45cSKlaus Jensen /*
74588eea45cSKlaus Jensen  * Map 'nsgld' data descriptors from 'segment'. The function will subtract the
74688eea45cSKlaus Jensen  * number of bytes mapped in len.
74788eea45cSKlaus Jensen  */
74888eea45cSKlaus Jensen static uint16_t nvme_map_sgl_data(NvmeCtrl *n, NvmeSg *sg,
74988eea45cSKlaus Jensen                                   NvmeSglDescriptor *segment, uint64_t nsgld,
75088eea45cSKlaus Jensen                                   size_t *len, NvmeCmd *cmd)
75188eea45cSKlaus Jensen {
75288eea45cSKlaus Jensen     dma_addr_t addr, trans_len;
75388eea45cSKlaus Jensen     uint32_t dlen;
75488eea45cSKlaus Jensen     uint16_t status;
75588eea45cSKlaus Jensen 
75688eea45cSKlaus Jensen     for (int i = 0; i < nsgld; i++) {
75788eea45cSKlaus Jensen         uint8_t type = NVME_SGL_TYPE(segment[i].type);
75888eea45cSKlaus Jensen 
75988eea45cSKlaus Jensen         switch (type) {
76088eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_BIT_BUCKET:
76188eea45cSKlaus Jensen             if (cmd->opcode == NVME_CMD_WRITE) {
76288eea45cSKlaus Jensen                 continue;
76388eea45cSKlaus Jensen             }
76488eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_DATA_BLOCK:
76588eea45cSKlaus Jensen             break;
76688eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
76788eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
76888eea45cSKlaus Jensen             return NVME_INVALID_NUM_SGL_DESCRS | NVME_DNR;
76988eea45cSKlaus Jensen         default:
77088eea45cSKlaus Jensen             return NVME_SGL_DESCR_TYPE_INVALID | NVME_DNR;
77188eea45cSKlaus Jensen         }
77288eea45cSKlaus Jensen 
77388eea45cSKlaus Jensen         dlen = le32_to_cpu(segment[i].len);
77488eea45cSKlaus Jensen 
77588eea45cSKlaus Jensen         if (!dlen) {
77688eea45cSKlaus Jensen             continue;
77788eea45cSKlaus Jensen         }
77888eea45cSKlaus Jensen 
77988eea45cSKlaus Jensen         if (*len == 0) {
78088eea45cSKlaus Jensen             /*
78188eea45cSKlaus Jensen              * All data has been mapped, but the SGL contains additional
78288eea45cSKlaus Jensen              * segments and/or descriptors. The controller might accept
78388eea45cSKlaus Jensen              * ignoring the rest of the SGL.
78488eea45cSKlaus Jensen              */
78588eea45cSKlaus Jensen             uint32_t sgls = le32_to_cpu(n->id_ctrl.sgls);
78688eea45cSKlaus Jensen             if (sgls & NVME_CTRL_SGLS_EXCESS_LENGTH) {
78788eea45cSKlaus Jensen                 break;
78888eea45cSKlaus Jensen             }
78988eea45cSKlaus Jensen 
79088eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_sgl_excess_length(dlen);
79188eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
79288eea45cSKlaus Jensen         }
79388eea45cSKlaus Jensen 
79488eea45cSKlaus Jensen         trans_len = MIN(*len, dlen);
79588eea45cSKlaus Jensen 
79688eea45cSKlaus Jensen         if (type == NVME_SGL_DESCR_TYPE_BIT_BUCKET) {
79788eea45cSKlaus Jensen             goto next;
79888eea45cSKlaus Jensen         }
79988eea45cSKlaus Jensen 
80088eea45cSKlaus Jensen         addr = le64_to_cpu(segment[i].addr);
80188eea45cSKlaus Jensen 
80288eea45cSKlaus Jensen         if (UINT64_MAX - addr < dlen) {
80388eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
80488eea45cSKlaus Jensen         }
80588eea45cSKlaus Jensen 
80688eea45cSKlaus Jensen         status = nvme_map_addr(n, sg, addr, trans_len);
80788eea45cSKlaus Jensen         if (status) {
80888eea45cSKlaus Jensen             return status;
80988eea45cSKlaus Jensen         }
81088eea45cSKlaus Jensen 
81188eea45cSKlaus Jensen next:
81288eea45cSKlaus Jensen         *len -= trans_len;
81388eea45cSKlaus Jensen     }
81488eea45cSKlaus Jensen 
81588eea45cSKlaus Jensen     return NVME_SUCCESS;
81688eea45cSKlaus Jensen }
81788eea45cSKlaus Jensen 
81888eea45cSKlaus Jensen static uint16_t nvme_map_sgl(NvmeCtrl *n, NvmeSg *sg, NvmeSglDescriptor sgl,
81988eea45cSKlaus Jensen                              size_t len, NvmeCmd *cmd)
82088eea45cSKlaus Jensen {
82188eea45cSKlaus Jensen     /*
82288eea45cSKlaus Jensen      * Read the segment in chunks of 256 descriptors (one 4k page) to avoid
82388eea45cSKlaus Jensen      * dynamically allocating a potentially huge SGL. The spec allows the SGL
82488eea45cSKlaus Jensen      * to be larger (as in number of bytes required to describe the SGL
82588eea45cSKlaus Jensen      * descriptors and segment chain) than the command transfer size, so it is
82688eea45cSKlaus Jensen      * not bounded by MDTS.
82788eea45cSKlaus Jensen      */
82888eea45cSKlaus Jensen     const int SEG_CHUNK_SIZE = 256;
82988eea45cSKlaus Jensen 
83088eea45cSKlaus Jensen     NvmeSglDescriptor segment[SEG_CHUNK_SIZE], *sgld, *last_sgld;
83188eea45cSKlaus Jensen     uint64_t nsgld;
83288eea45cSKlaus Jensen     uint32_t seg_len;
83388eea45cSKlaus Jensen     uint16_t status;
83488eea45cSKlaus Jensen     hwaddr addr;
83588eea45cSKlaus Jensen     int ret;
83688eea45cSKlaus Jensen 
83788eea45cSKlaus Jensen     sgld = &sgl;
83888eea45cSKlaus Jensen     addr = le64_to_cpu(sgl.addr);
83988eea45cSKlaus Jensen 
84088eea45cSKlaus Jensen     trace_pci_nvme_map_sgl(NVME_SGL_TYPE(sgl.type), len);
84188eea45cSKlaus Jensen 
84288eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, addr));
84388eea45cSKlaus Jensen 
84488eea45cSKlaus Jensen     /*
84588eea45cSKlaus Jensen      * If the entire transfer can be described with a single data block it can
84688eea45cSKlaus Jensen      * be mapped directly.
84788eea45cSKlaus Jensen      */
84888eea45cSKlaus Jensen     if (NVME_SGL_TYPE(sgl.type) == NVME_SGL_DESCR_TYPE_DATA_BLOCK) {
84988eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, sgld, 1, &len, cmd);
85088eea45cSKlaus Jensen         if (status) {
85188eea45cSKlaus Jensen             goto unmap;
85288eea45cSKlaus Jensen         }
85388eea45cSKlaus Jensen 
85488eea45cSKlaus Jensen         goto out;
85588eea45cSKlaus Jensen     }
85688eea45cSKlaus Jensen 
85788eea45cSKlaus Jensen     for (;;) {
85888eea45cSKlaus Jensen         switch (NVME_SGL_TYPE(sgld->type)) {
85988eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_SEGMENT:
86088eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_LAST_SEGMENT:
86188eea45cSKlaus Jensen             break;
86288eea45cSKlaus Jensen         default:
86388eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
86488eea45cSKlaus Jensen         }
86588eea45cSKlaus Jensen 
86688eea45cSKlaus Jensen         seg_len = le32_to_cpu(sgld->len);
86788eea45cSKlaus Jensen 
86888eea45cSKlaus Jensen         /* check the length of the (Last) Segment descriptor */
86988eea45cSKlaus Jensen         if ((!seg_len || seg_len & 0xf) &&
87088eea45cSKlaus Jensen             (NVME_SGL_TYPE(sgld->type) != NVME_SGL_DESCR_TYPE_BIT_BUCKET)) {
87188eea45cSKlaus Jensen             return NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
87288eea45cSKlaus Jensen         }
87388eea45cSKlaus Jensen 
87488eea45cSKlaus Jensen         if (UINT64_MAX - addr < seg_len) {
87588eea45cSKlaus Jensen             return NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
87688eea45cSKlaus Jensen         }
87788eea45cSKlaus Jensen 
87888eea45cSKlaus Jensen         nsgld = seg_len / sizeof(NvmeSglDescriptor);
87988eea45cSKlaus Jensen 
88088eea45cSKlaus Jensen         while (nsgld > SEG_CHUNK_SIZE) {
88188eea45cSKlaus Jensen             if (nvme_addr_read(n, addr, segment, sizeof(segment))) {
88288eea45cSKlaus Jensen                 trace_pci_nvme_err_addr_read(addr);
88388eea45cSKlaus Jensen                 status = NVME_DATA_TRAS_ERROR;
88488eea45cSKlaus Jensen                 goto unmap;
88588eea45cSKlaus Jensen             }
88688eea45cSKlaus Jensen 
88788eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, SEG_CHUNK_SIZE,
88888eea45cSKlaus Jensen                                        &len, cmd);
88988eea45cSKlaus Jensen             if (status) {
89088eea45cSKlaus Jensen                 goto unmap;
89188eea45cSKlaus Jensen             }
89288eea45cSKlaus Jensen 
89388eea45cSKlaus Jensen             nsgld -= SEG_CHUNK_SIZE;
89488eea45cSKlaus Jensen             addr += SEG_CHUNK_SIZE * sizeof(NvmeSglDescriptor);
89588eea45cSKlaus Jensen         }
89688eea45cSKlaus Jensen 
89788eea45cSKlaus Jensen         ret = nvme_addr_read(n, addr, segment, nsgld *
89888eea45cSKlaus Jensen                              sizeof(NvmeSglDescriptor));
89988eea45cSKlaus Jensen         if (ret) {
90088eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
90188eea45cSKlaus Jensen             status = NVME_DATA_TRAS_ERROR;
90288eea45cSKlaus Jensen             goto unmap;
90388eea45cSKlaus Jensen         }
90488eea45cSKlaus Jensen 
90588eea45cSKlaus Jensen         last_sgld = &segment[nsgld - 1];
90688eea45cSKlaus Jensen 
90788eea45cSKlaus Jensen         /*
90888eea45cSKlaus Jensen          * If the segment ends with a Data Block or Bit Bucket Descriptor Type,
90988eea45cSKlaus Jensen          * then we are done.
91088eea45cSKlaus Jensen          */
91188eea45cSKlaus Jensen         switch (NVME_SGL_TYPE(last_sgld->type)) {
91288eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_DATA_BLOCK:
91388eea45cSKlaus Jensen         case NVME_SGL_DESCR_TYPE_BIT_BUCKET:
91488eea45cSKlaus Jensen             status = nvme_map_sgl_data(n, sg, segment, nsgld, &len, cmd);
91588eea45cSKlaus Jensen             if (status) {
91688eea45cSKlaus Jensen                 goto unmap;
91788eea45cSKlaus Jensen             }
91888eea45cSKlaus Jensen 
91988eea45cSKlaus Jensen             goto out;
92088eea45cSKlaus Jensen 
92188eea45cSKlaus Jensen         default:
92288eea45cSKlaus Jensen             break;
92388eea45cSKlaus Jensen         }
92488eea45cSKlaus Jensen 
92588eea45cSKlaus Jensen         /*
92688eea45cSKlaus Jensen          * If the last descriptor was not a Data Block or Bit Bucket, then the
92788eea45cSKlaus Jensen          * current segment must not be a Last Segment.
92888eea45cSKlaus Jensen          */
92988eea45cSKlaus Jensen         if (NVME_SGL_TYPE(sgld->type) == NVME_SGL_DESCR_TYPE_LAST_SEGMENT) {
93088eea45cSKlaus Jensen             status = NVME_INVALID_SGL_SEG_DESCR | NVME_DNR;
93188eea45cSKlaus Jensen             goto unmap;
93288eea45cSKlaus Jensen         }
93388eea45cSKlaus Jensen 
93488eea45cSKlaus Jensen         sgld = last_sgld;
93588eea45cSKlaus Jensen         addr = le64_to_cpu(sgld->addr);
93688eea45cSKlaus Jensen 
93788eea45cSKlaus Jensen         /*
93888eea45cSKlaus Jensen          * Do not map the last descriptor; it will be a Segment or Last Segment
93988eea45cSKlaus Jensen          * descriptor and is handled by the next iteration.
94088eea45cSKlaus Jensen          */
94188eea45cSKlaus Jensen         status = nvme_map_sgl_data(n, sg, segment, nsgld - 1, &len, cmd);
94288eea45cSKlaus Jensen         if (status) {
94388eea45cSKlaus Jensen             goto unmap;
94488eea45cSKlaus Jensen         }
94588eea45cSKlaus Jensen     }
94688eea45cSKlaus Jensen 
94788eea45cSKlaus Jensen out:
94888eea45cSKlaus Jensen     /* if there is any residual left in len, the SGL was too short */
94988eea45cSKlaus Jensen     if (len) {
95088eea45cSKlaus Jensen         status = NVME_DATA_SGL_LEN_INVALID | NVME_DNR;
95188eea45cSKlaus Jensen         goto unmap;
95288eea45cSKlaus Jensen     }
95388eea45cSKlaus Jensen 
95488eea45cSKlaus Jensen     return NVME_SUCCESS;
95588eea45cSKlaus Jensen 
95688eea45cSKlaus Jensen unmap:
95788eea45cSKlaus Jensen     nvme_sg_unmap(sg);
95888eea45cSKlaus Jensen     return status;
95988eea45cSKlaus Jensen }
96088eea45cSKlaus Jensen 
96188eea45cSKlaus Jensen uint16_t nvme_map_dptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
96288eea45cSKlaus Jensen                        NvmeCmd *cmd)
96388eea45cSKlaus Jensen {
96488eea45cSKlaus Jensen     uint64_t prp1, prp2;
96588eea45cSKlaus Jensen 
96688eea45cSKlaus Jensen     switch (NVME_CMD_FLAGS_PSDT(cmd->flags)) {
96788eea45cSKlaus Jensen     case NVME_PSDT_PRP:
96888eea45cSKlaus Jensen         prp1 = le64_to_cpu(cmd->dptr.prp1);
96988eea45cSKlaus Jensen         prp2 = le64_to_cpu(cmd->dptr.prp2);
97088eea45cSKlaus Jensen 
97188eea45cSKlaus Jensen         return nvme_map_prp(n, sg, prp1, prp2, len);
97288eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_CONTIGUOUS:
97388eea45cSKlaus Jensen     case NVME_PSDT_SGL_MPTR_SGL:
97488eea45cSKlaus Jensen         return nvme_map_sgl(n, sg, cmd->dptr.sgl, len, cmd);
97588eea45cSKlaus Jensen     default:
97688eea45cSKlaus Jensen         return NVME_INVALID_FIELD;
97788eea45cSKlaus Jensen     }
97888eea45cSKlaus Jensen }
97988eea45cSKlaus Jensen 
98088eea45cSKlaus Jensen static uint16_t nvme_map_mptr(NvmeCtrl *n, NvmeSg *sg, size_t len,
98188eea45cSKlaus Jensen                               NvmeCmd *cmd)
98288eea45cSKlaus Jensen {
98388eea45cSKlaus Jensen     int psdt = NVME_CMD_FLAGS_PSDT(cmd->flags);
98488eea45cSKlaus Jensen     hwaddr mptr = le64_to_cpu(cmd->mptr);
98588eea45cSKlaus Jensen     uint16_t status;
98688eea45cSKlaus Jensen 
98788eea45cSKlaus Jensen     if (psdt == NVME_PSDT_SGL_MPTR_SGL) {
98888eea45cSKlaus Jensen         NvmeSglDescriptor sgl;
98988eea45cSKlaus Jensen 
99088eea45cSKlaus Jensen         if (nvme_addr_read(n, mptr, &sgl, sizeof(sgl))) {
99188eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
99288eea45cSKlaus Jensen         }
99388eea45cSKlaus Jensen 
99488eea45cSKlaus Jensen         status = nvme_map_sgl(n, sg, sgl, len, cmd);
99588eea45cSKlaus Jensen         if (status && (status & 0x7ff) == NVME_DATA_SGL_LEN_INVALID) {
99688eea45cSKlaus Jensen             status = NVME_MD_SGL_LEN_INVALID | NVME_DNR;
99788eea45cSKlaus Jensen         }
99888eea45cSKlaus Jensen 
99988eea45cSKlaus Jensen         return status;
100088eea45cSKlaus Jensen     }
100188eea45cSKlaus Jensen 
100288eea45cSKlaus Jensen     nvme_sg_init(n, sg, nvme_addr_is_dma(n, mptr));
100388eea45cSKlaus Jensen     status = nvme_map_addr(n, sg, mptr, len);
100488eea45cSKlaus Jensen     if (status) {
100588eea45cSKlaus Jensen         nvme_sg_unmap(sg);
100688eea45cSKlaus Jensen     }
100788eea45cSKlaus Jensen 
100888eea45cSKlaus Jensen     return status;
100988eea45cSKlaus Jensen }
101088eea45cSKlaus Jensen 
101188eea45cSKlaus Jensen static uint16_t nvme_map_data(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
101288eea45cSKlaus Jensen {
101388eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
101488eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
10152a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
10162a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
101788eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
101888eea45cSKlaus Jensen     uint16_t status;
101988eea45cSKlaus Jensen 
10202a132309SKlaus Jensen     if (nvme_ns_ext(ns) && !(pi && pract && ns->lbaf.ms == 8)) {
102188eea45cSKlaus Jensen         NvmeSg sg;
102288eea45cSKlaus Jensen 
102388eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
102488eea45cSKlaus Jensen 
102588eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
102688eea45cSKlaus Jensen         if (status) {
102788eea45cSKlaus Jensen             return status;
102888eea45cSKlaus Jensen         }
102988eea45cSKlaus Jensen 
103088eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
103188eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, &req->sg, NULL);
103288eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
103388eea45cSKlaus Jensen 
103488eea45cSKlaus Jensen         return NVME_SUCCESS;
103588eea45cSKlaus Jensen     }
103688eea45cSKlaus Jensen 
103788eea45cSKlaus Jensen     return nvme_map_dptr(n, &req->sg, len, &req->cmd);
103888eea45cSKlaus Jensen }
103988eea45cSKlaus Jensen 
104088eea45cSKlaus Jensen static uint16_t nvme_map_mdata(NvmeCtrl *n, uint32_t nlb, NvmeRequest *req)
104188eea45cSKlaus Jensen {
104288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
104388eea45cSKlaus Jensen     size_t len = nvme_m2b(ns, nlb);
104488eea45cSKlaus Jensen     uint16_t status;
104588eea45cSKlaus Jensen 
104688eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
104788eea45cSKlaus Jensen         NvmeSg sg;
104888eea45cSKlaus Jensen 
104988eea45cSKlaus Jensen         len += nvme_l2b(ns, nlb);
105088eea45cSKlaus Jensen 
105188eea45cSKlaus Jensen         status = nvme_map_dptr(n, &sg, len, &req->cmd);
105288eea45cSKlaus Jensen         if (status) {
105388eea45cSKlaus Jensen             return status;
105488eea45cSKlaus Jensen         }
105588eea45cSKlaus Jensen 
105688eea45cSKlaus Jensen         nvme_sg_init(n, &req->sg, sg.flags & NVME_SG_DMA);
105788eea45cSKlaus Jensen         nvme_sg_split(&sg, ns, NULL, &req->sg);
105888eea45cSKlaus Jensen         nvme_sg_unmap(&sg);
105988eea45cSKlaus Jensen 
106088eea45cSKlaus Jensen         return NVME_SUCCESS;
106188eea45cSKlaus Jensen     }
106288eea45cSKlaus Jensen 
106388eea45cSKlaus Jensen     return nvme_map_mptr(n, &req->sg, len, &req->cmd);
106488eea45cSKlaus Jensen }
106588eea45cSKlaus Jensen 
106688eea45cSKlaus Jensen static uint16_t nvme_tx_interleaved(NvmeCtrl *n, NvmeSg *sg, uint8_t *ptr,
106788eea45cSKlaus Jensen                                     uint32_t len, uint32_t bytes,
106888eea45cSKlaus Jensen                                     int32_t skip_bytes, int64_t offset,
106988eea45cSKlaus Jensen                                     NvmeTxDirection dir)
107088eea45cSKlaus Jensen {
107188eea45cSKlaus Jensen     hwaddr addr;
107288eea45cSKlaus Jensen     uint32_t trans_len, count = bytes;
107388eea45cSKlaus Jensen     bool dma = sg->flags & NVME_SG_DMA;
107488eea45cSKlaus Jensen     int64_t sge_len;
107588eea45cSKlaus Jensen     int sg_idx = 0;
107688eea45cSKlaus Jensen     int ret;
107788eea45cSKlaus Jensen 
107888eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
107988eea45cSKlaus Jensen 
108088eea45cSKlaus Jensen     while (len) {
108188eea45cSKlaus Jensen         sge_len = dma ? sg->qsg.sg[sg_idx].len : sg->iov.iov[sg_idx].iov_len;
108288eea45cSKlaus Jensen 
108388eea45cSKlaus Jensen         if (sge_len - offset < 0) {
108488eea45cSKlaus Jensen             offset -= sge_len;
108588eea45cSKlaus Jensen             sg_idx++;
108688eea45cSKlaus Jensen             continue;
108788eea45cSKlaus Jensen         }
108888eea45cSKlaus Jensen 
108988eea45cSKlaus Jensen         if (sge_len == offset) {
109088eea45cSKlaus Jensen             offset = 0;
109188eea45cSKlaus Jensen             sg_idx++;
109288eea45cSKlaus Jensen             continue;
109388eea45cSKlaus Jensen         }
109488eea45cSKlaus Jensen 
109588eea45cSKlaus Jensen         trans_len = MIN(len, count);
109688eea45cSKlaus Jensen         trans_len = MIN(trans_len, sge_len - offset);
109788eea45cSKlaus Jensen 
109888eea45cSKlaus Jensen         if (dma) {
109988eea45cSKlaus Jensen             addr = sg->qsg.sg[sg_idx].base + offset;
110088eea45cSKlaus Jensen         } else {
110188eea45cSKlaus Jensen             addr = (hwaddr)(uintptr_t)sg->iov.iov[sg_idx].iov_base + offset;
110288eea45cSKlaus Jensen         }
110388eea45cSKlaus Jensen 
110488eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
110588eea45cSKlaus Jensen             ret = nvme_addr_read(n, addr, ptr, trans_len);
110688eea45cSKlaus Jensen         } else {
110788eea45cSKlaus Jensen             ret = nvme_addr_write(n, addr, ptr, trans_len);
110888eea45cSKlaus Jensen         }
110988eea45cSKlaus Jensen 
111088eea45cSKlaus Jensen         if (ret) {
111188eea45cSKlaus Jensen             return NVME_DATA_TRAS_ERROR;
111288eea45cSKlaus Jensen         }
111388eea45cSKlaus Jensen 
111488eea45cSKlaus Jensen         ptr += trans_len;
111588eea45cSKlaus Jensen         len -= trans_len;
111688eea45cSKlaus Jensen         count -= trans_len;
111788eea45cSKlaus Jensen         offset += trans_len;
111888eea45cSKlaus Jensen 
111988eea45cSKlaus Jensen         if (count == 0) {
112088eea45cSKlaus Jensen             count = bytes;
112188eea45cSKlaus Jensen             offset += skip_bytes;
112288eea45cSKlaus Jensen         }
112388eea45cSKlaus Jensen     }
112488eea45cSKlaus Jensen 
112588eea45cSKlaus Jensen     return NVME_SUCCESS;
112688eea45cSKlaus Jensen }
112788eea45cSKlaus Jensen 
112888eea45cSKlaus Jensen static uint16_t nvme_tx(NvmeCtrl *n, NvmeSg *sg, uint8_t *ptr, uint32_t len,
112988eea45cSKlaus Jensen                         NvmeTxDirection dir)
113088eea45cSKlaus Jensen {
113188eea45cSKlaus Jensen     assert(sg->flags & NVME_SG_ALLOC);
113288eea45cSKlaus Jensen 
113388eea45cSKlaus Jensen     if (sg->flags & NVME_SG_DMA) {
113488eea45cSKlaus Jensen         uint64_t residual;
113588eea45cSKlaus Jensen 
113688eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
113788eea45cSKlaus Jensen             residual = dma_buf_write(ptr, len, &sg->qsg);
113888eea45cSKlaus Jensen         } else {
113988eea45cSKlaus Jensen             residual = dma_buf_read(ptr, len, &sg->qsg);
114088eea45cSKlaus Jensen         }
114188eea45cSKlaus Jensen 
114288eea45cSKlaus Jensen         if (unlikely(residual)) {
114388eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
114488eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
114588eea45cSKlaus Jensen         }
114688eea45cSKlaus Jensen     } else {
114788eea45cSKlaus Jensen         size_t bytes;
114888eea45cSKlaus Jensen 
114988eea45cSKlaus Jensen         if (dir == NVME_TX_DIRECTION_TO_DEVICE) {
115088eea45cSKlaus Jensen             bytes = qemu_iovec_to_buf(&sg->iov, 0, ptr, len);
115188eea45cSKlaus Jensen         } else {
115288eea45cSKlaus Jensen             bytes = qemu_iovec_from_buf(&sg->iov, 0, ptr, len);
115388eea45cSKlaus Jensen         }
115488eea45cSKlaus Jensen 
115588eea45cSKlaus Jensen         if (unlikely(bytes != len)) {
115688eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_dma();
115788eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
115888eea45cSKlaus Jensen         }
115988eea45cSKlaus Jensen     }
116088eea45cSKlaus Jensen 
116188eea45cSKlaus Jensen     return NVME_SUCCESS;
116288eea45cSKlaus Jensen }
116388eea45cSKlaus Jensen 
116488eea45cSKlaus Jensen static inline uint16_t nvme_c2h(NvmeCtrl *n, uint8_t *ptr, uint32_t len,
116588eea45cSKlaus Jensen                                 NvmeRequest *req)
116688eea45cSKlaus Jensen {
116788eea45cSKlaus Jensen     uint16_t status;
116888eea45cSKlaus Jensen 
116988eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
117088eea45cSKlaus Jensen     if (status) {
117188eea45cSKlaus Jensen         return status;
117288eea45cSKlaus Jensen     }
117388eea45cSKlaus Jensen 
117488eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_FROM_DEVICE);
117588eea45cSKlaus Jensen }
117688eea45cSKlaus Jensen 
117788eea45cSKlaus Jensen static inline uint16_t nvme_h2c(NvmeCtrl *n, uint8_t *ptr, uint32_t len,
117888eea45cSKlaus Jensen                                 NvmeRequest *req)
117988eea45cSKlaus Jensen {
118088eea45cSKlaus Jensen     uint16_t status;
118188eea45cSKlaus Jensen 
118288eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
118388eea45cSKlaus Jensen     if (status) {
118488eea45cSKlaus Jensen         return status;
118588eea45cSKlaus Jensen     }
118688eea45cSKlaus Jensen 
118788eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, NVME_TX_DIRECTION_TO_DEVICE);
118888eea45cSKlaus Jensen }
118988eea45cSKlaus Jensen 
119088eea45cSKlaus Jensen uint16_t nvme_bounce_data(NvmeCtrl *n, uint8_t *ptr, uint32_t len,
119188eea45cSKlaus Jensen                           NvmeTxDirection dir, NvmeRequest *req)
119288eea45cSKlaus Jensen {
119388eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
119488eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
11952a132309SKlaus Jensen     bool pi = !!NVME_ID_NS_DPS_TYPE(ns->id_ns.dps);
11962a132309SKlaus Jensen     bool pract = !!(le16_to_cpu(rw->control) & NVME_RW_PRINFO_PRACT);
119788eea45cSKlaus Jensen 
11982a132309SKlaus Jensen     if (nvme_ns_ext(ns) && !(pi && pract && ns->lbaf.ms == 8)) {
119988eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbasz,
120088eea45cSKlaus Jensen                                    ns->lbaf.ms, 0, dir);
120188eea45cSKlaus Jensen     }
120288eea45cSKlaus Jensen 
120388eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
120488eea45cSKlaus Jensen }
120588eea45cSKlaus Jensen 
120688eea45cSKlaus Jensen uint16_t nvme_bounce_mdata(NvmeCtrl *n, uint8_t *ptr, uint32_t len,
120788eea45cSKlaus Jensen                            NvmeTxDirection dir, NvmeRequest *req)
120888eea45cSKlaus Jensen {
120988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
121088eea45cSKlaus Jensen     uint16_t status;
121188eea45cSKlaus Jensen 
121288eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
121388eea45cSKlaus Jensen         return nvme_tx_interleaved(n, &req->sg, ptr, len, ns->lbaf.ms,
121488eea45cSKlaus Jensen                                    ns->lbasz, ns->lbasz, dir);
121588eea45cSKlaus Jensen     }
121688eea45cSKlaus Jensen 
121788eea45cSKlaus Jensen     nvme_sg_unmap(&req->sg);
121888eea45cSKlaus Jensen 
121988eea45cSKlaus Jensen     status = nvme_map_mptr(n, &req->sg, len, &req->cmd);
122088eea45cSKlaus Jensen     if (status) {
122188eea45cSKlaus Jensen         return status;
122288eea45cSKlaus Jensen     }
122388eea45cSKlaus Jensen 
122488eea45cSKlaus Jensen     return nvme_tx(n, &req->sg, ptr, len, dir);
122588eea45cSKlaus Jensen }
122688eea45cSKlaus Jensen 
122788eea45cSKlaus Jensen static inline void nvme_blk_read(BlockBackend *blk, int64_t offset,
122888eea45cSKlaus Jensen                                  BlockCompletionFunc *cb, NvmeRequest *req)
122988eea45cSKlaus Jensen {
123088eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
123188eea45cSKlaus Jensen 
123288eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
123388eea45cSKlaus Jensen         req->aiocb = dma_blk_read(blk, &req->sg.qsg, offset, BDRV_SECTOR_SIZE,
123488eea45cSKlaus Jensen                                   cb, req);
123588eea45cSKlaus Jensen     } else {
123688eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &req->sg.iov, 0, cb, req);
123788eea45cSKlaus Jensen     }
123888eea45cSKlaus Jensen }
123988eea45cSKlaus Jensen 
124088eea45cSKlaus Jensen static inline void nvme_blk_write(BlockBackend *blk, int64_t offset,
124188eea45cSKlaus Jensen                                   BlockCompletionFunc *cb, NvmeRequest *req)
124288eea45cSKlaus Jensen {
124388eea45cSKlaus Jensen     assert(req->sg.flags & NVME_SG_ALLOC);
124488eea45cSKlaus Jensen 
124588eea45cSKlaus Jensen     if (req->sg.flags & NVME_SG_DMA) {
124688eea45cSKlaus Jensen         req->aiocb = dma_blk_write(blk, &req->sg.qsg, offset, BDRV_SECTOR_SIZE,
124788eea45cSKlaus Jensen                                    cb, req);
124888eea45cSKlaus Jensen     } else {
124988eea45cSKlaus Jensen         req->aiocb = blk_aio_pwritev(blk, offset, &req->sg.iov, 0, cb, req);
125088eea45cSKlaus Jensen     }
125188eea45cSKlaus Jensen }
125288eea45cSKlaus Jensen 
125388eea45cSKlaus Jensen static void nvme_post_cqes(void *opaque)
125488eea45cSKlaus Jensen {
125588eea45cSKlaus Jensen     NvmeCQueue *cq = opaque;
125688eea45cSKlaus Jensen     NvmeCtrl *n = cq->ctrl;
125788eea45cSKlaus Jensen     NvmeRequest *req, *next;
125883d7ed5cSKlaus Jensen     bool pending = cq->head != cq->tail;
125988eea45cSKlaus Jensen     int ret;
126088eea45cSKlaus Jensen 
126188eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(req, &cq->req_list, entry, next) {
126288eea45cSKlaus Jensen         NvmeSQueue *sq;
126388eea45cSKlaus Jensen         hwaddr addr;
126488eea45cSKlaus Jensen 
126588eea45cSKlaus Jensen         if (nvme_cq_full(cq)) {
126688eea45cSKlaus Jensen             break;
126788eea45cSKlaus Jensen         }
126888eea45cSKlaus Jensen 
126988eea45cSKlaus Jensen         sq = req->sq;
127088eea45cSKlaus Jensen         req->cqe.status = cpu_to_le16((req->status << 1) | cq->phase);
127188eea45cSKlaus Jensen         req->cqe.sq_id = cpu_to_le16(sq->sqid);
127288eea45cSKlaus Jensen         req->cqe.sq_head = cpu_to_le16(sq->head);
127388eea45cSKlaus Jensen         addr = cq->dma_addr + cq->tail * n->cqe_size;
127488eea45cSKlaus Jensen         ret = pci_dma_write(&n->parent_obj, addr, (void *)&req->cqe,
127588eea45cSKlaus Jensen                             sizeof(req->cqe));
127688eea45cSKlaus Jensen         if (ret) {
127788eea45cSKlaus Jensen             trace_pci_nvme_err_addr_write(addr);
127888eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
127988eea45cSKlaus Jensen             n->bar.csts = NVME_CSTS_FAILED;
128088eea45cSKlaus Jensen             break;
128188eea45cSKlaus Jensen         }
128288eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->req_list, req, entry);
128388eea45cSKlaus Jensen         nvme_inc_cq_tail(cq);
128488eea45cSKlaus Jensen         nvme_sg_unmap(&req->sg);
128588eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->req_list, req, entry);
128688eea45cSKlaus Jensen     }
128788eea45cSKlaus Jensen     if (cq->tail != cq->head) {
128883d7ed5cSKlaus Jensen         if (cq->irq_enabled && !pending) {
128983d7ed5cSKlaus Jensen             n->cq_pending++;
129083d7ed5cSKlaus Jensen         }
129183d7ed5cSKlaus Jensen 
129288eea45cSKlaus Jensen         nvme_irq_assert(n, cq);
129388eea45cSKlaus Jensen     }
129488eea45cSKlaus Jensen }
129588eea45cSKlaus Jensen 
129688eea45cSKlaus Jensen static void nvme_enqueue_req_completion(NvmeCQueue *cq, NvmeRequest *req)
129788eea45cSKlaus Jensen {
129888eea45cSKlaus Jensen     assert(cq->cqid == req->sq->cqid);
129988eea45cSKlaus Jensen     trace_pci_nvme_enqueue_req_completion(nvme_cid(req), cq->cqid,
1300f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.result),
1301f1c97407SKlaus Jensen                                           le32_to_cpu(req->cqe.dw1),
130288eea45cSKlaus Jensen                                           req->status);
130388eea45cSKlaus Jensen 
130488eea45cSKlaus Jensen     if (req->status) {
130588eea45cSKlaus Jensen         trace_pci_nvme_err_req_status(nvme_cid(req), nvme_nsid(req->ns),
130688eea45cSKlaus Jensen                                       req->status, req->cmd.opcode);
130788eea45cSKlaus Jensen     }
130888eea45cSKlaus Jensen 
130988eea45cSKlaus Jensen     QTAILQ_REMOVE(&req->sq->out_req_list, req, entry);
131088eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&cq->req_list, req, entry);
131188eea45cSKlaus Jensen     timer_mod(cq->timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + 500);
131288eea45cSKlaus Jensen }
131388eea45cSKlaus Jensen 
131488eea45cSKlaus Jensen static void nvme_process_aers(void *opaque)
131588eea45cSKlaus Jensen {
131688eea45cSKlaus Jensen     NvmeCtrl *n = opaque;
131788eea45cSKlaus Jensen     NvmeAsyncEvent *event, *next;
131888eea45cSKlaus Jensen 
131988eea45cSKlaus Jensen     trace_pci_nvme_process_aers(n->aer_queued);
132088eea45cSKlaus Jensen 
132188eea45cSKlaus Jensen     QTAILQ_FOREACH_SAFE(event, &n->aer_queue, entry, next) {
132288eea45cSKlaus Jensen         NvmeRequest *req;
132388eea45cSKlaus Jensen         NvmeAerResult *result;
132488eea45cSKlaus Jensen 
132588eea45cSKlaus Jensen         /* can't post cqe if there is nothing to complete */
132688eea45cSKlaus Jensen         if (!n->outstanding_aers) {
132788eea45cSKlaus Jensen             trace_pci_nvme_no_outstanding_aers();
132888eea45cSKlaus Jensen             break;
132988eea45cSKlaus Jensen         }
133088eea45cSKlaus Jensen 
133188eea45cSKlaus Jensen         /* ignore if masked (cqe posted, but event not cleared) */
133288eea45cSKlaus Jensen         if (n->aer_mask & (1 << event->result.event_type)) {
133388eea45cSKlaus Jensen             trace_pci_nvme_aer_masked(event->result.event_type, n->aer_mask);
133488eea45cSKlaus Jensen             continue;
133588eea45cSKlaus Jensen         }
133688eea45cSKlaus Jensen 
133788eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
133888eea45cSKlaus Jensen         n->aer_queued--;
133988eea45cSKlaus Jensen 
134088eea45cSKlaus Jensen         n->aer_mask |= 1 << event->result.event_type;
134188eea45cSKlaus Jensen         n->outstanding_aers--;
134288eea45cSKlaus Jensen 
134388eea45cSKlaus Jensen         req = n->aer_reqs[n->outstanding_aers];
134488eea45cSKlaus Jensen 
134588eea45cSKlaus Jensen         result = (NvmeAerResult *) &req->cqe.result;
134688eea45cSKlaus Jensen         result->event_type = event->result.event_type;
134788eea45cSKlaus Jensen         result->event_info = event->result.event_info;
134888eea45cSKlaus Jensen         result->log_page = event->result.log_page;
134988eea45cSKlaus Jensen         g_free(event);
135088eea45cSKlaus Jensen 
135188eea45cSKlaus Jensen         trace_pci_nvme_aer_post_cqe(result->event_type, result->event_info,
135288eea45cSKlaus Jensen                                     result->log_page);
135388eea45cSKlaus Jensen 
135488eea45cSKlaus Jensen         nvme_enqueue_req_completion(&n->admin_cq, req);
135588eea45cSKlaus Jensen     }
135688eea45cSKlaus Jensen }
135788eea45cSKlaus Jensen 
135888eea45cSKlaus Jensen static void nvme_enqueue_event(NvmeCtrl *n, uint8_t event_type,
135988eea45cSKlaus Jensen                                uint8_t event_info, uint8_t log_page)
136088eea45cSKlaus Jensen {
136188eea45cSKlaus Jensen     NvmeAsyncEvent *event;
136288eea45cSKlaus Jensen 
136388eea45cSKlaus Jensen     trace_pci_nvme_enqueue_event(event_type, event_info, log_page);
136488eea45cSKlaus Jensen 
136588eea45cSKlaus Jensen     if (n->aer_queued == n->params.aer_max_queued) {
136688eea45cSKlaus Jensen         trace_pci_nvme_enqueue_event_noqueue(n->aer_queued);
136788eea45cSKlaus Jensen         return;
136888eea45cSKlaus Jensen     }
136988eea45cSKlaus Jensen 
137088eea45cSKlaus Jensen     event = g_new(NvmeAsyncEvent, 1);
137188eea45cSKlaus Jensen     event->result = (NvmeAerResult) {
137288eea45cSKlaus Jensen         .event_type = event_type,
137388eea45cSKlaus Jensen         .event_info = event_info,
137488eea45cSKlaus Jensen         .log_page   = log_page,
137588eea45cSKlaus Jensen     };
137688eea45cSKlaus Jensen 
137788eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&n->aer_queue, event, entry);
137888eea45cSKlaus Jensen     n->aer_queued++;
137988eea45cSKlaus Jensen 
138088eea45cSKlaus Jensen     nvme_process_aers(n);
138188eea45cSKlaus Jensen }
138288eea45cSKlaus Jensen 
138388eea45cSKlaus Jensen static void nvme_smart_event(NvmeCtrl *n, uint8_t event)
138488eea45cSKlaus Jensen {
138588eea45cSKlaus Jensen     uint8_t aer_info;
138688eea45cSKlaus Jensen 
138788eea45cSKlaus Jensen     /* Ref SPEC <Asynchronous Event Information 0x2013 SMART / Health Status> */
138888eea45cSKlaus Jensen     if (!(NVME_AEC_SMART(n->features.async_config) & event)) {
138988eea45cSKlaus Jensen         return;
139088eea45cSKlaus Jensen     }
139188eea45cSKlaus Jensen 
139288eea45cSKlaus Jensen     switch (event) {
139388eea45cSKlaus Jensen     case NVME_SMART_SPARE:
139488eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_SPARE_THRESH;
139588eea45cSKlaus Jensen         break;
139688eea45cSKlaus Jensen     case NVME_SMART_TEMPERATURE:
139788eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_TEMP_THRESH;
139888eea45cSKlaus Jensen         break;
139988eea45cSKlaus Jensen     case NVME_SMART_RELIABILITY:
140088eea45cSKlaus Jensen     case NVME_SMART_MEDIA_READ_ONLY:
140188eea45cSKlaus Jensen     case NVME_SMART_FAILED_VOLATILE_MEDIA:
140288eea45cSKlaus Jensen     case NVME_SMART_PMR_UNRELIABLE:
140388eea45cSKlaus Jensen         aer_info = NVME_AER_INFO_SMART_RELIABILITY;
140488eea45cSKlaus Jensen         break;
140588eea45cSKlaus Jensen     default:
140688eea45cSKlaus Jensen         return;
140788eea45cSKlaus Jensen     }
140888eea45cSKlaus Jensen 
140988eea45cSKlaus Jensen     nvme_enqueue_event(n, NVME_AER_TYPE_SMART, aer_info, NVME_LOG_SMART_INFO);
141088eea45cSKlaus Jensen }
141188eea45cSKlaus Jensen 
141288eea45cSKlaus Jensen static void nvme_clear_events(NvmeCtrl *n, uint8_t event_type)
141388eea45cSKlaus Jensen {
141488eea45cSKlaus Jensen     n->aer_mask &= ~(1 << event_type);
141588eea45cSKlaus Jensen     if (!QTAILQ_EMPTY(&n->aer_queue)) {
141688eea45cSKlaus Jensen         nvme_process_aers(n);
141788eea45cSKlaus Jensen     }
141888eea45cSKlaus Jensen }
141988eea45cSKlaus Jensen 
142088eea45cSKlaus Jensen static inline uint16_t nvme_check_mdts(NvmeCtrl *n, size_t len)
142188eea45cSKlaus Jensen {
142288eea45cSKlaus Jensen     uint8_t mdts = n->params.mdts;
142388eea45cSKlaus Jensen 
142488eea45cSKlaus Jensen     if (mdts && len > n->page_size << mdts) {
142588eea45cSKlaus Jensen         trace_pci_nvme_err_mdts(len);
142688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
142788eea45cSKlaus Jensen     }
142888eea45cSKlaus Jensen 
142988eea45cSKlaus Jensen     return NVME_SUCCESS;
143088eea45cSKlaus Jensen }
143188eea45cSKlaus Jensen 
143288eea45cSKlaus Jensen static inline uint16_t nvme_check_bounds(NvmeNamespace *ns, uint64_t slba,
143388eea45cSKlaus Jensen                                          uint32_t nlb)
143488eea45cSKlaus Jensen {
143588eea45cSKlaus Jensen     uint64_t nsze = le64_to_cpu(ns->id_ns.nsze);
143688eea45cSKlaus Jensen 
143788eea45cSKlaus Jensen     if (unlikely(UINT64_MAX - slba < nlb || slba + nlb > nsze)) {
143888eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb, nsze);
143988eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
144088eea45cSKlaus Jensen     }
144188eea45cSKlaus Jensen 
144288eea45cSKlaus Jensen     return NVME_SUCCESS;
144388eea45cSKlaus Jensen }
144488eea45cSKlaus Jensen 
1445ff0ac2c8SKlaus Jensen static int nvme_block_status_all(NvmeNamespace *ns, uint64_t slba,
1446ff0ac2c8SKlaus Jensen                                  uint32_t nlb, int flags)
144788eea45cSKlaus Jensen {
144888eea45cSKlaus Jensen     BlockDriverState *bs = blk_bs(ns->blkconf.blk);
144988eea45cSKlaus Jensen 
145088eea45cSKlaus Jensen     int64_t pnum = 0, bytes = nvme_l2b(ns, nlb);
145188eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
145288eea45cSKlaus Jensen     int ret;
145388eea45cSKlaus Jensen 
145488eea45cSKlaus Jensen     /*
145588eea45cSKlaus Jensen      * `pnum` holds the number of bytes after offset that shares the same
145688eea45cSKlaus Jensen      * allocation status as the byte at offset. If `pnum` is different from
145788eea45cSKlaus Jensen      * `bytes`, we should check the allocation status of the next range and
145888eea45cSKlaus Jensen      * continue this until all bytes have been checked.
145988eea45cSKlaus Jensen      */
146088eea45cSKlaus Jensen     do {
146188eea45cSKlaus Jensen         bytes -= pnum;
146288eea45cSKlaus Jensen 
146388eea45cSKlaus Jensen         ret = bdrv_block_status(bs, offset, bytes, &pnum, NULL, NULL);
146488eea45cSKlaus Jensen         if (ret < 0) {
1465ff0ac2c8SKlaus Jensen             return ret;
146688eea45cSKlaus Jensen         }
146788eea45cSKlaus Jensen 
146888eea45cSKlaus Jensen 
1469ff0ac2c8SKlaus Jensen         trace_pci_nvme_block_status(offset, bytes, pnum, ret,
1470ff0ac2c8SKlaus Jensen                                     !!(ret & BDRV_BLOCK_ZERO));
147188eea45cSKlaus Jensen 
1472ff0ac2c8SKlaus Jensen         if (!(ret & flags)) {
1473ff0ac2c8SKlaus Jensen             return 1;
147488eea45cSKlaus Jensen         }
147588eea45cSKlaus Jensen 
147688eea45cSKlaus Jensen         offset += pnum;
147788eea45cSKlaus Jensen     } while (pnum != bytes);
147888eea45cSKlaus Jensen 
1479ff0ac2c8SKlaus Jensen     return 0;
1480ff0ac2c8SKlaus Jensen }
1481ff0ac2c8SKlaus Jensen 
1482ff0ac2c8SKlaus Jensen static uint16_t nvme_check_dulbe(NvmeNamespace *ns, uint64_t slba,
1483ff0ac2c8SKlaus Jensen                                  uint32_t nlb)
1484ff0ac2c8SKlaus Jensen {
1485ff0ac2c8SKlaus Jensen     int ret;
1486ff0ac2c8SKlaus Jensen     Error *err = NULL;
1487ff0ac2c8SKlaus Jensen 
1488ff0ac2c8SKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_DATA);
1489ff0ac2c8SKlaus Jensen     if (ret) {
1490ff0ac2c8SKlaus Jensen         if (ret < 0) {
1491ff0ac2c8SKlaus Jensen             error_setg_errno(&err, -ret, "unable to get block status");
1492ff0ac2c8SKlaus Jensen             error_report_err(err);
1493ff0ac2c8SKlaus Jensen 
1494ff0ac2c8SKlaus Jensen             return NVME_INTERNAL_DEV_ERROR;
1495ff0ac2c8SKlaus Jensen         }
1496ff0ac2c8SKlaus Jensen 
1497ff0ac2c8SKlaus Jensen         return NVME_DULB;
1498ff0ac2c8SKlaus Jensen     }
1499ff0ac2c8SKlaus Jensen 
150088eea45cSKlaus Jensen     return NVME_SUCCESS;
150188eea45cSKlaus Jensen }
150288eea45cSKlaus Jensen 
150388eea45cSKlaus Jensen static void nvme_aio_err(NvmeRequest *req, int ret)
150488eea45cSKlaus Jensen {
150588eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
150688eea45cSKlaus Jensen     Error *local_err = NULL;
150788eea45cSKlaus Jensen 
150888eea45cSKlaus Jensen     switch (req->cmd.opcode) {
150988eea45cSKlaus Jensen     case NVME_CMD_READ:
151088eea45cSKlaus Jensen         status = NVME_UNRECOVERED_READ;
151188eea45cSKlaus Jensen         break;
151288eea45cSKlaus Jensen     case NVME_CMD_FLUSH:
151388eea45cSKlaus Jensen     case NVME_CMD_WRITE:
151488eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
151588eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
151688eea45cSKlaus Jensen         status = NVME_WRITE_FAULT;
151788eea45cSKlaus Jensen         break;
151888eea45cSKlaus Jensen     default:
151988eea45cSKlaus Jensen         status = NVME_INTERNAL_DEV_ERROR;
152088eea45cSKlaus Jensen         break;
152188eea45cSKlaus Jensen     }
152288eea45cSKlaus Jensen 
152388eea45cSKlaus Jensen     trace_pci_nvme_err_aio(nvme_cid(req), strerror(-ret), status);
152488eea45cSKlaus Jensen 
152588eea45cSKlaus Jensen     error_setg_errno(&local_err, -ret, "aio failed");
152688eea45cSKlaus Jensen     error_report_err(local_err);
152788eea45cSKlaus Jensen 
152888eea45cSKlaus Jensen     /*
152988eea45cSKlaus Jensen      * Set the command status code to the first encountered error but allow a
153088eea45cSKlaus Jensen      * subsequent Internal Device Error to trump it.
153188eea45cSKlaus Jensen      */
153288eea45cSKlaus Jensen     if (req->status && status != NVME_INTERNAL_DEV_ERROR) {
153388eea45cSKlaus Jensen         return;
153488eea45cSKlaus Jensen     }
153588eea45cSKlaus Jensen 
153688eea45cSKlaus Jensen     req->status = status;
153788eea45cSKlaus Jensen }
153888eea45cSKlaus Jensen 
153988eea45cSKlaus Jensen static inline uint32_t nvme_zone_idx(NvmeNamespace *ns, uint64_t slba)
154088eea45cSKlaus Jensen {
154188eea45cSKlaus Jensen     return ns->zone_size_log2 > 0 ? slba >> ns->zone_size_log2 :
154288eea45cSKlaus Jensen                                     slba / ns->zone_size;
154388eea45cSKlaus Jensen }
154488eea45cSKlaus Jensen 
154588eea45cSKlaus Jensen static inline NvmeZone *nvme_get_zone_by_slba(NvmeNamespace *ns, uint64_t slba)
154688eea45cSKlaus Jensen {
154788eea45cSKlaus Jensen     uint32_t zone_idx = nvme_zone_idx(ns, slba);
154888eea45cSKlaus Jensen 
1549189a8bf7SKlaus Jensen     if (zone_idx >= ns->num_zones) {
1550189a8bf7SKlaus Jensen         return NULL;
1551189a8bf7SKlaus Jensen     }
1552189a8bf7SKlaus Jensen 
155388eea45cSKlaus Jensen     return &ns->zone_array[zone_idx];
155488eea45cSKlaus Jensen }
155588eea45cSKlaus Jensen 
155688eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_write(NvmeZone *zone)
155788eea45cSKlaus Jensen {
155888eea45cSKlaus Jensen     uint64_t zslba = zone->d.zslba;
155988eea45cSKlaus Jensen 
156088eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
156188eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
156288eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
156388eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
156488eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
156588eea45cSKlaus Jensen         return NVME_SUCCESS;
156688eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
156788eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_full(zslba);
156888eea45cSKlaus Jensen         return NVME_ZONE_FULL;
156988eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
157088eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zslba);
157188eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
157288eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
157388eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_read_only(zslba);
157488eea45cSKlaus Jensen         return NVME_ZONE_READ_ONLY;
157588eea45cSKlaus Jensen     default:
157688eea45cSKlaus Jensen         assert(false);
157788eea45cSKlaus Jensen     }
157888eea45cSKlaus Jensen 
157988eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
158088eea45cSKlaus Jensen }
158188eea45cSKlaus Jensen 
158288eea45cSKlaus Jensen static uint16_t nvme_check_zone_write(NvmeNamespace *ns, NvmeZone *zone,
158388eea45cSKlaus Jensen                                       uint64_t slba, uint32_t nlb)
158488eea45cSKlaus Jensen {
158588eea45cSKlaus Jensen     uint64_t zcap = nvme_zone_wr_boundary(zone);
158688eea45cSKlaus Jensen     uint16_t status;
158788eea45cSKlaus Jensen 
158888eea45cSKlaus Jensen     status = nvme_check_zone_state_for_write(zone);
158988eea45cSKlaus Jensen     if (status) {
159088eea45cSKlaus Jensen         return status;
159188eea45cSKlaus Jensen     }
159288eea45cSKlaus Jensen 
159388eea45cSKlaus Jensen     if (unlikely(slba != zone->w_ptr)) {
159488eea45cSKlaus Jensen         trace_pci_nvme_err_write_not_at_wp(slba, zone->d.zslba, zone->w_ptr);
159588eea45cSKlaus Jensen         return NVME_ZONE_INVALID_WRITE;
159688eea45cSKlaus Jensen     }
159788eea45cSKlaus Jensen 
159888eea45cSKlaus Jensen     if (unlikely((slba + nlb) > zcap)) {
159988eea45cSKlaus Jensen         trace_pci_nvme_err_zone_boundary(slba, nlb, zcap);
160088eea45cSKlaus Jensen         return NVME_ZONE_BOUNDARY_ERROR;
160188eea45cSKlaus Jensen     }
160288eea45cSKlaus Jensen 
160388eea45cSKlaus Jensen     return NVME_SUCCESS;
160488eea45cSKlaus Jensen }
160588eea45cSKlaus Jensen 
160688eea45cSKlaus Jensen static uint16_t nvme_check_zone_state_for_read(NvmeZone *zone)
160788eea45cSKlaus Jensen {
160888eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
160988eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
161088eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
161188eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
161288eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
161388eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
161488eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
161588eea45cSKlaus Jensen         return NVME_SUCCESS;
161688eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
161788eea45cSKlaus Jensen         trace_pci_nvme_err_zone_is_offline(zone->d.zslba);
161888eea45cSKlaus Jensen         return NVME_ZONE_OFFLINE;
161988eea45cSKlaus Jensen     default:
162088eea45cSKlaus Jensen         assert(false);
162188eea45cSKlaus Jensen     }
162288eea45cSKlaus Jensen 
162388eea45cSKlaus Jensen     return NVME_INTERNAL_DEV_ERROR;
162488eea45cSKlaus Jensen }
162588eea45cSKlaus Jensen 
162688eea45cSKlaus Jensen static uint16_t nvme_check_zone_read(NvmeNamespace *ns, uint64_t slba,
162788eea45cSKlaus Jensen                                      uint32_t nlb)
162888eea45cSKlaus Jensen {
1629189a8bf7SKlaus Jensen     NvmeZone *zone;
1630189a8bf7SKlaus Jensen     uint64_t bndry, end;
163188eea45cSKlaus Jensen     uint16_t status;
163288eea45cSKlaus Jensen 
1633189a8bf7SKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
1634189a8bf7SKlaus Jensen     assert(zone);
1635189a8bf7SKlaus Jensen 
1636189a8bf7SKlaus Jensen     bndry = nvme_zone_rd_boundary(ns, zone);
1637189a8bf7SKlaus Jensen     end = slba + nlb;
1638189a8bf7SKlaus Jensen 
163988eea45cSKlaus Jensen     status = nvme_check_zone_state_for_read(zone);
164088eea45cSKlaus Jensen     if (status) {
164188eea45cSKlaus Jensen         ;
164288eea45cSKlaus Jensen     } else if (unlikely(end > bndry)) {
164388eea45cSKlaus Jensen         if (!ns->params.cross_zone_read) {
164488eea45cSKlaus Jensen             status = NVME_ZONE_BOUNDARY_ERROR;
164588eea45cSKlaus Jensen         } else {
164688eea45cSKlaus Jensen             /*
164788eea45cSKlaus Jensen              * Read across zone boundary - check that all subsequent
164888eea45cSKlaus Jensen              * zones that are being read have an appropriate state.
164988eea45cSKlaus Jensen              */
165088eea45cSKlaus Jensen             do {
165188eea45cSKlaus Jensen                 zone++;
165288eea45cSKlaus Jensen                 status = nvme_check_zone_state_for_read(zone);
165388eea45cSKlaus Jensen                 if (status) {
165488eea45cSKlaus Jensen                     break;
165588eea45cSKlaus Jensen                 }
165688eea45cSKlaus Jensen             } while (end > nvme_zone_rd_boundary(ns, zone));
165788eea45cSKlaus Jensen         }
165888eea45cSKlaus Jensen     }
165988eea45cSKlaus Jensen 
166088eea45cSKlaus Jensen     return status;
166188eea45cSKlaus Jensen }
166288eea45cSKlaus Jensen 
166388eea45cSKlaus Jensen static uint16_t nvme_zrm_finish(NvmeNamespace *ns, NvmeZone *zone)
166488eea45cSKlaus Jensen {
166588eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
166688eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
166788eea45cSKlaus Jensen         return NVME_SUCCESS;
166888eea45cSKlaus Jensen 
166988eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
167088eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
167188eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
167288eea45cSKlaus Jensen         /* fallthrough */
167388eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
167488eea45cSKlaus Jensen         nvme_aor_dec_active(ns);
167588eea45cSKlaus Jensen         /* fallthrough */
167688eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
167788eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_FULL);
167888eea45cSKlaus Jensen         return NVME_SUCCESS;
167988eea45cSKlaus Jensen 
168088eea45cSKlaus Jensen     default:
168188eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
168288eea45cSKlaus Jensen     }
168388eea45cSKlaus Jensen }
168488eea45cSKlaus Jensen 
168588eea45cSKlaus Jensen static uint16_t nvme_zrm_close(NvmeNamespace *ns, NvmeZone *zone)
168688eea45cSKlaus Jensen {
168788eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
168888eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
168988eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
169088eea45cSKlaus Jensen         nvme_aor_dec_open(ns);
169188eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
169288eea45cSKlaus Jensen         /* fall through */
169388eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
169488eea45cSKlaus Jensen         return NVME_SUCCESS;
169588eea45cSKlaus Jensen 
169688eea45cSKlaus Jensen     default:
169788eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
169888eea45cSKlaus Jensen     }
169988eea45cSKlaus Jensen }
170088eea45cSKlaus Jensen 
170163d96e4fSKlaus Jensen static uint16_t nvme_zrm_reset(NvmeNamespace *ns, NvmeZone *zone)
170263d96e4fSKlaus Jensen {
170363d96e4fSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
170463d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
170563d96e4fSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
170663d96e4fSKlaus Jensen         nvme_aor_dec_open(ns);
170763d96e4fSKlaus Jensen         /* fallthrough */
170863d96e4fSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
170963d96e4fSKlaus Jensen         nvme_aor_dec_active(ns);
171063d96e4fSKlaus Jensen         /* fallthrough */
171163d96e4fSKlaus Jensen     case NVME_ZONE_STATE_FULL:
171263d96e4fSKlaus Jensen         zone->w_ptr = zone->d.zslba;
171363d96e4fSKlaus Jensen         zone->d.wp = zone->w_ptr;
171463d96e4fSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EMPTY);
171563d96e4fSKlaus Jensen         /* fallthrough */
171663d96e4fSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
171763d96e4fSKlaus Jensen         return NVME_SUCCESS;
171863d96e4fSKlaus Jensen 
171963d96e4fSKlaus Jensen     default:
172063d96e4fSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
172163d96e4fSKlaus Jensen     }
172263d96e4fSKlaus Jensen }
172363d96e4fSKlaus Jensen 
172488eea45cSKlaus Jensen static void nvme_zrm_auto_transition_zone(NvmeNamespace *ns)
172588eea45cSKlaus Jensen {
172688eea45cSKlaus Jensen     NvmeZone *zone;
172788eea45cSKlaus Jensen 
172888eea45cSKlaus Jensen     if (ns->params.max_open_zones &&
172988eea45cSKlaus Jensen         ns->nr_open_zones == ns->params.max_open_zones) {
173088eea45cSKlaus Jensen         zone = QTAILQ_FIRST(&ns->imp_open_zones);
173188eea45cSKlaus Jensen         if (zone) {
173288eea45cSKlaus Jensen             /*
173388eea45cSKlaus Jensen              * Automatically close this implicitly open zone.
173488eea45cSKlaus Jensen              */
173588eea45cSKlaus Jensen             QTAILQ_REMOVE(&ns->imp_open_zones, zone, entry);
173688eea45cSKlaus Jensen             nvme_zrm_close(ns, zone);
173788eea45cSKlaus Jensen         }
173888eea45cSKlaus Jensen     }
173988eea45cSKlaus Jensen }
174088eea45cSKlaus Jensen 
174188eea45cSKlaus Jensen enum {
174288eea45cSKlaus Jensen     NVME_ZRM_AUTO = 1 << 0,
174388eea45cSKlaus Jensen };
174488eea45cSKlaus Jensen 
1745cccc2651SNiklas Cassel static uint16_t nvme_zrm_open_flags(NvmeCtrl *n, NvmeNamespace *ns,
1746cccc2651SNiklas Cassel                                     NvmeZone *zone, int flags)
174788eea45cSKlaus Jensen {
174888eea45cSKlaus Jensen     int act = 0;
174988eea45cSKlaus Jensen     uint16_t status;
175088eea45cSKlaus Jensen 
175188eea45cSKlaus Jensen     switch (nvme_get_zone_state(zone)) {
175288eea45cSKlaus Jensen     case NVME_ZONE_STATE_EMPTY:
175388eea45cSKlaus Jensen         act = 1;
175488eea45cSKlaus Jensen 
175588eea45cSKlaus Jensen         /* fallthrough */
175688eea45cSKlaus Jensen 
175788eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
1758cccc2651SNiklas Cassel         if (n->params.auto_transition_zones) {
175988eea45cSKlaus Jensen             nvme_zrm_auto_transition_zone(ns);
1760cccc2651SNiklas Cassel         }
176188eea45cSKlaus Jensen         status = nvme_aor_check(ns, act, 1);
176288eea45cSKlaus Jensen         if (status) {
176388eea45cSKlaus Jensen             return status;
176488eea45cSKlaus Jensen         }
176588eea45cSKlaus Jensen 
176688eea45cSKlaus Jensen         if (act) {
176788eea45cSKlaus Jensen             nvme_aor_inc_active(ns);
176888eea45cSKlaus Jensen         }
176988eea45cSKlaus Jensen 
177088eea45cSKlaus Jensen         nvme_aor_inc_open(ns);
177188eea45cSKlaus Jensen 
177288eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
177388eea45cSKlaus Jensen             nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_IMPLICITLY_OPEN);
177488eea45cSKlaus Jensen             return NVME_SUCCESS;
177588eea45cSKlaus Jensen         }
177688eea45cSKlaus Jensen 
177788eea45cSKlaus Jensen         /* fallthrough */
177888eea45cSKlaus Jensen 
177988eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
178088eea45cSKlaus Jensen         if (flags & NVME_ZRM_AUTO) {
178188eea45cSKlaus Jensen             return NVME_SUCCESS;
178288eea45cSKlaus Jensen         }
178388eea45cSKlaus Jensen 
178488eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_EXPLICITLY_OPEN);
178588eea45cSKlaus Jensen 
178688eea45cSKlaus Jensen         /* fallthrough */
178788eea45cSKlaus Jensen 
178888eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
178988eea45cSKlaus Jensen         return NVME_SUCCESS;
179088eea45cSKlaus Jensen 
179188eea45cSKlaus Jensen     default:
179288eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
179388eea45cSKlaus Jensen     }
179488eea45cSKlaus Jensen }
179588eea45cSKlaus Jensen 
1796cccc2651SNiklas Cassel static inline uint16_t nvme_zrm_auto(NvmeCtrl *n, NvmeNamespace *ns,
1797cccc2651SNiklas Cassel                                      NvmeZone *zone)
179888eea45cSKlaus Jensen {
1799cccc2651SNiklas Cassel     return nvme_zrm_open_flags(n, ns, zone, NVME_ZRM_AUTO);
180088eea45cSKlaus Jensen }
180188eea45cSKlaus Jensen 
1802cccc2651SNiklas Cassel static inline uint16_t nvme_zrm_open(NvmeCtrl *n, NvmeNamespace *ns,
1803cccc2651SNiklas Cassel                                      NvmeZone *zone)
180488eea45cSKlaus Jensen {
1805cccc2651SNiklas Cassel     return nvme_zrm_open_flags(n, ns, zone, 0);
180688eea45cSKlaus Jensen }
180788eea45cSKlaus Jensen 
180888eea45cSKlaus Jensen static void nvme_advance_zone_wp(NvmeNamespace *ns, NvmeZone *zone,
180988eea45cSKlaus Jensen                                  uint32_t nlb)
181088eea45cSKlaus Jensen {
181188eea45cSKlaus Jensen     zone->d.wp += nlb;
181288eea45cSKlaus Jensen 
181388eea45cSKlaus Jensen     if (zone->d.wp == nvme_zone_wr_boundary(zone)) {
181488eea45cSKlaus Jensen         nvme_zrm_finish(ns, zone);
181588eea45cSKlaus Jensen     }
181688eea45cSKlaus Jensen }
181788eea45cSKlaus Jensen 
181888eea45cSKlaus Jensen static void nvme_finalize_zoned_write(NvmeNamespace *ns, NvmeRequest *req)
181988eea45cSKlaus Jensen {
182088eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
182188eea45cSKlaus Jensen     NvmeZone *zone;
182288eea45cSKlaus Jensen     uint64_t slba;
182388eea45cSKlaus Jensen     uint32_t nlb;
182488eea45cSKlaus Jensen 
182588eea45cSKlaus Jensen     slba = le64_to_cpu(rw->slba);
182688eea45cSKlaus Jensen     nlb = le16_to_cpu(rw->nlb) + 1;
182788eea45cSKlaus Jensen     zone = nvme_get_zone_by_slba(ns, slba);
1828189a8bf7SKlaus Jensen     assert(zone);
182988eea45cSKlaus Jensen 
183088eea45cSKlaus Jensen     nvme_advance_zone_wp(ns, zone, nlb);
183188eea45cSKlaus Jensen }
183288eea45cSKlaus Jensen 
183388eea45cSKlaus Jensen static inline bool nvme_is_write(NvmeRequest *req)
183488eea45cSKlaus Jensen {
183588eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
183688eea45cSKlaus Jensen 
183788eea45cSKlaus Jensen     return rw->opcode == NVME_CMD_WRITE ||
183888eea45cSKlaus Jensen            rw->opcode == NVME_CMD_ZONE_APPEND ||
183988eea45cSKlaus Jensen            rw->opcode == NVME_CMD_WRITE_ZEROES;
184088eea45cSKlaus Jensen }
184188eea45cSKlaus Jensen 
184238f4ac65SKlaus Jensen static AioContext *nvme_get_aio_context(BlockAIOCB *acb)
184338f4ac65SKlaus Jensen {
184438f4ac65SKlaus Jensen     return qemu_get_aio_context();
184538f4ac65SKlaus Jensen }
184638f4ac65SKlaus Jensen 
184788eea45cSKlaus Jensen static void nvme_misc_cb(void *opaque, int ret)
184888eea45cSKlaus Jensen {
184988eea45cSKlaus Jensen     NvmeRequest *req = opaque;
185088eea45cSKlaus Jensen 
185138f4ac65SKlaus Jensen     trace_pci_nvme_misc_cb(nvme_cid(req));
185288eea45cSKlaus Jensen 
185388eea45cSKlaus Jensen     if (ret) {
185488eea45cSKlaus Jensen         nvme_aio_err(req, ret);
185588eea45cSKlaus Jensen     }
185688eea45cSKlaus Jensen 
185788eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
185888eea45cSKlaus Jensen }
185988eea45cSKlaus Jensen 
186088eea45cSKlaus Jensen void nvme_rw_complete_cb(void *opaque, int ret)
186188eea45cSKlaus Jensen {
186288eea45cSKlaus Jensen     NvmeRequest *req = opaque;
186388eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
186488eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
186588eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
186688eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
186788eea45cSKlaus Jensen 
186888eea45cSKlaus Jensen     trace_pci_nvme_rw_complete_cb(nvme_cid(req), blk_name(blk));
186988eea45cSKlaus Jensen 
187088eea45cSKlaus Jensen     if (ret) {
187188eea45cSKlaus Jensen         block_acct_failed(stats, acct);
187288eea45cSKlaus Jensen         nvme_aio_err(req, ret);
187388eea45cSKlaus Jensen     } else {
187488eea45cSKlaus Jensen         block_acct_done(stats, acct);
187588eea45cSKlaus Jensen     }
187688eea45cSKlaus Jensen 
187788eea45cSKlaus Jensen     if (ns->params.zoned && nvme_is_write(req)) {
187888eea45cSKlaus Jensen         nvme_finalize_zoned_write(ns, req);
187988eea45cSKlaus Jensen     }
188088eea45cSKlaus Jensen 
188188eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
188288eea45cSKlaus Jensen }
188388eea45cSKlaus Jensen 
188488eea45cSKlaus Jensen static void nvme_rw_cb(void *opaque, int ret)
188588eea45cSKlaus Jensen {
188688eea45cSKlaus Jensen     NvmeRequest *req = opaque;
188788eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
188888eea45cSKlaus Jensen 
188988eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
189088eea45cSKlaus Jensen 
189188eea45cSKlaus Jensen     trace_pci_nvme_rw_cb(nvme_cid(req), blk_name(blk));
189288eea45cSKlaus Jensen 
189388eea45cSKlaus Jensen     if (ret) {
189488eea45cSKlaus Jensen         goto out;
189588eea45cSKlaus Jensen     }
189688eea45cSKlaus Jensen 
189788eea45cSKlaus Jensen     if (ns->lbaf.ms) {
189888eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
189988eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
190088eea45cSKlaus Jensen         uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
190188eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
190288eea45cSKlaus Jensen 
190388eea45cSKlaus Jensen         if (req->cmd.opcode == NVME_CMD_WRITE_ZEROES) {
190488eea45cSKlaus Jensen             size_t mlen = nvme_m2b(ns, nlb);
190588eea45cSKlaus Jensen 
190688eea45cSKlaus Jensen             req->aiocb = blk_aio_pwrite_zeroes(blk, offset, mlen,
190788eea45cSKlaus Jensen                                                BDRV_REQ_MAY_UNMAP,
190888eea45cSKlaus Jensen                                                nvme_rw_complete_cb, req);
190988eea45cSKlaus Jensen             return;
191088eea45cSKlaus Jensen         }
191188eea45cSKlaus Jensen 
191288eea45cSKlaus Jensen         if (nvme_ns_ext(ns) || req->cmd.mptr) {
191388eea45cSKlaus Jensen             uint16_t status;
191488eea45cSKlaus Jensen 
191588eea45cSKlaus Jensen             nvme_sg_unmap(&req->sg);
191688eea45cSKlaus Jensen             status = nvme_map_mdata(nvme_ctrl(req), nlb, req);
191788eea45cSKlaus Jensen             if (status) {
191888eea45cSKlaus Jensen                 ret = -EFAULT;
191988eea45cSKlaus Jensen                 goto out;
192088eea45cSKlaus Jensen             }
192188eea45cSKlaus Jensen 
192288eea45cSKlaus Jensen             if (req->cmd.opcode == NVME_CMD_READ) {
192388eea45cSKlaus Jensen                 return nvme_blk_read(blk, offset, nvme_rw_complete_cb, req);
192488eea45cSKlaus Jensen             }
192588eea45cSKlaus Jensen 
192688eea45cSKlaus Jensen             return nvme_blk_write(blk, offset, nvme_rw_complete_cb, req);
192788eea45cSKlaus Jensen         }
192888eea45cSKlaus Jensen     }
192988eea45cSKlaus Jensen 
193088eea45cSKlaus Jensen out:
193188eea45cSKlaus Jensen     nvme_rw_complete_cb(req, ret);
193288eea45cSKlaus Jensen }
193388eea45cSKlaus Jensen 
193488eea45cSKlaus Jensen static void nvme_verify_cb(void *opaque, int ret)
193588eea45cSKlaus Jensen {
193688eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
193788eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
193888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
193988eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
194088eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
194188eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
194288eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
194388eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
19442a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
194588eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
194688eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
194788eea45cSKlaus Jensen     uint32_t reftag = le32_to_cpu(rw->reftag);
194888eea45cSKlaus Jensen     uint16_t status;
194988eea45cSKlaus Jensen 
19502a132309SKlaus Jensen     trace_pci_nvme_verify_cb(nvme_cid(req), prinfo, apptag, appmask, reftag);
195188eea45cSKlaus Jensen 
195288eea45cSKlaus Jensen     if (ret) {
195388eea45cSKlaus Jensen         block_acct_failed(stats, acct);
195488eea45cSKlaus Jensen         nvme_aio_err(req, ret);
195588eea45cSKlaus Jensen         goto out;
195688eea45cSKlaus Jensen     }
195788eea45cSKlaus Jensen 
195888eea45cSKlaus Jensen     block_acct_done(stats, acct);
195988eea45cSKlaus Jensen 
196088eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
196188eea45cSKlaus Jensen         status = nvme_dif_mangle_mdata(ns, ctx->mdata.bounce,
196288eea45cSKlaus Jensen                                        ctx->mdata.iov.size, slba);
196388eea45cSKlaus Jensen         if (status) {
196488eea45cSKlaus Jensen             req->status = status;
196588eea45cSKlaus Jensen             goto out;
196688eea45cSKlaus Jensen         }
196788eea45cSKlaus Jensen 
196888eea45cSKlaus Jensen         req->status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
196988eea45cSKlaus Jensen                                      ctx->mdata.bounce, ctx->mdata.iov.size,
19702a132309SKlaus Jensen                                      prinfo, slba, apptag, appmask, &reftag);
197188eea45cSKlaus Jensen     }
197288eea45cSKlaus Jensen 
197388eea45cSKlaus Jensen out:
197488eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
197588eea45cSKlaus Jensen     g_free(ctx->data.bounce);
197688eea45cSKlaus Jensen 
197788eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
197888eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
197988eea45cSKlaus Jensen 
198088eea45cSKlaus Jensen     g_free(ctx);
198188eea45cSKlaus Jensen 
198288eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
198388eea45cSKlaus Jensen }
198488eea45cSKlaus Jensen 
198588eea45cSKlaus Jensen 
198688eea45cSKlaus Jensen static void nvme_verify_mdata_in_cb(void *opaque, int ret)
198788eea45cSKlaus Jensen {
198888eea45cSKlaus Jensen     NvmeBounceContext *ctx = opaque;
198988eea45cSKlaus Jensen     NvmeRequest *req = ctx->req;
199088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
199188eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
199288eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
199388eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
199488eea45cSKlaus Jensen     size_t mlen = nvme_m2b(ns, nlb);
199588eea45cSKlaus Jensen     uint64_t offset = nvme_moff(ns, slba);
199688eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
199788eea45cSKlaus Jensen 
199888eea45cSKlaus Jensen     trace_pci_nvme_verify_mdata_in_cb(nvme_cid(req), blk_name(blk));
199988eea45cSKlaus Jensen 
200088eea45cSKlaus Jensen     if (ret) {
200188eea45cSKlaus Jensen         goto out;
200288eea45cSKlaus Jensen     }
200388eea45cSKlaus Jensen 
200488eea45cSKlaus Jensen     ctx->mdata.bounce = g_malloc(mlen);
200588eea45cSKlaus Jensen 
200688eea45cSKlaus Jensen     qemu_iovec_reset(&ctx->mdata.iov);
200788eea45cSKlaus Jensen     qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
200888eea45cSKlaus Jensen 
200988eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
201088eea45cSKlaus Jensen                                 nvme_verify_cb, ctx);
201188eea45cSKlaus Jensen     return;
201288eea45cSKlaus Jensen 
201388eea45cSKlaus Jensen out:
201488eea45cSKlaus Jensen     nvme_verify_cb(ctx, ret);
201588eea45cSKlaus Jensen }
201688eea45cSKlaus Jensen 
201788eea45cSKlaus Jensen struct nvme_compare_ctx {
201888eea45cSKlaus Jensen     struct {
201988eea45cSKlaus Jensen         QEMUIOVector iov;
202088eea45cSKlaus Jensen         uint8_t *bounce;
202188eea45cSKlaus Jensen     } data;
202288eea45cSKlaus Jensen 
202388eea45cSKlaus Jensen     struct {
202488eea45cSKlaus Jensen         QEMUIOVector iov;
202588eea45cSKlaus Jensen         uint8_t *bounce;
202688eea45cSKlaus Jensen     } mdata;
202788eea45cSKlaus Jensen };
202888eea45cSKlaus Jensen 
202988eea45cSKlaus Jensen static void nvme_compare_mdata_cb(void *opaque, int ret)
203088eea45cSKlaus Jensen {
203188eea45cSKlaus Jensen     NvmeRequest *req = opaque;
203288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
203388eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
203488eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
20352a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
203688eea45cSKlaus Jensen     uint16_t apptag = le16_to_cpu(rw->apptag);
203788eea45cSKlaus Jensen     uint16_t appmask = le16_to_cpu(rw->appmask);
203888eea45cSKlaus Jensen     uint32_t reftag = le32_to_cpu(rw->reftag);
203988eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
204088eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
204188eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
204288eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
204388eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
204488eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
204588eea45cSKlaus Jensen 
204688eea45cSKlaus Jensen     trace_pci_nvme_compare_mdata_cb(nvme_cid(req));
204788eea45cSKlaus Jensen 
204888eea45cSKlaus Jensen     if (ret) {
204988eea45cSKlaus Jensen         block_acct_failed(stats, acct);
205088eea45cSKlaus Jensen         nvme_aio_err(req, ret);
205188eea45cSKlaus Jensen         goto out;
205288eea45cSKlaus Jensen     }
205388eea45cSKlaus Jensen 
205488eea45cSKlaus Jensen     buf = g_malloc(ctx->mdata.iov.size);
205588eea45cSKlaus Jensen 
205688eea45cSKlaus Jensen     status = nvme_bounce_mdata(n, buf, ctx->mdata.iov.size,
205788eea45cSKlaus Jensen                                NVME_TX_DIRECTION_TO_DEVICE, req);
205888eea45cSKlaus Jensen     if (status) {
205988eea45cSKlaus Jensen         req->status = status;
206088eea45cSKlaus Jensen         goto out;
206188eea45cSKlaus Jensen     }
206288eea45cSKlaus Jensen 
206388eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
206488eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
206588eea45cSKlaus Jensen         uint8_t *bufp;
206688eea45cSKlaus Jensen         uint8_t *mbufp = ctx->mdata.bounce;
206788eea45cSKlaus Jensen         uint8_t *end = mbufp + ctx->mdata.iov.size;
206888eea45cSKlaus Jensen         int16_t pil = 0;
206988eea45cSKlaus Jensen 
207088eea45cSKlaus Jensen         status = nvme_dif_check(ns, ctx->data.bounce, ctx->data.iov.size,
20712a132309SKlaus Jensen                                 ctx->mdata.bounce, ctx->mdata.iov.size, prinfo,
20720ca5c3ccSKlaus Jensen                                 slba, apptag, appmask, &reftag);
207388eea45cSKlaus Jensen         if (status) {
207488eea45cSKlaus Jensen             req->status = status;
207588eea45cSKlaus Jensen             goto out;
207688eea45cSKlaus Jensen         }
207788eea45cSKlaus Jensen 
207888eea45cSKlaus Jensen         /*
207988eea45cSKlaus Jensen          * When formatted with protection information, do not compare the DIF
208088eea45cSKlaus Jensen          * tuple.
208188eea45cSKlaus Jensen          */
208288eea45cSKlaus Jensen         if (!(ns->id_ns.dps & NVME_ID_NS_DPS_FIRST_EIGHT)) {
208388eea45cSKlaus Jensen             pil = ns->lbaf.ms - sizeof(NvmeDifTuple);
208488eea45cSKlaus Jensen         }
208588eea45cSKlaus Jensen 
208688eea45cSKlaus Jensen         for (bufp = buf; mbufp < end; bufp += ns->lbaf.ms, mbufp += ns->lbaf.ms) {
208788eea45cSKlaus Jensen             if (memcmp(bufp + pil, mbufp + pil, ns->lbaf.ms - pil)) {
208888eea45cSKlaus Jensen                 req->status = NVME_CMP_FAILURE;
208988eea45cSKlaus Jensen                 goto out;
209088eea45cSKlaus Jensen             }
209188eea45cSKlaus Jensen         }
209288eea45cSKlaus Jensen 
209388eea45cSKlaus Jensen         goto out;
209488eea45cSKlaus Jensen     }
209588eea45cSKlaus Jensen 
209688eea45cSKlaus Jensen     if (memcmp(buf, ctx->mdata.bounce, ctx->mdata.iov.size)) {
209788eea45cSKlaus Jensen         req->status = NVME_CMP_FAILURE;
209888eea45cSKlaus Jensen         goto out;
209988eea45cSKlaus Jensen     }
210088eea45cSKlaus Jensen 
210188eea45cSKlaus Jensen     block_acct_done(stats, acct);
210288eea45cSKlaus Jensen 
210388eea45cSKlaus Jensen out:
210488eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
210588eea45cSKlaus Jensen     g_free(ctx->data.bounce);
210688eea45cSKlaus Jensen 
210788eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->mdata.iov);
210888eea45cSKlaus Jensen     g_free(ctx->mdata.bounce);
210988eea45cSKlaus Jensen 
211088eea45cSKlaus Jensen     g_free(ctx);
211188eea45cSKlaus Jensen 
211288eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
211388eea45cSKlaus Jensen }
211488eea45cSKlaus Jensen 
211588eea45cSKlaus Jensen static void nvme_compare_data_cb(void *opaque, int ret)
211688eea45cSKlaus Jensen {
211788eea45cSKlaus Jensen     NvmeRequest *req = opaque;
211888eea45cSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
211988eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
212088eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
212188eea45cSKlaus Jensen     BlockAcctCookie *acct = &req->acct;
212288eea45cSKlaus Jensen     BlockAcctStats *stats = blk_get_stats(blk);
212388eea45cSKlaus Jensen 
212488eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = req->opaque;
212588eea45cSKlaus Jensen     g_autofree uint8_t *buf = NULL;
212688eea45cSKlaus Jensen     uint16_t status;
212788eea45cSKlaus Jensen 
212888eea45cSKlaus Jensen     trace_pci_nvme_compare_data_cb(nvme_cid(req));
212988eea45cSKlaus Jensen 
213088eea45cSKlaus Jensen     if (ret) {
213188eea45cSKlaus Jensen         block_acct_failed(stats, acct);
213288eea45cSKlaus Jensen         nvme_aio_err(req, ret);
213388eea45cSKlaus Jensen         goto out;
213488eea45cSKlaus Jensen     }
213588eea45cSKlaus Jensen 
213688eea45cSKlaus Jensen     buf = g_malloc(ctx->data.iov.size);
213788eea45cSKlaus Jensen 
213888eea45cSKlaus Jensen     status = nvme_bounce_data(n, buf, ctx->data.iov.size,
213988eea45cSKlaus Jensen                               NVME_TX_DIRECTION_TO_DEVICE, req);
214088eea45cSKlaus Jensen     if (status) {
214188eea45cSKlaus Jensen         req->status = status;
214288eea45cSKlaus Jensen         goto out;
214388eea45cSKlaus Jensen     }
214488eea45cSKlaus Jensen 
214588eea45cSKlaus Jensen     if (memcmp(buf, ctx->data.bounce, ctx->data.iov.size)) {
214688eea45cSKlaus Jensen         req->status = NVME_CMP_FAILURE;
214788eea45cSKlaus Jensen         goto out;
214888eea45cSKlaus Jensen     }
214988eea45cSKlaus Jensen 
215088eea45cSKlaus Jensen     if (ns->lbaf.ms) {
215188eea45cSKlaus Jensen         NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
215288eea45cSKlaus Jensen         uint64_t slba = le64_to_cpu(rw->slba);
215388eea45cSKlaus Jensen         uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
215488eea45cSKlaus Jensen         size_t mlen = nvme_m2b(ns, nlb);
215588eea45cSKlaus Jensen         uint64_t offset = nvme_moff(ns, slba);
215688eea45cSKlaus Jensen 
215788eea45cSKlaus Jensen         ctx->mdata.bounce = g_malloc(mlen);
215888eea45cSKlaus Jensen 
215988eea45cSKlaus Jensen         qemu_iovec_init(&ctx->mdata.iov, 1);
216088eea45cSKlaus Jensen         qemu_iovec_add(&ctx->mdata.iov, ctx->mdata.bounce, mlen);
216188eea45cSKlaus Jensen 
216288eea45cSKlaus Jensen         req->aiocb = blk_aio_preadv(blk, offset, &ctx->mdata.iov, 0,
216388eea45cSKlaus Jensen                                     nvme_compare_mdata_cb, req);
216488eea45cSKlaus Jensen         return;
216588eea45cSKlaus Jensen     }
216688eea45cSKlaus Jensen 
216788eea45cSKlaus Jensen     block_acct_done(stats, acct);
216888eea45cSKlaus Jensen 
216988eea45cSKlaus Jensen out:
217088eea45cSKlaus Jensen     qemu_iovec_destroy(&ctx->data.iov);
217188eea45cSKlaus Jensen     g_free(ctx->data.bounce);
217288eea45cSKlaus Jensen     g_free(ctx);
217388eea45cSKlaus Jensen 
217488eea45cSKlaus Jensen     nvme_enqueue_req_completion(nvme_cq(req), req);
217588eea45cSKlaus Jensen }
217688eea45cSKlaus Jensen 
2177d7d1474fSKlaus Jensen typedef struct NvmeDSMAIOCB {
2178d7d1474fSKlaus Jensen     BlockAIOCB common;
2179d7d1474fSKlaus Jensen     BlockAIOCB *aiocb;
2180d7d1474fSKlaus Jensen     NvmeRequest *req;
2181d7d1474fSKlaus Jensen     QEMUBH *bh;
2182d7d1474fSKlaus Jensen     int ret;
2183d7d1474fSKlaus Jensen 
2184d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2185d7d1474fSKlaus Jensen     unsigned int nr;
2186d7d1474fSKlaus Jensen     unsigned int idx;
2187d7d1474fSKlaus Jensen } NvmeDSMAIOCB;
2188d7d1474fSKlaus Jensen 
2189d7d1474fSKlaus Jensen static void nvme_dsm_cancel(BlockAIOCB *aiocb)
2190d7d1474fSKlaus Jensen {
2191d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = container_of(aiocb, NvmeDSMAIOCB, common);
2192d7d1474fSKlaus Jensen 
2193d7d1474fSKlaus Jensen     /* break nvme_dsm_cb loop */
2194d7d1474fSKlaus Jensen     iocb->idx = iocb->nr;
2195d7d1474fSKlaus Jensen     iocb->ret = -ECANCELED;
2196d7d1474fSKlaus Jensen 
2197d7d1474fSKlaus Jensen     if (iocb->aiocb) {
2198d7d1474fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2199d7d1474fSKlaus Jensen         iocb->aiocb = NULL;
2200d7d1474fSKlaus Jensen     } else {
2201d7d1474fSKlaus Jensen         /*
2202d7d1474fSKlaus Jensen          * We only reach this if nvme_dsm_cancel() has already been called or
2203d7d1474fSKlaus Jensen          * the command ran to completion and nvme_dsm_bh is scheduled to run.
2204d7d1474fSKlaus Jensen          */
2205d7d1474fSKlaus Jensen         assert(iocb->idx == iocb->nr);
2206d7d1474fSKlaus Jensen     }
2207d7d1474fSKlaus Jensen }
2208d7d1474fSKlaus Jensen 
2209d7d1474fSKlaus Jensen static const AIOCBInfo nvme_dsm_aiocb_info = {
2210d7d1474fSKlaus Jensen     .aiocb_size   = sizeof(NvmeDSMAIOCB),
2211d7d1474fSKlaus Jensen     .cancel_async = nvme_dsm_cancel,
2212d7d1474fSKlaus Jensen };
2213d7d1474fSKlaus Jensen 
2214d7d1474fSKlaus Jensen static void nvme_dsm_bh(void *opaque)
2215d7d1474fSKlaus Jensen {
2216d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2217d7d1474fSKlaus Jensen 
2218d7d1474fSKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2219d7d1474fSKlaus Jensen 
2220d7d1474fSKlaus Jensen     qemu_bh_delete(iocb->bh);
2221d7d1474fSKlaus Jensen     iocb->bh = NULL;
2222d7d1474fSKlaus Jensen     qemu_aio_unref(iocb);
2223d7d1474fSKlaus Jensen }
2224d7d1474fSKlaus Jensen 
2225d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret);
2226d7d1474fSKlaus Jensen 
2227d7d1474fSKlaus Jensen static void nvme_dsm_md_cb(void *opaque, int ret)
2228d7d1474fSKlaus Jensen {
2229d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2230d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2231d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2232d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2233d7d1474fSKlaus Jensen     uint64_t slba;
2234d7d1474fSKlaus Jensen     uint32_t nlb;
2235d7d1474fSKlaus Jensen 
2236d7d1474fSKlaus Jensen     if (ret < 0) {
2237d7d1474fSKlaus Jensen         iocb->ret = ret;
2238d7d1474fSKlaus Jensen         goto done;
2239d7d1474fSKlaus Jensen     }
2240d7d1474fSKlaus Jensen 
2241d7d1474fSKlaus Jensen     if (!ns->lbaf.ms) {
2242d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
2243d7d1474fSKlaus Jensen         return;
2244d7d1474fSKlaus Jensen     }
2245d7d1474fSKlaus Jensen 
2246d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx - 1];
2247d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2248d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2249d7d1474fSKlaus Jensen 
2250d7d1474fSKlaus Jensen     /*
2251d7d1474fSKlaus Jensen      * Check that all block were discarded (zeroed); otherwise we do not zero
2252d7d1474fSKlaus Jensen      * the metadata.
2253d7d1474fSKlaus Jensen      */
2254d7d1474fSKlaus Jensen 
2255d7d1474fSKlaus Jensen     ret = nvme_block_status_all(ns, slba, nlb, BDRV_BLOCK_ZERO);
2256d7d1474fSKlaus Jensen     if (ret) {
2257d7d1474fSKlaus Jensen         if (ret < 0) {
2258d7d1474fSKlaus Jensen             iocb->ret = ret;
2259d7d1474fSKlaus Jensen             goto done;
2260d7d1474fSKlaus Jensen         }
2261d7d1474fSKlaus Jensen 
2262d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
2263d7d1474fSKlaus Jensen     }
2264d7d1474fSKlaus Jensen 
2265d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, nvme_moff(ns, slba),
2266d7d1474fSKlaus Jensen                                         nvme_m2b(ns, nlb), BDRV_REQ_MAY_UNMAP,
2267d7d1474fSKlaus Jensen                                         nvme_dsm_cb, iocb);
2268d7d1474fSKlaus Jensen     return;
2269d7d1474fSKlaus Jensen 
2270d7d1474fSKlaus Jensen done:
2271d7d1474fSKlaus Jensen     iocb->aiocb = NULL;
2272d7d1474fSKlaus Jensen     qemu_bh_schedule(iocb->bh);
2273d7d1474fSKlaus Jensen }
2274d7d1474fSKlaus Jensen 
2275d7d1474fSKlaus Jensen static void nvme_dsm_cb(void *opaque, int ret)
2276d7d1474fSKlaus Jensen {
2277d7d1474fSKlaus Jensen     NvmeDSMAIOCB *iocb = opaque;
2278d7d1474fSKlaus Jensen     NvmeRequest *req = iocb->req;
2279d7d1474fSKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
2280d7d1474fSKlaus Jensen     NvmeNamespace *ns = req->ns;
2281d7d1474fSKlaus Jensen     NvmeDsmRange *range;
2282d7d1474fSKlaus Jensen     uint64_t slba;
2283d7d1474fSKlaus Jensen     uint32_t nlb;
2284d7d1474fSKlaus Jensen 
2285d7d1474fSKlaus Jensen     if (ret < 0) {
2286d7d1474fSKlaus Jensen         iocb->ret = ret;
2287d7d1474fSKlaus Jensen         goto done;
2288d7d1474fSKlaus Jensen     }
2289d7d1474fSKlaus Jensen 
2290d7d1474fSKlaus Jensen next:
2291d7d1474fSKlaus Jensen     if (iocb->idx == iocb->nr) {
2292d7d1474fSKlaus Jensen         goto done;
2293d7d1474fSKlaus Jensen     }
2294d7d1474fSKlaus Jensen 
2295d7d1474fSKlaus Jensen     range = &iocb->range[iocb->idx++];
2296d7d1474fSKlaus Jensen     slba = le64_to_cpu(range->slba);
2297d7d1474fSKlaus Jensen     nlb = le32_to_cpu(range->nlb);
2298d7d1474fSKlaus Jensen 
2299d7d1474fSKlaus Jensen     trace_pci_nvme_dsm_deallocate(slba, nlb);
2300d7d1474fSKlaus Jensen 
2301d7d1474fSKlaus Jensen     if (nlb > n->dmrsl) {
2302d7d1474fSKlaus Jensen         trace_pci_nvme_dsm_single_range_limit_exceeded(nlb, n->dmrsl);
2303d7d1474fSKlaus Jensen         goto next;
2304d7d1474fSKlaus Jensen     }
2305d7d1474fSKlaus Jensen 
2306d7d1474fSKlaus Jensen     if (nvme_check_bounds(ns, slba, nlb)) {
2307d7d1474fSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(slba, nlb,
2308d7d1474fSKlaus Jensen                                              ns->id_ns.nsze);
2309d7d1474fSKlaus Jensen         goto next;
2310d7d1474fSKlaus Jensen     }
2311d7d1474fSKlaus Jensen 
2312d7d1474fSKlaus Jensen     iocb->aiocb = blk_aio_pdiscard(ns->blkconf.blk, nvme_l2b(ns, slba),
2313d7d1474fSKlaus Jensen                                    nvme_l2b(ns, nlb),
2314d7d1474fSKlaus Jensen                                    nvme_dsm_md_cb, iocb);
2315d7d1474fSKlaus Jensen     return;
2316d7d1474fSKlaus Jensen 
2317d7d1474fSKlaus Jensen done:
2318d7d1474fSKlaus Jensen     iocb->aiocb = NULL;
2319d7d1474fSKlaus Jensen     qemu_bh_schedule(iocb->bh);
2320d7d1474fSKlaus Jensen }
2321d7d1474fSKlaus Jensen 
232288eea45cSKlaus Jensen static uint16_t nvme_dsm(NvmeCtrl *n, NvmeRequest *req)
232388eea45cSKlaus Jensen {
232488eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
232588eea45cSKlaus Jensen     NvmeDsmCmd *dsm = (NvmeDsmCmd *) &req->cmd;
232688eea45cSKlaus Jensen     uint32_t attr = le32_to_cpu(dsm->attributes);
232788eea45cSKlaus Jensen     uint32_t nr = (le32_to_cpu(dsm->nr) & 0xff) + 1;
232888eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
232988eea45cSKlaus Jensen 
2330d7d1474fSKlaus Jensen     trace_pci_nvme_dsm(nr, attr);
233188eea45cSKlaus Jensen 
233288eea45cSKlaus Jensen     if (attr & NVME_DSMGMT_AD) {
2333d7d1474fSKlaus Jensen         NvmeDSMAIOCB *iocb = blk_aio_get(&nvme_dsm_aiocb_info, ns->blkconf.blk,
2334d7d1474fSKlaus Jensen                                          nvme_misc_cb, req);
233588eea45cSKlaus Jensen 
2336d7d1474fSKlaus Jensen         iocb->req = req;
2337d7d1474fSKlaus Jensen         iocb->bh = qemu_bh_new(nvme_dsm_bh, iocb);
2338d7d1474fSKlaus Jensen         iocb->ret = 0;
2339d7d1474fSKlaus Jensen         iocb->range = g_new(NvmeDsmRange, nr);
2340d7d1474fSKlaus Jensen         iocb->nr = nr;
2341d7d1474fSKlaus Jensen         iocb->idx = 0;
2342d7d1474fSKlaus Jensen 
2343d7d1474fSKlaus Jensen         status = nvme_h2c(n, (uint8_t *)iocb->range, sizeof(NvmeDsmRange) * nr,
2344d7d1474fSKlaus Jensen                           req);
234588eea45cSKlaus Jensen         if (status) {
234688eea45cSKlaus Jensen             return status;
234788eea45cSKlaus Jensen         }
234888eea45cSKlaus Jensen 
2349d7d1474fSKlaus Jensen         req->aiocb = &iocb->common;
2350d7d1474fSKlaus Jensen         nvme_dsm_cb(iocb, 0);
235188eea45cSKlaus Jensen 
2352d7d1474fSKlaus Jensen         return NVME_NO_COMPLETE;
235388eea45cSKlaus Jensen     }
235488eea45cSKlaus Jensen 
235588eea45cSKlaus Jensen     return status;
235688eea45cSKlaus Jensen }
235788eea45cSKlaus Jensen 
235888eea45cSKlaus Jensen static uint16_t nvme_verify(NvmeCtrl *n, NvmeRequest *req)
235988eea45cSKlaus Jensen {
236088eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
236188eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
236288eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
236388eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
236488eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
236588eea45cSKlaus Jensen     size_t len = nvme_l2b(ns, nlb);
236688eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
23672a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
236888eea45cSKlaus Jensen     uint32_t reftag = le32_to_cpu(rw->reftag);
236988eea45cSKlaus Jensen     NvmeBounceContext *ctx = NULL;
237088eea45cSKlaus Jensen     uint16_t status;
237188eea45cSKlaus Jensen 
237288eea45cSKlaus Jensen     trace_pci_nvme_verify(nvme_cid(req), nvme_nsid(ns), slba, nlb);
237388eea45cSKlaus Jensen 
237488eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
23752a132309SKlaus Jensen         status = nvme_check_prinfo(ns, prinfo, slba, reftag);
237688eea45cSKlaus Jensen         if (status) {
237788eea45cSKlaus Jensen             return status;
237888eea45cSKlaus Jensen         }
237988eea45cSKlaus Jensen 
23802a132309SKlaus Jensen         if (prinfo & NVME_PRINFO_PRACT) {
238188eea45cSKlaus Jensen             return NVME_INVALID_PROT_INFO | NVME_DNR;
238288eea45cSKlaus Jensen         }
238388eea45cSKlaus Jensen     }
238488eea45cSKlaus Jensen 
238588eea45cSKlaus Jensen     if (len > n->page_size << n->params.vsl) {
238688eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
238788eea45cSKlaus Jensen     }
238888eea45cSKlaus Jensen 
238988eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
239088eea45cSKlaus Jensen     if (status) {
239188eea45cSKlaus Jensen         return status;
239288eea45cSKlaus Jensen     }
239388eea45cSKlaus Jensen 
239488eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
239588eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
239688eea45cSKlaus Jensen         if (status) {
239788eea45cSKlaus Jensen             return status;
239888eea45cSKlaus Jensen         }
239988eea45cSKlaus Jensen     }
240088eea45cSKlaus Jensen 
240188eea45cSKlaus Jensen     ctx = g_new0(NvmeBounceContext, 1);
240288eea45cSKlaus Jensen     ctx->req = req;
240388eea45cSKlaus Jensen 
240488eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(len);
240588eea45cSKlaus Jensen 
240688eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
240788eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, len);
240888eea45cSKlaus Jensen 
240988eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, ctx->data.iov.size,
241088eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
241188eea45cSKlaus Jensen 
241288eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(ns->blkconf.blk, offset, &ctx->data.iov, 0,
241388eea45cSKlaus Jensen                                 nvme_verify_mdata_in_cb, ctx);
241488eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
241588eea45cSKlaus Jensen }
241688eea45cSKlaus Jensen 
2417796d2068SKlaus Jensen typedef struct NvmeCopyAIOCB {
2418796d2068SKlaus Jensen     BlockAIOCB common;
2419796d2068SKlaus Jensen     BlockAIOCB *aiocb;
2420796d2068SKlaus Jensen     NvmeRequest *req;
2421796d2068SKlaus Jensen     QEMUBH *bh;
2422796d2068SKlaus Jensen     int ret;
2423796d2068SKlaus Jensen 
2424796d2068SKlaus Jensen     NvmeCopySourceRange *ranges;
2425796d2068SKlaus Jensen     int nr;
2426796d2068SKlaus Jensen     int idx;
2427796d2068SKlaus Jensen 
2428796d2068SKlaus Jensen     uint8_t *bounce;
2429796d2068SKlaus Jensen     QEMUIOVector iov;
2430796d2068SKlaus Jensen     struct {
2431796d2068SKlaus Jensen         BlockAcctCookie read;
2432796d2068SKlaus Jensen         BlockAcctCookie write;
2433796d2068SKlaus Jensen     } acct;
2434796d2068SKlaus Jensen 
2435796d2068SKlaus Jensen     uint32_t reftag;
2436796d2068SKlaus Jensen     uint64_t slba;
2437796d2068SKlaus Jensen 
2438796d2068SKlaus Jensen     NvmeZone *zone;
2439796d2068SKlaus Jensen } NvmeCopyAIOCB;
2440796d2068SKlaus Jensen 
2441796d2068SKlaus Jensen static void nvme_copy_cancel(BlockAIOCB *aiocb)
244288eea45cSKlaus Jensen {
2443796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = container_of(aiocb, NvmeCopyAIOCB, common);
2444796d2068SKlaus Jensen 
2445796d2068SKlaus Jensen     iocb->ret = -ECANCELED;
2446796d2068SKlaus Jensen 
2447796d2068SKlaus Jensen     if (iocb->aiocb) {
2448796d2068SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
2449796d2068SKlaus Jensen         iocb->aiocb = NULL;
2450796d2068SKlaus Jensen     }
2451796d2068SKlaus Jensen }
2452796d2068SKlaus Jensen 
2453796d2068SKlaus Jensen static const AIOCBInfo nvme_copy_aiocb_info = {
2454796d2068SKlaus Jensen     .aiocb_size   = sizeof(NvmeCopyAIOCB),
2455796d2068SKlaus Jensen     .cancel_async = nvme_copy_cancel,
2456796d2068SKlaus Jensen };
2457796d2068SKlaus Jensen 
2458796d2068SKlaus Jensen static void nvme_copy_bh(void *opaque)
2459796d2068SKlaus Jensen {
2460796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2461796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
246288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
2463796d2068SKlaus Jensen     BlockAcctStats *stats = blk_get_stats(ns->blkconf.blk);
2464796d2068SKlaus Jensen 
2465796d2068SKlaus Jensen     if (iocb->idx != iocb->nr) {
2466796d2068SKlaus Jensen         req->cqe.result = cpu_to_le32(iocb->idx);
2467796d2068SKlaus Jensen     }
2468796d2068SKlaus Jensen 
2469796d2068SKlaus Jensen     qemu_iovec_destroy(&iocb->iov);
2470796d2068SKlaus Jensen     g_free(iocb->bounce);
2471796d2068SKlaus Jensen 
2472796d2068SKlaus Jensen     qemu_bh_delete(iocb->bh);
2473796d2068SKlaus Jensen     iocb->bh = NULL;
2474796d2068SKlaus Jensen 
2475796d2068SKlaus Jensen     if (iocb->ret < 0) {
2476796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.read);
2477796d2068SKlaus Jensen         block_acct_failed(stats, &iocb->acct.write);
2478796d2068SKlaus Jensen     } else {
2479796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.read);
2480796d2068SKlaus Jensen         block_acct_done(stats, &iocb->acct.write);
2481796d2068SKlaus Jensen     }
2482796d2068SKlaus Jensen 
2483796d2068SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
2484796d2068SKlaus Jensen     qemu_aio_unref(iocb);
2485796d2068SKlaus Jensen }
2486796d2068SKlaus Jensen 
2487796d2068SKlaus Jensen static void nvme_copy_cb(void *opaque, int ret);
2488796d2068SKlaus Jensen 
2489796d2068SKlaus Jensen static void nvme_copy_out_completed_cb(void *opaque, int ret)
2490796d2068SKlaus Jensen {
2491796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2492796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2493796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2494796d2068SKlaus Jensen     NvmeCopySourceRange *range = &iocb->ranges[iocb->idx];
2495796d2068SKlaus Jensen     uint32_t nlb = le32_to_cpu(range->nlb) + 1;
2496796d2068SKlaus Jensen 
2497796d2068SKlaus Jensen     if (ret < 0) {
2498796d2068SKlaus Jensen         iocb->ret = ret;
2499796d2068SKlaus Jensen         goto out;
2500796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2501796d2068SKlaus Jensen         goto out;
2502796d2068SKlaus Jensen     }
2503796d2068SKlaus Jensen 
2504796d2068SKlaus Jensen     if (ns->params.zoned) {
2505796d2068SKlaus Jensen         nvme_advance_zone_wp(ns, iocb->zone, nlb);
2506796d2068SKlaus Jensen     }
2507796d2068SKlaus Jensen 
2508796d2068SKlaus Jensen     iocb->idx++;
2509796d2068SKlaus Jensen     iocb->slba += nlb;
2510796d2068SKlaus Jensen out:
2511796d2068SKlaus Jensen     nvme_copy_cb(iocb, iocb->ret);
2512796d2068SKlaus Jensen }
2513796d2068SKlaus Jensen 
2514796d2068SKlaus Jensen static void nvme_copy_out_cb(void *opaque, int ret)
2515796d2068SKlaus Jensen {
2516796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2517796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2518796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2519796d2068SKlaus Jensen     NvmeCopySourceRange *range;
2520796d2068SKlaus Jensen     uint32_t nlb;
2521796d2068SKlaus Jensen     size_t mlen;
2522796d2068SKlaus Jensen     uint8_t *mbounce;
2523796d2068SKlaus Jensen 
2524796d2068SKlaus Jensen     if (ret < 0) {
2525796d2068SKlaus Jensen         iocb->ret = ret;
2526796d2068SKlaus Jensen         goto out;
2527796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2528796d2068SKlaus Jensen         goto out;
2529796d2068SKlaus Jensen     }
2530796d2068SKlaus Jensen 
2531796d2068SKlaus Jensen     if (!ns->lbaf.ms) {
2532796d2068SKlaus Jensen         nvme_copy_out_completed_cb(iocb, 0);
2533796d2068SKlaus Jensen         return;
2534796d2068SKlaus Jensen     }
2535796d2068SKlaus Jensen 
2536796d2068SKlaus Jensen     range = &iocb->ranges[iocb->idx];
2537796d2068SKlaus Jensen     nlb = le32_to_cpu(range->nlb) + 1;
2538796d2068SKlaus Jensen 
2539796d2068SKlaus Jensen     mlen = nvme_m2b(ns, nlb);
2540796d2068SKlaus Jensen     mbounce = iocb->bounce + nvme_l2b(ns, nlb);
2541796d2068SKlaus Jensen 
2542796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2543796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, mbounce, mlen);
2544796d2068SKlaus Jensen 
2545796d2068SKlaus Jensen     iocb->aiocb = blk_aio_pwritev(ns->blkconf.blk, nvme_moff(ns, iocb->slba),
2546796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_completed_cb,
2547796d2068SKlaus Jensen                                   iocb);
2548796d2068SKlaus Jensen 
2549796d2068SKlaus Jensen     return;
2550796d2068SKlaus Jensen 
2551796d2068SKlaus Jensen out:
2552796d2068SKlaus Jensen     nvme_copy_cb(iocb, ret);
2553796d2068SKlaus Jensen }
2554796d2068SKlaus Jensen 
2555796d2068SKlaus Jensen static void nvme_copy_in_completed_cb(void *opaque, int ret)
2556796d2068SKlaus Jensen {
2557796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2558796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2559796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2560796d2068SKlaus Jensen     NvmeCopySourceRange *range;
2561796d2068SKlaus Jensen     uint32_t nlb;
2562796d2068SKlaus Jensen     size_t len;
2563796d2068SKlaus Jensen     uint16_t status;
2564796d2068SKlaus Jensen 
2565796d2068SKlaus Jensen     if (ret < 0) {
2566796d2068SKlaus Jensen         iocb->ret = ret;
2567796d2068SKlaus Jensen         goto out;
2568796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2569796d2068SKlaus Jensen         goto out;
2570796d2068SKlaus Jensen     }
2571796d2068SKlaus Jensen 
2572796d2068SKlaus Jensen     range = &iocb->ranges[iocb->idx];
2573796d2068SKlaus Jensen     nlb = le32_to_cpu(range->nlb) + 1;
2574796d2068SKlaus Jensen     len = nvme_l2b(ns, nlb);
2575796d2068SKlaus Jensen 
2576796d2068SKlaus Jensen     trace_pci_nvme_copy_out(iocb->slba, nlb);
2577796d2068SKlaus Jensen 
2578796d2068SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
257988eea45cSKlaus Jensen         NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
258088eea45cSKlaus Jensen 
2581796d2068SKlaus Jensen         uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
2582796d2068SKlaus Jensen         uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
258388eea45cSKlaus Jensen 
2584796d2068SKlaus Jensen         uint16_t apptag = le16_to_cpu(range->apptag);
2585796d2068SKlaus Jensen         uint16_t appmask = le16_to_cpu(range->appmask);
2586796d2068SKlaus Jensen         uint32_t reftag = le32_to_cpu(range->reftag);
2587796d2068SKlaus Jensen 
2588796d2068SKlaus Jensen         uint64_t slba = le64_to_cpu(range->slba);
2589796d2068SKlaus Jensen         size_t mlen = nvme_m2b(ns, nlb);
2590796d2068SKlaus Jensen         uint8_t *mbounce = iocb->bounce + nvme_l2b(ns, nlb);
2591796d2068SKlaus Jensen 
2592796d2068SKlaus Jensen         status = nvme_dif_check(ns, iocb->bounce, len, mbounce, mlen, prinfor,
2593796d2068SKlaus Jensen                                 slba, apptag, appmask, &reftag);
2594796d2068SKlaus Jensen         if (status) {
2595796d2068SKlaus Jensen             goto invalid;
2596796d2068SKlaus Jensen         }
2597796d2068SKlaus Jensen 
2598796d2068SKlaus Jensen         apptag = le16_to_cpu(copy->apptag);
2599796d2068SKlaus Jensen         appmask = le16_to_cpu(copy->appmask);
2600796d2068SKlaus Jensen 
2601796d2068SKlaus Jensen         if (prinfow & NVME_PRINFO_PRACT) {
2602796d2068SKlaus Jensen             status = nvme_check_prinfo(ns, prinfow, iocb->slba, iocb->reftag);
2603796d2068SKlaus Jensen             if (status) {
2604796d2068SKlaus Jensen                 goto invalid;
2605796d2068SKlaus Jensen             }
2606796d2068SKlaus Jensen 
2607796d2068SKlaus Jensen             nvme_dif_pract_generate_dif(ns, iocb->bounce, len, mbounce, mlen,
2608796d2068SKlaus Jensen                                         apptag, &iocb->reftag);
2609796d2068SKlaus Jensen         } else {
2610796d2068SKlaus Jensen             status = nvme_dif_check(ns, iocb->bounce, len, mbounce, mlen,
2611796d2068SKlaus Jensen                                     prinfow, iocb->slba, apptag, appmask,
2612796d2068SKlaus Jensen                                     &iocb->reftag);
2613796d2068SKlaus Jensen             if (status) {
2614796d2068SKlaus Jensen                 goto invalid;
2615796d2068SKlaus Jensen             }
2616796d2068SKlaus Jensen         }
2617796d2068SKlaus Jensen     }
2618796d2068SKlaus Jensen 
2619796d2068SKlaus Jensen     status = nvme_check_bounds(ns, iocb->slba, nlb);
2620796d2068SKlaus Jensen     if (status) {
2621796d2068SKlaus Jensen         goto invalid;
2622796d2068SKlaus Jensen     }
2623796d2068SKlaus Jensen 
2624796d2068SKlaus Jensen     if (ns->params.zoned) {
2625796d2068SKlaus Jensen         status = nvme_check_zone_write(ns, iocb->zone, iocb->slba, nlb);
2626796d2068SKlaus Jensen         if (status) {
2627796d2068SKlaus Jensen             goto invalid;
2628796d2068SKlaus Jensen         }
2629796d2068SKlaus Jensen 
2630796d2068SKlaus Jensen         iocb->zone->w_ptr += nlb;
2631796d2068SKlaus Jensen     }
2632796d2068SKlaus Jensen 
2633796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2634796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
2635796d2068SKlaus Jensen 
2636796d2068SKlaus Jensen     iocb->aiocb = blk_aio_pwritev(ns->blkconf.blk, nvme_l2b(ns, iocb->slba),
2637796d2068SKlaus Jensen                                   &iocb->iov, 0, nvme_copy_out_cb, iocb);
2638796d2068SKlaus Jensen 
2639796d2068SKlaus Jensen     return;
2640796d2068SKlaus Jensen 
2641796d2068SKlaus Jensen invalid:
2642796d2068SKlaus Jensen     req->status = status;
2643796d2068SKlaus Jensen     iocb->aiocb = NULL;
2644796d2068SKlaus Jensen     if (iocb->bh) {
2645796d2068SKlaus Jensen         qemu_bh_schedule(iocb->bh);
2646796d2068SKlaus Jensen     }
2647796d2068SKlaus Jensen 
2648796d2068SKlaus Jensen     return;
2649796d2068SKlaus Jensen 
2650796d2068SKlaus Jensen out:
2651796d2068SKlaus Jensen     nvme_copy_cb(iocb, ret);
2652796d2068SKlaus Jensen }
2653796d2068SKlaus Jensen 
2654796d2068SKlaus Jensen static void nvme_copy_in_cb(void *opaque, int ret)
2655796d2068SKlaus Jensen {
2656796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2657796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2658796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2659796d2068SKlaus Jensen     NvmeCopySourceRange *range;
2660796d2068SKlaus Jensen     uint64_t slba;
2661796d2068SKlaus Jensen     uint32_t nlb;
2662796d2068SKlaus Jensen 
2663796d2068SKlaus Jensen     if (ret < 0) {
2664796d2068SKlaus Jensen         iocb->ret = ret;
2665796d2068SKlaus Jensen         goto out;
2666796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2667796d2068SKlaus Jensen         goto out;
2668796d2068SKlaus Jensen     }
2669796d2068SKlaus Jensen 
2670796d2068SKlaus Jensen     if (!ns->lbaf.ms) {
2671796d2068SKlaus Jensen         nvme_copy_in_completed_cb(iocb, 0);
2672796d2068SKlaus Jensen         return;
2673796d2068SKlaus Jensen     }
2674796d2068SKlaus Jensen 
2675796d2068SKlaus Jensen     range = &iocb->ranges[iocb->idx];
2676796d2068SKlaus Jensen     slba = le64_to_cpu(range->slba);
2677796d2068SKlaus Jensen     nlb = le32_to_cpu(range->nlb) + 1;
2678796d2068SKlaus Jensen 
2679796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2680796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce + nvme_l2b(ns, nlb),
2681796d2068SKlaus Jensen                    nvme_m2b(ns, nlb));
2682796d2068SKlaus Jensen 
2683796d2068SKlaus Jensen     iocb->aiocb = blk_aio_preadv(ns->blkconf.blk, nvme_moff(ns, slba),
2684796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_completed_cb,
2685796d2068SKlaus Jensen                                  iocb);
2686796d2068SKlaus Jensen     return;
2687796d2068SKlaus Jensen 
2688796d2068SKlaus Jensen out:
2689796d2068SKlaus Jensen     nvme_copy_cb(iocb, iocb->ret);
2690796d2068SKlaus Jensen }
2691796d2068SKlaus Jensen 
2692796d2068SKlaus Jensen static void nvme_copy_cb(void *opaque, int ret)
2693796d2068SKlaus Jensen {
2694796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = opaque;
2695796d2068SKlaus Jensen     NvmeRequest *req = iocb->req;
2696796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2697796d2068SKlaus Jensen     NvmeCopySourceRange *range;
2698796d2068SKlaus Jensen     uint64_t slba;
2699796d2068SKlaus Jensen     uint32_t nlb;
2700796d2068SKlaus Jensen     size_t len;
270188eea45cSKlaus Jensen     uint16_t status;
270288eea45cSKlaus Jensen 
2703796d2068SKlaus Jensen     if (ret < 0) {
2704796d2068SKlaus Jensen         iocb->ret = ret;
2705796d2068SKlaus Jensen         goto done;
2706796d2068SKlaus Jensen     } else if (iocb->ret < 0) {
2707796d2068SKlaus Jensen         goto done;
270888eea45cSKlaus Jensen     }
270988eea45cSKlaus Jensen 
2710796d2068SKlaus Jensen     if (iocb->idx == iocb->nr) {
2711796d2068SKlaus Jensen         goto done;
271288eea45cSKlaus Jensen     }
271388eea45cSKlaus Jensen 
2714796d2068SKlaus Jensen     range = &iocb->ranges[iocb->idx];
2715796d2068SKlaus Jensen     slba = le64_to_cpu(range->slba);
2716796d2068SKlaus Jensen     nlb = le32_to_cpu(range->nlb) + 1;
2717796d2068SKlaus Jensen     len = nvme_l2b(ns, nlb);
271888eea45cSKlaus Jensen 
2719796d2068SKlaus Jensen     trace_pci_nvme_copy_source_range(slba, nlb);
272088eea45cSKlaus Jensen 
2721796d2068SKlaus Jensen     if (nlb > le16_to_cpu(ns->id_ns.mssrl)) {
272288eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
2723796d2068SKlaus Jensen         goto invalid;
272488eea45cSKlaus Jensen     }
272588eea45cSKlaus Jensen 
2726796d2068SKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
272788eea45cSKlaus Jensen     if (status) {
2728796d2068SKlaus Jensen         goto invalid;
272988eea45cSKlaus Jensen     }
273088eea45cSKlaus Jensen 
273188eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
2732796d2068SKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
273388eea45cSKlaus Jensen         if (status) {
2734796d2068SKlaus Jensen             goto invalid;
273588eea45cSKlaus Jensen         }
273688eea45cSKlaus Jensen     }
273788eea45cSKlaus Jensen 
273888eea45cSKlaus Jensen     if (ns->params.zoned) {
2739796d2068SKlaus Jensen         status = nvme_check_zone_read(ns, slba, nlb);
274088eea45cSKlaus Jensen         if (status) {
2741796d2068SKlaus Jensen             goto invalid;
274288eea45cSKlaus Jensen         }
274388eea45cSKlaus Jensen     }
274488eea45cSKlaus Jensen 
2745796d2068SKlaus Jensen     qemu_iovec_reset(&iocb->iov);
2746796d2068SKlaus Jensen     qemu_iovec_add(&iocb->iov, iocb->bounce, len);
2747796d2068SKlaus Jensen 
2748796d2068SKlaus Jensen     iocb->aiocb = blk_aio_preadv(ns->blkconf.blk, nvme_l2b(ns, slba),
2749796d2068SKlaus Jensen                                  &iocb->iov, 0, nvme_copy_in_cb, iocb);
2750796d2068SKlaus Jensen     return;
2751796d2068SKlaus Jensen 
2752796d2068SKlaus Jensen invalid:
2753796d2068SKlaus Jensen     req->status = status;
2754796d2068SKlaus Jensen done:
2755796d2068SKlaus Jensen     iocb->aiocb = NULL;
2756796d2068SKlaus Jensen     if (iocb->bh) {
2757796d2068SKlaus Jensen         qemu_bh_schedule(iocb->bh);
2758796d2068SKlaus Jensen     }
275988eea45cSKlaus Jensen }
276088eea45cSKlaus Jensen 
2761796d2068SKlaus Jensen 
2762796d2068SKlaus Jensen static uint16_t nvme_copy(NvmeCtrl *n, NvmeRequest *req)
2763796d2068SKlaus Jensen {
2764796d2068SKlaus Jensen     NvmeNamespace *ns = req->ns;
2765796d2068SKlaus Jensen     NvmeCopyCmd *copy = (NvmeCopyCmd *)&req->cmd;
2766796d2068SKlaus Jensen     NvmeCopyAIOCB *iocb = blk_aio_get(&nvme_copy_aiocb_info, ns->blkconf.blk,
2767796d2068SKlaus Jensen                                       nvme_misc_cb, req);
2768796d2068SKlaus Jensen     uint16_t nr = copy->nr + 1;
2769796d2068SKlaus Jensen     uint8_t format = copy->control[0] & 0xf;
2770796d2068SKlaus Jensen     uint16_t prinfor = ((copy->control[0] >> 4) & 0xf);
2771796d2068SKlaus Jensen     uint16_t prinfow = ((copy->control[2] >> 2) & 0xf);
2772796d2068SKlaus Jensen 
2773796d2068SKlaus Jensen     uint16_t status;
2774796d2068SKlaus Jensen 
2775796d2068SKlaus Jensen     trace_pci_nvme_copy(nvme_cid(req), nvme_nsid(ns), nr, format);
2776796d2068SKlaus Jensen 
2777796d2068SKlaus Jensen     iocb->ranges = NULL;
2778796d2068SKlaus Jensen     iocb->zone = NULL;
2779796d2068SKlaus Jensen 
2780796d2068SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps) &&
2781796d2068SKlaus Jensen         ((prinfor & NVME_PRINFO_PRACT) != (prinfow & NVME_PRINFO_PRACT))) {
2782796d2068SKlaus Jensen         status = NVME_INVALID_FIELD | NVME_DNR;
2783796d2068SKlaus Jensen         goto invalid;
2784796d2068SKlaus Jensen     }
2785796d2068SKlaus Jensen 
2786796d2068SKlaus Jensen     if (!(n->id_ctrl.ocfs & (1 << format))) {
2787796d2068SKlaus Jensen         trace_pci_nvme_err_copy_invalid_format(format);
2788796d2068SKlaus Jensen         status = NVME_INVALID_FIELD | NVME_DNR;
2789796d2068SKlaus Jensen         goto invalid;
2790796d2068SKlaus Jensen     }
2791796d2068SKlaus Jensen 
2792796d2068SKlaus Jensen     if (nr > ns->id_ns.msrc + 1) {
279388eea45cSKlaus Jensen         status = NVME_CMD_SIZE_LIMIT | NVME_DNR;
2794796d2068SKlaus Jensen         goto invalid;
279588eea45cSKlaus Jensen     }
279688eea45cSKlaus Jensen 
2797796d2068SKlaus Jensen     iocb->ranges = g_new(NvmeCopySourceRange, nr);
2798796d2068SKlaus Jensen 
2799796d2068SKlaus Jensen     status = nvme_h2c(n, (uint8_t *)iocb->ranges,
2800796d2068SKlaus Jensen                       sizeof(NvmeCopySourceRange) * nr, req);
2801796d2068SKlaus Jensen     if (status) {
2802796d2068SKlaus Jensen         goto invalid;
280388eea45cSKlaus Jensen     }
280488eea45cSKlaus Jensen 
2805796d2068SKlaus Jensen     iocb->slba = le64_to_cpu(copy->sdlba);
2806796d2068SKlaus Jensen 
2807796d2068SKlaus Jensen     if (ns->params.zoned) {
2808796d2068SKlaus Jensen         iocb->zone = nvme_get_zone_by_slba(ns, iocb->slba);
2809796d2068SKlaus Jensen         if (!iocb->zone) {
2810796d2068SKlaus Jensen             status = NVME_LBA_RANGE | NVME_DNR;
2811796d2068SKlaus Jensen             goto invalid;
2812796d2068SKlaus Jensen         }
2813796d2068SKlaus Jensen 
2814796d2068SKlaus Jensen         status = nvme_zrm_auto(n, ns, iocb->zone);
2815796d2068SKlaus Jensen         if (status) {
2816796d2068SKlaus Jensen             goto invalid;
2817796d2068SKlaus Jensen         }
2818796d2068SKlaus Jensen     }
2819796d2068SKlaus Jensen 
2820796d2068SKlaus Jensen     iocb->req = req;
2821796d2068SKlaus Jensen     iocb->bh = qemu_bh_new(nvme_copy_bh, iocb);
2822796d2068SKlaus Jensen     iocb->ret = 0;
2823796d2068SKlaus Jensen     iocb->nr = nr;
2824796d2068SKlaus Jensen     iocb->idx = 0;
2825796d2068SKlaus Jensen     iocb->reftag = le32_to_cpu(copy->reftag);
2826796d2068SKlaus Jensen     iocb->bounce = g_malloc_n(le16_to_cpu(ns->id_ns.mssrl),
2827796d2068SKlaus Jensen                               ns->lbasz + ns->lbaf.ms);
2828796d2068SKlaus Jensen 
2829796d2068SKlaus Jensen     qemu_iovec_init(&iocb->iov, 1);
2830796d2068SKlaus Jensen 
2831796d2068SKlaus Jensen     block_acct_start(blk_get_stats(ns->blkconf.blk), &iocb->acct.read, 0,
283288eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
2833796d2068SKlaus Jensen     block_acct_start(blk_get_stats(ns->blkconf.blk), &iocb->acct.write, 0,
2834796d2068SKlaus Jensen                      BLOCK_ACCT_WRITE);
283588eea45cSKlaus Jensen 
2836796d2068SKlaus Jensen     req->aiocb = &iocb->common;
2837796d2068SKlaus Jensen     nvme_copy_cb(iocb, 0);
283888eea45cSKlaus Jensen 
283988eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
284088eea45cSKlaus Jensen 
2841796d2068SKlaus Jensen invalid:
2842796d2068SKlaus Jensen     g_free(iocb->ranges);
2843796d2068SKlaus Jensen     qemu_aio_unref(iocb);
284488eea45cSKlaus Jensen     return status;
284588eea45cSKlaus Jensen }
284688eea45cSKlaus Jensen 
284788eea45cSKlaus Jensen static uint16_t nvme_compare(NvmeCtrl *n, NvmeRequest *req)
284888eea45cSKlaus Jensen {
284988eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
285088eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
285188eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
285288eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
285388eea45cSKlaus Jensen     uint32_t nlb = le16_to_cpu(rw->nlb) + 1;
28542a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
285588eea45cSKlaus Jensen     size_t data_len = nvme_l2b(ns, nlb);
285688eea45cSKlaus Jensen     size_t len = data_len;
285788eea45cSKlaus Jensen     int64_t offset = nvme_l2b(ns, slba);
285888eea45cSKlaus Jensen     struct nvme_compare_ctx *ctx = NULL;
285988eea45cSKlaus Jensen     uint16_t status;
286088eea45cSKlaus Jensen 
286188eea45cSKlaus Jensen     trace_pci_nvme_compare(nvme_cid(req), nvme_nsid(ns), slba, nlb);
286288eea45cSKlaus Jensen 
28632a132309SKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps) && (prinfo & NVME_PRINFO_PRACT)) {
286488eea45cSKlaus Jensen         return NVME_INVALID_PROT_INFO | NVME_DNR;
286588eea45cSKlaus Jensen     }
286688eea45cSKlaus Jensen 
286788eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
286888eea45cSKlaus Jensen         len += nvme_m2b(ns, nlb);
286988eea45cSKlaus Jensen     }
287088eea45cSKlaus Jensen 
287188eea45cSKlaus Jensen     status = nvme_check_mdts(n, len);
287288eea45cSKlaus Jensen     if (status) {
287388eea45cSKlaus Jensen         return status;
287488eea45cSKlaus Jensen     }
287588eea45cSKlaus Jensen 
287688eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
287788eea45cSKlaus Jensen     if (status) {
287888eea45cSKlaus Jensen         return status;
287988eea45cSKlaus Jensen     }
288088eea45cSKlaus Jensen 
288188eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
288288eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
288388eea45cSKlaus Jensen         if (status) {
288488eea45cSKlaus Jensen             return status;
288588eea45cSKlaus Jensen         }
288688eea45cSKlaus Jensen     }
288788eea45cSKlaus Jensen 
288888eea45cSKlaus Jensen     status = nvme_map_dptr(n, &req->sg, len, &req->cmd);
288988eea45cSKlaus Jensen     if (status) {
289088eea45cSKlaus Jensen         return status;
289188eea45cSKlaus Jensen     }
289288eea45cSKlaus Jensen 
289388eea45cSKlaus Jensen     ctx = g_new(struct nvme_compare_ctx, 1);
289488eea45cSKlaus Jensen     ctx->data.bounce = g_malloc(data_len);
289588eea45cSKlaus Jensen 
289688eea45cSKlaus Jensen     req->opaque = ctx;
289788eea45cSKlaus Jensen 
289888eea45cSKlaus Jensen     qemu_iovec_init(&ctx->data.iov, 1);
289988eea45cSKlaus Jensen     qemu_iovec_add(&ctx->data.iov, ctx->data.bounce, data_len);
290088eea45cSKlaus Jensen 
290188eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_len,
290288eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
290388eea45cSKlaus Jensen     req->aiocb = blk_aio_preadv(blk, offset, &ctx->data.iov, 0,
290488eea45cSKlaus Jensen                                 nvme_compare_data_cb, req);
290588eea45cSKlaus Jensen 
290688eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
290788eea45cSKlaus Jensen }
290888eea45cSKlaus Jensen 
290938f4ac65SKlaus Jensen typedef struct NvmeFlushAIOCB {
291038f4ac65SKlaus Jensen     BlockAIOCB common;
291138f4ac65SKlaus Jensen     BlockAIOCB *aiocb;
291238f4ac65SKlaus Jensen     NvmeRequest *req;
291338f4ac65SKlaus Jensen     QEMUBH *bh;
291438f4ac65SKlaus Jensen     int ret;
291538f4ac65SKlaus Jensen 
291638f4ac65SKlaus Jensen     NvmeNamespace *ns;
291738f4ac65SKlaus Jensen     uint32_t nsid;
291838f4ac65SKlaus Jensen     bool broadcast;
291938f4ac65SKlaus Jensen } NvmeFlushAIOCB;
292038f4ac65SKlaus Jensen 
292138f4ac65SKlaus Jensen static void nvme_flush_cancel(BlockAIOCB *acb)
292238f4ac65SKlaus Jensen {
292338f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = container_of(acb, NvmeFlushAIOCB, common);
292438f4ac65SKlaus Jensen 
292538f4ac65SKlaus Jensen     iocb->ret = -ECANCELED;
292638f4ac65SKlaus Jensen 
292738f4ac65SKlaus Jensen     if (iocb->aiocb) {
292838f4ac65SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
292938f4ac65SKlaus Jensen     }
293038f4ac65SKlaus Jensen }
293138f4ac65SKlaus Jensen 
293238f4ac65SKlaus Jensen static const AIOCBInfo nvme_flush_aiocb_info = {
293338f4ac65SKlaus Jensen     .aiocb_size = sizeof(NvmeFlushAIOCB),
293438f4ac65SKlaus Jensen     .cancel_async = nvme_flush_cancel,
293538f4ac65SKlaus Jensen     .get_aio_context = nvme_get_aio_context,
293638f4ac65SKlaus Jensen };
293738f4ac65SKlaus Jensen 
293838f4ac65SKlaus Jensen static void nvme_flush_ns_cb(void *opaque, int ret)
293938f4ac65SKlaus Jensen {
294038f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = opaque;
294138f4ac65SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
294238f4ac65SKlaus Jensen 
294338f4ac65SKlaus Jensen     if (ret < 0) {
294438f4ac65SKlaus Jensen         iocb->ret = ret;
294538f4ac65SKlaus Jensen         goto out;
294638f4ac65SKlaus Jensen     } else if (iocb->ret < 0) {
294738f4ac65SKlaus Jensen         goto out;
294838f4ac65SKlaus Jensen     }
294938f4ac65SKlaus Jensen 
295038f4ac65SKlaus Jensen     if (ns) {
295138f4ac65SKlaus Jensen         trace_pci_nvme_flush_ns(iocb->nsid);
295238f4ac65SKlaus Jensen 
295338f4ac65SKlaus Jensen         iocb->ns = NULL;
295438f4ac65SKlaus Jensen         iocb->aiocb = blk_aio_flush(ns->blkconf.blk, nvme_flush_ns_cb, iocb);
295538f4ac65SKlaus Jensen         return;
295638f4ac65SKlaus Jensen     }
295738f4ac65SKlaus Jensen 
295838f4ac65SKlaus Jensen out:
295938f4ac65SKlaus Jensen     iocb->aiocb = NULL;
296038f4ac65SKlaus Jensen     qemu_bh_schedule(iocb->bh);
296138f4ac65SKlaus Jensen }
296238f4ac65SKlaus Jensen 
296338f4ac65SKlaus Jensen static void nvme_flush_bh(void *opaque)
296438f4ac65SKlaus Jensen {
296538f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb = opaque;
296638f4ac65SKlaus Jensen     NvmeRequest *req = iocb->req;
296738f4ac65SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
296838f4ac65SKlaus Jensen     int i;
296938f4ac65SKlaus Jensen 
297038f4ac65SKlaus Jensen     if (iocb->ret < 0) {
297138f4ac65SKlaus Jensen         goto done;
297238f4ac65SKlaus Jensen     }
297338f4ac65SKlaus Jensen 
297438f4ac65SKlaus Jensen     if (iocb->broadcast) {
297538f4ac65SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
297638f4ac65SKlaus Jensen             iocb->ns = nvme_ns(n, i);
297738f4ac65SKlaus Jensen             if (iocb->ns) {
297838f4ac65SKlaus Jensen                 iocb->nsid = i;
297938f4ac65SKlaus Jensen                 break;
298038f4ac65SKlaus Jensen             }
298138f4ac65SKlaus Jensen         }
298238f4ac65SKlaus Jensen     }
298338f4ac65SKlaus Jensen 
298438f4ac65SKlaus Jensen     if (!iocb->ns) {
298538f4ac65SKlaus Jensen         goto done;
298638f4ac65SKlaus Jensen     }
298738f4ac65SKlaus Jensen 
298838f4ac65SKlaus Jensen     nvme_flush_ns_cb(iocb, 0);
298938f4ac65SKlaus Jensen     return;
299038f4ac65SKlaus Jensen 
299138f4ac65SKlaus Jensen done:
299238f4ac65SKlaus Jensen     qemu_bh_delete(iocb->bh);
299338f4ac65SKlaus Jensen     iocb->bh = NULL;
299438f4ac65SKlaus Jensen 
299538f4ac65SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
299638f4ac65SKlaus Jensen 
299738f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
299838f4ac65SKlaus Jensen 
299938f4ac65SKlaus Jensen     return;
300038f4ac65SKlaus Jensen }
300138f4ac65SKlaus Jensen 
300288eea45cSKlaus Jensen static uint16_t nvme_flush(NvmeCtrl *n, NvmeRequest *req)
300388eea45cSKlaus Jensen {
300438f4ac65SKlaus Jensen     NvmeFlushAIOCB *iocb;
300588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
300688eea45cSKlaus Jensen     uint16_t status;
300788eea45cSKlaus Jensen 
300838f4ac65SKlaus Jensen     iocb = qemu_aio_get(&nvme_flush_aiocb_info, NULL, nvme_misc_cb, req);
300988eea45cSKlaus Jensen 
301038f4ac65SKlaus Jensen     iocb->req = req;
301138f4ac65SKlaus Jensen     iocb->bh = qemu_bh_new(nvme_flush_bh, iocb);
301238f4ac65SKlaus Jensen     iocb->ret = 0;
301338f4ac65SKlaus Jensen     iocb->ns = NULL;
301438f4ac65SKlaus Jensen     iocb->nsid = 0;
301538f4ac65SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
301638f4ac65SKlaus Jensen 
301738f4ac65SKlaus Jensen     if (!iocb->broadcast) {
301838f4ac65SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
301938f4ac65SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
302038f4ac65SKlaus Jensen             goto out;
302188eea45cSKlaus Jensen         }
302288eea45cSKlaus Jensen 
302338f4ac65SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
302438f4ac65SKlaus Jensen         if (!iocb->ns) {
302538f4ac65SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
302638f4ac65SKlaus Jensen             goto out;
302738f4ac65SKlaus Jensen         }
302838f4ac65SKlaus Jensen 
302938f4ac65SKlaus Jensen         iocb->nsid = nsid;
303038f4ac65SKlaus Jensen     }
303138f4ac65SKlaus Jensen 
303238f4ac65SKlaus Jensen     req->aiocb = &iocb->common;
303338f4ac65SKlaus Jensen     qemu_bh_schedule(iocb->bh);
303438f4ac65SKlaus Jensen 
303588eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
303688eea45cSKlaus Jensen 
303738f4ac65SKlaus Jensen out:
303838f4ac65SKlaus Jensen     qemu_bh_delete(iocb->bh);
303938f4ac65SKlaus Jensen     iocb->bh = NULL;
304038f4ac65SKlaus Jensen     qemu_aio_unref(iocb);
304188eea45cSKlaus Jensen 
304288eea45cSKlaus Jensen     return status;
304388eea45cSKlaus Jensen }
304488eea45cSKlaus Jensen 
304588eea45cSKlaus Jensen static uint16_t nvme_read(NvmeCtrl *n, NvmeRequest *req)
304688eea45cSKlaus Jensen {
304788eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
304888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
304988eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
305088eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
30512a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(le16_to_cpu(rw->control));
305288eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
305388eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
305488eea45cSKlaus Jensen     uint64_t data_offset;
305588eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
305688eea45cSKlaus Jensen     uint16_t status;
305788eea45cSKlaus Jensen 
305888eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
305988eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
306088eea45cSKlaus Jensen 
306188eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
30622a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
306388eea45cSKlaus Jensen 
306488eea45cSKlaus Jensen             if (pract && ns->lbaf.ms == 8) {
306588eea45cSKlaus Jensen                 mapped_size = data_size;
306688eea45cSKlaus Jensen             }
306788eea45cSKlaus Jensen         }
306888eea45cSKlaus Jensen     }
306988eea45cSKlaus Jensen 
307088eea45cSKlaus Jensen     trace_pci_nvme_read(nvme_cid(req), nvme_nsid(ns), nlb, mapped_size, slba);
307188eea45cSKlaus Jensen 
307288eea45cSKlaus Jensen     status = nvme_check_mdts(n, mapped_size);
307388eea45cSKlaus Jensen     if (status) {
307488eea45cSKlaus Jensen         goto invalid;
307588eea45cSKlaus Jensen     }
307688eea45cSKlaus Jensen 
307788eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
307888eea45cSKlaus Jensen     if (status) {
307988eea45cSKlaus Jensen         goto invalid;
308088eea45cSKlaus Jensen     }
308188eea45cSKlaus Jensen 
308288eea45cSKlaus Jensen     if (ns->params.zoned) {
308388eea45cSKlaus Jensen         status = nvme_check_zone_read(ns, slba, nlb);
308488eea45cSKlaus Jensen         if (status) {
308588eea45cSKlaus Jensen             trace_pci_nvme_err_zone_read_not_ok(slba, nlb, status);
308688eea45cSKlaus Jensen             goto invalid;
308788eea45cSKlaus Jensen         }
308888eea45cSKlaus Jensen     }
308988eea45cSKlaus Jensen 
309088eea45cSKlaus Jensen     if (NVME_ERR_REC_DULBE(ns->features.err_rec)) {
309188eea45cSKlaus Jensen         status = nvme_check_dulbe(ns, slba, nlb);
309288eea45cSKlaus Jensen         if (status) {
309388eea45cSKlaus Jensen             goto invalid;
309488eea45cSKlaus Jensen         }
309588eea45cSKlaus Jensen     }
309688eea45cSKlaus Jensen 
309788eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
309888eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
309988eea45cSKlaus Jensen     }
310088eea45cSKlaus Jensen 
310188eea45cSKlaus Jensen     status = nvme_map_data(n, nlb, req);
310288eea45cSKlaus Jensen     if (status) {
310388eea45cSKlaus Jensen         goto invalid;
310488eea45cSKlaus Jensen     }
310588eea45cSKlaus Jensen 
310688eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
310788eea45cSKlaus Jensen 
310888eea45cSKlaus Jensen     block_acct_start(blk_get_stats(blk), &req->acct, data_size,
310988eea45cSKlaus Jensen                      BLOCK_ACCT_READ);
311088eea45cSKlaus Jensen     nvme_blk_read(blk, data_offset, nvme_rw_cb, req);
311188eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
311288eea45cSKlaus Jensen 
311388eea45cSKlaus Jensen invalid:
311488eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_READ);
311588eea45cSKlaus Jensen     return status | NVME_DNR;
311688eea45cSKlaus Jensen }
311788eea45cSKlaus Jensen 
311888eea45cSKlaus Jensen static uint16_t nvme_do_write(NvmeCtrl *n, NvmeRequest *req, bool append,
311988eea45cSKlaus Jensen                               bool wrz)
312088eea45cSKlaus Jensen {
312188eea45cSKlaus Jensen     NvmeRwCmd *rw = (NvmeRwCmd *)&req->cmd;
312288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
312388eea45cSKlaus Jensen     uint64_t slba = le64_to_cpu(rw->slba);
312488eea45cSKlaus Jensen     uint32_t nlb = (uint32_t)le16_to_cpu(rw->nlb) + 1;
312588eea45cSKlaus Jensen     uint16_t ctrl = le16_to_cpu(rw->control);
31262a132309SKlaus Jensen     uint8_t prinfo = NVME_RW_PRINFO(ctrl);
312788eea45cSKlaus Jensen     uint64_t data_size = nvme_l2b(ns, nlb);
312888eea45cSKlaus Jensen     uint64_t mapped_size = data_size;
312988eea45cSKlaus Jensen     uint64_t data_offset;
313088eea45cSKlaus Jensen     NvmeZone *zone;
313188eea45cSKlaus Jensen     NvmeZonedResult *res = (NvmeZonedResult *)&req->cqe;
313288eea45cSKlaus Jensen     BlockBackend *blk = ns->blkconf.blk;
313388eea45cSKlaus Jensen     uint16_t status;
313488eea45cSKlaus Jensen 
313588eea45cSKlaus Jensen     if (nvme_ns_ext(ns)) {
313688eea45cSKlaus Jensen         mapped_size += nvme_m2b(ns, nlb);
313788eea45cSKlaus Jensen 
313888eea45cSKlaus Jensen         if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
31392a132309SKlaus Jensen             bool pract = prinfo & NVME_PRINFO_PRACT;
314088eea45cSKlaus Jensen 
314188eea45cSKlaus Jensen             if (pract && ns->lbaf.ms == 8) {
314288eea45cSKlaus Jensen                 mapped_size -= nvme_m2b(ns, nlb);
314388eea45cSKlaus Jensen             }
314488eea45cSKlaus Jensen         }
314588eea45cSKlaus Jensen     }
314688eea45cSKlaus Jensen 
314788eea45cSKlaus Jensen     trace_pci_nvme_write(nvme_cid(req), nvme_io_opc_str(rw->opcode),
314888eea45cSKlaus Jensen                          nvme_nsid(ns), nlb, mapped_size, slba);
314988eea45cSKlaus Jensen 
315088eea45cSKlaus Jensen     if (!wrz) {
315188eea45cSKlaus Jensen         status = nvme_check_mdts(n, mapped_size);
315288eea45cSKlaus Jensen         if (status) {
315388eea45cSKlaus Jensen             goto invalid;
315488eea45cSKlaus Jensen         }
315588eea45cSKlaus Jensen     }
315688eea45cSKlaus Jensen 
315788eea45cSKlaus Jensen     status = nvme_check_bounds(ns, slba, nlb);
315888eea45cSKlaus Jensen     if (status) {
315988eea45cSKlaus Jensen         goto invalid;
316088eea45cSKlaus Jensen     }
316188eea45cSKlaus Jensen 
316288eea45cSKlaus Jensen     if (ns->params.zoned) {
316388eea45cSKlaus Jensen         zone = nvme_get_zone_by_slba(ns, slba);
3164189a8bf7SKlaus Jensen         assert(zone);
316588eea45cSKlaus Jensen 
316688eea45cSKlaus Jensen         if (append) {
316788eea45cSKlaus Jensen             bool piremap = !!(ctrl & NVME_RW_PIREMAP);
316888eea45cSKlaus Jensen 
316988eea45cSKlaus Jensen             if (unlikely(slba != zone->d.zslba)) {
317088eea45cSKlaus Jensen                 trace_pci_nvme_err_append_not_at_start(slba, zone->d.zslba);
317188eea45cSKlaus Jensen                 status = NVME_INVALID_FIELD;
317288eea45cSKlaus Jensen                 goto invalid;
317388eea45cSKlaus Jensen             }
317488eea45cSKlaus Jensen 
317588eea45cSKlaus Jensen             if (n->params.zasl &&
317688eea45cSKlaus Jensen                 data_size > (uint64_t)n->page_size << n->params.zasl) {
317788eea45cSKlaus Jensen                 trace_pci_nvme_err_zasl(data_size);
317888eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
317988eea45cSKlaus Jensen             }
318088eea45cSKlaus Jensen 
318188eea45cSKlaus Jensen             slba = zone->w_ptr;
318288eea45cSKlaus Jensen             rw->slba = cpu_to_le64(slba);
318388eea45cSKlaus Jensen             res->slba = cpu_to_le64(slba);
318488eea45cSKlaus Jensen 
318588eea45cSKlaus Jensen             switch (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
318688eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_1:
318788eea45cSKlaus Jensen                 if (!piremap) {
318888eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
318988eea45cSKlaus Jensen                 }
319088eea45cSKlaus Jensen 
319188eea45cSKlaus Jensen                 /* fallthrough */
319288eea45cSKlaus Jensen 
319388eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_2:
319488eea45cSKlaus Jensen                 if (piremap) {
319588eea45cSKlaus Jensen                     uint32_t reftag = le32_to_cpu(rw->reftag);
319688eea45cSKlaus Jensen                     rw->reftag = cpu_to_le32(reftag + (slba - zone->d.zslba));
319788eea45cSKlaus Jensen                 }
319888eea45cSKlaus Jensen 
319988eea45cSKlaus Jensen                 break;
320088eea45cSKlaus Jensen 
320188eea45cSKlaus Jensen             case NVME_ID_NS_DPS_TYPE_3:
320288eea45cSKlaus Jensen                 if (piremap) {
320388eea45cSKlaus Jensen                     return NVME_INVALID_PROT_INFO | NVME_DNR;
320488eea45cSKlaus Jensen                 }
320588eea45cSKlaus Jensen 
320688eea45cSKlaus Jensen                 break;
320788eea45cSKlaus Jensen             }
320888eea45cSKlaus Jensen         }
320988eea45cSKlaus Jensen 
321088eea45cSKlaus Jensen         status = nvme_check_zone_write(ns, zone, slba, nlb);
321188eea45cSKlaus Jensen         if (status) {
321288eea45cSKlaus Jensen             goto invalid;
321388eea45cSKlaus Jensen         }
321488eea45cSKlaus Jensen 
3215cccc2651SNiklas Cassel         status = nvme_zrm_auto(n, ns, zone);
321688eea45cSKlaus Jensen         if (status) {
321788eea45cSKlaus Jensen             goto invalid;
321888eea45cSKlaus Jensen         }
321988eea45cSKlaus Jensen 
322088eea45cSKlaus Jensen         zone->w_ptr += nlb;
322188eea45cSKlaus Jensen     }
322288eea45cSKlaus Jensen 
322388eea45cSKlaus Jensen     data_offset = nvme_l2b(ns, slba);
322488eea45cSKlaus Jensen 
322588eea45cSKlaus Jensen     if (NVME_ID_NS_DPS_TYPE(ns->id_ns.dps)) {
322688eea45cSKlaus Jensen         return nvme_dif_rw(n, req);
322788eea45cSKlaus Jensen     }
322888eea45cSKlaus Jensen 
322988eea45cSKlaus Jensen     if (!wrz) {
323088eea45cSKlaus Jensen         status = nvme_map_data(n, nlb, req);
323188eea45cSKlaus Jensen         if (status) {
323288eea45cSKlaus Jensen             goto invalid;
323388eea45cSKlaus Jensen         }
323488eea45cSKlaus Jensen 
323588eea45cSKlaus Jensen         block_acct_start(blk_get_stats(blk), &req->acct, data_size,
323688eea45cSKlaus Jensen                          BLOCK_ACCT_WRITE);
323788eea45cSKlaus Jensen         nvme_blk_write(blk, data_offset, nvme_rw_cb, req);
323888eea45cSKlaus Jensen     } else {
323988eea45cSKlaus Jensen         req->aiocb = blk_aio_pwrite_zeroes(blk, data_offset, data_size,
324088eea45cSKlaus Jensen                                            BDRV_REQ_MAY_UNMAP, nvme_rw_cb,
324188eea45cSKlaus Jensen                                            req);
324288eea45cSKlaus Jensen     }
324388eea45cSKlaus Jensen 
324488eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
324588eea45cSKlaus Jensen 
324688eea45cSKlaus Jensen invalid:
324788eea45cSKlaus Jensen     block_acct_invalid(blk_get_stats(blk), BLOCK_ACCT_WRITE);
324888eea45cSKlaus Jensen     return status | NVME_DNR;
324988eea45cSKlaus Jensen }
325088eea45cSKlaus Jensen 
325188eea45cSKlaus Jensen static inline uint16_t nvme_write(NvmeCtrl *n, NvmeRequest *req)
325288eea45cSKlaus Jensen {
325388eea45cSKlaus Jensen     return nvme_do_write(n, req, false, false);
325488eea45cSKlaus Jensen }
325588eea45cSKlaus Jensen 
325688eea45cSKlaus Jensen static inline uint16_t nvme_write_zeroes(NvmeCtrl *n, NvmeRequest *req)
325788eea45cSKlaus Jensen {
325888eea45cSKlaus Jensen     return nvme_do_write(n, req, false, true);
325988eea45cSKlaus Jensen }
326088eea45cSKlaus Jensen 
326188eea45cSKlaus Jensen static inline uint16_t nvme_zone_append(NvmeCtrl *n, NvmeRequest *req)
326288eea45cSKlaus Jensen {
326388eea45cSKlaus Jensen     return nvme_do_write(n, req, true, false);
326488eea45cSKlaus Jensen }
326588eea45cSKlaus Jensen 
326688eea45cSKlaus Jensen static uint16_t nvme_get_mgmt_zone_slba_idx(NvmeNamespace *ns, NvmeCmd *c,
326788eea45cSKlaus Jensen                                             uint64_t *slba, uint32_t *zone_idx)
326888eea45cSKlaus Jensen {
326988eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(c->cdw10);
327088eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(c->cdw11);
327188eea45cSKlaus Jensen 
327288eea45cSKlaus Jensen     if (!ns->params.zoned) {
327388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(c->opcode);
327488eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
327588eea45cSKlaus Jensen     }
327688eea45cSKlaus Jensen 
327788eea45cSKlaus Jensen     *slba = ((uint64_t)dw11) << 32 | dw10;
327888eea45cSKlaus Jensen     if (unlikely(*slba >= ns->id_ns.nsze)) {
327988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_lba_range(*slba, 0, ns->id_ns.nsze);
328088eea45cSKlaus Jensen         *slba = 0;
328188eea45cSKlaus Jensen         return NVME_LBA_RANGE | NVME_DNR;
328288eea45cSKlaus Jensen     }
328388eea45cSKlaus Jensen 
328488eea45cSKlaus Jensen     *zone_idx = nvme_zone_idx(ns, *slba);
328588eea45cSKlaus Jensen     assert(*zone_idx < ns->num_zones);
328688eea45cSKlaus Jensen 
328788eea45cSKlaus Jensen     return NVME_SUCCESS;
328888eea45cSKlaus Jensen }
328988eea45cSKlaus Jensen 
329088eea45cSKlaus Jensen typedef uint16_t (*op_handler_t)(NvmeNamespace *, NvmeZone *, NvmeZoneState,
329188eea45cSKlaus Jensen                                  NvmeRequest *);
329288eea45cSKlaus Jensen 
329388eea45cSKlaus Jensen enum NvmeZoneProcessingMask {
329488eea45cSKlaus Jensen     NVME_PROC_CURRENT_ZONE    = 0,
329588eea45cSKlaus Jensen     NVME_PROC_OPENED_ZONES    = 1 << 0,
329688eea45cSKlaus Jensen     NVME_PROC_CLOSED_ZONES    = 1 << 1,
329788eea45cSKlaus Jensen     NVME_PROC_READ_ONLY_ZONES = 1 << 2,
329888eea45cSKlaus Jensen     NVME_PROC_FULL_ZONES      = 1 << 3,
329988eea45cSKlaus Jensen };
330088eea45cSKlaus Jensen 
330188eea45cSKlaus Jensen static uint16_t nvme_open_zone(NvmeNamespace *ns, NvmeZone *zone,
330288eea45cSKlaus Jensen                                NvmeZoneState state, NvmeRequest *req)
330388eea45cSKlaus Jensen {
3304cccc2651SNiklas Cassel     return nvme_zrm_open(nvme_ctrl(req), ns, zone);
330588eea45cSKlaus Jensen }
330688eea45cSKlaus Jensen 
330788eea45cSKlaus Jensen static uint16_t nvme_close_zone(NvmeNamespace *ns, NvmeZone *zone,
330888eea45cSKlaus Jensen                                 NvmeZoneState state, NvmeRequest *req)
330988eea45cSKlaus Jensen {
331088eea45cSKlaus Jensen     return nvme_zrm_close(ns, zone);
331188eea45cSKlaus Jensen }
331288eea45cSKlaus Jensen 
331388eea45cSKlaus Jensen static uint16_t nvme_finish_zone(NvmeNamespace *ns, NvmeZone *zone,
331488eea45cSKlaus Jensen                                  NvmeZoneState state, NvmeRequest *req)
331588eea45cSKlaus Jensen {
331688eea45cSKlaus Jensen     return nvme_zrm_finish(ns, zone);
331788eea45cSKlaus Jensen }
331888eea45cSKlaus Jensen 
331988eea45cSKlaus Jensen static uint16_t nvme_offline_zone(NvmeNamespace *ns, NvmeZone *zone,
332088eea45cSKlaus Jensen                                   NvmeZoneState state, NvmeRequest *req)
332188eea45cSKlaus Jensen {
332288eea45cSKlaus Jensen     switch (state) {
332388eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
332488eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_OFFLINE);
332588eea45cSKlaus Jensen         /* fall through */
332688eea45cSKlaus Jensen     case NVME_ZONE_STATE_OFFLINE:
332788eea45cSKlaus Jensen         return NVME_SUCCESS;
332888eea45cSKlaus Jensen     default:
332988eea45cSKlaus Jensen         return NVME_ZONE_INVAL_TRANSITION;
333088eea45cSKlaus Jensen     }
333188eea45cSKlaus Jensen }
333288eea45cSKlaus Jensen 
333388eea45cSKlaus Jensen static uint16_t nvme_set_zd_ext(NvmeNamespace *ns, NvmeZone *zone)
333488eea45cSKlaus Jensen {
333588eea45cSKlaus Jensen     uint16_t status;
333688eea45cSKlaus Jensen     uint8_t state = nvme_get_zone_state(zone);
333788eea45cSKlaus Jensen 
333888eea45cSKlaus Jensen     if (state == NVME_ZONE_STATE_EMPTY) {
333988eea45cSKlaus Jensen         status = nvme_aor_check(ns, 1, 0);
334088eea45cSKlaus Jensen         if (status) {
334188eea45cSKlaus Jensen             return status;
334288eea45cSKlaus Jensen         }
334388eea45cSKlaus Jensen         nvme_aor_inc_active(ns);
334488eea45cSKlaus Jensen         zone->d.za |= NVME_ZA_ZD_EXT_VALID;
334588eea45cSKlaus Jensen         nvme_assign_zone_state(ns, zone, NVME_ZONE_STATE_CLOSED);
334688eea45cSKlaus Jensen         return NVME_SUCCESS;
334788eea45cSKlaus Jensen     }
334888eea45cSKlaus Jensen 
334988eea45cSKlaus Jensen     return NVME_ZONE_INVAL_TRANSITION;
335088eea45cSKlaus Jensen }
335188eea45cSKlaus Jensen 
335288eea45cSKlaus Jensen static uint16_t nvme_bulk_proc_zone(NvmeNamespace *ns, NvmeZone *zone,
335388eea45cSKlaus Jensen                                     enum NvmeZoneProcessingMask proc_mask,
335488eea45cSKlaus Jensen                                     op_handler_t op_hndlr, NvmeRequest *req)
335588eea45cSKlaus Jensen {
335688eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
335788eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zone);
335888eea45cSKlaus Jensen     bool proc_zone;
335988eea45cSKlaus Jensen 
336088eea45cSKlaus Jensen     switch (zs) {
336188eea45cSKlaus Jensen     case NVME_ZONE_STATE_IMPLICITLY_OPEN:
336288eea45cSKlaus Jensen     case NVME_ZONE_STATE_EXPLICITLY_OPEN:
336388eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_OPENED_ZONES;
336488eea45cSKlaus Jensen         break;
336588eea45cSKlaus Jensen     case NVME_ZONE_STATE_CLOSED:
336688eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_CLOSED_ZONES;
336788eea45cSKlaus Jensen         break;
336888eea45cSKlaus Jensen     case NVME_ZONE_STATE_READ_ONLY:
336988eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_READ_ONLY_ZONES;
337088eea45cSKlaus Jensen         break;
337188eea45cSKlaus Jensen     case NVME_ZONE_STATE_FULL:
337288eea45cSKlaus Jensen         proc_zone = proc_mask & NVME_PROC_FULL_ZONES;
337388eea45cSKlaus Jensen         break;
337488eea45cSKlaus Jensen     default:
337588eea45cSKlaus Jensen         proc_zone = false;
337688eea45cSKlaus Jensen     }
337788eea45cSKlaus Jensen 
337888eea45cSKlaus Jensen     if (proc_zone) {
337988eea45cSKlaus Jensen         status = op_hndlr(ns, zone, zs, req);
338088eea45cSKlaus Jensen     }
338188eea45cSKlaus Jensen 
338288eea45cSKlaus Jensen     return status;
338388eea45cSKlaus Jensen }
338488eea45cSKlaus Jensen 
338588eea45cSKlaus Jensen static uint16_t nvme_do_zone_op(NvmeNamespace *ns, NvmeZone *zone,
338688eea45cSKlaus Jensen                                 enum NvmeZoneProcessingMask proc_mask,
338788eea45cSKlaus Jensen                                 op_handler_t op_hndlr, NvmeRequest *req)
338888eea45cSKlaus Jensen {
338988eea45cSKlaus Jensen     NvmeZone *next;
339088eea45cSKlaus Jensen     uint16_t status = NVME_SUCCESS;
339188eea45cSKlaus Jensen     int i;
339288eea45cSKlaus Jensen 
339388eea45cSKlaus Jensen     if (!proc_mask) {
339488eea45cSKlaus Jensen         status = op_hndlr(ns, zone, nvme_get_zone_state(zone), req);
339588eea45cSKlaus Jensen     } else {
339688eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_CLOSED_ZONES) {
339788eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->closed_zones, entry, next) {
339888eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
339988eea45cSKlaus Jensen                                              req);
340088eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
340188eea45cSKlaus Jensen                     goto out;
340288eea45cSKlaus Jensen                 }
340388eea45cSKlaus Jensen             }
340488eea45cSKlaus Jensen         }
340588eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_OPENED_ZONES) {
340688eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->imp_open_zones, entry, next) {
340788eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
340888eea45cSKlaus Jensen                                              req);
340988eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
341088eea45cSKlaus Jensen                     goto out;
341188eea45cSKlaus Jensen                 }
341288eea45cSKlaus Jensen             }
341388eea45cSKlaus Jensen 
341488eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->exp_open_zones, entry, next) {
341588eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
341688eea45cSKlaus Jensen                                              req);
341788eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
341888eea45cSKlaus Jensen                     goto out;
341988eea45cSKlaus Jensen                 }
342088eea45cSKlaus Jensen             }
342188eea45cSKlaus Jensen         }
342288eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_FULL_ZONES) {
342388eea45cSKlaus Jensen             QTAILQ_FOREACH_SAFE(zone, &ns->full_zones, entry, next) {
342488eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
342588eea45cSKlaus Jensen                                              req);
342688eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
342788eea45cSKlaus Jensen                     goto out;
342888eea45cSKlaus Jensen                 }
342988eea45cSKlaus Jensen             }
343088eea45cSKlaus Jensen         }
343188eea45cSKlaus Jensen 
343288eea45cSKlaus Jensen         if (proc_mask & NVME_PROC_READ_ONLY_ZONES) {
343388eea45cSKlaus Jensen             for (i = 0; i < ns->num_zones; i++, zone++) {
343488eea45cSKlaus Jensen                 status = nvme_bulk_proc_zone(ns, zone, proc_mask, op_hndlr,
343588eea45cSKlaus Jensen                                              req);
343688eea45cSKlaus Jensen                 if (status && status != NVME_NO_COMPLETE) {
343788eea45cSKlaus Jensen                     goto out;
343888eea45cSKlaus Jensen                 }
343988eea45cSKlaus Jensen             }
344088eea45cSKlaus Jensen         }
344188eea45cSKlaus Jensen     }
344288eea45cSKlaus Jensen 
344388eea45cSKlaus Jensen out:
344488eea45cSKlaus Jensen     return status;
344588eea45cSKlaus Jensen }
344688eea45cSKlaus Jensen 
344763d96e4fSKlaus Jensen typedef struct NvmeZoneResetAIOCB {
344863d96e4fSKlaus Jensen     BlockAIOCB common;
344963d96e4fSKlaus Jensen     BlockAIOCB *aiocb;
345063d96e4fSKlaus Jensen     NvmeRequest *req;
345163d96e4fSKlaus Jensen     QEMUBH *bh;
345263d96e4fSKlaus Jensen     int ret;
345363d96e4fSKlaus Jensen 
345463d96e4fSKlaus Jensen     bool all;
345563d96e4fSKlaus Jensen     int idx;
345663d96e4fSKlaus Jensen     NvmeZone *zone;
345763d96e4fSKlaus Jensen } NvmeZoneResetAIOCB;
345863d96e4fSKlaus Jensen 
345963d96e4fSKlaus Jensen static void nvme_zone_reset_cancel(BlockAIOCB *aiocb)
346063d96e4fSKlaus Jensen {
346163d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = container_of(aiocb, NvmeZoneResetAIOCB, common);
346263d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
346363d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
346463d96e4fSKlaus Jensen 
346563d96e4fSKlaus Jensen     iocb->idx = ns->num_zones;
346663d96e4fSKlaus Jensen 
346763d96e4fSKlaus Jensen     iocb->ret = -ECANCELED;
346863d96e4fSKlaus Jensen 
346963d96e4fSKlaus Jensen     if (iocb->aiocb) {
347063d96e4fSKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
347163d96e4fSKlaus Jensen         iocb->aiocb = NULL;
347263d96e4fSKlaus Jensen     }
347363d96e4fSKlaus Jensen }
347463d96e4fSKlaus Jensen 
347563d96e4fSKlaus Jensen static const AIOCBInfo nvme_zone_reset_aiocb_info = {
347663d96e4fSKlaus Jensen     .aiocb_size = sizeof(NvmeZoneResetAIOCB),
347763d96e4fSKlaus Jensen     .cancel_async = nvme_zone_reset_cancel,
347863d96e4fSKlaus Jensen };
347963d96e4fSKlaus Jensen 
348063d96e4fSKlaus Jensen static void nvme_zone_reset_bh(void *opaque)
348163d96e4fSKlaus Jensen {
348263d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
348363d96e4fSKlaus Jensen 
348463d96e4fSKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
348563d96e4fSKlaus Jensen 
348663d96e4fSKlaus Jensen     qemu_bh_delete(iocb->bh);
348763d96e4fSKlaus Jensen     iocb->bh = NULL;
348863d96e4fSKlaus Jensen     qemu_aio_unref(iocb);
348963d96e4fSKlaus Jensen }
349063d96e4fSKlaus Jensen 
349163d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret);
349263d96e4fSKlaus Jensen 
349363d96e4fSKlaus Jensen static void nvme_zone_reset_epilogue_cb(void *opaque, int ret)
349463d96e4fSKlaus Jensen {
349563d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
349663d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
349763d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
349863d96e4fSKlaus Jensen     int64_t moff;
349963d96e4fSKlaus Jensen     int count;
350063d96e4fSKlaus Jensen 
350163d96e4fSKlaus Jensen     if (ret < 0) {
350263d96e4fSKlaus Jensen         nvme_zone_reset_cb(iocb, ret);
350363d96e4fSKlaus Jensen         return;
350463d96e4fSKlaus Jensen     }
350563d96e4fSKlaus Jensen 
350663d96e4fSKlaus Jensen     if (!ns->lbaf.ms) {
350763d96e4fSKlaus Jensen         nvme_zone_reset_cb(iocb, 0);
350863d96e4fSKlaus Jensen         return;
350963d96e4fSKlaus Jensen     }
351063d96e4fSKlaus Jensen 
351163d96e4fSKlaus Jensen     moff = nvme_moff(ns, iocb->zone->d.zslba);
351263d96e4fSKlaus Jensen     count = nvme_m2b(ns, ns->zone_size);
351363d96e4fSKlaus Jensen 
351463d96e4fSKlaus Jensen     iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, moff, count,
351563d96e4fSKlaus Jensen                                         BDRV_REQ_MAY_UNMAP,
351663d96e4fSKlaus Jensen                                         nvme_zone_reset_cb, iocb);
351763d96e4fSKlaus Jensen     return;
351863d96e4fSKlaus Jensen }
351963d96e4fSKlaus Jensen 
352063d96e4fSKlaus Jensen static void nvme_zone_reset_cb(void *opaque, int ret)
352163d96e4fSKlaus Jensen {
352263d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb = opaque;
352363d96e4fSKlaus Jensen     NvmeRequest *req = iocb->req;
352463d96e4fSKlaus Jensen     NvmeNamespace *ns = req->ns;
352563d96e4fSKlaus Jensen 
352663d96e4fSKlaus Jensen     if (ret < 0) {
352763d96e4fSKlaus Jensen         iocb->ret = ret;
352863d96e4fSKlaus Jensen         goto done;
352963d96e4fSKlaus Jensen     }
353063d96e4fSKlaus Jensen 
353163d96e4fSKlaus Jensen     if (iocb->zone) {
353263d96e4fSKlaus Jensen         nvme_zrm_reset(ns, iocb->zone);
353363d96e4fSKlaus Jensen 
353463d96e4fSKlaus Jensen         if (!iocb->all) {
353563d96e4fSKlaus Jensen             goto done;
353663d96e4fSKlaus Jensen         }
353763d96e4fSKlaus Jensen     }
353863d96e4fSKlaus Jensen 
353963d96e4fSKlaus Jensen     while (iocb->idx < ns->num_zones) {
354063d96e4fSKlaus Jensen         NvmeZone *zone = &ns->zone_array[iocb->idx++];
354163d96e4fSKlaus Jensen 
354263d96e4fSKlaus Jensen         switch (nvme_get_zone_state(zone)) {
354363d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EMPTY:
354463d96e4fSKlaus Jensen             if (!iocb->all) {
354563d96e4fSKlaus Jensen                 goto done;
354663d96e4fSKlaus Jensen             }
354763d96e4fSKlaus Jensen 
354863d96e4fSKlaus Jensen             continue;
354963d96e4fSKlaus Jensen 
355063d96e4fSKlaus Jensen         case NVME_ZONE_STATE_EXPLICITLY_OPEN:
355163d96e4fSKlaus Jensen         case NVME_ZONE_STATE_IMPLICITLY_OPEN:
355263d96e4fSKlaus Jensen         case NVME_ZONE_STATE_CLOSED:
355363d96e4fSKlaus Jensen         case NVME_ZONE_STATE_FULL:
355463d96e4fSKlaus Jensen             iocb->zone = zone;
355563d96e4fSKlaus Jensen             break;
355663d96e4fSKlaus Jensen 
355763d96e4fSKlaus Jensen         default:
355863d96e4fSKlaus Jensen             continue;
355963d96e4fSKlaus Jensen         }
356063d96e4fSKlaus Jensen 
356163d96e4fSKlaus Jensen         trace_pci_nvme_zns_zone_reset(zone->d.zslba);
356263d96e4fSKlaus Jensen 
356363d96e4fSKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk,
356463d96e4fSKlaus Jensen                                             nvme_l2b(ns, zone->d.zslba),
356563d96e4fSKlaus Jensen                                             nvme_l2b(ns, ns->zone_size),
356663d96e4fSKlaus Jensen                                             BDRV_REQ_MAY_UNMAP,
356763d96e4fSKlaus Jensen                                             nvme_zone_reset_epilogue_cb,
356863d96e4fSKlaus Jensen                                             iocb);
356963d96e4fSKlaus Jensen         return;
357063d96e4fSKlaus Jensen     }
357163d96e4fSKlaus Jensen 
357263d96e4fSKlaus Jensen done:
357363d96e4fSKlaus Jensen     iocb->aiocb = NULL;
357463d96e4fSKlaus Jensen     if (iocb->bh) {
357563d96e4fSKlaus Jensen         qemu_bh_schedule(iocb->bh);
357663d96e4fSKlaus Jensen     }
357763d96e4fSKlaus Jensen }
357863d96e4fSKlaus Jensen 
357988eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_send(NvmeCtrl *n, NvmeRequest *req)
358088eea45cSKlaus Jensen {
358188eea45cSKlaus Jensen     NvmeCmd *cmd = (NvmeCmd *)&req->cmd;
358288eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
358388eea45cSKlaus Jensen     NvmeZone *zone;
358463d96e4fSKlaus Jensen     NvmeZoneResetAIOCB *iocb;
358588eea45cSKlaus Jensen     uint8_t *zd_ext;
358688eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
358788eea45cSKlaus Jensen     uint64_t slba = 0;
358888eea45cSKlaus Jensen     uint32_t zone_idx = 0;
358988eea45cSKlaus Jensen     uint16_t status;
359088eea45cSKlaus Jensen     uint8_t action;
359188eea45cSKlaus Jensen     bool all;
359288eea45cSKlaus Jensen     enum NvmeZoneProcessingMask proc_mask = NVME_PROC_CURRENT_ZONE;
359388eea45cSKlaus Jensen 
359488eea45cSKlaus Jensen     action = dw13 & 0xff;
359563d96e4fSKlaus Jensen     all = !!(dw13 & 0x100);
359688eea45cSKlaus Jensen 
359788eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
359888eea45cSKlaus Jensen 
359988eea45cSKlaus Jensen     if (!all) {
360088eea45cSKlaus Jensen         status = nvme_get_mgmt_zone_slba_idx(ns, cmd, &slba, &zone_idx);
360188eea45cSKlaus Jensen         if (status) {
360288eea45cSKlaus Jensen             return status;
360388eea45cSKlaus Jensen         }
360488eea45cSKlaus Jensen     }
360588eea45cSKlaus Jensen 
360688eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
360788eea45cSKlaus Jensen     if (slba != zone->d.zslba) {
360888eea45cSKlaus Jensen         trace_pci_nvme_err_unaligned_zone_cmd(action, slba, zone->d.zslba);
360988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
361088eea45cSKlaus Jensen     }
361188eea45cSKlaus Jensen 
361288eea45cSKlaus Jensen     switch (action) {
361388eea45cSKlaus Jensen 
361488eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OPEN:
361588eea45cSKlaus Jensen         if (all) {
361688eea45cSKlaus Jensen             proc_mask = NVME_PROC_CLOSED_ZONES;
361788eea45cSKlaus Jensen         }
361888eea45cSKlaus Jensen         trace_pci_nvme_open_zone(slba, zone_idx, all);
361988eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_open_zone, req);
362088eea45cSKlaus Jensen         break;
362188eea45cSKlaus Jensen 
362288eea45cSKlaus Jensen     case NVME_ZONE_ACTION_CLOSE:
362388eea45cSKlaus Jensen         if (all) {
362488eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES;
362588eea45cSKlaus Jensen         }
362688eea45cSKlaus Jensen         trace_pci_nvme_close_zone(slba, zone_idx, all);
362788eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_close_zone, req);
362888eea45cSKlaus Jensen         break;
362988eea45cSKlaus Jensen 
363088eea45cSKlaus Jensen     case NVME_ZONE_ACTION_FINISH:
363188eea45cSKlaus Jensen         if (all) {
363288eea45cSKlaus Jensen             proc_mask = NVME_PROC_OPENED_ZONES | NVME_PROC_CLOSED_ZONES;
363388eea45cSKlaus Jensen         }
363488eea45cSKlaus Jensen         trace_pci_nvme_finish_zone(slba, zone_idx, all);
363588eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_finish_zone, req);
363688eea45cSKlaus Jensen         break;
363788eea45cSKlaus Jensen 
363888eea45cSKlaus Jensen     case NVME_ZONE_ACTION_RESET:
363988eea45cSKlaus Jensen         trace_pci_nvme_reset_zone(slba, zone_idx, all);
364088eea45cSKlaus Jensen 
364163d96e4fSKlaus Jensen         iocb = blk_aio_get(&nvme_zone_reset_aiocb_info, ns->blkconf.blk,
364263d96e4fSKlaus Jensen                            nvme_misc_cb, req);
364388eea45cSKlaus Jensen 
364463d96e4fSKlaus Jensen         iocb->req = req;
364563d96e4fSKlaus Jensen         iocb->bh = qemu_bh_new(nvme_zone_reset_bh, iocb);
364663d96e4fSKlaus Jensen         iocb->ret = 0;
364763d96e4fSKlaus Jensen         iocb->all = all;
364863d96e4fSKlaus Jensen         iocb->idx = zone_idx;
364963d96e4fSKlaus Jensen         iocb->zone = NULL;
365088eea45cSKlaus Jensen 
365163d96e4fSKlaus Jensen         req->aiocb = &iocb->common;
365263d96e4fSKlaus Jensen         nvme_zone_reset_cb(iocb, 0);
365388eea45cSKlaus Jensen 
365463d96e4fSKlaus Jensen         return NVME_NO_COMPLETE;
365588eea45cSKlaus Jensen 
365688eea45cSKlaus Jensen     case NVME_ZONE_ACTION_OFFLINE:
365788eea45cSKlaus Jensen         if (all) {
365888eea45cSKlaus Jensen             proc_mask = NVME_PROC_READ_ONLY_ZONES;
365988eea45cSKlaus Jensen         }
366088eea45cSKlaus Jensen         trace_pci_nvme_offline_zone(slba, zone_idx, all);
366188eea45cSKlaus Jensen         status = nvme_do_zone_op(ns, zone, proc_mask, nvme_offline_zone, req);
366288eea45cSKlaus Jensen         break;
366388eea45cSKlaus Jensen 
366488eea45cSKlaus Jensen     case NVME_ZONE_ACTION_SET_ZD_EXT:
366588eea45cSKlaus Jensen         trace_pci_nvme_set_descriptor_extension(slba, zone_idx);
366688eea45cSKlaus Jensen         if (all || !ns->params.zd_extension_size) {
366788eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
366888eea45cSKlaus Jensen         }
366988eea45cSKlaus Jensen         zd_ext = nvme_get_zd_extension(ns, zone_idx);
367088eea45cSKlaus Jensen         status = nvme_h2c(n, zd_ext, ns->params.zd_extension_size, req);
367188eea45cSKlaus Jensen         if (status) {
367288eea45cSKlaus Jensen             trace_pci_nvme_err_zd_extension_map_error(zone_idx);
367388eea45cSKlaus Jensen             return status;
367488eea45cSKlaus Jensen         }
367588eea45cSKlaus Jensen 
367688eea45cSKlaus Jensen         status = nvme_set_zd_ext(ns, zone);
367788eea45cSKlaus Jensen         if (status == NVME_SUCCESS) {
367888eea45cSKlaus Jensen             trace_pci_nvme_zd_extension_set(zone_idx);
367988eea45cSKlaus Jensen             return status;
368088eea45cSKlaus Jensen         }
368188eea45cSKlaus Jensen         break;
368288eea45cSKlaus Jensen 
368388eea45cSKlaus Jensen     default:
368488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_mgmt_action(action);
368588eea45cSKlaus Jensen         status = NVME_INVALID_FIELD;
368688eea45cSKlaus Jensen     }
368788eea45cSKlaus Jensen 
368888eea45cSKlaus Jensen     if (status == NVME_ZONE_INVAL_TRANSITION) {
368988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_zone_state_transition(action, slba,
369088eea45cSKlaus Jensen                                                          zone->d.za);
369188eea45cSKlaus Jensen     }
369288eea45cSKlaus Jensen     if (status) {
369388eea45cSKlaus Jensen         status |= NVME_DNR;
369488eea45cSKlaus Jensen     }
369588eea45cSKlaus Jensen 
369688eea45cSKlaus Jensen     return status;
369788eea45cSKlaus Jensen }
369888eea45cSKlaus Jensen 
369988eea45cSKlaus Jensen static bool nvme_zone_matches_filter(uint32_t zafs, NvmeZone *zl)
370088eea45cSKlaus Jensen {
370188eea45cSKlaus Jensen     NvmeZoneState zs = nvme_get_zone_state(zl);
370288eea45cSKlaus Jensen 
370388eea45cSKlaus Jensen     switch (zafs) {
370488eea45cSKlaus Jensen     case NVME_ZONE_REPORT_ALL:
370588eea45cSKlaus Jensen         return true;
370688eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EMPTY:
370788eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EMPTY;
370888eea45cSKlaus Jensen     case NVME_ZONE_REPORT_IMPLICITLY_OPEN:
370988eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_IMPLICITLY_OPEN;
371088eea45cSKlaus Jensen     case NVME_ZONE_REPORT_EXPLICITLY_OPEN:
371188eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_EXPLICITLY_OPEN;
371288eea45cSKlaus Jensen     case NVME_ZONE_REPORT_CLOSED:
371388eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_CLOSED;
371488eea45cSKlaus Jensen     case NVME_ZONE_REPORT_FULL:
371588eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_FULL;
371688eea45cSKlaus Jensen     case NVME_ZONE_REPORT_READ_ONLY:
371788eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_READ_ONLY;
371888eea45cSKlaus Jensen     case NVME_ZONE_REPORT_OFFLINE:
371988eea45cSKlaus Jensen         return zs == NVME_ZONE_STATE_OFFLINE;
372088eea45cSKlaus Jensen     default:
372188eea45cSKlaus Jensen         return false;
372288eea45cSKlaus Jensen     }
372388eea45cSKlaus Jensen }
372488eea45cSKlaus Jensen 
372588eea45cSKlaus Jensen static uint16_t nvme_zone_mgmt_recv(NvmeCtrl *n, NvmeRequest *req)
372688eea45cSKlaus Jensen {
372788eea45cSKlaus Jensen     NvmeCmd *cmd = (NvmeCmd *)&req->cmd;
372888eea45cSKlaus Jensen     NvmeNamespace *ns = req->ns;
372988eea45cSKlaus Jensen     /* cdw12 is zero-based number of dwords to return. Convert to bytes */
373088eea45cSKlaus Jensen     uint32_t data_size = (le32_to_cpu(cmd->cdw12) + 1) << 2;
373188eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
373288eea45cSKlaus Jensen     uint32_t zone_idx, zra, zrasf, partial;
373388eea45cSKlaus Jensen     uint64_t max_zones, nr_zones = 0;
373488eea45cSKlaus Jensen     uint16_t status;
373588eea45cSKlaus Jensen     uint64_t slba;
373688eea45cSKlaus Jensen     NvmeZoneDescr *z;
373788eea45cSKlaus Jensen     NvmeZone *zone;
373888eea45cSKlaus Jensen     NvmeZoneReportHeader *header;
373988eea45cSKlaus Jensen     void *buf, *buf_p;
374088eea45cSKlaus Jensen     size_t zone_entry_sz;
374188eea45cSKlaus Jensen     int i;
374288eea45cSKlaus Jensen 
374388eea45cSKlaus Jensen     req->status = NVME_SUCCESS;
374488eea45cSKlaus Jensen 
374588eea45cSKlaus Jensen     status = nvme_get_mgmt_zone_slba_idx(ns, cmd, &slba, &zone_idx);
374688eea45cSKlaus Jensen     if (status) {
374788eea45cSKlaus Jensen         return status;
374888eea45cSKlaus Jensen     }
374988eea45cSKlaus Jensen 
375088eea45cSKlaus Jensen     zra = dw13 & 0xff;
375188eea45cSKlaus Jensen     if (zra != NVME_ZONE_REPORT && zra != NVME_ZONE_REPORT_EXTENDED) {
375288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
375388eea45cSKlaus Jensen     }
375488eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED && !ns->params.zd_extension_size) {
375588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
375688eea45cSKlaus Jensen     }
375788eea45cSKlaus Jensen 
375888eea45cSKlaus Jensen     zrasf = (dw13 >> 8) & 0xff;
375988eea45cSKlaus Jensen     if (zrasf > NVME_ZONE_REPORT_OFFLINE) {
376088eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
376188eea45cSKlaus Jensen     }
376288eea45cSKlaus Jensen 
376388eea45cSKlaus Jensen     if (data_size < sizeof(NvmeZoneReportHeader)) {
376488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
376588eea45cSKlaus Jensen     }
376688eea45cSKlaus Jensen 
376788eea45cSKlaus Jensen     status = nvme_check_mdts(n, data_size);
376888eea45cSKlaus Jensen     if (status) {
376988eea45cSKlaus Jensen         return status;
377088eea45cSKlaus Jensen     }
377188eea45cSKlaus Jensen 
377288eea45cSKlaus Jensen     partial = (dw13 >> 16) & 0x01;
377388eea45cSKlaus Jensen 
377488eea45cSKlaus Jensen     zone_entry_sz = sizeof(NvmeZoneDescr);
377588eea45cSKlaus Jensen     if (zra == NVME_ZONE_REPORT_EXTENDED) {
377688eea45cSKlaus Jensen         zone_entry_sz += ns->params.zd_extension_size;
377788eea45cSKlaus Jensen     }
377888eea45cSKlaus Jensen 
377988eea45cSKlaus Jensen     max_zones = (data_size - sizeof(NvmeZoneReportHeader)) / zone_entry_sz;
378088eea45cSKlaus Jensen     buf = g_malloc0(data_size);
378188eea45cSKlaus Jensen 
378288eea45cSKlaus Jensen     zone = &ns->zone_array[zone_idx];
378388eea45cSKlaus Jensen     for (i = zone_idx; i < ns->num_zones; i++) {
378488eea45cSKlaus Jensen         if (partial && nr_zones >= max_zones) {
378588eea45cSKlaus Jensen             break;
378688eea45cSKlaus Jensen         }
378788eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone++)) {
378888eea45cSKlaus Jensen             nr_zones++;
378988eea45cSKlaus Jensen         }
379088eea45cSKlaus Jensen     }
379188eea45cSKlaus Jensen     header = (NvmeZoneReportHeader *)buf;
379288eea45cSKlaus Jensen     header->nr_zones = cpu_to_le64(nr_zones);
379388eea45cSKlaus Jensen 
379488eea45cSKlaus Jensen     buf_p = buf + sizeof(NvmeZoneReportHeader);
379588eea45cSKlaus Jensen     for (; zone_idx < ns->num_zones && max_zones > 0; zone_idx++) {
379688eea45cSKlaus Jensen         zone = &ns->zone_array[zone_idx];
379788eea45cSKlaus Jensen         if (nvme_zone_matches_filter(zrasf, zone)) {
379888eea45cSKlaus Jensen             z = (NvmeZoneDescr *)buf_p;
379988eea45cSKlaus Jensen             buf_p += sizeof(NvmeZoneDescr);
380088eea45cSKlaus Jensen 
380188eea45cSKlaus Jensen             z->zt = zone->d.zt;
380288eea45cSKlaus Jensen             z->zs = zone->d.zs;
380388eea45cSKlaus Jensen             z->zcap = cpu_to_le64(zone->d.zcap);
380488eea45cSKlaus Jensen             z->zslba = cpu_to_le64(zone->d.zslba);
380588eea45cSKlaus Jensen             z->za = zone->d.za;
380688eea45cSKlaus Jensen 
380788eea45cSKlaus Jensen             if (nvme_wp_is_valid(zone)) {
380888eea45cSKlaus Jensen                 z->wp = cpu_to_le64(zone->d.wp);
380988eea45cSKlaus Jensen             } else {
381088eea45cSKlaus Jensen                 z->wp = cpu_to_le64(~0ULL);
381188eea45cSKlaus Jensen             }
381288eea45cSKlaus Jensen 
381388eea45cSKlaus Jensen             if (zra == NVME_ZONE_REPORT_EXTENDED) {
381488eea45cSKlaus Jensen                 if (zone->d.za & NVME_ZA_ZD_EXT_VALID) {
381588eea45cSKlaus Jensen                     memcpy(buf_p, nvme_get_zd_extension(ns, zone_idx),
381688eea45cSKlaus Jensen                            ns->params.zd_extension_size);
381788eea45cSKlaus Jensen                 }
381888eea45cSKlaus Jensen                 buf_p += ns->params.zd_extension_size;
381988eea45cSKlaus Jensen             }
382088eea45cSKlaus Jensen 
382188eea45cSKlaus Jensen             max_zones--;
382288eea45cSKlaus Jensen         }
382388eea45cSKlaus Jensen     }
382488eea45cSKlaus Jensen 
382588eea45cSKlaus Jensen     status = nvme_c2h(n, (uint8_t *)buf, data_size, req);
382688eea45cSKlaus Jensen 
382788eea45cSKlaus Jensen     g_free(buf);
382888eea45cSKlaus Jensen 
382988eea45cSKlaus Jensen     return status;
383088eea45cSKlaus Jensen }
383188eea45cSKlaus Jensen 
383288eea45cSKlaus Jensen static uint16_t nvme_io_cmd(NvmeCtrl *n, NvmeRequest *req)
383388eea45cSKlaus Jensen {
383488eea45cSKlaus Jensen     NvmeNamespace *ns;
383588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
383688eea45cSKlaus Jensen 
383788eea45cSKlaus Jensen     trace_pci_nvme_io_cmd(nvme_cid(req), nsid, nvme_sqid(req),
383888eea45cSKlaus Jensen                           req->cmd.opcode, nvme_io_opc_str(req->cmd.opcode));
383988eea45cSKlaus Jensen 
384088eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid)) {
384188eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
384288eea45cSKlaus Jensen     }
384388eea45cSKlaus Jensen 
384488eea45cSKlaus Jensen     /*
384588eea45cSKlaus Jensen      * In the base NVM command set, Flush may apply to all namespaces
384688eea45cSKlaus Jensen      * (indicated by NSID being set to FFFFFFFFh). But if that feature is used
384788eea45cSKlaus Jensen      * along with TP 4056 (Namespace Types), it may be pretty screwed up.
384888eea45cSKlaus Jensen      *
384988eea45cSKlaus Jensen      * If NSID is indeed set to FFFFFFFFh, we simply cannot associate the
385088eea45cSKlaus Jensen      * opcode with a specific command since we cannot determine a unique I/O
385188eea45cSKlaus Jensen      * command set. Opcode 0h could have any other meaning than something
385288eea45cSKlaus Jensen      * equivalent to flushing and say it DOES have completely different
385388eea45cSKlaus Jensen      * semantics in some other command set - does an NSID of FFFFFFFFh then
385488eea45cSKlaus Jensen      * mean "for all namespaces, apply whatever command set specific command
385588eea45cSKlaus Jensen      * that uses the 0h opcode?" Or does it mean "for all namespaces, apply
385688eea45cSKlaus Jensen      * whatever command that uses the 0h opcode if, and only if, it allows NSID
385788eea45cSKlaus Jensen      * to be FFFFFFFFh"?
385888eea45cSKlaus Jensen      *
385988eea45cSKlaus Jensen      * Anyway (and luckily), for now, we do not care about this since the
386088eea45cSKlaus Jensen      * device only supports namespace types that includes the NVM Flush command
386188eea45cSKlaus Jensen      * (NVM and Zoned), so always do an NVM Flush.
386288eea45cSKlaus Jensen      */
386388eea45cSKlaus Jensen     if (req->cmd.opcode == NVME_CMD_FLUSH) {
386488eea45cSKlaus Jensen         return nvme_flush(n, req);
386588eea45cSKlaus Jensen     }
386688eea45cSKlaus Jensen 
386788eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
386888eea45cSKlaus Jensen     if (unlikely(!ns)) {
386988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
387088eea45cSKlaus Jensen     }
387188eea45cSKlaus Jensen 
387288eea45cSKlaus Jensen     if (!(ns->iocs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
387388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_opc(req->cmd.opcode);
387488eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
387588eea45cSKlaus Jensen     }
387688eea45cSKlaus Jensen 
387788eea45cSKlaus Jensen     if (ns->status) {
387888eea45cSKlaus Jensen         return ns->status;
387988eea45cSKlaus Jensen     }
388088eea45cSKlaus Jensen 
388188eea45cSKlaus Jensen     req->ns = ns;
388288eea45cSKlaus Jensen 
388388eea45cSKlaus Jensen     switch (req->cmd.opcode) {
388488eea45cSKlaus Jensen     case NVME_CMD_WRITE_ZEROES:
388588eea45cSKlaus Jensen         return nvme_write_zeroes(n, req);
388688eea45cSKlaus Jensen     case NVME_CMD_ZONE_APPEND:
388788eea45cSKlaus Jensen         return nvme_zone_append(n, req);
388888eea45cSKlaus Jensen     case NVME_CMD_WRITE:
388988eea45cSKlaus Jensen         return nvme_write(n, req);
389088eea45cSKlaus Jensen     case NVME_CMD_READ:
389188eea45cSKlaus Jensen         return nvme_read(n, req);
389288eea45cSKlaus Jensen     case NVME_CMD_COMPARE:
389388eea45cSKlaus Jensen         return nvme_compare(n, req);
389488eea45cSKlaus Jensen     case NVME_CMD_DSM:
389588eea45cSKlaus Jensen         return nvme_dsm(n, req);
389688eea45cSKlaus Jensen     case NVME_CMD_VERIFY:
389788eea45cSKlaus Jensen         return nvme_verify(n, req);
389888eea45cSKlaus Jensen     case NVME_CMD_COPY:
389988eea45cSKlaus Jensen         return nvme_copy(n, req);
390088eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_SEND:
390188eea45cSKlaus Jensen         return nvme_zone_mgmt_send(n, req);
390288eea45cSKlaus Jensen     case NVME_CMD_ZONE_MGMT_RECV:
390388eea45cSKlaus Jensen         return nvme_zone_mgmt_recv(n, req);
390488eea45cSKlaus Jensen     default:
390588eea45cSKlaus Jensen         assert(false);
390688eea45cSKlaus Jensen     }
390788eea45cSKlaus Jensen 
390888eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
390988eea45cSKlaus Jensen }
391088eea45cSKlaus Jensen 
391188eea45cSKlaus Jensen static void nvme_free_sq(NvmeSQueue *sq, NvmeCtrl *n)
391288eea45cSKlaus Jensen {
391388eea45cSKlaus Jensen     n->sq[sq->sqid] = NULL;
391488eea45cSKlaus Jensen     timer_free(sq->timer);
391588eea45cSKlaus Jensen     g_free(sq->io_req);
391688eea45cSKlaus Jensen     if (sq->sqid) {
391788eea45cSKlaus Jensen         g_free(sq);
391888eea45cSKlaus Jensen     }
391988eea45cSKlaus Jensen }
392088eea45cSKlaus Jensen 
392188eea45cSKlaus Jensen static uint16_t nvme_del_sq(NvmeCtrl *n, NvmeRequest *req)
392288eea45cSKlaus Jensen {
392388eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
392488eea45cSKlaus Jensen     NvmeRequest *r, *next;
392588eea45cSKlaus Jensen     NvmeSQueue *sq;
392688eea45cSKlaus Jensen     NvmeCQueue *cq;
392788eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
392888eea45cSKlaus Jensen 
392988eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_sqid(n, qid))) {
393088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_sq(qid);
393188eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
393288eea45cSKlaus Jensen     }
393388eea45cSKlaus Jensen 
393488eea45cSKlaus Jensen     trace_pci_nvme_del_sq(qid);
393588eea45cSKlaus Jensen 
393688eea45cSKlaus Jensen     sq = n->sq[qid];
393788eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&sq->out_req_list)) {
393888eea45cSKlaus Jensen         r = QTAILQ_FIRST(&sq->out_req_list);
3939e76fb260SKlaus Jensen         assert(r->aiocb);
394088eea45cSKlaus Jensen         blk_aio_cancel(r->aiocb);
394188eea45cSKlaus Jensen     }
394288eea45cSKlaus Jensen 
394388eea45cSKlaus Jensen     assert(QTAILQ_EMPTY(&sq->out_req_list));
394488eea45cSKlaus Jensen 
394588eea45cSKlaus Jensen     if (!nvme_check_cqid(n, sq->cqid)) {
394688eea45cSKlaus Jensen         cq = n->cq[sq->cqid];
394788eea45cSKlaus Jensen         QTAILQ_REMOVE(&cq->sq_list, sq, entry);
394888eea45cSKlaus Jensen 
394988eea45cSKlaus Jensen         nvme_post_cqes(cq);
395088eea45cSKlaus Jensen         QTAILQ_FOREACH_SAFE(r, &cq->req_list, entry, next) {
395188eea45cSKlaus Jensen             if (r->sq == sq) {
395288eea45cSKlaus Jensen                 QTAILQ_REMOVE(&cq->req_list, r, entry);
395388eea45cSKlaus Jensen                 QTAILQ_INSERT_TAIL(&sq->req_list, r, entry);
395488eea45cSKlaus Jensen             }
395588eea45cSKlaus Jensen         }
395688eea45cSKlaus Jensen     }
395788eea45cSKlaus Jensen 
395888eea45cSKlaus Jensen     nvme_free_sq(sq, n);
395988eea45cSKlaus Jensen     return NVME_SUCCESS;
396088eea45cSKlaus Jensen }
396188eea45cSKlaus Jensen 
396288eea45cSKlaus Jensen static void nvme_init_sq(NvmeSQueue *sq, NvmeCtrl *n, uint64_t dma_addr,
396388eea45cSKlaus Jensen                          uint16_t sqid, uint16_t cqid, uint16_t size)
396488eea45cSKlaus Jensen {
396588eea45cSKlaus Jensen     int i;
396688eea45cSKlaus Jensen     NvmeCQueue *cq;
396788eea45cSKlaus Jensen 
396888eea45cSKlaus Jensen     sq->ctrl = n;
396988eea45cSKlaus Jensen     sq->dma_addr = dma_addr;
397088eea45cSKlaus Jensen     sq->sqid = sqid;
397188eea45cSKlaus Jensen     sq->size = size;
397288eea45cSKlaus Jensen     sq->cqid = cqid;
397388eea45cSKlaus Jensen     sq->head = sq->tail = 0;
397488eea45cSKlaus Jensen     sq->io_req = g_new0(NvmeRequest, sq->size);
397588eea45cSKlaus Jensen 
397688eea45cSKlaus Jensen     QTAILQ_INIT(&sq->req_list);
397788eea45cSKlaus Jensen     QTAILQ_INIT(&sq->out_req_list);
397888eea45cSKlaus Jensen     for (i = 0; i < sq->size; i++) {
397988eea45cSKlaus Jensen         sq->io_req[i].sq = sq;
398088eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&(sq->req_list), &sq->io_req[i], entry);
398188eea45cSKlaus Jensen     }
398288eea45cSKlaus Jensen     sq->timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, nvme_process_sq, sq);
398388eea45cSKlaus Jensen 
398488eea45cSKlaus Jensen     assert(n->cq[cqid]);
398588eea45cSKlaus Jensen     cq = n->cq[cqid];
398688eea45cSKlaus Jensen     QTAILQ_INSERT_TAIL(&(cq->sq_list), sq, entry);
398788eea45cSKlaus Jensen     n->sq[sqid] = sq;
398888eea45cSKlaus Jensen }
398988eea45cSKlaus Jensen 
399088eea45cSKlaus Jensen static uint16_t nvme_create_sq(NvmeCtrl *n, NvmeRequest *req)
399188eea45cSKlaus Jensen {
399288eea45cSKlaus Jensen     NvmeSQueue *sq;
399388eea45cSKlaus Jensen     NvmeCreateSq *c = (NvmeCreateSq *)&req->cmd;
399488eea45cSKlaus Jensen 
399588eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
399688eea45cSKlaus Jensen     uint16_t sqid = le16_to_cpu(c->sqid);
399788eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
399888eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->sq_flags);
399988eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
400088eea45cSKlaus Jensen 
400188eea45cSKlaus Jensen     trace_pci_nvme_create_sq(prp1, sqid, cqid, qsize, qflags);
400288eea45cSKlaus Jensen 
400388eea45cSKlaus Jensen     if (unlikely(!cqid || nvme_check_cqid(n, cqid))) {
400488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_cqid(cqid);
400588eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
400688eea45cSKlaus Jensen     }
400788eea45cSKlaus Jensen     if (unlikely(!sqid || sqid > n->params.max_ioqpairs ||
400888eea45cSKlaus Jensen         n->sq[sqid] != NULL)) {
400988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_sqid(sqid);
401088eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
401188eea45cSKlaus Jensen     }
401288eea45cSKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(n->bar.cap))) {
401388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_size(qsize);
401488eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
401588eea45cSKlaus Jensen     }
401688eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
401788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_addr(prp1);
401888eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
401988eea45cSKlaus Jensen     }
402088eea45cSKlaus Jensen     if (unlikely(!(NVME_SQ_FLAGS_PC(qflags)))) {
402188eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_sq_qflags(NVME_SQ_FLAGS_PC(qflags));
402288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
402388eea45cSKlaus Jensen     }
402488eea45cSKlaus Jensen     sq = g_malloc0(sizeof(*sq));
402588eea45cSKlaus Jensen     nvme_init_sq(sq, n, prp1, sqid, cqid, qsize + 1);
402688eea45cSKlaus Jensen     return NVME_SUCCESS;
402788eea45cSKlaus Jensen }
402888eea45cSKlaus Jensen 
402988eea45cSKlaus Jensen struct nvme_stats {
403088eea45cSKlaus Jensen     uint64_t units_read;
403188eea45cSKlaus Jensen     uint64_t units_written;
403288eea45cSKlaus Jensen     uint64_t read_commands;
403388eea45cSKlaus Jensen     uint64_t write_commands;
403488eea45cSKlaus Jensen };
403588eea45cSKlaus Jensen 
403688eea45cSKlaus Jensen static void nvme_set_blk_stats(NvmeNamespace *ns, struct nvme_stats *stats)
403788eea45cSKlaus Jensen {
403888eea45cSKlaus Jensen     BlockAcctStats *s = blk_get_stats(ns->blkconf.blk);
403988eea45cSKlaus Jensen 
404088eea45cSKlaus Jensen     stats->units_read += s->nr_bytes[BLOCK_ACCT_READ] >> BDRV_SECTOR_BITS;
404188eea45cSKlaus Jensen     stats->units_written += s->nr_bytes[BLOCK_ACCT_WRITE] >> BDRV_SECTOR_BITS;
404288eea45cSKlaus Jensen     stats->read_commands += s->nr_ops[BLOCK_ACCT_READ];
404388eea45cSKlaus Jensen     stats->write_commands += s->nr_ops[BLOCK_ACCT_WRITE];
404488eea45cSKlaus Jensen }
404588eea45cSKlaus Jensen 
404688eea45cSKlaus Jensen static uint16_t nvme_smart_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
404788eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
404888eea45cSKlaus Jensen {
404988eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
405088eea45cSKlaus Jensen     struct nvme_stats stats = { 0 };
405188eea45cSKlaus Jensen     NvmeSmartLog smart = { 0 };
405288eea45cSKlaus Jensen     uint32_t trans_len;
405388eea45cSKlaus Jensen     NvmeNamespace *ns;
405488eea45cSKlaus Jensen     time_t current_ms;
405588eea45cSKlaus Jensen 
405688eea45cSKlaus Jensen     if (off >= sizeof(smart)) {
405788eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
405888eea45cSKlaus Jensen     }
405988eea45cSKlaus Jensen 
406088eea45cSKlaus Jensen     if (nsid != 0xffffffff) {
406188eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
406288eea45cSKlaus Jensen         if (!ns) {
406388eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
406488eea45cSKlaus Jensen         }
406588eea45cSKlaus Jensen         nvme_set_blk_stats(ns, &stats);
406688eea45cSKlaus Jensen     } else {
406788eea45cSKlaus Jensen         int i;
406888eea45cSKlaus Jensen 
406988eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
407088eea45cSKlaus Jensen             ns = nvme_ns(n, i);
407188eea45cSKlaus Jensen             if (!ns) {
407288eea45cSKlaus Jensen                 continue;
407388eea45cSKlaus Jensen             }
407488eea45cSKlaus Jensen             nvme_set_blk_stats(ns, &stats);
407588eea45cSKlaus Jensen         }
407688eea45cSKlaus Jensen     }
407788eea45cSKlaus Jensen 
407888eea45cSKlaus Jensen     trans_len = MIN(sizeof(smart) - off, buf_len);
407988eea45cSKlaus Jensen     smart.critical_warning = n->smart_critical_warning;
408088eea45cSKlaus Jensen 
408188eea45cSKlaus Jensen     smart.data_units_read[0] = cpu_to_le64(DIV_ROUND_UP(stats.units_read,
408288eea45cSKlaus Jensen                                                         1000));
408388eea45cSKlaus Jensen     smart.data_units_written[0] = cpu_to_le64(DIV_ROUND_UP(stats.units_written,
408488eea45cSKlaus Jensen                                                            1000));
408588eea45cSKlaus Jensen     smart.host_read_commands[0] = cpu_to_le64(stats.read_commands);
408688eea45cSKlaus Jensen     smart.host_write_commands[0] = cpu_to_le64(stats.write_commands);
408788eea45cSKlaus Jensen 
408888eea45cSKlaus Jensen     smart.temperature = cpu_to_le16(n->temperature);
408988eea45cSKlaus Jensen 
409088eea45cSKlaus Jensen     if ((n->temperature >= n->features.temp_thresh_hi) ||
409188eea45cSKlaus Jensen         (n->temperature <= n->features.temp_thresh_low)) {
409288eea45cSKlaus Jensen         smart.critical_warning |= NVME_SMART_TEMPERATURE;
409388eea45cSKlaus Jensen     }
409488eea45cSKlaus Jensen 
409588eea45cSKlaus Jensen     current_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
409688eea45cSKlaus Jensen     smart.power_on_hours[0] =
409788eea45cSKlaus Jensen         cpu_to_le64((((current_ms - n->starttime_ms) / 1000) / 60) / 60);
409888eea45cSKlaus Jensen 
409988eea45cSKlaus Jensen     if (!rae) {
410088eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_SMART);
410188eea45cSKlaus Jensen     }
410288eea45cSKlaus Jensen 
410388eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &smart + off, trans_len, req);
410488eea45cSKlaus Jensen }
410588eea45cSKlaus Jensen 
410688eea45cSKlaus Jensen static uint16_t nvme_fw_log_info(NvmeCtrl *n, uint32_t buf_len, uint64_t off,
410788eea45cSKlaus Jensen                                  NvmeRequest *req)
410888eea45cSKlaus Jensen {
410988eea45cSKlaus Jensen     uint32_t trans_len;
411088eea45cSKlaus Jensen     NvmeFwSlotInfoLog fw_log = {
411188eea45cSKlaus Jensen         .afi = 0x1,
411288eea45cSKlaus Jensen     };
411388eea45cSKlaus Jensen 
411488eea45cSKlaus Jensen     if (off >= sizeof(fw_log)) {
411588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
411688eea45cSKlaus Jensen     }
411788eea45cSKlaus Jensen 
411888eea45cSKlaus Jensen     strpadcpy((char *)&fw_log.frs1, sizeof(fw_log.frs1), "1.0", ' ');
411988eea45cSKlaus Jensen     trans_len = MIN(sizeof(fw_log) - off, buf_len);
412088eea45cSKlaus Jensen 
412188eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *) &fw_log + off, trans_len, req);
412288eea45cSKlaus Jensen }
412388eea45cSKlaus Jensen 
412488eea45cSKlaus Jensen static uint16_t nvme_error_info(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
412588eea45cSKlaus Jensen                                 uint64_t off, NvmeRequest *req)
412688eea45cSKlaus Jensen {
412788eea45cSKlaus Jensen     uint32_t trans_len;
412888eea45cSKlaus Jensen     NvmeErrorLog errlog;
412988eea45cSKlaus Jensen 
413088eea45cSKlaus Jensen     if (off >= sizeof(errlog)) {
413188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
413288eea45cSKlaus Jensen     }
413388eea45cSKlaus Jensen 
413488eea45cSKlaus Jensen     if (!rae) {
413588eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_ERROR);
413688eea45cSKlaus Jensen     }
413788eea45cSKlaus Jensen 
413888eea45cSKlaus Jensen     memset(&errlog, 0x0, sizeof(errlog));
413988eea45cSKlaus Jensen     trans_len = MIN(sizeof(errlog) - off, buf_len);
414088eea45cSKlaus Jensen 
414188eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&errlog, trans_len, req);
414288eea45cSKlaus Jensen }
414388eea45cSKlaus Jensen 
414488eea45cSKlaus Jensen static uint16_t nvme_changed_nslist(NvmeCtrl *n, uint8_t rae, uint32_t buf_len,
414588eea45cSKlaus Jensen                                     uint64_t off, NvmeRequest *req)
414688eea45cSKlaus Jensen {
414788eea45cSKlaus Jensen     uint32_t nslist[1024];
414888eea45cSKlaus Jensen     uint32_t trans_len;
414988eea45cSKlaus Jensen     int i = 0;
415088eea45cSKlaus Jensen     uint32_t nsid;
415188eea45cSKlaus Jensen 
415288eea45cSKlaus Jensen     memset(nslist, 0x0, sizeof(nslist));
415388eea45cSKlaus Jensen     trans_len = MIN(sizeof(nslist) - off, buf_len);
415488eea45cSKlaus Jensen 
415588eea45cSKlaus Jensen     while ((nsid = find_first_bit(n->changed_nsids, NVME_CHANGED_NSID_SIZE)) !=
415688eea45cSKlaus Jensen             NVME_CHANGED_NSID_SIZE) {
415788eea45cSKlaus Jensen         /*
415888eea45cSKlaus Jensen          * If more than 1024 namespaces, the first entry in the log page should
415988eea45cSKlaus Jensen          * be set to FFFFFFFFh and the others to 0 as spec.
416088eea45cSKlaus Jensen          */
416188eea45cSKlaus Jensen         if (i == ARRAY_SIZE(nslist)) {
416288eea45cSKlaus Jensen             memset(nslist, 0x0, sizeof(nslist));
416388eea45cSKlaus Jensen             nslist[0] = 0xffffffff;
416488eea45cSKlaus Jensen             break;
416588eea45cSKlaus Jensen         }
416688eea45cSKlaus Jensen 
416788eea45cSKlaus Jensen         nslist[i++] = nsid;
416888eea45cSKlaus Jensen         clear_bit(nsid, n->changed_nsids);
416988eea45cSKlaus Jensen     }
417088eea45cSKlaus Jensen 
417188eea45cSKlaus Jensen     /*
417288eea45cSKlaus Jensen      * Remove all the remaining list entries in case returns directly due to
417388eea45cSKlaus Jensen      * more than 1024 namespaces.
417488eea45cSKlaus Jensen      */
417588eea45cSKlaus Jensen     if (nslist[0] == 0xffffffff) {
417688eea45cSKlaus Jensen         bitmap_zero(n->changed_nsids, NVME_CHANGED_NSID_SIZE);
417788eea45cSKlaus Jensen     }
417888eea45cSKlaus Jensen 
417988eea45cSKlaus Jensen     if (!rae) {
418088eea45cSKlaus Jensen         nvme_clear_events(n, NVME_AER_TYPE_NOTICE);
418188eea45cSKlaus Jensen     }
418288eea45cSKlaus Jensen 
418388eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)nslist) + off, trans_len, req);
418488eea45cSKlaus Jensen }
418588eea45cSKlaus Jensen 
418688eea45cSKlaus Jensen static uint16_t nvme_cmd_effects(NvmeCtrl *n, uint8_t csi, uint32_t buf_len,
418788eea45cSKlaus Jensen                                  uint64_t off, NvmeRequest *req)
418888eea45cSKlaus Jensen {
418988eea45cSKlaus Jensen     NvmeEffectsLog log = {};
419088eea45cSKlaus Jensen     const uint32_t *src_iocs = NULL;
419188eea45cSKlaus Jensen     uint32_t trans_len;
419288eea45cSKlaus Jensen 
419388eea45cSKlaus Jensen     if (off >= sizeof(log)) {
419488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page_offset(off, sizeof(log));
419588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
419688eea45cSKlaus Jensen     }
419788eea45cSKlaus Jensen 
419888eea45cSKlaus Jensen     switch (NVME_CC_CSS(n->bar.cc)) {
419988eea45cSKlaus Jensen     case NVME_CC_CSS_NVM:
420088eea45cSKlaus Jensen         src_iocs = nvme_cse_iocs_nvm;
420188eea45cSKlaus Jensen         /* fall through */
420288eea45cSKlaus Jensen     case NVME_CC_CSS_ADMIN_ONLY:
420388eea45cSKlaus Jensen         break;
420488eea45cSKlaus Jensen     case NVME_CC_CSS_CSI:
420588eea45cSKlaus Jensen         switch (csi) {
420688eea45cSKlaus Jensen         case NVME_CSI_NVM:
420788eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_nvm;
420888eea45cSKlaus Jensen             break;
420988eea45cSKlaus Jensen         case NVME_CSI_ZONED:
421088eea45cSKlaus Jensen             src_iocs = nvme_cse_iocs_zoned;
421188eea45cSKlaus Jensen             break;
421288eea45cSKlaus Jensen         }
421388eea45cSKlaus Jensen     }
421488eea45cSKlaus Jensen 
421588eea45cSKlaus Jensen     memcpy(log.acs, nvme_cse_acs, sizeof(nvme_cse_acs));
421688eea45cSKlaus Jensen 
421788eea45cSKlaus Jensen     if (src_iocs) {
421888eea45cSKlaus Jensen         memcpy(log.iocs, src_iocs, sizeof(log.iocs));
421988eea45cSKlaus Jensen     }
422088eea45cSKlaus Jensen 
422188eea45cSKlaus Jensen     trans_len = MIN(sizeof(log) - off, buf_len);
422288eea45cSKlaus Jensen 
422388eea45cSKlaus Jensen     return nvme_c2h(n, ((uint8_t *)&log) + off, trans_len, req);
422488eea45cSKlaus Jensen }
422588eea45cSKlaus Jensen 
422688eea45cSKlaus Jensen static uint16_t nvme_get_log(NvmeCtrl *n, NvmeRequest *req)
422788eea45cSKlaus Jensen {
422888eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
422988eea45cSKlaus Jensen 
423088eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
423188eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
423288eea45cSKlaus Jensen     uint32_t dw12 = le32_to_cpu(cmd->cdw12);
423388eea45cSKlaus Jensen     uint32_t dw13 = le32_to_cpu(cmd->cdw13);
423488eea45cSKlaus Jensen     uint8_t  lid = dw10 & 0xff;
423588eea45cSKlaus Jensen     uint8_t  lsp = (dw10 >> 8) & 0xf;
423688eea45cSKlaus Jensen     uint8_t  rae = (dw10 >> 15) & 0x1;
423788eea45cSKlaus Jensen     uint8_t  csi = le32_to_cpu(cmd->cdw14) >> 24;
423888eea45cSKlaus Jensen     uint32_t numdl, numdu;
423988eea45cSKlaus Jensen     uint64_t off, lpol, lpou;
424088eea45cSKlaus Jensen     size_t   len;
424188eea45cSKlaus Jensen     uint16_t status;
424288eea45cSKlaus Jensen 
424388eea45cSKlaus Jensen     numdl = (dw10 >> 16);
424488eea45cSKlaus Jensen     numdu = (dw11 & 0xffff);
424588eea45cSKlaus Jensen     lpol = dw12;
424688eea45cSKlaus Jensen     lpou = dw13;
424788eea45cSKlaus Jensen 
424888eea45cSKlaus Jensen     len = (((numdu << 16) | numdl) + 1) << 2;
424988eea45cSKlaus Jensen     off = (lpou << 32ULL) | lpol;
425088eea45cSKlaus Jensen 
425188eea45cSKlaus Jensen     if (off & 0x3) {
425288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
425388eea45cSKlaus Jensen     }
425488eea45cSKlaus Jensen 
425588eea45cSKlaus Jensen     trace_pci_nvme_get_log(nvme_cid(req), lid, lsp, rae, len, off);
425688eea45cSKlaus Jensen 
425788eea45cSKlaus Jensen     status = nvme_check_mdts(n, len);
425888eea45cSKlaus Jensen     if (status) {
425988eea45cSKlaus Jensen         return status;
426088eea45cSKlaus Jensen     }
426188eea45cSKlaus Jensen 
426288eea45cSKlaus Jensen     switch (lid) {
426388eea45cSKlaus Jensen     case NVME_LOG_ERROR_INFO:
426488eea45cSKlaus Jensen         return nvme_error_info(n, rae, len, off, req);
426588eea45cSKlaus Jensen     case NVME_LOG_SMART_INFO:
426688eea45cSKlaus Jensen         return nvme_smart_info(n, rae, len, off, req);
426788eea45cSKlaus Jensen     case NVME_LOG_FW_SLOT_INFO:
426888eea45cSKlaus Jensen         return nvme_fw_log_info(n, len, off, req);
426988eea45cSKlaus Jensen     case NVME_LOG_CHANGED_NSLIST:
427088eea45cSKlaus Jensen         return nvme_changed_nslist(n, rae, len, off, req);
427188eea45cSKlaus Jensen     case NVME_LOG_CMD_EFFECTS:
427288eea45cSKlaus Jensen         return nvme_cmd_effects(n, csi, len, off, req);
427388eea45cSKlaus Jensen     default:
427488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_log_page(nvme_cid(req), lid);
427588eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
427688eea45cSKlaus Jensen     }
427788eea45cSKlaus Jensen }
427888eea45cSKlaus Jensen 
427988eea45cSKlaus Jensen static void nvme_free_cq(NvmeCQueue *cq, NvmeCtrl *n)
428088eea45cSKlaus Jensen {
428188eea45cSKlaus Jensen     n->cq[cq->cqid] = NULL;
428288eea45cSKlaus Jensen     timer_free(cq->timer);
428388eea45cSKlaus Jensen     if (msix_enabled(&n->parent_obj)) {
428488eea45cSKlaus Jensen         msix_vector_unuse(&n->parent_obj, cq->vector);
428588eea45cSKlaus Jensen     }
428688eea45cSKlaus Jensen     if (cq->cqid) {
428788eea45cSKlaus Jensen         g_free(cq);
428888eea45cSKlaus Jensen     }
428988eea45cSKlaus Jensen }
429088eea45cSKlaus Jensen 
429188eea45cSKlaus Jensen static uint16_t nvme_del_cq(NvmeCtrl *n, NvmeRequest *req)
429288eea45cSKlaus Jensen {
429388eea45cSKlaus Jensen     NvmeDeleteQ *c = (NvmeDeleteQ *)&req->cmd;
429488eea45cSKlaus Jensen     NvmeCQueue *cq;
429588eea45cSKlaus Jensen     uint16_t qid = le16_to_cpu(c->qid);
429688eea45cSKlaus Jensen 
429788eea45cSKlaus Jensen     if (unlikely(!qid || nvme_check_cqid(n, qid))) {
429888eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_cqid(qid);
429988eea45cSKlaus Jensen         return NVME_INVALID_CQID | NVME_DNR;
430088eea45cSKlaus Jensen     }
430188eea45cSKlaus Jensen 
430288eea45cSKlaus Jensen     cq = n->cq[qid];
430388eea45cSKlaus Jensen     if (unlikely(!QTAILQ_EMPTY(&cq->sq_list))) {
430488eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_del_cq_notempty(qid);
430588eea45cSKlaus Jensen         return NVME_INVALID_QUEUE_DEL;
430688eea45cSKlaus Jensen     }
430783d7ed5cSKlaus Jensen 
430883d7ed5cSKlaus Jensen     if (cq->irq_enabled && cq->tail != cq->head) {
430983d7ed5cSKlaus Jensen         n->cq_pending--;
431083d7ed5cSKlaus Jensen     }
431183d7ed5cSKlaus Jensen 
431288eea45cSKlaus Jensen     nvme_irq_deassert(n, cq);
431388eea45cSKlaus Jensen     trace_pci_nvme_del_cq(qid);
431488eea45cSKlaus Jensen     nvme_free_cq(cq, n);
431588eea45cSKlaus Jensen     return NVME_SUCCESS;
431688eea45cSKlaus Jensen }
431788eea45cSKlaus Jensen 
431888eea45cSKlaus Jensen static void nvme_init_cq(NvmeCQueue *cq, NvmeCtrl *n, uint64_t dma_addr,
431988eea45cSKlaus Jensen                          uint16_t cqid, uint16_t vector, uint16_t size,
432088eea45cSKlaus Jensen                          uint16_t irq_enabled)
432188eea45cSKlaus Jensen {
432288eea45cSKlaus Jensen     int ret;
432388eea45cSKlaus Jensen 
432488eea45cSKlaus Jensen     if (msix_enabled(&n->parent_obj)) {
432588eea45cSKlaus Jensen         ret = msix_vector_use(&n->parent_obj, vector);
432688eea45cSKlaus Jensen         assert(ret == 0);
432788eea45cSKlaus Jensen     }
432888eea45cSKlaus Jensen     cq->ctrl = n;
432988eea45cSKlaus Jensen     cq->cqid = cqid;
433088eea45cSKlaus Jensen     cq->size = size;
433188eea45cSKlaus Jensen     cq->dma_addr = dma_addr;
433288eea45cSKlaus Jensen     cq->phase = 1;
433388eea45cSKlaus Jensen     cq->irq_enabled = irq_enabled;
433488eea45cSKlaus Jensen     cq->vector = vector;
433588eea45cSKlaus Jensen     cq->head = cq->tail = 0;
433688eea45cSKlaus Jensen     QTAILQ_INIT(&cq->req_list);
433788eea45cSKlaus Jensen     QTAILQ_INIT(&cq->sq_list);
433888eea45cSKlaus Jensen     n->cq[cqid] = cq;
433988eea45cSKlaus Jensen     cq->timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, nvme_post_cqes, cq);
434088eea45cSKlaus Jensen }
434188eea45cSKlaus Jensen 
434288eea45cSKlaus Jensen static uint16_t nvme_create_cq(NvmeCtrl *n, NvmeRequest *req)
434388eea45cSKlaus Jensen {
434488eea45cSKlaus Jensen     NvmeCQueue *cq;
434588eea45cSKlaus Jensen     NvmeCreateCq *c = (NvmeCreateCq *)&req->cmd;
434688eea45cSKlaus Jensen     uint16_t cqid = le16_to_cpu(c->cqid);
434788eea45cSKlaus Jensen     uint16_t vector = le16_to_cpu(c->irq_vector);
434888eea45cSKlaus Jensen     uint16_t qsize = le16_to_cpu(c->qsize);
434988eea45cSKlaus Jensen     uint16_t qflags = le16_to_cpu(c->cq_flags);
435088eea45cSKlaus Jensen     uint64_t prp1 = le64_to_cpu(c->prp1);
435188eea45cSKlaus Jensen 
435288eea45cSKlaus Jensen     trace_pci_nvme_create_cq(prp1, cqid, vector, qsize, qflags,
435388eea45cSKlaus Jensen                              NVME_CQ_FLAGS_IEN(qflags) != 0);
435488eea45cSKlaus Jensen 
435588eea45cSKlaus Jensen     if (unlikely(!cqid || cqid > n->params.max_ioqpairs ||
435688eea45cSKlaus Jensen         n->cq[cqid] != NULL)) {
435788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_cqid(cqid);
435888eea45cSKlaus Jensen         return NVME_INVALID_QID | NVME_DNR;
435988eea45cSKlaus Jensen     }
436088eea45cSKlaus Jensen     if (unlikely(!qsize || qsize > NVME_CAP_MQES(n->bar.cap))) {
436188eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_size(qsize);
436288eea45cSKlaus Jensen         return NVME_MAX_QSIZE_EXCEEDED | NVME_DNR;
436388eea45cSKlaus Jensen     }
436488eea45cSKlaus Jensen     if (unlikely(prp1 & (n->page_size - 1))) {
436588eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_addr(prp1);
436688eea45cSKlaus Jensen         return NVME_INVALID_PRP_OFFSET | NVME_DNR;
436788eea45cSKlaus Jensen     }
436888eea45cSKlaus Jensen     if (unlikely(!msix_enabled(&n->parent_obj) && vector)) {
436988eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
437088eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
437188eea45cSKlaus Jensen     }
437288eea45cSKlaus Jensen     if (unlikely(vector >= n->params.msix_qsize)) {
437388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_vector(vector);
437488eea45cSKlaus Jensen         return NVME_INVALID_IRQ_VECTOR | NVME_DNR;
437588eea45cSKlaus Jensen     }
437688eea45cSKlaus Jensen     if (unlikely(!(NVME_CQ_FLAGS_PC(qflags)))) {
437788eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_create_cq_qflags(NVME_CQ_FLAGS_PC(qflags));
437888eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
437988eea45cSKlaus Jensen     }
438088eea45cSKlaus Jensen 
438188eea45cSKlaus Jensen     cq = g_malloc0(sizeof(*cq));
438288eea45cSKlaus Jensen     nvme_init_cq(cq, n, prp1, cqid, vector, qsize + 1,
438388eea45cSKlaus Jensen                  NVME_CQ_FLAGS_IEN(qflags));
438488eea45cSKlaus Jensen 
438588eea45cSKlaus Jensen     /*
438688eea45cSKlaus Jensen      * It is only required to set qs_created when creating a completion queue;
438788eea45cSKlaus Jensen      * creating a submission queue without a matching completion queue will
438888eea45cSKlaus Jensen      * fail.
438988eea45cSKlaus Jensen      */
439088eea45cSKlaus Jensen     n->qs_created = true;
439188eea45cSKlaus Jensen     return NVME_SUCCESS;
439288eea45cSKlaus Jensen }
439388eea45cSKlaus Jensen 
439488eea45cSKlaus Jensen static uint16_t nvme_rpt_empty_id_struct(NvmeCtrl *n, NvmeRequest *req)
439588eea45cSKlaus Jensen {
439688eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
439788eea45cSKlaus Jensen 
439888eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
439988eea45cSKlaus Jensen }
440088eea45cSKlaus Jensen 
440188eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl(NvmeCtrl *n, NvmeRequest *req)
440288eea45cSKlaus Jensen {
440388eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl();
440488eea45cSKlaus Jensen 
440588eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&n->id_ctrl, sizeof(n->id_ctrl), req);
440688eea45cSKlaus Jensen }
440788eea45cSKlaus Jensen 
440888eea45cSKlaus Jensen static uint16_t nvme_identify_ctrl_csi(NvmeCtrl *n, NvmeRequest *req)
440988eea45cSKlaus Jensen {
441088eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
441188eea45cSKlaus Jensen     uint8_t id[NVME_IDENTIFY_DATA_SIZE] = {};
441288eea45cSKlaus Jensen     NvmeIdCtrlNvm *id_nvm = (NvmeIdCtrlNvm *)&id;
441388eea45cSKlaus Jensen 
441488eea45cSKlaus Jensen     trace_pci_nvme_identify_ctrl_csi(c->csi);
441588eea45cSKlaus Jensen 
441688eea45cSKlaus Jensen     switch (c->csi) {
441788eea45cSKlaus Jensen     case NVME_CSI_NVM:
441888eea45cSKlaus Jensen         id_nvm->vsl = n->params.vsl;
441988eea45cSKlaus Jensen         id_nvm->dmrsl = cpu_to_le32(n->dmrsl);
442088eea45cSKlaus Jensen         break;
442188eea45cSKlaus Jensen 
442288eea45cSKlaus Jensen     case NVME_CSI_ZONED:
442388eea45cSKlaus Jensen         ((NvmeIdCtrlZoned *)&id)->zasl = n->params.zasl;
442488eea45cSKlaus Jensen         break;
442588eea45cSKlaus Jensen 
442688eea45cSKlaus Jensen     default:
442788eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
442888eea45cSKlaus Jensen     }
442988eea45cSKlaus Jensen 
443088eea45cSKlaus Jensen     return nvme_c2h(n, id, sizeof(id), req);
443188eea45cSKlaus Jensen }
443288eea45cSKlaus Jensen 
443388eea45cSKlaus Jensen static uint16_t nvme_identify_ns(NvmeCtrl *n, NvmeRequest *req, bool active)
443488eea45cSKlaus Jensen {
443588eea45cSKlaus Jensen     NvmeNamespace *ns;
443688eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
443788eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
443888eea45cSKlaus Jensen 
443988eea45cSKlaus Jensen     trace_pci_nvme_identify_ns(nsid);
444088eea45cSKlaus Jensen 
444188eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
444288eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
444388eea45cSKlaus Jensen     }
444488eea45cSKlaus Jensen 
444588eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
444688eea45cSKlaus Jensen     if (unlikely(!ns)) {
444788eea45cSKlaus Jensen         if (!active) {
444888eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
444988eea45cSKlaus Jensen             if (!ns) {
445088eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
445188eea45cSKlaus Jensen             }
445288eea45cSKlaus Jensen         } else {
445388eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
445488eea45cSKlaus Jensen         }
445588eea45cSKlaus Jensen     }
445688eea45cSKlaus Jensen 
44573553c48fSGollu Appalanaidu     if (active || ns->csi == NVME_CSI_NVM) {
445888eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)&ns->id_ns, sizeof(NvmeIdNs), req);
445988eea45cSKlaus Jensen     }
446088eea45cSKlaus Jensen 
446188eea45cSKlaus Jensen     return NVME_INVALID_CMD_SET | NVME_DNR;
446288eea45cSKlaus Jensen }
446388eea45cSKlaus Jensen 
44645f4eb94dSGollu Appalanaidu static uint16_t nvme_identify_ctrl_list(NvmeCtrl *n, NvmeRequest *req,
44655f4eb94dSGollu Appalanaidu                                         bool attached)
446688eea45cSKlaus Jensen {
446788eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
44685f4eb94dSGollu Appalanaidu     uint32_t nsid = le32_to_cpu(c->nsid);
446988eea45cSKlaus Jensen     uint16_t min_id = le16_to_cpu(c->ctrlid);
447088eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
447188eea45cSKlaus Jensen     uint16_t *ids = &list[1];
447288eea45cSKlaus Jensen     NvmeNamespace *ns;
447388eea45cSKlaus Jensen     NvmeCtrl *ctrl;
447488eea45cSKlaus Jensen     int cntlid, nr_ids = 0;
447588eea45cSKlaus Jensen 
44765f4eb94dSGollu Appalanaidu     trace_pci_nvme_identify_ctrl_list(c->cns, min_id);
447788eea45cSKlaus Jensen 
44785f4eb94dSGollu Appalanaidu     if (!n->subsys) {
447988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
448088eea45cSKlaus Jensen     }
448188eea45cSKlaus Jensen 
44825f4eb94dSGollu Appalanaidu     if (attached) {
44835f4eb94dSGollu Appalanaidu         if (nsid == NVME_NSID_BROADCAST) {
44845f4eb94dSGollu Appalanaidu             return NVME_INVALID_FIELD | NVME_DNR;
44855f4eb94dSGollu Appalanaidu         }
44865f4eb94dSGollu Appalanaidu 
44875f4eb94dSGollu Appalanaidu         ns = nvme_subsys_ns(n->subsys, nsid);
448888eea45cSKlaus Jensen         if (!ns) {
448988eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
449088eea45cSKlaus Jensen         }
44915f4eb94dSGollu Appalanaidu     }
449288eea45cSKlaus Jensen 
449388eea45cSKlaus Jensen     for (cntlid = min_id; cntlid < ARRAY_SIZE(n->subsys->ctrls); cntlid++) {
449488eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, cntlid);
449588eea45cSKlaus Jensen         if (!ctrl) {
449688eea45cSKlaus Jensen             continue;
449788eea45cSKlaus Jensen         }
449888eea45cSKlaus Jensen 
44995f4eb94dSGollu Appalanaidu         if (attached && !nvme_ns(ctrl, nsid)) {
450088eea45cSKlaus Jensen             continue;
450188eea45cSKlaus Jensen         }
450288eea45cSKlaus Jensen 
450388eea45cSKlaus Jensen         ids[nr_ids++] = cntlid;
450488eea45cSKlaus Jensen     }
450588eea45cSKlaus Jensen 
450688eea45cSKlaus Jensen     list[0] = nr_ids;
450788eea45cSKlaus Jensen 
450888eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)list, sizeof(list), req);
450988eea45cSKlaus Jensen }
451088eea45cSKlaus Jensen 
451188eea45cSKlaus Jensen static uint16_t nvme_identify_ns_csi(NvmeCtrl *n, NvmeRequest *req,
451288eea45cSKlaus Jensen                                      bool active)
451388eea45cSKlaus Jensen {
451488eea45cSKlaus Jensen     NvmeNamespace *ns;
451588eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
451688eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
451788eea45cSKlaus Jensen 
451888eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_csi(nsid, c->csi);
451988eea45cSKlaus Jensen 
452088eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
452188eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
452288eea45cSKlaus Jensen     }
452388eea45cSKlaus Jensen 
452488eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
452588eea45cSKlaus Jensen     if (unlikely(!ns)) {
452688eea45cSKlaus Jensen         if (!active) {
452788eea45cSKlaus Jensen             ns = nvme_subsys_ns(n->subsys, nsid);
452888eea45cSKlaus Jensen             if (!ns) {
452988eea45cSKlaus Jensen                 return nvme_rpt_empty_id_struct(n, req);
453088eea45cSKlaus Jensen             }
453188eea45cSKlaus Jensen         } else {
453288eea45cSKlaus Jensen             return nvme_rpt_empty_id_struct(n, req);
453388eea45cSKlaus Jensen         }
453488eea45cSKlaus Jensen     }
453588eea45cSKlaus Jensen 
45363553c48fSGollu Appalanaidu     if (c->csi == NVME_CSI_NVM) {
453788eea45cSKlaus Jensen         return nvme_rpt_empty_id_struct(n, req);
453888eea45cSKlaus Jensen     } else if (c->csi == NVME_CSI_ZONED && ns->csi == NVME_CSI_ZONED) {
453988eea45cSKlaus Jensen         return nvme_c2h(n, (uint8_t *)ns->id_ns_zoned, sizeof(NvmeIdNsZoned),
454088eea45cSKlaus Jensen                         req);
454188eea45cSKlaus Jensen     }
454288eea45cSKlaus Jensen 
454388eea45cSKlaus Jensen     return NVME_INVALID_FIELD | NVME_DNR;
454488eea45cSKlaus Jensen }
454588eea45cSKlaus Jensen 
454688eea45cSKlaus Jensen static uint16_t nvme_identify_nslist(NvmeCtrl *n, NvmeRequest *req,
454788eea45cSKlaus Jensen                                      bool active)
454888eea45cSKlaus Jensen {
454988eea45cSKlaus Jensen     NvmeNamespace *ns;
455088eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
455188eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
455288eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
455388eea45cSKlaus Jensen     static const int data_len = sizeof(list);
455488eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
455588eea45cSKlaus Jensen     int i, j = 0;
455688eea45cSKlaus Jensen 
455788eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist(min_nsid);
455888eea45cSKlaus Jensen 
455988eea45cSKlaus Jensen     /*
456088eea45cSKlaus Jensen      * Both FFFFFFFFh (NVME_NSID_BROADCAST) and FFFFFFFFEh are invalid values
456188eea45cSKlaus Jensen      * since the Active Namespace ID List should return namespaces with ids
456288eea45cSKlaus Jensen      * *higher* than the NSID specified in the command. This is also specified
456388eea45cSKlaus Jensen      * in the spec (NVM Express v1.3d, Section 5.15.4).
456488eea45cSKlaus Jensen      */
456588eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
456688eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
456788eea45cSKlaus Jensen     }
456888eea45cSKlaus Jensen 
456988eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
457088eea45cSKlaus Jensen         ns = nvme_ns(n, i);
457188eea45cSKlaus Jensen         if (!ns) {
457288eea45cSKlaus Jensen             if (!active) {
457388eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
457488eea45cSKlaus Jensen                 if (!ns) {
457588eea45cSKlaus Jensen                     continue;
457688eea45cSKlaus Jensen                 }
457788eea45cSKlaus Jensen             } else {
457888eea45cSKlaus Jensen                 continue;
457988eea45cSKlaus Jensen             }
458088eea45cSKlaus Jensen         }
458188eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid) {
458288eea45cSKlaus Jensen             continue;
458388eea45cSKlaus Jensen         }
458488eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
458588eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
458688eea45cSKlaus Jensen             break;
458788eea45cSKlaus Jensen         }
458888eea45cSKlaus Jensen     }
458988eea45cSKlaus Jensen 
459088eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
459188eea45cSKlaus Jensen }
459288eea45cSKlaus Jensen 
459388eea45cSKlaus Jensen static uint16_t nvme_identify_nslist_csi(NvmeCtrl *n, NvmeRequest *req,
459488eea45cSKlaus Jensen                                          bool active)
459588eea45cSKlaus Jensen {
459688eea45cSKlaus Jensen     NvmeNamespace *ns;
459788eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
459888eea45cSKlaus Jensen     uint32_t min_nsid = le32_to_cpu(c->nsid);
459988eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
460088eea45cSKlaus Jensen     static const int data_len = sizeof(list);
460188eea45cSKlaus Jensen     uint32_t *list_ptr = (uint32_t *)list;
460288eea45cSKlaus Jensen     int i, j = 0;
460388eea45cSKlaus Jensen 
460488eea45cSKlaus Jensen     trace_pci_nvme_identify_nslist_csi(min_nsid, c->csi);
460588eea45cSKlaus Jensen 
460688eea45cSKlaus Jensen     /*
460788eea45cSKlaus Jensen      * Same as in nvme_identify_nslist(), FFFFFFFFh/FFFFFFFFEh are invalid.
460888eea45cSKlaus Jensen      */
460988eea45cSKlaus Jensen     if (min_nsid >= NVME_NSID_BROADCAST - 1) {
461088eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
461188eea45cSKlaus Jensen     }
461288eea45cSKlaus Jensen 
461388eea45cSKlaus Jensen     if (c->csi != NVME_CSI_NVM && c->csi != NVME_CSI_ZONED) {
461488eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
461588eea45cSKlaus Jensen     }
461688eea45cSKlaus Jensen 
461788eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
461888eea45cSKlaus Jensen         ns = nvme_ns(n, i);
461988eea45cSKlaus Jensen         if (!ns) {
462088eea45cSKlaus Jensen             if (!active) {
462188eea45cSKlaus Jensen                 ns = nvme_subsys_ns(n->subsys, i);
462288eea45cSKlaus Jensen                 if (!ns) {
462388eea45cSKlaus Jensen                     continue;
462488eea45cSKlaus Jensen                 }
462588eea45cSKlaus Jensen             } else {
462688eea45cSKlaus Jensen                 continue;
462788eea45cSKlaus Jensen             }
462888eea45cSKlaus Jensen         }
462988eea45cSKlaus Jensen         if (ns->params.nsid <= min_nsid || c->csi != ns->csi) {
463088eea45cSKlaus Jensen             continue;
463188eea45cSKlaus Jensen         }
463288eea45cSKlaus Jensen         list_ptr[j++] = cpu_to_le32(ns->params.nsid);
463388eea45cSKlaus Jensen         if (j == data_len / sizeof(uint32_t)) {
463488eea45cSKlaus Jensen             break;
463588eea45cSKlaus Jensen         }
463688eea45cSKlaus Jensen     }
463788eea45cSKlaus Jensen 
463888eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
463988eea45cSKlaus Jensen }
464088eea45cSKlaus Jensen 
464188eea45cSKlaus Jensen static uint16_t nvme_identify_ns_descr_list(NvmeCtrl *n, NvmeRequest *req)
464288eea45cSKlaus Jensen {
464388eea45cSKlaus Jensen     NvmeNamespace *ns;
464488eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
464588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(c->nsid);
464688eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
46476870cfb8SHeinrich Schuchardt     uint8_t *pos = list;
464888eea45cSKlaus Jensen     struct {
464988eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
465088eea45cSKlaus Jensen         uint8_t v[NVME_NIDL_UUID];
46516870cfb8SHeinrich Schuchardt     } QEMU_PACKED uuid;
46526870cfb8SHeinrich Schuchardt     struct {
46536870cfb8SHeinrich Schuchardt         NvmeIdNsDescr hdr;
46546870cfb8SHeinrich Schuchardt         uint64_t v;
46556870cfb8SHeinrich Schuchardt     } QEMU_PACKED eui64;
465688eea45cSKlaus Jensen     struct {
465788eea45cSKlaus Jensen         NvmeIdNsDescr hdr;
465888eea45cSKlaus Jensen         uint8_t v;
46596870cfb8SHeinrich Schuchardt     } QEMU_PACKED csi;
466088eea45cSKlaus Jensen 
466188eea45cSKlaus Jensen     trace_pci_nvme_identify_ns_descr_list(nsid);
466288eea45cSKlaus Jensen 
466388eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
466488eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
466588eea45cSKlaus Jensen     }
466688eea45cSKlaus Jensen 
466788eea45cSKlaus Jensen     ns = nvme_ns(n, nsid);
466888eea45cSKlaus Jensen     if (unlikely(!ns)) {
466988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
467088eea45cSKlaus Jensen     }
467188eea45cSKlaus Jensen 
467288eea45cSKlaus Jensen     /*
46736870cfb8SHeinrich Schuchardt      * If the EUI-64 field is 0 and the NGUID field is 0, the namespace must
46746870cfb8SHeinrich Schuchardt      * provide a valid Namespace UUID in the Namespace Identification Descriptor
46756870cfb8SHeinrich Schuchardt      * data structure. QEMU does not yet support setting NGUID.
467688eea45cSKlaus Jensen      */
46776870cfb8SHeinrich Schuchardt     uuid.hdr.nidt = NVME_NIDT_UUID;
46786870cfb8SHeinrich Schuchardt     uuid.hdr.nidl = NVME_NIDL_UUID;
46796870cfb8SHeinrich Schuchardt     memcpy(uuid.v, ns->params.uuid.data, NVME_NIDL_UUID);
46806870cfb8SHeinrich Schuchardt     memcpy(pos, &uuid, sizeof(uuid));
46816870cfb8SHeinrich Schuchardt     pos += sizeof(uuid);
468288eea45cSKlaus Jensen 
46836870cfb8SHeinrich Schuchardt     if (ns->params.eui64) {
46846870cfb8SHeinrich Schuchardt         eui64.hdr.nidt = NVME_NIDT_EUI64;
46856870cfb8SHeinrich Schuchardt         eui64.hdr.nidl = NVME_NIDL_EUI64;
46866870cfb8SHeinrich Schuchardt         eui64.v = cpu_to_be64(ns->params.eui64);
46876870cfb8SHeinrich Schuchardt         memcpy(pos, &eui64, sizeof(eui64));
46886870cfb8SHeinrich Schuchardt         pos += sizeof(eui64);
46896870cfb8SHeinrich Schuchardt     }
46906870cfb8SHeinrich Schuchardt 
46916870cfb8SHeinrich Schuchardt     csi.hdr.nidt = NVME_NIDT_CSI;
46926870cfb8SHeinrich Schuchardt     csi.hdr.nidl = NVME_NIDL_CSI;
46936870cfb8SHeinrich Schuchardt     csi.v = ns->csi;
46946870cfb8SHeinrich Schuchardt     memcpy(pos, &csi, sizeof(csi));
46956870cfb8SHeinrich Schuchardt     pos += sizeof(csi);
469688eea45cSKlaus Jensen 
469788eea45cSKlaus Jensen     return nvme_c2h(n, list, sizeof(list), req);
469888eea45cSKlaus Jensen }
469988eea45cSKlaus Jensen 
470088eea45cSKlaus Jensen static uint16_t nvme_identify_cmd_set(NvmeCtrl *n, NvmeRequest *req)
470188eea45cSKlaus Jensen {
470288eea45cSKlaus Jensen     uint8_t list[NVME_IDENTIFY_DATA_SIZE] = {};
470388eea45cSKlaus Jensen     static const int data_len = sizeof(list);
470488eea45cSKlaus Jensen 
470588eea45cSKlaus Jensen     trace_pci_nvme_identify_cmd_set();
470688eea45cSKlaus Jensen 
470788eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_NVM);
470888eea45cSKlaus Jensen     NVME_SET_CSI(*list, NVME_CSI_ZONED);
470988eea45cSKlaus Jensen 
471088eea45cSKlaus Jensen     return nvme_c2h(n, list, data_len, req);
471188eea45cSKlaus Jensen }
471288eea45cSKlaus Jensen 
471388eea45cSKlaus Jensen static uint16_t nvme_identify(NvmeCtrl *n, NvmeRequest *req)
471488eea45cSKlaus Jensen {
471588eea45cSKlaus Jensen     NvmeIdentify *c = (NvmeIdentify *)&req->cmd;
471688eea45cSKlaus Jensen 
471788eea45cSKlaus Jensen     trace_pci_nvme_identify(nvme_cid(req), c->cns, le16_to_cpu(c->ctrlid),
471888eea45cSKlaus Jensen                             c->csi);
471988eea45cSKlaus Jensen 
472088eea45cSKlaus Jensen     switch (c->cns) {
472188eea45cSKlaus Jensen     case NVME_ID_CNS_NS:
472288eea45cSKlaus Jensen         return nvme_identify_ns(n, req, true);
472388eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT:
472488eea45cSKlaus Jensen         return nvme_identify_ns(n, req, false);
472588eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ATTACHED_CTRL_LIST:
47265f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, true);
47275f4eb94dSGollu Appalanaidu     case NVME_ID_CNS_CTRL_LIST:
47285f4eb94dSGollu Appalanaidu         return nvme_identify_ctrl_list(n, req, false);
472988eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS:
473088eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, true);
473188eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT:
473288eea45cSKlaus Jensen         return nvme_identify_ns_csi(n, req, false);
473388eea45cSKlaus Jensen     case NVME_ID_CNS_CTRL:
473488eea45cSKlaus Jensen         return nvme_identify_ctrl(n, req);
473588eea45cSKlaus Jensen     case NVME_ID_CNS_CS_CTRL:
473688eea45cSKlaus Jensen         return nvme_identify_ctrl_csi(n, req);
473788eea45cSKlaus Jensen     case NVME_ID_CNS_NS_ACTIVE_LIST:
473888eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, true);
473988eea45cSKlaus Jensen     case NVME_ID_CNS_NS_PRESENT_LIST:
474088eea45cSKlaus Jensen         return nvme_identify_nslist(n, req, false);
474188eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_ACTIVE_LIST:
474288eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, true);
474388eea45cSKlaus Jensen     case NVME_ID_CNS_CS_NS_PRESENT_LIST:
474488eea45cSKlaus Jensen         return nvme_identify_nslist_csi(n, req, false);
474588eea45cSKlaus Jensen     case NVME_ID_CNS_NS_DESCR_LIST:
474688eea45cSKlaus Jensen         return nvme_identify_ns_descr_list(n, req);
474788eea45cSKlaus Jensen     case NVME_ID_CNS_IO_COMMAND_SET:
474888eea45cSKlaus Jensen         return nvme_identify_cmd_set(n, req);
474988eea45cSKlaus Jensen     default:
475088eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_identify_cns(le32_to_cpu(c->cns));
475188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
475288eea45cSKlaus Jensen     }
475388eea45cSKlaus Jensen }
475488eea45cSKlaus Jensen 
475588eea45cSKlaus Jensen static uint16_t nvme_abort(NvmeCtrl *n, NvmeRequest *req)
475688eea45cSKlaus Jensen {
475788eea45cSKlaus Jensen     uint16_t sqid = le32_to_cpu(req->cmd.cdw10) & 0xffff;
475888eea45cSKlaus Jensen 
475988eea45cSKlaus Jensen     req->cqe.result = 1;
476088eea45cSKlaus Jensen     if (nvme_check_sqid(n, sqid)) {
476188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
476288eea45cSKlaus Jensen     }
476388eea45cSKlaus Jensen 
476488eea45cSKlaus Jensen     return NVME_SUCCESS;
476588eea45cSKlaus Jensen }
476688eea45cSKlaus Jensen 
476788eea45cSKlaus Jensen static inline void nvme_set_timestamp(NvmeCtrl *n, uint64_t ts)
476888eea45cSKlaus Jensen {
476988eea45cSKlaus Jensen     trace_pci_nvme_setfeat_timestamp(ts);
477088eea45cSKlaus Jensen 
477188eea45cSKlaus Jensen     n->host_timestamp = le64_to_cpu(ts);
477288eea45cSKlaus Jensen     n->timestamp_set_qemu_clock_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
477388eea45cSKlaus Jensen }
477488eea45cSKlaus Jensen 
477588eea45cSKlaus Jensen static inline uint64_t nvme_get_timestamp(const NvmeCtrl *n)
477688eea45cSKlaus Jensen {
477788eea45cSKlaus Jensen     uint64_t current_time = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
477888eea45cSKlaus Jensen     uint64_t elapsed_time = current_time - n->timestamp_set_qemu_clock_ms;
477988eea45cSKlaus Jensen 
478088eea45cSKlaus Jensen     union nvme_timestamp {
478188eea45cSKlaus Jensen         struct {
478288eea45cSKlaus Jensen             uint64_t timestamp:48;
478388eea45cSKlaus Jensen             uint64_t sync:1;
478488eea45cSKlaus Jensen             uint64_t origin:3;
478588eea45cSKlaus Jensen             uint64_t rsvd1:12;
478688eea45cSKlaus Jensen         };
478788eea45cSKlaus Jensen         uint64_t all;
478888eea45cSKlaus Jensen     };
478988eea45cSKlaus Jensen 
479088eea45cSKlaus Jensen     union nvme_timestamp ts;
479188eea45cSKlaus Jensen     ts.all = 0;
479288eea45cSKlaus Jensen     ts.timestamp = n->host_timestamp + elapsed_time;
479388eea45cSKlaus Jensen 
479488eea45cSKlaus Jensen     /* If the host timestamp is non-zero, set the timestamp origin */
479588eea45cSKlaus Jensen     ts.origin = n->host_timestamp ? 0x01 : 0x00;
479688eea45cSKlaus Jensen 
479788eea45cSKlaus Jensen     trace_pci_nvme_getfeat_timestamp(ts.all);
479888eea45cSKlaus Jensen 
479988eea45cSKlaus Jensen     return cpu_to_le64(ts.all);
480088eea45cSKlaus Jensen }
480188eea45cSKlaus Jensen 
480288eea45cSKlaus Jensen static uint16_t nvme_get_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
480388eea45cSKlaus Jensen {
480488eea45cSKlaus Jensen     uint64_t timestamp = nvme_get_timestamp(n);
480588eea45cSKlaus Jensen 
480688eea45cSKlaus Jensen     return nvme_c2h(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
480788eea45cSKlaus Jensen }
480888eea45cSKlaus Jensen 
480988eea45cSKlaus Jensen static uint16_t nvme_get_feature(NvmeCtrl *n, NvmeRequest *req)
481088eea45cSKlaus Jensen {
481188eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
481288eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
481388eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
481488eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
481588eea45cSKlaus Jensen     uint32_t result;
481688eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
481788eea45cSKlaus Jensen     NvmeGetFeatureSelect sel = NVME_GETFEAT_SELECT(dw10);
481888eea45cSKlaus Jensen     uint16_t iv;
481988eea45cSKlaus Jensen     NvmeNamespace *ns;
482088eea45cSKlaus Jensen     int i;
482188eea45cSKlaus Jensen 
482288eea45cSKlaus Jensen     static const uint32_t nvme_feature_default[NVME_FID_MAX] = {
482388eea45cSKlaus Jensen         [NVME_ARBITRATION] = NVME_ARB_AB_NOLIMIT,
482488eea45cSKlaus Jensen     };
482588eea45cSKlaus Jensen 
482688eea45cSKlaus Jensen     trace_pci_nvme_getfeat(nvme_cid(req), nsid, fid, sel, dw11);
482788eea45cSKlaus Jensen 
482888eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
482988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
483088eea45cSKlaus Jensen     }
483188eea45cSKlaus Jensen 
483288eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
483388eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid) || nsid == NVME_NSID_BROADCAST) {
483488eea45cSKlaus Jensen             /*
483588eea45cSKlaus Jensen              * The Reservation Notification Mask and Reservation Persistence
483688eea45cSKlaus Jensen              * features require a status code of Invalid Field in Command when
483788eea45cSKlaus Jensen              * NSID is FFFFFFFFh. Since the device does not support those
483888eea45cSKlaus Jensen              * features we can always return Invalid Namespace or Format as we
483988eea45cSKlaus Jensen              * should do for all other features.
484088eea45cSKlaus Jensen              */
484188eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
484288eea45cSKlaus Jensen         }
484388eea45cSKlaus Jensen 
484488eea45cSKlaus Jensen         if (!nvme_ns(n, nsid)) {
484588eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
484688eea45cSKlaus Jensen         }
484788eea45cSKlaus Jensen     }
484888eea45cSKlaus Jensen 
484988eea45cSKlaus Jensen     switch (sel) {
485088eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CURRENT:
485188eea45cSKlaus Jensen         break;
485288eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_SAVED:
485388eea45cSKlaus Jensen         /* no features are saveable by the controller; fallthrough */
485488eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_DEFAULT:
485588eea45cSKlaus Jensen         goto defaults;
485688eea45cSKlaus Jensen     case NVME_GETFEAT_SELECT_CAP:
485788eea45cSKlaus Jensen         result = nvme_feature_cap[fid];
485888eea45cSKlaus Jensen         goto out;
485988eea45cSKlaus Jensen     }
486088eea45cSKlaus Jensen 
486188eea45cSKlaus Jensen     switch (fid) {
486288eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
486388eea45cSKlaus Jensen         result = 0;
486488eea45cSKlaus Jensen 
486588eea45cSKlaus Jensen         /*
486688eea45cSKlaus Jensen          * The controller only implements the Composite Temperature sensor, so
486788eea45cSKlaus Jensen          * return 0 for all other sensors.
486888eea45cSKlaus Jensen          */
486988eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
487088eea45cSKlaus Jensen             goto out;
487188eea45cSKlaus Jensen         }
487288eea45cSKlaus Jensen 
487388eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
487488eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
487588eea45cSKlaus Jensen             result = n->features.temp_thresh_hi;
487688eea45cSKlaus Jensen             goto out;
487788eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
487888eea45cSKlaus Jensen             result = n->features.temp_thresh_low;
487988eea45cSKlaus Jensen             goto out;
488088eea45cSKlaus Jensen         }
488188eea45cSKlaus Jensen 
488288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
488388eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
488488eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
488588eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
488688eea45cSKlaus Jensen         }
488788eea45cSKlaus Jensen 
488888eea45cSKlaus Jensen         ns = nvme_ns(n, nsid);
488988eea45cSKlaus Jensen         if (unlikely(!ns)) {
489088eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
489188eea45cSKlaus Jensen         }
489288eea45cSKlaus Jensen 
489388eea45cSKlaus Jensen         result = ns->features.err_rec;
489488eea45cSKlaus Jensen         goto out;
489588eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
489688eea45cSKlaus Jensen         result = 0;
489788eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
489888eea45cSKlaus Jensen             ns = nvme_ns(n, i);
489988eea45cSKlaus Jensen             if (!ns) {
490088eea45cSKlaus Jensen                 continue;
490188eea45cSKlaus Jensen             }
490288eea45cSKlaus Jensen 
490388eea45cSKlaus Jensen             result = blk_enable_write_cache(ns->blkconf.blk);
490488eea45cSKlaus Jensen             if (result) {
490588eea45cSKlaus Jensen                 break;
490688eea45cSKlaus Jensen             }
490788eea45cSKlaus Jensen         }
490888eea45cSKlaus Jensen         trace_pci_nvme_getfeat_vwcache(result ? "enabled" : "disabled");
490988eea45cSKlaus Jensen         goto out;
491088eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
491188eea45cSKlaus Jensen         result = n->features.async_config;
491288eea45cSKlaus Jensen         goto out;
491388eea45cSKlaus Jensen     case NVME_TIMESTAMP:
491488eea45cSKlaus Jensen         return nvme_get_feature_timestamp(n, req);
491588eea45cSKlaus Jensen     default:
491688eea45cSKlaus Jensen         break;
491788eea45cSKlaus Jensen     }
491888eea45cSKlaus Jensen 
491988eea45cSKlaus Jensen defaults:
492088eea45cSKlaus Jensen     switch (fid) {
492188eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
492288eea45cSKlaus Jensen         result = 0;
492388eea45cSKlaus Jensen 
492488eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
492588eea45cSKlaus Jensen             break;
492688eea45cSKlaus Jensen         }
492788eea45cSKlaus Jensen 
492888eea45cSKlaus Jensen         if (NVME_TEMP_THSEL(dw11) == NVME_TEMP_THSEL_OVER) {
492988eea45cSKlaus Jensen             result = NVME_TEMPERATURE_WARNING;
493088eea45cSKlaus Jensen         }
493188eea45cSKlaus Jensen 
493288eea45cSKlaus Jensen         break;
493388eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
493488eea45cSKlaus Jensen         result = (n->params.max_ioqpairs - 1) |
493588eea45cSKlaus Jensen             ((n->params.max_ioqpairs - 1) << 16);
493688eea45cSKlaus Jensen         trace_pci_nvme_getfeat_numq(result);
493788eea45cSKlaus Jensen         break;
493888eea45cSKlaus Jensen     case NVME_INTERRUPT_VECTOR_CONF:
493988eea45cSKlaus Jensen         iv = dw11 & 0xffff;
494088eea45cSKlaus Jensen         if (iv >= n->params.max_ioqpairs + 1) {
494188eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
494288eea45cSKlaus Jensen         }
494388eea45cSKlaus Jensen 
494488eea45cSKlaus Jensen         result = iv;
494588eea45cSKlaus Jensen         if (iv == n->admin_cq.vector) {
494688eea45cSKlaus Jensen             result |= NVME_INTVC_NOCOALESCING;
494788eea45cSKlaus Jensen         }
494888eea45cSKlaus Jensen         break;
494988eea45cSKlaus Jensen     default:
495088eea45cSKlaus Jensen         result = nvme_feature_default[fid];
495188eea45cSKlaus Jensen         break;
495288eea45cSKlaus Jensen     }
495388eea45cSKlaus Jensen 
495488eea45cSKlaus Jensen out:
495588eea45cSKlaus Jensen     req->cqe.result = cpu_to_le32(result);
495688eea45cSKlaus Jensen     return NVME_SUCCESS;
495788eea45cSKlaus Jensen }
495888eea45cSKlaus Jensen 
495988eea45cSKlaus Jensen static uint16_t nvme_set_feature_timestamp(NvmeCtrl *n, NvmeRequest *req)
496088eea45cSKlaus Jensen {
496188eea45cSKlaus Jensen     uint16_t ret;
496288eea45cSKlaus Jensen     uint64_t timestamp;
496388eea45cSKlaus Jensen 
496488eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)&timestamp, sizeof(timestamp), req);
496588eea45cSKlaus Jensen     if (ret) {
496688eea45cSKlaus Jensen         return ret;
496788eea45cSKlaus Jensen     }
496888eea45cSKlaus Jensen 
496988eea45cSKlaus Jensen     nvme_set_timestamp(n, timestamp);
497088eea45cSKlaus Jensen 
497188eea45cSKlaus Jensen     return NVME_SUCCESS;
497288eea45cSKlaus Jensen }
497388eea45cSKlaus Jensen 
497488eea45cSKlaus Jensen static uint16_t nvme_set_feature(NvmeCtrl *n, NvmeRequest *req)
497588eea45cSKlaus Jensen {
497688eea45cSKlaus Jensen     NvmeNamespace *ns = NULL;
497788eea45cSKlaus Jensen 
497888eea45cSKlaus Jensen     NvmeCmd *cmd = &req->cmd;
497988eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
498088eea45cSKlaus Jensen     uint32_t dw11 = le32_to_cpu(cmd->cdw11);
498188eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(cmd->nsid);
498288eea45cSKlaus Jensen     uint8_t fid = NVME_GETSETFEAT_FID(dw10);
498388eea45cSKlaus Jensen     uint8_t save = NVME_SETFEAT_SAVE(dw10);
498488eea45cSKlaus Jensen     int i;
498588eea45cSKlaus Jensen 
498688eea45cSKlaus Jensen     trace_pci_nvme_setfeat(nvme_cid(req), nsid, fid, save, dw11);
498788eea45cSKlaus Jensen 
498888eea45cSKlaus Jensen     if (save && !(nvme_feature_cap[fid] & NVME_FEAT_CAP_SAVE)) {
498988eea45cSKlaus Jensen         return NVME_FID_NOT_SAVEABLE | NVME_DNR;
499088eea45cSKlaus Jensen     }
499188eea45cSKlaus Jensen 
499288eea45cSKlaus Jensen     if (!nvme_feature_support[fid]) {
499388eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
499488eea45cSKlaus Jensen     }
499588eea45cSKlaus Jensen 
499688eea45cSKlaus Jensen     if (nvme_feature_cap[fid] & NVME_FEAT_CAP_NS) {
499788eea45cSKlaus Jensen         if (nsid != NVME_NSID_BROADCAST) {
499888eea45cSKlaus Jensen             if (!nvme_nsid_valid(n, nsid)) {
499988eea45cSKlaus Jensen                 return NVME_INVALID_NSID | NVME_DNR;
500088eea45cSKlaus Jensen             }
500188eea45cSKlaus Jensen 
500288eea45cSKlaus Jensen             ns = nvme_ns(n, nsid);
500388eea45cSKlaus Jensen             if (unlikely(!ns)) {
500488eea45cSKlaus Jensen                 return NVME_INVALID_FIELD | NVME_DNR;
500588eea45cSKlaus Jensen             }
500688eea45cSKlaus Jensen         }
500788eea45cSKlaus Jensen     } else if (nsid && nsid != NVME_NSID_BROADCAST) {
500888eea45cSKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
500988eea45cSKlaus Jensen             return NVME_INVALID_NSID | NVME_DNR;
501088eea45cSKlaus Jensen         }
501188eea45cSKlaus Jensen 
501288eea45cSKlaus Jensen         return NVME_FEAT_NOT_NS_SPEC | NVME_DNR;
501388eea45cSKlaus Jensen     }
501488eea45cSKlaus Jensen 
501588eea45cSKlaus Jensen     if (!(nvme_feature_cap[fid] & NVME_FEAT_CAP_CHANGE)) {
501688eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
501788eea45cSKlaus Jensen     }
501888eea45cSKlaus Jensen 
501988eea45cSKlaus Jensen     switch (fid) {
502088eea45cSKlaus Jensen     case NVME_TEMPERATURE_THRESHOLD:
502188eea45cSKlaus Jensen         if (NVME_TEMP_TMPSEL(dw11) != NVME_TEMP_TMPSEL_COMPOSITE) {
502288eea45cSKlaus Jensen             break;
502388eea45cSKlaus Jensen         }
502488eea45cSKlaus Jensen 
502588eea45cSKlaus Jensen         switch (NVME_TEMP_THSEL(dw11)) {
502688eea45cSKlaus Jensen         case NVME_TEMP_THSEL_OVER:
502788eea45cSKlaus Jensen             n->features.temp_thresh_hi = NVME_TEMP_TMPTH(dw11);
502888eea45cSKlaus Jensen             break;
502988eea45cSKlaus Jensen         case NVME_TEMP_THSEL_UNDER:
503088eea45cSKlaus Jensen             n->features.temp_thresh_low = NVME_TEMP_TMPTH(dw11);
503188eea45cSKlaus Jensen             break;
503288eea45cSKlaus Jensen         default:
503388eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
503488eea45cSKlaus Jensen         }
503588eea45cSKlaus Jensen 
503688eea45cSKlaus Jensen         if ((n->temperature >= n->features.temp_thresh_hi) ||
503788eea45cSKlaus Jensen             (n->temperature <= n->features.temp_thresh_low)) {
503888eea45cSKlaus Jensen             nvme_smart_event(n, NVME_AER_INFO_SMART_TEMP_THRESH);
503988eea45cSKlaus Jensen         }
504088eea45cSKlaus Jensen 
504188eea45cSKlaus Jensen         break;
504288eea45cSKlaus Jensen     case NVME_ERROR_RECOVERY:
504388eea45cSKlaus Jensen         if (nsid == NVME_NSID_BROADCAST) {
504488eea45cSKlaus Jensen             for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
504588eea45cSKlaus Jensen                 ns = nvme_ns(n, i);
504688eea45cSKlaus Jensen 
504788eea45cSKlaus Jensen                 if (!ns) {
504888eea45cSKlaus Jensen                     continue;
504988eea45cSKlaus Jensen                 }
505088eea45cSKlaus Jensen 
505188eea45cSKlaus Jensen                 if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat)) {
505288eea45cSKlaus Jensen                     ns->features.err_rec = dw11;
505388eea45cSKlaus Jensen                 }
505488eea45cSKlaus Jensen             }
505588eea45cSKlaus Jensen 
505688eea45cSKlaus Jensen             break;
505788eea45cSKlaus Jensen         }
505888eea45cSKlaus Jensen 
505988eea45cSKlaus Jensen         assert(ns);
506088eea45cSKlaus Jensen         if (NVME_ID_NS_NSFEAT_DULBE(ns->id_ns.nsfeat))  {
506188eea45cSKlaus Jensen             ns->features.err_rec = dw11;
506288eea45cSKlaus Jensen         }
506388eea45cSKlaus Jensen         break;
506488eea45cSKlaus Jensen     case NVME_VOLATILE_WRITE_CACHE:
506588eea45cSKlaus Jensen         for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
506688eea45cSKlaus Jensen             ns = nvme_ns(n, i);
506788eea45cSKlaus Jensen             if (!ns) {
506888eea45cSKlaus Jensen                 continue;
506988eea45cSKlaus Jensen             }
507088eea45cSKlaus Jensen 
507188eea45cSKlaus Jensen             if (!(dw11 & 0x1) && blk_enable_write_cache(ns->blkconf.blk)) {
507288eea45cSKlaus Jensen                 blk_flush(ns->blkconf.blk);
507388eea45cSKlaus Jensen             }
507488eea45cSKlaus Jensen 
507588eea45cSKlaus Jensen             blk_set_enable_write_cache(ns->blkconf.blk, dw11 & 1);
507688eea45cSKlaus Jensen         }
507788eea45cSKlaus Jensen 
507888eea45cSKlaus Jensen         break;
507988eea45cSKlaus Jensen 
508088eea45cSKlaus Jensen     case NVME_NUMBER_OF_QUEUES:
508188eea45cSKlaus Jensen         if (n->qs_created) {
508288eea45cSKlaus Jensen             return NVME_CMD_SEQ_ERROR | NVME_DNR;
508388eea45cSKlaus Jensen         }
508488eea45cSKlaus Jensen 
508588eea45cSKlaus Jensen         /*
508688eea45cSKlaus Jensen          * NVMe v1.3, Section 5.21.1.7: FFFFh is not an allowed value for NCQR
508788eea45cSKlaus Jensen          * and NSQR.
508888eea45cSKlaus Jensen          */
508988eea45cSKlaus Jensen         if ((dw11 & 0xffff) == 0xffff || ((dw11 >> 16) & 0xffff) == 0xffff) {
509088eea45cSKlaus Jensen             return NVME_INVALID_FIELD | NVME_DNR;
509188eea45cSKlaus Jensen         }
509288eea45cSKlaus Jensen 
509388eea45cSKlaus Jensen         trace_pci_nvme_setfeat_numq((dw11 & 0xffff) + 1,
509488eea45cSKlaus Jensen                                     ((dw11 >> 16) & 0xffff) + 1,
509588eea45cSKlaus Jensen                                     n->params.max_ioqpairs,
509688eea45cSKlaus Jensen                                     n->params.max_ioqpairs);
509788eea45cSKlaus Jensen         req->cqe.result = cpu_to_le32((n->params.max_ioqpairs - 1) |
509888eea45cSKlaus Jensen                                       ((n->params.max_ioqpairs - 1) << 16));
509988eea45cSKlaus Jensen         break;
510088eea45cSKlaus Jensen     case NVME_ASYNCHRONOUS_EVENT_CONF:
510188eea45cSKlaus Jensen         n->features.async_config = dw11;
510288eea45cSKlaus Jensen         break;
510388eea45cSKlaus Jensen     case NVME_TIMESTAMP:
510488eea45cSKlaus Jensen         return nvme_set_feature_timestamp(n, req);
510588eea45cSKlaus Jensen     case NVME_COMMAND_SET_PROFILE:
510688eea45cSKlaus Jensen         if (dw11 & 0x1ff) {
510788eea45cSKlaus Jensen             trace_pci_nvme_err_invalid_iocsci(dw11 & 0x1ff);
510888eea45cSKlaus Jensen             return NVME_CMD_SET_CMB_REJECTED | NVME_DNR;
510988eea45cSKlaus Jensen         }
511088eea45cSKlaus Jensen         break;
511188eea45cSKlaus Jensen     default:
511288eea45cSKlaus Jensen         return NVME_FEAT_NOT_CHANGEABLE | NVME_DNR;
511388eea45cSKlaus Jensen     }
511488eea45cSKlaus Jensen     return NVME_SUCCESS;
511588eea45cSKlaus Jensen }
511688eea45cSKlaus Jensen 
511788eea45cSKlaus Jensen static uint16_t nvme_aer(NvmeCtrl *n, NvmeRequest *req)
511888eea45cSKlaus Jensen {
511988eea45cSKlaus Jensen     trace_pci_nvme_aer(nvme_cid(req));
512088eea45cSKlaus Jensen 
512188eea45cSKlaus Jensen     if (n->outstanding_aers > n->params.aerl) {
512288eea45cSKlaus Jensen         trace_pci_nvme_aer_aerl_exceeded();
512388eea45cSKlaus Jensen         return NVME_AER_LIMIT_EXCEEDED;
512488eea45cSKlaus Jensen     }
512588eea45cSKlaus Jensen 
512688eea45cSKlaus Jensen     n->aer_reqs[n->outstanding_aers] = req;
512788eea45cSKlaus Jensen     n->outstanding_aers++;
512888eea45cSKlaus Jensen 
512988eea45cSKlaus Jensen     if (!QTAILQ_EMPTY(&n->aer_queue)) {
513088eea45cSKlaus Jensen         nvme_process_aers(n);
513188eea45cSKlaus Jensen     }
513288eea45cSKlaus Jensen 
513388eea45cSKlaus Jensen     return NVME_NO_COMPLETE;
513488eea45cSKlaus Jensen }
513588eea45cSKlaus Jensen 
513688eea45cSKlaus Jensen static void nvme_update_dmrsl(NvmeCtrl *n)
513788eea45cSKlaus Jensen {
513888eea45cSKlaus Jensen     int nsid;
513988eea45cSKlaus Jensen 
514088eea45cSKlaus Jensen     for (nsid = 1; nsid <= NVME_MAX_NAMESPACES; nsid++) {
514188eea45cSKlaus Jensen         NvmeNamespace *ns = nvme_ns(n, nsid);
514288eea45cSKlaus Jensen         if (!ns) {
514388eea45cSKlaus Jensen             continue;
514488eea45cSKlaus Jensen         }
514588eea45cSKlaus Jensen 
514688eea45cSKlaus Jensen         n->dmrsl = MIN_NON_ZERO(n->dmrsl,
514788eea45cSKlaus Jensen                                 BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
514888eea45cSKlaus Jensen     }
514988eea45cSKlaus Jensen }
515088eea45cSKlaus Jensen 
515188eea45cSKlaus Jensen static void nvme_select_iocs_ns(NvmeCtrl *n, NvmeNamespace *ns)
515288eea45cSKlaus Jensen {
515388eea45cSKlaus Jensen     ns->iocs = nvme_cse_iocs_none;
515488eea45cSKlaus Jensen     switch (ns->csi) {
515588eea45cSKlaus Jensen     case NVME_CSI_NVM:
515688eea45cSKlaus Jensen         if (NVME_CC_CSS(n->bar.cc) != NVME_CC_CSS_ADMIN_ONLY) {
515788eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
515888eea45cSKlaus Jensen         }
515988eea45cSKlaus Jensen         break;
516088eea45cSKlaus Jensen     case NVME_CSI_ZONED:
516188eea45cSKlaus Jensen         if (NVME_CC_CSS(n->bar.cc) == NVME_CC_CSS_CSI) {
516288eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_zoned;
516388eea45cSKlaus Jensen         } else if (NVME_CC_CSS(n->bar.cc) == NVME_CC_CSS_NVM) {
516488eea45cSKlaus Jensen             ns->iocs = nvme_cse_iocs_nvm;
516588eea45cSKlaus Jensen         }
516688eea45cSKlaus Jensen         break;
516788eea45cSKlaus Jensen     }
516888eea45cSKlaus Jensen }
516988eea45cSKlaus Jensen 
517088eea45cSKlaus Jensen static uint16_t nvme_ns_attachment(NvmeCtrl *n, NvmeRequest *req)
517188eea45cSKlaus Jensen {
517288eea45cSKlaus Jensen     NvmeNamespace *ns;
517388eea45cSKlaus Jensen     NvmeCtrl *ctrl;
517488eea45cSKlaus Jensen     uint16_t list[NVME_CONTROLLER_LIST_SIZE] = {};
517588eea45cSKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
517688eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
517788eea45cSKlaus Jensen     bool attach = !(dw10 & 0xf);
517888eea45cSKlaus Jensen     uint16_t *nr_ids = &list[0];
517988eea45cSKlaus Jensen     uint16_t *ids = &list[1];
518088eea45cSKlaus Jensen     uint16_t ret;
518188eea45cSKlaus Jensen     int i;
518288eea45cSKlaus Jensen 
518388eea45cSKlaus Jensen     trace_pci_nvme_ns_attachment(nvme_cid(req), dw10 & 0xf);
518488eea45cSKlaus Jensen 
518588eea45cSKlaus Jensen     if (!nvme_nsid_valid(n, nsid)) {
518688eea45cSKlaus Jensen         return NVME_INVALID_NSID | NVME_DNR;
518788eea45cSKlaus Jensen     }
518888eea45cSKlaus Jensen 
518988eea45cSKlaus Jensen     ns = nvme_subsys_ns(n->subsys, nsid);
519088eea45cSKlaus Jensen     if (!ns) {
519188eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
519288eea45cSKlaus Jensen     }
519388eea45cSKlaus Jensen 
519488eea45cSKlaus Jensen     ret = nvme_h2c(n, (uint8_t *)list, 4096, req);
519588eea45cSKlaus Jensen     if (ret) {
519688eea45cSKlaus Jensen         return ret;
519788eea45cSKlaus Jensen     }
519888eea45cSKlaus Jensen 
519988eea45cSKlaus Jensen     if (!*nr_ids) {
520088eea45cSKlaus Jensen         return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
520188eea45cSKlaus Jensen     }
520288eea45cSKlaus Jensen 
520388eea45cSKlaus Jensen     *nr_ids = MIN(*nr_ids, NVME_CONTROLLER_LIST_SIZE - 1);
520488eea45cSKlaus Jensen     for (i = 0; i < *nr_ids; i++) {
520588eea45cSKlaus Jensen         ctrl = nvme_subsys_ctrl(n->subsys, ids[i]);
520688eea45cSKlaus Jensen         if (!ctrl) {
520788eea45cSKlaus Jensen             return NVME_NS_CTRL_LIST_INVALID | NVME_DNR;
520888eea45cSKlaus Jensen         }
520988eea45cSKlaus Jensen 
521088eea45cSKlaus Jensen         if (attach) {
521188eea45cSKlaus Jensen             if (nvme_ns(ctrl, nsid)) {
521288eea45cSKlaus Jensen                 return NVME_NS_ALREADY_ATTACHED | NVME_DNR;
521388eea45cSKlaus Jensen             }
521488eea45cSKlaus Jensen 
521588eea45cSKlaus Jensen             if (ns->attached && !ns->params.shared) {
521688eea45cSKlaus Jensen                 return NVME_NS_PRIVATE | NVME_DNR;
521788eea45cSKlaus Jensen             }
521888eea45cSKlaus Jensen 
521988eea45cSKlaus Jensen             nvme_attach_ns(ctrl, ns);
522088eea45cSKlaus Jensen             nvme_select_iocs_ns(ctrl, ns);
522188eea45cSKlaus Jensen         } else {
522288eea45cSKlaus Jensen             if (!nvme_ns(ctrl, nsid)) {
522388eea45cSKlaus Jensen                 return NVME_NS_NOT_ATTACHED | NVME_DNR;
522488eea45cSKlaus Jensen             }
522588eea45cSKlaus Jensen 
522688eea45cSKlaus Jensen             ctrl->namespaces[nsid] = NULL;
522788eea45cSKlaus Jensen             ns->attached--;
522888eea45cSKlaus Jensen 
522988eea45cSKlaus Jensen             nvme_update_dmrsl(ctrl);
523088eea45cSKlaus Jensen         }
523188eea45cSKlaus Jensen 
523288eea45cSKlaus Jensen         /*
523388eea45cSKlaus Jensen          * Add namespace id to the changed namespace id list for event clearing
523488eea45cSKlaus Jensen          * via Get Log Page command.
523588eea45cSKlaus Jensen          */
523688eea45cSKlaus Jensen         if (!test_and_set_bit(nsid, ctrl->changed_nsids)) {
523788eea45cSKlaus Jensen             nvme_enqueue_event(ctrl, NVME_AER_TYPE_NOTICE,
523888eea45cSKlaus Jensen                                NVME_AER_INFO_NOTICE_NS_ATTR_CHANGED,
523988eea45cSKlaus Jensen                                NVME_LOG_CHANGED_NSLIST);
524088eea45cSKlaus Jensen         }
524188eea45cSKlaus Jensen     }
524288eea45cSKlaus Jensen 
524388eea45cSKlaus Jensen     return NVME_SUCCESS;
524488eea45cSKlaus Jensen }
524588eea45cSKlaus Jensen 
52463bcf26d3SKlaus Jensen typedef struct NvmeFormatAIOCB {
52473bcf26d3SKlaus Jensen     BlockAIOCB common;
52483bcf26d3SKlaus Jensen     BlockAIOCB *aiocb;
52493bcf26d3SKlaus Jensen     QEMUBH *bh;
52503bcf26d3SKlaus Jensen     NvmeRequest *req;
52513bcf26d3SKlaus Jensen     int ret;
525288eea45cSKlaus Jensen 
52533bcf26d3SKlaus Jensen     NvmeNamespace *ns;
52543bcf26d3SKlaus Jensen     uint32_t nsid;
52553bcf26d3SKlaus Jensen     bool broadcast;
52563bcf26d3SKlaus Jensen     int64_t offset;
52573bcf26d3SKlaus Jensen } NvmeFormatAIOCB;
52583bcf26d3SKlaus Jensen 
52593bcf26d3SKlaus Jensen static void nvme_format_bh(void *opaque);
52603bcf26d3SKlaus Jensen 
52613bcf26d3SKlaus Jensen static void nvme_format_cancel(BlockAIOCB *aiocb)
52623bcf26d3SKlaus Jensen {
52633bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = container_of(aiocb, NvmeFormatAIOCB, common);
52643bcf26d3SKlaus Jensen 
52653bcf26d3SKlaus Jensen     if (iocb->aiocb) {
52663bcf26d3SKlaus Jensen         blk_aio_cancel_async(iocb->aiocb);
52673bcf26d3SKlaus Jensen     }
52683bcf26d3SKlaus Jensen }
52693bcf26d3SKlaus Jensen 
52703bcf26d3SKlaus Jensen static const AIOCBInfo nvme_format_aiocb_info = {
52713bcf26d3SKlaus Jensen     .aiocb_size = sizeof(NvmeFormatAIOCB),
52723bcf26d3SKlaus Jensen     .cancel_async = nvme_format_cancel,
52733bcf26d3SKlaus Jensen     .get_aio_context = nvme_get_aio_context,
52743bcf26d3SKlaus Jensen };
52753bcf26d3SKlaus Jensen 
52763bcf26d3SKlaus Jensen static void nvme_format_set(NvmeNamespace *ns, NvmeCmd *cmd)
52773bcf26d3SKlaus Jensen {
52783bcf26d3SKlaus Jensen     uint32_t dw10 = le32_to_cpu(cmd->cdw10);
52793bcf26d3SKlaus Jensen     uint8_t lbaf = dw10 & 0xf;
52803bcf26d3SKlaus Jensen     uint8_t pi = (dw10 >> 5) & 0x7;
52813bcf26d3SKlaus Jensen     uint8_t mset = (dw10 >> 4) & 0x1;
52823bcf26d3SKlaus Jensen     uint8_t pil = (dw10 >> 8) & 0x1;
52833bcf26d3SKlaus Jensen 
52843bcf26d3SKlaus Jensen     trace_pci_nvme_format_set(ns->params.nsid, lbaf, mset, pi, pil);
52853bcf26d3SKlaus Jensen 
52863bcf26d3SKlaus Jensen     ns->id_ns.dps = (pil << 3) | pi;
52873bcf26d3SKlaus Jensen     ns->id_ns.flbas = lbaf | (mset << 4);
52883bcf26d3SKlaus Jensen 
52893bcf26d3SKlaus Jensen     nvme_ns_init_format(ns);
52903bcf26d3SKlaus Jensen }
52913bcf26d3SKlaus Jensen 
52923bcf26d3SKlaus Jensen static void nvme_format_ns_cb(void *opaque, int ret)
52933bcf26d3SKlaus Jensen {
52943bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = opaque;
52953bcf26d3SKlaus Jensen     NvmeRequest *req = iocb->req;
52963bcf26d3SKlaus Jensen     NvmeNamespace *ns = iocb->ns;
52973bcf26d3SKlaus Jensen     int bytes;
52983bcf26d3SKlaus Jensen 
52993bcf26d3SKlaus Jensen     if (ret < 0) {
53003bcf26d3SKlaus Jensen         iocb->ret = ret;
53013bcf26d3SKlaus Jensen         goto done;
53023bcf26d3SKlaus Jensen     }
53033bcf26d3SKlaus Jensen 
53043bcf26d3SKlaus Jensen     assert(ns);
53053bcf26d3SKlaus Jensen 
53063bcf26d3SKlaus Jensen     if (iocb->offset < ns->size) {
53073bcf26d3SKlaus Jensen         bytes = MIN(BDRV_REQUEST_MAX_BYTES, ns->size - iocb->offset);
53083bcf26d3SKlaus Jensen 
53093bcf26d3SKlaus Jensen         iocb->aiocb = blk_aio_pwrite_zeroes(ns->blkconf.blk, iocb->offset,
53103bcf26d3SKlaus Jensen                                             bytes, BDRV_REQ_MAY_UNMAP,
53113bcf26d3SKlaus Jensen                                             nvme_format_ns_cb, iocb);
53123bcf26d3SKlaus Jensen 
53133bcf26d3SKlaus Jensen         iocb->offset += bytes;
53143bcf26d3SKlaus Jensen         return;
53153bcf26d3SKlaus Jensen     }
53163bcf26d3SKlaus Jensen 
53173bcf26d3SKlaus Jensen     nvme_format_set(ns, &req->cmd);
53183bcf26d3SKlaus Jensen     ns->status = 0x0;
53193bcf26d3SKlaus Jensen     iocb->ns = NULL;
53203bcf26d3SKlaus Jensen     iocb->offset = 0;
53213bcf26d3SKlaus Jensen 
53223bcf26d3SKlaus Jensen done:
53233bcf26d3SKlaus Jensen     iocb->aiocb = NULL;
53243bcf26d3SKlaus Jensen     qemu_bh_schedule(iocb->bh);
53253bcf26d3SKlaus Jensen }
53263bcf26d3SKlaus Jensen 
53273bcf26d3SKlaus Jensen static uint16_t nvme_format_check(NvmeNamespace *ns, uint8_t lbaf, uint8_t pi)
53283bcf26d3SKlaus Jensen {
532988eea45cSKlaus Jensen     if (ns->params.zoned) {
533088eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
533188eea45cSKlaus Jensen     }
533288eea45cSKlaus Jensen 
533388eea45cSKlaus Jensen     if (lbaf > ns->id_ns.nlbaf) {
533488eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
533588eea45cSKlaus Jensen     }
533688eea45cSKlaus Jensen 
53373bcf26d3SKlaus Jensen     if (pi && (ns->id_ns.lbaf[lbaf].ms < sizeof(NvmeDifTuple))) {
533888eea45cSKlaus Jensen         return NVME_INVALID_FORMAT | NVME_DNR;
533988eea45cSKlaus Jensen     }
534088eea45cSKlaus Jensen 
534188eea45cSKlaus Jensen     if (pi && pi > NVME_ID_NS_DPS_TYPE_3) {
534288eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
534388eea45cSKlaus Jensen     }
534488eea45cSKlaus Jensen 
534588eea45cSKlaus Jensen     return NVME_SUCCESS;
534688eea45cSKlaus Jensen }
534788eea45cSKlaus Jensen 
53483bcf26d3SKlaus Jensen static void nvme_format_bh(void *opaque)
534988eea45cSKlaus Jensen {
53503bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb = opaque;
53513bcf26d3SKlaus Jensen     NvmeRequest *req = iocb->req;
53523bcf26d3SKlaus Jensen     NvmeCtrl *n = nvme_ctrl(req);
535388eea45cSKlaus Jensen     uint32_t dw10 = le32_to_cpu(req->cmd.cdw10);
535488eea45cSKlaus Jensen     uint8_t lbaf = dw10 & 0xf;
535588eea45cSKlaus Jensen     uint8_t pi = (dw10 >> 5) & 0x7;
535688eea45cSKlaus Jensen     uint16_t status;
535788eea45cSKlaus Jensen     int i;
535888eea45cSKlaus Jensen 
53593bcf26d3SKlaus Jensen     if (iocb->ret < 0) {
53603bcf26d3SKlaus Jensen         goto done;
536188eea45cSKlaus Jensen     }
536288eea45cSKlaus Jensen 
53633bcf26d3SKlaus Jensen     if (iocb->broadcast) {
53643bcf26d3SKlaus Jensen         for (i = iocb->nsid + 1; i <= NVME_MAX_NAMESPACES; i++) {
53653bcf26d3SKlaus Jensen             iocb->ns = nvme_ns(n, i);
53663bcf26d3SKlaus Jensen             if (iocb->ns) {
53673bcf26d3SKlaus Jensen                 iocb->nsid = i;
536888eea45cSKlaus Jensen                 break;
536988eea45cSKlaus Jensen             }
537088eea45cSKlaus Jensen         }
537188eea45cSKlaus Jensen     }
537288eea45cSKlaus Jensen 
53733bcf26d3SKlaus Jensen     if (!iocb->ns) {
53743bcf26d3SKlaus Jensen         goto done;
537588eea45cSKlaus Jensen     }
537688eea45cSKlaus Jensen 
53773bcf26d3SKlaus Jensen     status = nvme_format_check(iocb->ns, lbaf, pi);
53783bcf26d3SKlaus Jensen     if (status) {
53793bcf26d3SKlaus Jensen         req->status = status;
53803bcf26d3SKlaus Jensen         goto done;
53813bcf26d3SKlaus Jensen     }
53823bcf26d3SKlaus Jensen 
53833bcf26d3SKlaus Jensen     iocb->ns->status = NVME_FORMAT_IN_PROGRESS;
53843bcf26d3SKlaus Jensen     nvme_format_ns_cb(iocb, 0);
53853bcf26d3SKlaus Jensen     return;
53863bcf26d3SKlaus Jensen 
53873bcf26d3SKlaus Jensen done:
53883bcf26d3SKlaus Jensen     qemu_bh_delete(iocb->bh);
53893bcf26d3SKlaus Jensen     iocb->bh = NULL;
53903bcf26d3SKlaus Jensen 
53913bcf26d3SKlaus Jensen     iocb->common.cb(iocb->common.opaque, iocb->ret);
53923bcf26d3SKlaus Jensen 
53933bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
53943bcf26d3SKlaus Jensen }
53953bcf26d3SKlaus Jensen 
53963bcf26d3SKlaus Jensen static uint16_t nvme_format(NvmeCtrl *n, NvmeRequest *req)
53973bcf26d3SKlaus Jensen {
53983bcf26d3SKlaus Jensen     NvmeFormatAIOCB *iocb;
53993bcf26d3SKlaus Jensen     uint32_t nsid = le32_to_cpu(req->cmd.nsid);
54003bcf26d3SKlaus Jensen     uint16_t status;
54013bcf26d3SKlaus Jensen 
54023bcf26d3SKlaus Jensen     iocb = qemu_aio_get(&nvme_format_aiocb_info, NULL, nvme_misc_cb, req);
54033bcf26d3SKlaus Jensen 
54043bcf26d3SKlaus Jensen     iocb->req = req;
54053bcf26d3SKlaus Jensen     iocb->bh = qemu_bh_new(nvme_format_bh, iocb);
54063bcf26d3SKlaus Jensen     iocb->ret = 0;
54073bcf26d3SKlaus Jensen     iocb->ns = NULL;
54083bcf26d3SKlaus Jensen     iocb->nsid = 0;
54093bcf26d3SKlaus Jensen     iocb->broadcast = (nsid == NVME_NSID_BROADCAST);
54103bcf26d3SKlaus Jensen     iocb->offset = 0;
54113bcf26d3SKlaus Jensen 
54123bcf26d3SKlaus Jensen     if (!iocb->broadcast) {
54133bcf26d3SKlaus Jensen         if (!nvme_nsid_valid(n, nsid)) {
54143bcf26d3SKlaus Jensen             status = NVME_INVALID_NSID | NVME_DNR;
54153bcf26d3SKlaus Jensen             goto out;
54163bcf26d3SKlaus Jensen         }
54173bcf26d3SKlaus Jensen 
54183bcf26d3SKlaus Jensen         iocb->ns = nvme_ns(n, nsid);
54193bcf26d3SKlaus Jensen         if (!iocb->ns) {
54203bcf26d3SKlaus Jensen             status = NVME_INVALID_FIELD | NVME_DNR;
54213bcf26d3SKlaus Jensen             goto out;
54223bcf26d3SKlaus Jensen         }
54233bcf26d3SKlaus Jensen     }
54243bcf26d3SKlaus Jensen 
54253bcf26d3SKlaus Jensen     req->aiocb = &iocb->common;
54263bcf26d3SKlaus Jensen     qemu_bh_schedule(iocb->bh);
54273bcf26d3SKlaus Jensen 
54283bcf26d3SKlaus Jensen     return NVME_NO_COMPLETE;
54293bcf26d3SKlaus Jensen 
54303bcf26d3SKlaus Jensen out:
54313bcf26d3SKlaus Jensen     qemu_bh_delete(iocb->bh);
54323bcf26d3SKlaus Jensen     iocb->bh = NULL;
54333bcf26d3SKlaus Jensen     qemu_aio_unref(iocb);
54343bcf26d3SKlaus Jensen     return status;
543588eea45cSKlaus Jensen }
543688eea45cSKlaus Jensen 
543788eea45cSKlaus Jensen static uint16_t nvme_admin_cmd(NvmeCtrl *n, NvmeRequest *req)
543888eea45cSKlaus Jensen {
543988eea45cSKlaus Jensen     trace_pci_nvme_admin_cmd(nvme_cid(req), nvme_sqid(req), req->cmd.opcode,
544088eea45cSKlaus Jensen                              nvme_adm_opc_str(req->cmd.opcode));
544188eea45cSKlaus Jensen 
544288eea45cSKlaus Jensen     if (!(nvme_cse_acs[req->cmd.opcode] & NVME_CMD_EFF_CSUPP)) {
544388eea45cSKlaus Jensen         trace_pci_nvme_err_invalid_admin_opc(req->cmd.opcode);
544488eea45cSKlaus Jensen         return NVME_INVALID_OPCODE | NVME_DNR;
544588eea45cSKlaus Jensen     }
544688eea45cSKlaus Jensen 
544788eea45cSKlaus Jensen     /* SGLs shall not be used for Admin commands in NVMe over PCIe */
544888eea45cSKlaus Jensen     if (NVME_CMD_FLAGS_PSDT(req->cmd.flags) != NVME_PSDT_PRP) {
544988eea45cSKlaus Jensen         return NVME_INVALID_FIELD | NVME_DNR;
545088eea45cSKlaus Jensen     }
545188eea45cSKlaus Jensen 
545288eea45cSKlaus Jensen     switch (req->cmd.opcode) {
545388eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_SQ:
545488eea45cSKlaus Jensen         return nvme_del_sq(n, req);
545588eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_SQ:
545688eea45cSKlaus Jensen         return nvme_create_sq(n, req);
545788eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_LOG_PAGE:
545888eea45cSKlaus Jensen         return nvme_get_log(n, req);
545988eea45cSKlaus Jensen     case NVME_ADM_CMD_DELETE_CQ:
546088eea45cSKlaus Jensen         return nvme_del_cq(n, req);
546188eea45cSKlaus Jensen     case NVME_ADM_CMD_CREATE_CQ:
546288eea45cSKlaus Jensen         return nvme_create_cq(n, req);
546388eea45cSKlaus Jensen     case NVME_ADM_CMD_IDENTIFY:
546488eea45cSKlaus Jensen         return nvme_identify(n, req);
546588eea45cSKlaus Jensen     case NVME_ADM_CMD_ABORT:
546688eea45cSKlaus Jensen         return nvme_abort(n, req);
546788eea45cSKlaus Jensen     case NVME_ADM_CMD_SET_FEATURES:
546888eea45cSKlaus Jensen         return nvme_set_feature(n, req);
546988eea45cSKlaus Jensen     case NVME_ADM_CMD_GET_FEATURES:
547088eea45cSKlaus Jensen         return nvme_get_feature(n, req);
547188eea45cSKlaus Jensen     case NVME_ADM_CMD_ASYNC_EV_REQ:
547288eea45cSKlaus Jensen         return nvme_aer(n, req);
547388eea45cSKlaus Jensen     case NVME_ADM_CMD_NS_ATTACHMENT:
547488eea45cSKlaus Jensen         return nvme_ns_attachment(n, req);
547588eea45cSKlaus Jensen     case NVME_ADM_CMD_FORMAT_NVM:
547688eea45cSKlaus Jensen         return nvme_format(n, req);
547788eea45cSKlaus Jensen     default:
547888eea45cSKlaus Jensen         assert(false);
547988eea45cSKlaus Jensen     }
548088eea45cSKlaus Jensen 
548188eea45cSKlaus Jensen     return NVME_INVALID_OPCODE | NVME_DNR;
548288eea45cSKlaus Jensen }
548388eea45cSKlaus Jensen 
548488eea45cSKlaus Jensen static void nvme_process_sq(void *opaque)
548588eea45cSKlaus Jensen {
548688eea45cSKlaus Jensen     NvmeSQueue *sq = opaque;
548788eea45cSKlaus Jensen     NvmeCtrl *n = sq->ctrl;
548888eea45cSKlaus Jensen     NvmeCQueue *cq = n->cq[sq->cqid];
548988eea45cSKlaus Jensen 
549088eea45cSKlaus Jensen     uint16_t status;
549188eea45cSKlaus Jensen     hwaddr addr;
549288eea45cSKlaus Jensen     NvmeCmd cmd;
549388eea45cSKlaus Jensen     NvmeRequest *req;
549488eea45cSKlaus Jensen 
549588eea45cSKlaus Jensen     while (!(nvme_sq_empty(sq) || QTAILQ_EMPTY(&sq->req_list))) {
549688eea45cSKlaus Jensen         addr = sq->dma_addr + sq->head * n->sqe_size;
549788eea45cSKlaus Jensen         if (nvme_addr_read(n, addr, (void *)&cmd, sizeof(cmd))) {
549888eea45cSKlaus Jensen             trace_pci_nvme_err_addr_read(addr);
549988eea45cSKlaus Jensen             trace_pci_nvme_err_cfs();
550088eea45cSKlaus Jensen             n->bar.csts = NVME_CSTS_FAILED;
550188eea45cSKlaus Jensen             break;
550288eea45cSKlaus Jensen         }
550388eea45cSKlaus Jensen         nvme_inc_sq_head(sq);
550488eea45cSKlaus Jensen 
550588eea45cSKlaus Jensen         req = QTAILQ_FIRST(&sq->req_list);
550688eea45cSKlaus Jensen         QTAILQ_REMOVE(&sq->req_list, req, entry);
550788eea45cSKlaus Jensen         QTAILQ_INSERT_TAIL(&sq->out_req_list, req, entry);
550888eea45cSKlaus Jensen         nvme_req_clear(req);
550988eea45cSKlaus Jensen         req->cqe.cid = cmd.cid;
551088eea45cSKlaus Jensen         memcpy(&req->cmd, &cmd, sizeof(NvmeCmd));
551188eea45cSKlaus Jensen 
551288eea45cSKlaus Jensen         status = sq->sqid ? nvme_io_cmd(n, req) :
551388eea45cSKlaus Jensen             nvme_admin_cmd(n, req);
551488eea45cSKlaus Jensen         if (status != NVME_NO_COMPLETE) {
551588eea45cSKlaus Jensen             req->status = status;
551688eea45cSKlaus Jensen             nvme_enqueue_req_completion(cq, req);
551788eea45cSKlaus Jensen         }
551888eea45cSKlaus Jensen     }
551988eea45cSKlaus Jensen }
552088eea45cSKlaus Jensen 
552188eea45cSKlaus Jensen static void nvme_ctrl_reset(NvmeCtrl *n)
552288eea45cSKlaus Jensen {
552388eea45cSKlaus Jensen     NvmeNamespace *ns;
552488eea45cSKlaus Jensen     int i;
552588eea45cSKlaus Jensen 
552688eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
552788eea45cSKlaus Jensen         ns = nvme_ns(n, i);
552888eea45cSKlaus Jensen         if (!ns) {
552988eea45cSKlaus Jensen             continue;
553088eea45cSKlaus Jensen         }
553188eea45cSKlaus Jensen 
553288eea45cSKlaus Jensen         nvme_ns_drain(ns);
553388eea45cSKlaus Jensen     }
553488eea45cSKlaus Jensen 
553588eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
553688eea45cSKlaus Jensen         if (n->sq[i] != NULL) {
553788eea45cSKlaus Jensen             nvme_free_sq(n->sq[i], n);
553888eea45cSKlaus Jensen         }
553988eea45cSKlaus Jensen     }
554088eea45cSKlaus Jensen     for (i = 0; i < n->params.max_ioqpairs + 1; i++) {
554188eea45cSKlaus Jensen         if (n->cq[i] != NULL) {
554288eea45cSKlaus Jensen             nvme_free_cq(n->cq[i], n);
554388eea45cSKlaus Jensen         }
554488eea45cSKlaus Jensen     }
554588eea45cSKlaus Jensen 
554688eea45cSKlaus Jensen     while (!QTAILQ_EMPTY(&n->aer_queue)) {
554788eea45cSKlaus Jensen         NvmeAsyncEvent *event = QTAILQ_FIRST(&n->aer_queue);
554888eea45cSKlaus Jensen         QTAILQ_REMOVE(&n->aer_queue, event, entry);
554988eea45cSKlaus Jensen         g_free(event);
555088eea45cSKlaus Jensen     }
555188eea45cSKlaus Jensen 
555288eea45cSKlaus Jensen     n->aer_queued = 0;
555388eea45cSKlaus Jensen     n->outstanding_aers = 0;
555488eea45cSKlaus Jensen     n->qs_created = false;
555588eea45cSKlaus Jensen 
555688eea45cSKlaus Jensen     n->bar.cc = 0;
555788eea45cSKlaus Jensen }
555888eea45cSKlaus Jensen 
555988eea45cSKlaus Jensen static void nvme_ctrl_shutdown(NvmeCtrl *n)
556088eea45cSKlaus Jensen {
556188eea45cSKlaus Jensen     NvmeNamespace *ns;
556288eea45cSKlaus Jensen     int i;
556388eea45cSKlaus Jensen 
556488eea45cSKlaus Jensen     if (n->pmr.dev) {
556588eea45cSKlaus Jensen         memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
556688eea45cSKlaus Jensen     }
556788eea45cSKlaus Jensen 
556888eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
556988eea45cSKlaus Jensen         ns = nvme_ns(n, i);
557088eea45cSKlaus Jensen         if (!ns) {
557188eea45cSKlaus Jensen             continue;
557288eea45cSKlaus Jensen         }
557388eea45cSKlaus Jensen 
557488eea45cSKlaus Jensen         nvme_ns_shutdown(ns);
557588eea45cSKlaus Jensen     }
557688eea45cSKlaus Jensen }
557788eea45cSKlaus Jensen 
557888eea45cSKlaus Jensen static void nvme_select_iocs(NvmeCtrl *n)
557988eea45cSKlaus Jensen {
558088eea45cSKlaus Jensen     NvmeNamespace *ns;
558188eea45cSKlaus Jensen     int i;
558288eea45cSKlaus Jensen 
558388eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
558488eea45cSKlaus Jensen         ns = nvme_ns(n, i);
558588eea45cSKlaus Jensen         if (!ns) {
558688eea45cSKlaus Jensen             continue;
558788eea45cSKlaus Jensen         }
558888eea45cSKlaus Jensen 
558988eea45cSKlaus Jensen         nvme_select_iocs_ns(n, ns);
559088eea45cSKlaus Jensen     }
559188eea45cSKlaus Jensen }
559288eea45cSKlaus Jensen 
559388eea45cSKlaus Jensen static int nvme_start_ctrl(NvmeCtrl *n)
559488eea45cSKlaus Jensen {
559588eea45cSKlaus Jensen     uint32_t page_bits = NVME_CC_MPS(n->bar.cc) + 12;
559688eea45cSKlaus Jensen     uint32_t page_size = 1 << page_bits;
559788eea45cSKlaus Jensen 
559888eea45cSKlaus Jensen     if (unlikely(n->cq[0])) {
559988eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cq();
560088eea45cSKlaus Jensen         return -1;
560188eea45cSKlaus Jensen     }
560288eea45cSKlaus Jensen     if (unlikely(n->sq[0])) {
560388eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sq();
560488eea45cSKlaus Jensen         return -1;
560588eea45cSKlaus Jensen     }
560688eea45cSKlaus Jensen     if (unlikely(!n->bar.asq)) {
560788eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_nbarasq();
560888eea45cSKlaus Jensen         return -1;
560988eea45cSKlaus Jensen     }
561088eea45cSKlaus Jensen     if (unlikely(!n->bar.acq)) {
561188eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_nbaracq();
561288eea45cSKlaus Jensen         return -1;
561388eea45cSKlaus Jensen     }
561488eea45cSKlaus Jensen     if (unlikely(n->bar.asq & (page_size - 1))) {
561588eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_asq_misaligned(n->bar.asq);
561688eea45cSKlaus Jensen         return -1;
561788eea45cSKlaus Jensen     }
561888eea45cSKlaus Jensen     if (unlikely(n->bar.acq & (page_size - 1))) {
561988eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_acq_misaligned(n->bar.acq);
562088eea45cSKlaus Jensen         return -1;
562188eea45cSKlaus Jensen     }
562288eea45cSKlaus Jensen     if (unlikely(!(NVME_CAP_CSS(n->bar.cap) & (1 << NVME_CC_CSS(n->bar.cc))))) {
562388eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_css(NVME_CC_CSS(n->bar.cc));
562488eea45cSKlaus Jensen         return -1;
562588eea45cSKlaus Jensen     }
562688eea45cSKlaus Jensen     if (unlikely(NVME_CC_MPS(n->bar.cc) <
562788eea45cSKlaus Jensen                  NVME_CAP_MPSMIN(n->bar.cap))) {
562888eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_small(
562988eea45cSKlaus Jensen                     NVME_CC_MPS(n->bar.cc),
563088eea45cSKlaus Jensen                     NVME_CAP_MPSMIN(n->bar.cap));
563188eea45cSKlaus Jensen         return -1;
563288eea45cSKlaus Jensen     }
563388eea45cSKlaus Jensen     if (unlikely(NVME_CC_MPS(n->bar.cc) >
563488eea45cSKlaus Jensen                  NVME_CAP_MPSMAX(n->bar.cap))) {
563588eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_page_too_large(
563688eea45cSKlaus Jensen                     NVME_CC_MPS(n->bar.cc),
563788eea45cSKlaus Jensen                     NVME_CAP_MPSMAX(n->bar.cap));
563888eea45cSKlaus Jensen         return -1;
563988eea45cSKlaus Jensen     }
564088eea45cSKlaus Jensen     if (unlikely(NVME_CC_IOCQES(n->bar.cc) <
564188eea45cSKlaus Jensen                  NVME_CTRL_CQES_MIN(n->id_ctrl.cqes))) {
564288eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cqent_too_small(
564388eea45cSKlaus Jensen                     NVME_CC_IOCQES(n->bar.cc),
564488eea45cSKlaus Jensen                     NVME_CTRL_CQES_MIN(n->bar.cap));
564588eea45cSKlaus Jensen         return -1;
564688eea45cSKlaus Jensen     }
564788eea45cSKlaus Jensen     if (unlikely(NVME_CC_IOCQES(n->bar.cc) >
564888eea45cSKlaus Jensen                  NVME_CTRL_CQES_MAX(n->id_ctrl.cqes))) {
564988eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_cqent_too_large(
565088eea45cSKlaus Jensen                     NVME_CC_IOCQES(n->bar.cc),
565188eea45cSKlaus Jensen                     NVME_CTRL_CQES_MAX(n->bar.cap));
565288eea45cSKlaus Jensen         return -1;
565388eea45cSKlaus Jensen     }
565488eea45cSKlaus Jensen     if (unlikely(NVME_CC_IOSQES(n->bar.cc) <
565588eea45cSKlaus Jensen                  NVME_CTRL_SQES_MIN(n->id_ctrl.sqes))) {
565688eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sqent_too_small(
565788eea45cSKlaus Jensen                     NVME_CC_IOSQES(n->bar.cc),
565888eea45cSKlaus Jensen                     NVME_CTRL_SQES_MIN(n->bar.cap));
565988eea45cSKlaus Jensen         return -1;
566088eea45cSKlaus Jensen     }
566188eea45cSKlaus Jensen     if (unlikely(NVME_CC_IOSQES(n->bar.cc) >
566288eea45cSKlaus Jensen                  NVME_CTRL_SQES_MAX(n->id_ctrl.sqes))) {
566388eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_sqent_too_large(
566488eea45cSKlaus Jensen                     NVME_CC_IOSQES(n->bar.cc),
566588eea45cSKlaus Jensen                     NVME_CTRL_SQES_MAX(n->bar.cap));
566688eea45cSKlaus Jensen         return -1;
566788eea45cSKlaus Jensen     }
566888eea45cSKlaus Jensen     if (unlikely(!NVME_AQA_ASQS(n->bar.aqa))) {
566988eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_asqent_sz_zero();
567088eea45cSKlaus Jensen         return -1;
567188eea45cSKlaus Jensen     }
567288eea45cSKlaus Jensen     if (unlikely(!NVME_AQA_ACQS(n->bar.aqa))) {
567388eea45cSKlaus Jensen         trace_pci_nvme_err_startfail_acqent_sz_zero();
567488eea45cSKlaus Jensen         return -1;
567588eea45cSKlaus Jensen     }
567688eea45cSKlaus Jensen 
567788eea45cSKlaus Jensen     n->page_bits = page_bits;
567888eea45cSKlaus Jensen     n->page_size = page_size;
567988eea45cSKlaus Jensen     n->max_prp_ents = n->page_size / sizeof(uint64_t);
568088eea45cSKlaus Jensen     n->cqe_size = 1 << NVME_CC_IOCQES(n->bar.cc);
568188eea45cSKlaus Jensen     n->sqe_size = 1 << NVME_CC_IOSQES(n->bar.cc);
568288eea45cSKlaus Jensen     nvme_init_cq(&n->admin_cq, n, n->bar.acq, 0, 0,
568388eea45cSKlaus Jensen                  NVME_AQA_ACQS(n->bar.aqa) + 1, 1);
568488eea45cSKlaus Jensen     nvme_init_sq(&n->admin_sq, n, n->bar.asq, 0, 0,
568588eea45cSKlaus Jensen                  NVME_AQA_ASQS(n->bar.aqa) + 1);
568688eea45cSKlaus Jensen 
568788eea45cSKlaus Jensen     nvme_set_timestamp(n, 0ULL);
568888eea45cSKlaus Jensen 
568988eea45cSKlaus Jensen     QTAILQ_INIT(&n->aer_queue);
569088eea45cSKlaus Jensen 
569188eea45cSKlaus Jensen     nvme_select_iocs(n);
569288eea45cSKlaus Jensen 
569388eea45cSKlaus Jensen     return 0;
569488eea45cSKlaus Jensen }
569588eea45cSKlaus Jensen 
569688eea45cSKlaus Jensen static void nvme_cmb_enable_regs(NvmeCtrl *n)
569788eea45cSKlaus Jensen {
569888eea45cSKlaus Jensen     NVME_CMBLOC_SET_CDPCILS(n->bar.cmbloc, 1);
569988eea45cSKlaus Jensen     NVME_CMBLOC_SET_CDPMLS(n->bar.cmbloc, 1);
570088eea45cSKlaus Jensen     NVME_CMBLOC_SET_BIR(n->bar.cmbloc, NVME_CMB_BIR);
570188eea45cSKlaus Jensen 
570288eea45cSKlaus Jensen     NVME_CMBSZ_SET_SQS(n->bar.cmbsz, 1);
570388eea45cSKlaus Jensen     NVME_CMBSZ_SET_CQS(n->bar.cmbsz, 0);
570488eea45cSKlaus Jensen     NVME_CMBSZ_SET_LISTS(n->bar.cmbsz, 1);
570588eea45cSKlaus Jensen     NVME_CMBSZ_SET_RDS(n->bar.cmbsz, 1);
570688eea45cSKlaus Jensen     NVME_CMBSZ_SET_WDS(n->bar.cmbsz, 1);
570788eea45cSKlaus Jensen     NVME_CMBSZ_SET_SZU(n->bar.cmbsz, 2); /* MBs */
570888eea45cSKlaus Jensen     NVME_CMBSZ_SET_SZ(n->bar.cmbsz, n->params.cmb_size_mb);
570988eea45cSKlaus Jensen }
571088eea45cSKlaus Jensen 
571188eea45cSKlaus Jensen static void nvme_write_bar(NvmeCtrl *n, hwaddr offset, uint64_t data,
571288eea45cSKlaus Jensen                            unsigned size)
571388eea45cSKlaus Jensen {
571488eea45cSKlaus Jensen     if (unlikely(offset & (sizeof(uint32_t) - 1))) {
571588eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_misaligned32,
571688eea45cSKlaus Jensen                        "MMIO write not 32-bit aligned,"
571788eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", offset);
571888eea45cSKlaus Jensen         /* should be ignored, fall through for now */
571988eea45cSKlaus Jensen     }
572088eea45cSKlaus Jensen 
572188eea45cSKlaus Jensen     if (unlikely(size < sizeof(uint32_t))) {
572288eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_toosmall,
572388eea45cSKlaus Jensen                        "MMIO write smaller than 32-bits,"
572488eea45cSKlaus Jensen                        " offset=0x%"PRIx64", size=%u",
572588eea45cSKlaus Jensen                        offset, size);
572688eea45cSKlaus Jensen         /* should be ignored, fall through for now */
572788eea45cSKlaus Jensen     }
572888eea45cSKlaus Jensen 
572988eea45cSKlaus Jensen     switch (offset) {
573088eea45cSKlaus Jensen     case 0xc:   /* INTMS */
573188eea45cSKlaus Jensen         if (unlikely(msix_enabled(&(n->parent_obj)))) {
573288eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
573388eea45cSKlaus Jensen                            "undefined access to interrupt mask set"
573488eea45cSKlaus Jensen                            " when MSI-X is enabled");
573588eea45cSKlaus Jensen             /* should be ignored, fall through for now */
573688eea45cSKlaus Jensen         }
573788eea45cSKlaus Jensen         n->bar.intms |= data & 0xffffffff;
573888eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
573988eea45cSKlaus Jensen         trace_pci_nvme_mmio_intm_set(data & 0xffffffff, n->bar.intmc);
574088eea45cSKlaus Jensen         nvme_irq_check(n);
574188eea45cSKlaus Jensen         break;
574288eea45cSKlaus Jensen     case 0x10:  /* INTMC */
574388eea45cSKlaus Jensen         if (unlikely(msix_enabled(&(n->parent_obj)))) {
574488eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_intmask_with_msix,
574588eea45cSKlaus Jensen                            "undefined access to interrupt mask clr"
574688eea45cSKlaus Jensen                            " when MSI-X is enabled");
574788eea45cSKlaus Jensen             /* should be ignored, fall through for now */
574888eea45cSKlaus Jensen         }
574988eea45cSKlaus Jensen         n->bar.intms &= ~(data & 0xffffffff);
575088eea45cSKlaus Jensen         n->bar.intmc = n->bar.intms;
575188eea45cSKlaus Jensen         trace_pci_nvme_mmio_intm_clr(data & 0xffffffff, n->bar.intmc);
575288eea45cSKlaus Jensen         nvme_irq_check(n);
575388eea45cSKlaus Jensen         break;
575488eea45cSKlaus Jensen     case 0x14:  /* CC */
575588eea45cSKlaus Jensen         trace_pci_nvme_mmio_cfg(data & 0xffffffff);
575688eea45cSKlaus Jensen         /* Windows first sends data, then sends enable bit */
575788eea45cSKlaus Jensen         if (!NVME_CC_EN(data) && !NVME_CC_EN(n->bar.cc) &&
575888eea45cSKlaus Jensen             !NVME_CC_SHN(data) && !NVME_CC_SHN(n->bar.cc))
575988eea45cSKlaus Jensen         {
576088eea45cSKlaus Jensen             n->bar.cc = data;
576188eea45cSKlaus Jensen         }
576288eea45cSKlaus Jensen 
576388eea45cSKlaus Jensen         if (NVME_CC_EN(data) && !NVME_CC_EN(n->bar.cc)) {
576488eea45cSKlaus Jensen             n->bar.cc = data;
576588eea45cSKlaus Jensen             if (unlikely(nvme_start_ctrl(n))) {
576688eea45cSKlaus Jensen                 trace_pci_nvme_err_startfail();
576788eea45cSKlaus Jensen                 n->bar.csts = NVME_CSTS_FAILED;
576888eea45cSKlaus Jensen             } else {
576988eea45cSKlaus Jensen                 trace_pci_nvme_mmio_start_success();
577088eea45cSKlaus Jensen                 n->bar.csts = NVME_CSTS_READY;
577188eea45cSKlaus Jensen             }
577288eea45cSKlaus Jensen         } else if (!NVME_CC_EN(data) && NVME_CC_EN(n->bar.cc)) {
577388eea45cSKlaus Jensen             trace_pci_nvme_mmio_stopped();
577488eea45cSKlaus Jensen             nvme_ctrl_reset(n);
577588eea45cSKlaus Jensen             n->bar.csts &= ~NVME_CSTS_READY;
577688eea45cSKlaus Jensen         }
577788eea45cSKlaus Jensen         if (NVME_CC_SHN(data) && !(NVME_CC_SHN(n->bar.cc))) {
577888eea45cSKlaus Jensen             trace_pci_nvme_mmio_shutdown_set();
577988eea45cSKlaus Jensen             nvme_ctrl_shutdown(n);
578088eea45cSKlaus Jensen             n->bar.cc = data;
578188eea45cSKlaus Jensen             n->bar.csts |= NVME_CSTS_SHST_COMPLETE;
578288eea45cSKlaus Jensen         } else if (!NVME_CC_SHN(data) && NVME_CC_SHN(n->bar.cc)) {
578388eea45cSKlaus Jensen             trace_pci_nvme_mmio_shutdown_cleared();
578488eea45cSKlaus Jensen             n->bar.csts &= ~NVME_CSTS_SHST_COMPLETE;
578588eea45cSKlaus Jensen             n->bar.cc = data;
578688eea45cSKlaus Jensen         }
578788eea45cSKlaus Jensen         break;
578888eea45cSKlaus Jensen     case 0x1c:  /* CSTS */
578988eea45cSKlaus Jensen         if (data & (1 << 4)) {
579088eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ssreset_w1c_unsupported,
579188eea45cSKlaus Jensen                            "attempted to W1C CSTS.NSSRO"
579288eea45cSKlaus Jensen                            " but CAP.NSSRS is zero (not supported)");
579388eea45cSKlaus Jensen         } else if (data != 0) {
579488eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_mmiowr_ro_csts,
579588eea45cSKlaus Jensen                            "attempted to set a read only bit"
579688eea45cSKlaus Jensen                            " of controller status");
579788eea45cSKlaus Jensen         }
579888eea45cSKlaus Jensen         break;
579988eea45cSKlaus Jensen     case 0x20:  /* NSSR */
580088eea45cSKlaus Jensen         if (data == 0x4e564d65) {
580188eea45cSKlaus Jensen             trace_pci_nvme_ub_mmiowr_ssreset_unsupported();
580288eea45cSKlaus Jensen         } else {
580388eea45cSKlaus Jensen             /* The spec says that writes of other values have no effect */
580488eea45cSKlaus Jensen             return;
580588eea45cSKlaus Jensen         }
580688eea45cSKlaus Jensen         break;
580788eea45cSKlaus Jensen     case 0x24:  /* AQA */
580888eea45cSKlaus Jensen         n->bar.aqa = data & 0xffffffff;
580988eea45cSKlaus Jensen         trace_pci_nvme_mmio_aqattr(data & 0xffffffff);
581088eea45cSKlaus Jensen         break;
581188eea45cSKlaus Jensen     case 0x28:  /* ASQ */
581288eea45cSKlaus Jensen         n->bar.asq = size == 8 ? data :
581388eea45cSKlaus Jensen             (n->bar.asq & ~0xffffffffULL) | (data & 0xffffffff);
581488eea45cSKlaus Jensen         trace_pci_nvme_mmio_asqaddr(data);
581588eea45cSKlaus Jensen         break;
581688eea45cSKlaus Jensen     case 0x2c:  /* ASQ hi */
581788eea45cSKlaus Jensen         n->bar.asq = (n->bar.asq & 0xffffffff) | (data << 32);
581888eea45cSKlaus Jensen         trace_pci_nvme_mmio_asqaddr_hi(data, n->bar.asq);
581988eea45cSKlaus Jensen         break;
582088eea45cSKlaus Jensen     case 0x30:  /* ACQ */
582188eea45cSKlaus Jensen         trace_pci_nvme_mmio_acqaddr(data);
582288eea45cSKlaus Jensen         n->bar.acq = size == 8 ? data :
582388eea45cSKlaus Jensen             (n->bar.acq & ~0xffffffffULL) | (data & 0xffffffff);
582488eea45cSKlaus Jensen         break;
582588eea45cSKlaus Jensen     case 0x34:  /* ACQ hi */
582688eea45cSKlaus Jensen         n->bar.acq = (n->bar.acq & 0xffffffff) | (data << 32);
582788eea45cSKlaus Jensen         trace_pci_nvme_mmio_acqaddr_hi(data, n->bar.acq);
582888eea45cSKlaus Jensen         break;
582988eea45cSKlaus Jensen     case 0x38:  /* CMBLOC */
583088eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbloc_reserved,
583188eea45cSKlaus Jensen                        "invalid write to reserved CMBLOC"
583288eea45cSKlaus Jensen                        " when CMBSZ is zero, ignored");
583388eea45cSKlaus Jensen         return;
583488eea45cSKlaus Jensen     case 0x3C:  /* CMBSZ */
583588eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_cmbsz_readonly,
583688eea45cSKlaus Jensen                        "invalid write to read only CMBSZ, ignored");
583788eea45cSKlaus Jensen         return;
583888eea45cSKlaus Jensen     case 0x50:  /* CMBMSC */
583988eea45cSKlaus Jensen         if (!NVME_CAP_CMBS(n->bar.cap)) {
584088eea45cSKlaus Jensen             return;
584188eea45cSKlaus Jensen         }
584288eea45cSKlaus Jensen 
584388eea45cSKlaus Jensen         n->bar.cmbmsc = size == 8 ? data :
584488eea45cSKlaus Jensen             (n->bar.cmbmsc & ~0xffffffff) | (data & 0xffffffff);
584588eea45cSKlaus Jensen         n->cmb.cmse = false;
584688eea45cSKlaus Jensen 
584788eea45cSKlaus Jensen         if (NVME_CMBMSC_CRE(data)) {
584888eea45cSKlaus Jensen             nvme_cmb_enable_regs(n);
584988eea45cSKlaus Jensen 
585088eea45cSKlaus Jensen             if (NVME_CMBMSC_CMSE(data)) {
585188eea45cSKlaus Jensen                 hwaddr cba = NVME_CMBMSC_CBA(data) << CMBMSC_CBA_SHIFT;
585288eea45cSKlaus Jensen                 if (cba + int128_get64(n->cmb.mem.size) < cba) {
585388eea45cSKlaus Jensen                     NVME_CMBSTS_SET_CBAI(n->bar.cmbsts, 1);
585488eea45cSKlaus Jensen                     return;
585588eea45cSKlaus Jensen                 }
585688eea45cSKlaus Jensen 
585788eea45cSKlaus Jensen                 n->cmb.cba = cba;
585888eea45cSKlaus Jensen                 n->cmb.cmse = true;
585988eea45cSKlaus Jensen             }
586088eea45cSKlaus Jensen         } else {
586188eea45cSKlaus Jensen             n->bar.cmbsz = 0;
586288eea45cSKlaus Jensen             n->bar.cmbloc = 0;
586388eea45cSKlaus Jensen         }
586488eea45cSKlaus Jensen 
586588eea45cSKlaus Jensen         return;
586688eea45cSKlaus Jensen     case 0x54:  /* CMBMSC hi */
586788eea45cSKlaus Jensen         n->bar.cmbmsc = (n->bar.cmbmsc & 0xffffffff) | (data << 32);
586888eea45cSKlaus Jensen         return;
586988eea45cSKlaus Jensen 
587088eea45cSKlaus Jensen     case 0xe00: /* PMRCAP */
587188eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrcap_readonly,
587288eea45cSKlaus Jensen                        "invalid write to PMRCAP register, ignored");
587388eea45cSKlaus Jensen         return;
587488eea45cSKlaus Jensen     case 0xe04: /* PMRCTL */
58752b02aabcSKlaus Jensen         if (!NVME_CAP_PMRS(n->bar.cap)) {
58762b02aabcSKlaus Jensen             return;
58772b02aabcSKlaus Jensen         }
58782b02aabcSKlaus Jensen 
587988eea45cSKlaus Jensen         n->bar.pmrctl = data;
588088eea45cSKlaus Jensen         if (NVME_PMRCTL_EN(data)) {
588188eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, true);
588288eea45cSKlaus Jensen             n->bar.pmrsts = 0;
588388eea45cSKlaus Jensen         } else {
588488eea45cSKlaus Jensen             memory_region_set_enabled(&n->pmr.dev->mr, false);
588588eea45cSKlaus Jensen             NVME_PMRSTS_SET_NRDY(n->bar.pmrsts, 1);
588688eea45cSKlaus Jensen             n->pmr.cmse = false;
588788eea45cSKlaus Jensen         }
588888eea45cSKlaus Jensen         return;
588988eea45cSKlaus Jensen     case 0xe08: /* PMRSTS */
589088eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrsts_readonly,
589188eea45cSKlaus Jensen                        "invalid write to PMRSTS register, ignored");
589288eea45cSKlaus Jensen         return;
589388eea45cSKlaus Jensen     case 0xe0C: /* PMREBS */
589488eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrebs_readonly,
589588eea45cSKlaus Jensen                        "invalid write to PMREBS register, ignored");
589688eea45cSKlaus Jensen         return;
589788eea45cSKlaus Jensen     case 0xe10: /* PMRSWTP */
589888eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_pmrswtp_readonly,
589988eea45cSKlaus Jensen                        "invalid write to PMRSWTP register, ignored");
590088eea45cSKlaus Jensen         return;
590188eea45cSKlaus Jensen     case 0xe14: /* PMRMSCL */
590288eea45cSKlaus Jensen         if (!NVME_CAP_PMRS(n->bar.cap)) {
590388eea45cSKlaus Jensen             return;
590488eea45cSKlaus Jensen         }
590588eea45cSKlaus Jensen 
590688eea45cSKlaus Jensen         n->bar.pmrmsc = (n->bar.pmrmsc & ~0xffffffff) | (data & 0xffffffff);
590788eea45cSKlaus Jensen         n->pmr.cmse = false;
590888eea45cSKlaus Jensen 
590988eea45cSKlaus Jensen         if (NVME_PMRMSC_CMSE(n->bar.pmrmsc)) {
591088eea45cSKlaus Jensen             hwaddr cba = NVME_PMRMSC_CBA(n->bar.pmrmsc) << PMRMSC_CBA_SHIFT;
591188eea45cSKlaus Jensen             if (cba + int128_get64(n->pmr.dev->mr.size) < cba) {
591288eea45cSKlaus Jensen                 NVME_PMRSTS_SET_CBAI(n->bar.pmrsts, 1);
591388eea45cSKlaus Jensen                 return;
591488eea45cSKlaus Jensen             }
591588eea45cSKlaus Jensen 
591688eea45cSKlaus Jensen             n->pmr.cmse = true;
591788eea45cSKlaus Jensen             n->pmr.cba = cba;
591888eea45cSKlaus Jensen         }
591988eea45cSKlaus Jensen 
592088eea45cSKlaus Jensen         return;
592188eea45cSKlaus Jensen     case 0xe18: /* PMRMSCU */
592288eea45cSKlaus Jensen         if (!NVME_CAP_PMRS(n->bar.cap)) {
592388eea45cSKlaus Jensen             return;
592488eea45cSKlaus Jensen         }
592588eea45cSKlaus Jensen 
592688eea45cSKlaus Jensen         n->bar.pmrmsc = (n->bar.pmrmsc & 0xffffffff) | (data << 32);
592788eea45cSKlaus Jensen         return;
592888eea45cSKlaus Jensen     default:
592988eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiowr_invalid,
593088eea45cSKlaus Jensen                        "invalid MMIO write,"
593188eea45cSKlaus Jensen                        " offset=0x%"PRIx64", data=%"PRIx64"",
593288eea45cSKlaus Jensen                        offset, data);
593388eea45cSKlaus Jensen         break;
593488eea45cSKlaus Jensen     }
593588eea45cSKlaus Jensen }
593688eea45cSKlaus Jensen 
593788eea45cSKlaus Jensen static uint64_t nvme_mmio_read(void *opaque, hwaddr addr, unsigned size)
593888eea45cSKlaus Jensen {
593988eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
594088eea45cSKlaus Jensen     uint8_t *ptr = (uint8_t *)&n->bar;
594188eea45cSKlaus Jensen     uint64_t val = 0;
594288eea45cSKlaus Jensen 
594388eea45cSKlaus Jensen     trace_pci_nvme_mmio_read(addr, size);
594488eea45cSKlaus Jensen 
594588eea45cSKlaus Jensen     if (unlikely(addr & (sizeof(uint32_t) - 1))) {
594688eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_misaligned32,
594788eea45cSKlaus Jensen                        "MMIO read not 32-bit aligned,"
594888eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
594988eea45cSKlaus Jensen         /* should RAZ, fall through for now */
595088eea45cSKlaus Jensen     } else if (unlikely(size < sizeof(uint32_t))) {
595188eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_toosmall,
595288eea45cSKlaus Jensen                        "MMIO read smaller than 32-bits,"
595388eea45cSKlaus Jensen                        " offset=0x%"PRIx64"", addr);
595488eea45cSKlaus Jensen         /* should RAZ, fall through for now */
595588eea45cSKlaus Jensen     }
595688eea45cSKlaus Jensen 
595788eea45cSKlaus Jensen     if (addr < sizeof(n->bar)) {
595888eea45cSKlaus Jensen         /*
595988eea45cSKlaus Jensen          * When PMRWBM bit 1 is set then read from
596088eea45cSKlaus Jensen          * from PMRSTS should ensure prior writes
596188eea45cSKlaus Jensen          * made it to persistent media
596288eea45cSKlaus Jensen          */
596388eea45cSKlaus Jensen         if (addr == 0xe08 &&
596488eea45cSKlaus Jensen             (NVME_PMRCAP_PMRWBM(n->bar.pmrcap) & 0x02)) {
596588eea45cSKlaus Jensen             memory_region_msync(&n->pmr.dev->mr, 0, n->pmr.dev->size);
596688eea45cSKlaus Jensen         }
596788eea45cSKlaus Jensen         memcpy(&val, ptr + addr, size);
596888eea45cSKlaus Jensen     } else {
596988eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_mmiord_invalid_ofs,
597088eea45cSKlaus Jensen                        "MMIO read beyond last register,"
597188eea45cSKlaus Jensen                        " offset=0x%"PRIx64", returning 0", addr);
597288eea45cSKlaus Jensen     }
597388eea45cSKlaus Jensen 
597488eea45cSKlaus Jensen     return val;
597588eea45cSKlaus Jensen }
597688eea45cSKlaus Jensen 
597788eea45cSKlaus Jensen static void nvme_process_db(NvmeCtrl *n, hwaddr addr, int val)
597888eea45cSKlaus Jensen {
597988eea45cSKlaus Jensen     uint32_t qid;
598088eea45cSKlaus Jensen 
598188eea45cSKlaus Jensen     if (unlikely(addr & ((1 << 2) - 1))) {
598288eea45cSKlaus Jensen         NVME_GUEST_ERR(pci_nvme_ub_db_wr_misaligned,
598388eea45cSKlaus Jensen                        "doorbell write not 32-bit aligned,"
598488eea45cSKlaus Jensen                        " offset=0x%"PRIx64", ignoring", addr);
598588eea45cSKlaus Jensen         return;
598688eea45cSKlaus Jensen     }
598788eea45cSKlaus Jensen 
598888eea45cSKlaus Jensen     if (((addr - 0x1000) >> 2) & 1) {
598988eea45cSKlaus Jensen         /* Completion queue doorbell write */
599088eea45cSKlaus Jensen 
599188eea45cSKlaus Jensen         uint16_t new_head = val & 0xffff;
599288eea45cSKlaus Jensen         int start_sqs;
599388eea45cSKlaus Jensen         NvmeCQueue *cq;
599488eea45cSKlaus Jensen 
599588eea45cSKlaus Jensen         qid = (addr - (0x1000 + (1 << 2))) >> 3;
599688eea45cSKlaus Jensen         if (unlikely(nvme_check_cqid(n, qid))) {
599788eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cq,
599888eea45cSKlaus Jensen                            "completion queue doorbell write"
599988eea45cSKlaus Jensen                            " for nonexistent queue,"
600088eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
600188eea45cSKlaus Jensen 
600288eea45cSKlaus Jensen             /*
600388eea45cSKlaus Jensen              * NVM Express v1.3d, Section 4.1 state: "If host software writes
600488eea45cSKlaus Jensen              * an invalid value to the Submission Queue Tail Doorbell or
600588eea45cSKlaus Jensen              * Completion Queue Head Doorbell regiter and an Asynchronous Event
600688eea45cSKlaus Jensen              * Request command is outstanding, then an asynchronous event is
600788eea45cSKlaus Jensen              * posted to the Admin Completion Queue with a status code of
600888eea45cSKlaus Jensen              * Invalid Doorbell Write Value."
600988eea45cSKlaus Jensen              *
601088eea45cSKlaus Jensen              * Also note that the spec includes the "Invalid Doorbell Register"
601188eea45cSKlaus Jensen              * status code, but nowhere does it specify when to use it.
601288eea45cSKlaus Jensen              * However, it seems reasonable to use it here in a similar
601388eea45cSKlaus Jensen              * fashion.
601488eea45cSKlaus Jensen              */
601588eea45cSKlaus Jensen             if (n->outstanding_aers) {
601688eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
601788eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
601888eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
601988eea45cSKlaus Jensen             }
602088eea45cSKlaus Jensen 
602188eea45cSKlaus Jensen             return;
602288eea45cSKlaus Jensen         }
602388eea45cSKlaus Jensen 
602488eea45cSKlaus Jensen         cq = n->cq[qid];
602588eea45cSKlaus Jensen         if (unlikely(new_head >= cq->size)) {
602688eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_cqhead,
602788eea45cSKlaus Jensen                            "completion queue doorbell write value"
602888eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
602988eea45cSKlaus Jensen                            " new_head=%"PRIu16", ignoring",
603088eea45cSKlaus Jensen                            qid, new_head);
603188eea45cSKlaus Jensen 
603288eea45cSKlaus Jensen             if (n->outstanding_aers) {
603388eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
603488eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
603588eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
603688eea45cSKlaus Jensen             }
603788eea45cSKlaus Jensen 
603888eea45cSKlaus Jensen             return;
603988eea45cSKlaus Jensen         }
604088eea45cSKlaus Jensen 
604188eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_cq(cq->cqid, new_head);
604288eea45cSKlaus Jensen 
604388eea45cSKlaus Jensen         start_sqs = nvme_cq_full(cq) ? 1 : 0;
604488eea45cSKlaus Jensen         cq->head = new_head;
604588eea45cSKlaus Jensen         if (start_sqs) {
604688eea45cSKlaus Jensen             NvmeSQueue *sq;
604788eea45cSKlaus Jensen             QTAILQ_FOREACH(sq, &cq->sq_list, entry) {
604888eea45cSKlaus Jensen                 timer_mod(sq->timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + 500);
604988eea45cSKlaus Jensen             }
605088eea45cSKlaus Jensen             timer_mod(cq->timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + 500);
605188eea45cSKlaus Jensen         }
605288eea45cSKlaus Jensen 
605388eea45cSKlaus Jensen         if (cq->tail == cq->head) {
605483d7ed5cSKlaus Jensen             if (cq->irq_enabled) {
605583d7ed5cSKlaus Jensen                 n->cq_pending--;
605683d7ed5cSKlaus Jensen             }
605783d7ed5cSKlaus Jensen 
605888eea45cSKlaus Jensen             nvme_irq_deassert(n, cq);
605988eea45cSKlaus Jensen         }
606088eea45cSKlaus Jensen     } else {
606188eea45cSKlaus Jensen         /* Submission queue doorbell write */
606288eea45cSKlaus Jensen 
606388eea45cSKlaus Jensen         uint16_t new_tail = val & 0xffff;
606488eea45cSKlaus Jensen         NvmeSQueue *sq;
606588eea45cSKlaus Jensen 
606688eea45cSKlaus Jensen         qid = (addr - 0x1000) >> 3;
606788eea45cSKlaus Jensen         if (unlikely(nvme_check_sqid(n, qid))) {
606888eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sq,
606988eea45cSKlaus Jensen                            "submission queue doorbell write"
607088eea45cSKlaus Jensen                            " for nonexistent queue,"
607188eea45cSKlaus Jensen                            " sqid=%"PRIu32", ignoring", qid);
607288eea45cSKlaus Jensen 
607388eea45cSKlaus Jensen             if (n->outstanding_aers) {
607488eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
607588eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_REGISTER,
607688eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
607788eea45cSKlaus Jensen             }
607888eea45cSKlaus Jensen 
607988eea45cSKlaus Jensen             return;
608088eea45cSKlaus Jensen         }
608188eea45cSKlaus Jensen 
608288eea45cSKlaus Jensen         sq = n->sq[qid];
608388eea45cSKlaus Jensen         if (unlikely(new_tail >= sq->size)) {
608488eea45cSKlaus Jensen             NVME_GUEST_ERR(pci_nvme_ub_db_wr_invalid_sqtail,
608588eea45cSKlaus Jensen                            "submission queue doorbell write value"
608688eea45cSKlaus Jensen                            " beyond queue size, sqid=%"PRIu32","
608788eea45cSKlaus Jensen                            " new_tail=%"PRIu16", ignoring",
608888eea45cSKlaus Jensen                            qid, new_tail);
608988eea45cSKlaus Jensen 
609088eea45cSKlaus Jensen             if (n->outstanding_aers) {
609188eea45cSKlaus Jensen                 nvme_enqueue_event(n, NVME_AER_TYPE_ERROR,
609288eea45cSKlaus Jensen                                    NVME_AER_INFO_ERR_INVALID_DB_VALUE,
609388eea45cSKlaus Jensen                                    NVME_LOG_ERROR_INFO);
609488eea45cSKlaus Jensen             }
609588eea45cSKlaus Jensen 
609688eea45cSKlaus Jensen             return;
609788eea45cSKlaus Jensen         }
609888eea45cSKlaus Jensen 
609988eea45cSKlaus Jensen         trace_pci_nvme_mmio_doorbell_sq(sq->sqid, new_tail);
610088eea45cSKlaus Jensen 
610188eea45cSKlaus Jensen         sq->tail = new_tail;
610288eea45cSKlaus Jensen         timer_mod(sq->timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + 500);
610388eea45cSKlaus Jensen     }
610488eea45cSKlaus Jensen }
610588eea45cSKlaus Jensen 
610688eea45cSKlaus Jensen static void nvme_mmio_write(void *opaque, hwaddr addr, uint64_t data,
610788eea45cSKlaus Jensen                             unsigned size)
610888eea45cSKlaus Jensen {
610988eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
611088eea45cSKlaus Jensen 
611188eea45cSKlaus Jensen     trace_pci_nvme_mmio_write(addr, data, size);
611288eea45cSKlaus Jensen 
611388eea45cSKlaus Jensen     if (addr < sizeof(n->bar)) {
611488eea45cSKlaus Jensen         nvme_write_bar(n, addr, data, size);
611588eea45cSKlaus Jensen     } else {
611688eea45cSKlaus Jensen         nvme_process_db(n, addr, data);
611788eea45cSKlaus Jensen     }
611888eea45cSKlaus Jensen }
611988eea45cSKlaus Jensen 
612088eea45cSKlaus Jensen static const MemoryRegionOps nvme_mmio_ops = {
612188eea45cSKlaus Jensen     .read = nvme_mmio_read,
612288eea45cSKlaus Jensen     .write = nvme_mmio_write,
612388eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
612488eea45cSKlaus Jensen     .impl = {
612588eea45cSKlaus Jensen         .min_access_size = 2,
612688eea45cSKlaus Jensen         .max_access_size = 8,
612788eea45cSKlaus Jensen     },
612888eea45cSKlaus Jensen };
612988eea45cSKlaus Jensen 
613088eea45cSKlaus Jensen static void nvme_cmb_write(void *opaque, hwaddr addr, uint64_t data,
613188eea45cSKlaus Jensen                            unsigned size)
613288eea45cSKlaus Jensen {
613388eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
613488eea45cSKlaus Jensen     stn_le_p(&n->cmb.buf[addr], size, data);
613588eea45cSKlaus Jensen }
613688eea45cSKlaus Jensen 
613788eea45cSKlaus Jensen static uint64_t nvme_cmb_read(void *opaque, hwaddr addr, unsigned size)
613888eea45cSKlaus Jensen {
613988eea45cSKlaus Jensen     NvmeCtrl *n = (NvmeCtrl *)opaque;
614088eea45cSKlaus Jensen     return ldn_le_p(&n->cmb.buf[addr], size);
614188eea45cSKlaus Jensen }
614288eea45cSKlaus Jensen 
614388eea45cSKlaus Jensen static const MemoryRegionOps nvme_cmb_ops = {
614488eea45cSKlaus Jensen     .read = nvme_cmb_read,
614588eea45cSKlaus Jensen     .write = nvme_cmb_write,
614688eea45cSKlaus Jensen     .endianness = DEVICE_LITTLE_ENDIAN,
614788eea45cSKlaus Jensen     .impl = {
614888eea45cSKlaus Jensen         .min_access_size = 1,
614988eea45cSKlaus Jensen         .max_access_size = 8,
615088eea45cSKlaus Jensen     },
615188eea45cSKlaus Jensen };
615288eea45cSKlaus Jensen 
615388eea45cSKlaus Jensen static void nvme_check_constraints(NvmeCtrl *n, Error **errp)
615488eea45cSKlaus Jensen {
615588eea45cSKlaus Jensen     NvmeParams *params = &n->params;
615688eea45cSKlaus Jensen 
615788eea45cSKlaus Jensen     if (params->num_queues) {
615888eea45cSKlaus Jensen         warn_report("num_queues is deprecated; please use max_ioqpairs "
615988eea45cSKlaus Jensen                     "instead");
616088eea45cSKlaus Jensen 
616188eea45cSKlaus Jensen         params->max_ioqpairs = params->num_queues - 1;
616288eea45cSKlaus Jensen     }
616388eea45cSKlaus Jensen 
616488eea45cSKlaus Jensen     if (n->namespace.blkconf.blk && n->subsys) {
616588eea45cSKlaus Jensen         error_setg(errp, "subsystem support is unavailable with legacy "
616688eea45cSKlaus Jensen                    "namespace ('drive' property)");
616788eea45cSKlaus Jensen         return;
616888eea45cSKlaus Jensen     }
616988eea45cSKlaus Jensen 
617088eea45cSKlaus Jensen     if (params->max_ioqpairs < 1 ||
617188eea45cSKlaus Jensen         params->max_ioqpairs > NVME_MAX_IOQPAIRS) {
617288eea45cSKlaus Jensen         error_setg(errp, "max_ioqpairs must be between 1 and %d",
617388eea45cSKlaus Jensen                    NVME_MAX_IOQPAIRS);
617488eea45cSKlaus Jensen         return;
617588eea45cSKlaus Jensen     }
617688eea45cSKlaus Jensen 
617788eea45cSKlaus Jensen     if (params->msix_qsize < 1 ||
617888eea45cSKlaus Jensen         params->msix_qsize > PCI_MSIX_FLAGS_QSIZE + 1) {
617988eea45cSKlaus Jensen         error_setg(errp, "msix_qsize must be between 1 and %d",
618088eea45cSKlaus Jensen                    PCI_MSIX_FLAGS_QSIZE + 1);
618188eea45cSKlaus Jensen         return;
618288eea45cSKlaus Jensen     }
618388eea45cSKlaus Jensen 
618488eea45cSKlaus Jensen     if (!params->serial) {
618588eea45cSKlaus Jensen         error_setg(errp, "serial property not set");
618688eea45cSKlaus Jensen         return;
618788eea45cSKlaus Jensen     }
618888eea45cSKlaus Jensen 
618988eea45cSKlaus Jensen     if (n->pmr.dev) {
619088eea45cSKlaus Jensen         if (host_memory_backend_is_mapped(n->pmr.dev)) {
619188eea45cSKlaus Jensen             error_setg(errp, "can't use already busy memdev: %s",
619288eea45cSKlaus Jensen                        object_get_canonical_path_component(OBJECT(n->pmr.dev)));
619388eea45cSKlaus Jensen             return;
619488eea45cSKlaus Jensen         }
619588eea45cSKlaus Jensen 
619688eea45cSKlaus Jensen         if (!is_power_of_2(n->pmr.dev->size)) {
619788eea45cSKlaus Jensen             error_setg(errp, "pmr backend size needs to be power of 2 in size");
619888eea45cSKlaus Jensen             return;
619988eea45cSKlaus Jensen         }
620088eea45cSKlaus Jensen 
620188eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, true);
620288eea45cSKlaus Jensen     }
620388eea45cSKlaus Jensen 
620488eea45cSKlaus Jensen     if (n->params.zasl > n->params.mdts) {
620588eea45cSKlaus Jensen         error_setg(errp, "zoned.zasl (Zone Append Size Limit) must be less "
620688eea45cSKlaus Jensen                    "than or equal to mdts (Maximum Data Transfer Size)");
620788eea45cSKlaus Jensen         return;
620888eea45cSKlaus Jensen     }
620988eea45cSKlaus Jensen 
621088eea45cSKlaus Jensen     if (!n->params.vsl) {
621188eea45cSKlaus Jensen         error_setg(errp, "vsl must be non-zero");
621288eea45cSKlaus Jensen         return;
621388eea45cSKlaus Jensen     }
621488eea45cSKlaus Jensen }
621588eea45cSKlaus Jensen 
621688eea45cSKlaus Jensen static void nvme_init_state(NvmeCtrl *n)
621788eea45cSKlaus Jensen {
621888eea45cSKlaus Jensen     /* add one to max_ioqpairs to account for the admin queue pair */
621988eea45cSKlaus Jensen     n->reg_size = pow2ceil(sizeof(NvmeBar) +
622088eea45cSKlaus Jensen                            2 * (n->params.max_ioqpairs + 1) * NVME_DB_SIZE);
622188eea45cSKlaus Jensen     n->sq = g_new0(NvmeSQueue *, n->params.max_ioqpairs + 1);
622288eea45cSKlaus Jensen     n->cq = g_new0(NvmeCQueue *, n->params.max_ioqpairs + 1);
622388eea45cSKlaus Jensen     n->temperature = NVME_TEMPERATURE;
622488eea45cSKlaus Jensen     n->features.temp_thresh_hi = NVME_TEMPERATURE_WARNING;
622588eea45cSKlaus Jensen     n->starttime_ms = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
622688eea45cSKlaus Jensen     n->aer_reqs = g_new0(NvmeRequest *, n->params.aerl + 1);
622788eea45cSKlaus Jensen }
622888eea45cSKlaus Jensen 
622988eea45cSKlaus Jensen static void nvme_init_cmb(NvmeCtrl *n, PCIDevice *pci_dev)
623088eea45cSKlaus Jensen {
623188eea45cSKlaus Jensen     uint64_t cmb_size = n->params.cmb_size_mb * MiB;
623288eea45cSKlaus Jensen 
623388eea45cSKlaus Jensen     n->cmb.buf = g_malloc0(cmb_size);
623488eea45cSKlaus Jensen     memory_region_init_io(&n->cmb.mem, OBJECT(n), &nvme_cmb_ops, n,
623588eea45cSKlaus Jensen                           "nvme-cmb", cmb_size);
623688eea45cSKlaus Jensen     pci_register_bar(pci_dev, NVME_CMB_BIR,
623788eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
623888eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
623988eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->cmb.mem);
624088eea45cSKlaus Jensen 
624188eea45cSKlaus Jensen     NVME_CAP_SET_CMBS(n->bar.cap, 1);
624288eea45cSKlaus Jensen 
624388eea45cSKlaus Jensen     if (n->params.legacy_cmb) {
624488eea45cSKlaus Jensen         nvme_cmb_enable_regs(n);
624588eea45cSKlaus Jensen         n->cmb.cmse = true;
624688eea45cSKlaus Jensen     }
624788eea45cSKlaus Jensen }
624888eea45cSKlaus Jensen 
624988eea45cSKlaus Jensen static void nvme_init_pmr(NvmeCtrl *n, PCIDevice *pci_dev)
625088eea45cSKlaus Jensen {
625188eea45cSKlaus Jensen     NVME_PMRCAP_SET_RDS(n->bar.pmrcap, 1);
625288eea45cSKlaus Jensen     NVME_PMRCAP_SET_WDS(n->bar.pmrcap, 1);
625388eea45cSKlaus Jensen     NVME_PMRCAP_SET_BIR(n->bar.pmrcap, NVME_PMR_BIR);
625488eea45cSKlaus Jensen     /* Turn on bit 1 support */
625588eea45cSKlaus Jensen     NVME_PMRCAP_SET_PMRWBM(n->bar.pmrcap, 0x02);
625688eea45cSKlaus Jensen     NVME_PMRCAP_SET_CMSS(n->bar.pmrcap, 1);
625788eea45cSKlaus Jensen 
625888eea45cSKlaus Jensen     pci_register_bar(pci_dev, NVME_PMRCAP_BIR(n->bar.pmrcap),
625988eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_SPACE_MEMORY |
626088eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64 |
626188eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_PREFETCH, &n->pmr.dev->mr);
626288eea45cSKlaus Jensen 
626388eea45cSKlaus Jensen     memory_region_set_enabled(&n->pmr.dev->mr, false);
626488eea45cSKlaus Jensen }
626588eea45cSKlaus Jensen 
626688eea45cSKlaus Jensen static int nvme_init_pci(NvmeCtrl *n, PCIDevice *pci_dev, Error **errp)
626788eea45cSKlaus Jensen {
626888eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
626988eea45cSKlaus Jensen     uint64_t bar_size, msix_table_size, msix_pba_size;
627088eea45cSKlaus Jensen     unsigned msix_table_offset, msix_pba_offset;
627188eea45cSKlaus Jensen     int ret;
627288eea45cSKlaus Jensen 
627388eea45cSKlaus Jensen     Error *err = NULL;
627488eea45cSKlaus Jensen 
627588eea45cSKlaus Jensen     pci_conf[PCI_INTERRUPT_PIN] = 1;
627688eea45cSKlaus Jensen     pci_config_set_prog_interface(pci_conf, 0x2);
627788eea45cSKlaus Jensen 
627888eea45cSKlaus Jensen     if (n->params.use_intel_id) {
627988eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_INTEL);
628088eea45cSKlaus Jensen         pci_config_set_device_id(pci_conf, 0x5845);
628188eea45cSKlaus Jensen     } else {
628288eea45cSKlaus Jensen         pci_config_set_vendor_id(pci_conf, PCI_VENDOR_ID_REDHAT);
628388eea45cSKlaus Jensen         pci_config_set_device_id(pci_conf, PCI_DEVICE_ID_REDHAT_NVME);
628488eea45cSKlaus Jensen     }
628588eea45cSKlaus Jensen 
628688eea45cSKlaus Jensen     pci_config_set_class(pci_conf, PCI_CLASS_STORAGE_EXPRESS);
628788eea45cSKlaus Jensen     pcie_endpoint_cap_init(pci_dev, 0x80);
628888eea45cSKlaus Jensen 
628988eea45cSKlaus Jensen     bar_size = QEMU_ALIGN_UP(n->reg_size, 4 * KiB);
629088eea45cSKlaus Jensen     msix_table_offset = bar_size;
629188eea45cSKlaus Jensen     msix_table_size = PCI_MSIX_ENTRY_SIZE * n->params.msix_qsize;
629288eea45cSKlaus Jensen 
629388eea45cSKlaus Jensen     bar_size += msix_table_size;
629488eea45cSKlaus Jensen     bar_size = QEMU_ALIGN_UP(bar_size, 4 * KiB);
629588eea45cSKlaus Jensen     msix_pba_offset = bar_size;
629688eea45cSKlaus Jensen     msix_pba_size = QEMU_ALIGN_UP(n->params.msix_qsize, 64) / 8;
629788eea45cSKlaus Jensen 
629888eea45cSKlaus Jensen     bar_size += msix_pba_size;
629988eea45cSKlaus Jensen     bar_size = pow2ceil(bar_size);
630088eea45cSKlaus Jensen 
630188eea45cSKlaus Jensen     memory_region_init(&n->bar0, OBJECT(n), "nvme-bar0", bar_size);
630288eea45cSKlaus Jensen     memory_region_init_io(&n->iomem, OBJECT(n), &nvme_mmio_ops, n, "nvme",
630388eea45cSKlaus Jensen                           n->reg_size);
630488eea45cSKlaus Jensen     memory_region_add_subregion(&n->bar0, 0, &n->iomem);
630588eea45cSKlaus Jensen 
630688eea45cSKlaus Jensen     pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY |
630788eea45cSKlaus Jensen                      PCI_BASE_ADDRESS_MEM_TYPE_64, &n->bar0);
630888eea45cSKlaus Jensen     ret = msix_init(pci_dev, n->params.msix_qsize,
630988eea45cSKlaus Jensen                     &n->bar0, 0, msix_table_offset,
631088eea45cSKlaus Jensen                     &n->bar0, 0, msix_pba_offset, 0, &err);
631188eea45cSKlaus Jensen     if (ret < 0) {
631288eea45cSKlaus Jensen         if (ret == -ENOTSUP) {
631388eea45cSKlaus Jensen             warn_report_err(err);
631488eea45cSKlaus Jensen         } else {
631588eea45cSKlaus Jensen             error_propagate(errp, err);
631688eea45cSKlaus Jensen             return ret;
631788eea45cSKlaus Jensen         }
631888eea45cSKlaus Jensen     }
631988eea45cSKlaus Jensen 
632088eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
632188eea45cSKlaus Jensen         nvme_init_cmb(n, pci_dev);
632288eea45cSKlaus Jensen     }
632388eea45cSKlaus Jensen 
632488eea45cSKlaus Jensen     if (n->pmr.dev) {
632588eea45cSKlaus Jensen         nvme_init_pmr(n, pci_dev);
632688eea45cSKlaus Jensen     }
632788eea45cSKlaus Jensen 
632888eea45cSKlaus Jensen     return 0;
632988eea45cSKlaus Jensen }
633088eea45cSKlaus Jensen 
633188eea45cSKlaus Jensen static void nvme_init_subnqn(NvmeCtrl *n)
633288eea45cSKlaus Jensen {
633388eea45cSKlaus Jensen     NvmeSubsystem *subsys = n->subsys;
633488eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
633588eea45cSKlaus Jensen 
633688eea45cSKlaus Jensen     if (!subsys) {
633788eea45cSKlaus Jensen         snprintf((char *)id->subnqn, sizeof(id->subnqn),
633888eea45cSKlaus Jensen                  "nqn.2019-08.org.qemu:%s", n->params.serial);
633988eea45cSKlaus Jensen     } else {
634088eea45cSKlaus Jensen         pstrcpy((char *)id->subnqn, sizeof(id->subnqn), (char*)subsys->subnqn);
634188eea45cSKlaus Jensen     }
634288eea45cSKlaus Jensen }
634388eea45cSKlaus Jensen 
634488eea45cSKlaus Jensen static void nvme_init_ctrl(NvmeCtrl *n, PCIDevice *pci_dev)
634588eea45cSKlaus Jensen {
634688eea45cSKlaus Jensen     NvmeIdCtrl *id = &n->id_ctrl;
634788eea45cSKlaus Jensen     uint8_t *pci_conf = pci_dev->config;
634888eea45cSKlaus Jensen 
634988eea45cSKlaus Jensen     id->vid = cpu_to_le16(pci_get_word(pci_conf + PCI_VENDOR_ID));
635088eea45cSKlaus Jensen     id->ssvid = cpu_to_le16(pci_get_word(pci_conf + PCI_SUBSYSTEM_VENDOR_ID));
635188eea45cSKlaus Jensen     strpadcpy((char *)id->mn, sizeof(id->mn), "QEMU NVMe Ctrl", ' ');
635288eea45cSKlaus Jensen     strpadcpy((char *)id->fr, sizeof(id->fr), "1.0", ' ');
635388eea45cSKlaus Jensen     strpadcpy((char *)id->sn, sizeof(id->sn), n->params.serial, ' ');
635488eea45cSKlaus Jensen 
635588eea45cSKlaus Jensen     id->cntlid = cpu_to_le16(n->cntlid);
635688eea45cSKlaus Jensen 
635788eea45cSKlaus Jensen     id->oaes = cpu_to_le32(NVME_OAES_NS_ATTR);
635888eea45cSKlaus Jensen 
635988eea45cSKlaus Jensen     id->rab = 6;
636088eea45cSKlaus Jensen 
636188eea45cSKlaus Jensen     if (n->params.use_intel_id) {
636288eea45cSKlaus Jensen         id->ieee[0] = 0xb3;
636388eea45cSKlaus Jensen         id->ieee[1] = 0x02;
636488eea45cSKlaus Jensen         id->ieee[2] = 0x00;
636588eea45cSKlaus Jensen     } else {
636688eea45cSKlaus Jensen         id->ieee[0] = 0x00;
636788eea45cSKlaus Jensen         id->ieee[1] = 0x54;
636888eea45cSKlaus Jensen         id->ieee[2] = 0x52;
636988eea45cSKlaus Jensen     }
637088eea45cSKlaus Jensen 
637188eea45cSKlaus Jensen     id->mdts = n->params.mdts;
637288eea45cSKlaus Jensen     id->ver = cpu_to_le32(NVME_SPEC_VER);
637388eea45cSKlaus Jensen     id->oacs = cpu_to_le16(NVME_OACS_NS_MGMT | NVME_OACS_FORMAT);
637488eea45cSKlaus Jensen     id->cntrltype = 0x1;
637588eea45cSKlaus Jensen 
637688eea45cSKlaus Jensen     /*
637788eea45cSKlaus Jensen      * Because the controller always completes the Abort command immediately,
637888eea45cSKlaus Jensen      * there can never be more than one concurrently executing Abort command,
637988eea45cSKlaus Jensen      * so this value is never used for anything. Note that there can easily be
638088eea45cSKlaus Jensen      * many Abort commands in the queues, but they are not considered
638188eea45cSKlaus Jensen      * "executing" until processed by nvme_abort.
638288eea45cSKlaus Jensen      *
638388eea45cSKlaus Jensen      * The specification recommends a value of 3 for Abort Command Limit (four
638488eea45cSKlaus Jensen      * concurrently outstanding Abort commands), so lets use that though it is
638588eea45cSKlaus Jensen      * inconsequential.
638688eea45cSKlaus Jensen      */
638788eea45cSKlaus Jensen     id->acl = 3;
638888eea45cSKlaus Jensen     id->aerl = n->params.aerl;
638988eea45cSKlaus Jensen     id->frmw = (NVME_NUM_FW_SLOTS << 1) | NVME_FRMW_SLOT1_RO;
639088eea45cSKlaus Jensen     id->lpa = NVME_LPA_NS_SMART | NVME_LPA_CSE | NVME_LPA_EXTENDED;
639188eea45cSKlaus Jensen 
639288eea45cSKlaus Jensen     /* recommended default value (~70 C) */
639388eea45cSKlaus Jensen     id->wctemp = cpu_to_le16(NVME_TEMPERATURE_WARNING);
639488eea45cSKlaus Jensen     id->cctemp = cpu_to_le16(NVME_TEMPERATURE_CRITICAL);
639588eea45cSKlaus Jensen 
639688eea45cSKlaus Jensen     id->sqes = (0x6 << 4) | 0x6;
639788eea45cSKlaus Jensen     id->cqes = (0x4 << 4) | 0x4;
639888eea45cSKlaus Jensen     id->nn = cpu_to_le32(NVME_MAX_NAMESPACES);
639988eea45cSKlaus Jensen     id->oncs = cpu_to_le16(NVME_ONCS_WRITE_ZEROES | NVME_ONCS_TIMESTAMP |
640088eea45cSKlaus Jensen                            NVME_ONCS_FEATURES | NVME_ONCS_DSM |
640188eea45cSKlaus Jensen                            NVME_ONCS_COMPARE | NVME_ONCS_COPY);
640288eea45cSKlaus Jensen 
640388eea45cSKlaus Jensen     /*
640488eea45cSKlaus Jensen      * NOTE: If this device ever supports a command set that does NOT use 0x0
640588eea45cSKlaus Jensen      * as a Flush-equivalent operation, support for the broadcast NSID in Flush
640688eea45cSKlaus Jensen      * should probably be removed.
640788eea45cSKlaus Jensen      *
640888eea45cSKlaus Jensen      * See comment in nvme_io_cmd.
640988eea45cSKlaus Jensen      */
641088eea45cSKlaus Jensen     id->vwc = NVME_VWC_NSID_BROADCAST_SUPPORT | NVME_VWC_PRESENT;
641188eea45cSKlaus Jensen 
641288eea45cSKlaus Jensen     id->ocfs = cpu_to_le16(NVME_OCFS_COPY_FORMAT_0);
641388eea45cSKlaus Jensen     id->sgls = cpu_to_le32(NVME_CTRL_SGLS_SUPPORT_NO_ALIGN |
641488eea45cSKlaus Jensen                            NVME_CTRL_SGLS_BITBUCKET);
641588eea45cSKlaus Jensen 
641688eea45cSKlaus Jensen     nvme_init_subnqn(n);
641788eea45cSKlaus Jensen 
641888eea45cSKlaus Jensen     id->psd[0].mp = cpu_to_le16(0x9c4);
641988eea45cSKlaus Jensen     id->psd[0].enlat = cpu_to_le32(0x10);
642088eea45cSKlaus Jensen     id->psd[0].exlat = cpu_to_le32(0x4);
642188eea45cSKlaus Jensen 
642288eea45cSKlaus Jensen     if (n->subsys) {
642388eea45cSKlaus Jensen         id->cmic |= NVME_CMIC_MULTI_CTRL;
642488eea45cSKlaus Jensen     }
642588eea45cSKlaus Jensen 
642688eea45cSKlaus Jensen     NVME_CAP_SET_MQES(n->bar.cap, 0x7ff);
642788eea45cSKlaus Jensen     NVME_CAP_SET_CQR(n->bar.cap, 1);
642888eea45cSKlaus Jensen     NVME_CAP_SET_TO(n->bar.cap, 0xf);
642988eea45cSKlaus Jensen     NVME_CAP_SET_CSS(n->bar.cap, NVME_CAP_CSS_NVM);
643088eea45cSKlaus Jensen     NVME_CAP_SET_CSS(n->bar.cap, NVME_CAP_CSS_CSI_SUPP);
643188eea45cSKlaus Jensen     NVME_CAP_SET_CSS(n->bar.cap, NVME_CAP_CSS_ADMIN_ONLY);
643288eea45cSKlaus Jensen     NVME_CAP_SET_MPSMAX(n->bar.cap, 4);
643388eea45cSKlaus Jensen     NVME_CAP_SET_CMBS(n->bar.cap, n->params.cmb_size_mb ? 1 : 0);
643488eea45cSKlaus Jensen     NVME_CAP_SET_PMRS(n->bar.cap, n->pmr.dev ? 1 : 0);
643588eea45cSKlaus Jensen 
643688eea45cSKlaus Jensen     n->bar.vs = NVME_SPEC_VER;
643788eea45cSKlaus Jensen     n->bar.intmc = n->bar.intms = 0;
643888eea45cSKlaus Jensen }
643988eea45cSKlaus Jensen 
644088eea45cSKlaus Jensen static int nvme_init_subsys(NvmeCtrl *n, Error **errp)
644188eea45cSKlaus Jensen {
644288eea45cSKlaus Jensen     int cntlid;
644388eea45cSKlaus Jensen 
644488eea45cSKlaus Jensen     if (!n->subsys) {
644588eea45cSKlaus Jensen         return 0;
644688eea45cSKlaus Jensen     }
644788eea45cSKlaus Jensen 
644888eea45cSKlaus Jensen     cntlid = nvme_subsys_register_ctrl(n, errp);
644988eea45cSKlaus Jensen     if (cntlid < 0) {
645088eea45cSKlaus Jensen         return -1;
645188eea45cSKlaus Jensen     }
645288eea45cSKlaus Jensen 
645388eea45cSKlaus Jensen     n->cntlid = cntlid;
645488eea45cSKlaus Jensen 
645588eea45cSKlaus Jensen     return 0;
645688eea45cSKlaus Jensen }
645788eea45cSKlaus Jensen 
645888eea45cSKlaus Jensen void nvme_attach_ns(NvmeCtrl *n, NvmeNamespace *ns)
645988eea45cSKlaus Jensen {
646088eea45cSKlaus Jensen     uint32_t nsid = ns->params.nsid;
646188eea45cSKlaus Jensen     assert(nsid && nsid <= NVME_MAX_NAMESPACES);
646288eea45cSKlaus Jensen 
646388eea45cSKlaus Jensen     n->namespaces[nsid] = ns;
646488eea45cSKlaus Jensen     ns->attached++;
646588eea45cSKlaus Jensen 
646688eea45cSKlaus Jensen     n->dmrsl = MIN_NON_ZERO(n->dmrsl,
646788eea45cSKlaus Jensen                             BDRV_REQUEST_MAX_BYTES / nvme_l2b(ns, 1));
646888eea45cSKlaus Jensen }
646988eea45cSKlaus Jensen 
647088eea45cSKlaus Jensen static void nvme_realize(PCIDevice *pci_dev, Error **errp)
647188eea45cSKlaus Jensen {
647288eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
647388eea45cSKlaus Jensen     NvmeNamespace *ns;
647488eea45cSKlaus Jensen     Error *local_err = NULL;
647588eea45cSKlaus Jensen 
647688eea45cSKlaus Jensen     nvme_check_constraints(n, &local_err);
647788eea45cSKlaus Jensen     if (local_err) {
647888eea45cSKlaus Jensen         error_propagate(errp, local_err);
647988eea45cSKlaus Jensen         return;
648088eea45cSKlaus Jensen     }
648188eea45cSKlaus Jensen 
648288eea45cSKlaus Jensen     qbus_create_inplace(&n->bus, sizeof(NvmeBus), TYPE_NVME_BUS,
648388eea45cSKlaus Jensen                         &pci_dev->qdev, n->parent_obj.qdev.id);
648488eea45cSKlaus Jensen 
648588eea45cSKlaus Jensen     nvme_init_state(n);
648688eea45cSKlaus Jensen     if (nvme_init_pci(n, pci_dev, errp)) {
648788eea45cSKlaus Jensen         return;
648888eea45cSKlaus Jensen     }
648988eea45cSKlaus Jensen 
649088eea45cSKlaus Jensen     if (nvme_init_subsys(n, errp)) {
649188eea45cSKlaus Jensen         error_propagate(errp, local_err);
649288eea45cSKlaus Jensen         return;
649388eea45cSKlaus Jensen     }
649488eea45cSKlaus Jensen     nvme_init_ctrl(n, pci_dev);
649588eea45cSKlaus Jensen 
649688eea45cSKlaus Jensen     /* setup a namespace if the controller drive property was given */
649788eea45cSKlaus Jensen     if (n->namespace.blkconf.blk) {
649888eea45cSKlaus Jensen         ns = &n->namespace;
649988eea45cSKlaus Jensen         ns->params.nsid = 1;
650088eea45cSKlaus Jensen 
65015e4f6bccSKlaus Jensen         if (nvme_ns_setup(ns, errp)) {
650288eea45cSKlaus Jensen             return;
650388eea45cSKlaus Jensen         }
650488eea45cSKlaus Jensen 
650588eea45cSKlaus Jensen         nvme_attach_ns(n, ns);
650688eea45cSKlaus Jensen     }
650788eea45cSKlaus Jensen }
650888eea45cSKlaus Jensen 
650988eea45cSKlaus Jensen static void nvme_exit(PCIDevice *pci_dev)
651088eea45cSKlaus Jensen {
651188eea45cSKlaus Jensen     NvmeCtrl *n = NVME(pci_dev);
651288eea45cSKlaus Jensen     NvmeNamespace *ns;
651388eea45cSKlaus Jensen     int i;
651488eea45cSKlaus Jensen 
651588eea45cSKlaus Jensen     nvme_ctrl_reset(n);
651688eea45cSKlaus Jensen 
651788eea45cSKlaus Jensen     for (i = 1; i <= NVME_MAX_NAMESPACES; i++) {
651888eea45cSKlaus Jensen         ns = nvme_ns(n, i);
651988eea45cSKlaus Jensen         if (!ns) {
652088eea45cSKlaus Jensen             continue;
652188eea45cSKlaus Jensen         }
652288eea45cSKlaus Jensen 
652388eea45cSKlaus Jensen         nvme_ns_cleanup(ns);
652488eea45cSKlaus Jensen     }
652588eea45cSKlaus Jensen 
6526*b0fde9e8SKlaus Jensen     if (n->subsys) {
6527*b0fde9e8SKlaus Jensen         nvme_subsys_unregister_ctrl(n->subsys, n);
6528*b0fde9e8SKlaus Jensen     }
6529*b0fde9e8SKlaus Jensen 
653088eea45cSKlaus Jensen     g_free(n->cq);
653188eea45cSKlaus Jensen     g_free(n->sq);
653288eea45cSKlaus Jensen     g_free(n->aer_reqs);
653388eea45cSKlaus Jensen 
653488eea45cSKlaus Jensen     if (n->params.cmb_size_mb) {
653588eea45cSKlaus Jensen         g_free(n->cmb.buf);
653688eea45cSKlaus Jensen     }
653788eea45cSKlaus Jensen 
653888eea45cSKlaus Jensen     if (n->pmr.dev) {
653988eea45cSKlaus Jensen         host_memory_backend_set_mapped(n->pmr.dev, false);
654088eea45cSKlaus Jensen     }
654188eea45cSKlaus Jensen     msix_uninit(pci_dev, &n->bar0, &n->bar0);
654288eea45cSKlaus Jensen     memory_region_del_subregion(&n->bar0, &n->iomem);
654388eea45cSKlaus Jensen }
654488eea45cSKlaus Jensen 
654588eea45cSKlaus Jensen static Property nvme_props[] = {
654688eea45cSKlaus Jensen     DEFINE_BLOCK_PROPERTIES(NvmeCtrl, namespace.blkconf),
654788eea45cSKlaus Jensen     DEFINE_PROP_LINK("pmrdev", NvmeCtrl, pmr.dev, TYPE_MEMORY_BACKEND,
654888eea45cSKlaus Jensen                      HostMemoryBackend *),
654988eea45cSKlaus Jensen     DEFINE_PROP_LINK("subsys", NvmeCtrl, subsys, TYPE_NVME_SUBSYS,
655088eea45cSKlaus Jensen                      NvmeSubsystem *),
655188eea45cSKlaus Jensen     DEFINE_PROP_STRING("serial", NvmeCtrl, params.serial),
655288eea45cSKlaus Jensen     DEFINE_PROP_UINT32("cmb_size_mb", NvmeCtrl, params.cmb_size_mb, 0),
655388eea45cSKlaus Jensen     DEFINE_PROP_UINT32("num_queues", NvmeCtrl, params.num_queues, 0),
655488eea45cSKlaus Jensen     DEFINE_PROP_UINT32("max_ioqpairs", NvmeCtrl, params.max_ioqpairs, 64),
655588eea45cSKlaus Jensen     DEFINE_PROP_UINT16("msix_qsize", NvmeCtrl, params.msix_qsize, 65),
655688eea45cSKlaus Jensen     DEFINE_PROP_UINT8("aerl", NvmeCtrl, params.aerl, 3),
655788eea45cSKlaus Jensen     DEFINE_PROP_UINT32("aer_max_queued", NvmeCtrl, params.aer_max_queued, 64),
655888eea45cSKlaus Jensen     DEFINE_PROP_UINT8("mdts", NvmeCtrl, params.mdts, 7),
655988eea45cSKlaus Jensen     DEFINE_PROP_UINT8("vsl", NvmeCtrl, params.vsl, 7),
656088eea45cSKlaus Jensen     DEFINE_PROP_BOOL("use-intel-id", NvmeCtrl, params.use_intel_id, false),
656188eea45cSKlaus Jensen     DEFINE_PROP_BOOL("legacy-cmb", NvmeCtrl, params.legacy_cmb, false),
656288eea45cSKlaus Jensen     DEFINE_PROP_UINT8("zoned.zasl", NvmeCtrl, params.zasl, 0),
6563cccc2651SNiklas Cassel     DEFINE_PROP_BOOL("zoned.auto_transition", NvmeCtrl,
6564cccc2651SNiklas Cassel                      params.auto_transition_zones, true),
656588eea45cSKlaus Jensen     DEFINE_PROP_END_OF_LIST(),
656688eea45cSKlaus Jensen };
656788eea45cSKlaus Jensen 
656888eea45cSKlaus Jensen static void nvme_get_smart_warning(Object *obj, Visitor *v, const char *name,
656988eea45cSKlaus Jensen                                    void *opaque, Error **errp)
657088eea45cSKlaus Jensen {
657188eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
657288eea45cSKlaus Jensen     uint8_t value = n->smart_critical_warning;
657388eea45cSKlaus Jensen 
657488eea45cSKlaus Jensen     visit_type_uint8(v, name, &value, errp);
657588eea45cSKlaus Jensen }
657688eea45cSKlaus Jensen 
657788eea45cSKlaus Jensen static void nvme_set_smart_warning(Object *obj, Visitor *v, const char *name,
657888eea45cSKlaus Jensen                                    void *opaque, Error **errp)
657988eea45cSKlaus Jensen {
658088eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
658188eea45cSKlaus Jensen     uint8_t value, old_value, cap = 0, index, event;
658288eea45cSKlaus Jensen 
658388eea45cSKlaus Jensen     if (!visit_type_uint8(v, name, &value, errp)) {
658488eea45cSKlaus Jensen         return;
658588eea45cSKlaus Jensen     }
658688eea45cSKlaus Jensen 
658788eea45cSKlaus Jensen     cap = NVME_SMART_SPARE | NVME_SMART_TEMPERATURE | NVME_SMART_RELIABILITY
658888eea45cSKlaus Jensen           | NVME_SMART_MEDIA_READ_ONLY | NVME_SMART_FAILED_VOLATILE_MEDIA;
658988eea45cSKlaus Jensen     if (NVME_CAP_PMRS(n->bar.cap)) {
659088eea45cSKlaus Jensen         cap |= NVME_SMART_PMR_UNRELIABLE;
659188eea45cSKlaus Jensen     }
659288eea45cSKlaus Jensen 
659388eea45cSKlaus Jensen     if ((value & cap) != value) {
659488eea45cSKlaus Jensen         error_setg(errp, "unsupported smart critical warning bits: 0x%x",
659588eea45cSKlaus Jensen                    value & ~cap);
659688eea45cSKlaus Jensen         return;
659788eea45cSKlaus Jensen     }
659888eea45cSKlaus Jensen 
659988eea45cSKlaus Jensen     old_value = n->smart_critical_warning;
660088eea45cSKlaus Jensen     n->smart_critical_warning = value;
660188eea45cSKlaus Jensen 
660288eea45cSKlaus Jensen     /* only inject new bits of smart critical warning */
660388eea45cSKlaus Jensen     for (index = 0; index < NVME_SMART_WARN_MAX; index++) {
660488eea45cSKlaus Jensen         event = 1 << index;
660588eea45cSKlaus Jensen         if (value & ~old_value & event)
660688eea45cSKlaus Jensen             nvme_smart_event(n, event);
660788eea45cSKlaus Jensen     }
660888eea45cSKlaus Jensen }
660988eea45cSKlaus Jensen 
661088eea45cSKlaus Jensen static const VMStateDescription nvme_vmstate = {
661188eea45cSKlaus Jensen     .name = "nvme",
661288eea45cSKlaus Jensen     .unmigratable = 1,
661388eea45cSKlaus Jensen };
661488eea45cSKlaus Jensen 
661588eea45cSKlaus Jensen static void nvme_class_init(ObjectClass *oc, void *data)
661688eea45cSKlaus Jensen {
661788eea45cSKlaus Jensen     DeviceClass *dc = DEVICE_CLASS(oc);
661888eea45cSKlaus Jensen     PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc);
661988eea45cSKlaus Jensen 
662088eea45cSKlaus Jensen     pc->realize = nvme_realize;
662188eea45cSKlaus Jensen     pc->exit = nvme_exit;
662288eea45cSKlaus Jensen     pc->class_id = PCI_CLASS_STORAGE_EXPRESS;
662388eea45cSKlaus Jensen     pc->revision = 2;
662488eea45cSKlaus Jensen 
662588eea45cSKlaus Jensen     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
662688eea45cSKlaus Jensen     dc->desc = "Non-Volatile Memory Express";
662788eea45cSKlaus Jensen     device_class_set_props(dc, nvme_props);
662888eea45cSKlaus Jensen     dc->vmsd = &nvme_vmstate;
662988eea45cSKlaus Jensen }
663088eea45cSKlaus Jensen 
663188eea45cSKlaus Jensen static void nvme_instance_init(Object *obj)
663288eea45cSKlaus Jensen {
663388eea45cSKlaus Jensen     NvmeCtrl *n = NVME(obj);
663488eea45cSKlaus Jensen 
663588eea45cSKlaus Jensen     device_add_bootindex_property(obj, &n->namespace.blkconf.bootindex,
663688eea45cSKlaus Jensen                                   "bootindex", "/namespace@1,0",
663788eea45cSKlaus Jensen                                   DEVICE(obj));
663888eea45cSKlaus Jensen 
663988eea45cSKlaus Jensen     object_property_add(obj, "smart_critical_warning", "uint8",
664088eea45cSKlaus Jensen                         nvme_get_smart_warning,
664188eea45cSKlaus Jensen                         nvme_set_smart_warning, NULL, NULL);
664288eea45cSKlaus Jensen }
664388eea45cSKlaus Jensen 
664488eea45cSKlaus Jensen static const TypeInfo nvme_info = {
664588eea45cSKlaus Jensen     .name          = TYPE_NVME,
664688eea45cSKlaus Jensen     .parent        = TYPE_PCI_DEVICE,
664788eea45cSKlaus Jensen     .instance_size = sizeof(NvmeCtrl),
664888eea45cSKlaus Jensen     .instance_init = nvme_instance_init,
664988eea45cSKlaus Jensen     .class_init    = nvme_class_init,
665088eea45cSKlaus Jensen     .interfaces = (InterfaceInfo[]) {
665188eea45cSKlaus Jensen         { INTERFACE_PCIE_DEVICE },
665288eea45cSKlaus Jensen         { }
665388eea45cSKlaus Jensen     },
665488eea45cSKlaus Jensen };
665588eea45cSKlaus Jensen 
665688eea45cSKlaus Jensen static const TypeInfo nvme_bus_info = {
665788eea45cSKlaus Jensen     .name = TYPE_NVME_BUS,
665888eea45cSKlaus Jensen     .parent = TYPE_BUS,
665988eea45cSKlaus Jensen     .instance_size = sizeof(NvmeBus),
666088eea45cSKlaus Jensen };
666188eea45cSKlaus Jensen 
666288eea45cSKlaus Jensen static void nvme_register_types(void)
666388eea45cSKlaus Jensen {
666488eea45cSKlaus Jensen     type_register_static(&nvme_info);
666588eea45cSKlaus Jensen     type_register_static(&nvme_bus_info);
666688eea45cSKlaus Jensen }
666788eea45cSKlaus Jensen 
666888eea45cSKlaus Jensen type_init(nvme_register_types)
6669