1
2
3
4
5
6
7
8
9
10
11
12#include <linux/module.h>
13#include <linux/kernel.h>
14#include <linux/sched.h>
15#include <linux/console.h>
16#include <linux/init.h>
17#include <linux/mm.h>
18#include <linux/major.h>
19#include <linux/param.h>
20#include <linux/seq_file.h>
21#include <linux/serial.h>
22
23#include <linux/uaccess.h>
24#include <asm/irq.h>
25
26#include <platform/simcall.h>
27
28#include <linux/tty.h>
29#include <linux/tty_flip.h>
30
31#define SERIAL_MAX_NUM_LINES 1
32#define SERIAL_TIMER_VALUE (HZ / 10)
33
34static void rs_poll(struct timer_list *);
35
36static struct tty_driver *serial_driver;
37static struct tty_port serial_port;
38static DEFINE_TIMER(serial_timer, rs_poll);
39static DEFINE_SPINLOCK(timer_lock);
40
41static int rs_open(struct tty_struct *tty, struct file * filp)
42{
43 spin_lock_bh(&timer_lock);
44 if (tty->count == 1)
45 mod_timer(&serial_timer, jiffies + SERIAL_TIMER_VALUE);
46 spin_unlock_bh(&timer_lock);
47
48 return 0;
49}
50
51static void rs_close(struct tty_struct *tty, struct file * filp)
52{
53 spin_lock_bh(&timer_lock);
54 if (tty->count == 1)
55 del_timer_sync(&serial_timer);
56 spin_unlock_bh(&timer_lock);
57}
58
59
60static int rs_write(struct tty_struct * tty,
61 const unsigned char *buf, int count)
62{
63
64
65 simc_write(1, buf, count);
66 return count;
67}
68
69static void rs_poll(struct timer_list *unused)
70{
71 struct tty_port *port = &serial_port;
72 int i = 0;
73 int rd = 1;
74 unsigned char c;
75
76 spin_lock(&timer_lock);
77
78 while (simc_poll(0)) {
79 rd = simc_read(0, &c, 1);
80 if (rd <= 0)
81 break;
82 tty_insert_flip_char(port, c, TTY_NORMAL);
83 i++;
84 }
85
86 if (i)
87 tty_flip_buffer_push(port);
88 if (rd)
89 mod_timer(&serial_timer, jiffies + SERIAL_TIMER_VALUE);
90 spin_unlock(&timer_lock);
91}
92
93
94static int rs_put_char(struct tty_struct *tty, unsigned char ch)
95{
96 return rs_write(tty, &ch, 1);
97}
98
99static void rs_flush_chars(struct tty_struct *tty)
100{
101}
102
103static unsigned int rs_write_room(struct tty_struct *tty)
104{
105
106 return 2 * 1024;
107}
108
109static void rs_hangup(struct tty_struct *tty)
110{
111
112}
113
114static void rs_wait_until_sent(struct tty_struct *tty, int timeout)
115{
116
117}
118
119static int rs_proc_show(struct seq_file *m, void *v)
120{
121 seq_printf(m, "serinfo:1.0 driver:0.1\n");
122 return 0;
123}
124
125static const struct tty_operations serial_ops = {
126 .open = rs_open,
127 .close = rs_close,
128 .write = rs_write,
129 .put_char = rs_put_char,
130 .flush_chars = rs_flush_chars,
131 .write_room = rs_write_room,
132 .hangup = rs_hangup,
133 .wait_until_sent = rs_wait_until_sent,
134 .proc_show = rs_proc_show,
135};
136
137static int __init rs_init(void)
138{
139 struct tty_driver *driver;
140 int ret;
141
142 driver = tty_alloc_driver(SERIAL_MAX_NUM_LINES, TTY_DRIVER_REAL_RAW);
143 if (IS_ERR(driver))
144 return PTR_ERR(driver);
145
146 tty_port_init(&serial_port);
147
148
149
150 driver->driver_name = "iss_serial";
151 driver->name = "ttyS";
152 driver->major = TTY_MAJOR;
153 driver->minor_start = 64;
154 driver->type = TTY_DRIVER_TYPE_SERIAL;
155 driver->subtype = SERIAL_TYPE_NORMAL;
156 driver->init_termios = tty_std_termios;
157 driver->init_termios.c_cflag =
158 B9600 | CS8 | CREAD | HUPCL | CLOCAL;
159
160 tty_set_operations(driver, &serial_ops);
161 tty_port_link_device(&serial_port, driver, 0);
162
163 ret = tty_register_driver(driver);
164 if (ret) {
165 pr_err("Couldn't register serial driver\n");
166 tty_driver_kref_put(driver);
167 tty_port_destroy(&serial_port);
168
169 return ret;
170 }
171
172 serial_driver = driver;
173
174 return 0;
175}
176
177
178static __exit void rs_exit(void)
179{
180 tty_unregister_driver(serial_driver);
181 tty_driver_kref_put(serial_driver);
182 tty_port_destroy(&serial_port);
183}
184
185
186
187
188
189
190
191
192
193
194
195late_initcall(rs_init);
196
197
198#ifdef CONFIG_SERIAL_CONSOLE
199
200static void iss_console_write(struct console *co, const char *s, unsigned count)
201{
202 if (s && *s != 0) {
203 int len = strlen(s);
204 simc_write(1, s, count < len ? count : len);
205 }
206}
207
208static struct tty_driver* iss_console_device(struct console *c, int *index)
209{
210 *index = c->index;
211 return serial_driver;
212}
213
214
215static struct console sercons = {
216 .name = "ttyS",
217 .write = iss_console_write,
218 .device = iss_console_device,
219 .flags = CON_PRINTBUFFER,
220 .index = -1
221};
222
223static int __init iss_console_init(void)
224{
225 register_console(&sercons);
226 return 0;
227}
228
229console_initcall(iss_console_init);
230
231#endif
232
233