/*
 * 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;
    struct timespec abs;
    uint64_t time;

    time = xtimer_now_usec64() +
        (ble_npl_time_ticks_to_ms32(timeout) * US_PER_MS);
    abs.tv_sec = (time_t)(time / US_PER_SEC);
    abs.tv_nsec = (long)((time % US_PER_SEC) * NS_PER_US);

    rc = sem_timedwait(&sem->sem, &abs);

    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 xtimer value. */
    uint32_t crit_state = ble_npl_hw_enter_critical();
    uint64_t now = xtimer_now_usec64();
    c->target_us = now  + ticks * US_PER_MS;
    xtimer_set64(&c->timer, ticks * US_PER_MS);
    ble_npl_hw_exit_critical(crit_state);
    return BLE_NPL_OK;
}

uint32_t
ble_npl_callout_remaining_ticks(struct ble_npl_callout *co,
                                ble_npl_time_t time)
{
    uint64_t now = xtimer_now_usec64();
    return (uint32_t)((co->target_us - now) / US_PER_MS);
}