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