litex/vpi/ipc.c

/*
 * Copyright (C) 2012 Vermeer Manufacturing Co.
 * License: GPLv3 with additional permissions (see README).
 */

#ifdef _WIN32
#define WINVER 0x501
#endif

#include <assert.h>
#include <sys/types.h>
#include <unistd.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>

#ifdef _WIN32
#include <winsock2.h>
#include <ws2tcpip.h>
#else
#include <sys/socket.h>
#include <sys/un.h>
#endif


#include "ipc.h"

struct ipc_softc {
	int socket;
	go_handler h_go;
	write_handler h_write;
	read_handler h_read;
	void *user;
};

#define MAX_LEN 2048

#ifdef _WIN32
#define HEADER_LEN 2
#define SOCKET_PORT "50007"

unsigned char ipc_rxbuffer[2*MAX_LEN];
int ipc_rxlen;
#else
#define HEADER_LEN 0
#endif

struct ipc_softc *ipc_connect(const char *sockaddr,
	go_handler h_go, write_handler h_write, read_handler h_read, void *user)
{
	struct ipc_softc *sc;
#ifdef _WIN32
	struct addrinfo hints, *my_addrinfo;
	WSADATA wsaData;
	ipc_rxlen = 0;
#else
	struct sockaddr_un addr;
#endif

	sc = malloc(sizeof(struct ipc_softc));
	if(!sc) return NULL;

	sc->h_go = h_go;
	sc->h_write = h_write;
	sc->h_read = h_read;
	sc->user = user;

#ifdef _WIN32
	/* Initialize Winsock. */
	if (WSAStartup(MAKEWORD(2, 2), &wsaData) != 0) {
		free(sc);
		return NULL;
	}

	memset(&hints, 0, sizeof(hints));
	hints.ai_family = AF_INET;
	hints.ai_socktype = SOCK_STREAM;
	hints.ai_protocol = IPPROTO_TCP;

	if(getaddrinfo(sockaddr, SOCKET_PORT, NULL, &my_addrinfo) != 0) {
		free(sc);
		return NULL;
	}

	sc->socket = socket(AF_INET, SOCK_STREAM, 0);
	if(sc->socket < 0) {
		free(sc);
		return NULL;
	}

	if(connect(sc->socket, my_addrinfo->ai_addr, my_addrinfo->ai_addrlen) != 0) {
		close(sc->socket);
		free(sc);
		return NULL;
	}
#else
	sc->socket = socket(AF_UNIX, SOCK_SEQPACKET, 0);
	if(sc->socket < 0) {
		free(sc);
		return NULL;
	}

	addr.sun_family = AF_UNIX;
	strcpy(addr.sun_path, sockaddr);
	if(connect(sc->socket, (struct sockaddr *)&addr, sizeof(addr)) != 0) {
		close(sc->socket);
		free(sc);
		return NULL;
	}
#endif

	return sc;
}

void ipc_destroy(struct ipc_softc *sc)
{
	close(sc->socket);
	free(sc);
#ifdef _WIN32
	WSACleanup();
#endif
}

enum {
	MESSAGE_TICK = 0,
	MESSAGE_GO,
	MESSAGE_WRITE,
	MESSAGE_READ,
	MESSAGE_READ_REPLY
};

static int ipc_receive_packet(struct ipc_softc *sc, unsigned char *buffer) {
#ifdef _WIN32
	int len;
	int packet_len;
	/* ensure we have packet header */
	while(ipc_rxlen < HEADER_LEN) {
		len = recv(sc->socket, (char *)&ipc_rxbuffer[ipc_rxlen], MAX_LEN, 0);
		if(len)
			ipc_rxlen += len;
	}

	/* compute packet length and ensure we have the payload */
	packet_len = (ipc_rxbuffer[1] << 8) | ipc_rxbuffer[0];
	while(ipc_rxlen < packet_len) {
		len = recv(sc->socket, (char *)&ipc_rxbuffer[ipc_rxlen], MAX_LEN, 0);
		if(len)
			ipc_rxlen += len;
	}

	/* copy packet to buffer */
	memcpy(buffer, ipc_rxbuffer + HEADER_LEN, packet_len - HEADER_LEN);

	/* prepare ipc_rxbuffer for next packet */
	ipc_rxlen = ipc_rxlen - packet_len;
	memcpy(ipc_rxbuffer, ipc_rxbuffer + packet_len, ipc_rxlen);

	return packet_len - HEADER_LEN;
#else
	return recv(sc->socket, buffer, MAX_LEN, 0);
#endif
}

/*
 * 0 -> error
 * 1 -> success
 * 2 -> graceful shutdown
 */
int ipc_receive(struct ipc_softc *sc)
{
	unsigned char buffer[MAX_LEN];
	ssize_t l = 0;
	int i;

	l = ipc_receive_packet(sc, (unsigned char *)&buffer);
	if(l == 0)
		return 2;
	if((l < 0) || (l >= MAX_LEN))
		return 0;
	i = 0;

	switch(buffer[i++]) {
		case MESSAGE_GO:
			assert((l - i) == 0);

			return sc->h_go(sc->user);
		case MESSAGE_WRITE: {
			char *name;
			int nchunks;
			unsigned char *chunks;
			unsigned int chunk_index;

			name = (char *)&buffer[i];
			i += strlen(name) + 1;
			assert((i+4) < l);
			chunk_index = buffer[i] | buffer[i+1] << 8 | buffer[i+2] << 16 | buffer[i+3] << 24;
			i += 4;
			nchunks = buffer[i++];
			assert(i + nchunks == l);
			chunks = (unsigned char *)&buffer[i];

			return sc->h_write(name, chunk_index, nchunks, chunks, sc->user);
		}
		case MESSAGE_READ: {
			char *name;
			unsigned int name_index;

			name = (char *)&buffer[i];
			i += strlen(name) + 1;
			assert((i+4) == l);
			name_index = buffer[i] | buffer[i+1] << 8 | buffer[i+2] << 16 | buffer[i+3] << 24;

			return sc->h_read(name, name_index, sc->user);
		}
		default:
			return 0;
	}
}

int ipc_tick(struct ipc_softc *sc)
{
	ssize_t l;
	char c[HEADER_LEN + 1];

#ifdef _WIN32
	c[0] = 3;
	c[1] = 0;
#endif
	c[HEADER_LEN + 0] = MESSAGE_TICK;
	l = send(sc->socket, c, HEADER_LEN + 1, 0);
	if(l != (HEADER_LEN + 1))
		return 0;

	return 1;
}

int ipc_read_reply(struct ipc_softc *sc, int nchunks, const unsigned char *chunks)
{
	int len;
	char buffer[MAX_LEN];
	ssize_t l;

	len = nchunks + HEADER_LEN + 2;
	assert(len < MAX_LEN);
	assert(nchunks < 256);

#ifdef _WIN32
	buffer[0] = len & 0xFF;
	buffer[1] = (0xFF00 & len) >> 8;
#endif
	buffer[HEADER_LEN + 0] = MESSAGE_READ_REPLY;
	buffer[HEADER_LEN + 1] = nchunks;
	memcpy(&buffer[HEADER_LEN + 2], chunks, nchunks);

	l = send(sc->socket, buffer, len, 0);
	if(l != len)
		return 0;
	return 1;
}