|
@@ -33,6 +33,8 @@
|
|
|
|
|
|
#include "jsm.h"
|
|
|
|
|
|
+static DECLARE_BITMAP(linemap, MAXLINES);
|
|
|
+
|
|
|
static void jsm_carrier(struct jsm_channel *ch);
|
|
|
|
|
|
static inline int jsm_get_mstat(struct jsm_channel *ch)
|
|
@@ -433,6 +435,7 @@ int __devinit jsm_tty_init(struct jsm_board *brd)
|
|
|
int __devinit jsm_uart_port_init(struct jsm_board *brd)
|
|
|
{
|
|
|
int i;
|
|
|
+ unsigned int line;
|
|
|
struct jsm_channel *ch;
|
|
|
|
|
|
if (!brd)
|
|
@@ -459,9 +462,15 @@ int __devinit jsm_uart_port_init(struct jsm_board *brd)
|
|
|
brd->channels[i]->uart_port.membase = brd->re_map_membase;
|
|
|
brd->channels[i]->uart_port.fifosize = 16;
|
|
|
brd->channels[i]->uart_port.ops = &jsm_ops;
|
|
|
- brd->channels[i]->uart_port.line = brd->channels[i]->ch_portnum + brd->boardnum * 2;
|
|
|
+ line = find_first_zero_bit(linemap, MAXLINES);
|
|
|
+ if (line >= MAXLINES) {
|
|
|
+ printk(KERN_INFO "jsm: linemap is full, added device failed\n");
|
|
|
+ continue;
|
|
|
+ } else
|
|
|
+ set_bit((int)line, linemap);
|
|
|
+ brd->channels[i]->uart_port.line = line;
|
|
|
if (uart_add_one_port (&jsm_uart_driver, &brd->channels[i]->uart_port))
|
|
|
- printk(KERN_INFO "Added device failed\n");
|
|
|
+ printk(KERN_INFO "jsm: add device failed\n");
|
|
|
else
|
|
|
printk(KERN_INFO "Added device \n");
|
|
|
}
|
|
@@ -494,6 +503,7 @@ int jsm_remove_uart_port(struct jsm_board *brd)
|
|
|
|
|
|
ch = brd->channels[i];
|
|
|
|
|
|
+ clear_bit((int)(ch->uart_port.line), linemap);
|
|
|
uart_remove_one_port(&jsm_uart_driver, &brd->channels[i]->uart_port);
|
|
|
}
|
|
|
|