first commit for opensource

first commit for opensource

kernel/core/tos_mmblk.c

@@ -0,0 +1,118 @@
+#include <tos.h>
+
+#if TOS_CFG_MMBLK_EN > 0u
+
+__API__ k_err_t tos_mmblk_pool_create(k_mmblk_pool_t *mbp, void *pool_start, size_t blk_num, size_t blk_size)
+{
+    uint32_t    i;
+    void       *blk_curr;
+    void       *blk_next;
+
+    TOS_IN_IRQ_CHECK();
+    TOS_PTR_SANITY_CHECK(pool_start);
+
+    if (((cpu_addr_t)pool_start & K_MMBLK_ALIGN_MASK) != 0u) {
+        return K_ERR_MMBLK_INVALID_POOL_ADDR;
+    }
+
+    if ((blk_size & K_MMBLK_ALIGN_MASK) != 0u) {
+        return K_ERR_MMBLK_INVALID_BLK_SIZE;
+    }
+
+    blk_curr = pool_start;
+    blk_next = K_MMBLK_NEXT_BLK(blk_curr, blk_size);
+
+    for (i = 0; i < blk_num - 1u; ++i) {
+        *(void **)blk_curr  = blk_next;
+        blk_curr            = blk_next;
+        blk_next            = K_MMBLK_NEXT_BLK(blk_next, blk_size);
+    }
+    *(void **)blk_next = K_NULL;
+
+#if TOS_CFG_OBJECT_VERIFY_EN > 0u
+    knl_object_init(&mbp->knl_obj, KNL_OBJ_TYPE_MMBLK_POOL);
+#endif
+
+    mbp->pool_start = pool_start;
+    mbp->free_list  = pool_start;
+    mbp->blk_free   = blk_num;
+    mbp->blk_max    = blk_num;
+    mbp->blk_size   = blk_size;
+    return K_ERR_NONE;
+}
+
+__API__ k_err_t tos_mmblk_pool_destroy(k_mmblk_pool_t *mbp)
+{
+    TOS_PTR_SANITY_CHECK(mbp);
+
+#if TOS_CFG_OBJECT_VERIFY_EN > 0u
+    if (!knl_object_verify(&mbp->knl_obj, KNL_OBJ_TYPE_MMBLK_POOL)) {
+        return K_ERR_OBJ_INVALID;
+    }
+#endif
+
+    mbp->pool_start = K_NULL;
+    mbp->free_list  = K_NULL;
+    mbp->blk_free   = 0;
+    mbp->blk_max    = 0;
+    mbp->blk_size   = 0;
+
+#if TOS_CFG_OBJECT_VERIFY_EN > 0u
+    knl_object_deinit(&mbp->knl_obj);
+#endif
+
+    return K_ERR_NONE;
+}
+
+__API__ k_err_t tos_mmblk_alloc(k_mmblk_pool_t *mbp, void **blk)
+{
+    TOS_CPU_CPSR_ALLOC();
+
+    TOS_PTR_SANITY_CHECK(mbp);
+
+#if TOS_CFG_OBJECT_VERIFY_EN > 0u
+    if (!knl_object_verify(&mbp->knl_obj, KNL_OBJ_TYPE_MMBLK_POOL)) {
+        return K_ERR_OBJ_INVALID;
+    }
+#endif
+
+    TOS_CPU_INT_DISABLE();
+    if (mbp->blk_free == 0) {
+        TOS_CPU_INT_ENABLE();
+        *blk = K_NULL;
+        return K_ERR_MMBLK_POOL_EMPTY;
+    }
+    *blk            = mbp->free_list;
+    mbp->free_list  = *(void **)mbp->free_list;
+    --mbp->blk_free;
+    TOS_CPU_INT_ENABLE();
+    return K_ERR_NONE;
+}
+
+__API__ k_err_t tos_mmblk_free(k_mmblk_pool_t *mbp, void *blk)
+{
+    TOS_CPU_CPSR_ALLOC();
+
+    TOS_PTR_SANITY_CHECK(mbp);
+    TOS_PTR_SANITY_CHECK(blk);
+
+#if TOS_CFG_OBJECT_VERIFY_EN > 0u
+    if (!knl_object_verify(&mbp->knl_obj, KNL_OBJ_TYPE_MMBLK_POOL)) {
+        return K_ERR_OBJ_INVALID;
+    }
+#endif
+
+    TOS_CPU_INT_DISABLE();
+    if (mbp->blk_free >= mbp->blk_max) {
+        TOS_CPU_INT_ENABLE();
+        return K_ERR_MMBLK_POOL_FULL;
+    }
+    *(void **)blk   = mbp->free_list;
+    mbp->free_list  = blk;
+    ++mbp->blk_free;
+    TOS_CPU_INT_ENABLE();
+    return K_ERR_NONE;
+}
+
+#endif
+