info.c

Go to the documentation of this file.

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

#include <stdint.h>

int flink_info_get_description(flink_subdev* subdev, char* desc) {
    uint32_t offset;
    int i, k;
    uint32_t data;
    
    dbg_print("Reading description from info subdevice with id %d\n", subdev->id);
    
    offset = HEADER_SIZE + SUBHEADER_SIZE + REGISTER_WITH;
    for(i = 0; i < INFO_DESC_SIZE; i += 4, offset += 4) {
        if(flink_read(subdev, offset, 4, &data) != REGISTER_WITH) {
            libc_error();
            return EXIT_ERROR;
        }
        for (k = REGISTER_WITH - 1; k >= 0; k--) {
            *((uint8_t *)desc) = (uint8_t)(data >> (k * 8));
            desc++;
        }
        dbg_print("\t 0x%x\n", data);   
    }
    return EXIT_SUCCESS;
}