arch/um/drivers/slip_user.c

   1 #include <stdio.h>
   2 #include <stdlib.h>
   3 #include <unistd.h>
   4 #include <stddef.h>
   5 #include <sched.h>
   6 #include <string.h>
   7 #include <sys/fcntl.h>
   8 #include <sys/errno.h>
   9 #include <sys/termios.h>
  10 #include <sys/wait.h>
  11 #include <sys/ioctl.h>
  12 #include <sys/signal.h>
  13 #include "user_util.h"
  14 #include "kern_util.h"
  15 #include "user.h"
  16 #include "net_user.h"
  17 #include "slip.h"
  18 #include "slip_proto.h"
  19 #include "helper.h"
  20 #include "os.h"
  21
  22 void slip_user_init(void *data, void *dev)
  23 {
  24         struct slip_data *pri = data;
  25
  26         pri->dev = dev;
  27 }
  28
  29 static int set_up_tty(int fd)
  30 {
  31         int i;
  32         struct termios tios;
  33
  34         if (tcgetattr(fd, &tios) < 0) {
  35                 printk("could not get initial terminal attributes\n");
  36                 return(-1);
  37         }
  38
  39         tios.c_cflag = CS8 | CREAD | HUPCL | CLOCAL;
  40         tios.c_iflag = IGNBRK | IGNPAR;
  41         tios.c_oflag = 0;
  42         tios.c_lflag = 0;
  43         for (i = 0; i < NCCS; i++)
  44                 tios.c_cc[i] = 0;
  45         tios.c_cc[VMIN] = 1;
  46         tios.c_cc[VTIME] = 0;
  47
  48         cfsetospeed(&tios, B38400);
  49         cfsetispeed(&tios, B38400);
  50
  51         if (tcsetattr(fd, TCSAFLUSH, &tios) < 0) {
  52                 printk("failed to set terminal attributes\n");
  53                 return(-1);
  54         }
  55         return(0);
  56 }
  57
  58 struct slip_pre_exec_data {
  59         int stdin;
  60         int stdout;
  61         int close_me;
  62 };
  63
  64 static void slip_pre_exec(void *arg)
  65 {
  66         struct slip_pre_exec_data *data = arg;
  67
  68         if(data->stdin != -1) dup2(data->stdin, 0);
  69         dup2(data->stdout, 1);
  70         if(data->close_me != -1) close(data->close_me);
  71 }
  72
  73 static int slip_tramp(char **argv, int fd)
  74 {
  75         struct slip_pre_exec_data pe_data;
  76         char *output;
  77         int status, pid, fds[2], err, output_len;
  78
  79         err = os_pipe(fds, 1, 0);
  80         if(err){
  81                 printk("slip_tramp : pipe failed, errno = %d\n", -err);
  82                 return(err);
  83         }
  84
  85         err = 0;
  86         pe_data.stdin = fd;
  87         pe_data.stdout = fds[1];
  88         pe_data.close_me = fds[0];
  89         pid = run_helper(slip_pre_exec, &pe_data, argv, NULL);
  90
  91         if(pid < 0) err = pid;
  92         else {
  93                 output_len = page_size();
  94                 output = um_kmalloc(output_len);
  95                 if(output == NULL)
  96                         printk("slip_tramp : failed to allocate output "
  97                                "buffer\n");
  98
  99                 close(fds[1]);
 100                 read_output(fds[0], output, output_len);
 101                 if(output != NULL){
 102                         printk("%s", output);
 103                         kfree(output);
 104                 }
 105                 if(waitpid(pid, &status, 0) < 0) err = errno;
 106                 else if(!WIFEXITED(status) || (WEXITSTATUS(status) != 0)){
 107                         printk("'%s' didn't exit with status 0\n", argv[0]);
 108                         err = EINVAL;
 109                 }
 110         }
 111         return(err);
 112 }
 113
 114 static int slip_open(void *data)
 115 {
 116         struct slip_data *pri = data;
 117         char version_buf[sizeof("nnnnn\0")];
 118         char gate_buf[sizeof("nnn.nnn.nnn.nnn\0")];
 119         char *argv[] = { "uml_net", version_buf, "slip", "up", gate_buf,
 120                          NULL };
 121         int sfd, mfd, disc, sencap, err;
 122
 123         if((mfd = get_pty()) < 0){
 124                 printk("umn : Failed to open pty\n");
 125                 return(-1);
 126         }
 127         if((sfd = os_open_file(ptsname(mfd), of_rdwr(OPENFLAGS()), 0)) < 0){
 128                 printk("Couldn't open tty for slip line\n");
 129                 return(-1);
 130         }
 131         if(set_up_tty(sfd)) return(-1);
 132         pri->slave = sfd;
 133         pri->pos = 0;
 134         pri->esc = 0;
 135         if(pri->gate_addr != NULL){
 136                 sprintf(version_buf, "%d", UML_NET_VERSION);
 137                 strcpy(gate_buf, pri->gate_addr);
 138
 139                 err = slip_tramp(argv, sfd);
 140
 141                 if(err != 0){
 142                         printk("slip_tramp failed - errno = %d\n", err);
 143                         return(-err);
 144                 }
 145                 if(ioctl(pri->slave, SIOCGIFNAME, pri->name) < 0){
 146                         printk("SIOCGIFNAME failed, errno = %d\n", errno);
 147                         return(-errno);
 148                 }
 149                 iter_addresses(pri->dev, open_addr, pri->name);
 150         }
 151         else {
 152                 disc = N_SLIP;
 153                 if(ioctl(sfd, TIOCSETD, &disc) < 0){
 154                         printk("Failed to set slip line discipline - "
 155                                "errno = %d\n", errno);
 156                         return(-errno);
 157                 }
 158                 sencap = 0;
 159                 if(ioctl(sfd, SIOCSIFENCAP, &sencap) < 0){
 160                         printk("Failed to set slip encapsulation - "
 161                                "errno = %d\n", errno);
 162                         return(-errno);
 163                 }
 164         }
 165         return(mfd);
 166 }
 167
 168 static void slip_close(int fd, void *data)
 169 {
 170         struct slip_data *pri = data;
 171         char version_buf[sizeof("nnnnn\0")];
 172         char *argv[] = { "uml_net", version_buf, "slip", "down", pri->name,
 173                          NULL };
 174         int err;
 175
 176         if(pri->gate_addr != NULL)
 177                 iter_addresses(pri->dev, close_addr, pri->name);
 178
 179         sprintf(version_buf, "%d", UML_NET_VERSION);
 180
 181         err = slip_tramp(argv, -1);
 182
 183         if(err != 0)
 184                 printk("slip_tramp failed - errno = %d\n", err);
 185         close(fd);
 186         close(pri->slave);
 187         pri->slave = -1;
 188 }
 189
 190 int slip_user_read(int fd, void *buf, int len, struct slip_data *pri)
 191 {
 192         int i, n, size, start;
 193
 194         if(pri->more>0) {
 195                 i = 0;
 196                 while(i < pri->more) {
 197                         size = slip_unesc(pri->ibuf[i++],
 198                                         pri->ibuf, &pri->pos, &pri->esc);
 199                         if(size){
 200                                 memcpy(buf, pri->ibuf, size);
 201                                 memmove(pri->ibuf, &pri->ibuf[i], pri->more-i);
 202                                 pri->more=pri->more-i;
 203                                 return(size);
 204                         }
 205                 }
 206                 pri->more=0;
 207         }
 208
 209         n = net_read(fd, &pri->ibuf[pri->pos], sizeof(pri->ibuf) - pri->pos);
 210         if(n <= 0) return(n);
 211
 212         start = pri->pos;
 213         for(i = 0; i < n; i++){
 214                 size = slip_unesc(pri->ibuf[start + i],
 215                                 pri->ibuf, &pri->pos, &pri->esc);
 216                 if(size){
 217                         memcpy(buf, pri->ibuf, size);
 218                         memmove(pri->ibuf, &pri->ibuf[start+i+1], n-(i+1));
 219                         pri->more=n-(i+1);
 220                         return(size);
 221                 }
 222         }
 223         return(0);
 224 }
 225
 226 int slip_user_write(int fd, void *buf, int len, struct slip_data *pri)
 227 {
 228         int actual, n;
 229
 230         actual = slip_esc(buf, pri->obuf, len);
 231         n = net_write(fd, pri->obuf, actual);
 232         if(n < 0) return(n);
 233         else return(len);
 234 }
 235
 236 static int slip_set_mtu(int mtu, void *data)
 237 {
 238         return(mtu);
 239 }
 240
 241 static void slip_add_addr(unsigned char *addr, unsigned char *netmask,
 242                           void *data)
 243 {
 244         struct slip_data *pri = data;
 245
 246         if(pri->slave == -1) return;
 247         open_addr(addr, netmask, pri->name);
 248 }
 249
 250 static void slip_del_addr(unsigned char *addr, unsigned char *netmask,
 251                             void *data)
 252 {
 253         struct slip_data *pri = data;
 254
 255         if(pri->slave == -1) return;
 256         close_addr(addr, netmask, pri->name);
 257 }
 258
 259 struct net_user_info slip_user_info = {
 260         .init           = slip_user_init,
 261         .open           = slip_open,
 262         .close          = slip_close,
 263         .remove         = NULL,
 264         .set_mtu        = slip_set_mtu,
 265         .add_address    = slip_add_addr,
 266         .delete_address = slip_del_addr,
 267         .max_packet     = BUF_SIZE
 268 };
 269
 270 /*
 271  * Overrides for Emacs so that we follow Linus's tabbing style.
 272  * Emacs will notice this stuff at the end of the file and automatically
 273  * adjust the settings for this buffer only.  This must remain at the end
 274  * of the file.
 275  * ---------------------------------------------------------------------------
 276  * Local variables:
 277  * c-file-style: "linux"
 278  * End:
 279  */