1 /*
2 * Copyright (C) 2022 Huawei Device Co., Ltd.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at
6 *
7 * http://www.apache.org/licenses/LICENSE-2.0
8 *
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
14 */
15
16 #ifndef FILLP_UTILS_H
17 #define FILLP_UTILS_H
18 #include <time.h>
19 #include "fillp_os.h"
20 #include "opt.h"
21 #include "fillp_function.h"
22 #include "log.h"
23 #include "securec.h"
24
25 #ifdef __cplusplus
26 extern "C" {
27 #endif
28
29 #define UTILS_FLAGS_SET(_flag, _f) ((_flag) |= (_f))
30 #define UTILS_FLAGS_GET(_flag, _f) ((_flag) & (_f))
31 #define UTILS_FLAGS_CLEAN(_flag, _f) ((_flag) &= ~(_f))
32 #define UTILS_FLAGS_RESET(_flag) ((_flag) &= 0u)
33 #define UTILS_FLAGS_CHECK(_flag, _f) (((_flag) & (_f)) == (_f))
34
35 #define UTILS_MIN(a, b) ((a) < (b) ? (a) : (b))
36 #define UTILS_MAX(a, b) ((a) > (b) ? (a) : (b))
37
38 #define FILLP_UTILS_MS2US(ms) ((ms) * 1000)
39 #define FILLP_UTILS_US2MS(us) ((us) / 1000)
40 #define FILLP_UTILS_US2S(us) ((us) / 1000000)
41 #define FILLP_UTILS_S2US(s) ((s) * 1000000)
42
43 #define FILLP_UTILS_KBPS2BPS(kbps) ((kbps) * 1000)
44 #define FILLP_UTILS_BPS2KBPS(bps) ((bps) / 1000)
45 #define FILLP_UTILS_BIT2BYTE(bit) ((bit) >> 3)
46
47 #define UTILS_GET_ADDRPORT(addr) ((struct sockaddr_in*) (addr))->sin_port
48 #define IPV6_ADDR_LEN 16
49
UtilsIpv4AddrPortKey(FILLP_UINT16 port,struct sockaddr_in * remoteAddr)50 __inline static FILLP_UINT32 UtilsIpv4AddrPortKey(FILLP_UINT16 port, struct sockaddr_in *remoteAddr)
51 {
52 return (port ^ (remoteAddr)->sin_addr.s_addr);
53 }
54
UtilsIpv6AddrPortKey(FILLP_UINT16 port,struct sockaddr_in6 * remoteAddr)55 __inline static FILLP_UINT32 UtilsIpv6AddrPortKey(FILLP_UINT16 port, struct sockaddr_in6 *remoteAddr)
56 {
57 FILLP_INT i;
58 for (i = 0; i < IPV6_ADDR_LEN; i++) {
59 port ^= ((remoteAddr)->sin6_addr.s6_addr[i]);
60 }
61 return (FILLP_UINT32)port;
62 }
63
UtilsAddrHashKey(struct sockaddr_in * addr)64 __inline static FILLP_UINT32 UtilsAddrHashKey(struct sockaddr_in *addr)
65 {
66 FILLP_INT port = UTILS_GET_ADDRPORT(addr);
67 socklen_t addrLen = sizeof(struct sockaddr);
68
69 if (((struct sockaddr_in *)(void *)addr)->sin_family == AF_INET6) {
70 addrLen = sizeof(struct sockaddr_in6);
71 }
72
73 if (addrLen == sizeof(struct sockaddr)) {
74 return UtilsIpv4AddrPortKey((FILLP_UINT16)port, addr);
75 } else {
76 return UtilsIpv6AddrPortKey((FILLP_UINT16)port, (struct sockaddr_in6 *)addr);
77 }
78 }
79
UtilsIpv6AddrMatch(FILLP_CONST struct sockaddr_in6 * a,FILLP_CONST struct sockaddr_in6 * b)80 __inline static FILLP_BOOL UtilsIpv6AddrMatch(FILLP_CONST struct sockaddr_in6 *a, FILLP_CONST struct sockaddr_in6 *b)
81 {
82 FILLP_INT i;
83 for (i = 0; i < IPV6_ADDR_LEN; i++) {
84 if ((a)->sin6_addr.s6_addr[i] != (b)->sin6_addr.s6_addr[i]) {
85 return FILLP_FALSE;
86 }
87 }
88 return FILLP_TRUE;
89 }
90
91 #define UTILS_ADDR_FAMILY_MATCH(a, b) (((struct sockaddr_in *)(void *)(a))->sin_family == \
92 ((struct sockaddr_in *)(void *)(b))->sin_family)
93
94 #define UTILS_ADDR_PORT_MATCH(a, b) (((struct sockaddr_in *)(void *)(a))->sin_port == \
95 ((struct sockaddr_in *)(void *)(b))->sin_port)
96
97 #define UTILS_IPV4_ADDR_MATCH(a, b) ((a)->sin_addr.s_addr == (b)->sin_addr.s_addr && \
98 UTILS_ADDR_PORT_MATCH((a), (b)))
99
100 #define UTILS_IPV6_ADDR_MATCH(a, b) (UTILS_ADDR_PORT_MATCH((a), (b)) && \
101 UtilsIpv6AddrMatch((a), (b)))
102
UtilsAddrMatch(FILLP_CONST struct sockaddr_in * addrA,FILLP_CONST struct sockaddr_in * addrB)103 static __inline FILLP_BOOL UtilsAddrMatch(FILLP_CONST struct sockaddr_in *addrA, FILLP_CONST struct sockaddr_in *addrB)
104 {
105 if (!UTILS_ADDR_FAMILY_MATCH(addrA, addrB)) {
106 return FILLP_FALSE;
107 }
108
109 if (addrA->sin_family == AF_INET) {
110 return (FILLP_BOOL)UTILS_IPV4_ADDR_MATCH(addrA, addrB);
111 } else {
112 return (FILLP_BOOL)UTILS_IPV6_ADDR_MATCH((struct sockaddr_in6 *)addrA, (struct sockaddr_in6 *)addrB);
113 }
114 }
115
UtilsAddrCopy(struct sockaddr * dest,struct sockaddr * src)116 static __inline void UtilsAddrCopy(struct sockaddr *dest, struct sockaddr *src)
117 {
118 FillpErrorType err;
119 if (((struct sockaddr_in *)(void *)src)->sin_family == AF_INET) {
120 err = memcpy_s(dest, sizeof(struct sockaddr_in), src, sizeof(struct sockaddr_in));
121 } else {
122 err = memcpy_s(dest, sizeof(struct sockaddr_in6), src, sizeof(struct sockaddr_in6));
123 }
124 if (err != EOK) {
125 FILLP_LOGERR("utils_addr_copy memcpy_s failed : %d", err);
126 }
127 }
128
UtilsAddrValidLength(struct sockaddr_in * addr)129 static __inline size_t UtilsAddrValidLength(struct sockaddr_in *addr)
130 {
131 if (((struct sockaddr_in *)(void *)addr)->sin_family == AF_INET) {
132 return sizeof(struct sockaddr_in);
133 }
134
135 return sizeof(struct sockaddr_in6);
136 }
137
138 #ifdef __cplusplus
139 }
140 #endif
141
142 #endif /* FILLP_UTILS_H */