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