| /* |
| * 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 <stddef.h> |
| #include "nimble/nimble_npl.h" |
| |
| #define ENABLE_DEBUG (0) |
| #include "debug.h" |
| |
| volatile int ble_npl_in_critical = 0; |
| |
| static void |
| _callout_fire(void *arg) |
| { |
| struct ble_npl_callout *co = (struct ble_npl_callout *)arg; |
| event_post(co->q, &co->e.e.super); |
| } |
| |
| ble_npl_error_t |
| ble_npl_sem_pend(struct ble_npl_sem *sem, ble_npl_time_t timeout) |
| { |
| int rc = sema_wait_timed_ztimer(&sem->sem, ZTIMER_MSEC, timeout); |
| return (rc == 0) ? BLE_NPL_OK : BLE_NPL_ENOENT; |
| } |
| |
| void |
| ble_npl_callout_init(struct ble_npl_callout *c, struct ble_npl_eventq *evq, |
| ble_npl_event_fn *ev_cb, void *ev_arg) |
| { |
| c->timer.arg = (void *)c; |
| c->timer.callback = _callout_fire; |
| c->q = &evq->q; |
| ble_npl_event_init(&c->e, ev_cb, ev_arg); |
| } |
| |
| ble_npl_error_t |
| ble_npl_callout_reset(struct ble_npl_callout *c, ble_npl_time_t ticks) |
| { |
| /* Use critical section to ensure matching target_us and ztimer value. */ |
| uint32_t crit_state = ble_npl_hw_enter_critical(); |
| c->ticks = ztimer_now(ZTIMER_MSEC) + ticks; |
| ztimer_set(ZTIMER_MSEC, &c->timer, ticks); |
| ble_npl_hw_exit_critical(crit_state); |
| return BLE_NPL_OK; |
| } |
| |
| ble_npl_time_t |
| ble_npl_callout_remaining_ticks(struct ble_npl_callout *co, |
| ble_npl_time_t time) |
| { |
| ztimer_now_t now = ztimer_now(ZTIMER_MSEC); |
| return (ble_npl_time_t)(co->ticks - now); |
| } |