PageRenderTime 26ms CodeModel.GetById 15ms app.highlight 8ms RepoModel.GetById 1ms app.codeStats 0ms

/arch/um/drivers/daemon_user.c

https://bitbucket.org/evzijst/gittest
C | 197 lines | 155 code | 26 blank | 16 comment | 20 complexity | 2d514a3028d0ca133493fe2ed889bdfe MD5 | raw file
  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"
 20
 21#define MAX_PACKET (ETH_MAX_PACKET + ETH_HEADER_OTHER)
 22
 23enum request_type { REQ_NEW_CONTROL };
 24
 25#define SWITCH_MAGIC 0xfeedface
 26
 27struct request_v3 {
 28	uint32_t magic;
 29	uint32_t version;
 30	enum request_type type;
 31	struct sockaddr_un sock;
 32};
 33
 34static struct sockaddr_un *new_addr(void *name, int len)
 35{
 36	struct sockaddr_un *sun;
 37
 38	sun = um_kmalloc(sizeof(struct sockaddr_un));
 39	if(sun == NULL){
 40		printk("new_addr: allocation of sockaddr_un failed\n");
 41		return(NULL);
 42	}
 43	sun->sun_family = AF_UNIX;
 44	memcpy(sun->sun_path, name, len);
 45	return(sun);
 46}
 47
 48static int connect_to_switch(struct daemon_data *pri)
 49{
 50	struct sockaddr_un *ctl_addr = pri->ctl_addr;
 51	struct sockaddr_un *local_addr = pri->local_addr;
 52	struct sockaddr_un *sun;
 53	struct request_v3 req;
 54	int fd, n, err;
 55
 56	pri->control = socket(AF_UNIX, SOCK_STREAM, 0);
 57	if(pri->control < 0){
 58		printk("daemon_open : control socket failed, errno = %d\n", 
 59		       errno);		
 60		return(-errno);
 61	}
 62
 63	if(connect(pri->control, (struct sockaddr *) ctl_addr, 
 64		   sizeof(*ctl_addr)) < 0){
 65		printk("daemon_open : control connect failed, errno = %d\n",
 66		       errno);
 67		err = -errno;
 68		goto out;
 69	}
 70
 71	fd = socket(AF_UNIX, SOCK_DGRAM, 0);
 72	if(fd < 0){
 73		printk("daemon_open : data socket failed, errno = %d\n", 
 74		       errno);
 75		err = -errno;
 76		goto out;
 77	}
 78	if(bind(fd, (struct sockaddr *) local_addr, sizeof(*local_addr)) < 0){
 79		printk("daemon_open : data bind failed, errno = %d\n", 
 80		       errno);
 81		err = -errno;
 82		goto out_close;
 83	}
 84
 85	sun = um_kmalloc(sizeof(struct sockaddr_un));
 86	if(sun == NULL){
 87		printk("new_addr: allocation of sockaddr_un failed\n");
 88		err = -ENOMEM;
 89		goto out_close;
 90	}
 91
 92	req.magic = SWITCH_MAGIC;
 93	req.version = SWITCH_VERSION;
 94	req.type = REQ_NEW_CONTROL;
 95	req.sock = *local_addr;
 96	n = os_write_file(pri->control, &req, sizeof(req));
 97	if(n != sizeof(req)){
 98		printk("daemon_open : control setup request failed, err = %d\n",
 99		       -n);
100		err = -ENOTCONN;
101		goto out;		
102	}
103
104	n = os_read_file(pri->control, sun, sizeof(*sun));
105	if(n != sizeof(*sun)){
106		printk("daemon_open : read of data socket failed, err = %d\n",
107		       -n);
108		err = -ENOTCONN;
109		goto out_close;		
110	}
111
112	pri->data_addr = sun;
113	return(fd);
114
115 out_close:
116	os_close_file(fd);
117 out:
118	os_close_file(pri->control);
119	return(err);
120}
121
122static void daemon_user_init(void *data, void *dev)
123{
124	struct daemon_data *pri = data;
125	struct timeval tv;
126	struct {
127		char zero;
128		int pid;
129		int usecs;
130	} name;
131
132	if(!strcmp(pri->sock_type, "unix"))
133		pri->ctl_addr = new_addr(pri->ctl_sock, 
134					 strlen(pri->ctl_sock) + 1);
135	name.zero = 0;
136	name.pid = os_getpid();
137	gettimeofday(&tv, NULL);
138	name.usecs = tv.tv_usec;
139	pri->local_addr = new_addr(&name, sizeof(name));
140	pri->dev = dev;
141	pri->fd = connect_to_switch(pri);
142	if(pri->fd < 0){
143		kfree(pri->local_addr);
144		pri->local_addr = NULL;
145	}
146}
147
148static int daemon_open(void *data)
149{
150	struct daemon_data *pri = data;
151	return(pri->fd);
152}
153
154static void daemon_remove(void *data)
155{
156	struct daemon_data *pri = data;
157
158	os_close_file(pri->fd);
159	os_close_file(pri->control);
160	if(pri->data_addr != NULL) kfree(pri->data_addr);
161	if(pri->ctl_addr != NULL) kfree(pri->ctl_addr);
162	if(pri->local_addr != NULL) kfree(pri->local_addr);
163}
164
165int daemon_user_write(int fd, void *buf, int len, struct daemon_data *pri)
166{
167	struct sockaddr_un *data_addr = pri->data_addr;
168
169	return(net_sendto(fd, buf, len, data_addr, sizeof(*data_addr)));
170}
171
172static int daemon_set_mtu(int mtu, void *data)
173{
174	return(mtu);
175}
176
177struct net_user_info daemon_user_info = {
178	.init		= daemon_user_init,
179	.open		= daemon_open,
180	.close	 	= NULL,
181	.remove	 	= daemon_remove,
182	.set_mtu	= daemon_set_mtu,
183	.add_address	= NULL,
184	.delete_address = NULL,
185	.max_packet	= MAX_PACKET - ETH_HEADER_OTHER
186};
187
188/*
189 * Overrides for Emacs so that we follow Linus's tabbing style.
190 * Emacs will notice this stuff at the end of the file and automatically
191 * adjust the settings for this buffer only.  This must remain at the end
192 * of the file.
193 * ---------------------------------------------------------------------------
194 * Local variables:
195 * c-file-style: "linux"
196 * End:
197 */