[C] Odbieranie danych z portu szeregowego, Linux

#include <unistd.h>
#include <fcntl.h>
#include <termios.h>
#include <errno.h>
#include <stdio.h>
#include <sys/ioctl.h> /* Dla ioctl */
#include "ATCommand.h"

// Wlasne funkcje
int Open( int fd, char * port ) {
    struct termios options;
   
    fd = open( port, O_RDWR | O_NOCTTY | O_NDELAY );
    if( fd < 0 ) {
        printf( "Blad podczas otwierania portu\n" );
        return - 1;
    }
    else {
        /* Getting the current settings for the port */
        tcgetattr( fd, & options );
       
        /* Setting baudrate (19200) */
        cfsetispeed( & options, B9600 );
        cfsetospeed( & options, B9600 );
       
        options.c_cflag &= ~CSIZE; /* Wylaczenie maski bitowej */
        options.c_cflag |= CS8; /* Osiem bitow danch */
        options.c_cflag &= ~CSTOPB; /* 1 bit stopu */
        options.c_cflag |= PARENB; /* Wlacz kontrole parzystosci */
        options.c_cflag &= ~PARODD; /* even parity */
       
        options.c_lflag &= ~( ICANON | ECHO | ECHOE | ISIG ); /* raw input (bez przetwarzania) */
       
        options.c_iflag &= ~( ICRNL | INLCR | IGNCR | IUCLC ); /* Wylaczenie mapowania */
        options.c_iflag &= ~( IXON | IXOFF | IXANY ); /* Wylaczenie kontroli przeplywu */
       
        options.c_oflag &= ~OPOST; /* Bez przetwarzania danych wyjsciowych */
       
        /* Setting the new settings for the port immediately */
        tcsetattr( fd, TCSANOW, & options );
        printf( "Port otwarty i skonfigurowany\n" );
        return fd;
    }
}

void ATI( char * port, char * odpowiedz )
{
    int fd = 0; /* File descriptor */
    int wynik; /* Wynik operacji na pliku */
    int bytes; /* Ilosc bajtow gotowych do odebrania */
   
    fd = Open( fd, port ); /* Otwarcie portu */
   
    /* Wyslanie danych */
    if( fd >= 0 ) {
        wynik = write( fd, "ATI\r", 4 ); /* \r to <CR> */
        if( wynik > 0 ) {
            printf( "Wyslano dane\n" );
        }
        else {
            printf( "Blad wysylania danych\n" );
            wynik = 0;
        }
    }
    else {
        wynik = 0;
        printf( "Blad otwarcia portu przy wysylaniu danych\n" );
    }
    close( fd );
   
    sleep( 0.5 ); /* Czekanie na odpowiedz układu */
   
    fd = 0;
    fd = Open( fd, port ); /* Otwarcie portu */
   
    /* Odebranie danych z urzadzenia */
    if( fd >= 0 ) {
        ioctl( fd, FIONREAD, & bytes ); /* Pobranie infiracji o ilosci bajtow czekajacych po pobrania */
        if( bytes > 0 ) {
            wynik = read( fd, odpowiedz, bytes );
            if( wynik > 0 ) {
                printf( "Pobrano dane" );
            }
            else {
                printf( "Blad pobierania danych\n" );
                wynik = 0;
            }
        }
        else {
            printf( "Brak danych do pobrania\n" );
            wynik = 0;
        }
    }
    else {
        wynik = 0;
        printf( "Blad otwarcia portu przy pobieraniu danych\n" );
    }
   
    close( fd );
}