#include <linux/delay.h>
#include <linux/init.h>
#include <linux/can.h>
+#include <linux/kthread.h>
+
+/* Should be in include/linux/tty.h */
+#define N_SLLIN 25
static __initdata const char banner[] =
KERN_INFO "sllin: serial line LIN interface driver\n";
module_param(maxdev, int, 0);
MODULE_PARM_DESC(maxdev, "Maximum number of sllin interfaces");
-/* maximum rx buffer len: extended CAN frame with timestamp */
-#define SLC_MTU (sizeof("T1111222281122334455667788EA5F\r")+1)
+/* maximum buffer len to store whole LIN message*/
+#define SLLIN_DATA_MAX 8
+#define SLLIN_BUFF_LEN (1 /*break*/ + 1 /*sync*/ + 1 /*ID*/ + \
+ SLLIN_DATA_MAX + 1 /*checksum*/)
+#define SLLIN_BUFF_BREAK 0
+#define SLLIN_BUFF_SYNC 1
+#define SLLIN_BUFF_ID 2
+#define SLLIN_BUFF_DATA 3
+
+enum slstate {
+ SLSTATE_IDLE = 0,
+ SLSTATE_BREAK_SENT,
+ SLSTATE_ID_SENT,
+ SLSTATE_RESPONSE_WAIT,
+ SLSTATE_RESPONSE_SENT,
+};
struct sllin {
int magic;
struct net_device *dev; /* easy for intr handling */
spinlock_t lock;
- /* These are pointers to the malloc()ed frame buffers. */
- unsigned char rbuff[SLC_MTU]; /* receiver buffer */
- int rcount; /* received chars counter */
- unsigned char xbuff[SLC_MTU]; /* transmitter buffer */
- unsigned char *xhead; /* pointer to next XMIT byte */
- int xleft; /* bytes left in XMIT queue */
+ /* LIN message buffer and actual processed data counts */
+ unsigned char rx_buff[SLLIN_BUFF_LEN]; /* LIN Rx buffer */
+ unsigned char tx_buff[SLLIN_BUFF_LEN]; /* LIN Tx buffer */
+ int rx_expect; /* expected number of Rx chars */
+ int rx_lim; /* maximum Rx chars for ID */
+ int rx_cnt; /* message buffer Rx fill level */
+ int tx_lim; /* actual limit of bytes to Tx */
+ int tx_cnt; /* number of already Tx bytes */
+ char lin_master; /* node is a master node */
+ int lin_baud; /* LIN baudrate */
+ int lin_state; /* state */
+ int id_to_send; /* there is ID to be sent */
unsigned long flags; /* Flag values/ mode etc */
#define SLF_INUSE 0 /* Channel in use */
#define SLF_ERROR 1 /* Parity, etc. error */
+#define SLF_RXEVENT 2 /* Rx wake event */
+#define SLF_TXEVENT 3 /* Tx wake event */
+#define SLF_MSGEVENT 4 /* CAN message to sent */
- unsigned char leased;
dev_t line;
- pid_t pid;
+ struct task_struct *kwthread;
+ wait_queue_head_t kwt_wq;
};
static struct net_device **sllin_devs;
- /************************************************************************
- * SLLIN ENCAPSULATION FORMAT *
- ************************************************************************/
-
-/*
- * A CAN frame has a can_id (11 bit standard frame format OR 29 bit extended
- * frame format) a data length code (can_dlc) which can be from 0 to 8
- * and up to <can_dlc> data bytes as payload.
- * Additionally a CAN frame may become a remote transmission frame if the
- * RTR-bit is set. This causes another ECU to send a CAN frame with the
- * given can_id.
- *
- * The SLLIN ASCII representation of these different frame types is:
- * <type> <id> <dlc> <data>*
- *
- * Extended frames (29 bit) are defined by capital characters in the type.
- * RTR frames are defined as 'r' types - normal frames have 't' type:
- * t => 11 bit data frame
- * r => 11 bit RTR frame
- * T => 29 bit data frame
- * R => 29 bit RTR frame
- *
- * The <id> is 3 (standard) or 8 (extended) bytes in ASCII Hex (base64).
- * The <dlc> is a one byte ASCII number ('0' - '8')
- * The <data> section has at much ASCII Hex bytes as defined by the <dlc>
- *
- * Examples:
- *
- * t1230 : can_id 0x123, can_dlc 0, no data
- * t4563112233 : can_id 0x456, can_dlc 3, data 0x11 0x22 0x33
- * T12ABCDEF2AA55 : extended can_id 0x12ABCDEF, can_dlc 2, data 0xAA 0x55
- * r1230 : can_id 0x123, can_dlc 0, no data, remote transmission request
- *
- */
-
- /************************************************************************
- * STANDARD SLLIN DECAPSULATION *
- ************************************************************************/
+const unsigned char sllin_id_parity_table[] = {
+ 0x80,0xc0,0x40,0x00,0xc0,0x80,0x00,0x40,
+ 0x00,0x40,0xc0,0x80,0x40,0x00,0x80,0xc0,
+ 0x40,0x00,0x80,0xc0,0x00,0x40,0xc0,0x80,
+ 0xc0,0x80,0x00,0x40,0x80,0xc0,0x40,0x00,
+ 0x00,0x40,0xc0,0x80,0x40,0x00,0x80,0xc0,
+ 0x80,0xc0,0x40,0x00,0xc0,0x80,0x00,0x40,
+ 0xc0,0x80,0x00,0x40,0x80,0xc0,0x40,0x00,
+ 0x40,0x00,0x80,0xc0,0x00,0x40,0xc0,0x80
+};
-static int asc2nibble(char c)
+static int sltty_change_speed(struct tty_struct *tty, unsigned speed)
{
+ struct ktermios old_termios;
+ int cflag;
- if ((c >= '0') && (c <= '9'))
- return c - '0';
+ mutex_lock(&tty->termios_mutex);
- if ((c >= 'A') && (c <= 'F'))
- return c - 'A' + 10;
+ old_termios = *(tty->termios);
+ cflag = tty->termios->c_cflag;
+ cflag &= ~(CBAUD | CIBAUD);
+ cflag |= BOTHER;
+ tty->termios->c_cflag = cflag;
- if ((c >= 'a') && (c <= 'f'))
- return c - 'a' + 10;
+ tty_encode_baud_rate(tty, speed, speed);
- return 16; /* error */
+ if (tty->ops->set_termios)
+ tty->ops->set_termios(tty, &old_termios);
+ //priv->io.speed = speed;
+ mutex_unlock(&tty->termios_mutex);
+
+ return 0;
}
+
/* Send one completely decapsulated can_frame to the network layer */
static void sll_bump(struct sllin *sl)
{
- struct sk_buff *skb;
- struct can_frame cf;
- int i, dlc_pos, tmp;
- unsigned long ultmp;
- char cmd = sl->rbuff[0];
-
- if ((cmd != 't') && (cmd != 'T') && (cmd != 'r') && (cmd != 'R'))
- return;
-
- if (cmd & 0x20) /* tiny chars 'r' 't' => standard frame format */
- dlc_pos = 4; /* dlc position tiiid */
- else
- dlc_pos = 9; /* dlc position Tiiiiiiiid */
-
- if (!((sl->rbuff[dlc_pos] >= '0') && (sl->rbuff[dlc_pos] < '9')))
- return;
-
- cf.can_dlc = sl->rbuff[dlc_pos] - '0'; /* get can_dlc from ASCII val */
-
- sl->rbuff[dlc_pos] = 0; /* terminate can_id string */
-
- if (strict_strtoul(sl->rbuff+1, 16, &ultmp))
- return;
-
- cf.can_id = ultmp;
-
- if (!(cmd & 0x20)) /* NO tiny chars => extended frame format */
- cf.can_id |= CAN_EFF_FLAG;
-
- if ((cmd | 0x20) == 'r') /* RTR frame */
- cf.can_id |= CAN_RTR_FLAG;
-
- *(u64 *) (&cf.data) = 0; /* clear payload */
-
- for (i = 0, dlc_pos++; i < cf.can_dlc; i++) {
-
- tmp = asc2nibble(sl->rbuff[dlc_pos++]);
- if (tmp > 0x0F)
- return;
- cf.data[i] = (tmp << 4);
- tmp = asc2nibble(sl->rbuff[dlc_pos++]);
- if (tmp > 0x0F)
- return;
- cf.data[i] |= tmp;
- }
-
-
- skb = dev_alloc_skb(sizeof(struct can_frame));
- if (!skb)
- return;
-
- skb->dev = sl->dev;
- skb->protocol = htons(ETH_P_CAN);
- skb->pkt_type = PACKET_BROADCAST;
- skb->ip_summed = CHECKSUM_UNNECESSARY;
- memcpy(skb_put(skb, sizeof(struct can_frame)),
- &cf, sizeof(struct can_frame));
- netif_rx(skb);
-
- sl->dev->stats.rx_packets++;
- sl->dev->stats.rx_bytes += cf.can_dlc;
+// struct sk_buff *skb;
+// struct can_frame cf;
+// int i, dlc_pos, tmp;
+// unsigned long ultmp;
+// char cmd = sl->rbuff[0];
+//
+// if ((cmd != 't') && (cmd != 'T') && (cmd != 'r') && (cmd != 'R'))
+// return;
+//
+// if (cmd & 0x20) /* tiny chars 'r' 't' => standard frame format */
+// dlc_pos = 4; /* dlc position tiiid */
+// else
+// dlc_pos = 9; /* dlc position Tiiiiiiiid */
+//
+// if (!((sl->rbuff[dlc_pos] >= '0') && (sl->rbuff[dlc_pos] < '9')))
+// return;
+//
+// cf.can_dlc = sl->rbuff[dlc_pos] - '0'; /* get can_dlc from ASCII val */
+//
+// sl->rbuff[dlc_pos] = 0; /* terminate can_id string */
+//
+// if (strict_strtoul(sl->rbuff+1, 16, &ultmp))
+// return;
+//
+// cf.can_id = ultmp;
+//
+// if (!(cmd & 0x20)) /* NO tiny chars => extended frame format */
+// cf.can_id |= CAN_EFF_FLAG;
+//
+// if ((cmd | 0x20) == 'r') /* RTR frame */
+// cf.can_id |= CAN_RTR_FLAG;
+//
+// *(u64 *) (&cf.data) = 0; /* clear payload */
+//
+// for (i = 0, dlc_pos++; i < cf.can_dlc; i++) {
+//
+// tmp = asc2nibble(sl->rbuff[dlc_pos++]);
+// if (tmp > 0x0F)
+// return;
+// cf.data[i] = (tmp << 4);
+// tmp = asc2nibble(sl->rbuff[dlc_pos++]);
+// if (tmp > 0x0F)
+// return;
+// cf.data[i] |= tmp;
+// }
+//
+//
+// skb = dev_alloc_skb(sizeof(struct can_frame));
+// if (!skb)
+// return;
+//
+// skb->dev = sl->dev;
+// skb->protocol = htons(ETH_P_CAN);
+// skb->pkt_type = PACKET_BROADCAST;
+// skb->ip_summed = CHECKSUM_UNNECESSARY;
+// memcpy(skb_put(skb, sizeof(struct can_frame)),
+// &cf, sizeof(struct can_frame));
+// netif_rx(skb);
+//
+// sl->dev->stats.rx_packets++;
+// sl->dev->stats.rx_bytes += cf.can_dlc;
}
-/* parse tty input stream */
-static void sllin_unesc(struct sllin *sl, unsigned char s)
-{
-
- if ((s == '\r') || (s == '\a')) { /* CR or BEL ends the pdu */
- if (!test_and_clear_bit(SLF_ERROR, &sl->flags) &&
- (sl->rcount > 4)) {
- sll_bump(sl);
- }
- sl->rcount = 0;
- } else {
- if (!test_bit(SLF_ERROR, &sl->flags)) {
- if (sl->rcount < SLC_MTU) {
- sl->rbuff[sl->rcount++] = s;
- return;
- } else {
- sl->dev->stats.rx_over_errors++;
- set_bit(SLF_ERROR, &sl->flags);
- }
- }
- }
-}
/************************************************************************
* STANDARD SLLIN ENCAPSULATION *
************************************************************************/
-/* Encapsulate one can_frame and stuff into a TTY queue. */
+/* Convert particular CAN frame into LIN frame and send it to TTY queue. */
static void sll_encaps(struct sllin *sl, struct can_frame *cf)
{
- int actual, idx, i;
- char cmd;
-
- if (cf->can_id & CAN_RTR_FLAG)
- cmd = 'R'; /* becomes 'r' in standard frame format */
- else
- cmd = 'T'; /* becomes 't' in standard frame format */
-
- if (cf->can_id & CAN_EFF_FLAG)
- sprintf(sl->xbuff, "%c%08X%d", cmd,
- cf->can_id & CAN_EFF_MASK, cf->can_dlc);
- else
- sprintf(sl->xbuff, "%c%03X%d", cmd | 0x20,
- cf->can_id & CAN_SFF_MASK, cf->can_dlc);
-
- idx = strlen(sl->xbuff);
-
- for (i = 0; i < cf->can_dlc; i++)
- sprintf(&sl->xbuff[idx + 2*i], "%02X", cf->data[i]);
-
- strcat(sl->xbuff, "\r"); /* add terminating character */
-
- /* Order of next two lines is *very* important.
- * When we are sending a little amount of data,
- * the transfer may be completed inside the ops->write()
- * routine, because it's running with interrupts enabled.
- * In this case we *never* got WRITE_WAKEUP event,
- * if we did not request it before write operation.
- * 14 Oct 1994 Dmitry Gorodchanin.
- */
- set_bit(TTY_DO_WRITE_WAKEUP, &sl->tty->flags);
- actual = sl->tty->ops->write(sl->tty, sl->xbuff, strlen(sl->xbuff));
- sl->xleft = strlen(sl->xbuff) - actual;
- sl->xhead = sl->xbuff + actual;
- sl->dev->stats.tx_bytes += cf->can_dlc;
+// int actual, idx, i;
+// char lframe[16] = {0x00, 0x55}; /* Fake break, Sync byte */
+// struct tty_struct *tty = sl->tty;
+//
+// pr_debug("sllin: %s() invoked\n", __FUNCTION__);
+//
+// /* We do care only about SFF frames */
+// if (cf->can_id & CAN_EFF_FLAG)
+// return;
+//
+// /* Send only header */
+// if (cf->can_id & CAN_RTR_FLAG) {
+// pr_debug("sllin: %s() RTR CAN frame\n", __FUNCTION__);
+// lframe[2] = (u8)cf->can_id; /* Get one byte LIN ID */
+//
+// sltty_change_speed(tty, sl->lin_baud * 2 / 3);
+// tty->ops->write(tty, &lframe[0], 1);
+// sltty_change_speed(tty, sl->lin_baud);
+// tty->ops->write(tty, &lframe[1], 1);
+// tty->ops->write(tty, &lframe[2], 1);
+// } else {
+// pr_debug("sllin: %s() non-RTR CAN frame\n", __FUNCTION__);
+// /* idx = strlen(sl->xbuff);
+//
+// for (i = 0; i < cf->can_dlc; i++)
+// sprintf(&sl->xbuff[idx + 2*i], "%02X", cf->data[i]);
+//
+// * Order of next two lines is *very* important.
+// * When we are sending a little amount of data,
+// * the transfer may be completed inside the ops->write()
+// * routine, because it's running with interrupts enabled.
+// * In this case we *never* got WRITE_WAKEUP event,
+// * if we did not request it before write operation.
+// * 14 Oct 1994 Dmitry Gorodchanin.
+//
+// set_bit(TTY_DO_WRITE_WAKEUP, &sl->tty->flags);
+// actual = sl->tty->ops->write(sl->tty, sl->xbuff, strlen(sl->xbuff));
+// sl->xleft = strlen(sl->xbuff) - actual;
+// sl->xhead = sl->xbuff + actual;
+// sl->dev->stats.tx_bytes += cf->can_dlc;
+// */
+// }
+//
}
/*
static void sllin_write_wakeup(struct tty_struct *tty)
{
int actual;
+ int remains;
struct sllin *sl = (struct sllin *) tty->disc_data;
/* First make sure we're connected. */
if (!sl || sl->magic != SLLIN_MAGIC || !netif_running(sl->dev))
return;
- if (sl->xleft <= 0) {
- /* Now serial buffer is almost free & we can start
- * transmission of another packet */
- sl->dev->stats.tx_packets++;
- clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
- netif_wake_queue(sl->dev);
- return;
+ if (sl->lin_state != SLSTATE_BREAK_SENT)
+ remains = sl->tx_lim - sl->tx_cnt;
+ else
+ remains = SLLIN_BUFF_BREAK + 1 - sl->tx_cnt;
+
+ if (remains > 0) {
+ actual = tty->ops->write(tty, sl->tx_buff + sl->tx_cnt, sl->tx_cnt - sl->tx_lim);
+ sl->tx_cnt += actual;
+
+ if (sl->tx_cnt < sl->tx_lim) {
+ printk(KERN_INFO "sllin_write_wakeup sent %d, remains %d, waiting\n",
+ sl->tx_cnt, sl->tx_lim - sl->tx_cnt);
+ return;
+ }
}
- actual = tty->ops->write(tty, sl->xhead, sl->xleft);
- sl->xleft -= actual;
- sl->xhead += actual;
+ clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
+ set_bit(SLF_TXEVENT, &sl->flags);
+ wake_up(&sl->kwt_wq);
+
+ printk(KERN_INFO "sllin_write_wakeup sent %d, wakeup\n", sl->tx_cnt);
}
/* Send a can_frame to a TTY queue. */
clear_bit(TTY_DO_WRITE_WAKEUP, &sl->tty->flags);
}
netif_stop_queue(dev);
- sl->rcount = 0;
- sl->xleft = 0;
+ sl->rx_expect = 0;
+ sl->tx_lim = 0;
spin_unlock_bh(&sl->lock);
return 0;
{
struct sllin *sl = netdev_priv(dev);
+ pr_debug("sllin: %s() invoked\n", __FUNCTION__);
+
if (sl->tty == NULL)
return -ENODEV;
{
struct sllin *sl = (struct sllin *) tty->disc_data;
+ printk(KERN_INFO "sllin_receive_buf invoked\n");
+
if (!sl || sl->magic != SLLIN_MAGIC || !netif_running(sl->dev))
return;
if (fp && *fp++) {
if (!test_and_set_bit(SLF_ERROR, &sl->flags))
sl->dev->stats.rx_errors++;
+ printk(KERN_INFO "sllin_receive_buf char 0x%02x ignored due marker 0x%02x, flags 0x%lx\n",
+ *cp, *(fp-1), sl->flags);
cp++;
continue;
}
- sllin_unesc(sl, *cp++);
+
+ if (sl->rx_cnt < SLLIN_BUFF_LEN) {
+ sl->rx_buff[sl->rx_cnt++] = *cp++;
+ }
+ }
+
+ if(sl->rx_cnt >= sl->rx_expect) {
+ set_bit(SLF_RXEVENT, &sl->flags);
+ wake_up(&sl->kwt_wq);
+ printk(KERN_INFO "sllin_receive_buf count %d, wakeup\n", sl->rx_cnt);
+ } else {
+ printk(KERN_INFO "sllin_receive_buf count %d, waiting\n", sl->rx_cnt);
}
}
+/*****************************************
+ * sllin message helper routines
+ *****************************************/
+
+int sllin_setup_msg(struct sllin *sl, int mode, int id,
+ unsigned char *data, int len)
+{
+ if (id > 0x3f)
+ return -1;
+
+ sl->rx_cnt = 0;
+ sl->tx_cnt = 0;
+ sl->rx_expect = 0;
+
+ sl->tx_buff[SLLIN_BUFF_BREAK] = 0;
+ sl->tx_buff[SLLIN_BUFF_SYNC] = 0x55;
+ sl->tx_buff[SLLIN_BUFF_ID] = id | sllin_id_parity_table[id];
+ sl->tx_lim = SLLIN_BUFF_DATA;
+
+ if ((data != NULL) && len) {
+ int i;
+ unsigned csum = 0;
+
+ sl->tx_lim += len;
+ memcpy(sl->tx_buff + SLLIN_BUFF_DATA, data, len);
+ /* compute data parity there */
+ for (i = SLLIN_BUFF_DATA; i < sl->tx_lim; i++) {
+ csum += sl->tx_buff[i];
+ if (csum > 255)
+ csum -= 255;
+ }
+
+ sl->tx_buff[sl->tx_lim++] = csum;
+ }
+ if (len != 0)
+ sl->rx_lim += len + 1;
+
+ return 0;
+}
+
+
+int sllin_send_tx_buff(struct sllin *sl)
+{
+ struct tty_struct *tty = sl->tty;
+ int remains;
+ int res;
+
+ if (sl->lin_state != SLSTATE_BREAK_SENT)
+ remains = sl->tx_lim - sl->tx_cnt;
+ else
+ remains = 1;
+
+
+ res = tty->ops->write(tty, sl->tx_buff + sl->tx_cnt, remains);
+ if (res < 0)
+ return -1;
+
+ remains -= res;
+ sl->tx_cnt += res;
+
+ if (remains > 0) {
+ set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
+ res = tty->ops->write(tty, sl->tx_buff + sl->tx_cnt, remains);
+ if (res < 0) {
+ clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
+ return -1;
+ }
+
+ remains -= res;
+ sl->tx_cnt += res;
+ }
+
+ printk(KERN_INFO "sllin_send_tx_buff sent %d, remains %d\n",
+ sl->tx_cnt, remains);
+
+ return 0;
+}
+
+int sllin_send_break(struct sllin *sl)
+{
+ struct tty_struct *tty = sl->tty;
+ unsigned long break_baud = sl->lin_baud;
+ int res;
+
+ //break_baud = (break_baud * 8) / 14;
+ break_baud /= 2;
+
+ sltty_change_speed(tty, break_baud);
+
+ sl->rx_expect = SLLIN_BUFF_BREAK + 1;
+
+ sl->lin_state = SLSTATE_BREAK_SENT;
+
+ res = sllin_send_tx_buff(sl);
+ if (res < 0) {
+ sl->lin_state = SLSTATE_IDLE;
+ return res;
+ }
+
+ return 0;
+}
+
+/*****************************************
+ * sllin_kwthread - kernel worker thread
+ *****************************************/
+
+int sllin_kwthread(void *ptr)
+{
+ struct sllin *sl = (struct sllin *)ptr;
+ struct tty_struct *tty = sl->tty;
+ int res;
+
+ printk(KERN_INFO "sllin: sllin_kwthread started.\n");
+
+ clear_bit(SLF_ERROR, &sl->flags);
+
+ sltty_change_speed(tty, sl->lin_baud);
+
+ sllin_setup_msg(sl, 0, 0x33, NULL, 0);
+ sl->id_to_send = 1;
+
+ while (!kthread_should_stop()) {
+
+ if ((sl->lin_state == SLSTATE_IDLE) && sl->lin_master &&
+ sl->id_to_send) {
+ if(sllin_send_break(sl)<0) {
+ /* error processing */
+ }
+
+ }
+
+ wait_event_killable(sl->kwt_wq, kthread_should_stop() ||
+ test_bit(SLF_RXEVENT, &sl->flags) ||
+ test_bit(SLF_TXEVENT, &sl->flags));
+
+ if (test_and_clear_bit(SLF_RXEVENT, &sl->flags)) {
+ printk(KERN_INFO "sllin_kthread RXEVENT \n");
+ }
+
+ if (test_and_clear_bit(SLF_TXEVENT, &sl->flags)) {
+ printk(KERN_INFO "sllin_kthread TXEVENT \n");
+ }
+
+ switch (sl->lin_state) {
+ case SLSTATE_BREAK_SENT:
+ if (sl->rx_cnt <= SLLIN_BUFF_BREAK)
+ continue;
+
+ res = sltty_change_speed(tty, sl->lin_baud);
+
+ sllin_send_tx_buff(sl);
+
+ sl->lin_state = SLSTATE_ID_SENT;
+
+ break;
+ case SLSTATE_ID_SENT:
+ sl->id_to_send = 0;
+ sl->lin_state = SLSTATE_IDLE;
+ break;
+ }
+
+
+
+ /* sll_bump(sl); send packet to the network layer */
+
+ /* sl->dev->stats.tx_packets++; send frames statistic */
+ /* netif_wake_queue(sl->dev); allow next Tx packet arrival */
+ }
+
+
+ printk(KERN_INFO "sllin: sllin_kwthread stopped.\n");
+
+ return 0;
+}
+
+
/************************************
* sllin_open helper routines.
************************************/
break;
sl = netdev_priv(dev);
- if (sl->tty || sl->leased)
+ if (sl->tty)
continue;
if (dev->flags & IFF_UP)
dev_close(dev);
{
struct sllin *sl;
int err;
+ pr_debug("sllin: %s() invoked\n", __FUNCTION__);
if (!capable(CAP_NET_ADMIN))
return -EPERM;
sl->tty = tty;
tty->disc_data = sl;
sl->line = tty_devnum(tty);
- sl->pid = current->pid;
if (!test_bit(SLF_INUSE, &sl->flags)) {
/* Perform the low-level SLLIN initialization. */
- sl->rcount = 0;
- sl->xleft = 0;
+ sl->rx_cnt = 0;
+ sl->rx_expect = 0;
+ sl->tx_cnt = 0;
+ sl->tx_lim = 0;
+
+ sl->lin_baud = 2400;
+
+ sl->lin_master = 1;
+ sl->lin_state = SLSTATE_IDLE;
set_bit(SLF_INUSE, &sl->flags);
+ init_waitqueue_head(&sl->kwt_wq);
+ sl->kwthread = kthread_run(sllin_kwthread, sl, "sllin");
+ if (sl->kwthread == NULL)
+ goto err_free_chan;
+
err = register_netdevice(sl->dev);
if (err)
- goto err_free_chan;
+ goto err_free_chan_and_thread;
}
/* Done. We have linked the TTY line to a channel. */
rtnl_unlock();
- tty->receive_room = 65536; /* We don't flow control */
+ tty->receive_room = SLLIN_BUFF_LEN * 40; /* We don't flow control */
/* TTY layer expects 0 on success */
return 0;
+err_free_chan_and_thread:
+ kthread_stop(sl->kwthread);
+ sl->kwthread = NULL;
+
err_free_chan:
sl->tty = NULL;
tty->disc_data = NULL;
if (!sl || sl->magic != SLLIN_MAGIC || sl->tty != tty)
return;
+ kthread_stop(sl->kwthread);
+ sl->kwthread = NULL;
+
tty->disc_data = NULL;
sl->tty = NULL;
- if (!sl->leased)
- sl->line = 0;
/* Flush network side */
unregister_netdev(sl->dev);