sim-card
/
sam7-util
Archived
9
0
Fork 0
Utility for SAM-BA flashing of AT91SAM7
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
This repo is archived. You can view files and clone it, but cannot push or open issues/pull-requests.
 
 
 
 
sam7-util/io_posix.c

114 lines
2.0 KiB

/*
* io.c
*
* Copyright (C) 2005 Erik Gilling, all rights reserved
* Copyright (C) 2011 Holger Freyther, 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
static int posix_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();
}
static int posix_io_cleanup( void )
{
close( io_fd );
return 0;
}
static int posix_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;
}
static int posix_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
}
static struct io_driver posix_driver = {
.name = "posix",
.io_init = posix_io_init,
.io_cleanup = posix_io_cleanup,
.io_write = posix_io_write,
.io_read = posix_io_read,
};
static void __attribute__((constructor)) posix_on_load(void)
{
io_driver_register(&posix_driver);
}