1 /*
2 * Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved.
3 * Copyright (c) 2020-2021 Huawei Device Co., Ltd. All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without modification,
6 * are permitted provided that the following conditions are met:
7 *
8 * 1. Redistributions of source code must retain the above copyright notice, this list of
9 * conditions and the following disclaimer.
10 *
11 * 2. Redistributions in binary form must reproduce the above copyright notice, this list
12 * of conditions and the following disclaimer in the documentation and/or other materials
13 * provided with the distribution.
14 *
15 * 3. Neither the name of the copyright holder nor the names of its contributors may be used
16 * to endorse or promote products derived from this software without specific prior written
17 * permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
21 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
23 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
24 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
25 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
26 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
27 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
28 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
29 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #include "los_vdso_pri.h"
33 #include "los_vdso_datapage.h"
34 #include "los_init.h"
35 #include "los_vm_map.h"
36 #include "los_vm_lock.h"
37 #include "los_vm_phys.h"
38 #include "los_process_pri.h"
39
40 LITE_VDSO_DATAPAGE VdsoDataPage g_vdsoDataPage __attribute__((__used__));
41
42 STATIC size_t g_vdsoSize;
43
OsVdsoInit(VOID)44 UINT32 OsVdsoInit(VOID)
45 {
46 g_vdsoSize = &__vdso_text_end - &__vdso_data_start;
47
48 if (memcmp((CHAR *)(&__vdso_text_start), ELF_HEAD, ELF_HEAD_LEN)) {
49 PRINT_ERR("VDSO Init Failed!\n");
50 return LOS_NOK;
51 }
52 return LOS_OK;
53 }
54
55 LOS_MODULE_INIT(OsVdsoInit, LOS_INIT_LEVEL_KMOD_EXTENDED);
56
OsVdsoMap(LosVmSpace * space,size_t len,PADDR_T paddr,VADDR_T vaddr,UINT32 flag)57 STATIC INT32 OsVdsoMap(LosVmSpace *space, size_t len, PADDR_T paddr, VADDR_T vaddr, UINT32 flag)
58 {
59 STATUS_T ret;
60
61 while (len > 0) {
62 ret = LOS_ArchMmuMap(&(space->archMmu), vaddr, paddr, 1, flag);
63 if (ret != 1) {
64 PRINT_ERR("VDSO Load Failed! : LOS_ArchMmuMap!\n");
65 return LOS_NOK;
66 }
67 paddr += PAGE_SIZE;
68 vaddr += PAGE_SIZE;
69 len -= PAGE_SIZE;
70 }
71 return LOS_OK;
72 }
73
OsVdsoLoad(const LosProcessCB * processCB)74 vaddr_t OsVdsoLoad(const LosProcessCB *processCB)
75 {
76 INT32 ret = -1;
77 LosVmMapRegion *vdsoRegion = NULL;
78 UINT32 flag = VM_MAP_REGION_FLAG_PERM_USER | VM_MAP_REGION_FLAG_PERM_READ | VM_MAP_REGION_FLAG_PERM_EXECUTE;
79
80 if ((processCB == NULL) || (processCB->vmSpace == NULL)) {
81 return 0;
82 }
83
84 (VOID)LOS_MuxAcquire(&processCB->vmSpace->regionMux);
85
86 vdsoRegion = LOS_RegionAlloc(processCB->vmSpace, 0, g_vdsoSize, flag, 0);
87 if (vdsoRegion == NULL) {
88 PRINT_ERR("%s %d, region alloc failed in vdso load\n", __FUNCTION__, __LINE__);
89 goto LOCK_RELEASE;
90 }
91 vdsoRegion->regionFlags |= VM_MAP_REGION_FLAG_VDSO;
92
93 ret = OsVdsoMap(processCB->vmSpace, g_vdsoSize, LOS_PaddrQuery((VOID *)(&__vdso_data_start)),
94 vdsoRegion->range.base, flag);
95 if (ret != LOS_OK) {
96 ret = LOS_RegionFree(processCB->vmSpace, vdsoRegion);
97 if (ret) {
98 PRINT_ERR("%s %d, free region failed, ret = %d\n", __FUNCTION__, __LINE__, ret);
99 }
100 ret = -1;
101 }
102
103 LOCK_RELEASE:
104 (VOID)LOS_MuxRelease(&processCB->vmSpace->regionMux);
105 if (ret == LOS_OK) {
106 return (vdsoRegion->range.base + PAGE_SIZE);
107 }
108 return 0;
109 }
110
LockVdsoDataPage(VdsoDataPage * vdsoDataPage)111 STATIC VOID LockVdsoDataPage(VdsoDataPage *vdsoDataPage)
112 {
113 vdsoDataPage->lockCount = 1;
114 DMB;
115 }
116
UnlockVdsoDataPage(VdsoDataPage * vdsoDataPage)117 STATIC VOID UnlockVdsoDataPage(VdsoDataPage *vdsoDataPage)
118 {
119 DMB;
120 vdsoDataPage->lockCount = 0;
121 }
122
OsVdsoTimevalUpdate(VOID)123 VOID OsVdsoTimevalUpdate(VOID)
124 {
125 VdsoDataPage *kVdsoDataPage = (VdsoDataPage *)(&__vdso_data_start);
126
127 LockVdsoDataPage(kVdsoDataPage);
128 OsVdsoTimeGet(kVdsoDataPage);
129 UnlockVdsoDataPage(kVdsoDataPage);
130 }
131