- if ((sl->lin_state == SLSTATE_IDLE) && test_bit(SLF_MSGEVENT, &sl->flags)) {
- cf = (struct can_frame *)sl->tx_req_skb->data;
-
- /* EFF CAN frame -> "Configuration" frame */
- if (cf->can_id & CAN_EFF_FLAG) {
- sllin_configure_frame_cache(sl, cf);
- goto free_skb;
- } /* SFF RTR CAN frame -> LIN header */
- else if (cf->can_id & CAN_RTR_FLAG) {
- printk(KERN_INFO "%s: RTR SFF CAN frame, ID = %x\n",
- __FUNCTION__, cf->can_id & SLLIN_ID_MASK);
-
- /* Is there Slave response in linfr_cache to be sent? */
- if ((sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].frame_fl &
- SLLIN_LOC_SLAVE_CACHE)
- && (sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].dlc > 0)) {
-
- printk(KERN_INFO "Sending LIN response from linfr_cache\n");
- lin_data = &sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].data;
- lin_dlc = sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].dlc;
- } else {
- lin_data = NULL;
- lin_dlc = sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].dlc;
+ switch (sl->lin_state) {
+ case SLSTATE_IDLE:
+ if (!test_bit(SLF_MSGEVENT, &sl->flags))
+ break;
+
+ cf = (struct can_frame *)sl->tx_req_skb->data;
+
+ /* SFF RTR CAN frame -> LIN header */
+ if (cf->can_id & CAN_RTR_FLAG) {
+ spin_lock(&sl->lock);
+ printk(KERN_INFO "%s: RTR SFF CAN frame, ID = %x\n",
+ __FUNCTION__, cf->can_id & SLLIN_ID_MASK);
+
+ /* Is there Slave response in linfr_cache to be sent? */
+ if ((sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].frame_fl &
+ SLLIN_LOC_SLAVE_CACHE)
+ && (sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].dlc > 0)) {
+
+ printk(KERN_INFO "Sending LIN response from linfr_cache\n");
+ lin_data = sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].data;
+ lin_dlc = sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].dlc;
+ if (lin_dlc > SLLIN_DATA_MAX)
+ lin_dlc = SLLIN_DATA_MAX;
+ memcpy(lin_data_buff, lin_data, lin_dlc);
+ lin_data = lin_data_buff;
+ } else {
+ lin_data = NULL;
+ lin_dlc = sl->linfr_cache[cf->can_id & SLLIN_ID_MASK].dlc;
+ }
+ spin_unlock(&sl->lock);
+ } else { /* SFF NON-RTR CAN frame -> LIN header + LIN response */
+ printk(KERN_INFO "%s: NON-RTR SFF CAN frame, ID = %x\n",
+ __FUNCTION__, (int)cf->can_id & SLLIN_ID_MASK);
+
+ lin_data = cf->data;
+ lin_dlc = cf->can_dlc;
+ if (lin_dlc > SLLIN_DATA_MAX)
+ lin_dlc = SLLIN_DATA_MAX;
+ tx_bytes = lin_dlc;