arch/um/drivers/port_user.c

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