dio.c

Go to the documentation of this file.

/*******************************************************************
 *   _________     _____      _____    ____  _____    ___  ____    *
 *  |_   ___  |  |_   _|     |_   _|  |_   \|_   _|  |_  ||_  _|   *
 *    | |_  \_|    | |         | |      |   \ | |      | |_/ /     *
 *    |  _|        | |   _     | |      | |\ \| |      |  __'.     *
 *   _| |_        _| |__/ |   _| |_    _| |_\   |_    _| |  \ \_   *
 *  |_____|      |________|  |_____|  |_____|\____|  |____||____|  *
 *                                                                 *
 *******************************************************************
 *                                                                 *
 *  flink userspace library, subdevice function "digital I/O"      *
 *                                                                 *
 *******************************************************************/
 
#include "flinklib.h"
#include "types.h"
#include "error.h"
#include "log.h"

#include <stdint.h>

int flink_dio_set_direction(flink_subdev* subdev, uint32_t channel, uint8_t output) {
    uint32_t offset;
    uint8_t bit;
    
    dbg_print("Setting digital I/O direction for channel %d on subdevice %d\n", channel, subdev->id);
    
    offset = HEADER_SIZE + SUBHEADER_SIZE + channel / (REGISTER_WITH * 8);
    bit = channel % (REGISTER_WITH * 8);
    
    dbg_print("   --> calculated offset is 0x%x\n", offset);
    dbg_print("   --> calculated bit is %u\n", bit);
    
    if(flink_write_bit(subdev, offset, bit, &output)) {
        libc_error();
        return EXIT_ERROR;
    }
    return EXIT_SUCCESS;
}

int flink_dio_set_value(flink_subdev* subdev, uint32_t channel, uint8_t value) {
    uint32_t offset;
    uint8_t bit;
    uint8_t val = (value != 0);
    
    dbg_print("Setting digital output value to %u...\n", val);
    
    offset = HEADER_SIZE + SUBHEADER_SIZE + subdev->nof_channels / (REGISTER_WITH * 8) + channel / (REGISTER_WITH * 8);
    if(subdev->nof_channels % (REGISTER_WITH * 8) != 0) offset += 4;
    bit = channel % (REGISTER_WITH * 8);
    
    dbg_print("   --> calculated offset is 0x%x\n", offset);
    dbg_print("   --> calculated bit is %u\n", bit);
    
    if(flink_write_bit(subdev, offset, bit, &val)) {
        libc_error();
        return EXIT_ERROR;
    }
    return EXIT_SUCCESS;
}

int flink_dio_get_value(flink_subdev* subdev, uint32_t channel, uint8_t* value) {
    uint32_t offset;
    uint8_t bit;
    
    dbg_print("Reading digital input value from channel %d on subdevice %d\n", channel, subdev->id);
    
    offset = HEADER_SIZE + SUBHEADER_SIZE + subdev->nof_channels / (REGISTER_WITH * 8) + channel / (REGISTER_WITH * 8);
    if(subdev->nof_channels % (REGISTER_WITH * 8) != 0) offset += 4;
    bit = channel % (REGISTER_WITH * 8);
    
    dbg_print("[DEBUG]   --> calculated offset is 0x%x\n", offset);
    dbg_print("[DEBUG]   --> calculated bit is %u\n", bit);
    
    if(flink_read_bit(subdev, offset, bit, value)) {
        libc_error();
        return EXIT_ERROR;
    }
    return EXIT_SUCCESS;
}