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
|
/*
* Licensed to the Apache Software Foundation (ASF) under one
* or more contributor license agreements. See the NOTICE file
* distributed with this work for additional information
* regarding copyright ownership. The ASF licenses this file
* to you 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.
*/
#include <nuttx/config.h>
#include <assert.h>
#include <errno.h>
#include <semaphore.h>
#include "os/os.h"
#include "nimble/nimble_npl.h"
ble_npl_error_t
ble_npl_sem_init(struct ble_npl_sem *sem, uint16_t tokens)
{
if (!sem) {
return BLE_NPL_INVALID_PARAM;
}
sem_init(&sem->lock, 0, tokens);
return BLE_NPL_OK;
}
ble_npl_error_t
ble_npl_sem_release(struct ble_npl_sem *sem)
{
int err;
if (!sem) {
return BLE_NPL_INVALID_PARAM;
}
err = sem_post(&sem->lock);
return (err) ? BLE_NPL_ERROR : BLE_NPL_OK;
}
ble_npl_error_t
ble_npl_sem_pend(struct ble_npl_sem *sem, uint32_t timeout)
{
int err = 0;
struct timespec wait;
if (!sem) {
return BLE_NPL_INVALID_PARAM;
}
if (timeout == BLE_NPL_TIME_FOREVER) {
err = sem_wait(&sem->lock);
} else {
err = clock_gettime(CLOCK_REALTIME, &wait);
if (err) {
return BLE_NPL_ERROR;
}
wait.tv_sec += timeout / 1000;
wait.tv_nsec += (timeout % 1000) * 1000000;
err = sem_timedwait(&sem->lock, &wait);
if (err && errno == ETIMEDOUT) {
return BLE_NPL_TIMEOUT;
}
}
return (err) ? BLE_NPL_ERROR : BLE_NPL_OK;
}
uint16_t
ble_npl_sem_get_count(struct ble_npl_sem *sem)
{
int count;
assert(sem);
assert(&sem->lock);
sem_getvalue(&sem->lock, &count);
/* NuttX can return negative value, return 0 in that case */
if (count < 0) {
count = 0;
}
return count;
}
|
