git.oblomov.eu Git - linux-2.6/blob - arch/um/drivers/port_user.c

   1 /*
   2  * Copyright (C) 2001 Jeff Dike (jdike@karaya.com)
   3  * Licensed under the GPL
   4  */
   5
   6 #include <stdio.h>
   7 #include <stddef.h>
   8 #include <stdlib.h>
   9 #include <string.h>
  10 #include <errno.h>
  11 #include <unistd.h>
  12 #include <termios.h>
  13 #include <sys/socket.h>
  14 #include <sys/un.h>
  15 #include <netinet/in.h>
  16 #include "user_util.h"
  17 #include "kern_util.h"
  18 #include "user.h"
  19 #include "chan_user.h"
  20 #include "port.h"
  21 #include "helper.h"
  22 #include "os.h"
  23
  24 struct port_chan {
  25         int raw;
  26         struct termios tt;
  27         void *kernel_data;
  28         char dev[sizeof("32768\0")];
  29 };
  30
  31 static void *port_init(char *str, int device, struct chan_opts *opts)
  32 {
  33         struct port_chan *data;
  34         void *kern_data;
  35         char *end;
  36         int port;
  37
  38         if(*str != ':'){
  39                 printk("port_init : channel type 'port' must specify a "
  40                        "port number\n");
  41                 return(NULL);
  42         }
  43         str++;
  44         port = strtoul(str, &end, 0);
  45         if((*end != '\0') || (end == str)){
  46                 printk("port_init : couldn't parse port '%s'\n", str);
  47                 return(NULL);
  48         }
  49
  50         kern_data = port_data(port);
  51         if(kern_data == NULL)
  52                 return(NULL);
  53
  54         data = um_kmalloc(sizeof(*data));
  55         if(data == NULL)
  56                 goto err;
  57
  58         *data = ((struct port_chan) { .raw              = opts->raw,
  59                                       .kernel_data      = kern_data });
  60         sprintf(data->dev, "%d", port);
  61
  62         return(data);
  63  err:
  64         port_kern_free(kern_data);
  65         return(NULL);
  66 }
  67
  68 static void port_free(void *d)
  69 {
  70         struct port_chan *data = d;
  71
  72         port_kern_free(data->kernel_data);
  73         kfree(data);
  74 }
  75
  76 static int port_open(int input, int output, int primary, void *d,
  77                      char **dev_out)
  78 {
  79         struct port_chan *data = d;
  80         int fd, err;
  81
  82         fd = port_wait(data->kernel_data);
  83         if((fd >= 0) && data->raw){
  84                 CATCH_EINTR(err = tcgetattr(fd, &data->tt));
  85                 if(err)
  86                         return(err);
  87
  88                 err = raw(fd);
  89                 if(err)
  90                         return(err);
  91         }
  92         *dev_out = data->dev;
  93         return(fd);
  94 }
  95
  96 static void port_close(int fd, void *d)
  97 {
  98         struct port_chan *data = d;
  99
 100         port_remove_dev(data->kernel_data);
 101         os_close_file(fd);
 102 }
 103
 104 static int port_console_write(int fd, const char *buf, int n, void *d)
 105 {
 106         struct port_chan *data = d;
 107
 108         return(generic_console_write(fd, buf, n, &data->tt));
 109 }
 110
 111 struct chan_ops port_ops = {
 112         .type           = "port",
 113         .init           = port_init,
 114         .open           = port_open,
 115         .close          = port_close,
 116         .read           = generic_read,
 117         .write          = generic_write,
 118         .console_write  = port_console_write,
 119         .window_size    = generic_window_size,
 120         .free           = port_free,
 121         .winch          = 1,
 122 };
 123
 124 int port_listen_fd(int port)
 125 {
 126         struct sockaddr_in addr;
 127         int fd, err, arg;
 128
 129         fd = socket(PF_INET, SOCK_STREAM, 0);
 130         if(fd == -1)
 131                 return(-errno);
 132
 133         arg = 1;
 134         if(setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &arg, sizeof(arg)) < 0){
 135                 err = -errno;
 136                 goto out;
 137         }
 138
 139         addr.sin_family = AF_INET;
 140         addr.sin_port = htons(port);
 141         addr.sin_addr.s_addr = htonl(INADDR_ANY);
 142         if(bind(fd, (struct sockaddr *) &addr, sizeof(addr)) < 0){
 143                 err = -errno;
 144                 goto out;
 145         }
 146
 147         if(listen(fd, 1) < 0){
 148                 err = -errno;
 149                 goto out;
 150         }
 151
 152         err = os_set_fd_block(fd, 0);
 153         if(err < 0)
 154                 goto out;
 155
 156         return(fd);
 157  out:
 158         os_close_file(fd);
 159         return(err);
 160 }
 161
 162 struct port_pre_exec_data {
 163         int sock_fd;
 164         int pipe_fd;
 165 };
 166
 167 void port_pre_exec(void *arg)
 168 {
 169         struct port_pre_exec_data *data = arg;
 170
 171         dup2(data->sock_fd, 0);
 172         dup2(data->sock_fd, 1);
 173         dup2(data->sock_fd, 2);
 174         os_close_file(data->sock_fd);
 175         dup2(data->pipe_fd, 3);
 176         os_shutdown_socket(3, 1, 0);
 177         os_close_file(data->pipe_fd);
 178 }
 179
 180 int port_connection(int fd, int *socket, int *pid_out)
 181 {
 182         int new, err;
 183         char *argv[] = { "/usr/sbin/in.telnetd", "-L",
 184                          "/usr/lib/uml/port-helper", NULL };
 185         struct port_pre_exec_data data;
 186
 187         new = os_accept_connection(fd);
 188         if(new < 0)
 189                 return(new);
 190
 191         err = os_pipe(socket, 0, 0);
 192         if(err < 0)
 193                 goto out_close;
 194
 195         data = ((struct port_pre_exec_data)
 196                 { .sock_fd              = new,
 197                   .pipe_fd              = socket[1] });
 198
 199         err = run_helper(port_pre_exec, &data, argv, NULL);
 200         if(err < 0)
 201                 goto out_shutdown;
 202
 203         *pid_out = err;
 204         return(new);
 205
 206  out_shutdown:
 207         os_shutdown_socket(socket[0], 1, 1);
 208         os_close_file(socket[0]);
 209         os_shutdown_socket(socket[1], 1, 1);
 210         os_close_file(socket[1]);
 211  out_close:
 212         os_close_file(new);
 213         return(err);
 214 }
 215
 216 /*
 217  * Overrides for Emacs so that we follow Linus's tabbing style.
 218  * Emacs will notice this stuff at the end of the file and automatically
 219  * adjust the settings for this buffer only.  This must remain at the end
 220  * of the file.
 221  * ---------------------------------------------------------------------------
 222  * Local variables:
 223  * c-file-style: "linux"
 224  * End:
 225  */