129 lines
2.8 KiB
C
129 lines
2.8 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <sys/time.h> // gettimeofday
|
|
#include <sys/stat.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <sys/types.h>
|
|
#include <fcntl.h>
|
|
#include <sys/mman.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/socket.h>
|
|
#include <netinet/in.h>
|
|
#include <arpa/inet.h>
|
|
#include <netdb.h>
|
|
#include <errno.h>
|
|
|
|
#include "serial.h"
|
|
#include "uartinf.h"
|
|
#include "confile.h"
|
|
#include "udp_util.h"
|
|
|
|
char _rx_data[1024];
|
|
|
|
|
|
int main (int argc, char *argv[])
|
|
{
|
|
char buffer[1024];
|
|
char buffer1[1024];
|
|
char buffer2[1024];
|
|
|
|
int stream;
|
|
int stream1;
|
|
int stream2;
|
|
|
|
int fd_param1;
|
|
// float *buffer_param1;
|
|
int *buffer_param1;
|
|
int signal;
|
|
int signal1;
|
|
int signal2;
|
|
//int len;
|
|
//n_read = uart_init(ROUTE_UART, "/dev/ttyAMA0", 115200, 'N');
|
|
//if(n_read <=0 ) {
|
|
// printf("open /dev/ttyPS1 failed\n");
|
|
// return -1;
|
|
// }
|
|
|
|
fd_param1 = shm_open("/param.txt",O_RDWR|O_CREAT|O_EXCL,0777);
|
|
if(fd_param1 < 0){
|
|
fd_param1 = shm_open("/param.txt",O_RDWR,0777);
|
|
}else
|
|
ftruncate(fd_param1,4096);
|
|
buffer_param1= mmap(NULL,4096,PROT_READ|PROT_WRITE,MAP_SHARED,fd_param1,0);
|
|
|
|
//buffer_param1[0]=0xAA;
|
|
|
|
while(1){
|
|
|
|
stream = open("/tmp/ceshi.txt", O_RDWR);
|
|
//printf("stream %s\n\r",buffer);
|
|
ssize_t byread = read(stream,buffer,sizeof(buffer));
|
|
|
|
// printf("buffer %s\n\r",buffer);
|
|
signal=atoi(buffer);
|
|
// printf("--- %d\n\r",signal);
|
|
printf("--- %x\n\r",signal);
|
|
#if 1
|
|
stream1 = open("/tmp/ceshi1.txt", O_RDWR);
|
|
ssize_t byread1 = read(stream1,buffer1,sizeof(buffer1));
|
|
// printf("buffer1 %s\n\r",buffer2);
|
|
signal1=atof(buffer1);
|
|
// printf("--- %d\n\r",signal1);
|
|
printf("--- %x\n\r",signal1);
|
|
// printf("1 --- %f\n\r",signal1);
|
|
//buffer_param1[1]=signal1;
|
|
|
|
stream2 = open("/tmp/ceshi2.txt", O_RDWR);
|
|
ssize_t byread2 = read(stream2,buffer2,sizeof(buffer2));
|
|
// printf("buffer2 %s\n\r",buffer2);
|
|
signal2=atof(buffer2);
|
|
// printf("--- %d\n\r",signal2);
|
|
printf("--- %x\n\r",signal2);
|
|
//buffer_param1[2]=signal2;
|
|
#endif
|
|
if(stream > 0){
|
|
#if 1
|
|
if(signal==0x42){ //66
|
|
buffer_param1[0]=0xaa;//0xaa;
|
|
//printf("--down--\n\r");
|
|
|
|
}
|
|
else if(signal==0x37)
|
|
{
|
|
buffer_param1[0]=0x55;//0x55; //55
|
|
//printf("--up--\n\r");
|
|
}
|
|
|
|
if(signal1==0x42){ //66
|
|
buffer_param1[5]=0xaa;//0xaa;
|
|
//printf("--down--\n\r");
|
|
|
|
}
|
|
else if(signal1==0x37)
|
|
{
|
|
buffer_param1[5]=0x55;//0x55; //55
|
|
//printf("--up--\n\r");
|
|
}
|
|
|
|
if(signal2==0x42){ //66
|
|
buffer_param1[4]=0xaa;//0xaa;
|
|
// printf("--down--\n\r");
|
|
|
|
}
|
|
else if(signal2==0x37)
|
|
{
|
|
buffer_param1[4]=0x55;//0x55; //55
|
|
// printf("--up--\n\r");
|
|
}
|
|
#endif
|
|
}
|
|
|
|
close(stream);
|
|
close(stream1);
|
|
close(stream2);
|
|
sleep(1);
|
|
}
|
|
|
|
}
|