drivers/net/ibm_emac/ibm_emac_zmii.c

   1 /*
   2  * drivers/net/ibm_emac/ibm_emac_zmii.c
   3  *
   4  * Driver for PowerPC 4xx on-chip ethernet controller, ZMII bridge support.
   5  *
   6  * Copyright (c) 2004, 2005 Zultys Technologies.
   7  * Eugene Surovegin <eugene.surovegin@zultys.com> or <ebs@ebshome.net>
   8  *
   9  * Based on original work by
  10  *      Armin Kuster <akuster@mvista.com>
  11  *      Copyright 2001 MontaVista Softare Inc.
  12  *
  13  * This program is free software; you can redistribute  it and/or modify it
  14  * under  the terms of  the GNU General  Public License as published by the
  15  * Free Software Foundation;  either version 2 of the  License, or (at your
  16  * option) any later version.
  17  *
  18  */
  19 #include <linux/config.h>
  20 #include <linux/kernel.h>
  21 #include <linux/ethtool.h>
  22 #include <asm/io.h>
  23
  24 #include "ibm_emac_core.h"
  25 #include "ibm_emac_debug.h"
  26
  27 /* ZMIIx_FER */
  28 #define ZMII_FER_MDI(idx)       (0x80000000 >> ((idx) * 4))
  29 #define ZMII_FER_MDI_ALL        (ZMII_FER_MDI(0) | ZMII_FER_MDI(1) | \
  30                                  ZMII_FER_MDI(2) | ZMII_FER_MDI(3))
  31
  32 #define ZMII_FER_SMII(idx)      (0x40000000 >> ((idx) * 4))
  33 #define ZMII_FER_RMII(idx)      (0x20000000 >> ((idx) * 4))
  34 #define ZMII_FER_MII(idx)       (0x10000000 >> ((idx) * 4))
  35
  36 /* ZMIIx_SSR */
  37 #define ZMII_SSR_SCI(idx)       (0x40000000 >> ((idx) * 4))
  38 #define ZMII_SSR_FSS(idx)       (0x20000000 >> ((idx) * 4))
  39 #define ZMII_SSR_SP(idx)        (0x10000000 >> ((idx) * 4))
  40
  41 /* ZMII only supports MII, RMII and SMII
  42  * we also support autodetection for backward compatibility
  43  */
  44 static inline int zmii_valid_mode(int mode)
  45 {
  46         return  mode == PHY_MODE_MII ||
  47                 mode == PHY_MODE_RMII ||
  48                 mode == PHY_MODE_SMII ||
  49                 mode == PHY_MODE_NA;
  50 }
  51
  52 static inline const char *zmii_mode_name(int mode)
  53 {
  54         switch (mode) {
  55         case PHY_MODE_MII:
  56                 return "MII";
  57         case PHY_MODE_RMII:
  58                 return "RMII";
  59         case PHY_MODE_SMII:
  60                 return "SMII";
  61         default:
  62                 BUG();
  63         }
  64 }
  65
  66 static inline u32 zmii_mode_mask(int mode, int input)
  67 {
  68         switch (mode) {
  69         case PHY_MODE_MII:
  70                 return ZMII_FER_MII(input);
  71         case PHY_MODE_RMII:
  72                 return ZMII_FER_RMII(input);
  73         case PHY_MODE_SMII:
  74                 return ZMII_FER_SMII(input);
  75         default:
  76                 return 0;
  77         }
  78 }
  79
  80 static int __init zmii_init(struct ocp_device *ocpdev, int input, int *mode)
  81 {
  82         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
  83         struct zmii_regs *p;
  84
  85         ZMII_DBG("%d: init(%d, %d)" NL, ocpdev->def->index, input, *mode);
  86
  87         if (!dev) {
  88                 dev = kzalloc(sizeof(struct ibm_ocp_zmii), GFP_KERNEL);
  89                 if (!dev) {
  90                         printk(KERN_ERR
  91                                "zmii%d: couldn't allocate device structure!\n",
  92                                ocpdev->def->index);
  93                         return -ENOMEM;
  94                 }
  95                 dev->mode = PHY_MODE_NA;
  96
  97                 p = (struct zmii_regs *)ioremap(ocpdev->def->paddr,
  98                                                 sizeof(struct zmii_regs));
  99                 if (!p) {
 100                         printk(KERN_ERR
 101                                "zmii%d: could not ioremap device registers!\n",
 102                                ocpdev->def->index);
 103                         kfree(dev);
 104                         return -ENOMEM;
 105                 }
 106                 dev->base = p;
 107                 ocp_set_drvdata(ocpdev, dev);
 108
 109                 /* We may need FER value for autodetection later */
 110                 dev->fer_save = in_be32(&p->fer);
 111
 112                 /* Disable all inputs by default */
 113                 out_be32(&p->fer, 0);
 114         } else
 115                 p = dev->base;
 116
 117         if (!zmii_valid_mode(*mode)) {
 118                 /* Probably an EMAC connected to RGMII,
 119                  * but it still may need ZMII for MDIO
 120                  */
 121                 goto out;
 122         }
 123
 124         /* Autodetect ZMII mode if not specified.
 125          * This is only for backward compatibility with the old driver.
 126          * Please, always specify PHY mode in your board port to avoid
 127          * any surprises.
 128          */
 129         if (dev->mode == PHY_MODE_NA) {
 130                 if (*mode == PHY_MODE_NA) {
 131                         u32 r = dev->fer_save;
 132
 133                         ZMII_DBG("%d: autodetecting mode, FER = 0x%08x" NL,
 134                                  ocpdev->def->index, r);
 135
 136                         if (r & (ZMII_FER_MII(0) | ZMII_FER_MII(1)))
 137                                 dev->mode = PHY_MODE_MII;
 138                         else if (r & (ZMII_FER_RMII(0) | ZMII_FER_RMII(1)))
 139                                 dev->mode = PHY_MODE_RMII;
 140                         else
 141                                 dev->mode = PHY_MODE_SMII;
 142                 } else
 143                         dev->mode = *mode;
 144
 145                 printk(KERN_NOTICE "zmii%d: bridge in %s mode\n",
 146                        ocpdev->def->index, zmii_mode_name(dev->mode));
 147         } else {
 148                 /* All inputs must use the same mode */
 149                 if (*mode != PHY_MODE_NA && *mode != dev->mode) {
 150                         printk(KERN_ERR
 151                                "zmii%d: invalid mode %d specified for input %d\n",
 152                                ocpdev->def->index, *mode, input);
 153                         return -EINVAL;
 154                 }
 155         }
 156
 157         /* Report back correct PHY mode,
 158          * it may be used during PHY initialization.
 159          */
 160         *mode = dev->mode;
 161
 162         /* Enable this input */
 163         out_be32(&p->fer, in_be32(&p->fer) | zmii_mode_mask(dev->mode, input));
 164       out:
 165         ++dev->users;
 166         return 0;
 167 }
 168
 169 int __init zmii_attach(void *emac)
 170 {
 171         struct ocp_enet_private *dev = emac;
 172         struct ocp_func_emac_data *emacdata = dev->def->additions;
 173
 174         if (emacdata->zmii_idx >= 0) {
 175                 dev->zmii_input = emacdata->zmii_mux;
 176                 dev->zmii_dev =
 177                     ocp_find_device(OCP_VENDOR_IBM, OCP_FUNC_ZMII,
 178                                     emacdata->zmii_idx);
 179                 if (!dev->zmii_dev) {
 180                         printk(KERN_ERR "emac%d: unknown zmii%d!\n",
 181                                dev->def->index, emacdata->zmii_idx);
 182                         return -ENODEV;
 183                 }
 184                 if (zmii_init
 185                     (dev->zmii_dev, dev->zmii_input, &emacdata->phy_mode)) {
 186                         printk(KERN_ERR
 187                                "emac%d: zmii%d initialization failed!\n",
 188                                dev->def->index, emacdata->zmii_idx);
 189                         return -ENODEV;
 190                 }
 191         }
 192         return 0;
 193 }
 194
 195 void __zmii_enable_mdio(struct ocp_device *ocpdev, int input)
 196 {
 197         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
 198         u32 fer = in_be32(&dev->base->fer) & ~ZMII_FER_MDI_ALL;
 199
 200         ZMII_DBG2("%d: mdio(%d)" NL, ocpdev->def->index, input);
 201
 202         out_be32(&dev->base->fer, fer | ZMII_FER_MDI(input));
 203 }
 204
 205 void __zmii_set_speed(struct ocp_device *ocpdev, int input, int speed)
 206 {
 207         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
 208         u32 ssr = in_be32(&dev->base->ssr);
 209
 210         ZMII_DBG("%d: speed(%d, %d)" NL, ocpdev->def->index, input, speed);
 211
 212         if (speed == SPEED_100)
 213                 ssr |= ZMII_SSR_SP(input);
 214         else
 215                 ssr &= ~ZMII_SSR_SP(input);
 216
 217         out_be32(&dev->base->ssr, ssr);
 218 }
 219
 220 void __exit __zmii_fini(struct ocp_device *ocpdev, int input)
 221 {
 222         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
 223         BUG_ON(!dev || dev->users == 0);
 224
 225         ZMII_DBG("%d: fini(%d)" NL, ocpdev->def->index, input);
 226
 227         /* Disable this input */
 228         out_be32(&dev->base->fer,
 229                  in_be32(&dev->base->fer) & ~zmii_mode_mask(dev->mode, input));
 230
 231         if (!--dev->users) {
 232                 /* Free everything if this is the last user */
 233                 ocp_set_drvdata(ocpdev, NULL);
 234                 iounmap((void *)dev->base);
 235                 kfree(dev);
 236         }
 237 }
 238
 239 int __zmii_get_regs_len(struct ocp_device *ocpdev)
 240 {
 241         return sizeof(struct emac_ethtool_regs_subhdr) +
 242             sizeof(struct zmii_regs);
 243 }
 244
 245 void *zmii_dump_regs(struct ocp_device *ocpdev, void *buf)
 246 {
 247         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
 248         struct emac_ethtool_regs_subhdr *hdr = buf;
 249         struct zmii_regs *regs = (struct zmii_regs *)(hdr + 1);
 250
 251         hdr->version = 0;
 252         hdr->index = ocpdev->def->index;
 253         memcpy_fromio(regs, dev->base, sizeof(struct zmii_regs));
 254         return regs + 1;
 255 }