| /* |
| * 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); |
| } |