conn_fwloader: write CAU temperature to FW before DPD training

write CAU temperature to FW before DPD training

Signed-off-by: Maochen Wang <[email protected]>

Author: MaochenWang1

mcux/mcux-sdk-ng/components/conn_fwloader/fsl_loader.c

@@ -56,6 +56,30 @@ void power_off_device(LOAD_Target_Type loadTarget)
 {
     power_off_device_impl(loadTarget);
 }
+
+////////////////////////////////////////////////////////////////////////////
+//! @brief write temperature to FW
+////////////////////////////////////////////////////////////////////////////
+int32_t cau_temperature_write_to_firmware(void)
+{
+    return cau_temperature_write_to_firmware_impl();
+}
+
+////////////////////////////////////////////////////////////////////////////
+//! @brief get cau temperature
+////////////////////////////////////////////////////////////////////////////
+int32_t cau_get_temperature(void)
+{
+    return cau_get_temperature_impl();
+}
+
+////////////////////////////////////////////////////////////////////////////
+//! @brief enable cau temperature
+////////////////////////////////////////////////////////////////////////////
+void cau_temperature_enable(void)
+{
+    cau_temperature_enable_impl();
+}
 //! @}
 ////////////////////////////////////////////////////////////////////////////
 // EOF

mcux/mcux-sdk-ng/components/conn_fwloader/fsl_loader_utils.c

@@ -1330,6 +1330,90 @@ static int __OtpDeInit(void)
     return ret;
 }
 
+void cau_temperature_enable_impl(void)
+{
+    uint32_t val;
+
+    val = CAU_REG32(CAU_ENABLE_ADDR);
+    val &= ~(0xC);
+    val |= (2 << 2);
+    CAU_WRITE_REG32(CAU_ENABLE_ADDR, val);
+    OSA_TimeDelay(1);
+}
+
+int32_t cau_get_temperature_impl(void)
+{
+    int32_t val                   = 0;
+    uint32_t reg_val              = 0;
+    uint32_t temp_Cau_Raw_Reading = 0;
+    status_t status               = 0;
+    uint32_t board_type           = 0;
+
+    reg_val              = CAU_REG32(CAU_TEMPERATURE_ADDR);
+    temp_Cau_Raw_Reading = ((reg_val & 0XFFC00) >> 10);
+
+    OCOTP_OtpInit();
+    status = OCOTP_ReadPackage(&board_type);
+    if (status != kStatus_Success)
+    {
+        /*If status error, use BGA as default type*/
+        board_type = RW610_PACKAGE_TYPE_BGA;
+    }
+    OCOTP_OtpDeinit();
+
+    switch (board_type)
+    {
+        case RW610_PACKAGE_TYPE_QFN:
+            val = (((((int32_t)(temp_Cau_Raw_Reading)) * 484260) - 220040600) / 1000000);
+            break;
+
+        case RW610_PACKAGE_TYPE_CSP:
+            val = (((((int32_t)(temp_Cau_Raw_Reading)) * 480560) - 220707000) / 1000000);
+            break;
+
+        case RW610_PACKAGE_TYPE_BGA:
+            val = (((((int32_t)(temp_Cau_Raw_Reading)) * 480561) - 220707400) / 1000000);
+            break;
+
+        default:
+            val = (((((int32_t)(temp_Cau_Raw_Reading)) * 480561) - 220707400) / 1000000);
+            break;
+    }
+
+    return val;
+}
+
+int32_t cau_temperature_write_to_firmware_impl()
+{
+    int32_t val = 0;
+
+    val = cau_get_temperature_impl();
+    CAU_WRITE_REG32(CAU_TEMPERATURE_FW_ADDR, val);
+    return val;
+}
+
+static void cau_pmip_v33_enable()
+{
+    uint32_t val;
+
+    val = CAU_REG32(CAU_PMIP_TSEN_ADDR);
+    val &= ~(0xE);
+    val |= (5 << 1);
+    CAU_WRITE_REG32(CAU_PMIP_TSEN_ADDR, val);
+
+    val = CAU_REG32(CAU_V33_VSEN_ADDR);
+    val &= ~(0xE);
+    val |= (5 << 1);
+    CAU_WRITE_REG32(CAU_V33_VSEN_ADDR, val);
+
+    val = CAU_REG32(CAU_ADC_CTRL_ADDR);
+    val |= 1 << 0;
+    CAU_WRITE_REG32(CAU_ADC_CTRL_ADDR, val);
+
+    val = CAU_REG32(CAU_ADC_CTRL_ADDR);
+    val &= ~(1 << 0);
+    CAU_WRITE_REG32(CAU_ADC_CTRL_ADDR, val);
+}
 
 ////////////////////////////////////////////////////////////////////////////
 //! @brief load service
@@ -1497,6 +1581,10 @@ status_t load_service(LOAD_Target_Type loadTarget, uint32_t sourceAddr)
         (void)__OtpDeInit();
     }
 
+    cau_temperature_enable_impl();
+    cau_pmip_v33_enable();
+    cau_temperature_write_to_firmware_impl();
+
     if (status == kStatus_Success)
     {
         reset_device(loadTarget);
@@ -1586,6 +1674,10 @@ static status_t load_service_monolithic(LOAD_Target_Type loadTarget, uint32_t so
         (void)__OtpDeInit();
     }
 
+    cau_temperature_enable_impl();
+    cau_pmip_v33_enable();
+    cau_temperature_write_to_firmware_impl();
+
     if (status == kStatus_Success)
     {
         reset_device(loadTarget);

mcux/mcux-sdk-ng/components/conn_fwloader/include/fsl_loader.h

@@ -29,6 +29,9 @@ void power_off_device(LOAD_Target_Type loadTarget);
 
 status_t sb3_fw_download(LOAD_Target_Type loadTarget, uint32_t flag, uint32_t sourceAddr);
 status_t sb3_fw_reset(LOAD_Target_Type loadTarget, uint32_t flag, uint32_t sourceAddr);
+int32_t cau_temperature_write_to_firmware(void);
+int32_t cau_get_temperature(void);
+void cau_temperature_enable(void);
 
 //! @}
 

mcux/mcux-sdk-ng/components/conn_fwloader/include/fsl_loader_utils.h

@@ -117,6 +117,22 @@ typedef uint32_t fsl_nboot_status_t;
 #define kNBOOT_RootKeyUsage_DebugCA_ImageCA_FwCA_ImageKey_FwKey (0x0u)
 #define kNBOOT_RootKeyUsage_Unused                              (0x7u)
 
+   /*! @brief The cau registers. */
+#define CAU_ENABLE_ADDR         (0x45004008U)
+#define CAU_TEMPERATURE_ADDR    (0x4500400CU)
+#define CAU_TEMPERATURE_FW_ADDR (0x41382490U)
+#define CAU_FW_WAKE_STATUS_ADDR     (0x40031068U)
+#define CAU_PMIP_TSEN_ADDR          (0x45004010U)
+#define CAU_V33_VSEN_ADDR           (0x45004028U)
+#define CAU_ADC_CTRL_ADDR           (0x45004000U)
+
+#define RW610_PACKAGE_TYPE_QFN 0
+#define RW610_PACKAGE_TYPE_CSP 1
+#define RW610_PACKAGE_TYPE_BGA 2
+
+#define CAU_REG32(x) (*(volatile unsigned int *)(x))
+#define CAU_WRITE_REG32(reg, val) (CAU_REG32(reg) = (val))
+
 //! @brief SB loader status codes.
 enum _sbloader_status
 {
@@ -663,7 +679,9 @@ status_t loader_process_sb_file(uint32_t readOffset);
 status_t fsl_sbloader_init(fsl_api_core_context_t *ctx);
 status_t fsl_sbloader_finalize(fsl_api_core_context_t *ctx);
 uint8_t get_chip_revision(void);
-
+int32_t cau_temperature_write_to_firmware_impl(void);
+int32_t cau_get_temperature_impl(void);
+void cau_temperature_enable_impl(void);
 //! @}
 
 #endif /* __FSL_LOADER_UTILS_H__ */