- /* 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;
- sl->data_to_send = false;
- }
- } 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;
- sl->data_to_send = true;
+ /* 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 = 0;