lowlevel.c

Go to the documentation of this file.

/*******************************************************************
 *   _________     _____      _____    ____  _____    ___  ____    *
 *  |_   ___  |  |_   _|     |_   _|  |_   \|_   _|  |_  ||_  _|   *
 *    | |_  \_|    | |         | |      |   \ | |      | |_/ /     *
 *    |  _|        | |   _     | |      | |\ \| |      |  __'.     *
 *   _| |_        _| |__/ |   _| |_    _| |_\   |_    _| |  \ \_   *
 *  |_____|      |________|  |_____|  |_____|\____|  |____||____|  *
 *                                                                 *
 *******************************************************************
 *                                                                 *
 *  fLink userspace library, low level operations                  *
 *                                                                 *
 *******************************************************************/
 
#include "flinklib.h"
#include "flinkioctl.h"
#include "types.h"
#include "error.h"
#include "log.h"
#include "valid.h"

#include <sys/ioctl.h>
#include <unistd.h>


int flink_ioctl(flink_dev* dev, int cmd, void* arg) {
    int ret;
    
    dbg_print("flink_ioctl '0x%x'\n", cmd);
    
    if(!validate_flink_dev(dev)) {
        flink_error(FLINK_EINVALDEV);
        return EXIT_ERROR;
    }
    
    ret = ioctl(dev->fd, cmd, arg);
    if(ret < 0) {
        libc_error();
    }
    
    return ret;
}


ssize_t flink_read(flink_subdev* subdev, uint32_t offset, uint8_t size, void* rdata) {
    int res = 0;
    ssize_t read_size = 0;
    ioctl_container_t ioctl_arg;
    ioctl_arg.subdevice = subdev->id;
    ioctl_arg.offset    = offset;
    ioctl_arg.size      = size;
    ioctl_arg.data      = rdata;
    
    // Check data pointer
    if(rdata == NULL) {
        flink_error(FLINK_ENULLPTR);
        return EXIT_ERROR;
    }
    
    // Check flink subdevice structure
    if(!validate_flink_subdev(subdev)) {
        flink_error(FLINK_EINVALDEV);
        return EXIT_ERROR;
    }

    // read data from device
    read_size = flink_ioctl(subdev->parent, SELECT_AND_READ, &ioctl_arg);
    if(read_size == -1) {
        libc_error();
        return EXIT_ERROR;
    }
    
    return read_size;
}


ssize_t flink_write(flink_subdev* subdev, uint32_t offset, uint8_t size, void* wdata) {
    int res = 0;
    ssize_t write_size = 0;
    ioctl_container_t ioctl_arg;
    ioctl_arg.subdevice = subdev->id;
    ioctl_arg.offset    = offset;
    ioctl_arg.size      = size;
    ioctl_arg.data      = wdata;
    
    // Check data pointer
    if(wdata == NULL) {
        flink_error(FLINK_ENULLPTR);
        return EXIT_ERROR;
    }
    
    // Check flink subdevice structure
    if(!validate_flink_subdev(subdev)) {
        flink_error(FLINK_EINVALDEV);
        return EXIT_ERROR;
    }
    
    // write data to device
    write_size = flink_ioctl(subdev->parent, SELECT_AND_WRITE, &ioctl_arg);
    if(write_size == -1) {
        libc_error();
        return EXIT_ERROR;
    }
    
    return write_size;
}


int flink_read_bit(flink_subdev* subdev, uint32_t offset, uint8_t bit, void* rdata) {
    ioctl_bit_container_t ioctl_arg;
    ioctl_arg.offset    = offset;
    ioctl_arg.bit       = bit;
    ioctl_arg.subdevice = subdev->id;
    
    // Check data pointer
    if(rdata == NULL) {
        flink_error(FLINK_ENULLPTR);
        return EXIT_ERROR;
    }
    
    // Check flink subdevice structure
    if(!validate_flink_subdev(subdev)) {
        flink_error(FLINK_EINVALDEV);
        return EXIT_ERROR;
    }
    
    // select subdevice and read data
    if(flink_ioctl(subdev->parent, SELECT_AND_READ_BIT, &ioctl_arg) < 0) {
        libc_error();
        return EXIT_ERROR;
    }
    
    *((uint8_t*)rdata) = ioctl_arg.value;
    
    return EXIT_SUCCESS;
}


int flink_write_bit(flink_subdev* subdev, uint32_t offset, uint8_t bit, void* wdata) {
    ioctl_bit_container_t ioctl_arg;
    ioctl_arg.offset    = offset;
    ioctl_arg.bit       = bit;
    ioctl_arg.value     = *((uint8_t*)wdata);
    ioctl_arg.subdevice = subdev->id;
    
    // Check data pointer
    if(wdata == NULL) {
        flink_error(FLINK_ENULLPTR);
        return EXIT_ERROR;
    }
    
    // Check flink subdevice structure
    if(!validate_flink_subdev(subdev)) {
        flink_error(FLINK_EINVALDEV);
        return EXIT_ERROR;
    }
    
    // select subdevice and write data
    if(flink_ioctl(subdev->parent, SELECT_AND_WRITE_BIT, &ioctl_arg) < 0) {
        libc_error();
        return EXIT_ERROR;
    }
    
    return EXIT_SUCCESS;
}