firmware: stratix10-svc: extend svc to support RSU feature

Extend Intel Stratix10 service layer driver to support new RSU
DCMF status reporting.

The status of each DCMF is reported. The currently used DCMF is used as
reference, while the other three are compared against it to determine if
they are corrupted.

DCMF = Decision Configuration Management Firmware
RSU = Remote System Update

Signed-off-by: Radu Bacrau <radu.bacrau@intel.com>
Signed-off-by: Ang Tien Sung <tien.sung.ang@intel.com>
Signed-off-by: Kah Jing Lee <kah.jing.lee@intel.com>
Signed-off-by: Dinh Nguyen <dinguyen@kernel.org>
Link: https://lore.kernel.org/r/20220711223140.2307945-5-dinguyen@kernel.org
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

diff --git a/drivers/firmware/stratix10-svc.c b/drivers/firmware/stratix10-svc.c
index 1cf9f4f47b9408a6f8cdfec3b1944b182b5a6799..7fea94fe2ca083bc871e1bb723259a1fedaf912c 100644 (file)
--- a/drivers/firmware/stratix10-svc.c
+++ b/drivers/firmware/stratix10-svc.c
@@ -338,6 +338,7 @@ static void svc_thread_recv_status_ok(struct stratix10_svc_data *p_data,
                break;
        case COMMAND_RSU_RETRY:
        case COMMAND_RSU_MAX_RETRY:
+       case COMMAND_RSU_DCMF_STATUS:
        case COMMAND_FIRMWARE_VERSION:
                cb_data->status = BIT(SVC_STATUS_OK);
                cb_data->kaddr1 = &res.a1;
@@ -518,7 +519,11 @@ static int svc_normal_to_secure_thread(void *data)
                        a1 = (unsigned long)pdata->paddr;
                        a2 = (unsigned long)pdata->size;
                        break;
-
+               case COMMAND_RSU_DCMF_STATUS:
+                       a0 = INTEL_SIP_SMC_RSU_DCMF_STATUS;
+                       a1 = 0;
+                       a2 = 0;
+                       break;
                default:
                        pr_warn("it shouldn't happen\n");
                        break;
@@ -596,8 +601,9 @@ static int svc_normal_to_secure_thread(void *data)
                        pr_err("%s: STATUS_ERROR\n", __func__);
                        cbdata->status = BIT(SVC_STATUS_ERROR);
                        cbdata->kaddr1 = &res.a1;
-                       cbdata->kaddr2 = NULL;
-                       cbdata->kaddr3 = NULL;
+                       cbdata->kaddr2 = (res.a2) ?
+                               svc_pa_to_va(res.a2) : NULL;
+                       cbdata->kaddr3 = (res.a3) ? &res.a3 : NULL;
                        pdata->chan->scl->receive_cb(pdata->chan->scl, cbdata);
                        break;
                default:
@@ -605,12 +611,10 @@ static int svc_normal_to_secure_thread(void *data)
 
                        /*
                         * be compatible with older version firmware which
-                        * doesn't support RSU notify or retry
+                        * doesn't support newer RSU commands
                         */
-                       if ((pdata->command == COMMAND_RSU_RETRY) ||
-                           (pdata->command == COMMAND_RSU_MAX_RETRY) ||
-                           (pdata->command == COMMAND_RSU_NOTIFY) ||
-                           (pdata->command == COMMAND_FIRMWARE_VERSION)) {
+                       if ((pdata->command != COMMAND_RSU_UPDATE) &&
+                               (pdata->command != COMMAND_RSU_STATUS)) {
                                cbdata->status =
                                        BIT(SVC_STATUS_NO_SUPPORT);
                                cbdata->kaddr1 = NULL;

diff --git a/include/linux/firmware/intel/stratix10-smc.h b/include/linux/firmware/intel/stratix10-smc.h
index 8c198984a47cc4a21abd4a3607430268550fe0a2..8fc4aa450517595b60125e438dcae89b75326289 100644 (file)
--- a/include/linux/firmware/intel/stratix10-smc.h
+++ b/include/linux/firmware/intel/stratix10-smc.h
@@ -403,6 +403,27 @@ INTEL_SIP_SMC_FAST_CALL_VAL(INTEL_SIP_SMC_FUNCID_FPGA_CONFIG_COMPLETED_WRITE)
 #define INTEL_SIP_SMC_RSU_MAX_RETRY \
        INTEL_SIP_SMC_FAST_CALL_VAL(INTEL_SIP_SMC_FUNCID_RSU_MAX_RETRY)
 
+/**
+ * Request INTEL_SIP_SMC_RSU_DCMF_STATUS
+ *
+ * Sync call used by service driver at EL1 to query DCMF status from FW
+ *
+ * Call register usage:
+ * a0 INTEL_SIP_SMC_RSU_DCMF_STATUS
+ * a1-7 not used
+ *
+ * Return status
+ * a0 INTEL_SIP_SMC_STATUS_OK
+ * a1 dcmf3 | dcmf2 | dcmf1 | dcmf0
+ *
+ * Or
+ *
+ * a0 INTEL_SIP_SMC_RSU_ERROR
+ */
+#define INTEL_SIP_SMC_FUNCID_RSU_DCMF_STATUS 20
+#define INTEL_SIP_SMC_RSU_DCMF_STATUS \
+       INTEL_SIP_SMC_FAST_CALL_VAL(INTEL_SIP_SMC_FUNCID_RSU_DCMF_STATUS)
+
 /**
  * Request INTEL_SIP_SMC_SERVICE_COMPLETED
  * Sync call to check if the secure world have completed service request

diff --git a/include/linux/firmware/intel/stratix10-svc-client.h b/include/linux/firmware/intel/stratix10-svc-client.h
index 677720792259aeea9b6ae26c02af68c73c188e3a..82a20e62f15f0c570a88de38aa82c5fb073686de 100644 (file)
--- a/include/linux/firmware/intel/stratix10-svc-client.h
+++ b/include/linux/firmware/intel/stratix10-svc-client.h
@@ -114,6 +114,9 @@ struct stratix10_svc_chan;
  * @COMMAND_FIRMWARE_VERSION: query running firmware version, return status
  * is SVC_STATUS_OK or SVC_STATUS_ERROR
  *
+ * @COMMAND_RSU_DCMF_STATUS: query firmware for the DCMF status
+ * return status is SVC_STATUS_OK or SVC_STATUS_ERROR
+ *
  * @COMMAND_FCS_REQUEST_SERVICE: request validation of image from firmware,
  * return status is SVC_STATUS_OK, SVC_STATUS_INVALID_PARAM
  *
@@ -146,6 +149,7 @@ enum stratix10_svc_command_code {
        COMMAND_RSU_RETRY,
        COMMAND_RSU_MAX_RETRY,
        COMMAND_RSU_DCMF_VERSION,
+       COMMAND_RSU_DCMF_STATUS,
        COMMAND_FIRMWARE_VERSION,
        /* for FCS */
        COMMAND_FCS_REQUEST_SERVICE = 20,