150 lines
2.6 KiB
C
150 lines
2.6 KiB
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 <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/at91_0"
|
|
|
|
#undef DEBUG_IO
|
|
|
|
int io_init( char *dev )
|
|
{
|
|
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;
|
|
}
|
|
|
|
|
|
|
|
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
|