blob: b9086e35688cf194d7848589c2fe4b50745f9eba [file] [log] [blame]
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001/* arch/arm/mach-msm/smd_tty.c
2 *
3 * Copyright (C) 2007 Google, Inc.
4 * Copyright (c) 2009-2011, Code Aurora Forum. All rights reserved.
5 * Author: Brian Swetland <swetland@google.com>
6 *
7 * This software is licensed under the terms of the GNU General Public
8 * License version 2, as published by the Free Software Foundation, and
9 * may be copied, distributed, and modified under those terms.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 */
17
18#include <linux/module.h>
19#include <linux/fs.h>
20#include <linux/cdev.h>
21#include <linux/device.h>
22#include <linux/interrupt.h>
23#include <linux/delay.h>
24#include <linux/wakelock.h>
25#include <linux/platform_device.h>
26#include <linux/sched.h>
27
28#include <linux/tty.h>
29#include <linux/tty_driver.h>
30#include <linux/tty_flip.h>
31
32#include <mach/msm_smd.h>
33#include <mach/peripheral-loader.h>
Jeff Hugo4c0ba6c2011-07-15 11:47:13 -060034#include <mach/socinfo.h>
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070035
36#include "smd_private.h"
37
38#define MAX_SMD_TTYS 37
39#define MAX_TTY_BUF_SIZE 2048
40
41static DEFINE_MUTEX(smd_tty_lock);
42
43static uint smd_tty_modem_wait;
44module_param_named(modem_wait, smd_tty_modem_wait,
45 uint, S_IRUGO | S_IWUSR | S_IWGRP);
46
47struct smd_tty_info {
48 smd_channel_t *ch;
49 struct tty_struct *tty;
50 struct wake_lock wake_lock;
51 int open_count;
52 struct tasklet_struct tty_tsklt;
53 struct timer_list buf_req_timer;
54 struct completion ch_allocated;
55 struct platform_driver driver;
56 void *pil;
57 int in_reset;
58 int in_reset_updated;
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -060059 int is_open;
60 wait_queue_head_t ch_opened_wait_queue;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070061 spinlock_t reset_lock;
62};
63
64#define LOOPBACK_IDX 36
65static char *smd_ch_name[] = {
66 [0] = "DS",
67 [1] = "APPS_FM",
68 [2] = "APPS_RIVA_BT_ACL",
69 [3] = "APPS_RIVA_BT_CMD",
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +053070 [4] = "MBALBRIDGE",
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070071 [7] = "DATA1",
72 [21] = "DATA21",
73 [27] = "GPSNMEA",
74 [36] = "LOOPBACK",
75};
76
77static uint32_t smd_ch_edge[] = {
78 [0] = SMD_APPS_MODEM,
79 [1] = SMD_APPS_WCNSS,
80 [2] = SMD_APPS_WCNSS,
81 [3] = SMD_APPS_WCNSS,
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +053082 [4] = SMD_APPS_MODEM,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070083 [7] = SMD_APPS_MODEM,
84 [21] = SMD_APPS_MODEM,
85 [27] = SMD_APPS_MODEM,
86 [36] = SMD_APPS_MODEM,
87};
88
89
90static struct delayed_work loopback_work;
91static struct smd_tty_info smd_tty[MAX_SMD_TTYS];
92
93static int is_in_reset(struct smd_tty_info *info)
94{
95 return info->in_reset;
96}
97
98static void buf_req_retry(unsigned long param)
99{
100 struct smd_tty_info *info = (struct smd_tty_info *)param;
Karthikeyan Ramasubramanianf8ad4132011-11-22 09:11:18 -0700101 unsigned long flags;
102
103 spin_lock_irqsave(&info->reset_lock, flags);
104 if (info->is_open) {
105 spin_unlock_irqrestore(&info->reset_lock, flags);
106 tasklet_hi_schedule(&info->tty_tsklt);
107 return;
108 }
109 spin_unlock_irqrestore(&info->reset_lock, flags);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700110}
111
112static void smd_tty_read(unsigned long param)
113{
114 unsigned char *ptr;
115 int avail;
116 struct smd_tty_info *info = (struct smd_tty_info *)param;
117 struct tty_struct *tty = info->tty;
118
119 if (!tty)
120 return;
121
122 for (;;) {
123 if (is_in_reset(info)) {
124 /* signal TTY clients using TTY_BREAK */
125 tty_insert_flip_char(tty, 0x00, TTY_BREAK);
126 tty_flip_buffer_push(tty);
127 break;
128 }
129
130 if (test_bit(TTY_THROTTLED, &tty->flags)) break;
131 avail = smd_read_avail(info->ch);
132 if (avail == 0)
133 break;
134
135 if (avail > MAX_TTY_BUF_SIZE)
136 avail = MAX_TTY_BUF_SIZE;
137
138 avail = tty_prepare_flip_string(tty, &ptr, avail);
139 if (avail <= 0) {
140 if (!timer_pending(&info->buf_req_timer)) {
141 init_timer(&info->buf_req_timer);
142 info->buf_req_timer.expires = jiffies +
143 ((30 * HZ)/1000);
144 info->buf_req_timer.function = buf_req_retry;
145 info->buf_req_timer.data = param;
146 add_timer(&info->buf_req_timer);
147 }
148 return;
149 }
150
151 if (smd_read(info->ch, ptr, avail) != avail) {
152 /* shouldn't be possible since we're in interrupt
153 ** context here and nobody else could 'steal' our
154 ** characters.
155 */
156 printk(KERN_ERR "OOPS - smd_tty_buffer mismatch?!");
157 }
158
159 wake_lock_timeout(&info->wake_lock, HZ / 2);
160 tty_flip_buffer_push(tty);
161 }
162
163 /* XXX only when writable and necessary */
164 tty_wakeup(tty);
165}
166
167static void smd_tty_notify(void *priv, unsigned event)
168{
169 struct smd_tty_info *info = priv;
170 unsigned long flags;
171
172 switch (event) {
173 case SMD_EVENT_DATA:
Karthikeyan Ramasubramanianf8ad4132011-11-22 09:11:18 -0700174 spin_lock_irqsave(&info->reset_lock, flags);
175 if (!info->is_open) {
176 spin_unlock_irqrestore(&info->reset_lock, flags);
177 break;
178 }
179 spin_unlock_irqrestore(&info->reset_lock, flags);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700180 /* There may be clients (tty framework) that are blocked
181 * waiting for space to write data, so if a possible read
182 * interrupt came in wake anyone waiting and disable the
183 * interrupts
184 */
185 if (smd_write_avail(info->ch)) {
186 smd_disable_read_intr(info->ch);
187 if (info->tty)
188 wake_up_interruptible(&info->tty->write_wait);
189 }
190 tasklet_hi_schedule(&info->tty_tsklt);
191 break;
192
193 case SMD_EVENT_OPEN:
194 spin_lock_irqsave(&info->reset_lock, flags);
195 info->in_reset = 0;
196 info->in_reset_updated = 1;
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600197 info->is_open = 1;
198 wake_up_interruptible(&info->ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700199 spin_unlock_irqrestore(&info->reset_lock, flags);
200 break;
201
202 case SMD_EVENT_CLOSE:
203 spin_lock_irqsave(&info->reset_lock, flags);
204 info->in_reset = 1;
205 info->in_reset_updated = 1;
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600206 info->is_open = 0;
207 wake_up_interruptible(&info->ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700208 spin_unlock_irqrestore(&info->reset_lock, flags);
209 /* schedule task to send TTY_BREAK */
210 tasklet_hi_schedule(&info->tty_tsklt);
211
212 if (info->tty->index == LOOPBACK_IDX)
213 schedule_delayed_work(&loopback_work,
214 msecs_to_jiffies(1000));
215 break;
216 }
217}
218
219static uint32_t is_modem_smsm_inited(void)
220{
221 uint32_t modem_state;
222 uint32_t ready_state = (SMSM_INIT | SMSM_SMDINIT);
223
224 modem_state = smsm_get_state(SMSM_MODEM_STATE);
225 return (modem_state & ready_state) == ready_state;
226}
227
228static int smd_tty_open(struct tty_struct *tty, struct file *f)
229{
230 int res = 0;
231 int n = tty->index;
232 struct smd_tty_info *info;
233 char *peripheral = NULL;
234
235
236 if (!smd_ch_name[n])
237 return -ENODEV;
238
239 info = smd_tty + n;
240
241 mutex_lock(&smd_tty_lock);
242 tty->driver_data = info;
243
244 if (info->open_count++ == 0) {
245 if (smd_ch_edge[n] == SMD_APPS_MODEM)
246 peripheral = "modem";
247
248 if (peripheral) {
249 info->pil = pil_get("modem");
250 if (IS_ERR(info->pil)) {
251 res = PTR_ERR(info->pil);
252 goto out;
253 }
254
255 /* Wait for the modem SMSM to be inited for the SMD
256 * Loopback channel to be allocated at the modem. Since
257 * the wait need to be done atmost once, using msleep
258 * doesn't degrade the performance.
259 */
260 if (n == 36) {
261 if (!is_modem_smsm_inited())
262 msleep(5000);
263 smsm_change_state(SMSM_APPS_STATE,
264 0, SMSM_SMD_LOOPBACK);
265 msleep(100);
266 }
267
268
269 /*
270 * Wait for a channel to be allocated so we know
271 * the modem is ready enough.
272 */
273 if (smd_tty_modem_wait) {
274 res = wait_for_completion_interruptible_timeout(
275 &info->ch_allocated,
276 msecs_to_jiffies(smd_tty_modem_wait *
277 1000));
278
279 if (res == 0) {
280 pr_err("Timed out waiting for SMD"
281 " channel\n");
282 res = -ETIMEDOUT;
283 goto release_pil;
284 } else if (res < 0) {
285 pr_err("Error waiting for SMD channel:"
286 " %d\n",
287 res);
288 goto release_pil;
289 }
290
291 res = 0;
292 }
293 }
294
295
296 info->tty = tty;
297 tasklet_init(&info->tty_tsklt, smd_tty_read,
298 (unsigned long)info);
299 wake_lock_init(&info->wake_lock, WAKE_LOCK_SUSPEND,
300 smd_ch_name[n]);
301 if (!info->ch) {
302 res = smd_named_open_on_edge(smd_ch_name[n],
303 smd_ch_edge[n],
304 &info->ch, info,
305 smd_tty_notify);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600306 if (res < 0) {
307 pr_err("%s: %s open failed %d\n", __func__,
308 smd_ch_name[n], res);
309 goto release_pil;
310 }
311
312 res = wait_event_interruptible_timeout(
313 info->ch_opened_wait_queue,
314 info->is_open, (2 * HZ));
315 if (res == 0)
316 res = -ETIMEDOUT;
317 if (res < 0) {
318 pr_err("%s: wait for %s smd_open failed %d\n",
319 __func__, smd_ch_name[n], res);
320 goto release_pil;
321 }
322 res = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700323 }
324 }
325
326release_pil:
327 if (res < 0)
328 pil_put(info->pil);
329 else
330 smd_disable_read_intr(info->ch);
331out:
332 mutex_unlock(&smd_tty_lock);
333
334 return res;
335}
336
337static void smd_tty_close(struct tty_struct *tty, struct file *f)
338{
339 struct smd_tty_info *info = tty->driver_data;
Karthikeyan Ramasubramaniand563de52011-11-22 08:38:17 -0700340 unsigned long flags;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700341
342 if (info == 0)
343 return;
344
345 mutex_lock(&smd_tty_lock);
346 if (--info->open_count == 0) {
Karthikeyan Ramasubramaniand563de52011-11-22 08:38:17 -0700347 spin_lock_irqsave(&info->reset_lock, flags);
348 info->is_open = 0;
349 spin_unlock_irqrestore(&info->reset_lock, flags);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700350 if (info->tty) {
351 tasklet_kill(&info->tty_tsklt);
352 wake_lock_destroy(&info->wake_lock);
353 info->tty = 0;
354 }
355 tty->driver_data = 0;
356 del_timer(&info->buf_req_timer);
357 if (info->ch) {
358 smd_close(info->ch);
359 info->ch = 0;
360 pil_put(info->pil);
361 }
362 }
363 mutex_unlock(&smd_tty_lock);
364}
365
366static int smd_tty_write(struct tty_struct *tty, const unsigned char *buf, int len)
367{
368 struct smd_tty_info *info = tty->driver_data;
369 int avail;
370
371 /* if we're writing to a packet channel we will
372 ** never be able to write more data than there
373 ** is currently space for
374 */
375 if (is_in_reset(info))
376 return -ENETRESET;
377
378 avail = smd_write_avail(info->ch);
379 /* if no space, we'll have to setup a notification later to wake up the
380 * tty framework when space becomes avaliable
381 */
382 if (!avail) {
383 smd_enable_read_intr(info->ch);
384 return 0;
385 }
386 if (len > avail)
387 len = avail;
388
389 return smd_write(info->ch, buf, len);
390}
391
392static int smd_tty_write_room(struct tty_struct *tty)
393{
394 struct smd_tty_info *info = tty->driver_data;
395 return smd_write_avail(info->ch);
396}
397
398static int smd_tty_chars_in_buffer(struct tty_struct *tty)
399{
400 struct smd_tty_info *info = tty->driver_data;
401 return smd_read_avail(info->ch);
402}
403
404static void smd_tty_unthrottle(struct tty_struct *tty)
405{
406 struct smd_tty_info *info = tty->driver_data;
Karthikeyan Ramasubramanianf8ad4132011-11-22 09:11:18 -0700407 unsigned long flags;
408
409 spin_lock_irqsave(&info->reset_lock, flags);
410 if (info->is_open) {
411 spin_unlock_irqrestore(&info->reset_lock, flags);
412 tasklet_hi_schedule(&info->tty_tsklt);
413 return;
414 }
415 spin_unlock_irqrestore(&info->reset_lock, flags);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700416}
417
418/*
419 * Returns the current TIOCM status bits including:
420 * SMD Signals (DTR/DSR, CTS/RTS, CD, RI)
421 * TIOCM_OUT1 - reset state (1=in reset)
422 * TIOCM_OUT2 - reset state updated (1=updated)
423 */
424static int smd_tty_tiocmget(struct tty_struct *tty)
425{
426 struct smd_tty_info *info = tty->driver_data;
427 unsigned long flags;
428 int tiocm;
429
430 tiocm = smd_tiocmget(info->ch);
431
432 spin_lock_irqsave(&info->reset_lock, flags);
433 tiocm |= (info->in_reset ? TIOCM_OUT1 : 0);
434 if (info->in_reset_updated) {
435 tiocm |= TIOCM_OUT2;
436 info->in_reset_updated = 0;
437 }
438 spin_unlock_irqrestore(&info->reset_lock, flags);
439
440 return tiocm;
441}
442
443static int smd_tty_tiocmset(struct tty_struct *tty,
444 unsigned int set, unsigned int clear)
445{
446 struct smd_tty_info *info = tty->driver_data;
447
448 if (info->in_reset)
449 return -ENETRESET;
450
451 return smd_tiocmset(info->ch, set, clear);
452}
453
454static void loopback_probe_worker(struct work_struct *work)
455{
456 /* wait for modem to restart before requesting loopback server */
457 if (!is_modem_smsm_inited())
458 schedule_delayed_work(&loopback_work, msecs_to_jiffies(1000));
459 else
460 smsm_change_state(SMSM_APPS_STATE,
461 0, SMSM_SMD_LOOPBACK);
462}
463
464static struct tty_operations smd_tty_ops = {
465 .open = smd_tty_open,
466 .close = smd_tty_close,
467 .write = smd_tty_write,
468 .write_room = smd_tty_write_room,
469 .chars_in_buffer = smd_tty_chars_in_buffer,
470 .unthrottle = smd_tty_unthrottle,
471 .tiocmget = smd_tty_tiocmget,
472 .tiocmset = smd_tty_tiocmset,
473};
474
475static int smd_tty_dummy_probe(struct platform_device *pdev)
476{
477 if (!strncmp(pdev->name, smd_ch_name[0],
478 strnlen(smd_ch_name[0], SMD_MAX_CH_NAME_LEN)))
479 complete_all(&smd_tty[0].ch_allocated);
480 else if (!strncmp(pdev->name, smd_ch_name[1],
481 strnlen(smd_ch_name[1], SMD_MAX_CH_NAME_LEN)))
482 complete_all(&smd_tty[1].ch_allocated);
483 else if (!strncmp(pdev->name, smd_ch_name[2],
484 strnlen(smd_ch_name[2], SMD_MAX_CH_NAME_LEN)))
485 complete_all(&smd_tty[2].ch_allocated);
486 else if (!strncmp(pdev->name, smd_ch_name[3],
487 strnlen(smd_ch_name[3], SMD_MAX_CH_NAME_LEN)))
488 complete_all(&smd_tty[3].ch_allocated);
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +0530489 else if (!strncmp(pdev->name, smd_ch_name[4],
490 strnlen(smd_ch_name[4], SMD_MAX_CH_NAME_LEN)))
491 complete_all(&smd_tty[4].ch_allocated);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700492 else if (!strncmp(pdev->name, smd_ch_name[7],
493 strnlen(smd_ch_name[7], SMD_MAX_CH_NAME_LEN)))
494 complete_all(&smd_tty[7].ch_allocated);
495 else if (!strncmp(pdev->name, smd_ch_name[21],
496 strnlen(smd_ch_name[21], SMD_MAX_CH_NAME_LEN)))
497 complete_all(&smd_tty[21].ch_allocated);
498 else if (!strncmp(pdev->name, smd_ch_name[27],
499 strnlen(smd_ch_name[27], SMD_MAX_CH_NAME_LEN)))
500 complete_all(&smd_tty[27].ch_allocated);
501 else if (!strncmp(pdev->name, "LOOPBACK_TTY",
502 strnlen("LOOPBACK_TTY", SMD_MAX_CH_NAME_LEN)))
503 complete_all(&smd_tty[36].ch_allocated);
504
505 return 0;
506}
507
508static struct tty_driver *smd_tty_driver;
509
510static int __init smd_tty_init(void)
511{
512 int ret;
Jeff Hugo4c0ba6c2011-07-15 11:47:13 -0600513 int ds_registered = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700514
515 smd_tty_driver = alloc_tty_driver(MAX_SMD_TTYS);
516 if (smd_tty_driver == 0)
517 return -ENOMEM;
518
519 smd_tty_driver->owner = THIS_MODULE;
520 smd_tty_driver->driver_name = "smd_tty_driver";
521 smd_tty_driver->name = "smd";
522 smd_tty_driver->major = 0;
523 smd_tty_driver->minor_start = 0;
524 smd_tty_driver->type = TTY_DRIVER_TYPE_SERIAL;
525 smd_tty_driver->subtype = SERIAL_TYPE_NORMAL;
526 smd_tty_driver->init_termios = tty_std_termios;
527 smd_tty_driver->init_termios.c_iflag = 0;
528 smd_tty_driver->init_termios.c_oflag = 0;
529 smd_tty_driver->init_termios.c_cflag = B38400 | CS8 | CREAD;
530 smd_tty_driver->init_termios.c_lflag = 0;
531 smd_tty_driver->flags = TTY_DRIVER_RESET_TERMIOS |
532 TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
533 tty_set_operations(smd_tty_driver, &smd_tty_ops);
534
535 ret = tty_register_driver(smd_tty_driver);
536 if (ret) return ret;
537
538 /* this should be dynamic */
539 tty_register_device(smd_tty_driver, 0, 0);
540 tty_register_device(smd_tty_driver, 1, 0);
541 tty_register_device(smd_tty_driver, 2, 0);
542 tty_register_device(smd_tty_driver, 3, 0);
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +0530543 tty_register_device(smd_tty_driver, 4, 0);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700544 tty_register_device(smd_tty_driver, 7, 0);
545 tty_register_device(smd_tty_driver, 21, 0);
546 tty_register_device(smd_tty_driver, 27, 0);
547 tty_register_device(smd_tty_driver, 36, 0);
548
549 init_completion(&smd_tty[0].ch_allocated);
550 init_completion(&smd_tty[1].ch_allocated);
551 init_completion(&smd_tty[2].ch_allocated);
552 init_completion(&smd_tty[3].ch_allocated);
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +0530553 init_completion(&smd_tty[4].ch_allocated);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700554 init_completion(&smd_tty[7].ch_allocated);
555 init_completion(&smd_tty[21].ch_allocated);
556 init_completion(&smd_tty[27].ch_allocated);
557 init_completion(&smd_tty[36].ch_allocated);
558
559 smd_tty[0].driver.probe = smd_tty_dummy_probe;
560 smd_tty[0].driver.driver.name = smd_ch_name[0];
561 smd_tty[0].driver.driver.owner = THIS_MODULE;
562 spin_lock_init(&smd_tty[0].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600563 smd_tty[0].is_open = 0;
564 init_waitqueue_head(&smd_tty[0].ch_opened_wait_queue);
Jeff Hugo4c0ba6c2011-07-15 11:47:13 -0600565 /*
566 * DS port is opened in the kernel starting with 8660 fusion.
567 * Only register the platform driver for targets older than that.
568 */
569 if (cpu_is_msm7x01() || cpu_is_msm7x25() || cpu_is_msm7x27() ||
570 cpu_is_msm7x27a() || cpu_is_msm7x27aa() ||
571 cpu_is_msm7x25a() || cpu_is_msm7x25aa() ||
572 cpu_is_msm7x30() || cpu_is_qsd8x50() ||
573 cpu_is_msm8x55() || (cpu_is_msm8x60() &&
574 socinfo_get_platform_subtype() == 0x1)) {
575 ret = platform_driver_register(&smd_tty[0].driver);
576 if (ret)
577 goto out;
578 ds_registered = 1;
579 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700580 smd_tty[1].driver.probe = smd_tty_dummy_probe;
581 smd_tty[1].driver.driver.name = smd_ch_name[1];
582 smd_tty[1].driver.driver.owner = THIS_MODULE;
583 spin_lock_init(&smd_tty[1].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600584 smd_tty[1].is_open = 0;
585 init_waitqueue_head(&smd_tty[1].ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700586 ret = platform_driver_register(&smd_tty[1].driver);
587 if (ret)
588 goto unreg0;
589 smd_tty[2].driver.probe = smd_tty_dummy_probe;
590 smd_tty[2].driver.driver.name = smd_ch_name[2];
591 smd_tty[2].driver.driver.owner = THIS_MODULE;
592 spin_lock_init(&smd_tty[2].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600593 smd_tty[2].is_open = 0;
594 init_waitqueue_head(&smd_tty[2].ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700595 ret = platform_driver_register(&smd_tty[2].driver);
596 if (ret)
597 goto unreg1;
598 smd_tty[3].driver.probe = smd_tty_dummy_probe;
599 smd_tty[3].driver.driver.name = smd_ch_name[3];
600 smd_tty[3].driver.driver.owner = THIS_MODULE;
601 spin_lock_init(&smd_tty[3].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600602 smd_tty[3].is_open = 0;
603 init_waitqueue_head(&smd_tty[3].ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700604 ret = platform_driver_register(&smd_tty[3].driver);
605 if (ret)
606 goto unreg2;
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +0530607 smd_tty[4].driver.probe = smd_tty_dummy_probe;
608 smd_tty[4].driver.driver.name = smd_ch_name[4];
609 smd_tty[4].driver.driver.owner = THIS_MODULE;
610 spin_lock_init(&smd_tty[4].reset_lock);
611 smd_tty[4].is_open = 0;
612 init_waitqueue_head(&smd_tty[4].ch_opened_wait_queue);
613 ret = platform_driver_register(&smd_tty[4].driver);
614 if (ret)
615 goto unreg3;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700616 smd_tty[7].driver.probe = smd_tty_dummy_probe;
617 smd_tty[7].driver.driver.name = smd_ch_name[7];
618 smd_tty[7].driver.driver.owner = THIS_MODULE;
619 spin_lock_init(&smd_tty[7].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600620 smd_tty[7].is_open = 0;
621 init_waitqueue_head(&smd_tty[7].ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700622 ret = platform_driver_register(&smd_tty[7].driver);
623 if (ret)
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +0530624 goto unreg4;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700625 smd_tty[21].driver.probe = smd_tty_dummy_probe;
626 smd_tty[21].driver.driver.name = smd_ch_name[21];
627 smd_tty[21].driver.driver.owner = THIS_MODULE;
628 spin_lock_init(&smd_tty[21].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600629 smd_tty[21].is_open = 0;
630 init_waitqueue_head(&smd_tty[21].ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700631 ret = platform_driver_register(&smd_tty[21].driver);
632 if (ret)
633 goto unreg7;
634 smd_tty[27].driver.probe = smd_tty_dummy_probe;
635 smd_tty[27].driver.driver.name = smd_ch_name[27];
636 smd_tty[27].driver.driver.owner = THIS_MODULE;
637 spin_lock_init(&smd_tty[27].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600638 smd_tty[27].is_open = 0;
639 init_waitqueue_head(&smd_tty[27].ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700640 ret = platform_driver_register(&smd_tty[27].driver);
641 if (ret)
642 goto unreg21;
643 smd_tty[36].driver.probe = smd_tty_dummy_probe;
644 smd_tty[36].driver.driver.name = "LOOPBACK_TTY";
645 smd_tty[36].driver.driver.owner = THIS_MODULE;
646 spin_lock_init(&smd_tty[36].reset_lock);
Karthikeyan Ramasubramaniand5e63af2011-07-29 11:30:59 -0600647 smd_tty[36].is_open = 0;
648 init_waitqueue_head(&smd_tty[36].ch_opened_wait_queue);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700649 INIT_DELAYED_WORK(&loopback_work, loopback_probe_worker);
650 ret = platform_driver_register(&smd_tty[36].driver);
651 if (ret)
652 goto unreg27;
653
654 return 0;
655
656unreg27:
657 platform_driver_unregister(&smd_tty[27].driver);
658unreg21:
659 platform_driver_unregister(&smd_tty[21].driver);
660unreg7:
661 platform_driver_unregister(&smd_tty[7].driver);
Angshuman Sarkar8fa3eb62011-09-15 16:50:07 +0530662unreg4:
663 platform_driver_unregister(&smd_tty[4].driver);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700664unreg3:
665 platform_driver_unregister(&smd_tty[3].driver);
666unreg2:
667 platform_driver_unregister(&smd_tty[2].driver);
668unreg1:
669 platform_driver_unregister(&smd_tty[1].driver);
670unreg0:
Jeff Hugo4c0ba6c2011-07-15 11:47:13 -0600671 if (ds_registered)
672 platform_driver_unregister(&smd_tty[0].driver);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700673out:
674 tty_unregister_device(smd_tty_driver, 0);
675 tty_unregister_device(smd_tty_driver, 1);
676 tty_unregister_device(smd_tty_driver, 2);
677 tty_unregister_device(smd_tty_driver, 3);
678 tty_unregister_device(smd_tty_driver, 7);
679 tty_unregister_device(smd_tty_driver, 21);
680 tty_unregister_device(smd_tty_driver, 27);
681 tty_unregister_device(smd_tty_driver, 36);
682 tty_unregister_driver(smd_tty_driver);
683 put_tty_driver(smd_tty_driver);
684 return ret;
685}
686
687module_init(smd_tty_init);