[mirror_ubuntu-artful-kernel.git] / arch / um / drivers / daemon_user.c

/*
 * Copyright (C) 2001 Lennert Buytenhek (buytenh@gnu.org) and 
 * James Leu (jleu@mindspring.net).
 * Copyright (C) 2001 by various other people who didn't put their name here.
 * Licensed under the GPL.
 */

#include <errno.h>
#include <unistd.h>
#include <stdint.h>
#include <sys/socket.h>
#include <sys/un.h>
#include <sys/time.h>
#include "net_user.h"
#include "daemon.h"
#include "kern_util.h"
#include "user_util.h"
#include "user.h"
#include "os.h"
#include "um_malloc.h"

#define MAX_PACKET (ETH_MAX_PACKET + ETH_HEADER_OTHER)

enum request_type { REQ_NEW_CONTROL };

#define SWITCH_MAGIC 0xfeedface

struct request_v3 {
	uint32_t magic;
	uint32_t version;
	enum request_type type;
	struct sockaddr_un sock;
};

static struct sockaddr_un *new_addr(void *name, int len)
{
	struct sockaddr_un *sun;

	sun = um_kmalloc(sizeof(struct sockaddr_un));
	if(sun == NULL){
		printk("new_addr: allocation of sockaddr_un failed\n");
		return NULL;
	}
	sun->sun_family = AF_UNIX;
	memcpy(sun->sun_path, name, len);
	return sun;
}

static int connect_to_switch(struct daemon_data *pri)
{
	struct sockaddr_un *ctl_addr = pri->ctl_addr;
	struct sockaddr_un *local_addr = pri->local_addr;
	struct sockaddr_un *sun;
	struct request_v3 req;
	int fd, n, err;

	pri->control = socket(AF_UNIX, SOCK_STREAM, 0);
	if(pri->control < 0){
		err = -errno;
		printk("daemon_open : control socket failed, errno = %d\n", 
		       -err);
		return err;
	}

	if(connect(pri->control, (struct sockaddr *) ctl_addr, 
		   sizeof(*ctl_addr)) < 0){
		err = -errno;
		printk("daemon_open : control connect failed, errno = %d\n",
		       -err);
		goto out;
	}

	fd = socket(AF_UNIX, SOCK_DGRAM, 0);
	if(fd < 0){
		err = -errno;
		printk("daemon_open : data socket failed, errno = %d\n",
		       -err);
		goto out;
	}
	if(bind(fd, (struct sockaddr *) local_addr, sizeof(*local_addr)) < 0){
		err = -errno;
		printk("daemon_open : data bind failed, errno = %d\n",
		       -err);
		goto out_close;
	}

	sun = um_kmalloc(sizeof(struct sockaddr_un));
	if(sun == NULL){
		printk("new_addr: allocation of sockaddr_un failed\n");
		err = -ENOMEM;
		goto out_close;
	}

	req.magic = SWITCH_MAGIC;
	req.version = SWITCH_VERSION;
	req.type = REQ_NEW_CONTROL;
	req.sock = *local_addr;
	n = os_write_file(pri->control, &req, sizeof(req));
	if(n != sizeof(req)){
		printk("daemon_open : control setup request failed, err = %d\n",
		       -n);
		err = -ENOTCONN;
		goto out_free;
	}

	n = os_read_file(pri->control, sun, sizeof(*sun));
	if(n != sizeof(*sun)){
		printk("daemon_open : read of data socket failed, err = %d\n",
		       -n);
		err = -ENOTCONN;
		goto out_free;
	}

	pri->data_addr = sun;
	return fd;

 out_free:
	kfree(sun);
 out_close:
	os_close_file(fd);
 out:
	os_close_file(pri->control);
	return err;
}

static void daemon_user_init(void *data, void *dev)
{
	struct daemon_data *pri = data;
	struct timeval tv;
	struct {
		char zero;
		int pid;
		int usecs;
	} name;

	if(!strcmp(pri->sock_type, "unix"))
		pri->ctl_addr = new_addr(pri->ctl_sock, 
					 strlen(pri->ctl_sock) + 1);
	name.zero = 0;
	name.pid = os_getpid();
	gettimeofday(&tv, NULL);
	name.usecs = tv.tv_usec;
	pri->local_addr = new_addr(&name, sizeof(name));
	pri->dev = dev;
	pri->fd = connect_to_switch(pri);
	if(pri->fd < 0){
		kfree(pri->local_addr);
		pri->local_addr = NULL;
	}
}

static int daemon_open(void *data)
{
	struct daemon_data *pri = data;
	return pri->fd;
}

static void daemon_remove(void *data)
{
	struct daemon_data *pri = data;

	os_close_file(pri->fd);
	pri->fd = -1;
	os_close_file(pri->control);
	pri->control = -1;

	kfree(pri->data_addr);
	pri->data_addr = NULL;
	kfree(pri->ctl_addr);
	pri->ctl_addr = NULL;
	kfree(pri->local_addr);
	pri->local_addr = NULL;
}

int daemon_user_write(int fd, void *buf, int len, struct daemon_data *pri)
{
	struct sockaddr_un *data_addr = pri->data_addr;

	return net_sendto(fd, buf, len, data_addr, sizeof(*data_addr));
}

static int daemon_set_mtu(int mtu, void *data)
{
	return mtu;
}

const struct net_user_info daemon_user_info = {
	.init		= daemon_user_init,
	.open		= daemon_open,
	.close	 	= NULL,
	.remove	 	= daemon_remove,
	.set_mtu	= daemon_set_mtu,
	.add_address	= NULL,
	.delete_address = NULL,
	.max_packet	= MAX_PACKET - ETH_HEADER_OTHER
};
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Copyright (C) 2001 Lennert Buytenhek (buytenh@gnu.org) and
	3	* James Leu (jleu@mindspring.net).
	4	* Copyright (C) 2001 by various other people who didn't put their name here.
	5	* Licensed under the GPL.
	6	*/
	7
	8	#include <errno.h>
	9	#include <unistd.h>
	10	#include <stdint.h>
	11	#include <sys/socket.h>
	12	#include <sys/un.h>
	13	#include <sys/time.h>
	14	#include "net_user.h"
	15	#include "daemon.h"
	16	#include "kern_util.h"
	17	#include "user_util.h"
	18	#include "user.h"
	19	#include "os.h"
c13e5690	20	#include "um_malloc.h"
1da177e4 LT	21
	22	#define MAX_PACKET (ETH_MAX_PACKET + ETH_HEADER_OTHER)
	23
	24	enum request_type { REQ_NEW_CONTROL };
	25
	26	#define SWITCH_MAGIC 0xfeedface
	27
	28	struct request_v3 {
	29	uint32_t magic;
	30	uint32_t version;
	31	enum request_type type;
	32	struct sockaddr_un sock;
	33	};
	34
	35	static struct sockaddr_un new_addr(void name, int len)
	36	{
	37	struct sockaddr_un *sun;
	38
	39	sun = um_kmalloc(sizeof(struct sockaddr_un));
	40	if(sun == NULL){
	41	printk("new_addr: allocation of sockaddr_un failed\n");
56bd194b	42	return NULL;
1da177e4 LT	43	}
	44	sun->sun_family = AF_UNIX;
	45	memcpy(sun->sun_path, name, len);
56bd194b	46	return sun;
1da177e4 LT	47	}
	48
	49	static int connect_to_switch(struct daemon_data *pri)
	50	{
	51	struct sockaddr_un *ctl_addr = pri->ctl_addr;
	52	struct sockaddr_un *local_addr = pri->local_addr;
	53	struct sockaddr_un *sun;
	54	struct request_v3 req;
	55	int fd, n, err;
	56
	57	pri->control = socket(AF_UNIX, SOCK_STREAM, 0);
	58	if(pri->control < 0){
de7b37cd	59	err = -errno;
1da177e4	60	printk("daemon_open : control socket failed, errno = %d\n",
de7b37cd PBG	61	-err);
de7b37cd PBG	62	return err;
1da177e4 LT	63	}
	64
	65	if(connect(pri->control, (struct sockaddr *) ctl_addr,
	66	sizeof(*ctl_addr)) < 0){
1da177e4	67	err = -errno;
de7b37cd PBG	68	printk("daemon_open : control connect failed, errno = %d\n",
de7b37cd PBG	69	-err);
1da177e4 LT	70	goto out;
	71	}
	72
	73	fd = socket(AF_UNIX, SOCK_DGRAM, 0);
	74	if(fd < 0){
1da177e4	75	err = -errno;
de7b37cd PBG	76	printk("daemon_open : data socket failed, errno = %d\n",
de7b37cd PBG	77	-err);
1da177e4 LT	78	goto out;
	79	}
	80	if(bind(fd, (struct sockaddr ) local_addr, sizeof(local_addr)) < 0){
1da177e4	81	err = -errno;
de7b37cd PBG	82	printk("daemon_open : data bind failed, errno = %d\n",
de7b37cd PBG	83	-err);
1da177e4 LT	84	goto out_close;
	85	}
	86
	87	sun = um_kmalloc(sizeof(struct sockaddr_un));
	88	if(sun == NULL){
	89	printk("new_addr: allocation of sockaddr_un failed\n");
	90	err = -ENOMEM;
	91	goto out_close;
	92	}
	93
	94	req.magic = SWITCH_MAGIC;
	95	req.version = SWITCH_VERSION;
	96	req.type = REQ_NEW_CONTROL;
	97	req.sock = *local_addr;
	98	n = os_write_file(pri->control, &req, sizeof(req));
	99	if(n != sizeof(req)){
	100	printk("daemon_open : control setup request failed, err = %d\n",
	101	-n);
	102	err = -ENOTCONN;
ba260e23	103	goto out_free;
1da177e4 LT	104	}
	105
	106	n = os_read_file(pri->control, sun, sizeof(*sun));
	107	if(n != sizeof(*sun)){
	108	printk("daemon_open : read of data socket failed, err = %d\n",
	109	-n);
	110	err = -ENOTCONN;
ba260e23	111	goto out_free;
1da177e4 LT	112	}
	113
	114	pri->data_addr = sun;
56bd194b	115	return fd;
1da177e4	116
ba260e23 PBG	117	out_free:
ba260e23 PBG	118	kfree(sun);
1da177e4 LT	119	out_close:
	120	os_close_file(fd);
	121	out:
	122	os_close_file(pri->control);
56bd194b	123	return err;
1da177e4 LT	124	}
	125
	126	static void daemon_user_init(void data, void dev)
	127	{
	128	struct daemon_data *pri = data;
	129	struct timeval tv;
	130	struct {
	131	char zero;
	132	int pid;
	133	int usecs;
	134	} name;
	135
	136	if(!strcmp(pri->sock_type, "unix"))
	137	pri->ctl_addr = new_addr(pri->ctl_sock,
	138	strlen(pri->ctl_sock) + 1);
	139	name.zero = 0;
	140	name.pid = os_getpid();
	141	gettimeofday(&tv, NULL);
	142	name.usecs = tv.tv_usec;
	143	pri->local_addr = new_addr(&name, sizeof(name));
	144	pri->dev = dev;
	145	pri->fd = connect_to_switch(pri);
	146	if(pri->fd < 0){
	147	kfree(pri->local_addr);
	148	pri->local_addr = NULL;
	149	}
	150	}
	151
	152	static int daemon_open(void *data)
	153	{
	154	struct daemon_data *pri = data;
56bd194b	155	return pri->fd;
1da177e4 LT	156	}
	157
	158	static void daemon_remove(void *data)
	159	{
	160	struct daemon_data *pri = data;
	161
	162	os_close_file(pri->fd);
c42791b6	163	pri->fd = -1;
1da177e4	164	os_close_file(pri->control);
c42791b6 PBG	165	pri->control = -1;
c42791b6 PBG	166
41f2148a	167	kfree(pri->data_addr);
c42791b6	168	pri->data_addr = NULL;
41f2148a	169	kfree(pri->ctl_addr);
c42791b6	170	pri->ctl_addr = NULL;
41f2148a	171	kfree(pri->local_addr);
c42791b6	172	pri->local_addr = NULL;
1da177e4 LT	173	}
	174
	175	int daemon_user_write(int fd, void buf, int len, struct daemon_data pri)
	176	{
	177	struct sockaddr_un *data_addr = pri->data_addr;
	178
56bd194b	179	return net_sendto(fd, buf, len, data_addr, sizeof(*data_addr));
1da177e4 LT	180	}
	181
	182	static int daemon_set_mtu(int mtu, void *data)
	183	{
56bd194b	184	return mtu;
1da177e4 LT	185	}
1da177e4 LT	186
5e7672ec	187	const struct net_user_info daemon_user_info = {
1da177e4 LT	188	.init = daemon_user_init,
	189	.open = daemon_open,
	190	.close = NULL,
	191	.remove = daemon_remove,
	192	.set_mtu = daemon_set_mtu,
	193	.add_address = NULL,
	194	.delete_address = NULL,
	195	.max_packet = MAX_PACKET - ETH_HEADER_OTHER
	196	};