2 * Copyright (C) 2000, 2001, 2002 Jeff Dike (jdike@karaya.com)
3 * Licensed under the GPL
6 #include <linux/stddef.h>
7 #include <linux/kernel.h>
8 #include <linux/list.h>
9 #include <linux/slab.h>
10 #include <linux/tty.h>
11 #include <linux/string.h>
12 #include <linux/tty_flip.h>
14 #include "chan_kern.h"
15 #include "user_util.h"
22 /* XXX: could well be moved to somewhere else, if needed. */
23 static int my_printf(const char * fmt
, ...)
24 __attribute__ ((format (printf
, 1, 2)));
26 static int my_printf(const char * fmt
, ...)
28 /* Yes, can be called on atomic context.*/
29 char *buf
= kmalloc(4096, GFP_ATOMIC
);
34 /* We print directly fmt.
35 * Yes, yes, yes, feel free to complain. */
39 r
= vsprintf(buf
, fmt
, args
);
45 r
= os_write_file(1, fmt
, r
);
50 #ifdef CONFIG_NOCONFIG_CHAN
51 /* Despite its name, there's no added trailing newline. */
52 static int my_puts(const char * buf
)
54 return os_write_file(1, buf
, strlen(buf
));
57 static void *not_configged_init(char *str
, int device
, struct chan_opts
*opts
)
59 my_puts("Using a channel type which is configured out of "
64 static int not_configged_open(int input
, int output
, int primary
, void *data
,
67 my_puts("Using a channel type which is configured out of "
72 static void not_configged_close(int fd
, void *data
)
74 my_puts("Using a channel type which is configured out of "
78 static int not_configged_read(int fd
, char *c_out
, void *data
)
80 my_puts("Using a channel type which is configured out of "
85 static int not_configged_write(int fd
, const char *buf
, int len
, void *data
)
87 my_puts("Using a channel type which is configured out of "
92 static int not_configged_console_write(int fd
, const char *buf
, int len
)
94 my_puts("Using a channel type which is configured out of "
99 static int not_configged_window_size(int fd
, void *data
, unsigned short *rows
,
100 unsigned short *cols
)
102 my_puts("Using a channel type which is configured out of "
107 static void not_configged_free(void *data
)
109 my_puts("Using a channel type which is configured out of "
113 static struct chan_ops not_configged_ops
= {
114 .init
= not_configged_init
,
115 .open
= not_configged_open
,
116 .close
= not_configged_close
,
117 .read
= not_configged_read
,
118 .write
= not_configged_write
,
119 .console_write
= not_configged_console_write
,
120 .window_size
= not_configged_window_size
,
121 .free
= not_configged_free
,
124 #endif /* CONFIG_NOCONFIG_CHAN */
126 void generic_close(int fd
, void *unused
)
131 int generic_read(int fd
, char *c_out
, void *unused
)
135 n
= os_read_file(fd
, c_out
, sizeof(*c_out
));
144 /* XXX Trivial wrapper around os_write_file */
146 int generic_write(int fd
, const char *buf
, int n
, void *unused
)
148 return os_write_file(fd
, buf
, n
);
151 int generic_window_size(int fd
, void *unused
, unsigned short *rows_out
,
152 unsigned short *cols_out
)
157 ret
= os_window_size(fd
, &rows
, &cols
);
161 ret
= ((*rows_out
!= rows
) || (*cols_out
!= cols
));
169 void generic_free(void *data
)
174 static void tty_receive_char(struct tty_struct
*tty
, char ch
)
176 if(tty
== NULL
) return;
178 if(I_IXON(tty
) && !I_IXOFF(tty
) && !tty
->raw
) {
179 if(ch
== STOP_CHAR(tty
)){
183 else if(ch
== START_CHAR(tty
)){
189 if((tty
->flip
.flag_buf_ptr
== NULL
) ||
190 (tty
->flip
.char_buf_ptr
== NULL
))
192 tty_insert_flip_char(tty
, ch
, TTY_NORMAL
);
195 static int open_one_chan(struct chan
*chan
)
202 if(chan
->ops
->open
== NULL
)
204 else fd
= (*chan
->ops
->open
)(chan
->input
, chan
->output
, chan
->primary
,
205 chan
->data
, &chan
->dev
);
214 int open_chan(struct list_head
*chans
)
216 struct list_head
*ele
;
220 list_for_each(ele
, chans
){
221 chan
= list_entry(ele
, struct chan
, list
);
222 ret
= open_one_chan(chan
);
229 void chan_enable_winch(struct list_head
*chans
, struct tty_struct
*tty
)
231 struct list_head
*ele
;
234 list_for_each(ele
, chans
){
235 chan
= list_entry(ele
, struct chan
, list
);
236 if(chan
->primary
&& chan
->output
&& chan
->ops
->winch
){
237 register_winch(chan
->fd
, tty
);
243 void enable_chan(struct line
*line
)
245 struct list_head
*ele
;
248 list_for_each(ele
, &line
->chan_list
){
249 chan
= list_entry(ele
, struct chan
, list
);
250 if(open_one_chan(chan
))
255 line_setup_irq(chan
->fd
, chan
->input
, chan
->output
, line
,
261 static LIST_HEAD(irqs_to_free
);
267 while(!list_empty(&irqs_to_free
)){
268 chan
= list_entry(irqs_to_free
.next
, struct chan
, free_list
);
269 list_del(&chan
->free_list
);
272 free_irq(chan
->line
->driver
->read_irq
, chan
);
274 free_irq(chan
->line
->driver
->write_irq
, chan
);
279 static void close_one_chan(struct chan
*chan
, int delay_free_irq
)
285 list_add(&chan
->free_list
, &irqs_to_free
);
289 free_irq(chan
->line
->driver
->read_irq
, chan
);
291 free_irq(chan
->line
->driver
->write_irq
, chan
);
294 if(chan
->ops
->close
!= NULL
)
295 (*chan
->ops
->close
)(chan
->fd
, chan
->data
);
301 void close_chan(struct list_head
*chans
, int delay_free_irq
)
305 /* Close in reverse order as open in case more than one of them
306 * refers to the same device and they save and restore that device's
307 * state. Then, the first one opened will have the original state,
308 * so it must be the last closed.
310 list_for_each_entry_reverse(chan
, chans
, list
) {
311 close_one_chan(chan
, delay_free_irq
);
315 int write_chan(struct list_head
*chans
, const char *buf
, int len
,
318 struct list_head
*ele
;
319 struct chan
*chan
= NULL
;
322 list_for_each(ele
, chans
) {
323 chan
= list_entry(ele
, struct chan
, list
);
324 if (!chan
->output
|| (chan
->ops
->write
== NULL
))
326 n
= chan
->ops
->write(chan
->fd
, buf
, len
, chan
->data
);
329 if ((ret
== -EAGAIN
) || ((ret
>= 0) && (ret
< len
)))
330 reactivate_fd(chan
->fd
, write_irq
);
336 int console_write_chan(struct list_head
*chans
, const char *buf
, int len
)
338 struct list_head
*ele
;
342 list_for_each(ele
, chans
){
343 chan
= list_entry(ele
, struct chan
, list
);
344 if(!chan
->output
|| (chan
->ops
->console_write
== NULL
))
346 n
= chan
->ops
->console_write(chan
->fd
, buf
, len
);
347 if(chan
->primary
) ret
= n
;
352 int console_open_chan(struct line
*line
, struct console
*co
,
353 struct chan_opts
*opts
)
357 err
= open_chan(&line
->chan_list
);
361 printk("Console initialized on /dev/%s%d\n",co
->name
,co
->index
);
365 int chan_window_size(struct list_head
*chans
, unsigned short *rows_out
,
366 unsigned short *cols_out
)
368 struct list_head
*ele
;
371 list_for_each(ele
, chans
){
372 chan
= list_entry(ele
, struct chan
, list
);
374 if(chan
->ops
->window_size
== NULL
)
376 return chan
->ops
->window_size(chan
->fd
, chan
->data
,
383 void free_one_chan(struct chan
*chan
, int delay_free_irq
)
385 list_del(&chan
->list
);
387 close_one_chan(chan
, delay_free_irq
);
389 if(chan
->ops
->free
!= NULL
)
390 (*chan
->ops
->free
)(chan
->data
);
392 if(chan
->primary
&& chan
->output
) ignore_sigio_fd(chan
->fd
);
396 void free_chan(struct list_head
*chans
, int delay_free_irq
)
398 struct list_head
*ele
, *next
;
401 list_for_each_safe(ele
, next
, chans
){
402 chan
= list_entry(ele
, struct chan
, list
);
403 free_one_chan(chan
, delay_free_irq
);
407 static int one_chan_config_string(struct chan
*chan
, char *str
, int size
,
413 CONFIG_CHUNK(str
, size
, n
, "none", 1);
417 CONFIG_CHUNK(str
, size
, n
, chan
->ops
->type
, 0);
419 if(chan
->dev
== NULL
){
420 CONFIG_CHUNK(str
, size
, n
, "", 1);
424 CONFIG_CHUNK(str
, size
, n
, ":", 0);
425 CONFIG_CHUNK(str
, size
, n
, chan
->dev
, 0);
430 static int chan_pair_config_string(struct chan
*in
, struct chan
*out
,
431 char *str
, int size
, char **error_out
)
435 n
= one_chan_config_string(in
, str
, size
, error_out
);
440 CONFIG_CHUNK(str
, size
, n
, "", 1);
444 CONFIG_CHUNK(str
, size
, n
, ",", 1);
445 n
= one_chan_config_string(out
, str
, size
, error_out
);
448 CONFIG_CHUNK(str
, size
, n
, "", 1);
453 int chan_config_string(struct list_head
*chans
, char *str
, int size
,
456 struct list_head
*ele
;
457 struct chan
*chan
, *in
= NULL
, *out
= NULL
;
459 list_for_each(ele
, chans
){
460 chan
= list_entry(ele
, struct chan
, list
);
469 return chan_pair_config_string(in
, out
, str
, size
, error_out
);
474 struct chan_ops
*ops
;
477 struct chan_type chan_table
[] = {
480 #ifdef CONFIG_NULL_CHAN
481 { "null", &null_ops
},
483 { "null", ¬_configged_ops
},
486 #ifdef CONFIG_PORT_CHAN
487 { "port", &port_ops
},
489 { "port", ¬_configged_ops
},
492 #ifdef CONFIG_PTY_CHAN
496 { "pty", ¬_configged_ops
},
497 { "pts", ¬_configged_ops
},
500 #ifdef CONFIG_TTY_CHAN
503 { "tty", ¬_configged_ops
},
506 #ifdef CONFIG_XTERM_CHAN
507 { "xterm", &xterm_ops
},
509 { "xterm", ¬_configged_ops
},
513 static struct chan
*parse_chan(struct line
*line
, char *str
, int device
,
514 struct chan_opts
*opts
)
516 struct chan_type
*entry
;
517 struct chan_ops
*ops
;
524 for(i
= 0; i
< sizeof(chan_table
)/sizeof(chan_table
[0]); i
++){
525 entry
= &chan_table
[i
];
526 if(!strncmp(str
, entry
->key
, strlen(entry
->key
))){
528 str
+= strlen(entry
->key
);
533 my_printf("parse_chan couldn't parse \"%s\"\n",
537 if(ops
->init
== NULL
)
539 data
= (*ops
->init
)(str
, device
, opts
);
543 chan
= kmalloc(sizeof(*chan
), GFP_ATOMIC
);
546 *chan
= ((struct chan
) { .list
= LIST_HEAD_INIT(chan
->list
),
548 LIST_HEAD_INIT(chan
->free_list
),
561 int parse_chan_pair(char *str
, struct line
*line
, int device
,
562 struct chan_opts
*opts
)
564 struct list_head
*chans
= &line
->chan_list
;
565 struct chan
*new, *chan
;
568 if(!list_empty(chans
)){
569 chan
= list_entry(chans
->next
, struct chan
, list
);
571 INIT_LIST_HEAD(chans
);
574 out
= strchr(str
, ',');
579 new = parse_chan(line
, in
, device
, opts
);
584 list_add(&new->list
, chans
);
586 new = parse_chan(line
, out
, device
, opts
);
590 list_add(&new->list
, chans
);
594 new = parse_chan(line
, str
, device
, opts
);
598 list_add(&new->list
, chans
);
605 int chan_out_fd(struct list_head
*chans
)
607 struct list_head
*ele
;
610 list_for_each(ele
, chans
){
611 chan
= list_entry(ele
, struct chan
, list
);
612 if(chan
->primary
&& chan
->output
)
618 void chan_interrupt(struct list_head
*chans
, struct work_struct
*task
,
619 struct tty_struct
*tty
, int irq
)
621 struct list_head
*ele
, *next
;
626 list_for_each_safe(ele
, next
, chans
){
627 chan
= list_entry(ele
, struct chan
, list
);
628 if(!chan
->input
|| (chan
->ops
->read
== NULL
)) continue;
631 (tty
->flip
.count
>= TTY_FLIPBUF_SIZE
)){
632 schedule_delayed_work(task
, 1);
635 err
= chan
->ops
->read(chan
->fd
, &c
, chan
->data
);
637 tty_receive_char(tty
, c
);
640 if(err
== 0) reactivate_fd(chan
->fd
, irq
);
645 close_chan(chans
, 1);
648 else close_one_chan(chan
, 1);
652 if(tty
) tty_flip_buffer_push(tty
);