1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
|
/******************************************************************************
*
* Copyright 2014 Google, Inc.
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
******************************************************************************/
#define LOG_TAG "bt_osi_semaphore"
#include "osi/include/semaphore.h"
#include <base/logging.h>
#include <errno.h>
#include <fcntl.h>
#include <malloc.h>
#include <string.h>
#include <sys/eventfd.h>
#include <unistd.h>
#include "osi/include/allocator.h"
#include "osi/include/log.h"
#include "osi/include/osi.h"
#if !defined(EFD_SEMAPHORE)
#define EFD_SEMAPHORE (1 << 0)
#endif
struct semaphore_t {
int fd;
};
semaphore_t* semaphore_new(unsigned int value) {
semaphore_t* ret = static_cast<semaphore_t*>(osi_malloc(sizeof(semaphore_t)));
ret->fd = eventfd(value, EFD_SEMAPHORE);
if (ret->fd == INVALID_FD) {
LOG_ERROR("%s unable to allocate semaphore: %s", __func__, strerror(errno));
osi_free(ret);
ret = NULL;
}
return ret;
}
void semaphore_free(semaphore_t* semaphore) {
if (!semaphore) return;
if (semaphore->fd != INVALID_FD) close(semaphore->fd);
osi_free(semaphore);
}
void semaphore_wait(semaphore_t* semaphore) {
CHECK(semaphore != NULL);
CHECK(semaphore->fd != INVALID_FD);
eventfd_t value;
if (eventfd_read(semaphore->fd, &value) == -1)
LOG_ERROR("%s unable to wait on semaphore: %s", __func__, strerror(errno));
}
bool semaphore_try_wait(semaphore_t* semaphore) {
CHECK(semaphore != NULL);
CHECK(semaphore->fd != INVALID_FD);
int flags = fcntl(semaphore->fd, F_GETFL);
if (flags == -1) {
LOG_ERROR("%s unable to get flags for semaphore fd: %s", __func__,
strerror(errno));
return false;
}
if (fcntl(semaphore->fd, F_SETFL, flags | O_NONBLOCK) == -1) {
LOG_ERROR("%s unable to set O_NONBLOCK for semaphore fd: %s", __func__,
strerror(errno));
return false;
}
bool rc = true;
eventfd_t value;
if (eventfd_read(semaphore->fd, &value) == -1) rc = false;
if (fcntl(semaphore->fd, F_SETFL, flags) == -1)
LOG_ERROR("%s unable to restore flags for semaphore fd: %s", __func__,
strerror(errno));
return rc;
}
void semaphore_post(semaphore_t* semaphore) {
CHECK(semaphore != NULL);
CHECK(semaphore->fd != INVALID_FD);
if (eventfd_write(semaphore->fd, 1ULL) == -1)
LOG_ERROR("%s unable to post to semaphore: %s", __func__, strerror(errno));
}
int semaphore_get_fd(const semaphore_t* semaphore) {
CHECK(semaphore != NULL);
CHECK(semaphore->fd != INVALID_FD);
return semaphore->fd;
}
|
