tools/testing/cxl: Mock the Clear Poison mailbox command

Mock the clear of poison by deleting the device:address entry from
the mock_poison_list[]. Behave like a real CXL device and do not fail
if the address is not in the poison list, but offer a dev_dbg()
message.

Signed-off-by: Alison Schofield <alison.schofield@intel.com>
Reviewed-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
Reviewed-by: Dave Jiang <dave.jiang@intel.com>
Link: https://lore.kernel.org/r/ecf19743c6572e60971bbd078f67d520cf5bca5d.1681874357.git.alison.schofield@intel.com
Signed-off-by: Dan Williams <dan.j.williams@intel.com>

diff --git a/tools/testing/cxl/test/mem.c b/tools/testing/cxl/test/mem.c
index 2731ebb..3c3909d 100644 (file)
--- a/tools/testing/cxl/test/mem.c
+++ b/tools/testing/cxl/test/mem.c
@@ -52,6 +52,10 @@ static struct cxl_cel_entry mock_cel[] = {
                .opcode = cpu_to_le16(CXL_MBOX_OP_INJECT_POISON),
                .effect = cpu_to_le16(0),
        },
+       {
+               .opcode = cpu_to_le16(CXL_MBOX_OP_CLEAR_POISON),
+               .effect = cpu_to_le16(0),
+       },
 };
 
 /* See CXL 2.0 Table 181 Get Health Info Output Payload */
@@ -997,6 +1001,35 @@ static int mock_inject_poison(struct cxl_dev_state *cxlds,
        return 0;
 }
 
+static bool mock_poison_del(struct cxl_dev_state *cxlds, u64 dpa)
+{
+       for (int i = 0; i < MOCK_INJECT_TEST_MAX; i++) {
+               if (mock_poison_list[i].cxlds == cxlds &&
+                   mock_poison_list[i].dpa == dpa) {
+                       mock_poison_list[i].cxlds = NULL;
+                       return true;
+               }
+       }
+       return false;
+}
+
+static int mock_clear_poison(struct cxl_dev_state *cxlds,
+                            struct cxl_mbox_cmd *cmd)
+{
+       struct cxl_mbox_clear_poison *pi = cmd->payload_in;
+       u64 dpa = le64_to_cpu(pi->address);
+
+       /*
+        * A real CXL device will write pi->write_data to the address
+        * being cleared. In this mock, just delete this address from
+        * the mock poison list.
+        */
+       if (!mock_poison_del(cxlds, dpa))
+               dev_dbg(cxlds->dev, "DPA: 0x%llx not in poison list\n", dpa);
+
+       return 0;
+}
+
 static int cxl_mock_mbox_send(struct cxl_dev_state *cxlds, struct cxl_mbox_cmd *cmd)
 {
        struct device *dev = cxlds->dev;
@@ -1057,6 +1090,9 @@ static int cxl_mock_mbox_send(struct cxl_dev_state *cxlds, struct cxl_mbox_cmd *
        case CXL_MBOX_OP_INJECT_POISON:
                rc = mock_inject_poison(cxlds, cmd);
                break;
+       case CXL_MBOX_OP_CLEAR_POISON:
+               rc = mock_clear_poison(cxlds, cmd);
+               break;
        default:
                break;
        }