[new][services] add mask identification query

Author: TofMassilia13320

services/stsafea/stsafea_put_query.c

@@ -24,6 +24,8 @@
 
 #ifdef STSE_CONF_STSAFE_A_SUPPORT
 
+#define STSAFEA_SUB_TAG_MASK_ID    		0x01
+
 stse_ReturnCode_t stsafea_put_life_cyle_state(
     stse_Handle_t *pSTSE,
     stsafea_life_cycle_state_t life_cycle_state) {
@@ -147,4 +149,43 @@ stse_ReturnCode_t stsafea_query_i2c_parameters(
                                       stsafea_cmd_timings[pSTSE->device_type][cmd_header]);
 }
 
+stse_ReturnCode_t stsafea_query_mask_id(
+    stse_Handler_t *pSTSE,
+	PLAT_UI8 mask_id[STSAFEA_MASK_ID_SIZE]) {
+    PLAT_UI8 cmd_header = STSAFEA_CMD_QUERY;
+    PLAT_UI8 tag = STSAFEA_SUBJECT_TAG_PRODUCT_DATA;
+    PLAT_UI8 rsp_header;
+    PLAT_UI8 sub_tag;
+    PLAT_UI8 sub_tag_size;
+    stse_ReturnCode_t ret;
+
+    if (pSTSE == NULL) {
+        return (STSE_SERVICE_HANDLER_NOT_INITIALISED);
+    }
+
+    /*- Create CMD frame and populate elements */
+    stse_frame_allocate(CmdFrame);
+    stse_frame_element_allocate_push(&CmdFrame, eCmd_header, 1, &cmd_header);
+    stse_frame_element_allocate_push(&CmdFrame, eTag, 1, &tag);
+
+    /*- Create Rsp frame and populate elements*/
+    stse_frame_allocate(RspFrame);
+    stse_frame_element_allocate_push(&RspFrame, eRsp_header, 1, &rsp_header);
+    stse_frame_element_allocate_push(&RspFrame, e_sub_tag, 1, &sub_tag);
+    stse_frame_element_allocate_push(&RspFrame, e_sub_tag_size, 1, &sub_tag_size);
+    stse_frame_element_allocate_push(&RspFrame, e_mask_id, STSAFEA_MASK_ID_SIZE, mask_id);
+
+    /*- Perform Transfer*/
+    ret = stsafea_frame_raw_transfer(pSTSE,
+                                      &CmdFrame,
+                                      &RspFrame,
+                                      stsafea_cmd_timings[pSTSE->device_type][cmd_header]);
+
+    if (sub_tag != STSAFEA_SUB_TAG_MASK_ID) {
+    	return (STSE_SERVICE_INCOMPATIBLE_DEVICE_TYPE);
+    }
+
+    return ret;
+}
+
 #endif /* STSE_CONF_STSAFE_A_SUPPORT */

services/stsafea/stsafea_put_query.h

@@ -74,6 +74,8 @@
 #define STSAFEA_SUBJECT_TAG_GENERIC_PUBLIC_KEY_SLOT 0x4C                   /*!< Generic public key slot subject-tag */
 #define STSAFEA_SUBJECT_TAG_GENERIC_PUBLIC_KEY_CONFIGURATION_FLAGS 0x4D    /*!< Generic public key configuration flags subject-tag */
 
+#define STSAFEA_MASK_ID_SIZE    3	/*!< Mask identification size */
+
 /*!
  * \enum stsafea_life_cycle_state_t
  * STSAFEA Life cycle state type
@@ -134,16 +136,27 @@ stse_ReturnCode_t stsafea_put_i2c_parameters(
     stsafea_i2c_parameters_t *pI2c_parameters);
 
 /**
- * \brief 		STSAFEA put life cycle service
- * \details 	This service format and send/receive the put life cycle command/response
- * \param[in] 	pSTSE	 			Pointer to STSE Handler
- * \param[out] 	pLife_cycle_state 	Life cycle state
+ * \brief 		STSAFEA query I2C parameters service
+ * \details 	This service format and send/receive the query I2C parameters command/response
+ * \param[in] 	pSTSE	 					Pointer to STSE Handler
+ * \param[out] 	pI2c_parameters 			I2C parameters
  * \return 		\ref STSE_OK on success ; \ref stse_ReturnCode_t error code otherwise
  */
 stse_ReturnCode_t stsafea_query_i2c_parameters(
     stse_Handle_t *pSTSE,
     stsafea_i2c_parameters_t *pI2c_parameters);
 
+/**
+ * \brief 		STSAFEA query mask identification service
+ * \details 	This service format and send/receive the mask identification command/response
+ * \param[in] 	pSTSE	 			Pointer to STSE Handler
+ * \param[out] 	mask_id		 		Mask identification (3 bytes)
+ * \return 		\ref STSE_OK on success ; \ref stse_ReturnCode_t error code otherwise
+ */
+stse_ReturnCode_t stsafea_query_mask_id(
+    stse_Handler_t *pSTSE,
+	PLAT_UI8 mask_id[STSAFEA_MASK_ID_SIZE]);
+
 /** \}*/
 
 #endif /* STSAFEA_PUT_QUERY_H */