lbp.c

//
//    Copyright (C) 2013-2014 Michael Geszkiewicz
//
//    This program is free software; you can redistribute it and/or modify
//    it under the terms of the GNU General Public License as published by
//    the Free Software Foundation; either version 2 of the License, or
//    (at your option) any later version.
//
//    This program is distributed in the hope that it will be useful,
//    but WITHOUT ANY WARRANTY; without even the implied warranty of
//    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
//    GNU General Public License for more details.
//
//    You should have received a copy of the GNU General Public License
//    along with this program; if not, write to the Free Software
//    Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
//

#ifdef _WIN32
#include <windows.h>
#endif
#include <sys/fcntl.h>
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "types.h"
#include "boards.h"
#include "lbp.h"

#ifdef __linux__
static int sd = -1;
#elif _WIN32
HANDLE sd;
#endif

void lbp_send_checked(void *packet, int size) {
#ifdef __linux__
    int result = write(sd, packet, size);
    if (result != size) {
        perror("write(lbp_send_checked)");
        abort();
    }
#elif _WIN32
    BOOL result = WriteFile(sd, packet, size, &send, NULL);
    if (!result) {
        printf("WriteFile(lbp_send_checked): %d\n", GetLastError());
    }
#endif
}

void lbp_recv_checked(void *packet, int size) {
#ifdef __linux__
    int result = read(sd, packet, size);
    if (result != size) {
        perror("read(lbp_recv_checked)");
        abort();
    }
#elif _WIN32
    BOOL result = ReadFile(sd, packet, size, &recv, NULL);
    if (!result) {
        printf("ReadFile(lbp_recv_checked): %d\n", GetLastError());
    }
#endif
}

u8 lbp_read_ctrl(u8 cmd) {
    u8 data;

    lbp_send_checked(&cmd, 1);
    lbp_recv_checked(&data, 1);
    if (LBP_SENDRECV_DEBUG)
        printf("send(%X), recv(%X)\n", cmd, data);

    return data;
}

int lbp_read(u16 addr, void *buffer) {
    lbp_cmd_addr packet;
    u32 *ptr = buffer;

    packet.cmd = LBP_CMD_READ | LBP_ARGS_32BIT;
    packet.addr_hi = LO_BYTE(addr);
    packet.addr_lo = HI_BYTE(addr);

    lbp_send_checked(&packet, sizeof(lbp_cmd_addr));
    lbp_recv_checked(buffer, 4);
    if (LBP_SENDRECV_DEBUG)
        printf("lbp_read(%02X:%04X): %08X\n", packet.cmd, addr, *ptr);

    return 0;
}

int lbp_write(u16 addr, void *buffer) {
    lbp_cmd_addr_data packet;

    packet.cmd = LBP_CMD_WRITE | LBP_ARGS_32BIT;
    packet.addr_hi = LO_BYTE(addr);
    packet.addr_lo = HI_BYTE(addr);
    memcpy(&packet.data, buffer, 4);

    lbp_send_checked(&packet, sizeof(lbp_cmd_addr_data));
    if (LBP_SENDRECV_DEBUG)
        printf("lbp_write(%02X:%04X)\n", packet.cmd, addr);

    return 0;
}

void lbp_print_info() {
    u8 data;

    data = lbp_read_ctrl(LBP_CMD_READ_VERSION);
    printf("  LBP version %d\n", data);
}

void lbp_init(board_access_t *access) {
#ifdef __linux__
    sd = open(access->dev_addr, O_RDWR, O_NONBLOCK);
    if (sd == -1) 
        perror("Unable to open the serial port\n");
#elif _WIN32
    char dev_name[32];
    
    snprintf(dev_name, 32, "\\\\.\\%s", access->dev_addr);
    sd = CreateFile(dev_name, GENERIC_READ | GENERIC_WRITE, 0, 0, OPEN_EXISTING, 0, 0);
    if (sd == INVALID_HANDLE_VALUE) { 
        printf("Unable to open the serial port %d\n", errno);
    }
#endif
}

void lbp_release() {
#ifdef __linux__
    close(sd);
#endif
}