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_sortlink.h"
33 #include "los_sched.h"
34 #include "los_debug.h"
35
36 SortLinkAttribute g_taskSortLink;
37
38 #if (LOSCFG_BASE_CORE_SWTMR == 1)
39 SortLinkAttribute g_swtmrSortLink;
40 #endif
41
OsSortLinkInit(SortLinkAttribute * sortLinkHead)42 UINT32 OsSortLinkInit(SortLinkAttribute *sortLinkHead)
43 {
44 LOS_ListInit(&sortLinkHead->sortLink);
45 return LOS_OK;
46 }
47
OsAddNode2SortLink(SortLinkAttribute * sortLinkHead,SortLinkList * sortList)48 STATIC INLINE VOID OsAddNode2SortLink(SortLinkAttribute *sortLinkHead, SortLinkList *sortList)
49 {
50 LOS_DL_LIST *head = (LOS_DL_LIST *)&sortLinkHead->sortLink;
51
52 if (LOS_ListEmpty(head)) {
53 LOS_ListAdd(head, &sortList->sortLinkNode);
54 return;
55 }
56
57 SortLinkList *listSorted = LOS_DL_LIST_ENTRY(head->pstNext, SortLinkList, sortLinkNode);
58 if (listSorted->responseTime > sortList->responseTime) {
59 LOS_ListAdd(head, &sortList->sortLinkNode);
60 return;
61 } else if (listSorted->responseTime == sortList->responseTime) {
62 LOS_ListAdd(head->pstNext, &sortList->sortLinkNode);
63 return;
64 }
65
66 LOS_DL_LIST *prevNode = head->pstPrev;
67 do {
68 listSorted = LOS_DL_LIST_ENTRY(prevNode, SortLinkList, sortLinkNode);
69 if (listSorted->responseTime <= sortList->responseTime) {
70 LOS_ListAdd(prevNode, &sortList->sortLinkNode);
71 break;
72 }
73
74 prevNode = prevNode->pstPrev;
75 } while (1);
76 }
77
OsAdd2SortLink(SortLinkList * node,UINT64 startTime,UINT32 waitTicks,SortLinkType type)78 VOID OsAdd2SortLink(SortLinkList *node, UINT64 startTime, UINT32 waitTicks, SortLinkType type)
79 {
80 UINT32 intSave;
81 SortLinkAttribute *sortLinkHead = NULL;
82
83 if (type == OS_SORT_LINK_TASK) {
84 sortLinkHead = &g_taskSortLink;
85 #if (LOSCFG_BASE_CORE_SWTMR == 1)
86 } else if (type == OS_SORT_LINK_SWTMR) {
87 sortLinkHead = &g_swtmrSortLink;
88 #endif
89 } else {
90 LOS_Panic("Sort link type error : %u\n", type);
91 }
92
93 intSave = LOS_IntLock();
94 SET_SORTLIST_VALUE(node, startTime + OS_SYS_TICK_TO_CYCLE(waitTicks));
95 OsAddNode2SortLink(sortLinkHead, node);
96 LOS_IntRestore(intSave);
97 }
98
OsDeleteSortLink(SortLinkList * node)99 VOID OsDeleteSortLink(SortLinkList *node)
100 {
101 UINT32 intSave;
102
103 intSave = LOS_IntLock();
104 if (node->responseTime != OS_SORT_LINK_INVALID_TIME) {
105 OsSchedResetSchedResponseTime(node->responseTime);
106 OsDeleteNodeSortLink(node);
107 }
108 LOS_IntRestore(intSave);
109 }
110
SortLinkNodeTimeUpdate(SortLinkAttribute * sortLinkHead,UINT32 oldFreq)111 STATIC INLINE VOID SortLinkNodeTimeUpdate(SortLinkAttribute *sortLinkHead, UINT32 oldFreq)
112 {
113 LOS_DL_LIST *head = (LOS_DL_LIST *)&sortLinkHead->sortLink;
114
115 if (LOS_ListEmpty(head)) {
116 return;
117 }
118
119 LOS_DL_LIST *nextNode = head->pstNext;
120 do {
121 SortLinkList *listSorted = LOS_DL_LIST_ENTRY(nextNode, SortLinkList, sortLinkNode);
122 listSorted->responseTime = OsTimeConvertFreq(listSorted->responseTime, oldFreq, g_sysClock);
123 nextNode = nextNode->pstNext;
124 } while (nextNode != head);
125 }
126
OsSortLinkResponseTimeConvertFreq(UINT32 oldFreq)127 VOID OsSortLinkResponseTimeConvertFreq(UINT32 oldFreq)
128 {
129 SortLinkAttribute *taskHead = &g_taskSortLink;
130 SortLinkNodeTimeUpdate(taskHead, oldFreq);
131
132 #if (LOSCFG_BASE_CORE_SWTMR == 1)
133 SortLinkAttribute *swtmrHead = &g_swtmrSortLink;
134 SortLinkNodeTimeUpdate(swtmrHead, oldFreq);
135 #endif
136 }
137
OsGetSortLinkAttribute(SortLinkType type)138 SortLinkAttribute *OsGetSortLinkAttribute(SortLinkType type)
139 {
140 if (type == OS_SORT_LINK_TASK) {
141 return &g_taskSortLink;
142 #if (LOSCFG_BASE_CORE_SWTMR == 1)
143 } else if (type == OS_SORT_LINK_SWTMR) {
144 return &g_swtmrSortLink;
145 #endif
146 }
147
148 PRINT_ERR("Invalid sort link type!\n");
149 return NULL;
150 }
151
OsSortLinkGetTargetExpireTime(UINT64 currTime,const SortLinkList * targetSortList)152 UINT64 OsSortLinkGetTargetExpireTime(UINT64 currTime, const SortLinkList *targetSortList)
153 {
154 if (currTime >= targetSortList->responseTime) {
155 return 0;
156 }
157
158 return (targetSortList->responseTime - currTime);
159 }
160
OsSortLinkGetNextExpireTime(const SortLinkAttribute * sortLinkHead)161 UINT64 OsSortLinkGetNextExpireTime(const SortLinkAttribute *sortLinkHead)
162 {
163 LOS_DL_LIST *head = (LOS_DL_LIST *)&sortLinkHead->sortLink;
164
165 if (LOS_ListEmpty(head)) {
166 return 0;
167 }
168
169 SortLinkList *listSorted = LOS_DL_LIST_ENTRY(head->pstNext, SortLinkList, sortLinkNode);
170 return OsSortLinkGetTargetExpireTime(OsGetCurrSchedTimeCycle(), listSorted);
171 }
172