1dbddf429SAlex Dewar // SPDX-License-Identifier: GPL-2.0
2cd1ae0e4SJeff Dike /*
3cd1ae0e4SJeff Dike * Copyright (C) 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
4cd1ae0e4SJeff Dike */
5cd1ae0e4SJeff Dike
61da177e4SLinus Torvalds #include <stdio.h>
71da177e4SLinus Torvalds #include <stdlib.h>
81da177e4SLinus Torvalds #include <unistd.h>
91da177e4SLinus Torvalds #include <errno.h>
10cd1ae0e4SJeff Dike #include <fcntl.h>
11cd1ae0e4SJeff Dike #include <string.h>
125e1121cdSIgnat Korchagin #include <termios.h>
131da177e4SLinus Torvalds #include <sys/wait.h>
1437185b33SAl Viro #include <net_user.h>
1537185b33SAl Viro #include <os.h>
16cd1ae0e4SJeff Dike #include "slip.h"
1737185b33SAl Viro #include <um_malloc.h>
181da177e4SLinus Torvalds
slip_user_init(void * data,void * dev)19f34d9d2dSJeff Dike static int slip_user_init(void *data, void *dev)
201da177e4SLinus Torvalds {
211da177e4SLinus Torvalds struct slip_data *pri = data;
221da177e4SLinus Torvalds
231da177e4SLinus Torvalds pri->dev = dev;
24f34d9d2dSJeff Dike return 0;
251da177e4SLinus Torvalds }
261da177e4SLinus Torvalds
set_up_tty(int fd)271da177e4SLinus Torvalds static int set_up_tty(int fd)
281da177e4SLinus Torvalds {
291da177e4SLinus Torvalds int i;
301da177e4SLinus Torvalds struct termios tios;
311da177e4SLinus Torvalds
321da177e4SLinus Torvalds if (tcgetattr(fd, &tios) < 0) {
33cd1ae0e4SJeff Dike printk(UM_KERN_ERR "could not get initial terminal "
34cd1ae0e4SJeff Dike "attributes\n");
35cd1ae0e4SJeff Dike return -1;
361da177e4SLinus Torvalds }
371da177e4SLinus Torvalds
381da177e4SLinus Torvalds tios.c_cflag = CS8 | CREAD | HUPCL | CLOCAL;
391da177e4SLinus Torvalds tios.c_iflag = IGNBRK | IGNPAR;
401da177e4SLinus Torvalds tios.c_oflag = 0;
411da177e4SLinus Torvalds tios.c_lflag = 0;
421da177e4SLinus Torvalds for (i = 0; i < NCCS; i++)
431da177e4SLinus Torvalds tios.c_cc[i] = 0;
441da177e4SLinus Torvalds tios.c_cc[VMIN] = 1;
451da177e4SLinus Torvalds tios.c_cc[VTIME] = 0;
461da177e4SLinus Torvalds
471da177e4SLinus Torvalds cfsetospeed(&tios, B38400);
481da177e4SLinus Torvalds cfsetispeed(&tios, B38400);
491da177e4SLinus Torvalds
501da177e4SLinus Torvalds if (tcsetattr(fd, TCSAFLUSH, &tios) < 0) {
51cd1ae0e4SJeff Dike printk(UM_KERN_ERR "failed to set terminal attributes\n");
52cd1ae0e4SJeff Dike return -1;
531da177e4SLinus Torvalds }
54cd1ae0e4SJeff Dike return 0;
551da177e4SLinus Torvalds }
561da177e4SLinus Torvalds
571da177e4SLinus Torvalds struct slip_pre_exec_data {
58f9bb3b59SHans-Werner Hilse int stdin_fd;
59f9bb3b59SHans-Werner Hilse int stdout_fd;
601da177e4SLinus Torvalds int close_me;
611da177e4SLinus Torvalds };
621da177e4SLinus Torvalds
slip_pre_exec(void * arg)631da177e4SLinus Torvalds static void slip_pre_exec(void *arg)
641da177e4SLinus Torvalds {
651da177e4SLinus Torvalds struct slip_pre_exec_data *data = arg;
661da177e4SLinus Torvalds
67f9bb3b59SHans-Werner Hilse if (data->stdin_fd >= 0)
68f9bb3b59SHans-Werner Hilse dup2(data->stdin_fd, 0);
69f9bb3b59SHans-Werner Hilse dup2(data->stdout_fd, 1);
70cd1ae0e4SJeff Dike if (data->close_me >= 0)
71cd1ae0e4SJeff Dike close(data->close_me);
721da177e4SLinus Torvalds }
731da177e4SLinus Torvalds
slip_tramp(char ** argv,int fd)741da177e4SLinus Torvalds static int slip_tramp(char **argv, int fd)
751da177e4SLinus Torvalds {
761da177e4SLinus Torvalds struct slip_pre_exec_data pe_data;
771da177e4SLinus Torvalds char *output;
784dbed85aSStanislaw Gruszka int pid, fds[2], err, output_len;
791da177e4SLinus Torvalds
801da177e4SLinus Torvalds err = os_pipe(fds, 1, 0);
811da177e4SLinus Torvalds if (err < 0) {
82cd1ae0e4SJeff Dike printk(UM_KERN_ERR "slip_tramp : pipe failed, err = %d\n",
83cd1ae0e4SJeff Dike -err);
84a3c77c67SJeff Dike goto out;
851da177e4SLinus Torvalds }
861da177e4SLinus Torvalds
871da177e4SLinus Torvalds err = 0;
88f9bb3b59SHans-Werner Hilse pe_data.stdin_fd = fd;
89f9bb3b59SHans-Werner Hilse pe_data.stdout_fd = fds[1];
901da177e4SLinus Torvalds pe_data.close_me = fds[0];
91c4399016SJeff Dike err = run_helper(slip_pre_exec, &pe_data, argv);
92a3c77c67SJeff Dike if (err < 0)
93a3c77c67SJeff Dike goto out_close;
94a3c77c67SJeff Dike pid = err;
951da177e4SLinus Torvalds
961ffb9164SJeff Dike output_len = UM_KERN_PAGE_SIZE;
9743f5b308SJeff Dike output = uml_kmalloc(output_len, UM_GFP_KERNEL);
98a3c77c67SJeff Dike if (output == NULL) {
99cd1ae0e4SJeff Dike printk(UM_KERN_ERR "slip_tramp : failed to allocate output "
100cd1ae0e4SJeff Dike "buffer\n");
101a3c77c67SJeff Dike os_kill_process(pid, 1);
102a3c77c67SJeff Dike err = -ENOMEM;
1039a8beb93SVitaliy Ivanov goto out_close;
104a3c77c67SJeff Dike }
1051da177e4SLinus Torvalds
106cd1ae0e4SJeff Dike close(fds[1]);
1071da177e4SLinus Torvalds read_output(fds[0], output, output_len);
1081da177e4SLinus Torvalds printk("%s", output);
109a3c77c67SJeff Dike
1101aa351a3SJeff Dike err = helper_wait(pid);
111cd1ae0e4SJeff Dike close(fds[0]);
1121da177e4SLinus Torvalds
113a3c77c67SJeff Dike kfree(output);
114a3c77c67SJeff Dike return err;
115a3c77c67SJeff Dike
116a3c77c67SJeff Dike out_close:
117cd1ae0e4SJeff Dike close(fds[0]);
118cd1ae0e4SJeff Dike close(fds[1]);
119a3c77c67SJeff Dike out:
120a3c77c67SJeff Dike return err;
1211da177e4SLinus Torvalds }
1221da177e4SLinus Torvalds
slip_open(void * data)1231da177e4SLinus Torvalds static int slip_open(void *data)
1241da177e4SLinus Torvalds {
1251da177e4SLinus Torvalds struct slip_data *pri = data;
1261da177e4SLinus Torvalds char version_buf[sizeof("nnnnn\0")];
1271da177e4SLinus Torvalds char gate_buf[sizeof("nnn.nnn.nnn.nnn\0")];
1281da177e4SLinus Torvalds char *argv[] = { "uml_net", version_buf, "slip", "up", gate_buf,
1291da177e4SLinus Torvalds NULL };
1301da177e4SLinus Torvalds int sfd, mfd, err;
1311da177e4SLinus Torvalds
132a3c77c67SJeff Dike err = get_pty();
133a3c77c67SJeff Dike if (err < 0) {
134cd1ae0e4SJeff Dike printk(UM_KERN_ERR "slip-open : Failed to open pty, err = %d\n",
135cd1ae0e4SJeff Dike -err);
136a3c77c67SJeff Dike goto out;
1371da177e4SLinus Torvalds }
138a3c77c67SJeff Dike mfd = err;
139a3c77c67SJeff Dike
140cd1ae0e4SJeff Dike err = open(ptsname(mfd), O_RDWR, 0);
141a3c77c67SJeff Dike if (err < 0) {
142cd1ae0e4SJeff Dike printk(UM_KERN_ERR "Couldn't open tty for slip line, "
143cd1ae0e4SJeff Dike "err = %d\n", -err);
144a3c77c67SJeff Dike goto out_close;
1451da177e4SLinus Torvalds }
146a3c77c67SJeff Dike sfd = err;
147a3c77c67SJeff Dike
148*b77e81fbSZhen Lei err = set_up_tty(sfd);
149*b77e81fbSZhen Lei if (err)
150a3c77c67SJeff Dike goto out_close2;
151a3c77c67SJeff Dike
1521da177e4SLinus Torvalds pri->slave = sfd;
153a3c77c67SJeff Dike pri->slip.pos = 0;
154a3c77c67SJeff Dike pri->slip.esc = 0;
1551da177e4SLinus Torvalds if (pri->gate_addr != NULL) {
1561da177e4SLinus Torvalds sprintf(version_buf, "%d", UML_NET_VERSION);
1571da177e4SLinus Torvalds strcpy(gate_buf, pri->gate_addr);
1581da177e4SLinus Torvalds
1591da177e4SLinus Torvalds err = slip_tramp(argv, sfd);
1601da177e4SLinus Torvalds
1611da177e4SLinus Torvalds if (err < 0) {
162cd1ae0e4SJeff Dike printk(UM_KERN_ERR "slip_tramp failed - err = %d\n",
163cd1ae0e4SJeff Dike -err);
164a3c77c67SJeff Dike goto out_close2;
1651da177e4SLinus Torvalds }
1661da177e4SLinus Torvalds err = os_get_ifname(pri->slave, pri->name);
1671da177e4SLinus Torvalds if (err < 0) {
168cd1ae0e4SJeff Dike printk(UM_KERN_ERR "get_ifname failed, err = %d\n",
169cd1ae0e4SJeff Dike -err);
170a3c77c67SJeff Dike goto out_close2;
1711da177e4SLinus Torvalds }
1721da177e4SLinus Torvalds iter_addresses(pri->dev, open_addr, pri->name);
1731da177e4SLinus Torvalds }
1741da177e4SLinus Torvalds else {
1751da177e4SLinus Torvalds err = os_set_slip(sfd);
1761da177e4SLinus Torvalds if (err < 0) {
177cd1ae0e4SJeff Dike printk(UM_KERN_ERR "Failed to set slip discipline "
178cd1ae0e4SJeff Dike "encapsulation - err = %d\n", -err);
179a3c77c67SJeff Dike goto out_close2;
1801da177e4SLinus Torvalds }
1811da177e4SLinus Torvalds }
182cd1ae0e4SJeff Dike return mfd;
183a3c77c67SJeff Dike out_close2:
184cd1ae0e4SJeff Dike close(sfd);
185a3c77c67SJeff Dike out_close:
186cd1ae0e4SJeff Dike close(mfd);
187a3c77c67SJeff Dike out:
188a3c77c67SJeff Dike return err;
1891da177e4SLinus Torvalds }
1901da177e4SLinus Torvalds
slip_close(int fd,void * data)1911da177e4SLinus Torvalds static void slip_close(int fd, void *data)
1921da177e4SLinus Torvalds {
1931da177e4SLinus Torvalds struct slip_data *pri = data;
1941da177e4SLinus Torvalds char version_buf[sizeof("nnnnn\0")];
1951da177e4SLinus Torvalds char *argv[] = { "uml_net", version_buf, "slip", "down", pri->name,
1961da177e4SLinus Torvalds NULL };
1971da177e4SLinus Torvalds int err;
1981da177e4SLinus Torvalds
1991da177e4SLinus Torvalds if (pri->gate_addr != NULL)
2001da177e4SLinus Torvalds iter_addresses(pri->dev, close_addr, pri->name);
2011da177e4SLinus Torvalds
2021da177e4SLinus Torvalds sprintf(version_buf, "%d", UML_NET_VERSION);
2031da177e4SLinus Torvalds
2041da177e4SLinus Torvalds err = slip_tramp(argv, pri->slave);
2051da177e4SLinus Torvalds
2061da177e4SLinus Torvalds if (err != 0)
207cd1ae0e4SJeff Dike printk(UM_KERN_ERR "slip_tramp failed - errno = %d\n", -err);
208cd1ae0e4SJeff Dike close(fd);
209cd1ae0e4SJeff Dike close(pri->slave);
2101da177e4SLinus Torvalds pri->slave = -1;
2111da177e4SLinus Torvalds }
2121da177e4SLinus Torvalds
slip_user_read(int fd,void * buf,int len,struct slip_data * pri)2131da177e4SLinus Torvalds int slip_user_read(int fd, void *buf, int len, struct slip_data *pri)
2141da177e4SLinus Torvalds {
215a3c77c67SJeff Dike return slip_proto_read(fd, buf, len, &pri->slip);
2161da177e4SLinus Torvalds }
2171da177e4SLinus Torvalds
slip_user_write(int fd,void * buf,int len,struct slip_data * pri)2181da177e4SLinus Torvalds int slip_user_write(int fd, void *buf, int len, struct slip_data *pri)
2191da177e4SLinus Torvalds {
220a3c77c67SJeff Dike return slip_proto_write(fd, buf, len, &pri->slip);
2211da177e4SLinus Torvalds }
2221da177e4SLinus Torvalds
slip_add_addr(unsigned char * addr,unsigned char * netmask,void * data)2231da177e4SLinus Torvalds static void slip_add_addr(unsigned char *addr, unsigned char *netmask,
2241da177e4SLinus Torvalds void *data)
2251da177e4SLinus Torvalds {
2261da177e4SLinus Torvalds struct slip_data *pri = data;
2271da177e4SLinus Torvalds
228cd1ae0e4SJeff Dike if (pri->slave < 0)
229cd1ae0e4SJeff Dike return;
2301da177e4SLinus Torvalds open_addr(addr, netmask, pri->name);
2311da177e4SLinus Torvalds }
2321da177e4SLinus Torvalds
slip_del_addr(unsigned char * addr,unsigned char * netmask,void * data)2331da177e4SLinus Torvalds static void slip_del_addr(unsigned char *addr, unsigned char *netmask,
2341da177e4SLinus Torvalds void *data)
2351da177e4SLinus Torvalds {
2361da177e4SLinus Torvalds struct slip_data *pri = data;
2371da177e4SLinus Torvalds
238cd1ae0e4SJeff Dike if (pri->slave < 0)
239cd1ae0e4SJeff Dike return;
2401da177e4SLinus Torvalds close_addr(addr, netmask, pri->name);
2411da177e4SLinus Torvalds }
2421da177e4SLinus Torvalds
2435e7672ecSJeff Dike const struct net_user_info slip_user_info = {
2441da177e4SLinus Torvalds .init = slip_user_init,
2451da177e4SLinus Torvalds .open = slip_open,
2461da177e4SLinus Torvalds .close = slip_close,
2471da177e4SLinus Torvalds .remove = NULL,
2481da177e4SLinus Torvalds .add_address = slip_add_addr,
2491da177e4SLinus Torvalds .delete_address = slip_del_addr,
250b53f35a8SJeff Dike .mtu = BUF_SIZE,
251b53f35a8SJeff Dike .max_packet = BUF_SIZE,
2521da177e4SLinus Torvalds };
253