rtos/source/EventFlags.cpp - master - githubmirror/mbed-os

rtos/source/EventFlags.cpp
166 строк5 KB
Martin Kojtal
platform: move internal headers to internal/
20 авг 2020, 10:58
20 авг 2020, 10:58a6ce2c5
/* mbed Microcontroller Library
 * Copyright (c) 2006-2017 ARM Limited
 * SPDX-License-Identifier: MIT
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */
#include "rtos/EventFlags.h"
#include "rtos/ThisThread.h"
#include "platform/internal/mbed_os_timer.h"
#include <string.h>
#include "platform/mbed_error.h"
#include "platform/mbed_assert.h"

using std::milli;
using std::chrono::duration;

namespace rtos {

EventFlags::EventFlags()
{
    constructor("application_unnamed_event_flags");
}

EventFlags::EventFlags(const char *name)
{
    constructor(name);
}

void EventFlags::constructor(const char *name)
{
#if MBED_CONF_RTOS_PRESENT
    osEventFlagsAttr_t attr = { 0 };
    attr.name = name;
    attr.cb_mem = &_obj_mem;
    attr.cb_size = sizeof(_obj_mem);
    _id = osEventFlagsNew(&attr);
    MBED_ASSERT(_id);
#else
    _flags = 0;
#endif
}

uint32_t EventFlags::set(uint32_t flags)
{
#if MBED_CONF_RTOS_PRESENT
    return osEventFlagsSet(_id, flags);
#else
    return core_util_atomic_fetch_or_u32(&_flags, flags) | flags;
#endif
}

uint32_t EventFlags::clear(uint32_t flags)
{
#if MBED_CONF_RTOS_PRESENT
    return osEventFlagsClear(_id, flags);
#else
    return core_util_atomic_fetch_and_u32(&_flags, ~flags);
#endif
}

uint32_t EventFlags::get() const
{
#if MBED_CONF_RTOS_PRESENT
    return osEventFlagsGet(_id);
#else
    return core_util_atomic_load_u32(&_flags);
#endif
}

uint32_t EventFlags::wait_all(uint32_t flags, uint32_t millisec, bool clear)
{
    return wait_all_for(flags, duration<uint32_t, milli>(millisec), clear);
}

uint32_t EventFlags::wait_all_for(uint32_t flags, Kernel::Clock::duration_u32 rel_time, bool clear)
{
    return wait_for(flags, osFlagsWaitAll, rel_time, clear);
}

uint32_t EventFlags::wait_all_until(uint32_t flags, Kernel::Clock::time_point abs_time, bool clear)
{
    return wait_until(flags, osFlagsWaitAll, abs_time, clear);
}

uint32_t EventFlags::wait_any(uint32_t flags, uint32_t millisec, bool clear)
{
    return wait_any_for(flags, duration<uint32_t, milli>(millisec), clear);
}

uint32_t EventFlags::wait_any_for(uint32_t flags, Kernel::Clock::duration_u32 rel_time, bool clear)
{
    return wait_for(flags, osFlagsWaitAny, rel_time, clear);
}

uint32_t EventFlags::wait_any_until(uint32_t flags, Kernel::Clock::time_point abs_time, bool clear)
{
    return wait_until(flags, osFlagsWaitAny, abs_time, clear);
}

EventFlags::~EventFlags()
{
#if MBED_CONF_RTOS_PRESENT
    osEventFlagsDelete(_id);
#endif
}

uint32_t EventFlags::wait_for(uint32_t flags, uint32_t opt, Kernel::Clock::duration_u32 rel_time, bool clear)
{
    if (clear == false) {
        opt |= osFlagsNoClear;
    }

#if MBED_CONF_RTOS_PRESENT
    return osEventFlagsWait(_id, flags, opt, rel_time.count());
#else
    rtos::internal::flags_check_capture check;
    check.flags = &_flags;
    check.options = opt;
    check.flags_wanted = flags;
    check.result = 0;
    check.match = false;
    mbed::internal::do_timed_sleep_relative_or_forever(rel_time, rtos::internal::non_rtos_check_flags, &check);
    if (check.match) {
        return check.result;
    } else if (rel_time == rel_time.zero()) {
        return osErrorResource;
    } else {
        return osErrorTimeout;
    }
#endif
}

uint32_t EventFlags::wait_until(uint32_t flags, uint32_t opt, Kernel::Clock::time_point abs_time, bool clear)
{
    Kernel::Clock::time_point now = Kernel::Clock::now();

    Kernel::Clock::duration_u32 rel_time;
    if (now >= abs_time) {
        rel_time = rel_time.zero();
    } else if (abs_time - now > Kernel::wait_for_u32_max) {
        // Documentation permits early return for big offsets
        rel_time = Kernel::wait_for_u32_max;
    } else {
        rel_time = abs_time - now;
    }
    return wait_for(flags, opt, rel_time, clear);
}


}