+#ifdef BREAK_BY_BAUD
+int sllin_send_break(struct sllin *sl)
+{
+ struct tty_struct *tty = sl->tty;
+ unsigned long break_baud;
+ int res;
+
+ break_baud = ((sl->lin_baud * 2) / 3);
+ sltty_change_speed(tty, break_baud);
+
+ tty->ops->flush_buffer(tty);
+ sl->rx_cnt = SLLIN_BUFF_BREAK;
+
+ 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;
+}
+#else /* BREAK_BY_BAUD */
+
+int sllin_send_break(struct sllin *sl)
+{
+ struct tty_struct *tty = sl->tty;
+ unsigned long break_baud;
+ unsigned long flags;
+ int retval;
+
+ sl->rx_cnt = SLLIN_BUFF_BREAK;
+ sl->rx_expect = SLLIN_BUFF_BREAK + 1;
+ sl->lin_state = SLSTATE_BREAK_SENT;
+
+ /* Do the break ourselves; Inspired by
+ http://lxr.linux.no/#linux+v3.1.2/drivers/tty/tty_io.c#L2452 */
+ retval = tty->ops->break_ctl(tty, -1);
+ if (retval)
+ return retval;
+
+ //udelay(712);
+ usleep_range(650, 750);
+
+ retval = tty->ops->break_ctl(tty, 0);
+ usleep_range(50, 100);
+
+ tty->ops->flush_buffer(tty);
+
+ sl->tx_cnt = SLLIN_BUFF_SYNC;
+
+ printk(KERN_INFO "sllin: Break sent.\n");
+ set_bit(SLF_RXEVENT, &sl->flags);
+ wake_up(&sl->kwt_wq);
+
+ return 0;
+}
+#endif /* BREAK_BY_BAUD */
+
+/*****************************************
+ * sllin_kwthread - kernel worker thread
+ *****************************************/
+
+int sllin_kwthread(void *ptr)
+{
+ struct sllin *sl = (struct sllin *)ptr;
+ struct tty_struct *tty = sl->tty;
+ struct sched_param schparam = { .sched_priority = 40 };
+ int res;
+ struct can_frame *cf;
+
+ printk(KERN_INFO "sllin: sllin_kwthread started.\n");
+ sched_setscheduler(current, SCHED_FIFO, &schparam);
+
+ clear_bit(SLF_ERROR, &sl->flags);
+ sltty_change_speed(tty, sl->lin_baud);
+
+ 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) ||
+ ((sl->lin_state == SLSTATE_IDLE) && test_bit(SLF_MSGEVENT, &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");
+ }
+
+ if ((sl->lin_state == SLSTATE_IDLE) && test_bit(SLF_MSGEVENT, &sl->flags)) {
+ cf = (struct can_frame *)sl->rec_skb->data;
+
+ /* We do care only about SFF frames */
+ if (cf->can_id & CAN_EFF_FLAG)
+ goto release_skb;
+
+ if (cf->can_id & CAN_RTR_FLAG) {
+ printk(KERN_INFO "%s: RTR CAN frame, ID = %x\n",
+ __FUNCTION__, cf->can_id & CAN_SFF_MASK);
+ if (sllin_setup_msg(sl, 0,
+ cf->can_id & CAN_SFF_MASK, NULL, 0) != -1) {
+ sl->id_to_send = true;
+ }
+ } else {
+ printk(KERN_INFO "%s: NON-RTR CAN frame, ID = %x\n",
+ __FUNCTION__, (int)cf->can_id & CAN_SFF_MASK);
+
+ if (sllin_setup_msg(sl, 0, cf->can_id & CAN_SFF_MASK,
+ cf->data, cf->can_dlc) != -1) {
+ sl->id_to_send = true;
+ }
+ }
+
+ release_skb:
+ clear_bit(SLF_MSGEVENT, &sl->flags);
+ kfree_skb(sl->rec_skb);
+ netif_wake_queue(sl->dev);
+ }
+
+ switch (sl->lin_state) {
+ case SLSTATE_BREAK_SENT:
+#ifdef BREAK_BY_BAUD
+ if (sl->rx_cnt <= SLLIN_BUFF_BREAK)
+ continue;
+
+ res = sltty_change_speed(tty, sl->lin_baud);
+#endif
+
+ sl->lin_state = SLSTATE_ID_SENT;
+ sllin_send_tx_buff(sl);
+ break;
+
+ case SLSTATE_ID_SENT:
+ sl->id_to_send = false;
+ 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;
+}
+
+