drivers/net/ethernet/chelsio/cxgb/my3126.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* $Date: 2005/11/12 02:13:49 $ $RCSfile: my3126.c,v $ $Revision: 1.15 $ */
   3 #include "cphy.h"
   4 #include "elmer0.h"
   5 #include "suni1x10gexp_regs.h"
   6
   7 /* Port Reset */
   8 static int my3126_reset(struct cphy *cphy, int wait)
   9 {
  10         /*
  11          * This can be done through registers.  It is not required since
  12          * a full chip reset is used.
  13          */
  14         return 0;
  15 }
  16
  17 static int my3126_interrupt_enable(struct cphy *cphy)
  18 {
  19         schedule_delayed_work(&cphy->phy_update, HZ/30);
  20         t1_tpi_read(cphy->adapter, A_ELMER0_GPO, &cphy->elmer_gpo);
  21         return 0;
  22 }
  23
  24 static int my3126_interrupt_disable(struct cphy *cphy)
  25 {
  26         cancel_delayed_work_sync(&cphy->phy_update);
  27         return 0;
  28 }
  29
  30 static int my3126_interrupt_clear(struct cphy *cphy)
  31 {
  32         return 0;
  33 }
  34
  35 #define OFFSET(REG_ADDR)    (REG_ADDR << 2)
  36
  37 static int my3126_interrupt_handler(struct cphy *cphy)
  38 {
  39         u32 val;
  40         u16 val16;
  41         u16 status;
  42         u32 act_count;
  43         adapter_t *adapter;
  44         adapter = cphy->adapter;
  45
  46         if (cphy->count == 50) {
  47                 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_STAT1, &val);
  48                 val16 = (u16) val;
  49                 status = cphy->bmsr ^ val16;
  50
  51                 if (status & MDIO_STAT1_LSTATUS)
  52                         t1_link_changed(adapter, 0);
  53                 cphy->bmsr = val16;
  54
  55                 /* We have only enabled link change interrupts so it
  56                    must be that
  57                  */
  58                 cphy->count = 0;
  59         }
  60
  61         t1_tpi_write(adapter, OFFSET(SUNI1x10GEXP_REG_MSTAT_CONTROL),
  62                 SUNI1x10GEXP_BITMSK_MSTAT_SNAP);
  63         t1_tpi_read(adapter,
  64                 OFFSET(SUNI1x10GEXP_REG_MSTAT_COUNTER_1_LOW), &act_count);
  65         t1_tpi_read(adapter,
  66                 OFFSET(SUNI1x10GEXP_REG_MSTAT_COUNTER_33_LOW), &val);
  67         act_count += val;
  68
  69         /* Populate elmer_gpo with the register value */
  70         t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  71         cphy->elmer_gpo = val;
  72
  73         if ( (val & (1 << 8)) || (val & (1 << 19)) ||
  74              (cphy->act_count == act_count) || cphy->act_on ) {
  75                 if (is_T2(adapter))
  76                         val |= (1 << 9);
  77                 else if (t1_is_T1B(adapter))
  78                         val |= (1 << 20);
  79                 cphy->act_on = 0;
  80         } else {
  81                 if (is_T2(adapter))
  82                         val &= ~(1 << 9);
  83                 else if (t1_is_T1B(adapter))
  84                         val &= ~(1 << 20);
  85                 cphy->act_on = 1;
  86         }
  87
  88         t1_tpi_write(adapter, A_ELMER0_GPO, val);
  89
  90         cphy->elmer_gpo = val;
  91         cphy->act_count = act_count;
  92         cphy->count++;
  93
  94         return cphy_cause_link_change;
  95 }
  96
  97 static void my3216_poll(struct work_struct *work)
  98 {
  99         struct cphy *cphy = container_of(work, struct cphy, phy_update.work);
 100
 101         my3126_interrupt_handler(cphy);
 102 }
 103
 104 static int my3126_set_loopback(struct cphy *cphy, int on)
 105 {
 106         return 0;
 107 }
 108
 109 /* To check the activity LED */
 110 static int my3126_get_link_status(struct cphy *cphy,
 111                         int *link_ok, int *speed, int *duplex, int *fc)
 112 {
 113         u32 val;
 114         u16 val16;
 115         adapter_t *adapter;
 116
 117         adapter = cphy->adapter;
 118         cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_STAT1, &val);
 119         val16 = (u16) val;
 120
 121         /* Populate elmer_gpo with the register value */
 122         t1_tpi_read(adapter, A_ELMER0_GPO, &val);
 123         cphy->elmer_gpo = val;
 124
 125         *link_ok = (val16 & MDIO_STAT1_LSTATUS);
 126
 127         if (*link_ok) {
 128                 /* Turn on the LED. */
 129                 if (is_T2(adapter))
 130                          val &= ~(1 << 8);
 131                 else if (t1_is_T1B(adapter))
 132                          val &= ~(1 << 19);
 133         } else {
 134                 /* Turn off the LED. */
 135                 if (is_T2(adapter))
 136                          val |= (1 << 8);
 137                 else if (t1_is_T1B(adapter))
 138                          val |= (1 << 19);
 139         }
 140
 141         t1_tpi_write(adapter, A_ELMER0_GPO, val);
 142         cphy->elmer_gpo = val;
 143         *speed = SPEED_10000;
 144         *duplex = DUPLEX_FULL;
 145
 146         /* need to add flow control */
 147         if (fc)
 148                 *fc = PAUSE_RX | PAUSE_TX;
 149
 150         return 0;
 151 }
 152
 153 static void my3126_destroy(struct cphy *cphy)
 154 {
 155         kfree(cphy);
 156 }
 157
 158 static const struct cphy_ops my3126_ops = {
 159         .destroy                = my3126_destroy,
 160         .reset                  = my3126_reset,
 161         .interrupt_enable       = my3126_interrupt_enable,
 162         .interrupt_disable      = my3126_interrupt_disable,
 163         .interrupt_clear        = my3126_interrupt_clear,
 164         .interrupt_handler      = my3126_interrupt_handler,
 165         .get_link_status        = my3126_get_link_status,
 166         .set_loopback           = my3126_set_loopback,
 167         .mmds                   = (MDIO_DEVS_PMAPMD | MDIO_DEVS_PCS |
 168                                    MDIO_DEVS_PHYXS),
 169 };
 170
 171 static struct cphy *my3126_phy_create(struct net_device *dev,
 172                         int phy_addr, const struct mdio_ops *mdio_ops)
 173 {
 174         struct cphy *cphy = kzalloc(sizeof (*cphy), GFP_KERNEL);
 175
 176         if (!cphy)
 177                 return NULL;
 178
 179         cphy_init(cphy, dev, phy_addr, &my3126_ops, mdio_ops);
 180         INIT_DELAYED_WORK(&cphy->phy_update, my3216_poll);
 181         cphy->bmsr = 0;
 182
 183         return cphy;
 184 }
 185
 186 /* Chip Reset */
 187 static int my3126_phy_reset(adapter_t * adapter)
 188 {
 189         u32 val;
 190
 191         t1_tpi_read(adapter, A_ELMER0_GPO, &val);
 192         val &= ~4;
 193         t1_tpi_write(adapter, A_ELMER0_GPO, val);
 194         msleep(100);
 195
 196         t1_tpi_write(adapter, A_ELMER0_GPO, val | 4);
 197         msleep(1000);
 198
 199         /* Now lets enable the Laser. Delay 100us */
 200         t1_tpi_read(adapter, A_ELMER0_GPO, &val);
 201         val |= 0x8000;
 202         t1_tpi_write(adapter, A_ELMER0_GPO, val);
 203         udelay(100);
 204         return 0;
 205 }
 206
 207 const struct gphy t1_my3126_ops = {
 208         .create = my3126_phy_create,
 209         .reset = my3126_phy_reset
 210 };