Subversion Repositories igor

#include <termios.h>
#include <fcntl.h>
#include <strings.h>
#include <string.h>
#include <stdio.h>
#include <unistd.h>
#include "serialdmp.h"
 
 
static int fd;
struct termios settings, oldtio;
 
#define TYPES 12
 
 
static const char* types[TYPES] = {"NONE","INT","CONS","SNOC","PTR","ARRAY","NIL","T","CHAR","SYMBOL","FUNCTION","BUILTIN"};
 
 
int main() {
    unsigned char buffer[4];
    int i;
 
    if (serialinit() == -1 ) {
	printf("serialinit() failed. exiting\n");
	return -1;
    } else {
	printf("serialinit() completed");
    }
    for(i = 0 ; i< 4 ; i++ ) {
	buffer[i] = 0;
    }
 
    while ( 1 ) {
	getdata(buffer,sizeof(char));
	// If buffer = Unit Separator Convert to Object
	if ( buffer[0] == 17 ) {;
	    getdata(buffer,sizeof(buffer));
	    // This printf is somewhat.. ugly
	    printf("TYPE: %s\t DATA: 0x%02X%02X%02X\tRAW: 0x%02X%02X%02X%02X\n",(buffer[0]<TYPES)?types[buffer[0]]:"INVALID",buffer[1],buffer[2],buffer[3],buffer[0],buffer[1],buffer[2],buffer[3]);
 
	} else {
	    printf("RAW byte read: 0x%02X - %c\n", buffer[0], isalpha(buffer[0])?buffer[0]:'.');
	}
    }
 
}
 
 
 
int serialinit() {
 
    fd = open(DEVICE, O_RDONLY | O_NOCTTY);
    if ( fd < 0 ) {
	perror(DEVICE);
	return -1;
    }
 
    tcgetattr(fd, &oldtio);
    bzero(&settings, sizeof(settings));
 
    settings.c_cflag = BAUDRATE | CRTSCTS | CS8 | CSTOPB | CLOCAL | CREAD;
    settings.c_iflag = IGNPAR;
    settings.c_oflag = 0;
    settings.c_lflag = 0;
 
    settings.c_cc[VMIN]		= 2;
    settings.c_cc[VTIME]	= 0;
 
    tcflush(fd, TCIFLUSH);
    tcsetattr(fd, TCSANOW, &settings);
 
    return 0;
}
 
void serialuninit() {
    tcsetattr(fd, TCSANOW, &oldtio);
    close(fd);
}
 
void getdata(char* data ,unsigned char length) {
    char vmin = settings.c_cc[VMIN];
    settings.c_cc[VMIN] = length;
    tcsetattr(fd,TCSANOW,&settings);
    read(fd, data, length);
    settings.c_cc[VMIN] = vmin;
    tcsetattr(fd,TCSANOW,&settings);
}