freertos_drivers/common/Node.cxx

Go to the documentation of this file.

 
#include "Devtab.hxx"
 
#include <algorithm>
#include <sys/stat.h>
 
#include "can_ioctl.h"
#include "executor/Notifiable.hxx"
 
int Node::open(File *, const char *, int, int)
{
    OSMutexLock l(&lock_);
    if (references_++ == 0)
    {
        enable();
    }
    return 0;
}
 
int Node::close(File *)
{
    OSMutexLock l(&lock_);
    if (--references_ <= 0)
    {
        disable();
        references_ = 0;
    }
    return 0;
}
 
int Node::fstat(File* file, struct stat *stat)
{
    memset(stat, 0, sizeof(*stat));
    stat->st_mode = mode_;
    return 0;
}
 
int NonBlockNode::ioctl(File *file, unsigned long int key, unsigned long data)
{
    /* sanity check to be sure we have a valid key for this device */
    HASSERT(IOC_TYPE(key) == CAN_IOC_MAGIC);
 
    // Will be called at the end if non-null.
    Notifiable* n = nullptr;
 
    if (IOC_SIZE(key) == NOTIFIABLE_TYPE) {
        n = reinterpret_cast<Notifiable*>(data);
    }
 
    switch (key)
    {
        default:
            return -EINVAL;
        case CAN_IOC_READ_ACTIVE:
            portENTER_CRITICAL();
            if (!has_rx_buffer_data())
            {
                std::swap(n, readableNotify_);
            }
            portEXIT_CRITICAL();
            break;
        case CAN_IOC_WRITE_ACTIVE:
            portENTER_CRITICAL();
            if (!has_tx_buffer_space())
            {
                std::swap(n, writableNotify_);
            }
            portEXIT_CRITICAL();
            break;
    }
    if (n)
    {
        n->notify();
    }
    return 0;
}