2 * Connection oriented routing
3 * Copyright (C) 2007-2010 Michael Blizek
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * as published by the Free Software Foundation; either version 2
8 * of the License, or (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
24 * Splited packet data format:
25 * announce proto version [4]
26 * is 0, may be increased if format changes
28 * starts with 0, increments every time the data field changes
30 * total data size of all merged packets
32 * used to determine the order when merging the split packet
35 * commulative checksum [8] (not yet)
36 * chunk 1 contains the checksum of the data in chunk 1
37 * chunk 2 contains the checksum of the data in chunk 1+2
40 * Data format of the announce packet "data" field:
41 * min_announce_proto_version [4]
42 * max_announce_proto_version [4]
43 * min_cor_proto_version [4]
44 * max_cor_proto_version [4]
45 * versions which are understood
49 * commanddata [commandlength]
54 #define NEIGHCMD_ADDADDR 1
59 * addrtype [addrtypelen]
65 DEFINE_MUTEX(neighbor_operation_lock
);
67 char *addrtype
= "id";
73 struct kmem_cache
*nb_slab
;
75 LIST_HEAD(announce_out_list
);
77 struct notifier_block netdev_notify
;
80 #define ADDRTYPE_UNKNOWN 0
83 static int get_addrtype(__u32 addrtypelen
, char *addrtype
)
85 if (addrtypelen
== 2 &&
86 (addrtype
[0] == 'i' || addrtype
[0] == 'I') &&
87 (addrtype
[1] == 'd' || addrtype
[1] == 'D'))
90 return ADDRTYPE_UNKNOWN
;
93 void neighbor_free(struct kref
*ref
)
95 struct neighbor
*nb
= container_of(ref
, struct neighbor
, ref
);
96 printk(KERN_ERR
"neighbor free");
97 BUG_ON(nb
->nb_list
.next
!= LIST_POISON1
);
98 BUG_ON(nb
->nb_list
.prev
!= LIST_POISON2
);
105 kmem_cache_free(nb_slab
, nb
);
108 static struct neighbor
*alloc_neighbor(gfp_t allocflags
)
110 struct neighbor
*nb
= kmem_cache_alloc(nb_slab
, allocflags
);
113 if (unlikely(nb
== 0))
116 memset(nb
, 0, sizeof(struct neighbor
));
118 kref_init(&(nb
->ref
));
119 mutex_init(&(nb
->cmsg_lock
));
120 INIT_LIST_HEAD(&(nb
->control_msgs_out
));
121 INIT_LIST_HEAD(&(nb
->ucontrol_msgs_out
));
122 nb
->last_ping_time
= jiffies
;
123 atomic_set(&(nb
->ooo_packets
), 0);
124 spin_lock_init(&(nb
->credits_lock
));
125 nb
->jiffies_credit_update
= nb
->last_ping_time
;
126 get_random_bytes((char *) &seqno
, sizeof(seqno
));
127 mutex_init(&(nb
->pingcookie_lock
));
128 atomic_set(&(nb
->latency
), 1000000);
129 atomic_set(&(nb
->max_remote_cmsg_delay
), 1000000);
130 spin_lock_init(&(nb
->state_lock
));
131 atomic_set(&(nb
->kpacket_seqno
), seqno
);
132 mutex_init(&(nb
->conn_list_lock
));
133 INIT_LIST_HEAD(&(nb
->rcv_conn_list
));
134 INIT_LIST_HEAD(&(nb
->snd_conn_list
));
135 spin_lock_init(&(nb
->retrans_lock
));
136 INIT_LIST_HEAD(&(nb
->retrans_list
));
137 INIT_LIST_HEAD(&(nb
->retrans_list_conn
));
142 struct neighbor
*get_neigh_by_mac(struct sk_buff
*skb
)
144 struct list_head
*currlh
;
145 struct neighbor
*ret
= 0;
148 char source_hw
[MAX_ADDR_LEN
];
149 memset(source_hw
, 0, MAX_ADDR_LEN
);
150 if (skb
->dev
->header_ops
!= 0 &&
151 skb
->dev
->header_ops
->parse
!= 0)
152 skb
->dev
->header_ops
->parse(skb
, source_hw
);
154 mutex_lock(&(neighbor_operation_lock
));
156 currlh
= nb_list
.next
;
158 while (currlh
!= &nb_list
) {
159 struct neighbor
*curr
= container_of(currlh
, struct neighbor
,
162 if (memcmp(curr
->mac
, source_hw
, MAX_ADDR_LEN
) == 0) {
164 kref_get(&(ret
->ref
));
168 currlh
= currlh
->next
;
171 mutex_unlock(&(neighbor_operation_lock
));
176 struct neighbor
*find_neigh(__u16 addrtypelen
, __u8
*addrtype
,
177 __u16 addrlen
, __u8
*addr
)
179 struct list_head
*currlh
;
180 struct neighbor
*ret
= 0;
182 if (get_addrtype(addrtypelen
, addrtype
) != ADDRTYPE_ID
)
185 mutex_lock(&(neighbor_operation_lock
));
187 currlh
= nb_list
.next
;
189 while (currlh
!= &nb_list
) {
190 struct neighbor
*curr
= container_of(currlh
, struct neighbor
,
193 if (curr
->addrlen
== addrlen
&& memcmp(curr
->addr
, addr
,
196 kref_get(&(ret
->ref
));
201 currlh
= currlh
->next
;
205 mutex_unlock(&(neighbor_operation_lock
));
215 * credit exchange factor + unstable flag
216 * throughput bound conns: throughput,credits/msecs
217 * latency bound conns: latency (ms), credits/byte
220 __u32
generate_neigh_list(char *buf
, __u32 buflen
, __u32 limit
, __u32 offset
)
222 struct list_head
*currlh
;
224 char *p_totalneighs
= buf
;
225 char *p_response_rows
= buf
+ 4;
232 __u32 buf_offset
= 8;
237 mutex_lock(&(neighbor_operation_lock
));
239 currlh
= nb_list
.next
;
241 while (currlh
!= &nb_list
) {
242 struct neighbor
*curr
= container_of(currlh
, struct neighbor
,
246 unsigned long iflags
;
247 /* get_neigh_state not used here because it would deadlock */
248 spin_lock_irqsave( &(curr
->state_lock
), iflags
);
250 spin_unlock_irqrestore( &(curr
->state_lock
), iflags
);
252 if (state
!= NEIGHBOR_STATE_ACTIVE
)
258 if (unlikely(buflen
- buf_offset
- 6 - 2 - curr
->addrlen
< 0))
264 put_u16(buf
+ buf_offset
, 1, 1);/* numaddr */
266 put_u16(buf
+ buf_offset
, 2, 1);/* addrtypelen */
268 put_u16(buf
+ buf_offset
, curr
->addrlen
, 1);/* addren */
270 buf
[buf_offset
] = 'i'; /* addrtype */
272 buf
[buf_offset
] = 'd';
274 memcpy(buf
+ buf_offset
, curr
->addr
, curr
->addrlen
); /* addr */
275 buf_offset
+= curr
->addrlen
;
277 BUG_ON(buf_offset
> buflen
);
284 currlh
= currlh
->next
;
287 mutex_unlock(&(neighbor_operation_lock
));
289 put_u32(p_totalneighs
, total
, 1);
290 put_u32(p_response_rows
, cnt
, 1);
295 void set_last_routdtrip(struct neighbor
*nb
, unsigned long time
)
297 unsigned long iflags
;
301 spin_lock_irqsave( &(nb
->state_lock
), iflags
);
303 if(likely(nb
->state
== NEIGHBOR_STATE_ACTIVE
) && time_after(time
,
304 nb
->state_time
.last_roundtrip
))
305 nb
->state_time
.last_roundtrip
= time
;
307 spin_unlock_irqrestore( &(nb
->state_lock
), iflags
);
310 static void _refresh_initial_debitsrate(struct net_device
*dev
,
314 struct list_head
*currlh
;
316 currlh
= nb_list
.next
;
318 while (currlh
!= &nb_list
) {
319 struct neighbor
*curr
= container_of(currlh
, struct neighbor
,
322 if (curr
->dev
== dev
)
325 currlh
= currlh
->next
;
328 currlh
= nb_list
.next
;
330 while (currlh
!= &nb_list
) {
331 struct neighbor
*curr
= container_of(currlh
, struct neighbor
,
334 if (curr
->dev
== dev
)
335 set_debitrate_initial(curr
,
336 debitsrate
/neighbors
);
338 currlh
= currlh
->next
;
342 /* neighbor operation lock has to be held while calling this */
343 static void refresh_initial_debitsrate(void)
345 struct list_head
*currlh1
;
348 currlh1
= nb_list
.next
;
350 while (currlh1
!= &nb_list
) {
351 struct neighbor
*curr1
= container_of(currlh1
, struct neighbor
,
354 struct list_head
*currlh2
;
355 currlh2
= nb_list
.next
;
356 while (currlh2
!= currlh1
) {
357 struct neighbor
*curr2
= container_of(currlh2
,
358 struct neighbor
, nb_list
);
359 if (curr1
->dev
== curr2
->dev
)
367 currlh1
= currlh1
->next
;
370 currlh1
= nb_list
.next
;
372 while (currlh1
!= &nb_list
) {
373 struct neighbor
*curr1
= container_of(currlh1
, struct neighbor
,
376 struct list_head
*currlh2
;
377 currlh2
= nb_list
.next
;
378 while (currlh2
!= currlh1
) {
379 struct neighbor
*curr2
= container_of(currlh2
,
380 struct neighbor
, nb_list
);
381 if (curr1
->dev
== curr2
->dev
)
385 _refresh_initial_debitsrate(curr1
->dev
,
386 CREDIT_RATE_INITIAL
/ifcnt
);
390 currlh1
= currlh1
->next
;
394 static void reset_stall_conns(struct neighbor
*nb
,
395 int stall_time_ms
, int resetall
)
397 struct list_head
*currlh
;
400 mutex_lock(&(nb
->conn_list_lock
));
401 currlh
= nb
->snd_conn_list
.next
;
403 while (currlh
!= &(nb
->snd_conn_list
)) {
404 struct conn
*sconn
= container_of(currlh
, struct conn
,
406 BUG_ON(sconn
->targettype
!= TARGET_OUT
);
408 if (resetall
|| stall_time_ms
>=
409 sconn
->target
.out
.stall_timeout_ms
) {
411 * reset_conn must not be called with conn_list_lock
414 mutex_unlock(&(nb
->conn_list_lock
));
418 currlh
= currlh
->next
;
421 BUG_ON(list_empty(&(nb
->snd_conn_list
)) && nb
->num_send_conns
!= 0);
422 mutex_unlock(&(nb
->conn_list_lock
));
425 static void stall_timer(struct work_struct
*work
)
427 struct neighbor
*nb
= container_of(to_delayed_work(work
),
428 struct neighbor
, stalltimeout_timer
);
435 unsigned long iflags
;
437 spin_lock_irqsave( &(nb
->state_lock
), iflags
);
438 stall_time_ms
= jiffies_to_msecs(jiffies
-
439 nb
->state_time
.last_roundtrip
);
441 spin_unlock_irqrestore( &(nb
->state_lock
), iflags
);
443 if (unlikely(nbstate
!= NEIGHBOR_STATE_STALLED
)) {
444 nb
->str_timer_pending
= 0;
445 kref_put(&(nb
->ref
), neighbor_free
);
449 resetall
= (stall_time_ms
> NB_KILL_TIME_MS
);
452 printk(KERN_ERR "reset_all");*/
454 reset_stall_conns(nb
, stall_time_ms
, resetall
);
457 spin_lock_irqsave( &(nb
->state_lock
), iflags
);
458 nb
->state
= NEIGHBOR_STATE_KILLED
;
459 spin_unlock_irqrestore( &(nb
->state_lock
), iflags
);
461 mutex_lock(&neighbor_operation_lock
);
462 list_del(&(nb
->nb_list
));
463 refresh_initial_debitsrate();
464 mutex_unlock(&neighbor_operation_lock
);
465 kref_put(&(nb
->ref
), neighbor_free
); /* nb_list */
467 kref_put(&(nb
->ref
), neighbor_free
); /* stall_timer */
470 INIT_DELAYED_WORK(&(nb
->stalltimeout_timer
), stall_timer
);
471 schedule_delayed_work(&(nb
->stalltimeout_timer
),
472 msecs_to_jiffies(STALL_TIMER_INTERVAL_MS
));
476 int get_neigh_state(struct neighbor
*nb
)
479 int switchedtostalled
= 0;
480 unsigned long iflags
;
484 spin_lock_irqsave( &(nb
->state_lock
), iflags
);
486 if (unlikely(likely(nb
->state
== NEIGHBOR_STATE_ACTIVE
) && unlikely(
487 time_after_eq(jiffies
, nb
->state_time
.last_roundtrip
+
488 msecs_to_jiffies(NB_STALL_TIME_MS
)) && (
489 nb
->ping_intransit
>= NB_STALL_MINPINGS
||
490 nb
->ping_intransit
>= PING_COOKIES_PER_NEIGH
)))) {
491 nb
->state
= NEIGHBOR_STATE_STALLED
;
492 switchedtostalled
= 1;
493 printk(KERN_ERR
"switched to stalled");
494 BUG_ON(nb
->ping_intransit
> PING_COOKIES_PER_NEIGH
);
499 spin_unlock_irqrestore( &(nb
->state_lock
), iflags
);
501 if (unlikely(switchedtostalled
)) {
502 /*printk(KERN_ERR "switched to stalled");*/
504 spin_lock_irqsave( &(nb
->state_lock
), iflags
);
505 pending
= nb
->str_timer_pending
;
506 spin_unlock_irqrestore( &(nb
->state_lock
), iflags
);
509 kref_get(&(nb
->ref
));
510 INIT_DELAYED_WORK(&(nb
->stalltimeout_timer
),
512 schedule_delayed_work(&(nb
->stalltimeout_timer
), 1);
519 static struct ping_cookie
*find_cookie(struct neighbor
*nb
, __u32 cookie
)
523 for(i
=0;i
<PING_COOKIES_PER_NEIGH
;i
++) {
524 if (nb
->cookies
[i
].cookie
== cookie
)
525 return &(nb
->cookies
[i
]);
530 void ping_resp(struct neighbor
*nb
, __u32 cookie
, __u32 respdelay
)
532 struct ping_cookie
*c
;
535 unsigned long cookie_sendtime
;
538 unsigned long iflags
;
540 mutex_lock(&(nb
->pingcookie_lock
));
542 c
= find_cookie(nb
, cookie
);
544 if (unlikely(c
== 0))
547 cookie_sendtime
= c
->time
;
549 newlatency
= ((((__s64
) ((__u32
)atomic_read(&(nb
->latency
)))) * 15 +
550 jiffies_to_usecs(jiffies
- c
->time
) - respdelay
) / 16);
551 if (unlikely(newlatency
< 0))
553 if (unlikely(newlatency
> (((__s64
)256)*256*256*256 - 1)))
554 newlatency
= ((__s64
)256)*256*256*256 - 1;
556 atomic_set(&(nb
->latency
), (__u32
) newlatency
);
559 nb
->ping_intransit
--;
561 for(i
=0;i
<PING_COOKIES_PER_NEIGH
;i
++) {
562 if (nb
->cookies
[i
].cookie
!= 0 &&
563 time_before(nb
->cookies
[i
].time
, c
->time
)) {
564 nb
->cookies
[i
].pongs
++;
565 if (nb
->cookies
[i
].pongs
>= PING_PONGLIMIT
) {
566 nb
->cookies
[i
].cookie
= 0;
567 nb
->cookies
[i
].pongs
= 0;
568 nb
->ping_intransit
--;
573 spin_lock_irqsave( &(nb
->state_lock
), iflags
);
575 if (unlikely(nb
->state
== NEIGHBOR_STATE_INITIAL
||
576 nb
->state
== NEIGHBOR_STATE_STALLED
)) {
579 if (nb
->state
== NEIGHBOR_STATE_INITIAL
) {
580 __u64 jiffies64
= get_jiffies_64();
581 if (nb
->state_time
.last_state_change
== 0)
582 nb
->state_time
.last_state_change
= jiffies64
;
583 if (jiffies64
<= (nb
->state_time
.last_state_change
+
584 msecs_to_jiffies(INITIAL_TIME_MS
)))
588 if (nb
->ping_success
>= PING_SUCCESS_CNT
) {
589 /*if (nb->state == NEIGHBOR_STATE_INITIAL)
590 printk(KERN_ERR "switched from initial to active");
592 printk(KERN_ERR "switched from stalled to active");
594 nb
->state
= NEIGHBOR_STATE_ACTIVE
;
595 nb
->ping_success
= 0;
596 nb
->state_time
.last_roundtrip
= jiffies
;
599 nb
->state_time
.last_roundtrip
= cookie_sendtime
;
603 spin_unlock_irqrestore( &(nb
->state_lock
), iflags
);
606 mutex_unlock(&(nb
->pingcookie_lock
));
609 __u32
add_ping_req(struct neighbor
*nb
)
611 struct ping_cookie
*c
;
616 mutex_lock(&(nb
->pingcookie_lock
));
618 for (i
=0;i
<PING_COOKIES_PER_NEIGH
;i
++) {
619 if (nb
->cookies
[i
].cookie
== 0)
623 get_random_bytes((char *) &i
, sizeof(i
));
624 i
= (i
% (PING_COOKIES_PER_NEIGH
- PING_COOKIES_FIFO
)) +
628 c
= &(nb
->cookies
[i
]);
632 if (unlikely(nb
->lastcookie
== 0))
634 c
->cookie
= nb
->lastcookie
;
636 nb
->ping_intransit
++;
640 nb
->last_ping_time
= jiffies
;
642 mutex_unlock(&(nb
->pingcookie_lock
));
647 void unadd_ping_req(struct neighbor
*nb
, __u32 cookie
)
654 mutex_lock(&(nb
->pingcookie_lock
));
656 for (i
=0;i
<PING_COOKIES_PER_NEIGH
;i
++) {
657 if (nb
->cookies
[i
].cookie
== cookie
) {
658 nb
->cookies
[i
].cookie
= 0;
659 nb
->ping_intransit
--;
664 mutex_unlock(&(nb
->pingcookie_lock
));
667 static int neighbor_idle(struct neighbor
*nb
)
670 mutex_lock(&(nb
->conn_list_lock
));
671 ret
= (list_empty(&(nb
->rcv_conn_list
)) &&
672 list_empty(&(nb
->snd_conn_list
)));
673 BUG_ON(list_empty(&(nb
->snd_conn_list
)) && nb
->num_send_conns
!= 0);
674 mutex_unlock(&(nb
->conn_list_lock
));
679 * Check additional to the checks and timings already done in kpacket_gen.c
680 * This is primarily to make sure that we do not invalidate other ping cookies
681 * which might still receive responses. It does this by requiring a certain
682 * mimimum delay between pings, depending on how many pings are already in
685 int time_to_send_ping(struct neighbor
*nb
)
689 int state
= get_neigh_state(nb
);
690 int idle
= (state
!= NEIGHBOR_STATE_ACTIVE
? 0 :
694 mutex_lock(&(nb
->pingcookie_lock
));
695 if (nb
->ping_intransit
>= PING_COOKIES_NOTHROTTLE
) {
696 __u32 mindelay
= (( ((__u32
) atomic_read(&(nb
->latency
))) +
697 ((__u32
) atomic_read(
698 &(nb
->max_remote_cmsg_delay
))) )/1000) <<
699 (nb
->ping_intransit
+ 1 -
700 PING_COOKIES_NOTHROTTLE
);
702 if (mindelay
> PING_THROTTLE_LIMIT_MS
)
703 mindelay
= PING_THROTTLE_LIMIT_MS
;
705 if (jiffies_to_msecs(jiffies
- nb
->last_ping_time
) < mindelay
)
709 if (unlikely(state
!= NEIGHBOR_STATE_ACTIVE
) ||
710 nb
->ping_intransit
!= 0)
711 forcetime
= PING_FORCETIME_MS
;
713 forcetime
= PING_FORCETIME_ACTIVEIDLE_MS
;
715 forcetime
= PING_FORCETIME_ACTIVE_MS
;
717 if (jiffies_to_msecs(jiffies
- nb
->last_ping_time
) < (forcetime
/2))
719 else if (jiffies_to_msecs(jiffies
- nb
->last_ping_time
) >= forcetime
)
722 mutex_unlock(&(nb
->pingcookie_lock
));
727 static void add_neighbor(struct neighbor
*nb
)
729 struct list_head
*currlh
= nb_list
.next
;
731 BUG_ON((nb
->addr
== 0) != (nb
->addrlen
== 0));
733 while (currlh
!= &nb_list
) {
734 struct neighbor
*curr
= container_of(currlh
, struct neighbor
,
737 if (curr
->addrlen
== nb
->addrlen
&& memcmp(curr
->addr
, nb
->addr
,
739 goto already_present
;
741 currlh
= currlh
->next
;
744 /* kref_get not needed here, because the caller leaves its ref to us */
745 printk(KERN_ERR
"add_neigh");
747 list_add_tail(&(nb
->nb_list
), &nb_list
);
748 refresh_initial_debitsrate();
749 schedule_controlmsg_timerfunc(nb
);
750 INIT_DELAYED_WORK(&(nb
->retrans_timer
), retransmit_timerfunc
);
751 INIT_DELAYED_WORK(&(nb
->retrans_timer_conn
), retransmit_conn_timerfunc
);
755 kmem_cache_free(nb_slab
, nb
);
759 static __u32
pull_u32(struct sk_buff
*skb
, int convbo
)
761 char *ptr
= cor_pull_skb(skb
, 4);
767 ((char *)&ret
)[0] = ptr
[0];
768 ((char *)&ret
)[1] = ptr
[1];
769 ((char *)&ret
)[2] = ptr
[2];
770 ((char *)&ret
)[3] = ptr
[3];
773 return be32_to_cpu(ret
);
777 static int apply_announce_addaddr(struct neighbor
*nb
, __u32 cmd
, __u32 len
,
785 BUG_ON((nb
->addr
== 0) != (nb
->addrlen
== 0));
793 addrtypelen
= be16_to_cpu(*((__u16
*) cmddata
));
800 addrlen
= be16_to_cpu(*((__u16
*) cmddata
));
805 cmddata
+= addrtypelen
;
815 if (get_addrtype(addrtypelen
, addrtype
) != ADDRTYPE_ID
)
818 nb
->addr
= kmalloc(addrlen
, GFP_KERNEL
);
819 if (unlikely(nb
->addr
== 0))
822 memcpy(nb
->addr
, addr
, addrlen
);
823 nb
->addrlen
= addrlen
;
828 static void apply_announce_cmd(struct neighbor
*nb
, __u32 cmd
, __u32 len
,
831 if (cmd
== NEIGHCMD_ADDADDR
) {
832 apply_announce_addaddr(nb
, cmd
, len
, cmddata
);
834 /* ignore unknown cmds */
838 static void apply_announce_cmds(char *msg
, __u32 len
, struct net_device
*dev
,
841 struct neighbor
*nb
= alloc_neighbor(GFP_KERNEL
);
843 if (unlikely(nb
== 0))
850 cmd
= be32_to_cpu(*((__u32
*) msg
));
853 cmdlen
= be32_to_cpu(*((__u32
*) msg
));
857 BUG_ON(cmdlen
> len
);
859 apply_announce_cmd(nb
, cmd
, cmdlen
, msg
);
867 memcpy(nb
->mac
, source_hw
, MAX_ADDR_LEN
);
874 static int check_announce_cmds(char *msg
, __u32 len
)
880 cmd
= be32_to_cpu(*((__u32
*) msg
));
883 cmdlen
= be32_to_cpu(*((__u32
*) msg
));
887 /* malformated packet */
888 if (unlikely(cmdlen
> len
))
895 if (unlikely(len
!= 0))
901 static void parse_announce(char *msg
, __u32 len
, struct net_device
*dev
,
904 __u32 min_announce_version
;
905 __u32 max_announce_version
;
906 __u32 min_cor_version
;
907 __u32 max_cor_version
;
909 if (unlikely(len
< 16))
912 min_announce_version
= be32_to_cpu(*((__u32
*) msg
));
915 max_announce_version
= be32_to_cpu(*((__u32
*) msg
));
918 min_cor_version
= be32_to_cpu(*((__u32
*) msg
));
921 max_cor_version
= be32_to_cpu(*((__u32
*) msg
));
925 if (min_announce_version
!= 0)
927 if (min_cor_version
!= 0)
929 if (check_announce_cmds(msg
, len
)) {
932 apply_announce_cmds(msg
, len
, dev
, source_hw
);
936 /* lh has to be first */
938 struct sk_buff_head skbs
; /* sorted by offset */
939 struct net_device
*dev
;
940 char source_hw
[MAX_ADDR_LEN
];
941 __u32 announce_proto_version
;
942 __u32 packet_version
;
945 __u64 last_received_packet
;
948 LIST_HEAD(announce_list
);
950 struct kmem_cache
*announce_in_slab
;
952 static void merge_announce(struct announce_in
*ann
)
954 char *msg
= kmalloc(ann
->total_size
, GFP_KERNEL
);
958 /* try again when next packet arrives */
962 while (copy
!= ann
->total_size
) {
966 struct skb_procstate
*ps
;
968 if (unlikely(skb_queue_empty(&(ann
->skbs
)))) {
969 printk(KERN_ERR
"net/cor/neighbor.c: sk_head ran "
970 "empty while merging packets\n");
974 skb
= skb_dequeue(&(ann
->skbs
));
975 ps
= skb_pstate(skb
);
978 if (unlikely(ps
->funcstate
.announce
.offset
> copy
)) {
979 printk(KERN_ERR
"net/cor/neighbor.c: invalid offset"
984 if (unlikely(ps
->funcstate
.announce
.offset
< copy
)) {
985 offset
= copy
- ps
->funcstate
.announce
.offset
;
989 if (unlikely(currcpy
+ copy
> ann
->total_size
))
992 memcpy(msg
+ copy
, skb
->data
+ offset
, currcpy
);
997 parse_announce(msg
, ann
->total_size
, ann
->dev
, ann
->source_hw
);
1004 list_del(&(ann
->lh
));
1005 kmem_cache_free(announce_in_slab
, ann
);
1008 static int _rcv_announce(struct sk_buff
*skb
, struct announce_in
*ann
)
1010 struct skb_procstate
*ps
= skb_pstate(skb
);
1012 __u32 offset
= ps
->funcstate
.announce
.offset
;
1013 __u32 len
= skb
->len
;
1015 __u32 curroffset
= 0;
1016 __u32 prevoffset
= 0;
1019 struct sk_buff
*curr
= ann
->skbs
.next
;
1021 if (unlikely(len
+ offset
> ann
->total_size
)) {
1022 /* invalid header */
1028 * Try to find the right place to insert in the sorted list. This
1029 * means to process the list until we find a skb which has a greater
1030 * offset, so we can insert before it to keep the sort order. However,
1031 * this is complicated by the fact that the new skb must not be inserted
1032 * between 2 skbs if there is no data missing in between. So the loop
1033 * runs has to keep running until there is either a gap to insert or
1034 * we see that this data has already been received.
1036 while ((void *) curr
!= (void *) &(ann
->skbs
)) {
1037 struct skb_procstate
*currps
= skb_pstate(skb
);
1039 curroffset
= currps
->funcstate
.announce
.offset
;
1041 if (curroffset
> offset
&& (prevoffset
+ prevlen
) < curroffset
)
1044 prevoffset
= curroffset
;
1045 prevlen
= curr
->len
;
1048 if ((offset
+len
) <= (prevoffset
+prevlen
)) {
1049 /* we already have this data */
1056 * Calculate how much data was really received, by substracting
1057 * the bytes we already have.
1059 if (unlikely(prevoffset
+ prevlen
> offset
)) {
1060 len
-= (prevoffset
+ prevlen
) - offset
;
1061 offset
= prevoffset
+ prevlen
;
1064 if (unlikely((void *) curr
!= (void *) &(ann
->skbs
) &&
1065 (offset
+ len
) > curroffset
))
1066 len
= curroffset
- offset
;
1068 ann
->received_size
+= len
;
1069 BUG_ON(ann
->received_size
> ann
->total_size
);
1070 __skb_queue_before(&(ann
->skbs
), curr
, skb
);
1071 ann
->last_received_packet
= get_jiffies_64();
1073 if (ann
->received_size
== ann
->total_size
)
1074 merge_announce(ann
);
1075 else if (unlikely(ann
->skbs
.qlen
>= 16))
1081 void rcv_announce(struct sk_buff
*skb
)
1083 struct skb_procstate
*ps
= skb_pstate(skb
);
1084 struct announce_in
*curr
= 0;
1085 struct announce_in
*leastactive
= 0;
1086 __u32 list_size
= 0;
1088 __u32 announce_proto_version
= pull_u32(skb
, 1);
1089 __u32 packet_version
= pull_u32(skb
, 1);
1090 __u32 total_size
= pull_u32(skb
, 1);
1092 char source_hw
[MAX_ADDR_LEN
];
1093 memset(source_hw
, 0, MAX_ADDR_LEN
);
1094 if (skb
->dev
->header_ops
!= 0 &&
1095 skb
->dev
->header_ops
->parse
!= 0)
1096 skb
->dev
->header_ops
->parse(skb
, source_hw
);
1098 ps
->funcstate
.announce
.offset
= pull_u32(skb
, 1);
1100 if (total_size
> 8192)
1103 mutex_lock(&(neighbor_operation_lock
));
1105 if (announce_proto_version
!= 0)
1108 curr
= (struct announce_in
*) announce_list
.next
;
1110 while (((struct list_head
*) curr
) != &(announce_list
)) {
1112 if (curr
->dev
== skb
->dev
&& memcmp(curr
->source_hw
, source_hw
,
1113 MAX_ADDR_LEN
) == 0 &&
1114 curr
->announce_proto_version
==
1115 announce_proto_version
&&
1116 curr
->packet_version
== packet_version
&&
1117 curr
->total_size
== total_size
)
1120 if (leastactive
== 0 || curr
->last_received_packet
<
1121 leastactive
->last_received_packet
)
1124 curr
= (struct announce_in
*) curr
->lh
.next
;
1127 if (list_size
>= 128) {
1128 BUG_ON(leastactive
== 0);
1131 curr
->last_received_packet
= get_jiffies_64();
1133 while (!skb_queue_empty(&(curr
->skbs
))) {
1134 struct sk_buff
*skb2
= skb_dequeue(&(curr
->skbs
));
1140 curr
= kmem_cache_alloc(announce_in_slab
,
1145 skb_queue_head_init(&(curr
->skbs
));
1146 list_add_tail((struct list_head
*) curr
, &announce_list
);
1149 curr
->packet_version
= packet_version
;
1150 curr
->total_size
= total_size
;
1151 curr
->received_size
= 0;
1152 curr
->announce_proto_version
= announce_proto_version
;
1153 curr
->dev
= skb
->dev
;
1154 dev_hold(curr
->dev
);
1155 memcpy(curr
->source_hw
, source_hw
, MAX_ADDR_LEN
);
1158 if (_rcv_announce(skb
, curr
)) {
1159 list_del((struct list_head
*) curr
);
1161 kmem_cache_free(announce_in_slab
, curr
);
1169 mutex_unlock(&(neighbor_operation_lock
));
1175 __u32 packet_version
;
1177 __u32 announce_msg_len
;
1180 struct announce
*last_announce
;
1182 static int send_announce_chunk(struct announce_data
*ann
)
1184 struct sk_buff
*skb
;
1185 __u32 packet_size
= 256;
1186 __u32 remainingdata
= ann
->ann
->announce_msg_len
-
1187 ann
->curr_announce_msg_offset
;
1188 __u32 headroom
= LL_ALLOCATED_SPACE(ann
->dev
);
1189 __u32 overhead
= 17 + headroom
;
1194 if (remainingdata
< packet_size
)
1195 packet_size
= remainingdata
;
1197 skb
= alloc_skb(packet_size
+ overhead
, GFP_KERNEL
);
1198 if (unlikely(skb
== 0))
1201 skb
->protocol
= htons(ETH_P_COR
);
1202 skb
->dev
= ann
->dev
;
1203 skb_reserve(skb
, headroom
);
1205 if(unlikely(dev_hard_header(skb
, ann
->dev
, ETH_P_COR
,
1206 ann
->dev
->broadcast
, ann
->dev
->dev_addr
, skb
->len
) < 0))
1209 skb_reset_network_header(skb
);
1211 header
= skb_put(skb
, 17);
1212 if (unlikely(header
== 0))
1215 header
[0] = PACKET_TYPE_ANNOUNCE
;
1217 put_u32(header
+ 1, 0, 1); /* announce proto version */
1218 put_u32(header
+ 5, ann
->ann
->packet_version
, 1); /* packet version */
1219 put_u32(header
+ 9, ann
->ann
->announce_msg_len
, 1); /* total size */
1220 put_u32(header
+ 13, ann
->curr_announce_msg_offset
, 1); /* offset */
1222 ptr
= skb_put(skb
, packet_size
);
1223 if (unlikely(ptr
== 0))
1226 memcpy(ptr
, ann
->ann
->announce_msg
+ ann
->curr_announce_msg_offset
,
1229 rc
= dev_queue_xmit(skb
);
1232 ann
->curr_announce_msg_offset
+= packet_size
;
1234 if (ann
->curr_announce_msg_offset
== ann
->ann
->announce_msg_len
)
1235 ann
->curr_announce_msg_offset
= 0;
1247 int send_announce_qos(struct announce_data
*ann
)
1250 mutex_lock(&(neighbor_operation_lock
));
1251 rc
= send_announce_chunk(ann
);
1252 mutex_unlock(&(neighbor_operation_lock
));
1256 static void announce_free(struct kref
*ref
)
1258 struct announce
*ann
= container_of(ref
, struct announce
, ref
);
1259 kfree(&(ann
->announce_msg
));
1263 void announce_data_free(struct kref
*ref
)
1265 struct announce_data
*ann
= container_of(ref
, struct announce_data
,
1268 kref_put(&(ann
->ann
->ref
), announce_free
);
1272 static void send_announce(struct work_struct
*work
)
1274 struct announce_data
*ann
= container_of(to_delayed_work(work
),
1275 struct announce_data
, announce_work
);
1279 mutex_lock(&(neighbor_operation_lock
));
1281 if (unlikely(ann
->dev
== 0))
1285 if (unlikely(ann
->ann
== 0 && last_announce
== 0))
1287 if (ann
->curr_announce_msg_offset
== 0 &&
1288 unlikely(ann
->ann
!= last_announce
)) {
1290 kref_put(&(ann
->ann
->ref
), announce_free
);
1291 ann
->ann
= last_announce
;
1292 kref_get(&(ann
->ann
->ref
));
1295 rc
= send_announce_chunk(ann
);
1298 mutex_unlock(&(neighbor_operation_lock
));
1301 qos_enqueue(ann
->dev
, &(ann
->rb
), QOS_CALLER_ANNOUNCE
);
1303 if (unlikely(reschedule
== 0)) {
1304 kref_put(&(ann
->ref
), announce_data_free
);
1306 __u64 jiffies
= get_jiffies_64();
1309 ann
->scheduled_announce_timer
+= msecs_to_jiffies(
1310 ANNOUNCE_SEND_PACKETINTELVAL_MS
);
1312 delay
= ann
->scheduled_announce_timer
- jiffies
;
1316 INIT_DELAYED_WORK(&(ann
->announce_work
), send_announce
);
1317 schedule_delayed_work(&(ann
->announce_work
), delay
);
1321 static struct announce_data
*get_announce_by_netdev(struct net_device
*dev
)
1323 struct list_head
*lh
= announce_out_list
.next
;
1325 while (lh
!= &announce_out_list
) {
1326 struct announce_data
*curr
= (struct announce_data
*)(
1328 offsetof(struct announce_data
, lh
));
1330 if (curr
->dev
== dev
)
1337 static void announce_send_adddev(struct net_device
*dev
)
1339 struct announce_data
*ann
;
1341 ann
= kmalloc(sizeof(struct announce_data
), GFP_KERNEL
);
1343 if (unlikely(ann
== 0)) {
1344 printk(KERN_ERR
"cor cannot allocate memory for sending "
1349 memset(ann
, 0, sizeof(struct announce_data
));
1351 kref_init(&(ann
->ref
));
1356 mutex_lock(&(neighbor_operation_lock
));
1357 list_add_tail(&(ann
->lh
), &announce_out_list
);
1358 mutex_unlock(&(neighbor_operation_lock
));
1360 ann
->scheduled_announce_timer
= get_jiffies_64();
1361 INIT_DELAYED_WORK(&(ann
->announce_work
), send_announce
);
1362 schedule_delayed_work(&(ann
->announce_work
), 1);
1365 static void announce_send_rmdev(struct net_device
*dev
)
1367 struct announce_data
*ann
;
1369 mutex_lock(&(neighbor_operation_lock
));
1371 ann
= get_announce_by_netdev(dev
);
1380 mutex_unlock(&(neighbor_operation_lock
));
1383 int netdev_notify_func(struct notifier_block
*not, unsigned long event
,
1386 struct net_device
*dev
= (struct net_device
*) ptr
;
1391 rc
= create_queue(dev
);
1394 announce_send_adddev(dev
);
1398 announce_send_rmdev(dev
);
1402 case NETDEV_REGISTER
:
1403 case NETDEV_UNREGISTER
:
1404 case NETDEV_CHANGEMTU
:
1405 case NETDEV_CHANGEADDR
:
1406 case NETDEV_GOING_DOWN
:
1407 case NETDEV_CHANGENAME
:
1408 case NETDEV_FEAT_CHANGE
:
1409 case NETDEV_BONDING_FAILOVER
:
1418 static int set_announce(char *msg
, __u32 len
)
1420 struct announce
*ann
= kmalloc(sizeof(struct announce
), GFP_KERNEL
);
1422 if (unlikely(ann
== 0)) {
1427 memset(ann
, 0, sizeof(struct announce
));
1429 ann
->announce_msg
= msg
;
1430 ann
->announce_msg_len
= len
;
1432 kref_init(&(ann
->ref
));
1434 mutex_lock(&(neighbor_operation_lock
));
1436 if (last_announce
!= 0) {
1437 ann
->packet_version
= last_announce
->packet_version
+ 1;
1438 kref_put(&(last_announce
->ref
), announce_free
);
1441 last_announce
= ann
;
1443 mutex_unlock(&(neighbor_operation_lock
));
1448 static int generate_announce(void)
1450 __u32 addrtypelen
= strlen(addrtype
);
1453 __u32 cmd_hdr_len
= 8;
1454 __u32 cmd_len
= 2 + 2 + addrtypelen
+ addrlen
;
1456 __u32 len
= hdr_len
+ cmd_hdr_len
+ cmd_len
;
1459 char *msg
= kmalloc(len
, GFP_KERNEL
);
1460 if (unlikely(msg
== 0))
1463 put_u32(msg
+ offset
, 0, 1); /* min_announce_proto_version */
1465 put_u32(msg
+ offset
, 0, 1); /* max_announce_proto_version */
1467 put_u32(msg
+ offset
, 0, 1); /* min_cor_proto_version */
1469 put_u32(msg
+ offset
, 0, 1); /* max_cor_proto_version */
1473 put_u32(msg
+ offset
, NEIGHCMD_ADDADDR
, 1); /* command */
1475 put_u32(msg
+ offset
, cmd_len
, 1); /* command length */
1478 /* addrtypelen, addrlen */
1479 put_u16(msg
+ offset
, addrtypelen
, 1);
1481 put_u16(msg
+ offset
, addrlen
, 1);
1484 /* addrtype, addr */
1485 memcpy(msg
+ offset
, addrtype
, addrtypelen
);
1486 offset
+= addrtypelen
;
1487 memcpy(msg
+ offset
, addr
, addrlen
);
1490 BUG_ON(offset
!= len
);
1492 return set_announce(msg
, len
);
1495 int __init
cor_neighbor_init(void)
1499 addr
= kmalloc(addrlen
, GFP_KERNEL
);
1500 if (unlikely(addr
== 0))
1503 get_random_bytes(addr
, addrlen
);
1505 nb_slab
= kmem_cache_create("cor_neighbor", sizeof(struct neighbor
), 8,
1507 announce_in_slab
= kmem_cache_create("cor_announce_in",
1508 sizeof(struct announce_in
), 8, 0, 0);
1510 if (unlikely(generate_announce()))
1513 memset(&netdev_notify
, 0, sizeof(netdev_notify
));
1514 netdev_notify
.notifier_call
= netdev_notify_func
;
1515 register_netdevice_notifier(&netdev_notify
);
1526 MODULE_LICENSE("GPL");