1  | 
     | 
     | 
    /*	$OpenBSD: switch.c,v 1.3 2016/09/18 13:17:40 rzalamena Exp $	*/  | 
    
    
    2  | 
     | 
     | 
     | 
    
    
    3  | 
     | 
     | 
    /*  | 
    
    
    4  | 
     | 
     | 
     * Copyright (c) 2013-2016 Reyk Floeter <reyk@openbsd.org>  | 
    
    
    5  | 
     | 
     | 
     *  | 
    
    
    6  | 
     | 
     | 
     * Permission to use, copy, modify, and distribute this software for any  | 
    
    
    7  | 
     | 
     | 
     * purpose with or without fee is hereby granted, provided that the above  | 
    
    
    8  | 
     | 
     | 
     * copyright notice and this permission notice appear in all copies.  | 
    
    
    9  | 
     | 
     | 
     *  | 
    
    
    10  | 
     | 
     | 
     * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES  | 
    
    
    11  | 
     | 
     | 
     * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF  | 
    
    
    12  | 
     | 
     | 
     * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR  | 
    
    
    13  | 
     | 
     | 
     * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES  | 
    
    
    14  | 
     | 
     | 
     * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN  | 
    
    
    15  | 
     | 
     | 
     * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF  | 
    
    
    16  | 
     | 
     | 
     * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.  | 
    
    
    17  | 
     | 
     | 
     */  | 
    
    
    18  | 
     | 
     | 
     | 
    
    
    19  | 
     | 
     | 
    #include <sys/types.h>  | 
    
    
    20  | 
     | 
     | 
    #include <sys/queue.h>  | 
    
    
    21  | 
     | 
     | 
    #include <sys/tree.h>  | 
    
    
    22  | 
     | 
     | 
    #include <sys/socket.h>  | 
    
    
    23  | 
     | 
     | 
    #include <sys/uio.h>  | 
    
    
    24  | 
     | 
     | 
     | 
    
    
    25  | 
     | 
     | 
    #include <stdio.h>  | 
    
    
    26  | 
     | 
     | 
    #include <stdlib.h>  | 
    
    
    27  | 
     | 
     | 
    #include <string.h>  | 
    
    
    28  | 
     | 
     | 
    #include <imsg.h>  | 
    
    
    29  | 
     | 
     | 
    #include <event.h>  | 
    
    
    30  | 
     | 
     | 
     | 
    
    
    31  | 
     | 
     | 
    #include "switchd.h"  | 
    
    
    32  | 
     | 
     | 
     | 
    
    
    33  | 
     | 
     | 
    void	 switch_timer(struct switchd *, void *);  | 
    
    
    34  | 
     | 
     | 
     | 
    
    
    35  | 
     | 
     | 
    static __inline int  | 
    
    
    36  | 
     | 
     | 
    	 switch_cmp(struct switch_control *, struct switch_control *);  | 
    
    
    37  | 
     | 
     | 
    static __inline int  | 
    
    
    38  | 
     | 
     | 
    	 switch_maccmp(struct macaddr *, struct macaddr *);  | 
    
    
    39  | 
     | 
     | 
     | 
    
    
    40  | 
     | 
     | 
    void  | 
    
    
    41  | 
     | 
     | 
    switch_init(struct switchd *sc)  | 
    
    
    42  | 
     | 
     | 
    { | 
    
    
    43  | 
     | 
     | 
    	RB_INIT(&sc->sc_switches);  | 
    
    
    44  | 
     | 
     | 
    }  | 
    
    
    45  | 
     | 
     | 
     | 
    
    
    46  | 
     | 
     | 
    int  | 
    
    
    47  | 
     | 
     | 
    switch_dispatch_control(int fd, struct privsep_proc *p, struct imsg *imsg)  | 
    
    
    48  | 
     | 
     | 
    { | 
    
    
    49  | 
     | 
     | 
    	struct privsep		*ps = p->p_ps;  | 
    
    
    50  | 
     | 
     | 
    	struct switchd		*sc = ps->ps_env;  | 
    
    
    51  | 
     | 
     | 
    	struct switch_control	*sw;  | 
    
    
    52  | 
     | 
     | 
    	struct macaddr		*mac;  | 
    
    
    53  | 
     | 
     | 
    	struct iovec		 iov[2];  | 
    
    
    54  | 
     | 
     | 
     | 
    
    
    55  | 
     | 
     | 
    	switch (imsg->hdr.type) { | 
    
    
    56  | 
     | 
     | 
    	case IMSG_CTL_SHOW_SUM:  | 
    
    
    57  | 
     | 
     | 
    		IMSG_SIZE_CHECK(imsg, &fd);  | 
    
    
    58  | 
     | 
     | 
     | 
    
    
    59  | 
     | 
     | 
    		RB_FOREACH(sw, switch_head, &sc->sc_switches) { | 
    
    
    60  | 
     | 
     | 
    			iov[0].iov_base = imsg->data;  | 
    
    
    61  | 
     | 
     | 
    			iov[0].iov_len = IMSG_DATA_SIZE(imsg);  | 
    
    
    62  | 
     | 
     | 
    			iov[1].iov_base = sw;  | 
    
    
    63  | 
     | 
     | 
    			iov[1].iov_len = sizeof(*sw);  | 
    
    
    64  | 
     | 
     | 
     | 
    
    
    65  | 
     | 
     | 
    			proc_composev(ps, PROC_CONTROL,  | 
    
    
    66  | 
     | 
     | 
    			    IMSG_CTL_SWITCH, iov, 2);  | 
    
    
    67  | 
     | 
     | 
     | 
    
    
    68  | 
     | 
     | 
    			RB_FOREACH(mac, macaddr_head, &sw->sw_addrcache) { | 
    
    
    69  | 
     | 
     | 
    				iov[0].iov_base = imsg->data;  | 
    
    
    70  | 
     | 
     | 
    				iov[0].iov_len = IMSG_DATA_SIZE(imsg);  | 
    
    
    71  | 
     | 
     | 
    				iov[1].iov_base = mac;  | 
    
    
    72  | 
     | 
     | 
    				iov[1].iov_len = sizeof(*mac);  | 
    
    
    73  | 
     | 
     | 
     | 
    
    
    74  | 
     | 
     | 
    				proc_composev(ps, PROC_CONTROL,  | 
    
    
    75  | 
     | 
     | 
    				    IMSG_CTL_MAC, iov, 2);  | 
    
    
    76  | 
     | 
     | 
    			}  | 
    
    
    77  | 
     | 
     | 
    		}  | 
    
    
    78  | 
     | 
     | 
     | 
    
    
    79  | 
     | 
     | 
    		proc_compose(ps, PROC_CONTROL,  | 
    
    
    80  | 
     | 
     | 
    		    IMSG_CTL_END, imsg->data, IMSG_DATA_SIZE(imsg));  | 
    
    
    81  | 
     | 
     | 
    		return (0);  | 
    
    
    82  | 
     | 
     | 
    	default:  | 
    
    
    83  | 
     | 
     | 
    		break;  | 
    
    
    84  | 
     | 
     | 
    	}  | 
    
    
    85  | 
     | 
     | 
     | 
    
    
    86  | 
     | 
     | 
    	return (-1);  | 
    
    
    87  | 
     | 
     | 
    }  | 
    
    
    88  | 
     | 
     | 
     | 
    
    
    89  | 
     | 
     | 
    struct switch_control *  | 
    
    
    90  | 
     | 
     | 
    switch_get(struct switch_connection *con)  | 
    
    
    91  | 
     | 
     | 
    { | 
    
    
    92  | 
     | 
     | 
    	struct switchd		*sc = con->con_sc;  | 
    
    
    93  | 
     | 
     | 
    	struct switch_control	 key;  | 
    
    
    94  | 
     | 
     | 
     | 
    
    
    95  | 
     | 
     | 
    	memcpy(&key.sw_addr, &con->con_peer, sizeof(key.sw_addr));  | 
    
    
    96  | 
     | 
     | 
     | 
    
    
    97  | 
     | 
     | 
    	con->con_switch = RB_FIND(switch_head, &sc->sc_switches, &key);  | 
    
    
    98  | 
     | 
     | 
    	return (con->con_switch);  | 
    
    
    99  | 
     | 
     | 
    }  | 
    
    
    100  | 
     | 
     | 
     | 
    
    
    101  | 
     | 
     | 
    struct switch_control *  | 
    
    
    102  | 
     | 
     | 
    switch_add(struct switch_connection *con)  | 
    
    
    103  | 
     | 
     | 
    { | 
    
    
    104  | 
     | 
     | 
    	struct switchd		*sc = con->con_sc;  | 
    
    
    105  | 
     | 
     | 
    	struct switch_control	*sw, *oldsw;  | 
    
    
    106  | 
     | 
     | 
    	static unsigned int	 id = 0;  | 
    
    
    107  | 
     | 
     | 
     | 
    
    
    108  | 
     | 
     | 
    	/* Connection already has an associated switch */  | 
    
    
    109  | 
     | 
     | 
    	if (con->con_switch != NULL)  | 
    
    
    110  | 
     | 
     | 
    		return (NULL);  | 
    
    
    111  | 
     | 
     | 
     | 
    
    
    112  | 
     | 
     | 
    	if ((sw = calloc(1, sizeof(*sw))) == NULL)  | 
    
    
    113  | 
     | 
     | 
    		return (NULL);  | 
    
    
    114  | 
     | 
     | 
     | 
    
    
    115  | 
     | 
     | 
    	memcpy(&sw->sw_addr, &con->con_peer, sizeof(sw->sw_addr));  | 
    
    
    116  | 
     | 
     | 
    	sw->sw_id = ++id;  | 
    
    
    117  | 
     | 
     | 
    	RB_INIT(&sw->sw_addrcache);  | 
    
    
    118  | 
     | 
     | 
     | 
    
    
    119  | 
     | 
     | 
    	if ((oldsw =  | 
    
    
    120  | 
     | 
     | 
    	    RB_INSERT(switch_head, &sc->sc_switches, sw)) != NULL) { | 
    
    
    121  | 
     | 
     | 
    		free(sw);  | 
    
    
    122  | 
     | 
     | 
    		sw = oldsw;  | 
    
    
    123  | 
     | 
     | 
    	} else { | 
    
    
    124  | 
     | 
     | 
    		timer_set(sc, &sw->sw_timer, switch_timer, sw);  | 
    
    
    125  | 
     | 
     | 
    		timer_add(sc, &sw->sw_timer, sc->sc_cache_timeout);  | 
    
    
    126  | 
     | 
     | 
    	}  | 
    
    
    127  | 
     | 
     | 
     | 
    
    
    128  | 
     | 
     | 
    	con->con_switch = sw;  | 
    
    
    129  | 
     | 
     | 
    	return (con->con_switch);  | 
    
    
    130  | 
     | 
     | 
    }  | 
    
    
    131  | 
     | 
     | 
     | 
    
    
    132  | 
     | 
     | 
    void  | 
    
    
    133  | 
     | 
     | 
    switch_timer(struct switchd *sc, void *arg)  | 
    
    
    134  | 
     | 
     | 
    { | 
    
    
    135  | 
     | 
     | 
    	struct switch_control	*sw = arg;  | 
    
    
    136  | 
     | 
     | 
    	struct macaddr		*mac, *next;  | 
    
    
    137  | 
     | 
     | 
    	struct timeval		 tv;  | 
    
    
    138  | 
     | 
     | 
    	unsigned int		 cnt = 0;  | 
    
    
    139  | 
     | 
     | 
     | 
    
    
    140  | 
     | 
     | 
    	getmonotime(&tv);  | 
    
    
    141  | 
     | 
     | 
     | 
    
    
    142  | 
     | 
     | 
    	for (mac = RB_MIN(macaddr_head, &sw->sw_addrcache);  | 
    
    
    143  | 
     | 
     | 
    	    mac != NULL; mac = next) { | 
    
    
    144  | 
     | 
     | 
    		next = RB_NEXT(macaddr_head, &sw->sw_addrcache, mac);  | 
    
    
    145  | 
     | 
     | 
     | 
    
    
    146  | 
     | 
     | 
    		/* Simple monotonic timeout */  | 
    
    
    147  | 
     | 
     | 
    		if ((tv.tv_sec - mac->mac_age) >= sc->sc_cache_timeout) { | 
    
    
    148  | 
     | 
     | 
    			RB_REMOVE(macaddr_head, &sw->sw_addrcache, mac);  | 
    
    
    149  | 
     | 
     | 
    			sw->sw_cachesize--;  | 
    
    
    150  | 
     | 
     | 
    			free(mac);  | 
    
    
    151  | 
     | 
     | 
    			cnt++;  | 
    
    
    152  | 
     | 
     | 
    		}  | 
    
    
    153  | 
     | 
     | 
    	}  | 
    
    
    154  | 
     | 
     | 
    	if (cnt)  | 
    
    
    155  | 
     | 
     | 
    		log_debug("%s: flushed %d mac from switch %u after timeout", | 
    
    
    156  | 
     | 
     | 
    		    __func__, cnt, sw->sw_id);  | 
    
    
    157  | 
     | 
     | 
     | 
    
    
    158  | 
     | 
     | 
    	timer_add(sc, &sw->sw_timer, sc->sc_cache_timeout);  | 
    
    
    159  | 
     | 
     | 
    }  | 
    
    
    160  | 
     | 
     | 
     | 
    
    
    161  | 
     | 
     | 
    void  | 
    
    
    162  | 
     | 
     | 
    switch_remove(struct switchd *sc, struct switch_control *sw)  | 
    
    
    163  | 
     | 
     | 
    { | 
    
    
    164  | 
     | 
     | 
    	struct macaddr	*mac, *next;  | 
    
    
    165  | 
     | 
     | 
     | 
    
    
    166  | 
     | 
     | 
    	if (sw == NULL)  | 
    
    
    167  | 
     | 
     | 
    		return;  | 
    
    
    168  | 
     | 
     | 
     | 
    
    
    169  | 
     | 
     | 
    	timer_del(sc, &sw->sw_timer);  | 
    
    
    170  | 
     | 
     | 
     | 
    
    
    171  | 
     | 
     | 
    	for (mac = RB_MIN(macaddr_head, &sw->sw_addrcache);  | 
    
    
    172  | 
     | 
     | 
    	    mac != NULL; mac = next) { | 
    
    
    173  | 
     | 
     | 
    		next = RB_NEXT(macaddr_head, &sw->sw_addrcache, mac);  | 
    
    
    174  | 
     | 
     | 
    		RB_REMOVE(macaddr_head, &sw->sw_addrcache, mac);  | 
    
    
    175  | 
     | 
     | 
    		sw->sw_cachesize--;  | 
    
    
    176  | 
     | 
     | 
    		free(mac);  | 
    
    
    177  | 
     | 
     | 
    	}  | 
    
    
    178  | 
     | 
     | 
    	RB_REMOVE(switch_head, &sc->sc_switches, sw);  | 
    
    
    179  | 
     | 
     | 
     | 
    
    
    180  | 
     | 
     | 
    	log_debug("%s: switch %u removed", __func__, sw->sw_id); | 
    
    
    181  | 
     | 
     | 
     | 
    
    
    182  | 
     | 
     | 
    	free(sw);  | 
    
    
    183  | 
     | 
     | 
    }  | 
    
    
    184  | 
     | 
     | 
     | 
    
    
    185  | 
     | 
     | 
    struct macaddr *  | 
    
    
    186  | 
     | 
     | 
    switch_learn(struct switchd *sc, struct switch_control *sw,  | 
    
    
    187  | 
     | 
     | 
        uint8_t *ea, uint32_t port)  | 
    
    
    188  | 
     | 
     | 
    { | 
    
    
    189  | 
     | 
     | 
    	struct macaddr	*mac, *oldmac = NULL;  | 
    
    
    190  | 
     | 
     | 
    	struct timeval	 tv;  | 
    
    
    191  | 
     | 
     | 
     | 
    
    
    192  | 
     | 
     | 
    	if ((mac = oldmac = switch_cached(sw, ea)) != NULL)  | 
    
    
    193  | 
     | 
     | 
    		goto update;  | 
    
    
    194  | 
     | 
     | 
     | 
    
    
    195  | 
     | 
     | 
    	if (sw->sw_cachesize >= sc->sc_cache_max)  | 
    
    
    196  | 
     | 
     | 
    		return (NULL);  | 
    
    
    197  | 
     | 
     | 
     | 
    
    
    198  | 
     | 
     | 
    	if ((mac = calloc(1, sizeof(*mac))) == NULL)  | 
    
    
    199  | 
     | 
     | 
    		return (NULL);  | 
    
    
    200  | 
     | 
     | 
     | 
    
    
    201  | 
     | 
     | 
    	memcpy(&mac->mac_addr, ea, sizeof(mac->mac_addr));  | 
    
    
    202  | 
     | 
     | 
     | 
    
    
    203  | 
     | 
     | 
    	if (RB_INSERT(macaddr_head, &sw->sw_addrcache, mac) != NULL)  | 
    
    
    204  | 
     | 
     | 
    		fatalx("cache corrupted"); | 
    
    
    205  | 
     | 
     | 
    	sw->sw_cachesize++;  | 
    
    
    206  | 
     | 
     | 
     | 
    
    
    207  | 
     | 
     | 
     update:  | 
    
    
    208  | 
     | 
     | 
    	getmonotime(&tv);  | 
    
    
    209  | 
     | 
     | 
    	mac->mac_port = port;  | 
    
    
    210  | 
     | 
     | 
    	mac->mac_age = tv.tv_sec;  | 
    
    
    211  | 
     | 
     | 
     | 
    
    
    212  | 
     | 
     | 
    	log_debug("%s: %s mac %s on switch %u port %u", | 
    
    
    213  | 
     | 
     | 
    	    __func__, oldmac == NULL ? "learned new" : "updated",  | 
    
    
    214  | 
     | 
     | 
    	    print_ether(ea), sw->sw_id, port);  | 
    
    
    215  | 
     | 
     | 
     | 
    
    
    216  | 
     | 
     | 
    	return (mac);  | 
    
    
    217  | 
     | 
     | 
    }  | 
    
    
    218  | 
     | 
     | 
     | 
    
    
    219  | 
     | 
     | 
    struct macaddr *  | 
    
    
    220  | 
     | 
     | 
    switch_cached(struct switch_control *sw, uint8_t *ea)  | 
    
    
    221  | 
     | 
     | 
    { | 
    
    
    222  | 
     | 
     | 
    	struct macaddr	 key;  | 
    
    
    223  | 
     | 
     | 
    	memcpy(&key.mac_addr, ea, sizeof(key.mac_addr));  | 
    
    
    224  | 
     | 
     | 
    	return (RB_FIND(macaddr_head, &sw->sw_addrcache, &key));  | 
    
    
    225  | 
     | 
     | 
    }  | 
    
    
    226  | 
     | 
     | 
     | 
    
    
    227  | 
     | 
     | 
    static __inline int  | 
    
    
    228  | 
     | 
     | 
    switch_cmp(struct switch_control *a, struct switch_control *b)  | 
    
    
    229  | 
     | 
     | 
    { | 
    
    
    230  | 
     | 
     | 
    	int		diff = 0;  | 
    
    
    231  | 
     | 
     | 
     | 
    
    
    232  | 
     | 
     | 
    	diff = sockaddr_cmp((struct sockaddr *)&a->sw_addr,  | 
    
    
    233  | 
     | 
     | 
    	    (struct sockaddr *)&b->sw_addr, 128);  | 
    
    
    234  | 
     | 
     | 
    	if (!diff)  | 
    
    
    235  | 
     | 
     | 
    		diff = socket_getport(&a->sw_addr) -  | 
    
    
    236  | 
     | 
     | 
    		    socket_getport(&b->sw_addr);  | 
    
    
    237  | 
     | 
     | 
     | 
    
    
    238  | 
     | 
     | 
    	return (diff);  | 
    
    
    239  | 
     | 
     | 
    }  | 
    
    
    240  | 
     | 
     | 
     | 
    
    
    241  | 
     | 
     | 
    static __inline int  | 
    
    
    242  | 
     | 
     | 
    switch_maccmp(struct macaddr *a, struct macaddr *b)  | 
    
    
    243  | 
     | 
     | 
    { | 
    
    
    244  | 
     | 
     | 
    	return (memcmp(a->mac_addr, b->mac_addr, sizeof(a->mac_addr)));  | 
    
    
    245  | 
     | 
     | 
    }  | 
    
    
    246  | 
     | 
     | 
     | 
    
    
    247  | 
     | 
     | 
    RB_GENERATE(switch_head, switch_control, sw_entry, switch_cmp);  | 
    
    
    248  | 
     | 
     | 
    RB_GENERATE(macaddr_head, macaddr, mac_entry, switch_maccmp);  |