1 /* $Date: 2005/11/12 02:13:49 $ $RCSfile: my3126.c,v $ $Revision: 1.15 $ */
4 #include "suni1x10gexp_regs.h"
7 static int my3126_reset(struct cphy *cphy, int wait)
10 * This can be done through registers. It is not required since
11 * a full chip reset is used.
16 static int my3126_interrupt_enable(struct cphy *cphy)
18 schedule_delayed_work(&cphy->phy_update, HZ/30);
19 t1_tpi_read(cphy->adapter, A_ELMER0_GPO, &cphy->elmer_gpo);
23 static int my3126_interrupt_disable(struct cphy *cphy)
25 cancel_rearming_delayed_work(&cphy->phy_update);
29 static int my3126_interrupt_clear(struct cphy *cphy)
34 #define OFFSET(REG_ADDR) (REG_ADDR << 2)
36 static int my3126_interrupt_handler(struct cphy *cphy)
43 adapter = cphy->adapter;
45 if (cphy->count == 50) {
46 mdio_read(cphy, 0x1, 0x1, &val);
48 status = cphy->bmsr ^ val16;
50 if (status & BMSR_LSTATUS)
51 t1_link_changed(adapter, 0);
54 /* We have only enabled link change interrupts so it
60 t1_tpi_write(adapter, OFFSET(SUNI1x10GEXP_REG_MSTAT_CONTROL),
61 SUNI1x10GEXP_BITMSK_MSTAT_SNAP);
63 OFFSET(SUNI1x10GEXP_REG_MSTAT_COUNTER_1_LOW), &act_count);
65 OFFSET(SUNI1x10GEXP_REG_MSTAT_COUNTER_33_LOW), &val);
68 /* Populate elmer_gpo with the register value */
69 t1_tpi_read(adapter, A_ELMER0_GPO, &val);
70 cphy->elmer_gpo = val;
72 if ( (val & (1 << 8)) || (val & (1 << 19)) ||
73 (cphy->act_count == act_count) || cphy->act_on ) {
76 else if (t1_is_T1B(adapter))
82 else if (t1_is_T1B(adapter))
87 t1_tpi_write(adapter, A_ELMER0_GPO, val);
89 cphy->elmer_gpo = val;
90 cphy->act_count = act_count;
93 return cphy_cause_link_change;
96 static void my3216_poll(void *arg)
98 my3126_interrupt_handler(arg);
101 static int my3126_set_loopback(struct cphy *cphy, int on)
106 /* To check the activity LED */
107 static int my3126_get_link_status(struct cphy *cphy,
108 int *link_ok, int *speed, int *duplex, int *fc)
114 adapter = cphy->adapter;
115 mdio_read(cphy, 0x1, 0x1, &val);
118 /* Populate elmer_gpo with the register value */
119 t1_tpi_read(adapter, A_ELMER0_GPO, &val);
120 cphy->elmer_gpo = val;
122 *link_ok = (val16 & BMSR_LSTATUS);
125 /* Turn on the LED. */
128 else if (t1_is_T1B(adapter))
131 /* Turn off the LED. */
134 else if (t1_is_T1B(adapter))
138 t1_tpi_write(adapter, A_ELMER0_GPO, val);
139 cphy->elmer_gpo = val;
140 *speed = SPEED_10000;
141 *duplex = DUPLEX_FULL;
143 /* need to add flow control */
145 *fc = PAUSE_RX | PAUSE_TX;
150 static void my3126_destroy(struct cphy *cphy)
155 static struct cphy_ops my3126_ops = {
156 .destroy = my3126_destroy,
157 .reset = my3126_reset,
158 .interrupt_enable = my3126_interrupt_enable,
159 .interrupt_disable = my3126_interrupt_disable,
160 .interrupt_clear = my3126_interrupt_clear,
161 .interrupt_handler = my3126_interrupt_handler,
162 .get_link_status = my3126_get_link_status,
163 .set_loopback = my3126_set_loopback,
166 static struct cphy *my3126_phy_create(adapter_t *adapter,
167 int phy_addr, struct mdio_ops *mdio_ops)
169 struct cphy *cphy = kzalloc(sizeof (*cphy), GFP_KERNEL);
172 cphy_init(cphy, adapter, phy_addr, &my3126_ops, mdio_ops);
174 INIT_WORK(&cphy->phy_update, my3216_poll, cphy);
181 static int my3126_phy_reset(adapter_t * adapter)
185 t1_tpi_read(adapter, A_ELMER0_GPO, &val);
187 t1_tpi_write(adapter, A_ELMER0_GPO, val);
190 t1_tpi_write(adapter, A_ELMER0_GPO, val | 4);
193 /* Now lets enable the Laser. Delay 100us */
194 t1_tpi_read(adapter, A_ELMER0_GPO, &val);
196 t1_tpi_write(adapter, A_ELMER0_GPO, val);
201 struct gphy t1_my3126_ops = {