TMSG44-CoolPi/main.c

#include <sys/socket.h>
#include <netinet/in.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <unistd.h>
#include <errno.h>
#include <arpa/inet.h> 
#include <signal.h>
#include <sys/mman.h>
#include <fcntl.h>

#include "Devices//tmsgheaders.h"
#include "Devices//lmx2594.h"
#include "Devices//lmk04821.h"
#include "Devices//ad9912.h"

#include "command.h"

#define REQUESTED_MEMORY_SIZE  0x1000
#define SERVER_PORT 5000
#define BACKLOG 10

volatile int conn_fd = 0;
volatile int pci_fd = 0;
int listen_fd = 0;

void *bar1;

//Обработчик ошибок
void error(const char *msg)
{
	perror(msg);

	if (conn_fd != 0) 
	{
		close(conn_fd);
	}
	if (listen_fd != 0) 
	{
		close(listen_fd);
	}
    if (pci_fd != 0)
    {
        close(pci_fd);
    }
    munmap(bar1, REQUESTED_MEMORY_SIZE);
	exit(1);
} 

//Обработчик сигнала SIGINT завершения программы при нажатии Ctrl+C
void handleCloseSignal(int signal)
{
	if (signal == SIGINT) 
	{
		printf("\nCaught signal %d, closing socket and exiting...\n", signal);
		if (conn_fd != 0) 
		{
			close(conn_fd);
		}
		if (listen_fd != 0) 
		{
			close(listen_fd);
		}
        if (pci_fd != 0)
        {
            close(pci_fd);
        }
        munmap(bar1, REQUESTED_MEMORY_SIZE);
		exit(0);
	}
}

int main(int argc, char *argv[])
{
	socklen_t client_len;
	ssize_t n;
	struct sockaddr_in serv_addr, client_addr;
	char recvBuff[1024];

    char *filename = "/dev/MyDmaModule";

    pci_fd = open(filename, O_RDWR | O_SYNC);
    if (pci_fd == -1) {
        int error = errno;
        fprintf(stderr, "Cannot open file: %s\n", strerror(error));
        return 1;
    }

    bar1 = mmap(NULL, REQUESTED_MEMORY_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, pci_fd, 0);
    printf("bar0 ptr %p\n", bar1);
    if (bar1 == MAP_FAILED) {
        perror("mmap");
        close(pci_fd);
        return 1;
    }

    lmk04821_a_init(bar1);
    usleep(500);
    lmk04821_b_init(bar1);
    rst_for_fpga(bar1);
    shift_reg(bar1);
    ad9912_init(bar1);
    lmx2594_init(bar1);

	// Установка обработчика сигналов
	signal(SIGINT, handleCloseSignal);

	// if(argc != 2)
	// {
	// 	printf("\n Usage: %s <ip of server> \n",argv[0]);
	// 	return 1;
	// }

	listen_fd = socket(AF_INET, SOCK_STREAM, 0);
	{
		error("Error : Could not create socket!");
	} 

	memset(&serv_addr, 0, sizeof(serv_addr));

	serv_addr.sin_family = AF_INET;
	serv_addr.sin_addr.s_addr = htonl(INADDR_ANY);
	serv_addr.sin_port = htons(SERVER_PORT); 

	// if (inet_pton(AF_INET, argv[1], &serv_addr.sin_addr) <= 0)
	// {
	// 	error("inet_pton error occured");
	// } 

	// if (connect(sockfd, (struct sockaddr *)&serv_addr, sizeof(serv_addr)) < 0)
	// {
	//    error("Error : Connect Failed");
	// }

	if (bind(listen_fd, (struct sockaddr*)&serv_addr, sizeof(serv_addr)) < 0) 
	{
        error("Error : Bind failed");
    }

	if (listen(listen_fd, BACKLOG) < 0) 
	{
        error("Error : Listen failed");
    }
	
	while(1) {
		client_len = sizeof(client_addr);
		conn_fd = accept(listen_fd, (struct sockaddr*)&client_addr, &client_len);
		if (conn_fd < 0) 
		{
			perror("Error : Accept failed");
			continue;
		}

		memset(recvBuff, 0,sizeof(recvBuff));

		while ((n = recv(conn_fd, recvBuff, sizeof(recvBuff) - 1, 0)) > 0)
		{
			recvBuff[n] = 0;
			if(fputs(recvBuff, stdout) == EOF)
			{
				printf("\n Error : Fputs error\n");
				break;
			}
			//Запуск парсера команд
			processCommand(recvBuff);
		} 

		if (n == 0)
		{
			printf("\n Client closed the connection\n");
		}
		else if (n < 0)
		{
			error("Read error");
		} 

		close(conn_fd);
	}

	close(listen_fd);

    munmap(bar1, REQUESTED_MEMORY_SIZE);
    int fd_close = close(pci_fd);
    if (fd_close == -1) {
        perror("close");
        return 1;
    }

	return 0;
}