blob: 71c130f1989838c4cbf430e311d6c8e632794082 [file] [log] [blame]
/*
* 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);
}