arch/xtensa/platform-iss/console.c

   1 /*
   2  * arch/xtensa/platform-iss/console.c
   3  *
   4  * This file is subject to the terms and conditions of the GNU General Public
   5  * License.  See the file "COPYING" in the main directory of this archive
   6  * for more details.
   7  *
   8  * Copyright (C) 2001-2005 Tensilica Inc.
   9  *   Authors    Christian Zankel, Joe Taylor
  10  */
  11
  12 #include <linux/module.h>
  13 #include <linux/config.h>
  14 #include <linux/kernel.h>
  15 #include <linux/sched.h>
  16 #include <linux/console.h>
  17 #include <linux/init.h>
  18 #include <linux/slab.h>
  19 #include <linux/mm.h>
  20 #include <linux/major.h>
  21 #include <linux/param.h>
  22 #include <linux/serial.h>
  23 #include <linux/serialP.h>
  24 #include <linux/console.h>
  25
  26 #include <asm/uaccess.h>
  27 #include <asm/irq.h>
  28
  29 #include <xtensa/simcall.h>
  30
  31 #include <linux/tty.h>
  32 #include <linux/tty_flip.h>
  33
  34 #ifdef SERIAL_INLINE
  35 #define _INLINE_ inline
  36 #endif
  37
  38 #define SERIAL_MAX_NUM_LINES 1
  39 #define SERIAL_TIMER_VALUE (20 * HZ)
  40
  41 static struct tty_driver *serial_driver;
  42 static struct timer_list serial_timer;
  43
  44 static DEFINE_SPINLOCK(timer_lock);
  45
  46 int errno;
  47
  48 static int __simc (int a, int b, int c, int d, int e, int f)
  49 {
  50         int ret;
  51         __asm__ __volatile__ ("simcall\n"
  52                         "mov %0, a2\n"
  53                         "mov %1, a3\n" : "=a" (ret), "=a" (errno)
  54                         : : "a2", "a3");
  55         return ret;
  56 }
  57
  58 static char *serial_version = "0.1";
  59 static char *serial_name = "ISS serial driver";
  60
  61 /*
  62  * This routine is called whenever a serial port is opened.  It
  63  * enables interrupts for a serial port, linking in its async structure into
  64  * the IRQ chain.   It also performs the serial-specific
  65  * initialization for the tty structure.
  66  */
  67
  68 static void rs_poll(unsigned long);
  69
  70 static int rs_open(struct tty_struct *tty, struct file * filp)
  71 {
  72         int line = tty->index;
  73
  74         if ((line < 0) || (line >= SERIAL_MAX_NUM_LINES))
  75                 return -ENODEV;
  76
  77         spin_lock(&timer_lock);
  78
  79         if (tty->count == 1) {
  80                 init_timer(&serial_timer);
  81                 serial_timer.data = (unsigned long) tty;
  82                 serial_timer.function = rs_poll;
  83                 mod_timer(&serial_timer, jiffies + SERIAL_TIMER_VALUE);
  84         }
  85         spin_unlock(&timer_lock);
  86
  87         return 0;
  88 }
  89
  90
  91 /*
  92  * ------------------------------------------------------------
  93  * iss_serial_close()
  94  *
  95  * This routine is called when the serial port gets closed.  First, we
  96  * wait for the last remaining data to be sent.  Then, we unlink its
  97  * async structure from the interrupt chain if necessary, and we free
  98  * that IRQ if nothing is left in the chain.
  99  * ------------------------------------------------------------
 100  */
 101 static void rs_close(struct tty_struct *tty, struct file * filp)
 102 {
 103         spin_lock(&timer_lock);
 104         if (tty->count == 1)
 105                 del_timer_sync(&serial_timer);
 106         spin_unlock(&timer_lock);
 107 }
 108
 109
 110 static int rs_write(struct tty_struct * tty,
 111                     const unsigned char *buf, int count)
 112 {
 113         /* see drivers/char/serialX.c to reference original version */
 114
 115         __simc (SYS_write, 1, (unsigned long)buf, count, 0, 0);
 116         return count;
 117 }
 118
 119 static void rs_poll(unsigned long priv)
 120 {
 121         struct tty_struct* tty = (struct tty_struct*) priv;
 122
 123         struct timeval tv = { .tv_sec = 0, .tv_usec = 0 };
 124         int i = 0;
 125         unsigned char c;
 126
 127         spin_lock(&timer_lock);
 128
 129         while (__simc(SYS_select_one, 0, XTISS_SELECT_ONE_READ, (int)&tv,0,0)){
 130                 __simc (SYS_read, 0, (unsigned long)&c, 1, 0, 0);
 131                 tty->flip.count++;
 132                 *tty->flip.char_buf_ptr++ = c;
 133                 *tty->flip.flag_buf_ptr++ = TTY_NORMAL;
 134                 i++;
 135         }
 136
 137         if (i)
 138                 tty_flip_buffer_push(tty);
 139
 140
 141         mod_timer(&serial_timer, jiffies + SERIAL_TIMER_VALUE);
 142         spin_unlock(&timer_lock);
 143 }
 144
 145
 146 static void rs_put_char(struct tty_struct *tty, unsigned char ch)
 147 {
 148         char buf[2];
 149
 150         if (!tty)
 151                 return;
 152
 153         buf[0] = ch;
 154         buf[1] = '\0';          /* Is this NULL necessary? */
 155         __simc (SYS_write, 1, (unsigned long) buf, 1, 0, 0);
 156 }
 157
 158 static void rs_flush_chars(struct tty_struct *tty)
 159 {
 160 }
 161
 162 static int rs_write_room(struct tty_struct *tty)
 163 {
 164         /* Let's say iss can always accept 2K characters.. */
 165         return 2 * 1024;
 166 }
 167
 168 static int rs_chars_in_buffer(struct tty_struct *tty)
 169 {
 170         /* the iss doesn't buffer characters */
 171         return 0;
 172 }
 173
 174 static void rs_hangup(struct tty_struct *tty)
 175 {
 176         /* Stub, once again.. */
 177 }
 178
 179 static void rs_wait_until_sent(struct tty_struct *tty, int timeout)
 180 {
 181         /* Stub, once again.. */
 182 }
 183
 184 static int rs_read_proc(char *page, char **start, off_t off, int count,
 185                         int *eof, void *data)
 186 {
 187         int len = 0;
 188         off_t begin = 0;
 189
 190         len += sprintf(page, "serinfo:1.0 driver:%s\n", serial_version);
 191         *eof = 1;
 192
 193         if (off >= len + begin)
 194                 return 0;
 195
 196         *start = page + (off - begin);
 197         return ((count < begin + len - off) ? count : begin + len - off);
 198 }
 199
 200
 201 static struct tty_operations serial_ops = {
 202         .open = rs_open,
 203         .close = rs_close,
 204         .write = rs_write,
 205         .put_char = rs_put_char,
 206         .flush_chars = rs_flush_chars,
 207         .write_room = rs_write_room,
 208         .chars_in_buffer = rs_chars_in_buffer,
 209         .hangup = rs_hangup,
 210         .wait_until_sent = rs_wait_until_sent,
 211         .read_proc = rs_read_proc
 212 };
 213
 214 int __init rs_init(void)
 215 {
 216         serial_driver = alloc_tty_driver(1);
 217
 218         printk ("%s %s\n", serial_name, serial_version);
 219
 220         /* Initialize the tty_driver structure */
 221
 222         serial_driver->owner = THIS_MODULE;
 223         serial_driver->driver_name = "iss_serial";
 224         serial_driver->name = "ttyS";
 225         serial_driver->major = TTY_MAJOR;
 226         serial_driver->minor_start = 64;
 227         serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
 228         serial_driver->subtype = SERIAL_TYPE_NORMAL;
 229         serial_driver->init_termios = tty_std_termios;
 230         serial_driver->init_termios.c_cflag =
 231                 B9600 | CS8 | CREAD | HUPCL | CLOCAL;
 232         serial_driver->flags = TTY_DRIVER_REAL_RAW;
 233
 234         tty_set_operations(serial_driver, &serial_ops);
 235
 236         if (tty_register_driver(serial_driver))
 237                 panic("Couldn't register serial driver\n");
 238         return 0;
 239 }
 240
 241
 242 static __exit void rs_exit(void)
 243 {
 244         int error;
 245
 246         if ((error = tty_unregister_driver(serial_driver)))
 247                 printk("ISS_SERIAL: failed to unregister serial driver (%d)\n",
 248                        error);
 249         put_tty_driver(serial_driver);
 250 }
 251
 252
 253 /* We use `late_initcall' instead of just `__initcall' as a workaround for
 254  * the fact that (1) simcons_tty_init can't be called before tty_init,
 255  * (2) tty_init is called via `module_init', (3) if statically linked,
 256  * module_init == device_init, and (4) there's no ordering of init lists.
 257  * We can do this easily because simcons is always statically linked, but
 258  * other tty drivers that depend on tty_init and which must use
 259  * `module_init' to declare their init routines are likely to be broken.
 260  */
 261
 262 late_initcall(rs_init);
 263
 264
 265 #ifdef CONFIG_SERIAL_CONSOLE
 266
 267 static void iss_console_write(struct console *co, const char *s, unsigned count)
 268 {
 269         int len = strlen(s);
 270
 271         if (s != 0 && *s != 0)
 272                 __simc (SYS_write, 1, (unsigned long)s,
 273                         count < len ? count : len,0,0);
 274 }
 275
 276 static struct tty_driver* iss_console_device(struct console *c, int *index)
 277 {
 278         *index = c->index;
 279         return serial_driver;
 280 }
 281
 282
 283 static struct console sercons = {
 284         .name = "ttyS",
 285         .write = iss_console_write,
 286         .device = iss_console_device,
 287         .flags = CON_PRINTBUFFER,
 288         .index = -1
 289 };
 290
 291 static int __init iss_console_init(void)
 292 {
 293         register_console(&sercons);
 294         return 0;
 295 }
 296
 297 console_initcall(iss_console_init);
 298
 299 #endif /* CONFIG_SERIAL_CONSOLE */
 300