ip175d.c revision 265767
1250386Sadrian/*- 2250386Sadrian * Copyright (c) 2013 Luiz Otavio O Souza. 3250386Sadrian * Copyright (c) 2011-2012 Stefan Bethke. 4250386Sadrian * Copyright (c) 2012 Adrian Chadd. 5250386Sadrian * Copyright (C) 2008 Patrick Horn. 6250386Sadrian * Copyright (C) 2008, 2010 Martin Mares. 7250386Sadrian * All rights reserved. 8250386Sadrian * 9250386Sadrian * Redistribution and use in source and binary forms, with or without 10250386Sadrian * modification, are permitted provided that the following conditions 11250386Sadrian * are met: 12250386Sadrian * 1. Redistributions of source code must retain the above copyright 13250386Sadrian * notice, this list of conditions and the following disclaimer. 14250386Sadrian * 2. Redistributions in binary form must reproduce the above copyright 15250386Sadrian * notice, this list of conditions and the following disclaimer in the 16250386Sadrian * documentation and/or other materials provided with the distribution. 17250386Sadrian * 18250386Sadrian * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19250386Sadrian * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20250386Sadrian * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21250386Sadrian * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22250386Sadrian * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23250386Sadrian * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24250386Sadrian * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25250386Sadrian * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26250386Sadrian * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27250386Sadrian * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28250386Sadrian * SUCH DAMAGE. 29250386Sadrian * 30250386Sadrian * $FreeBSD: head/sys/dev/etherswitch/ip17x/ip175d.c 265767 2014-05-09 13:07:39Z loos $ 31250386Sadrian */ 32250386Sadrian 33250386Sadrian#include <sys/param.h> 34250386Sadrian#include <sys/bus.h> 35250386Sadrian#include <sys/kernel.h> 36250386Sadrian#include <sys/lock.h> 37250386Sadrian#include <sys/mutex.h> 38250386Sadrian#include <sys/systm.h> 39250386Sadrian#include <sys/socket.h> 40250386Sadrian 41250386Sadrian#include <net/if.h> 42250386Sadrian 43250386Sadrian#include <dev/mii/mii.h> 44250386Sadrian 45250386Sadrian#include <dev/etherswitch/etherswitch.h> 46250386Sadrian#include <dev/etherswitch/ip17x/ip17x_phy.h> 47250386Sadrian#include <dev/etherswitch/ip17x/ip17x_reg.h> 48250386Sadrian#include <dev/etherswitch/ip17x/ip17x_var.h> 49250386Sadrian#include <dev/etherswitch/ip17x/ip17x_vlans.h> 50250386Sadrian#include <dev/etherswitch/ip17x/ip175d.h> 51250386Sadrian 52250386Sadrian/* 53250386Sadrian * IP175D specific functions. 54250386Sadrian */ 55250386Sadrian 56250386Sadrian/* 57250386Sadrian * Reset the switch to default state. 58250386Sadrian */ 59250386Sadrianstatic int 60250386Sadrianip175d_reset(struct ip17x_softc *sc) 61250386Sadrian{ 62250386Sadrian 63250386Sadrian /* Reset all the switch settings. */ 64250386Sadrian ip17x_writephy(sc->sc_dev, IP175D_RESET_PHY, IP175D_RESET_REG, 0x175d); 65265767Sloos DELAY(2000); 66250386Sadrian 67250386Sadrian /* Disable the special tagging mode. */ 68250386Sadrian ip17x_updatephy(sc->sc_dev, 21, 22, 0x3, 0x0); 69250386Sadrian 70250386Sadrian /* Set 802.1q protocol type. */ 71250386Sadrian ip17x_writephy(sc->sc_dev, 22, 3, 0x8100); 72250386Sadrian 73250386Sadrian return (0); 74250386Sadrian} 75250386Sadrian 76250386Sadrian/* 77250386Sadrian * Set the Switch configuration. 78250386Sadrian */ 79250386Sadrianstatic int 80250386Sadrianip175d_hw_setup(struct ip17x_softc *sc) 81250386Sadrian{ 82250386Sadrian struct ip17x_vlan *v; 83250386Sadrian uint32_t ports[IP17X_MAX_VLANS]; 84250386Sadrian uint32_t addtag[IP17X_MAX_VLANS]; 85250386Sadrian uint32_t striptag[IP17X_MAX_VLANS]; 86250386Sadrian uint32_t vlan_mask; 87250386Sadrian int i, j; 88250386Sadrian 89250386Sadrian vlan_mask = 0; 90250386Sadrian for (i = 0; i < IP17X_MAX_VLANS; i++) { 91250386Sadrian 92250386Sadrian ports[i] = 0; 93250386Sadrian addtag[i] = 0; 94250386Sadrian striptag[i] = 0; 95250386Sadrian 96250386Sadrian v = &sc->vlan[i]; 97253569Sloos if ((v->vlanid & ETHERSWITCH_VID_VALID) == 0 || 98253569Sloos sc->vlan_mode == 0) { 99250386Sadrian /* Vlangroup disabled. Reset the filter. */ 100250386Sadrian ip17x_writephy(sc->sc_dev, 22, 14 + i, i + 1); 101250386Sadrian ports[i] = 0x3f; 102250386Sadrian continue; 103250386Sadrian } 104250386Sadrian 105250386Sadrian vlan_mask |= (1 << i); 106250386Sadrian ports[i] = v->ports; 107250386Sadrian 108250386Sadrian /* Setup the filter, write the VLAN id. */ 109253569Sloos ip17x_writephy(sc->sc_dev, 22, 14 + i, 110253569Sloos v->vlanid & ETHERSWITCH_VID_MASK); 111250386Sadrian 112250386Sadrian for (j = 0; j < MII_NPHY; j++) { 113250386Sadrian if ((ports[i] & (1 << j)) == 0) 114250386Sadrian continue; 115250386Sadrian if (sc->addtag & (1 << j)) 116250386Sadrian addtag[i] |= (1 << j); 117250386Sadrian if (sc->striptag & (1 << j)) 118250386Sadrian striptag[i] |= (1 << j); 119250386Sadrian } 120250386Sadrian } 121250386Sadrian 122250386Sadrian /* Write the port masks, tag adds and removals. */ 123250386Sadrian for (i = 0; i < IP17X_MAX_VLANS / 2; i++) { 124250386Sadrian ip17x_writephy(sc->sc_dev, 23, i, 125250386Sadrian ports[2 * i] | (ports[2 * i + 1] << 8)); 126250386Sadrian ip17x_writephy(sc->sc_dev, 23, i + 8, 127250386Sadrian addtag[2 * i] | (addtag[2 * i + 1] << 8)); 128250386Sadrian ip17x_writephy(sc->sc_dev, 23, i + 16, 129250386Sadrian striptag[2 * i] | (striptag[2 * i + 1] << 8)); 130250386Sadrian } 131250386Sadrian 132250386Sadrian /* Write the in use vlan mask. */ 133250386Sadrian ip17x_writephy(sc->sc_dev, 22, 10, vlan_mask); 134250386Sadrian 135250386Sadrian /* Write the PVID of each port. */ 136250386Sadrian for (i = 0; i < sc->numports; i++) 137250386Sadrian ip17x_writephy(sc->sc_dev, 22, 4 + i, sc->pvid[i]); 138250386Sadrian 139250386Sadrian return (0); 140250386Sadrian} 141250386Sadrian 142250386Sadrian/* 143250386Sadrian * Set the switch VLAN mode. 144250386Sadrian */ 145250386Sadrianstatic int 146250386Sadrianip175d_set_vlan_mode(struct ip17x_softc *sc, uint32_t mode) 147250386Sadrian{ 148250386Sadrian 149250386Sadrian switch (mode) { 150250386Sadrian case ETHERSWITCH_VLAN_DOT1Q: 151250386Sadrian /* 152250386Sadrian * VLAN classification rules: tag-based VLANs, 153250386Sadrian * use VID to classify, drop packets that cannot 154250386Sadrian * be classified. 155250386Sadrian */ 156250386Sadrian ip17x_updatephy(sc->sc_dev, 22, 0, 0x3fff, 0x003f); 157250386Sadrian sc->vlan_mode = mode; 158250386Sadrian break; 159250386Sadrian case ETHERSWITCH_VLAN_PORT: 160250386Sadrian sc->vlan_mode = mode; 161250386Sadrian /* fallthrough */ 162250386Sadrian default: 163250386Sadrian /* 164250386Sadrian * VLAN classification rules: everything off & 165250386Sadrian * clear table. 166250386Sadrian */ 167250386Sadrian ip17x_updatephy(sc->sc_dev, 22, 0, 0xbfff, 0x8000); 168250386Sadrian sc->vlan_mode = 0; 169250386Sadrian break; 170250386Sadrian }; 171250386Sadrian 172250386Sadrian if (sc->vlan_mode != 0) { 173250386Sadrian /* 174250386Sadrian * Ingress rules: CFI=1 dropped, null VID is untagged, VID=1 passed, 175250386Sadrian * VID=0xfff discarded, admin both tagged and untagged, ingress 176250386Sadrian * filters enabled. 177250386Sadrian */ 178250386Sadrian ip17x_updatephy(sc->sc_dev, 22, 1, 0x0fff, 0x0c3f); 179250386Sadrian 180250386Sadrian /* Egress rules: IGMP processing off, keep VLAN header off. */ 181250386Sadrian ip17x_updatephy(sc->sc_dev, 22, 2, 0x0fff, 0x0000); 182250386Sadrian } else { 183250386Sadrian ip17x_updatephy(sc->sc_dev, 22, 1, 0x0fff, 0x043f); 184250386Sadrian ip17x_updatephy(sc->sc_dev, 22, 2, 0x0fff, 0x0020); 185250386Sadrian } 186250386Sadrian 187250386Sadrian /* Reset vlans. */ 188250386Sadrian ip17x_reset_vlans(sc, sc->vlan_mode); 189250386Sadrian 190250386Sadrian /* Update switch configuration. */ 191250386Sadrian ip175d_hw_setup(sc); 192250386Sadrian 193250386Sadrian return (0); 194250386Sadrian} 195250386Sadrian 196250386Sadrian/* 197250386Sadrian * Get the switch VLAN mode. 198250386Sadrian */ 199250386Sadrianstatic int 200250386Sadrianip175d_get_vlan_mode(struct ip17x_softc *sc) 201250386Sadrian{ 202250386Sadrian 203250386Sadrian return (sc->vlan_mode); 204250386Sadrian} 205250386Sadrian 206250386Sadrianvoid 207250386Sadrianip175d_attach(struct ip17x_softc *sc) 208250386Sadrian{ 209250386Sadrian 210250386Sadrian sc->hal.ip17x_reset = ip175d_reset; 211250386Sadrian sc->hal.ip17x_hw_setup = ip175d_hw_setup; 212250386Sadrian sc->hal.ip17x_get_vlan_mode = ip175d_get_vlan_mode; 213250386Sadrian sc->hal.ip17x_set_vlan_mode = ip175d_set_vlan_mode; 214250386Sadrian 215250386Sadrian /* Defaults for IP175C. */ 216250386Sadrian sc->cpuport = IP175X_CPU_PORT; 217250386Sadrian sc->numports = IP175X_NUM_PORTS; 218250386Sadrian sc->info.es_vlan_caps = ETHERSWITCH_VLAN_DOT1Q; 219250386Sadrian 220250386Sadrian device_printf(sc->sc_dev, "type: IP175D\n"); 221250386Sadrian} 222