cxl/test: Add Get Supported Features mailbox command support

Add cxl-test emulation of Get Supported Features mailbox command.
Currently only adding a test feature with feature identifier of
all f's for testing.

Reviewed-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
Acked-by: Dan Williams <dan.j.williams@intel.com>
Reviewed-by: Li Ming <ming.li@zohomail.com>
Link: https://patch.msgid.link/20250220194438.2281088-4-dave.jiang@intel.com
Signed-off-by: Dave Jiang <dave.jiang@intel.com>

diff --git a/tools/testing/cxl/test/mem.c b/tools/testing/cxl/test/mem.c
index e9494cd446ef521ddf0c80585bd84619802a4f50..4809a90ff9b66987b955e0bd252e49564542a6af 100644 (file)
--- a/tools/testing/cxl/test/mem.c
+++ b/tools/testing/cxl/test/mem.c
@@ -44,6 +44,10 @@ static struct cxl_cel_entry mock_cel[] = {
                .opcode = cpu_to_le16(CXL_MBOX_OP_GET_SUPPORTED_LOGS),
                .effect = CXL_CMD_EFFECT_NONE,
        },
+       {
+               .opcode = cpu_to_le16(CXL_MBOX_OP_GET_SUPPORTED_FEATURES),
+               .effect = CXL_CMD_EFFECT_NONE,
+       },
        {
                .opcode = cpu_to_le16(CXL_MBOX_OP_IDENTIFY),
                .effect = CXL_CMD_EFFECT_NONE,
@@ -1354,6 +1358,69 @@ static int mock_activate_fw(struct cxl_mockmem_data *mdata,
        return -EINVAL;
 }
 
+#define CXL_VENDOR_FEATURE_TEST                                                        \
+       UUID_INIT(0xffffffff, 0xffff, 0xffff, 0xff, 0xff, 0xff, 0xff, 0xff,     \
+                 0xff, 0xff, 0xff)
+
+static void fill_feature_vendor_test(struct cxl_feat_entry *feat)
+{
+       feat->uuid = CXL_VENDOR_FEATURE_TEST;
+       feat->id = 0;
+       feat->get_feat_size = cpu_to_le16(0x4);
+       feat->set_feat_size = cpu_to_le16(0x4);
+       feat->flags = cpu_to_le32(CXL_FEATURE_F_CHANGEABLE |
+                                 CXL_FEATURE_F_DEFAULT_SEL |
+                                 CXL_FEATURE_F_SAVED_SEL);
+       feat->get_feat_ver = 1;
+       feat->set_feat_ver = 1;
+       feat->effects = cpu_to_le16(CXL_CMD_CONFIG_CHANGE_COLD_RESET |
+                                   CXL_CMD_EFFECTS_VALID);
+}
+
+#define MAX_CXL_TEST_FEATS     1
+
+static int mock_get_supported_features(struct cxl_mockmem_data *mdata,
+                                      struct cxl_mbox_cmd *cmd)
+{
+       struct cxl_mbox_get_sup_feats_in *in = cmd->payload_in;
+       struct cxl_mbox_get_sup_feats_out *out = cmd->payload_out;
+       struct cxl_feat_entry *feat;
+       u16 start_idx, count;
+
+       if (cmd->size_out < sizeof(*out)) {
+               cmd->return_code = CXL_MBOX_CMD_RC_PAYLOADLEN;
+               return -EINVAL;
+       }
+
+       /*
+        * Current emulation only supports 1 feature
+        */
+       start_idx = le16_to_cpu(in->start_idx);
+       if (start_idx != 0) {
+               cmd->return_code = CXL_MBOX_CMD_RC_INPUT;
+               return -EINVAL;
+       }
+
+       count = le16_to_cpu(in->count);
+       if (count < struct_size(out, ents, 0)) {
+               cmd->return_code = CXL_MBOX_CMD_RC_PAYLOADLEN;
+               return -EINVAL;
+       }
+
+       out->supported_feats = cpu_to_le16(MAX_CXL_TEST_FEATS);
+       cmd->return_code = 0;
+       if (count < struct_size(out, ents, MAX_CXL_TEST_FEATS)) {
+               out->num_entries = 0;
+               return 0;
+       }
+
+       out->num_entries = cpu_to_le16(MAX_CXL_TEST_FEATS);
+       feat = out->ents;
+       fill_feature_vendor_test(feat);
+
+       return 0;
+}
+
 static int cxl_mock_mbox_send(struct cxl_mailbox *cxl_mbox,
                              struct cxl_mbox_cmd *cmd)
 {
@@ -1439,6 +1506,9 @@ static int cxl_mock_mbox_send(struct cxl_mailbox *cxl_mbox,
        case CXL_MBOX_OP_ACTIVATE_FW:
                rc = mock_activate_fw(mdata, cmd);
                break;
+       case CXL_MBOX_OP_GET_SUPPORTED_FEATURES:
+               rc = mock_get_supported_features(mdata, cmd);
+               break;
        default:
                break;
        }