Matomat/sam7utils/io_posix.c

/*
 * io.c
 *
 * Copyright (C) 2005 Erik Gilling, all rights reserved
 *
 *	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, version 2.
 *
 */

#include "config.h"

#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/select.h>
#include <sys/termios.h>

#include <stdio.h>
#include <string.h>
#include <errno.h>


#ifdef HAVE_STDINT_H
#include <stdint.h>
#endif

#include "io.h"
#include "samba.h"

static int io_fd;

#define SAM7_TTY "/dev/ttyUSB0"

#undef DEBUG_IO

int io_init( char *dev )
{
  struct termios port_setting;
  
  if( dev == NULL ) {
    dev = SAM7_TTY;
  }
  //  char buff[16];

  if( (io_fd = open( dev, O_RDWR )) < 0 ) {
    printf( "can't open \"%s\": %s\n", dev, strerror( errno ) );
    return -1;        
    }
    
  if(tcgetattr(io_fd, &port_setting)!=0)
    return -2;
	
  port_setting.c_iflag = IGNBRK | IGNPAR;
  port_setting.c_cflag = B115200 | CS8 | CREAD | HUPCL | CLOCAL;
  port_setting.c_oflag = 0;
  port_setting.c_lflag = 0;
  
  if(tcsetattr(io_fd, TCSAFLUSH, &port_setting)!=0)
    return -3;
  else
     return samba_init();
}

int io_cleanup( void )
{
  close( io_fd );
  
  return 0;
}
int io_write( void *buff, int len ) 
{
  int write_len = 0;
  int ret;

#ifdef DEBUG_IO
  write( STDOUT_FILENO, ">", 1 );
  write( STDOUT_FILENO, buff, len );
  write( STDOUT_FILENO, "\n", 1 );
  
#endif
  while( write_len < len ) {
    if( (ret = write( io_fd, buff + write_len, len - write_len )) < 0 ) {
      return -1;
    }
    write_len += ret;
  }

  return write_len;
}

int io_read( void *buff, int len ) 
{
#ifdef DEBUG_IO
  int i;
  char outbuff[16];
  len = read( io_fd, buff, len );
  write( STDOUT_FILENO, "<", 1 );
  for( i=0 ; i<len ; i++ ) {
    snprintf( outbuff, 16, " %02X", ((char*)buff)[i] & 0xff );
    write( STDOUT_FILENO, outbuff, strlen(outbuff) );
  }
  write( STDOUT_FILENO, "\n", 1 );

  return len;
#else
  return read( io_fd, buff, len );
#endif
}

#if 0
int io_read_response( char *buff, int len ) 
{
  int read_len = 0;
  struct timeval tv;
  fd_set fds;
  int ret;
  
  while( read_len < len ) {

    tv.tv_sec = 1;
    tv.tv_usec = 0;
    
    FD_ZERO( &fds );
    FD_SET( io_fd, &fds );

    if( (ret = select( io_fd + 1, &fds, NULL, NULL, &tv )) < 0 ) {
      if( errno == EINTR ) {
	continue;
      }
    }
    if( ret == 0 ) {
      buff[read_len] = '\0';
      printf( "timeout '%s'\n", buff);
      return -read_len;
    }

    if( (ret = read( io_fd, buff + read_len, len - read_len )) < 0 ) {
      return -1;
    }
    read_len += ret;

    if( (read_len > 0) && 
	buff[ read_len - 1 ] == '>' ) {
      if( (read_len > 2) &&
	  buff[ read_len - 2 ] == '\r' &&
	  buff[ read_len - 3 ] == '\n' ) {
	return buff[read_len - 3] = '\0' ;
	return read_len-3 ;
      } else {
	return buff[read_len - 1] = '\0' ;
	return read_len-1 ;
      }
    }
  }

  return read_len;
}
#endif