Browse Source

sleep retention: wraps the regdma link and hardware driver to provide system sleep retention (WiFi, BLE, 15.4 and digital peripheral) support

Li Shuai 3 years ago
parent
commit
d097bbe40b

+ 4 - 0
components/esp_hw_support/CMakeLists.txt

@@ -34,6 +34,10 @@ if(NOT BOOTLOADER_BUILD)
         list(APPEND srcs "sleep_cpu.c")
     endif()
 
+    if(CONFIG_SOC_PAU_SUPPORTED)
+        list(APPEND srcs "sleep_retention.c")
+    endif()
+
     # [refactor-todo]: requires "driver" for GPIO and RTC  (by sleep_gpio and sleep_modes)
     list(APPEND priv_requires driver esp_timer)
 

+ 120 - 0
components/esp_hw_support/include/esp_private/sleep_retention.h

@@ -0,0 +1,120 @@
+/*
+ * SPDX-FileCopyrightText: 2022-2023 Espressif Systems (Shanghai) CO LTD
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ */
+
+#pragma once
+#include <stdint.h>
+#include "sdkconfig.h"
+#include "soc/soc_caps.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#if SOC_PAU_SUPPORTED
+#include "esp_regdma.h"
+
+/**
+ * @file sleep_retention.h
+ *
+ * This file contains declarations of sleep retention related functions, it
+ * includes sleep retention list creation, destruction and debugging interfaces.
+ */
+
+typedef enum sleep_retention_module_bitmap {
+    /* clock module, which includes system and modem */
+    SLEEP_RETENTION_MODULE_CLOCK_SYSTEM = BIT(1),
+    SLEEP_RETENTION_MODULE_CLOCK_MODEM  = BIT(2),
+
+    /* modem module, which includes WiFi, BLE and 802.15.4 */
+    SLEEP_RETENTION_MODULE_WIFI_MAC     = BIT(10),
+    SLEEP_RETENTION_MODULE_WIFI_BB      = BIT(11),
+    SLEEP_RETENTION_MODULE_BLE_MAC      = BIT(12),
+    SLEEP_RETENTION_MODULE_BLE_BB       = BIT(13),
+    SLEEP_RETENTION_MODULE_802154_MAC   = BIT(14),
+    SLEEP_RETENTION_MODULE_802154_BB    = BIT(15),
+
+    /* digital peripheral module, which includes Interrupt Matrix, HP_SYSTEM,
+     * TEE, APM, UART, Timer Group, IOMUX, SPIMEM, SysTimer, etc.. */
+    SLEEP_RETENTION_MODULE_INTR_MATRIX  = BIT(16),
+    SLEEP_RETENTION_MODULE_HP_SYSTEM    = BIT(17),
+    SLEEP_RETENTION_MODULE_TEE_APM      = BIT(18),
+    SLEEP_RETENTION_MODULE_UART0        = BIT(19),
+    SLEEP_RETENTION_MODULE_TG0          = BIT(20),
+    SLEEP_RETENTION_MODULE_IOMUX        = BIT(21),
+    SLEEP_RETENTION_MODULE_SPIMEM       = BIT(22),
+    SLEEP_RETENTION_MODULE_SYSTIMER     = BIT(23),
+
+    SLEEP_RETENTION_MODULE_ALL          = (uint32_t)-1
+} sleep_retention_module_bitmap_t;
+
+typedef regdma_entry_buf_t sleep_retention_entries_t;
+
+typedef struct {
+    regdma_link_config_t    config;
+    uint32_t                owner;  /**< Indicates which regdma entries the current node will insert into */
+} sleep_retention_entries_config_t;
+
+/**
+ * @brief Create a runtime sleep retention linked list
+ *
+ * @param retent   sleep retention linked list node configuration table
+ * @param num      the total number of sleep retention linked list configuration
+ *                 items
+ * @param priority the priority of the created sleep retention linked list
+ * @param module   the bitmap of the module to which the created sleep retention
+ *                 linked list belongs
+ * @return
+ *      - ESP_OK on success
+ *      - ESP_ERR_NO_MEM not enough memory for sleep retention
+ *      - ESP_ERR_INVALID_ARG if either of the arguments is out of range
+ */
+esp_err_t sleep_retention_entries_create(const sleep_retention_entries_config_t retent[], int num, regdma_link_priority_t priority, int module);
+
+/**
+ * @brief Destroy a runtime sleep retention linked list
+ *
+ * @param module   the bitmap of the module to be destroyed
+ */
+void sleep_retention_entries_destroy(int module);
+
+/**
+ * @brief Print all runtime sleep retention linked lists
+ */
+void sleep_retention_entries_show_memories(void);
+
+/**
+ * @brief Find the linked list node with the unique id
+ *
+ * @param  id the unique identifier of specified linked list node
+ *
+ * @return NULL or the address of the linked list node found
+ */
+void * sleep_retention_find_link_by_id(int id);
+
+/**
+ * @brief Get the head pointer of all entry linked list of REGDMA
+ *
+ * @param  entries buffer for getting results
+ */
+void sleep_retention_entries_get(sleep_retention_entries_t *entries);
+
+/**
+ * @brief Get all registered modules that require sleep retention
+ *
+ * This is an unprotected interface for getting a bitmap of all modules that
+ * require sleep retention.
+ *
+ * It can only be called by the sleep procedure.
+ *
+ * @return the bitmap of all modules requiring sleep retention
+ */
+uint32_t sleep_retention_get_modules(void);
+
+#endif // SOC_PAU_SUPPORTED
+
+#ifdef __cplusplus
+}
+#endif

+ 463 - 0
components/esp_hw_support/sleep_retention.c

@@ -0,0 +1,463 @@
+/*
+ * SPDX-FileCopyrightText: 2022-2023 Espressif Systems (Shanghai) CO LTD
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ */
+
+#include <stddef.h>
+#include <string.h>
+#include <sys/lock.h>
+#include <sys/param.h>
+
+#include "esp_attr.h"
+#include "esp_log.h"
+#include "esp_heap_caps.h"
+#include "soc/soc_caps.h"
+#include "esp_private/esp_regdma.h"
+#include "esp_private/esp_pau.h"
+#include "esp_private/sleep_retention.h"
+#include "sdkconfig.h"
+#include "esp_pmu.h"
+
+
+static __attribute__((unused)) const char *TAG = "sleep";
+
+/**
+ * Internal structure which holds all requested sleep retention parameters
+ */
+typedef struct {
+    /* The hardware retention module (REGDMA and PMU) uses 4 linked lists to
+     * record the hardware context information that needs to be backed up and
+     * restored when switching between different power states. The 4 linked
+     * lists are linked by 8 types of nodes. The 4 linked lists can reuse some
+     * nodes with each other, or separate their own unique nodes after branch
+     * type nodes.
+     * The REGDMA module iterates the entire linked list from the head of a
+     * linked list and backs up and restores the corresponding register context
+     * information according to the configuration information of the linked list
+     * nodes.
+     * The PMU module triggers REGDMA to use the corresponding linked list when
+     * swtiching between different power states. For example:
+     *
+     *  Current power state     Next power state   This entry will be used by REGDMA
+     *     PMU_HP_ACTIVE          PMU_HP_SLEEP       entry0
+     *     PMU_HP_SLEEP           PMU_HP_ACTIVE      entry0
+     *     PMU_HP_MODEM           PMU_HP_SLEEP       entry1
+     *     PMU_HP_SLEEP           PMU_HP_MODEM       entry1
+     *     PMU_HP_MODEM           PMU_HP_ACTIVE      entry2
+     *
+     *           +--------+    +-------------------------+    +-------------+                            +-----------+    +--------+    +-----+
+     * entry2 -> |        | -> | WiFi MAC Minimum System | -> |             | -------------------------> |           | -> |        | -> | End |
+     *           |  SOC   |    +-------------------------+    |   Digital   |                            | Bluetooth |    | Zigbee |    +-----+
+     *           | System |             +--------+            | Peripherals |    +------+    +------+    |   / BLE   |    |        |    +-----+
+     * entry0 -> |        | ----------> |        | ---------> |             | -> |      | -> |      | -> |           | -> |        | -> | End |
+     *           +--------+             | Modem  |            +-------------+    | WiFi |    | WiFi |    +-----------+    +--------+    +-----+
+     *                                  | System |                               | MAC  |    |  BB  |    +-----+
+     * entry1 ------------------------> |        |-----------------------------> |      | -> |      | -> | End |
+     *                                  +--------+                               +------+    +------+    +-----+
+     */
+#define SLEEP_RETENTION_REGDMA_LINK_NR_PRIORITIES       (8u)
+#define SLEEP_RETENTION_REGDMA_LINK_HIGHEST_PRIORITY    (0)
+#define SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY     (SLEEP_RETENTION_REGDMA_LINK_NR_PRIORITIES - 1)
+    struct {
+        sleep_retention_entries_t entries;
+        uint32_t entries_bitmap: REGDMA_LINK_ENTRY_NUM,
+                 runtime_bitmap: REGDMA_LINK_ENTRY_NUM,
+                 reserved: 32-(2*REGDMA_LINK_ENTRY_NUM);
+        void *entries_tail;
+    } lists[SLEEP_RETENTION_REGDMA_LINK_NR_PRIORITIES];
+    _lock_t lock;
+    regdma_link_priority_t highpri;
+    uint32_t modules;
+} sleep_retention_t;
+
+static DRAM_ATTR __attribute__((unused)) sleep_retention_t s_retention = { .highpri = (uint8_t)-1, .modules = 0 };
+
+#define SLEEP_RETENTION_ENTRY_BITMAP_MASK       (BIT(REGDMA_LINK_ENTRY_NUM) - 1)
+#define SLEEP_RETENTION_ENTRY_BITMAP(bitmap)    ((bitmap) & SLEEP_RETENTION_ENTRY_BITMAP_MASK)
+
+static esp_err_t sleep_retention_entries_create_impl(const sleep_retention_entries_config_t retent[], int num, regdma_link_priority_t priority, int module);
+static void sleep_retention_entries_join(void);
+
+static inline bool sleep_retention_entries_require_branch(uint32_t owner, uint32_t runtime_bitmap)
+{
+    bool use_new_entry      = SLEEP_RETENTION_ENTRY_BITMAP(owner & ~runtime_bitmap) ? true : false;
+    bool intersection_exist = SLEEP_RETENTION_ENTRY_BITMAP(owner &  runtime_bitmap) ? true : false;
+    return use_new_entry && intersection_exist;
+}
+
+static esp_err_t sleep_retention_entries_check_and_create_default(uint32_t owner, uint32_t runtime_bitmap, uint32_t entries_bitmap, regdma_link_priority_t priority, uint32_t module)
+{
+    assert(sleep_retention_entries_require_branch(owner, runtime_bitmap));
+
+    static sleep_retention_entries_config_t dummy = { REGDMA_LINK_WAIT_INIT(0xffff, 0, 0, 0, 1, 1), 0 };
+    dummy.owner = SLEEP_RETENTION_ENTRY_BITMAP(owner & ~entries_bitmap);
+    if (dummy.owner) {
+        return sleep_retention_entries_create_impl(&dummy, 1, priority, module);
+    }
+    return ESP_OK;
+}
+
+static esp_err_t sleep_retention_entries_check_and_create_final_default(void)
+{
+    static const sleep_retention_entries_config_t final_dummy = { REGDMA_LINK_WAIT_INIT(0xffff, 0, 0, 0, 1, 1), SLEEP_RETENTION_ENTRY_BITMAP_MASK };
+
+    esp_err_t err = ESP_OK;
+    _lock_acquire_recursive(&s_retention.lock);
+    if (s_retention.lists[SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY].entries_bitmap == 0) {
+        err = sleep_retention_entries_create_impl(&final_dummy, 1, SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY, 0);
+    }
+    _lock_release_recursive(&s_retention.lock);
+    return err;
+}
+
+static void sleep_retention_entries_update(uint32_t owner, void *new_link, regdma_link_priority_t priority)
+{
+    _lock_acquire_recursive(&s_retention.lock);
+    sleep_retention_entries_t retention_entries = {
+        (owner & BIT(0)) ? new_link : s_retention.lists[priority].entries[0],
+        (owner & BIT(1)) ? new_link : s_retention.lists[priority].entries[1],
+        (owner & BIT(2)) ? new_link : s_retention.lists[priority].entries[2],
+        (owner & BIT(3)) ? new_link : s_retention.lists[priority].entries[3]
+    };
+    if (s_retention.lists[priority].entries_bitmap == 0) {
+        s_retention.lists[priority].entries_tail = new_link;
+    }
+    memcpy(s_retention.lists[priority].entries, retention_entries, sizeof(sleep_retention_entries_t));
+    s_retention.lists[priority].runtime_bitmap  = owner;
+    s_retention.lists[priority].entries_bitmap |= owner;
+    _lock_release_recursive(&s_retention.lock);
+}
+
+static void * sleep_retention_entries_try_create(const regdma_link_config_t *config, uint32_t owner, regdma_link_priority_t priority, uint32_t module)
+{
+    void *link = NULL;
+    assert(owner > 0 && owner < BIT(REGDMA_LINK_ENTRY_NUM));
+
+    _lock_acquire_recursive(&s_retention.lock);
+    if (sleep_retention_entries_require_branch(owner, s_retention.lists[priority].runtime_bitmap)) {
+        if (sleep_retention_entries_check_and_create_default(owner, s_retention.lists[priority].runtime_bitmap,
+            s_retention.lists[priority].entries_bitmap, priority, module) == ESP_OK) { /* branch node can't as tail node */
+            link = regdma_link_init_safe(
+                        config, true, module,
+                        (owner & BIT(0)) ? s_retention.lists[priority].entries[0] : NULL,
+                        (owner & BIT(1)) ? s_retention.lists[priority].entries[1] : NULL,
+                        (owner & BIT(2)) ? s_retention.lists[priority].entries[2] : NULL,
+                        (owner & BIT(3)) ? s_retention.lists[priority].entries[3] : NULL
+                    );
+        }
+    } else {
+        link = regdma_link_init_safe(config, false, module, s_retention.lists[priority].entries[__builtin_ffs(owner) - 1]);
+    }
+    _lock_release_recursive(&s_retention.lock);
+    return link;
+}
+
+static void * sleep_retention_entries_try_create_bonding(const regdma_link_config_t *config, uint32_t owner, regdma_link_priority_t priority, uint32_t module)
+{
+    assert(owner > 0 && owner < BIT(REGDMA_LINK_ENTRY_NUM));
+    _lock_acquire_recursive(&s_retention.lock);
+    void *link = regdma_link_init_safe(
+                config, true, module,
+                (owner & BIT(0)) ? s_retention.lists[priority].entries[0] : NULL,
+                (owner & BIT(1)) ? s_retention.lists[priority].entries[1] : NULL,
+                (owner & BIT(2)) ? s_retention.lists[priority].entries[2] : NULL,
+                (owner & BIT(3)) ? s_retention.lists[priority].entries[3] : NULL
+            );
+    _lock_release_recursive(&s_retention.lock);
+    return link;
+}
+
+static void sleep_retention_entries_stats(void)
+{
+    _lock_acquire_recursive(&s_retention.lock);
+    if (s_retention.highpri >= SLEEP_RETENTION_REGDMA_LINK_HIGHEST_PRIORITY && s_retention.highpri <= SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY) {
+        for (int entry = 0; entry < ARRAY_SIZE(s_retention.lists[s_retention.highpri].entries); entry++) {
+            regdma_link_stats(s_retention.lists[s_retention.highpri].entries[entry], entry);
+        }
+    }
+    _lock_release_recursive(&s_retention.lock);
+}
+
+#if REGDMA_LINK_DBG
+void sleep_retention_entries_show_memories(void)
+{
+    if (&s_retention.lock) {
+        _lock_acquire_recursive(&s_retention.lock);
+        if (s_retention.highpri >= SLEEP_RETENTION_REGDMA_LINK_HIGHEST_PRIORITY && s_retention.highpri <= SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY) {
+            for (int entry = 0; entry < ARRAY_SIZE(s_retention.lists[s_retention.highpri].entries); entry++) {
+                ESP_LOGW(TAG, "Print sleep retention entries[%d] memories:", entry);
+                regdma_link_show_memories(s_retention.lists[s_retention.highpri].entries[entry], entry);
+            }
+        }
+        _lock_release_recursive(&s_retention.lock);
+    }
+}
+#endif
+
+void * sleep_retention_find_link_by_id(int id)
+{
+    void *link = NULL;
+    if (&s_retention.lock) {
+        _lock_acquire_recursive(&s_retention.lock);
+        if (s_retention.highpri >= SLEEP_RETENTION_REGDMA_LINK_HIGHEST_PRIORITY &&
+            s_retention.highpri <= SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY) {
+            for (int entry = 0; (link == NULL && entry < ARRAY_SIZE(s_retention.lists[s_retention.highpri].entries)); entry++) {
+                link = regdma_find_link_by_id(s_retention.lists[s_retention.highpri].entries[entry], entry, id);
+            }
+        }
+        _lock_release_recursive(&s_retention.lock);
+    }
+    return link;
+}
+
+static uint32_t sleep_retention_entries_owner_bitmap(sleep_retention_entries_t *entries, sleep_retention_entries_t *tails)
+{
+    uint32_t owner = 0;
+    _lock_acquire_recursive(&s_retention.lock);
+    for (int entry = 0; entry < ARRAY_SIZE(*entries); entry++) {
+        owner |= regdma_link_get_owner_bitmap((*entries)[entry], (*tails)[entry], entry);
+    }
+    _lock_release_recursive(&s_retention.lock);
+    return owner;
+}
+
+static bool sleep_retention_entries_get_destroy_context(regdma_link_priority_t priority, uint32_t module, sleep_retention_entries_t *destroy_entries, void **destroy_tail, sleep_retention_entries_t *next_entries, void **prev_tail)
+{
+    bool exist = false;
+    sleep_retention_entries_t destroy_tails, prev_tails;
+
+    memset(&destroy_tails, 0, sizeof(sleep_retention_entries_t));
+    memset(&prev_tails, 0, sizeof(sleep_retention_entries_t));
+
+    _lock_acquire_recursive(&s_retention.lock);
+    for (int entry = 0; entry < ARRAY_SIZE(s_retention.lists[priority].entries); entry++) {
+        (*destroy_entries)[entry] = regdma_find_module_link_head(
+                s_retention.lists[priority].entries[entry], s_retention.lists[priority].entries_tail, entry, module);
+        destroy_tails     [entry] = regdma_find_module_link_tail(
+                s_retention.lists[priority].entries[entry], s_retention.lists[priority].entries_tail, entry, module);
+        (*next_entries)   [entry] = regdma_find_next_module_link_head(
+                s_retention.lists[priority].entries[entry], s_retention.lists[priority].entries_tail, entry, module);
+        prev_tails        [entry] = regdma_find_prev_module_link_tail(
+                s_retention.lists[priority].entries[entry], s_retention.lists[priority].entries_tail, entry, module);
+        if ((*destroy_entries)[entry] && destroy_tails[entry]) {
+            exist = true;
+        }
+        assert(destroy_tails[entry] == destroy_tails[0]);
+        assert(prev_tails[entry] == prev_tails[0]);
+    }
+    *destroy_tail = destroy_tails[0];
+    *prev_tail = prev_tails[0];
+    _lock_release_recursive(&s_retention.lock);
+    return exist;
+}
+
+static void sleep_retention_entries_context_update(regdma_link_priority_t priority)
+{
+    _lock_acquire_recursive(&s_retention.lock);
+    sleep_retention_entries_t tails = {
+        s_retention.lists[priority].entries_tail, s_retention.lists[priority].entries_tail,
+        s_retention.lists[priority].entries_tail, s_retention.lists[priority].entries_tail
+    };
+    s_retention.lists[priority].entries_bitmap = sleep_retention_entries_owner_bitmap(&s_retention.lists[priority].entries, &tails);
+    s_retention.lists[priority].runtime_bitmap = sleep_retention_entries_owner_bitmap(&s_retention.lists[priority].entries, &s_retention.lists[priority].entries);
+    _lock_release_recursive(&s_retention.lock);
+}
+
+static bool sleep_retention_entries_dettach(regdma_link_priority_t priority, sleep_retention_entries_t *destroy_entries, void *destroy_tail, sleep_retention_entries_t *next_entries, void *prev_tail)
+{
+    _lock_acquire_recursive(&s_retention.lock);
+    bool is_head = (memcmp(destroy_entries, &s_retention.lists[priority].entries, sizeof(sleep_retention_entries_t)) == 0);
+    bool is_tail = (destroy_tail == s_retention.lists[priority].entries_tail);
+
+    if (is_head && is_tail) {
+        memset(s_retention.lists[priority].entries, 0, sizeof(sleep_retention_entries_t));
+        s_retention.lists[priority].entries_tail = NULL;
+    } else if (is_head) {
+        memcpy(&s_retention.lists[priority].entries, next_entries, sizeof(sleep_retention_entries_t));
+    } else if (is_tail) {
+        s_retention.lists[priority].entries_tail = prev_tail;
+    } else {
+        regdma_link_update_next_safe(prev_tail, (*next_entries)[0], (*next_entries)[1], (*next_entries)[2], (*next_entries)[3]);
+    }
+    sleep_retention_entries_context_update(priority);
+
+    regdma_link_update_next_safe(destroy_tail, NULL, NULL, NULL, NULL);
+    _lock_release_recursive(&s_retention.lock);
+    return (is_head || is_tail);
+}
+
+static void sleep_retention_entries_destroy_wrapper(sleep_retention_entries_t *destroy_entries)
+{
+    for (int entry = 0; entry < ARRAY_SIZE(*destroy_entries); entry++) {
+        regdma_link_destroy((*destroy_entries)[entry], entry);
+    }
+}
+
+static void sleep_retention_entries_check_and_distroy_final_default(void)
+{
+    _lock_acquire_recursive(&s_retention.lock);
+    assert(s_retention.highpri == SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY);
+    assert(s_retention.modules == 0);
+    sleep_retention_entries_destroy_wrapper(&s_retention.lists[SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY].entries);
+    _lock_release_recursive(&s_retention.lock);
+}
+
+static void sleep_retention_entries_all_destroy_wrapper(uint32_t module)
+{
+    void *destroy_tail = NULL, *prev_tail = NULL;
+    sleep_retention_entries_t destroy_entries, next_entries;
+
+    memset(&destroy_entries, 0, sizeof(sleep_retention_entries_t));
+    memset(&next_entries, 0, sizeof(sleep_retention_entries_t));
+
+    _lock_acquire_recursive(&s_retention.lock);
+    regdma_link_priority_t priority = 0;
+    do {
+        bool exist = sleep_retention_entries_get_destroy_context(priority, module, &destroy_entries, &destroy_tail, &next_entries, &prev_tail);
+        if (s_retention.lists[priority].entries_bitmap && exist) {
+            if (sleep_retention_entries_dettach(priority, &destroy_entries, destroy_tail, &next_entries, prev_tail)) {
+                sleep_retention_entries_join();
+            }
+            sleep_retention_entries_destroy_wrapper(&destroy_entries);
+        } else {
+            priority++;
+        }
+    } while (priority < SLEEP_RETENTION_REGDMA_LINK_NR_PRIORITIES);
+    s_retention.modules &= ~module;
+    _lock_release_recursive(&s_retention.lock);
+}
+
+void sleep_retention_entries_destroy(int module)
+{
+    assert(module != 0);
+    if (&s_retention.lock) {
+        _lock_acquire_recursive(&s_retention.lock);
+        sleep_retention_entries_join();
+        sleep_retention_entries_stats();
+        sleep_retention_entries_all_destroy_wrapper(module);
+        if (s_retention.modules == 0) {
+            sleep_retention_entries_check_and_distroy_final_default();
+            pmu_sleep_disable_regdma_backup();
+            memset((void *)s_retention.lists, 0, sizeof(s_retention.lists));
+            s_retention.highpri = (uint8_t)-1;
+            _lock_release_recursive(&s_retention.lock);
+            _lock_close_recursive(&s_retention.lock);
+            s_retention.lock = NULL;
+            return;
+        }
+        _lock_acquire_recursive(&s_retention.lock);
+    }
+}
+
+static esp_err_t sleep_retention_entries_create_impl(const sleep_retention_entries_config_t retent[], int num, regdma_link_priority_t priority, int module)
+{
+    _lock_acquire_recursive(&s_retention.lock);
+    for (int i = num - 1; i >= 0; i--) {
+        void *link = sleep_retention_entries_try_create(&retent[i].config, retent[i].owner, priority, module);
+        if (link == NULL) {
+            _lock_release_recursive(&s_retention.lock);
+            sleep_retention_entries_destroy(module);
+            return ESP_ERR_NO_MEM;
+        }
+        sleep_retention_entries_update(retent[i].owner, link, priority);
+    }
+    _lock_release_recursive(&s_retention.lock);
+    return ESP_OK;
+}
+
+static esp_err_t sleep_retention_entries_create_bonding(regdma_link_priority_t priority, uint32_t module)
+{
+    static const sleep_retention_entries_config_t bonding_dummy = { REGDMA_LINK_WAIT_INIT(0xffff, 0, 0, 0, 1, 1), SLEEP_RETENTION_ENTRY_BITMAP_MASK };
+
+    _lock_acquire_recursive(&s_retention.lock);
+    void *link = sleep_retention_entries_try_create_bonding(&bonding_dummy.config, bonding_dummy.owner, priority, module);
+    if (link == NULL) {
+        _lock_release_recursive(&s_retention.lock);
+        sleep_retention_entries_destroy(module);
+        return ESP_ERR_NO_MEM;
+    }
+    sleep_retention_entries_update(bonding_dummy.owner, link, priority);
+    _lock_release_recursive(&s_retention.lock);
+    return ESP_OK;
+}
+
+static void sleep_retention_entries_join(void)
+{
+    void *entries_tail = NULL;
+    _lock_acquire_recursive(&s_retention.lock);
+    s_retention.highpri = SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY;
+    for (regdma_link_priority_t priority = 0; priority < SLEEP_RETENTION_REGDMA_LINK_NR_PRIORITIES; priority++) {
+        if (s_retention.lists[priority].entries_bitmap == 0) continue;
+        if (priority < s_retention.highpri) { s_retention.highpri = priority; }
+        if (entries_tail) {
+            regdma_link_update_next_safe(
+                    entries_tail,
+                    s_retention.lists[priority].entries[0],
+                    s_retention.lists[priority].entries[1],
+                    s_retention.lists[priority].entries[2],
+                    s_retention.lists[priority].entries[3]
+                );
+        }
+        entries_tail = s_retention.lists[priority].entries_tail;
+    }
+    pau_regdma_set_entry_link_addr(&(s_retention.lists[s_retention.highpri].entries));
+    _lock_release_recursive(&s_retention.lock);
+}
+
+static esp_err_t sleep_retention_entries_create_wrapper(const sleep_retention_entries_config_t retent[], int num, regdma_link_priority_t priority, uint32_t module)
+{
+    _lock_acquire_recursive(&s_retention.lock);
+    esp_err_t err = sleep_retention_entries_create_bonding(priority, module);
+    if(err) goto error;
+    err = sleep_retention_entries_create_impl(retent, num, priority, module);
+    if(err) goto error;
+    err = sleep_retention_entries_create_bonding(priority, module);
+    if(err) goto error;
+    s_retention.modules |= module;
+    sleep_retention_entries_join();
+
+error:
+    _lock_release_recursive(&s_retention.lock);
+    return err;
+}
+
+esp_err_t sleep_retention_entries_create(const sleep_retention_entries_config_t retent[], int num, regdma_link_priority_t priority, int module)
+{
+    if (!(retent && num > 0 && (priority < SLEEP_RETENTION_REGDMA_LINK_NR_PRIORITIES) && (module != 0))) {
+        return ESP_ERR_INVALID_ARG;
+    }
+    if (s_retention.lock == NULL) {
+        _lock_init_recursive(&s_retention.lock);
+        if (s_retention.lock == NULL) {
+            ESP_LOGE(TAG, "Create sleep retention lock failed");
+            return ESP_ERR_NO_MEM;
+        }
+    }
+    esp_err_t err = sleep_retention_entries_check_and_create_final_default();
+    if (err)  goto error;
+    err = sleep_retention_entries_create_wrapper(retent, num, priority, module);
+    if (err)  goto error;
+    pmu_sleep_enable_regdma_backup();
+
+error:
+    return err;
+}
+
+void sleep_retention_entries_get(sleep_retention_entries_t *entries)
+{
+    memset(entries, 0, sizeof(sleep_retention_entries_t));
+    if (&s_retention.lock) {
+        _lock_acquire_recursive(&s_retention.lock);
+        if (s_retention.highpri >= SLEEP_RETENTION_REGDMA_LINK_HIGHEST_PRIORITY &&
+            s_retention.highpri <= SLEEP_RETENTION_REGDMA_LINK_LOWEST_PRIORITY) {
+            memcpy(entries, &s_retention.lists[s_retention.highpri].entries, sizeof(sleep_retention_entries_t));
+        }
+        _lock_release_recursive(&s_retention.lock);
+    }
+}
+
+uint32_t IRAM_ATTR sleep_retention_get_modules(void)
+{
+    return s_retention.modules;
+}