OpenCores
URL https://opencores.org/ocsvn/or1k_old/or1k_old/trunk

Subversion Repositories or1k_old

[/] [or1k_old/] [trunk/] [uclinux/] [uClinux-2.0.x/] [net/] [bridge/] [br.c] - Blame information for rev 1782

Details | Compare with Previous | View Log

Line No. Rev Author Line
1 199 simons
/*
2
 *      Linux NET3 Bridge Support
3
 *
4
 *      Originally by John Hayes (Network Plumbing).
5
 *      Minor hacks to get it to run with 1.3.x by Alan Cox <Alan.Cox@linux.org>
6
 *
7
 *      This program is free software; you can redistribute it and/or
8
 *      modify it under the terms of the GNU General Public License
9
 *      as published by the Free Software Foundation; either version
10
 *      2 of the License, or (at your option) any later version.
11
 *
12
 *      Fixes:
13
 *
14
 *      Todo:
15
 *              Don't bring up devices automatically. Start ports disabled
16
 *      and use a netlink notifier so a daemon can maintain the bridge
17
 *      port group (could we also do multiple groups ????).
18
 *              A nice /proc file interface.
19
 *              Put the path costs in the port info and devices.
20
 *              Put the bridge port number in the device structure for speed.
21
 *              Bridge SNMP stats.
22
 *
23
 */
24
 
25
#include <linux/errno.h>
26
#include <linux/types.h>
27
#include <linux/socket.h>
28
#include <linux/in.h>
29
#include <linux/kernel.h>
30
#include <linux/sched.h>
31
#include <linux/timer.h>
32
#include <linux/string.h>
33
#include <linux/net.h>
34
#include <linux/inet.h>
35
#include <linux/netdevice.h>
36
#include <linux/string.h>
37
#include <linux/skbuff.h>
38
#include <linux/if_arp.h>
39
#include <asm/segment.h>
40
#include <asm/system.h>
41
#include <net/br.h>
42
 
43
static int br_device_event(struct notifier_block *dnot, unsigned long event, void *ptr);
44
static void br_tick(unsigned long arg);
45
int br_forward(struct sk_buff *skb, int port);  /* 3.7 */
46
int br_port_cost(struct device *dev);   /* 4.10.2 */
47
void br_bpdu(struct sk_buff *skb); /* consumes skb */
48
int br_tx_frame(struct sk_buff *skb);
49
int br_cmp(unsigned int *a, unsigned int *b);
50
 
51
unsigned char bridge_ula[ETH_ALEN] = { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x00 };
52
 
53
Bridge_data     bridge_info;                      /* (4.5.3)     */
54
Port_data       port_info[All_ports];             /* (4.5.5)     */
55
Config_bpdu     config_bpdu[All_ports];
56
Tcn_bpdu        tcn_bpdu[All_ports];
57
Timer           hello_timer;                      /* (4.5.4.1)   */
58
Timer           tcn_timer;                        /* (4.5.4.2)   */
59
Timer           topology_change_timer;            /* (4.5.4.3)   */
60
Timer           message_age_timer[All_ports];     /* (4.5.6.1)   */
61
Timer           forward_delay_timer[All_ports];   /* (4.5.6.2)   */
62
Timer           hold_timer[All_ports];            /* (4.5.6.3)   */
63
 
64
/* entries timeout after this many seconds */
65
unsigned int fdb_aging_time = FDB_TIMEOUT;
66
 
67
struct br_stat br_stats;
68
 
69
static struct timer_list tl; /* for 1 second timer... */
70
 
71
/*
72
 * the following structure is required so that we receive
73
 * event notifications when network devices are enabled and
74
 * disabled (ifconfig up and down).
75
 */
76
static struct notifier_block br_dev_notifier={
77
        br_device_event,
78
        NULL,
79
 
80
};
81
 
82
/** Elements of Procedure (4.6) **/
83
 
84
/*
85
 * this section of code was graciously borrowed from the IEEE 802.1d
86
 * specification section 4.9.1 starting on pg 69.  It has been
87
 * modified somewhat to fit within out framework and structure.  It
88
 * implements the spanning tree algorithm that is the heart of the
89
 * 802.1d bridging protocol.
90
 */
91
 
92
void transmit_config(int port_no)                         /* (4.6.1)     */
93
{
94
        if(!(br_stats.flags & BR_UP))
95
                return; /* this should not happen but happens */
96
        if (hold_timer[port_no].active) {         /* (4.6.1.3.1)         */
97
                port_info[port_no].config_pending = TRUE;       /* (4.6.1.3.1)   */
98
        } else {                                  /* (4.6.1.3.2)         */
99
                config_bpdu[port_no].type = BPDU_TYPE_CONFIG;
100
                config_bpdu[port_no].root_id = bridge_info.designated_root;
101
                /* (4.6.1.3.2(1)) */
102
                config_bpdu[port_no].root_path_cost = bridge_info.root_path_cost;
103
                /* (4.6.1.3.2(2)) */
104
                config_bpdu[port_no].bridge_id = bridge_info.bridge_id;
105
                /* (4.6.1.3.2(3)) */
106
                config_bpdu[port_no].port_id = port_info[port_no].port_id;
107
                /*
108
                 * (4.6.1.3.2(4))
109
                 */
110
                if (root_bridge()) {
111
                        config_bpdu[port_no].message_age = Zero;        /* (4.6.1.3.2(5)) */
112
                } else {
113
                        config_bpdu[port_no].message_age
114
                                = message_age_timer[bridge_info.root_port].value
115
                                + Message_age_increment;        /* (4.6.1.3.2(6)) */
116
                }
117
 
118
                config_bpdu[port_no].max_age = bridge_info.max_age;     /* (4.6.1.3.2(7)) */
119
                config_bpdu[port_no].hello_time = bridge_info.hello_time;
120
                config_bpdu[port_no].forward_delay = bridge_info.forward_delay;
121
                config_bpdu[port_no].flags = 0;
122
                config_bpdu[port_no].flags |=
123
                        port_info[port_no].top_change_ack ? TOPOLOGY_CHANGE_ACK : 0;
124
                /* (4.6.1.3.2(8)) */
125
                port_info[port_no].top_change_ack = 0;
126
                /* (4.6.1.3.2(8)) */
127
                config_bpdu[port_no].flags |=
128
                        bridge_info.top_change ? TOPOLOGY_CHANGE : 0;
129
                /* (4.6.1.3.2(9)) */
130
 
131
                send_config_bpdu(port_no, &config_bpdu[port_no]);
132
                port_info[port_no].config_pending = FALSE;      /* (4.6.1.3.2(10)) */
133
                start_hold_timer(port_no);        /* (4.6.1.3.2(11)) */
134
        }
135
}
136
 
137
int root_bridge(void)
138
{
139
        return (br_cmp(bridge_info.designated_root.BRIDGE_ID,
140
                 bridge_info.bridge_id.BRIDGE_ID)?FALSE:TRUE);
141
}
142
 
143
int supersedes_port_info(int port_no, Config_bpdu *config)        /* (4.6.2.2)   */
144
{
145
        return (
146
                (br_cmp(config->root_id.BRIDGE_ID,
147
                 port_info[port_no].designated_root.BRIDGE_ID) < 0)      /* (4.6.2.2.1)   */
148
                ||
149
                ((br_cmp(config->root_id.BRIDGE_ID,
150
                  port_info[port_no].designated_root.BRIDGE_ID) == 0
151
                  )
152
                 &&
153
                 ((config->root_path_cost
154
                   < port_info[port_no].designated_cost /* (4.6.2.2.2)   */
155
                   )
156
                  ||
157
                  ((config->root_path_cost
158
                    == port_info[port_no].designated_cost
159
                    )
160
                   &&
161
                   ((br_cmp(config->bridge_id.BRIDGE_ID,
162
                     port_info[port_no].designated_bridge.BRIDGE_ID) < 0 /* (4.6.2.2.3)    */
163
                     )
164
                    ||
165
                    ((br_cmp(config->bridge_id.BRIDGE_ID,
166
                      port_info[port_no].designated_bridge.BRIDGE_ID) == 0
167
                      )                           /* (4.6.2.2.4)         */
168
                     &&
169
                     ((br_cmp(config->bridge_id.BRIDGE_ID,
170
                        bridge_info.bridge_id.BRIDGE_ID) != 0
171
                       )                          /* (4.6.2.2.4(1)) */
172
                      ||
173
                      (config->port_id <=
174
                       port_info[port_no].designated_port
175
                       )                          /* (4.6.2.2.4(2)) */
176
                      ))))))
177
                );
178
}
179
 
180
void record_config_information(int port_no, Config_bpdu *config)          /* (4.6.2)     */
181
{
182
        port_info[port_no].designated_root = config->root_id;   /* (4.6.2.3.1)   */
183
        port_info[port_no].designated_cost = config->root_path_cost;
184
        port_info[port_no].designated_bridge = config->bridge_id;
185
        port_info[port_no].designated_port = config->port_id;
186
        start_message_age_timer(port_no, config->message_age);  /* (4.6.2.3.2)   */
187
}
188
 
189
void record_config_timeout_values(Config_bpdu *config)            /* (4.6.3)     */
190
{
191
        bridge_info.max_age = config->max_age;    /* (4.6.3.3)   */
192
        bridge_info.hello_time = config->hello_time;
193
        bridge_info.forward_delay = config->forward_delay;
194
        if (config->flags & TOPOLOGY_CHANGE)
195
                bridge_info.top_change = 1;
196
}
197
 
198
void config_bpdu_generation(void)
199
{                                                 /* (4.6.4)     */
200
        int             port_no;
201
        for (port_no = One; port_no <= No_of_ports; port_no++) {        /* (4.6.4.3) */
202
                if (designated_port(port_no)      /* (4.6.4.3)   */
203
                                &&
204
                                (port_info[port_no].state != Disabled)
205
                        ) {
206
                        transmit_config(port_no); /* (4.6.4.3)   */
207
                }                                 /* (4.6.1.2)   */
208
        }
209
}
210
 
211
int designated_port(int port_no)
212
{
213
        return ((br_cmp(port_info[port_no].designated_bridge.BRIDGE_ID,
214
                 bridge_info.bridge_id.BRIDGE_ID) == 0
215
                 )
216
                &&
217
                (port_info[port_no].designated_port
218
                 == port_info[port_no].port_id
219
                 )
220
                );
221
}
222
 
223
void reply(int port_no)                                   /* (4.6.5)     */
224
{
225
        transmit_config(port_no);                 /* (4.6.5.3)   */
226
}
227
 
228
void transmit_tcn(void)
229
{                                                 /* (4.6.6)     */
230
        int             port_no;
231
 
232
        port_no = bridge_info.root_port;
233
        tcn_bpdu[port_no].type = BPDU_TYPE_TOPO_CHANGE;
234
        send_tcn_bpdu(port_no, &tcn_bpdu[bridge_info.root_port]);       /* (4.6.6.3)     */
235
}
236
 
237
void configuration_update(void) /* (4.6.7) */
238
{
239
        root_selection();                         /* (4.6.7.3.1)         */
240
        /* (4.6.8.2)     */
241
        designated_port_selection();              /* (4.6.7.3.2)         */
242
        /* (4.6.9.2)     */
243
}
244
 
245
void root_selection(void)
246
{                                                 /* (4.6.8) */
247
        int             root_port;
248
        int             port_no;
249
        root_port = No_port;
250
        for (port_no = One; port_no <= No_of_ports; port_no++) {        /* (4.6.8.3.1) */
251
                if (((!designated_port(port_no))
252
                     &&
253
                     (port_info[port_no].state != Disabled)
254
                     &&
255
                (br_cmp(port_info[port_no].designated_root.BRIDGE_ID,
256
                        bridge_info.bridge_id.BRIDGE_ID) < 0)
257
                        )
258
                                &&
259
                                ((root_port == No_port)
260
                                 ||
261
                                 (br_cmp(port_info[port_no].designated_root.BRIDGE_ID,
262
                                  port_info[root_port].designated_root.BRIDGE_ID) < 0
263
                                  )
264
                                 ||
265
                                 ((br_cmp(port_info[port_no].designated_root.BRIDGE_ID,
266
                                   port_info[root_port].designated_root.BRIDGE_ID) == 0
267
                                   )
268
                                  &&
269
                                  (((port_info[port_no].designated_cost
270
                                     + port_info[port_no].path_cost
271
                                     )
272
                                    <
273
                                    (port_info[root_port].designated_cost
274
                                     + port_info[root_port].path_cost
275
                                     )            /* (4.6.8.3.1(2)) */
276
                                    )
277
                                   ||
278
                                   (((port_info[port_no].designated_cost
279
                                      + port_info[port_no].path_cost
280
                                      )
281
                                     ==
282
                                     (port_info[root_port].designated_cost
283
                                      + port_info[root_port].path_cost
284
                                      )
285
                                     )
286
                                    &&
287
                                    ((br_cmp(port_info[port_no].designated_bridge.BRIDGE_ID,
288
                                    port_info[root_port].designated_bridge.BRIDGE_ID) < 0
289
                                      )           /* (4.6.8.3.1(3)) */
290
                                     ||
291
                                     ((br_cmp(port_info[port_no].designated_bridge.BRIDGE_ID,
292
                                   port_info[root_port].designated_bridge.BRIDGE_ID) == 0
293
                                       )
294
                                      &&
295
                                      ((port_info[port_no].designated_port
296
                                      < port_info[root_port].designated_port
297
                                        )         /* (4.6.8.3.1(4)) */
298
                                       ||
299
                                       ((port_info[port_no].designated_port
300
                                      = port_info[root_port].designated_port
301
                                         )
302
                                        &&
303
                                        (port_info[port_no].port_id
304
                                         < port_info[root_port].port_id
305
                                         )        /* (4.6.8.3.1(5)) */
306
                                        ))))))))) {
307
                        root_port = port_no;
308
                }
309
        }
310
        bridge_info.root_port = root_port;        /* (4.6.8.3.1)         */
311
 
312
        if (root_port == No_port) {               /* (4.6.8.3.2)         */
313
                bridge_info.designated_root = bridge_info.bridge_id;
314
                /* (4.6.8.3.2(1)) */
315
                bridge_info.root_path_cost = Zero;/* (4.6.8.3.2(2)) */
316
        } else {                                  /* (4.6.8.3.3)         */
317
                bridge_info.designated_root = port_info[root_port].designated_root;
318
                /* (4.6.8.3.3(1)) */
319
                bridge_info.root_path_cost = (port_info[root_port].designated_cost
320
                                            + port_info[root_port].path_cost
321
                        );                        /* (4.6.8.3.3(2)) */
322
        }
323
}
324
 
325
void designated_port_selection(void)
326
{                                                 /* (4.6.9)     */
327
        int             port_no;
328
 
329
        for (port_no = One; port_no <= No_of_ports; port_no++) {        /* (4.6.9.3)     */
330
                if (designated_port(port_no)      /* (4.6.9.3.1)         */
331
                                ||
332
                                (
333
                                 br_cmp(port_info[port_no].designated_root.BRIDGE_ID,
334
                                 bridge_info.designated_root.BRIDGE_ID) != 0
335
                                 )
336
                                ||
337
                                (bridge_info.root_path_cost
338
                                 < port_info[port_no].designated_cost
339
                                 )                /* (4.6.9.3.3)         */
340
                                ||
341
                                ((bridge_info.root_path_cost
342
                                  == port_info[port_no].designated_cost
343
                                  )
344
                                 &&
345
                                 ((br_cmp(bridge_info.bridge_id.BRIDGE_ID,
346
                                   port_info[port_no].designated_bridge.BRIDGE_ID) < 0
347
                                   )              /* (4.6.9.3.4)         */
348
                                  ||
349
                                  ((br_cmp(bridge_info.bridge_id.BRIDGE_ID,
350
                                    port_info[port_no].designated_bridge.BRIDGE_ID) == 0
351
                                    )
352
                                   &&
353
                                   (port_info[port_no].port_id
354
                                    <= port_info[port_no].designated_port
355
                                    )             /* (4.6.9.3.5)         */
356
                                   )))) {
357
                        become_designated_port(port_no);        /* (4.6.10.3.2.2) */
358
                }
359
        }
360
}
361
 
362
void become_designated_port(int port_no)
363
{                                                 /* (4.6.10)    */
364
 
365
        /* (4.6.10.3.1) */
366
        port_info[port_no].designated_root = bridge_info.designated_root;
367
        /* (4.6.10.3.2) */
368
        port_info[port_no].designated_cost = bridge_info.root_path_cost;
369
        /* (4.6.10.3.3) */
370
        port_info[port_no].designated_bridge = bridge_info.bridge_id;
371
        /* (4.6.10.3.4) */
372
        port_info[port_no].designated_port = port_info[port_no].port_id;
373
}
374
 
375
void port_state_selection(void)
376
{                                                 /* (4.6.11) */
377
        int             port_no;
378
        for (port_no = One; port_no <= No_of_ports; port_no++) {
379
                if (port_no == bridge_info.root_port) { /* (4.6.11.3.1) */
380
                        port_info[port_no].config_pending = FALSE;      /* (4.6.11.3~1(1)) */
381
                        port_info[port_no].top_change_ack = 0;
382
                        make_forwarding(port_no); /* (4.6.11.3.1(2)) */
383
                } else if (designated_port(port_no)) {  /* (4.6.11.3.2) */
384
                        stop_message_age_timer(port_no);        /* (4.6.11.3.2(1)) */
385
                        make_forwarding(port_no); /* (4.6.11.3.2(2)) */
386
                } else {                          /* (4.6.11.3.3) */
387
                        port_info[port_no].config_pending = FALSE;      /* (4.6.11.3.3(1)) */
388
                        port_info[port_no].top_change_ack = 0;
389
                        make_blocking(port_no);   /* (4.6.11.3.3(2)) */
390
                }
391
        }
392
 
393
}
394
 
395
void make_forwarding(int port_no)
396
{                                                 /* (4.6.12) */
397
        if (port_info[port_no].state == Blocking) {     /* (4.6.12.3) */
398
                set_port_state(port_no, Listening);     /* (4.6.12.3.1) */
399
                start_forward_delay_timer(port_no);     /* (4.6.12.3.2) */
400
        }
401
}
402
 
403
void topology_change_detection(void)
404
{                                                 /* (4.6.14)       */
405
        if (root_bridge()) {                      /* (4.6.14.3.1)   */
406
                bridge_info.top_change = 1;
407
                start_topology_change_timer();    /* (4.6.14.3.1(2)) */
408
        } else if (!(bridge_info.top_change_detected)) {
409
                transmit_tcn();                   /* (4.6.14.3.2(1)) */
410
                start_tcn_timer();                /* (4.6.14.3.2(2)) */
411
        }
412
        bridge_info.top_change = 1;
413
}
414
 
415
void topology_change_acknowledged(void)
416
{                                                 /* (4.6.15) */
417
        bridge_info.top_change_detected = 0;
418
        stop_tcn_timer();                         /* (4.6.15.3.2) */
419
}
420
 
421
void acknowledge_topology_change(int port_no)
422
{                                                 /* (4.6.16) */
423
        port_info[port_no].top_change_ack = 1;
424
        transmit_config(port_no);                 /* (4.6.16.3.2) */
425
}
426
 
427
void make_blocking(int port_no)                           /* (4.6.13)    */
428
{
429
 
430
        if ((port_info[port_no].state != Disabled)
431
                        &&
432
                        (port_info[port_no].state != Blocking)
433
        /* (4.6.13.3)    */
434
                ) {
435
                if ((port_info[port_no].state == Forwarding)
436
                                ||
437
                                (port_info[port_no].state == Learning)
438
                        ) {
439
                        topology_change_detection();    /* (4.6.13.3.1) */
440
                        /* (4.6.14.2.3)  */
441
                }
442
                set_port_state(port_no, Blocking);/* (4.6.13.3.2) */
443
                stop_forward_delay_timer(port_no);/* (4.6.13.3.3) */
444
        }
445
}
446
 
447
void set_port_state(int port_no, int state)
448
{
449
        port_info[port_no].state = state;
450
}
451
 
452
void received_config_bpdu(int port_no, Config_bpdu *config)               /* (4.7.1)     */
453
{
454
        int         root;
455
 
456
        root = root_bridge();
457
        if (port_info[port_no].state != Disabled) {
458
                if (supersedes_port_info(port_no, config)) {    /* (4.7.1.1)     *//* (4.
459
                                                                 * 6.2.2)        */
460
                        record_config_information(port_no, config);     /* (4.7.1.1.1)   */
461
                        /* (4.6.2.2)     */
462
                        configuration_update();   /* (4.7.1.1.2)         */
463
                        /* (4.6.7.2.1)   */
464
                        port_state_selection();   /* (4.7.1.1.3)         */
465
                        /* (4.6.11.2.1)  */
466
                        if ((!root_bridge()) && root) { /* (4.7.1.1.4)   */
467
                                stop_hello_timer();
468
                                if (bridge_info.top_change_detected) {  /* (4.7.1.1.5~ */
469
                                        stop_topology_change_timer();
470
                                        transmit_tcn(); /* (4.6.6.1)     */
471
                                        start_tcn_timer();
472
                                }
473
                        }
474
                        if (port_no == bridge_info.root_port) {
475
                                record_config_timeout_values(config);   /* (4.7.1.1.6)   */
476
                                /* (4.6.3.2)     */
477
                                config_bpdu_generation();       /* (4.6.4.2.1)   */
478
                                if (config->flags & TOPOLOGY_CHANGE_ACK) {      /* (4.7.1.1.7)    */
479
                                        topology_change_acknowledged(); /* (4.6.15.2)    */
480
                                }
481
                        }
482
                } else if (designated_port(port_no)) {  /* (4.7.1.2)     */
483
                        reply(port_no);           /* (4.7.1.2.1)         */
484
                        /* (4.6.5.2)     */
485
                }
486
        }
487
}
488
 
489
void received_tcn_bpdu(int port_no, Tcn_bpdu *tcn)                        /* (4.7.2)     */
490
{
491
        if (port_info[port_no].state != Disabled) {
492
                if (designated_port(port_no)) {
493
                        topology_change_detection();    /* (4.7.2.1)     */
494
                        /* (4.6.14.2.1)  */
495
                        acknowledge_topology_change(port_no);   /* (4.7.2.2)     */
496
                }                                 /* (4.6.16.2)  */
497
        }
498
}
499
 
500
void hello_timer_expiry(void)
501
{                                                 /* (4.7.3)     */
502
        config_bpdu_generation();                 /* (4.6.4.2.2)         */
503
        start_hello_timer();
504
}
505
 
506
void message_age_timer_expiry(int port_no)                /* (4.7.4)     */
507
{
508
        int         root;
509
        root = root_bridge();
510
 
511
        become_designated_port(port_no);          /* (4.7.4.1)   */
512
        /* (4.6.10.2.1)  */
513
        configuration_update();                   /* (4.7.4.2)   */
514
        /* (4.6.7.2.2)   */
515
        port_state_selection();                   /* (4.7.4.3)   */
516
        /* (4.6.11.2.2)  */
517
        if ((root_bridge()) && (!root)) {         /* (4.7.4.4)   */
518
 
519
                bridge_info.max_age = bridge_info.bridge_max_age;       /* (4.7.4.4.1)    */
520
                bridge_info.hello_time = bridge_info.bridge_hello_time;
521
                bridge_info.forward_delay = bridge_info.bridge_forward_delay;
522
                topology_change_detection();      /* (4.7.4.4.2)         */
523
                /* (4.6.14.2.4)  */
524
                stop_tcn_timer();                 /* (4.7.4.4.3)         */
525
                config_bpdu_generation();         /* (4.7.4.4.4)         */
526
                /* (4.6.4.4.3)   */
527
                start_hello_timer();
528
        }
529
}
530
 
531
void forward_delay_timer_expiry(int port_no)              /* (4.7.5)     */
532
{
533
        if (port_info[port_no].state == Listening) {    /* (4.7.5.1)     */
534
                set_port_state(port_no, Learning);      /* (4.7.5.1.1)   */
535
                start_forward_delay_timer(port_no);     /* (4.7.5.1.2)   */
536
        } else if (port_info[port_no].state == Learning) {      /* (4.7.5.2) */
537
                set_port_state(port_no, Forwarding);    /* (4.7.5.2.1) */
538
                if (designated_for_some_port()) { /* (4.7.5.2.2) */
539
                        topology_change_detection();    /* (4.6.14.2.2) */
540
 
541
                }
542
        }
543
}
544
 
545
int designated_for_some_port(void)
546
{
547
        int             port_no;
548
 
549
 
550
        for (port_no = One; port_no <= No_of_ports; port_no++) {
551
                if ((br_cmp(port_info[port_no].designated_bridge.BRIDGE_ID,
552
                                bridge_info.bridge_id.BRIDGE_ID) == 0)
553
                        ) {
554
                        return (TRUE);
555
                }
556
        }
557
        return (FALSE);
558
}
559
 
560
void tcn_timer_expiry(void)
561
{                                                 /* (4.7.6)     */
562
        transmit_tcn();                           /* (4.7.6.1)   */
563
        start_tcn_timer();                        /* (4.7.6.2)   */
564
}
565
 
566
void topology_change_timer_expiry(void)
567
{                                                 /* (4.7.7)     */
568
        bridge_info.top_change_detected = 0;
569
        bridge_info.top_change = 0;
570
          /* (4.7.7.2)   */
571
}
572
 
573
void hold_timer_expiry(int port_no)                       /* (4.7.8)     */
574
{
575
        if (port_info[port_no].config_pending) {
576
                transmit_config(port_no);         /* (4.7.8.1)   */
577
        }                                         /* (4.6.1.2.3)         */
578
}
579
 
580
void br_init(void)
581
{                                                 /* (4.8.1)     */
582
        int             port_no;
583
 
584
        printk(KERN_INFO "Ethernet Bridge 002 for NET3.035 (Linux 2.0)\n");
585
        bridge_info.designated_root = bridge_info.bridge_id;    /* (4.8.1.1)     */
586
        bridge_info.root_path_cost = Zero;
587
        bridge_info.root_port = No_port;
588
 
589
        bridge_info.bridge_max_age = BRIDGE_MAX_AGE;
590
        bridge_info.bridge_hello_time = BRIDGE_HELLO_TIME;
591
        bridge_info.bridge_forward_delay = BRIDGE_FORWARD_DELAY;
592
        bridge_info.hold_time = HOLD_TIME;
593
 
594
        bridge_info.max_age = bridge_info.bridge_max_age;       /* (4.8.1.2)     */
595
        bridge_info.hello_time = bridge_info.bridge_hello_time;
596
        bridge_info.forward_delay = bridge_info.bridge_forward_delay;
597
 
598
        bridge_info.top_change_detected = 0;
599
        bridge_info.top_change = 0;
600
        stop_tcn_timer();
601
        stop_topology_change_timer();
602
        for (port_no = One; port_no <= No_of_ports; port_no++) {        /* (4.8.1.4) */
603
                br_init_port(port_no);
604
                disable_port(port_no);
605
        }
606
        port_state_selection();                   /* (4.8.1.5)   */
607
        config_bpdu_generation();                 /* (4.8.1.6)   */
608
 
609
        /* initialize system timer */
610
        tl.expires = jiffies+HZ;        /* 1 second */
611
        tl.function = br_tick;
612
        add_timer(&tl);
613
 
614
        register_netdevice_notifier(&br_dev_notifier);
615
        br_stats.flags = 0; /*BR_UP | BR_DEBUG*/;        /* enable bridge */
616
        /*start_hello_timer();*/
617
}
618
 
619
void br_init_port(int port_no)
620
{
621
        become_designated_port(port_no);          /* (4.8.1.4.1) */
622
        set_port_state(port_no, Blocking);        /* (4.8.1.4.2)    */
623
        port_info[port_no].top_change_ack = 0;
624
        port_info[port_no].config_pending = FALSE;/* (4.8.1.4.4)         */
625
        stop_message_age_timer(port_no);          /* (4.8.1.4.5)         */
626
        stop_forward_delay_timer(port_no);        /* (4.8.1.4.6)         */
627
        stop_hold_timer(port_no);                 /* (4.8.1.4.7)         */
628
}
629
 
630
void enable_port(int port_no)                             /* (4.8.2)     */
631
{
632
        br_init_port(port_no);
633
        port_state_selection();                   /* (4.8.2.7)   */
634
}                                                 /* */
635
 
636
void disable_port(int port_no)                            /* (4.8.3)     */
637
{
638
        int         root;
639
 
640
        root = root_bridge();
641
        become_designated_port(port_no);          /* (4.8.3.1)   */
642
        set_port_state(port_no, Disabled);        /* (4.8.3.2)   */
643
        port_info[port_no].top_change_ack = 0;
644
        port_info[port_no].config_pending = FALSE;/* (4.8.3.4)   */
645
        stop_message_age_timer(port_no);          /* (4.8.3.5)   */
646
        stop_forward_delay_timer(port_no);        /* (4.8.3.6)   */
647
        configuration_update();
648
        port_state_selection();                   /* (4.8.3.7)   */
649
        if ((root_bridge()) && (!root)) {         /* (4.8.3.8)   */
650
                bridge_info.max_age = bridge_info.bridge_max_age;       /* (4.8.3.8.1)    */
651
                bridge_info.hello_time = bridge_info.bridge_hello_time;
652
                bridge_info.forward_delay = bridge_info.bridge_forward_delay;
653
                topology_change_detection();      /* (4.8.3.8.2)    */
654
                stop_tcn_timer();                 /* (4.8.3.8.3)    */
655
                config_bpdu_generation();         /* (4.8.3.8.4)    */
656
                start_hello_timer();
657
        }
658
}
659
 
660
 
661
void set_bridge_priority(bridge_id_t *new_bridge_id)              /* (4.8.4)     */
662
{
663
 
664
        int         root;
665
        int             port_no;
666
        root = root_bridge();
667
        for (port_no = One; port_no <= No_of_ports; port_no++) {        /* (4.8.4.2) */
668
                if (designated_port(port_no)) {
669
                        port_info[port_no].designated_bridge = *new_bridge_id;
670
                }
671
        }
672
 
673
        bridge_info.bridge_id = *new_bridge_id;   /* (4.8.4.3)   */
674
        configuration_update();                   /* (4.8.4.4)   */
675
        port_state_selection();                   /* (4.8.4.5)   */
676
        if ((root_bridge()) && (!root)) {         /* (4.8.4.6)   */
677
                bridge_info.max_age = bridge_info.bridge_max_age;       /* (4.8.4.6.1)    */
678
                bridge_info.hello_time = bridge_info.bridge_hello_time;
679
                bridge_info.forward_delay = bridge_info.bridge_forward_delay;
680
                topology_change_detection();      /* (4.8.4.6.2)    */
681
                stop_tcn_timer();                 /* (4.8.4.6.3)    */
682
                config_bpdu_generation(),         /* (4.8.4.6.4)    */
683
                start_hello_timer();
684
        }
685
}
686
 
687
void set_port_priority(int port_no, unsigned short new_port_id)           /* (4.8.5)     */
688
{
689
        if (designated_port(port_no)) {           /* (4.8.5.2)   */
690
                port_info[port_no].designated_port = new_port_id;
691
        }
692
        port_info[port_no].port_id = new_port_id; /* (4.8.5.3)   */
693
        if ((br_cmp(bridge_info.bridge_id.BRIDGE_ID,
694
             port_info[port_no].designated_bridge.BRIDGE_ID) == 0
695
             )
696
                        &&
697
                        (port_info[port_no].port_id
698
                         < port_info[port_no].designated_port
699
 
700
                         )
701
                ) {
702
                become_designated_port(port_no);  /* (4.8.5.4.1) */
703
                port_state_selection();           /* (4.8.5.4.2) */
704
        }
705
}
706
 
707
void set_path_cost(int port_no, unsigned short path_cost)                 /* (4.8.6)     */
708
{
709
        port_info[port_no].path_cost = path_cost; /* (4.8.6.1)   */
710
        configuration_update();                   /* (4.8.6.2)   */
711
        port_state_selection();                   /* (4.8.6.3)   */
712
}
713
 
714
static void br_tick(unsigned long arg)
715
{
716
        int             port_no;
717
 
718
        if (hello_timer_expired()) {
719
                hello_timer_expiry();
720
        }
721
        if (tcn_timer_expired()) {
722
                tcn_timer_expiry();
723
        }
724
        if (topology_change_timer_expired()) {
725
                topology_change_timer_expiry();
726
        }
727
        for (port_no = One; port_no <= No_of_ports; port_no++) {
728
                if (forward_delay_timer_expired(port_no)) {
729
                        forward_delay_timer_expiry(port_no);
730
                }
731
                if (message_age_timer_expired(port_no)) {
732
                        message_age_timer_expiry(port_no);
733
                }
734
                if (hold_timer_expired(port_no)) {
735
                        hold_timer_expiry(port_no);
736
                }
737
        }
738
        /* call me again sometime... */
739
        tl.expires = jiffies+HZ;        /* 1 second */
740
        tl.function = br_tick;
741
        add_timer(&tl);
742
}
743
 
744
void start_hello_timer(void)
745
{
746
        hello_timer.value = 0;
747
        hello_timer.active = TRUE;
748
}
749
 
750
void stop_hello_timer(void)
751
{
752
        hello_timer.active = FALSE;
753
}
754
 
755
int hello_timer_expired(void)
756
{
757
        if (hello_timer.active && (++hello_timer.value >= bridge_info.hello_time)) {
758
                hello_timer.active = FALSE;
759
                return (TRUE);
760
        }
761
        return (FALSE);
762
}
763
 
764
void start_tcn_timer(void)
765
{
766
        tcn_timer.value = 0;
767
        tcn_timer.active = TRUE;
768
}
769
 
770
void stop_tcn_timer(void)
771
{
772
        tcn_timer.active = FALSE;
773
}
774
 
775
int tcn_timer_expired(void)
776
{
777
        if (tcn_timer.active && (++tcn_timer.value >=
778
                                 bridge_info.bridge_hello_time)) {
779
                tcn_timer.active = FALSE;
780
                return (TRUE);
781
        }
782
        return (FALSE);
783
 
784
}
785
 
786
void start_topology_change_timer(void)
787
{
788
        topology_change_timer.value = 0;
789
        topology_change_timer.active = TRUE;
790
}
791
 
792
void stop_topology_change_timer(void)
793
{
794
        topology_change_timer.active = FALSE;
795
}
796
 
797
int topology_change_timer_expired(void)
798
{
799
        if (topology_change_timer.active
800
                        && (++topology_change_timer.value
801
                            >= bridge_info.topology_change_time
802
                            )) {
803
                topology_change_timer.active = FALSE;
804
                return (TRUE);
805
        }
806
        return (FALSE);
807
}
808
 
809
void start_message_age_timer(int port_no, unsigned short message_age)
810
{
811
        message_age_timer[port_no].value = message_age;
812
        message_age_timer[port_no].active = TRUE;
813
}
814
 
815
void stop_message_age_timer(int port_no)
816
{
817
        message_age_timer[port_no].active = FALSE;
818
}
819
 
820
int message_age_timer_expired(int port_no)
821
{
822
        if (message_age_timer[port_no].active &&
823
              (++message_age_timer[port_no].value >= bridge_info.max_age)) {
824
                message_age_timer[port_no].active = FALSE;
825
                return (TRUE);
826
        }
827
        return (FALSE);
828
}
829
 
830
void start_forward_delay_timer(int port_no)
831
{
832
        forward_delay_timer[port_no].value = 0;
833
        forward_delay_timer[port_no].active = TRUE;
834
}
835
 
836
void stop_forward_delay_timer(int port_no)
837
{
838
        forward_delay_timer[port_no].active = FALSE;
839
}
840
 
841
int forward_delay_timer_expired(int port_no)
842
{
843
                if (forward_delay_timer[port_no].active &&
844
                                (++forward_delay_timer[port_no].value >= bridge_info.forward_delay)) {
845
                        forward_delay_timer[port_no].active = FALSE;
846
                        return (TRUE);
847
                }
848
                return (FALSE);
849
}
850
 
851
void start_hold_timer(int port_no)
852
{
853
        hold_timer[port_no].value = 0;
854
        hold_timer[port_no].active = TRUE;
855
}
856
 
857
void stop_hold_timer(int port_no)
858
{
859
        hold_timer[port_no].active = FALSE;
860
}
861
 
862
 
863
int hold_timer_expired(int port_no)
864
{
865
        if (hold_timer[port_no].active &&
866
                   (++hold_timer[port_no].value >= bridge_info.hold_time)) {
867
                hold_timer[port_no].active = FALSE;
868
                return (TRUE);
869
        }
870
        return (FALSE);
871
 
872
}
873
 
874
int send_config_bpdu(int port_no, Config_bpdu *config_bpdu)
875
{
876
        struct sk_buff *skb;
877
        struct device *dev = port_info[port_no].dev;
878
        int size;
879
 
880
        if(!(br_stats.flags & BR_UP))
881
                return(-1); /* this should not happen but happens */
882
        if (port_info[port_no].state == Disabled) {
883
                printk(KERN_DEBUG "send_config_bpdu: port %i not valid\n",port_no);
884
                return(-1);
885
                }
886
        if (br_stats.flags & BR_DEBUG)
887
                printk("send_config_bpdu: ");
888
        /*
889
         * create and send the message
890
         */
891
        size = sizeof(Config_bpdu) + dev->hard_header_len;
892
        skb = alloc_skb(size, GFP_ATOMIC);
893
        if (skb == NULL) {
894
                printk(KERN_DEBUG "send_config_bpdu: no skb available\n");
895
                return(-1);
896
                }
897
        skb->dev = dev;
898
        skb->free = 1;
899
        skb->h.eth = (struct ethhdr *)skb_put(skb, size);
900
        memcpy(skb->h.eth->h_dest, bridge_ula, ETH_ALEN);
901
        memcpy(skb->h.eth->h_source, dev->dev_addr, ETH_ALEN);
902
        if (br_stats.flags & BR_DEBUG)
903
                printk("port %i src %02x:%02x:%02x:%02x:%02x:%02x\
904
                        dest %02x:%02x:%02x:%02x:%02x:%02x\n",
905
                        port_no,
906
                        skb->h.eth->h_source[0],
907
                        skb->h.eth->h_source[1],
908
                        skb->h.eth->h_source[2],
909
                        skb->h.eth->h_source[3],
910
                        skb->h.eth->h_source[4],
911
                        skb->h.eth->h_source[5],
912
                        skb->h.eth->h_dest[0],
913
                        skb->h.eth->h_dest[1],
914
                        skb->h.eth->h_dest[2],
915
                        skb->h.eth->h_dest[3],
916
                        skb->h.eth->h_dest[4],
917
                        skb->h.eth->h_dest[5]);
918
        skb->h.eth->h_proto = htonl(0x8038);    /* XXX verify */
919
 
920
        skb->h.raw += skb->dev->hard_header_len;
921
        memcpy(skb->h.raw, config_bpdu, sizeof(Config_bpdu));
922
 
923
        /* won't get bridged again... */
924
        skb->pkt_bridged = IS_BRIDGED;
925
        skb->arp = 1;   /* do not resolve... */
926
        skb->h.raw = skb->data + ETH_HLEN;
927
        dev_queue_xmit(skb, dev, SOPRI_INTERACTIVE);
928
        return(0);
929
}
930
 
931
int send_tcn_bpdu(int port_no, Tcn_bpdu *bpdu)
932
{
933
        struct sk_buff *skb;
934
        struct device *dev = port_info[port_no].dev;
935
        int size;
936
 
937
        if(!(br_stats.flags & BR_UP))
938
                return(-1); /* this should not happen but happens */
939
        if (port_info[port_no].state == Disabled) {
940
                printk(KERN_DEBUG "send_tcn_bpdu: port %i not valid\n",port_no);
941
                return(-1);
942
                }
943
        if (br_stats.flags & BR_DEBUG)
944
                printk("send_tcn_bpdu: ");
945
        size = sizeof(Tcn_bpdu) + dev->hard_header_len;
946
        skb = alloc_skb(size, GFP_ATOMIC);
947
        if (skb == NULL) {
948
                printk(KERN_DEBUG "send_tcn_bpdu: no skb available\n");
949
                return(-1);
950
                }
951
        skb->dev = dev;
952
        skb->free = 1;
953
        skb->h.eth = (struct ethhdr *)skb_put(skb,size);
954
        memcpy(skb->h.eth->h_dest, bridge_ula, ETH_ALEN);
955
        memcpy(skb->h.eth->h_source, dev->dev_addr, ETH_ALEN);
956
        if (br_stats.flags & BR_DEBUG)
957
                printk("port %i src %02x:%02x:%02x:%02x:%02x:%02x\
958
                        dest %02x:%02x:%02x:%02x:%02x:%02x\n",
959
                        port_no,
960
                        skb->h.eth->h_source[0],
961
                        skb->h.eth->h_source[1],
962
                        skb->h.eth->h_source[2],
963
                        skb->h.eth->h_source[3],
964
                        skb->h.eth->h_source[4],
965
                        skb->h.eth->h_source[5],
966
                        skb->h.eth->h_dest[0],
967
                        skb->h.eth->h_dest[1],
968
                        skb->h.eth->h_dest[2],
969
                        skb->h.eth->h_dest[3],
970
                        skb->h.eth->h_dest[4],
971
                        skb->h.eth->h_dest[5]);
972
        skb->h.eth->h_proto = 0x8038;   /* XXX verify */
973
 
974
        skb->h.raw += skb->dev->hard_header_len;
975
        memcpy(skb->h.raw, bpdu, sizeof(Tcn_bpdu));
976
 
977
        /* mark that's we've been here... */
978
        skb->pkt_bridged = IS_BRIDGED;
979
        skb->arp = 1;   /* do not resolve... */
980
        skb->h.raw = skb->data + ETH_HLEN;
981
 
982
        dev_queue_xmit(skb, dev, SOPRI_INTERACTIVE);
983
        return(0);
984
}
985
 
986
static int br_device_event(struct notifier_block *unused, unsigned long event, void *ptr)
987
{
988
        struct device *dev = ptr;
989
        int i;
990
 
991
        /* check for loopback devices */
992
        if (dev->flags & IFF_LOOPBACK)
993
                return(NOTIFY_DONE);
994
 
995
        switch (event) {
996
        case NETDEV_DOWN:
997
                if (br_stats.flags & BR_DEBUG)
998
                        printk("br_device_event: NETDEV_DOWN...\n");
999
                /* find our device and mark it down */
1000
                for (i = One; i <= No_of_ports; i++) {
1001
                        if (port_info[i].dev == dev) {
1002
                                disable_port(i);
1003
                                return NOTIFY_DONE;
1004
                                break;
1005
                        }
1006
                }
1007
                break;
1008
        case NETDEV_UP:
1009
                if (br_stats.flags & BR_DEBUG)
1010
                        printk("br_device_event: NETDEV_UP...\n");
1011
                /* Only handle ethernet ports */
1012
                if(dev->type!=ARPHRD_ETHER && dev->type!=ARPHRD_LOOPBACK)
1013
                        return NOTIFY_DONE;
1014
                /* look up an unused device and enable it */
1015
                for (i = One; i <= No_of_ports; i++) {
1016
                        if ((port_info[i].dev == (struct device *)0) ||
1017
                                (port_info[i].dev == dev)) {
1018
                                port_info[i].dev = dev;
1019
                                enable_port(i);
1020
                                set_path_cost(i, br_port_cost(dev));
1021
                                set_port_priority(i, 128);
1022
                                port_info[i].port_id = i;
1023
                                /* set bridge addr from 1st device addr */
1024
                                if ((bridge_info.bridge_id.BRIDGE_ID[0] == 0) &&
1025
                                                (bridge_info.bridge_id.BRIDGE_ID[1] == 0)) {
1026
                                        memcpy(bridge_info.bridge_id.BRIDGE_ID_ULA, dev->dev_addr, 6);
1027
                                        bridge_info.bridge_id.BRIDGE_PRIORITY = port_info[i].port_id;
1028
                                        set_bridge_priority(&bridge_info.bridge_id);
1029
                                }
1030
                                make_forwarding(i);
1031
                                return NOTIFY_DONE;
1032
                                break;
1033
                        }
1034
                }
1035
                break;
1036
#if 0
1037
        default:
1038
                printk("br_device_event: unknown event [%x]\n",
1039
                        (unsigned int)event);
1040
#endif                  
1041
        }
1042
        return NOTIFY_DONE;
1043
}
1044
 
1045
/*
1046
 * following routine is called when a frame is received
1047
 * from an interface, it returns 1 when it consumes the
1048
 * frame, 0 when it does not
1049
 */
1050
 
1051
int br_receive_frame(struct sk_buff *skb)       /* 3.5 */
1052
{
1053
        int port;
1054
 
1055
        if (br_stats.flags & BR_DEBUG)
1056
                printk("br_receive_frame: ");
1057
        /* sanity */
1058
        if (!skb) {
1059
                printk(KERN_CRIT "br_receive_frame: no skb!\n");
1060
                return(1);
1061
        }
1062
 
1063
        skb->pkt_bridged = IS_BRIDGED;
1064
 
1065
        /* check for loopback */
1066
        if (skb->dev->flags & IFF_LOOPBACK)
1067
                return(0);
1068
 
1069
        port = find_port(skb->dev);
1070
 
1071
        skb->arp = 1;           /* Received frame so it is resolved */
1072
        skb->h.raw = skb->mac.raw;
1073
        if (br_stats.flags & BR_DEBUG)
1074
                printk("port %i src %02x:%02x:%02x:%02x:%02x:%02x\
1075
                        dest %02x:%02x:%02x:%02x:%02x:%02x\n",
1076
                        port,
1077
                        skb->h.eth->h_source[0],
1078
                        skb->h.eth->h_source[1],
1079
                        skb->h.eth->h_source[2],
1080
                        skb->h.eth->h_source[3],
1081
                        skb->h.eth->h_source[4],
1082
                        skb->h.eth->h_source[5],
1083
                        skb->h.eth->h_dest[0],
1084
                        skb->h.eth->h_dest[1],
1085
                        skb->h.eth->h_dest[2],
1086
                        skb->h.eth->h_dest[3],
1087
                        skb->h.eth->h_dest[4],
1088
                        skb->h.eth->h_dest[5]);
1089
 
1090
        if (!port) {
1091
                if(br_stats.flags&BR_DEBUG)
1092
                        printk("\nbr_receive_frame: no port!\n");
1093
                return(0);
1094
        }
1095
 
1096
        switch (port_info[port].state)
1097
        {
1098
                case Learning:
1099
                        (void) br_learn(skb, port);     /* 3.8 */
1100
                        /* fall through */
1101
                case Listening:
1102
                        /* process BPDUs */
1103
                        if (memcmp(skb->h.eth->h_dest, bridge_ula, 6) == 0) {
1104
                                br_bpdu(skb);
1105
                                return(1); /* br_bpdu consumes skb */
1106
                        }
1107
                        /* fall through */
1108
                case Blocking:
1109
                        /* fall through */
1110
                case Disabled:
1111
                        /* should drop frames, but for now, we let
1112
                         * them get passed up to the next higher layer
1113
                        return(br_drop(skb));
1114
                         */
1115
                        return(0);       /* pass frame up stack */
1116
                        break;
1117
                case Forwarding:
1118
                        (void) br_learn(skb, port);     /* 3.8 */
1119
                        /* process BPDUs */
1120
                        if (memcmp(skb->h.eth->h_dest, bridge_ula,
1121
                                        ETH_ALEN) == 0)
1122
                        {
1123
                                /*printk("frame bpdu processor for me!!!\n");*/
1124
                                br_bpdu(skb);
1125
                                return(1); /* br_bpdu consumes skb */
1126
                        }
1127
                        /* is frame for me? */
1128
                        if (memcmp(skb->h.eth->h_dest,
1129
                                        port_info[port].dev->dev_addr,
1130
                                        ETH_ALEN) == 0)
1131
                        {
1132
                                /* Packet is for us */
1133
                                skb->pkt_type = PACKET_HOST;
1134
                                return(0);       /* pass frame up our stack (this will */
1135
                                                /* happen in net_bh() in dev.c) */
1136
                        }
1137
                        /* ok, forward this frame... */
1138
                        return(br_forward(skb, port));
1139
                default:
1140
                        printk(KERN_DEBUG "br_receive_frame: port [%i] unknown state [%i]\n",
1141
                                port, port_info[port].state);
1142
                        return(0);       /* pass frame up stack? */
1143
        }
1144
}
1145
 
1146
/*
1147
 * the following routine is called to transmit frames from the host
1148
 * stack.  it returns 1 when it consumes the frame and
1149
 * 0 when it does not.
1150
 */
1151
 
1152
int br_tx_frame(struct sk_buff *skb)    /* 3.5 */
1153
{
1154
        int port;
1155
 
1156
        /* sanity */
1157
        if (!skb)
1158
        {
1159
                printk(KERN_CRIT "br_tx_frame: no skb!\n");
1160
                return(0);
1161
        }
1162
 
1163
        if (!skb->dev)
1164
        {
1165
                printk(KERN_CRIT "br_tx_frame: no dev!\n");
1166
                return(0);
1167
        }
1168
 
1169
        /* check for loopback */
1170
        if (skb->dev->flags & IFF_LOOPBACK)
1171
                return(0);
1172
 
1173
        skb->h.raw = skb->data;
1174
        port = 0;        /* an impossible port */
1175
        if (br_stats.flags & BR_DEBUG)
1176
                printk("br_tx_fr : port %i src %02x:%02x:%02x:%02x:%02x:%02x\
1177
                        dest %02x:%02x:%02x:%02x:%02x:%02x\n",
1178
                        port,
1179
                        skb->h.eth->h_source[0],
1180
                        skb->h.eth->h_source[1],
1181
                        skb->h.eth->h_source[2],
1182
                        skb->h.eth->h_source[3],
1183
                        skb->h.eth->h_source[4],
1184
                        skb->h.eth->h_source[5],
1185
                        skb->h.eth->h_dest[0],
1186
                        skb->h.eth->h_dest[1],
1187
                        skb->h.eth->h_dest[2],
1188
                        skb->h.eth->h_dest[3],
1189
                        skb->h.eth->h_dest[4],
1190
                        skb->h.eth->h_dest[5]);
1191
        return(br_forward(skb, port));
1192
}
1193
 
1194
/*
1195
 * this routine returns 0 when it learns (or updates) from the
1196
 * frame, and -1 if the frame is simply discarded due to port
1197
 * state or lack of resources...
1198
 */
1199
 
1200
int br_learn(struct sk_buff *skb, int port)     /* 3.8 */
1201
{
1202
        struct fdb *f;
1203
 
1204
        switch (port_info[port].state) {
1205
                case Listening:
1206
                case Blocking:
1207
                case Disabled:
1208
                default:
1209
                        return(-1);
1210
                        /* break; */
1211
                case Learning:
1212
                case Forwarding:
1213
                        /* don't keep group addresses in the tree */
1214
                        if (skb->h.eth->h_source[0] & 0x01)
1215
                                return(-1);
1216
 
1217
                        f = (struct fdb *)kmalloc(sizeof(struct fdb),
1218
                                GFP_ATOMIC);
1219
 
1220
                        if (!f) {
1221
                                printk(KERN_DEBUG "br_learn: unable to malloc fdb\n");
1222
                                return(-1);
1223
                        }
1224
                        f->port = port; /* source port */
1225
                        memcpy(f->ula, skb->h.eth->h_source, 6);
1226
                        f->timer = CURRENT_TIME;
1227
                        f->flags = FDB_ENT_VALID;
1228
                        /*
1229
                         * add entity to AVL tree.  If entity already
1230
                         * exists in the tree, update the fields with
1231
                         * what we have here.
1232
                         */
1233
                        if (br_avl_insert(f) == 0) { /* update */
1234
                                kfree(f);
1235
                                return(0);
1236
                        }
1237
                        /* add to head of port chain */
1238
                        f->fdb_next = port_info[port].fdb;
1239
                        port_info[port].fdb = f;
1240
                        return(0);
1241
                        /* break */
1242
        }
1243
}
1244
 
1245
/*
1246
 * this routine always consumes the frame
1247
 */
1248
 
1249
int br_drop(struct sk_buff *skb)
1250
{
1251
        kfree_skb(skb, 0);
1252
        return(1);
1253
}
1254
 
1255
/*
1256
 * this routine always consumes the frame
1257
 */
1258
 
1259
int br_dev_drop(struct sk_buff *skb)
1260
{
1261
        dev_kfree_skb(skb, 0);
1262
        return(1);
1263
}
1264
 
1265
/*
1266
 * this routine returns 1 if it consumes the frame, 0
1267
 * if not...
1268
 */
1269
 
1270
int br_forward(struct sk_buff *skb, int port)   /* 3.7 */
1271
{
1272
        struct fdb *f;
1273
 
1274
        /*
1275
         * flood all ports with frames destined for a group
1276
         * address.  If frame came from above, drop it,
1277
         * otherwise it will be handled in br_receive_frame()
1278
         * Multicast frames will also need to be seen
1279
         * by our upper layers.
1280
         */
1281
        if (skb->h.eth->h_dest[0] & 0x01)
1282
        {
1283
                /* group address */
1284
                br_flood(skb, port);
1285
                /*
1286
                 *      External groups are fed out via the normal source
1287
                 *      This probably should be dropped since the flood will
1288
                 *      have sent it anyway.
1289
                 */
1290
                if (port == 0)                   /* locally generated */
1291
                        return(br_dev_drop(skb));
1292
                return(0);
1293
        } else {
1294
                /* locate port to forward to */
1295
                f = br_avl_find_addr(skb->h.eth->h_dest);
1296
                /*
1297
                 *      Send flood and drop.
1298
                 */
1299
                if (!f || !(f->flags & FDB_ENT_VALID)) {
1300
                        /* not found; flood all ports */
1301
                        br_flood(skb, port);
1302
                        return(br_dev_drop(skb));
1303
                }
1304
                /*
1305
                 *      Sending
1306
                 */
1307
 
1308
                /*
1309
                 * Vova Oksman: There was the BUG, we must to check timer
1310
                 * before comparing source and destination ports, becouse
1311
                 * case that destination was switched from same port with
1312
                 * source to other port.
1313
                 */
1314
                        /* has entry expired? */
1315
                if (port_info[f->port].state == Forwarding &&
1316
                    f->timer + fdb_aging_time < CURRENT_TIME) {
1317
                                /* timer expired, invalidate entry */
1318
                                f->flags &= ~FDB_ENT_VALID;
1319
                                if (br_stats.flags & BR_DEBUG)
1320
                                        printk("fdb entry expired...\n");
1321
                                /*
1322
                                 *      Send flood and drop original
1323
                                 */
1324
                                br_flood(skb, port);
1325
                                return(br_dev_drop(skb));
1326
                        }
1327
                if (f->port!=port && port_info[f->port].state == Forwarding) {
1328
                        /* mark that's we've been here... */
1329
                        skb->pkt_bridged = IS_BRIDGED;
1330
 
1331
                        /* reset the skb->ip pointer */
1332
                        skb->h.raw = skb->data + ETH_HLEN;
1333
 
1334
                        /*
1335
                         *      Send the buffer out.
1336
                         */
1337
 
1338
                        skb->dev=port_info[f->port].dev;
1339
 
1340
                        /*
1341
                         *      We send this still locked
1342
                         */
1343
                        dev_queue_xmit(skb, skb->dev,1);
1344
                        return(1);      /* skb has been consumed */
1345
                } else {
1346
                        /*
1347
                         *      Arrived on the right port, we discard
1348
                         */
1349
                        return(br_dev_drop(skb));
1350
                }
1351
        }
1352
}
1353
 
1354
/*
1355
 * this routine sends a copy of the frame to all forwarding ports
1356
 * with the exception of the port given.  This routine never
1357
 * consumes the original frame.
1358
 */
1359
 
1360
int br_flood(struct sk_buff *skb, int port)
1361
{
1362
        int i;
1363
        struct sk_buff *nskb;
1364
 
1365
        for (i = One; i <= No_of_ports; i++)
1366
        {
1367
                if (i == port)
1368
                        continue;
1369
                if (port_info[i].state == Forwarding)
1370
                {
1371
                        nskb = skb_clone(skb, GFP_ATOMIC);
1372
                        if(nskb==NULL)
1373
                                continue;
1374
                        /* mark that's we've been here... */
1375
                        nskb->pkt_bridged = IS_BRIDGED;
1376
                        /* Send to each port in turn */
1377
                        nskb->dev= port_info[i].dev;
1378
                        /* To get here we must have done ARP already,
1379
                           or have a received valid MAC header */
1380
                        nskb->arp = 1;
1381
 
1382
/*                      printk("Flood to port %d\n",i);*/
1383
                        nskb->h.raw = nskb->data + ETH_HLEN;
1384
                        dev_queue_xmit(nskb,nskb->dev,1);
1385
                }
1386
        }
1387
        return(0);
1388
}
1389
 
1390
int find_port(struct device *dev)
1391
{
1392
        int i;
1393
 
1394
        for (i = One; i <= No_of_ports; i++)
1395
                if ((port_info[i].dev == dev) &&
1396
                        (port_info[i].state != Disabled))
1397
                        return(i);
1398
        return(0);
1399
}
1400
 
1401
int br_port_cost(struct device *dev)    /* 4.10.2 */
1402
{
1403
        if (strncmp(dev->name, "eth", 3) == 0)   /* ethernet */
1404
                return(100);
1405
        if (strncmp(dev->name, "wic", 3) == 0)   /* wic */
1406
                return(1600);
1407
        if (strncmp(dev->name, "plip",4) == 0) /* plip */
1408
                return (1600);
1409
        return(100);    /* default */
1410
}
1411
 
1412
/*
1413
 * this routine always consumes the skb
1414
 */
1415
 
1416
void br_bpdu(struct sk_buff *skb) /* consumes skb */
1417
{
1418
        Tcn_bpdu *bpdu;
1419
        int port;
1420
 
1421
        port = find_port(skb->dev);
1422
        if (port == 0) { /* unknown port */
1423
                br_drop(skb);
1424
                return;
1425
        }
1426
 
1427
        bpdu = (Tcn_bpdu *) (skb->data + ETH_HLEN);
1428
        switch (bpdu->type) {
1429
                case BPDU_TYPE_CONFIG:
1430
                        received_config_bpdu(port, (Config_bpdu *)bpdu);
1431
                        break;
1432
                case BPDU_TYPE_TOPO_CHANGE:
1433
                        received_tcn_bpdu(port, bpdu);
1434
                        break;
1435
                default:
1436
                        printk(KERN_DEBUG "br_bpdu: received unknown bpdu, type = %i\n",
1437
                                bpdu->type);
1438
                        /* break; */
1439
        }
1440
        br_drop(skb);
1441
}
1442
 
1443
int br_ioctl(unsigned int cmd, void *arg)
1444
{
1445
        int err;
1446
        struct br_cf bcf;
1447
 
1448
        switch(cmd)
1449
        {
1450
                case SIOCGIFBR: /* get bridging control blocks */
1451
                        err = verify_area(VERIFY_WRITE, arg,
1452
                                sizeof(struct br_stat));
1453
                        if(err)
1454
                                return err;
1455
                        memcpy(&br_stats.bridge_data, &bridge_info, sizeof(Bridge_data));
1456
                        memcpy(&br_stats.port_data, &port_info, sizeof(Port_data)*No_of_ports);
1457
                        memcpy_tofs(arg, &br_stats, sizeof(struct br_stat));
1458
                        return(0);
1459
                case SIOCSIFBR:
1460
                        if (!suser())
1461
                                return -EPERM;
1462
                        err = verify_area(VERIFY_READ, arg,
1463
                                sizeof(struct br_cf));
1464
                        if(err)
1465
                                return err;
1466
                        memcpy_fromfs(&bcf, arg, sizeof(struct br_cf));
1467
                        switch (bcf.cmd) {
1468
                                case BRCMD_BRIDGE_ENABLE:
1469
                                        if (br_stats.flags & BR_UP)
1470
                                                return(-EALREADY);
1471
                                        printk(KERN_DEBUG "br: enabling bridging function\n");
1472
                                        br_stats.flags |= BR_UP;        /* enable bridge */
1473
                                        start_hello_timer();
1474
                                        break;
1475
                                case BRCMD_BRIDGE_DISABLE:
1476
                                        if (!(br_stats.flags & BR_UP))
1477
                                                return(-EALREADY);
1478
                                        printk(KERN_DEBUG "br: disabling bridging function\n");
1479
                                        br_stats.flags &= ~BR_UP;       /* disable bridge */
1480
                                        stop_hello_timer();
1481
#if 0                                   
1482
                                        for (i = One; i <= No_of_ports; i++)
1483
                                                if (port_info[i].state != Disabled)
1484
                                                        disable_port(i);
1485
#endif                                                  
1486
                                        break;
1487
                                case BRCMD_PORT_ENABLE:
1488
                                        if (port_info[bcf.arg1].dev == 0)
1489
                                                return(-EINVAL);
1490
                                        if (port_info[bcf.arg1].state != Disabled)
1491
                                                return(-EALREADY);
1492
                                        printk(KERN_DEBUG "br: enabling port %i\n",bcf.arg1);
1493
                                        enable_port(bcf.arg1);
1494
                                        break;
1495
                                case BRCMD_PORT_DISABLE:
1496
                                        if (port_info[bcf.arg1].dev == 0)
1497
                                                return(-EINVAL);
1498
                                        if (port_info[bcf.arg1].state == Disabled)
1499
                                                return(-EALREADY);
1500
                                        printk(KERN_DEBUG "br: disabling port %i\n",bcf.arg1);
1501
                                        disable_port(bcf.arg1);
1502
                                        break;
1503
                                case BRCMD_SET_BRIDGE_PRIORITY:
1504
                                        set_bridge_priority((bridge_id_t *)&bcf.arg1);
1505
                                        break;
1506
                                case BRCMD_SET_PORT_PRIORITY:
1507
                                        if (port_info[bcf.arg1].dev == 0)
1508
                                                return(-EINVAL);
1509
                                        set_port_priority(bcf.arg1, bcf.arg2);
1510
                                        break;
1511
                                case BRCMD_SET_PATH_COST:
1512
                                        if (port_info[bcf.arg1].dev == 0)
1513
                                                return(-EINVAL);
1514
                                        set_path_cost(bcf.arg1, bcf.arg2);
1515
                                        break;
1516
                                case BRCMD_ENABLE_DEBUG:
1517
                                        br_stats.flags |= BR_DEBUG;
1518
                                        break;
1519
                                case BRCMD_DISABLE_DEBUG:
1520
                                        br_stats.flags &= ~BR_DEBUG;
1521
                                        break;
1522
                                default:
1523
                                        return -EINVAL;
1524
                        }
1525
                        return(0);
1526
                default:
1527
                        return -EINVAL;
1528
        }
1529
        /*NOTREACHED*/
1530
        return 0;
1531
}
1532
 
1533
int br_cmp(unsigned int *a, unsigned int *b)
1534
{
1535
        int i;
1536
        for (i=0; i<2; i++)
1537
        {
1538
                if (a[i] == b[i])
1539
                        continue;
1540
                if (a[i] < b[i])
1541
                        return(1);
1542
                if (a[i] > b[i])
1543
                        return(-1);
1544
        }
1545
        return(0);
1546
}
1547
 

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.