#include <stdio.h>
#include <sys/socket.h>
#include <sys/types.h>
#include <netinet/in.h>
#include <unistd.h>
#include <string.h>
#include <stdlib.h> //atoi()
#define PORT 13400
int main()
{
int server_fd, new_socket, ret;
struct sockaddr_in address;
int addrlen = sizeof(address);
char buffer[100] = {0x00, };
char rountine_active[15] = { 0x02,
0xfd,
0x00,0x05,
0x00,0x00,0x00,0x07,
0x0e,0x81,
0x00,
0x00,0x00,0x00,0x00 };
char daig_msg[15] = { 0x02,
0xfd,
0x80,0x01,
0x00,0x00,0x00,0x07,
0x0e,0x81,
0x10,0x02,
0x22,0xf1,0x86 };
// Create server socket
if ((server_fd = socket(AF_INET, SOCK_STREAM, 0)) == 0)
{
perror("socket failed");
exit(EXIT_FAILURE);
}
// Bind socket to port
address.sin_family = AF_INET;
address.sin_addr.s_addr = INADDR_ANY;
address.sin_port = htons(PORT);
if (bind(server_fd, (struct sockaddr *)&address, sizeof(address))<0)
{
perror("bind failed");
exit(EXIT_FAILURE);
}
// Listen for incoming connections
if (listen(server_fd, 3) < 0)
{
perror("listen failed");
exit(EXIT_FAILURE);
}
// Accept incoming connections and read data
while(1)
{
printf("\nWaiting for client connection...\n");
if ((new_socket = accept(server_fd, (struct sockaddr *)&address, (socklen_t*)&addrlen))<0)
{
perror("accept failed");
exit(EXIT_FAILURE);
}
printf("Client connected!\n");
bzero(buffer, sizeof(buffer));
ret = read(new_socket, buffer, sizeof(buffer));
if(ret<=0)
{
perror("read failed");
close(new_socket);
continue;
}
printf("Received data: ");
for(int i=0; i<ret; i++)
{
printf("%02X ", buffer[i]);
}
printf("\n");
if(memcmp(buffer, rountine_active, sizeof(rountine_active)) == 0)
{
printf("Routine active message received.\n");
// Process routine active message
}
else if(memcmp(buffer, daig_msg, sizeof(daig_msg)) == 0)
{
printf("Daig message received.\n");
// Process daig message
}
close(new_socket);
}
return 0;
}