Blame view

kernel/linux-imx6_3.14.28/arch/um/drivers/tty.c 1.46 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
  /*
   * Copyright (C) 2001 - 2007 Jeff Dike (jdike@{linux.intel,addtoit}.com)
   * Licensed under the GPL
   */
  
  #include <errno.h>
  #include <fcntl.h>
  #include <termios.h>
  #include "chan_user.h"
  #include <os.h>
  #include <um_malloc.h>
  
  struct tty_chan {
  	char *dev;
  	int raw;
  	struct termios tt;
  };
  
  static void *tty_chan_init(char *str, int device, const struct chan_opts *opts)
  {
  	struct tty_chan *data;
  
  	if (*str != ':') {
  		printk(UM_KERN_ERR "tty_init : channel type 'tty' must specify "
  		       "a device
  ");
  		return NULL;
  	}
  	str++;
  
  	data = uml_kmalloc(sizeof(*data), UM_GFP_KERNEL);
  	if (data == NULL)
  		return NULL;
  	*data = ((struct tty_chan) { .dev 	= str,
  				     .raw 	= opts->raw });
  
  	return data;
  }
  
  static int tty_open(int input, int output, int primary, void *d,
  		    char **dev_out)
  {
  	struct tty_chan *data = d;
  	int fd, err, mode = 0;
  
  	if (input && output)
  		mode = O_RDWR;
  	else if (input)
  		mode = O_RDONLY;
  	else if (output)
  		mode = O_WRONLY;
  
  	fd = open(data->dev, mode);
  	if (fd < 0)
  		return -errno;
  
  	if (data->raw) {
  		CATCH_EINTR(err = tcgetattr(fd, &data->tt));
  		if (err)
  			return err;
  
  		err = raw(fd);
  		if (err)
  			return err;
  	}
  
  	*dev_out = data->dev;
  	return fd;
  }
  
  const struct chan_ops tty_ops = {
  	.type		= "tty",
  	.init		= tty_chan_init,
  	.open		= tty_open,
  	.close		= generic_close,
  	.read		= generic_read,
  	.write		= generic_write,
  	.console_write	= generic_console_write,
  	.window_size	= generic_window_size,
  	.free		= generic_free,
  	.winch		= 0,
  };