Добрый день, уважаемые Коллеги.
ПЕРЕДАЧА
| Код |
#include <stdio.h> /* Стандартные объявления ввода/вывода */
#include <stdlib.h>
#include <string.h> /* Объявления строковых функций */
#include <unistd.h> /* Объявления стандартных функций UNIX */
#include <fcntl.h> /* Объявления управления файлами */
#include <errno.h> /* Объявления кодов ошибок */
#include <termios.h> /* Объявления управления POSIX-терминалом */
#include <time.h>
#include <sys/timeb.h>
#include <sys/types.h>
#include <sys/ioctl.h>
void clear_port(int);
void open_dev();
void work();
unsigned char time_out = 40;
int port;
char str[256];
int main(int argc,char **argv)
{
int i,j,k;
open_dev();
work();
}
/* Открытие и конфигурирование порта*/
void open_dev()
{
struct termios m_termios;
int j;
/* Открываем порт */
port = open("/dev/ttyAP0",O_RDWR|O_NDELAY|O_NOCTTY);
if(port < 0) {
printf("/dev/ttyAP0 Open BAD !!!\n") ;
exit(-1);
}
printf("/dev/ttyAP0 Open Ok !!!\n") ;
/* Получаем атрибуты порта */
tcgetattr(port, &m_termios);
m_termios.c_iflag |= ( BRKINT | IXANY | IMAXBEL | IUTF8 ) ;
m_termios.c_cflag |= ( CREAD | CLOCAL | HUPCL );
m_termios.c_cflag &= ~CSIZE; /* Mask the character size bits */
m_termios.c_cflag |= CS8; /* Select 8 data bits */
m_termios.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG); //Raw input
m_termios.c_oflag &= ~OPOST;
/* Установка четности */
m_termios.c_cflag &= (~PARODD) ;
m_termios.c_cflag &= (~PARENB) ;
/* Стопы */
m_termios.c_cflag &= (~CSTOPB) ;
/* Скорость */
cfsetospeed(&m_termios,B19200);
cfsetispeed(&m_termios,B19200);
/* Установка новых атрибутов */
tcsetattr(port,TCSANOW,&m_termios);
/* Очищаем порт */
clear_port(port);
printf("PORT - Ok!!! \n");
}
void work()
{
int i,j,len;
len = 5;
printf("WORK - BEGIN \n");
while(1) {
unsigned char XmitBuffer[len];
XmitBuffer[1] = 0;
XmitBuffer[2] = 1;
XmitBuffer[3] = 0x46;
XmitBuffer[4] = 0xB2;
for (i = 0; i < 8; i++) {
XmitBuffer[0] = i+1;
printf(" SENDER = %X,%X,%X,%X,%X,%X,\n",XmitBuffer[0],XmitBuffer[1],XmitBuffer[2],XmitBuffer[3],XmitBuffer[4],len);
if (write(port,XmitBuffer , len) == -1) {
printf("ERROR write in port");
}
sleep(1);
}
}
}
void clear_port(int i)
{
int j;
j=1;
while(j > 0) {
j=read(i,str,256);
}
}
|
ПРИЕМ
| Код |
#include <stdio.h> /* Стандартные объявления ввода/вывода */
#include <stdlib.h>
#include <string.h> /* Объявления строковых функций */
#include <unistd.h> /* Объявления стандартных функций UNIX */
#include <fcntl.h> /* Объявления управления файлами */
#include <errno.h> /* Объявления кодов ошибок */
#include <termios.h> /* Объявления управления POSIX-терминалом */
#include <time.h>
#include <sys/timeb.h>
#include <sys/types.h>
#include <sys/ioctl.h>
void clear_port(int);
void open_dev();
void work();
void read_data();
int wait_blok(int);
int time_out1 = 2000;
unsigned char time_out = 40;
int port;
char str[256];
unsigned char XmitBuffer[20];
int main(int argc,char **argv)
{
int i,j,k;
open_dev();
work();
}
/* Открытие и конфигурирование порта */
void open_dev()
{
struct termios m_termios;
int j;
/* Открываем порт */
port = open("/dev/ttyAP1",O_RDWR|O_NDELAY|O_NOCTTY);
if(port < 0) {
printf("/dev/ttyAP1 Open BAD !!!\n") ;
exit(-1);
}
printf("/dev/ttyAP1 Open Ok !!!\n") ;
/* Получаем атрибуты порта */
tcgetattr(port, &m_termios);
m_termios.c_iflag |= ( BRKINT | IXANY | IMAXBEL | IUTF8 ) ;
m_termios.c_cflag |= ( CREAD | CLOCAL | HUPCL );
m_termios.c_cflag &= ~CSIZE; /* Mask the character size bits */
m_termios.c_cflag |= CS8; /* Select 8 data bits */
m_termios.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG); //Raw input
m_termios.c_oflag &= ~OPOST;
/* Четность */
m_termios.c_cflag &= (~PARODD) ;
m_termios.c_cflag &= (~PARENB) ;
/* СТОПЫ */
m_termios.c_cflag &= (~CSTOPB) ;
/*Скорость */
cfsetospeed(&m_termios,B19200);
cfsetispeed(&m_termios,B19200);
/* Устанавливаем новые атрибуты */
tcsetattr(port,TCSANOW,&m_termios);
/* Очищаем порт */
clear_port(port);
printf("PORT - Ok!!! \n");
}
void work()
{
int i,j,len;
len = 5;
printf("WORK - BEGIN \n");
while(1) {
read_data();
}
}
void clear_port(int i)
{
int j;
j=1;
while(j > 0) {
j=read(i,str,256);
}
}
int wait_blok(int num)
{
struct timeb st_time,end_time;
time_t i,i1,l;
int n;
n=0;
ftime(&st_time);
while(n < num) {
ftime(&end_time);
i=end_time.time*1000+end_time.millitm;
i1=st_time.time*1000+st_time.millitm;
l=i - i1;
ioctl(port, FIONREAD, &n);
if(n >= num) {
printf(" COUNT BYTE = %d !!!!!!!!!!!!\n", n);
return 0 ;
}
if( l > time_out1) {
clear_port(port);
return(1);
}
}
return(0);
}
void read_data()
{
int j,c;
struct timeval mm_val;
fd_set infd;
FD_ZERO(&infd);
FD_SET(port, &infd);
mm_val.tv_sec= 2;
mm_val.tv_usec=0;
// юЙФБА ЛБДТ
j=port+1;
c = select(j, &infd, NULL, NULL, &mm_val);
if(c > 0 ) {
if (FD_ISSET(port, &infd)) {
if((j=wait_blok(5))) {
return;
}
j=read(port,XmitBuffer , 5);
printf(" RECEIVER = %X,%X,%X,%X,%X \n",XmitBuffer[0],XmitBuffer[1],XmitBuffer[2],XmitBuffer[3],XmitBuffer[4]);
}
}
}
|
Передающая пишет в порт по 5 байт с интервалом в 1сек.
Приемная должна читать по 5 байт, а читает мусор.
Может FIFO не задано ? Как задать ?
|
