- printk( KERN_INFO "can:%d\n", *(u16*)nla_data( tb[CGW_CAN_IF] ) );
- printk( KERN_INFO "eth addr:%x\n", *(u16*)nla_data( tb[CGW_ETH_IP] ) );
- printk( KERN_INFO "eth port:%hu\n", *(u16*)nla_data( tb[CGW_ETH_PORT] ) );
+ /* so far we only support CAN -> CAN routings */
+ switch( r->gwtype )
+ {
+ case CGW_TYPE_CAN_ETH_UDP:
+ printk( KERN_INFO "can:%d\n", *(int*)nla_data( tb[CGW_CAN_IF] ) );
+ printk( KERN_INFO "eth addr:%x\n", *(u32*)nla_data( tb[CGW_ETH_IP] ) );
+ printk( KERN_INFO "eth port:%hu\n", *(u16*)nla_data( tb[CGW_ETH_PORT] ) );
+ cethgw = kmalloc( sizeof(struct can_eth_gw), GFP_KERNEL );
+ if( cethgw == NULL )
+ {
+ printk( KERN_ERR "error: kmalloc\n" );
+ break;
+ }
+ cethgw->src_if_idx = *(int*)nla_data( tb[CGW_CAN_IF] );
+ cethgw->dst_addr = *(struct in_addr*)nla_data( tb[CGW_ETH_IP] );
+ cethgw->dst_port = *(u16*)nla_data( tb[CGW_ETH_PORT] );
+
+ hlist_add_head_rcu( &cethgw->list, &can_eth_job );
+ break;
+ case CGW_TYPE_ETH_CAN_UDP:
+ printk( KERN_INFO "can:%d\n", *(int*)nla_data( tb[CGW_CAN_IF] ) );
+ ecangw = kmalloc( sizeof(struct eth_can_gw), GFP_KERNEL );
+ if( ecangw == NULL )
+ {
+ printk( KERN_ERR "error: kmalloc\n" );
+ break;
+ }
+ ecangw->dst_if_idx = *(int*)nla_data( tb[CGW_CAN_IF] );
+ hlist_add_head_rcu( &ecangw->list, ð_can_job );
+ break;
+ default:
+ /* ToDo undef operation */
+ break;
+ }