1*042d53a7SEvalZero /*
2*042d53a7SEvalZero * Licensed to the Apache Software Foundation (ASF) under one
3*042d53a7SEvalZero * or more contributor license agreements. See the NOTICE file
4*042d53a7SEvalZero * distributed with this work for additional information
5*042d53a7SEvalZero * regarding copyright ownership. The ASF licenses this file
6*042d53a7SEvalZero * to you under the Apache License, Version 2.0 (the
7*042d53a7SEvalZero * "License"); you may not use this file except in compliance
8*042d53a7SEvalZero * with the License. You may obtain a copy of the License at
9*042d53a7SEvalZero *
10*042d53a7SEvalZero * http://www.apache.org/licenses/LICENSE-2.0
11*042d53a7SEvalZero *
12*042d53a7SEvalZero * Unless required by applicable law or agreed to in writing,
13*042d53a7SEvalZero * software distributed under the License is distributed on an
14*042d53a7SEvalZero * "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
15*042d53a7SEvalZero * KIND, either express or implied. See the License for the
16*042d53a7SEvalZero * specific language governing permissions and limitations
17*042d53a7SEvalZero * under the License.
18*042d53a7SEvalZero */
19*042d53a7SEvalZero
20*042d53a7SEvalZero #include "ble_hs_priv.h"
21*042d53a7SEvalZero
22*042d53a7SEvalZero int
ble_mqueue_init(struct ble_mqueue * mq,ble_npl_event_fn * ev_fn,void * ev_arg)23*042d53a7SEvalZero ble_mqueue_init(struct ble_mqueue *mq, ble_npl_event_fn *ev_fn, void *ev_arg)
24*042d53a7SEvalZero {
25*042d53a7SEvalZero STAILQ_INIT(&mq->head);
26*042d53a7SEvalZero
27*042d53a7SEvalZero ble_npl_event_init(&mq->ev, ev_fn, ev_arg);
28*042d53a7SEvalZero
29*042d53a7SEvalZero return (0);
30*042d53a7SEvalZero }
31*042d53a7SEvalZero
32*042d53a7SEvalZero struct os_mbuf *
ble_mqueue_get(struct ble_mqueue * mq)33*042d53a7SEvalZero ble_mqueue_get(struct ble_mqueue *mq)
34*042d53a7SEvalZero {
35*042d53a7SEvalZero struct os_mbuf_pkthdr *mp;
36*042d53a7SEvalZero struct os_mbuf *om;
37*042d53a7SEvalZero os_sr_t sr;
38*042d53a7SEvalZero
39*042d53a7SEvalZero OS_ENTER_CRITICAL(sr);
40*042d53a7SEvalZero mp = STAILQ_FIRST(&mq->head);
41*042d53a7SEvalZero if (mp) {
42*042d53a7SEvalZero STAILQ_REMOVE_HEAD(&mq->head, omp_next);
43*042d53a7SEvalZero }
44*042d53a7SEvalZero OS_EXIT_CRITICAL(sr);
45*042d53a7SEvalZero
46*042d53a7SEvalZero if (mp) {
47*042d53a7SEvalZero om = OS_MBUF_PKTHDR_TO_MBUF(mp);
48*042d53a7SEvalZero } else {
49*042d53a7SEvalZero om = NULL;
50*042d53a7SEvalZero }
51*042d53a7SEvalZero
52*042d53a7SEvalZero return (om);
53*042d53a7SEvalZero }
54*042d53a7SEvalZero
55*042d53a7SEvalZero int
ble_mqueue_put(struct ble_mqueue * mq,struct ble_npl_eventq * evq,struct os_mbuf * om)56*042d53a7SEvalZero ble_mqueue_put(struct ble_mqueue *mq, struct ble_npl_eventq *evq, struct os_mbuf *om)
57*042d53a7SEvalZero {
58*042d53a7SEvalZero struct os_mbuf_pkthdr *mp;
59*042d53a7SEvalZero os_sr_t sr;
60*042d53a7SEvalZero int rc;
61*042d53a7SEvalZero
62*042d53a7SEvalZero /* Can only place the head of a chained mbuf on the queue. */
63*042d53a7SEvalZero if (!OS_MBUF_IS_PKTHDR(om)) {
64*042d53a7SEvalZero rc = OS_EINVAL;
65*042d53a7SEvalZero goto err;
66*042d53a7SEvalZero }
67*042d53a7SEvalZero
68*042d53a7SEvalZero mp = OS_MBUF_PKTHDR(om);
69*042d53a7SEvalZero
70*042d53a7SEvalZero OS_ENTER_CRITICAL(sr);
71*042d53a7SEvalZero STAILQ_INSERT_TAIL(&mq->head, mp, omp_next);
72*042d53a7SEvalZero OS_EXIT_CRITICAL(sr);
73*042d53a7SEvalZero
74*042d53a7SEvalZero /* Only post an event to the queue if its specified */
75*042d53a7SEvalZero if (evq) {
76*042d53a7SEvalZero ble_npl_eventq_put(evq, &mq->ev);
77*042d53a7SEvalZero }
78*042d53a7SEvalZero
79*042d53a7SEvalZero return (0);
80*042d53a7SEvalZero err:
81*042d53a7SEvalZero return (rc);
82*042d53a7SEvalZero }
83