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
|
/*
* 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 "ble_hs_priv.h"
int
ble_mqueue_init(struct ble_mqueue *mq, ble_npl_event_fn *ev_fn, void *ev_arg)
{
STAILQ_INIT(&mq->head);
ble_npl_event_init(&mq->ev, ev_fn, ev_arg);
return (0);
}
struct os_mbuf *
ble_mqueue_get(struct ble_mqueue *mq)
{
struct os_mbuf_pkthdr *mp;
struct os_mbuf *om;
os_sr_t sr;
OS_ENTER_CRITICAL(sr);
mp = STAILQ_FIRST(&mq->head);
if (mp) {
STAILQ_REMOVE_HEAD(&mq->head, omp_next);
}
OS_EXIT_CRITICAL(sr);
if (mp) {
om = OS_MBUF_PKTHDR_TO_MBUF(mp);
} else {
om = NULL;
}
return (om);
}
int
ble_mqueue_put(struct ble_mqueue *mq, struct ble_npl_eventq *evq, struct os_mbuf *om)
{
struct os_mbuf_pkthdr *mp;
os_sr_t sr;
int rc;
/* Can only place the head of a chained mbuf on the queue. */
if (!OS_MBUF_IS_PKTHDR(om)) {
rc = OS_EINVAL;
goto err;
}
mp = OS_MBUF_PKTHDR(om);
OS_ENTER_CRITICAL(sr);
STAILQ_INSERT_TAIL(&mq->head, mp, omp_next);
OS_EXIT_CRITICAL(sr);
/* Only post an event to the queue if its specified */
if (evq) {
ble_npl_eventq_put(evq, &mq->ev);
}
return (0);
err:
return (rc);
}
|
