sys/dev/etherswitch/ip17x/ip175c.c

   1 /*-
   2  * Copyright (c) 2013 Luiz Otavio O Souza.
   3  * Copyright (c) 2011-2012 Stefan Bethke.
   4  * Copyright (c) 2012 Adrian Chadd.
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  26  * SUCH DAMAGE.
  27  *
  28  * $FreeBSD$
  29  */
  30
  31 #include <sys/param.h>
  32 #include <sys/bus.h>
  33 #include <sys/kernel.h>
  34 #include <sys/lock.h>
  35 #include <sys/mutex.h>
  36 #include <sys/systm.h>
  37 #include <sys/socket.h>
  38
  39 #include <net/if.h>
  40
  41 #include <dev/mii/mii.h>
  42
  43 #include <dev/etherswitch/etherswitch.h>
  44 #include <dev/etherswitch/ip17x/ip17x_phy.h>
  45 #include <dev/etherswitch/ip17x/ip17x_reg.h>
  46 #include <dev/etherswitch/ip17x/ip17x_var.h>
  47 #include <dev/etherswitch/ip17x/ip17x_vlans.h>
  48 #include <dev/etherswitch/ip17x/ip175c.h>
  49
  50 /*
  51  * IP175C specific functions.
  52  */
  53
  54 /*
  55  * Reset the switch.
  56  */
  57 static int
  58 ip175c_reset(struct ip17x_softc *sc)
  59 {
  60         uint32_t data;
  61
  62         /* Reset all the switch settings. */
  63         if (ip17x_writephy(sc->sc_dev, IP175C_RESET_PHY, IP175C_RESET_REG,
  64             0x175c))
  65                 return (-1);
  66         DELAY(2);
  67
  68         /* Force IP175C mode. */
  69         data = ip17x_readphy(sc->sc_dev, IP175C_MODE_PHY, IP175C_MODE_REG);
  70         if (data == 0x175a) {
  71                 if (ip17x_writephy(sc->sc_dev, IP175C_MODE_PHY, IP175C_MODE_REG,
  72                     0x175c))
  73                 return (-1);
  74         }
  75
  76         return (0);
  77 }
  78
  79 static int
  80 ip175c_port_vlan_setup(struct ip17x_softc *sc)
  81 {
  82         struct ip17x_vlan *v;
  83         uint32_t ports[IP175X_NUM_PORTS], reg[IP175X_NUM_PORTS/2];
  84         int i, err, phy;
  85
  86         KASSERT(sc->cpuport == 5, ("cpuport != 5 not supported for IP175C"));
  87         KASSERT(sc->numports == 6, ("numports != 6 not supported for IP175C"));
  88
  89         /* Build the port access masks. */
  90         memset(ports, 0, sizeof(ports));
  91         for (i = 0; i < sc->info.es_nports; i++) {
  92                 phy = sc->portphy[i];
  93                 v = &sc->vlan[i];
  94                 ports[phy] = v->ports;
  95         }
  96
  97         /* Move the cpuport bit to its correct place. */
  98         for (i = 0; i < sc->numports; i++) {
  99                 if (ports[i] & (1 << sc->cpuport)) {
 100                         ports[i] |= (1 << 7);
 101                         ports[i] &= ~(1 << sc->cpuport);
 102                 }
 103         }
 104
 105         /* And now build the switch register data. */
 106         memset(reg, 0, sizeof(reg));
 107         for (i = 0; i < (sc->numports / 2); i++)
 108                 reg[i] = ports[i * 2] << 8 | ports[i * 2 + 1];
 109
 110         /* Update the switch resgisters. */
 111         err = ip17x_writephy(sc->sc_dev, 29, 19, reg[0]);
 112         if (err == 0)
 113                 err = ip17x_writephy(sc->sc_dev, 29, 20, reg[1]);
 114         if (err == 0)
 115                 err = ip17x_updatephy(sc->sc_dev, 29, 21, 0xff00, reg[2]);
 116         if (err == 0)
 117                 err = ip17x_updatephy(sc->sc_dev, 30, 18, 0x00ff, reg[2]);
 118         return (err);
 119 }
 120
 121 static int
 122 ip175c_dot1q_vlan_setup(struct ip17x_softc *sc)
 123 {
 124         struct ip17x_vlan *v;
 125         uint32_t data;
 126         uint32_t vlans[IP17X_MAX_VLANS];
 127         int i, j;
 128
 129         KASSERT(sc->cpuport == 5, ("cpuport != 5 not supported for IP175C"));
 130         KASSERT(sc->numports == 6, ("numports != 6 not supported for IP175C"));
 131
 132         /* Add and strip VLAN tags. */
 133         data = (sc->addtag & ~(1 << IP175X_CPU_PORT)) << 11;
 134         data |= (sc->striptag & ~(1 << IP175X_CPU_PORT)) << 6;
 135         if (sc->addtag & (1 << IP175X_CPU_PORT))
 136                 data |= (1 << 1);
 137         if (sc->striptag & (1 << IP175X_CPU_PORT))
 138                 data |= (1 << 0);
 139         if (ip17x_writephy(sc->sc_dev, 29, 23, data))
 140                 return (-1);
 141
 142         /* Set the VID_IDX_SEL to 0. */
 143         if (ip17x_updatephy(sc->sc_dev, 30, 9, 0x70, 0))
 144                 return (-1);
 145
 146         /* Calculate the port masks. */
 147         memset(vlans, 0, sizeof(vlans));
 148         for (i = 0; i < IP17X_MAX_VLANS; i++) {
 149                 v = &sc->vlan[i];
 150                 if ((v->vlanid & ETHERSWITCH_VID_VALID) == 0)
 151                         continue;
 152                 vlans[v->vlanid & ETHERSWITCH_VID_MASK] = v->ports;
 153         }
 154
 155         for (j = 0, i = 1; i <= IP17X_MAX_VLANS / 2; i++) {
 156                 data = vlans[j++] & 0x3f;
 157                 data |= (vlans[j++] & 0x3f) << 8;
 158                 if (ip17x_writephy(sc->sc_dev, 30, i, data))
 159                         return (-1);
 160         }
 161
 162         /* Port default VLAN ID. */
 163         for (i = 0; i < sc->numports; i++) {
 164                 if (i == IP175X_CPU_PORT) {
 165                         if (ip17x_writephy(sc->sc_dev, 29, 30, sc->pvid[i]))
 166                                 return (-1);
 167                 } else {
 168                         if (ip17x_writephy(sc->sc_dev, 29, 24 + i, sc->pvid[i]))
 169                                 return (-1);
 170                 }
 171         }
 172
 173         return (0);
 174 }
 175
 176 /*
 177  * Set the Switch configuration.
 178  */
 179 static int
 180 ip175c_hw_setup(struct ip17x_softc *sc)
 181 {
 182
 183         switch (sc->vlan_mode) {
 184         case ETHERSWITCH_VLAN_PORT:
 185                 return (ip175c_port_vlan_setup(sc));
 186                 break;
 187         case ETHERSWITCH_VLAN_DOT1Q:
 188                 return (ip175c_dot1q_vlan_setup(sc));
 189                 break;
 190         }
 191         return (-1);
 192 }
 193
 194 /*
 195  * Set the switch VLAN mode.
 196  */
 197 static int
 198 ip175c_set_vlan_mode(struct ip17x_softc *sc, uint32_t mode)
 199 {
 200
 201         switch (mode) {
 202         case ETHERSWITCH_VLAN_DOT1Q:
 203                 /* Enable VLAN tag processing. */
 204                 ip17x_updatephy(sc->sc_dev, 30, 9, 0x80, 0x80);
 205                 sc->vlan_mode = mode;
 206                 break;
 207         case ETHERSWITCH_VLAN_PORT:
 208         default:
 209                 /* Disable VLAN tag processing. */
 210                 ip17x_updatephy(sc->sc_dev, 30, 9, 0x80, 0);
 211                 sc->vlan_mode = ETHERSWITCH_VLAN_PORT;
 212                 break;
 213         };
 214
 215         /* Reset vlans. */
 216         ip17x_reset_vlans(sc, sc->vlan_mode);
 217
 218         /* Update switch configuration. */
 219         ip175c_hw_setup(sc);
 220
 221         return (0);
 222 }
 223
 224 /*
 225  * Get the switch VLAN mode.
 226  */
 227 static int
 228 ip175c_get_vlan_mode(struct ip17x_softc *sc)
 229 {
 230
 231         return (sc->vlan_mode);
 232 }
 233
 234 void
 235 ip175c_attach(struct ip17x_softc *sc)
 236 {
 237
 238         sc->hal.ip17x_reset = ip175c_reset;
 239         sc->hal.ip17x_hw_setup = ip175c_hw_setup;
 240         sc->hal.ip17x_get_vlan_mode = ip175c_get_vlan_mode;
 241         sc->hal.ip17x_set_vlan_mode = ip175c_set_vlan_mode;
 242
 243         /* Defaults for IP175C. */
 244         sc->cpuport = IP175X_CPU_PORT;
 245         sc->numports = IP175X_NUM_PORTS;
 246         sc->info.es_vlan_caps = ETHERSWITCH_VLAN_PORT | ETHERSWITCH_VLAN_DOT1Q;
 247
 248         device_printf(sc->sc_dev, "type: IP175C\n");
 249 }