1 /*
2 * Copyright (c) 2006-2022, RT-Thread Development Team
3 *
4 * SPDX-License-Identifier: Apache-2.0
5 *
6 * Change Logs:
7 * Date Author Notes
8 * 2022-11-14 WangXiaoyao the first version
9 */
10
11 #include <rtthread.h>
12 #define DBG_TAG "mm.kmem"
13 #define DBG_LVL DBG_INFO
14 #include <rtdbg.h>
15
16 #include "mm_aspace.h"
17 #include "mm_private.h"
18 #include <mmu.h>
19
list_kmem(void)20 static void list_kmem(void)
21 {
22 rt_aspace_print_all(&rt_kernel_space);
23 }
24 MSH_CMD_EXPORT(list_kmem, List varea in kernel virtual memory space);
25
26 void rt_kmem_list(void) __attribute__((alias("list_kmem")));
27
28 static rt_ubase_t rt_pv_offset;
29
rt_kmem_pvoff(void)30 const rt_ubase_t rt_kmem_pvoff(void)
31 {
32 return rt_pv_offset;
33 }
34
rt_kmem_pvoff_set(rt_ubase_t pvoff)35 void rt_kmem_pvoff_set(rt_ubase_t pvoff)
36 {
37 rt_pv_offset = pvoff;
38 }
39
40 #define _KMEM_LO_OFF(addr) ((rt_ubase_t)(addr) & ARCH_PAGE_MASK)
41
rt_kmem_map_phy(void * va,void * pa,rt_size_t length,rt_size_t attr)42 int rt_kmem_map_phy(void *va, void *pa, rt_size_t length, rt_size_t attr)
43 {
44 int err;
45 size_t lo_off;
46 lo_off = _KMEM_LO_OFF(pa);
47
48 if (va == RT_NULL)
49 {
50 LOG_E("%s: va NULL is not a valid input", __func__);
51 err = -RT_EINVAL;
52 }
53 else if (_KMEM_LO_OFF(pa) != _KMEM_LO_OFF(va))
54 {
55 LOG_E("%s: misaligned PA(%p) to VA(%p)", __func__, pa, va);
56 err = -RT_EINVAL;
57 }
58 else
59 {
60 struct rt_mm_va_hint hint = {.flags = MMF_MAP_FIXED,
61 .limit_range_size = rt_kernel_space.size,
62 .limit_start = rt_kernel_space.start,
63 .prefer = va,
64 .map_size = RT_ALIGN(length + lo_off, ARCH_PAGE_SIZE)};
65
66 err = rt_aspace_map_phy(&rt_kernel_space, &hint, attr, MM_PA_TO_OFF(pa), &va);
67
68 if (err)
69 {
70 LOG_W("%s: map %p to %p (%p bytes) failed(err %d)", __func__, pa, va, length, err);
71 }
72 }
73
74 return err;
75 }
76
rt_kmem_v2p(void * vaddr)77 void *rt_kmem_v2p(void *vaddr)
78 {
79 return rt_hw_mmu_v2p(&rt_kernel_space, vaddr);
80 }
81
rt_kmem_p2v(void * paddr)82 void *rt_kmem_p2v(void *paddr)
83 {
84 char *rc;
85 char *linear_va;
86 char *linear_pa;
87 if (paddr != ARCH_MAP_FAILED)
88 {
89 linear_va = (char *)paddr - PV_OFFSET;
90 linear_pa = rt_kmem_v2p(linear_va);
91 if (linear_pa != paddr)
92 {
93 rc = RT_NULL;
94 }
95 else
96 {
97 rc = linear_va;
98 }
99 }
100 else
101 {
102 rc = RT_NULL;
103 }
104
105 return rc;
106 }
107