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(dwork: &cphy->phy_update, HZ/30); |
20 | t1_tpi_read(adapter: cphy->adapter, A_ELMER0_GPO, value: &cphy->elmer_gpo); |
21 | return 0; |
22 | } |
23 | |
24 | static int my3126_interrupt_disable(struct cphy *cphy) |
25 | { |
26 | cancel_delayed_work_sync(dwork: &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, valp: &val); |
48 | val16 = (u16) val; |
49 | status = cphy->bmsr ^ val16; |
50 | |
51 | if (status & MDIO_STAT1_LSTATUS) |
52 | t1_link_changed(adapter, port_id: 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), value: &act_count); |
65 | t1_tpi_read(adapter, |
66 | OFFSET(SUNI1x10GEXP_REG_MSTAT_COUNTER_33_LOW), value: &val); |
67 | act_count += val; |
68 | |
69 | /* Populate elmer_gpo with the register value */ |
70 | t1_tpi_read(adapter, A_ELMER0_GPO, value: &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, value: 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 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 | |
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, valp: &val); |
119 | val16 = (u16) val; |
120 | |
121 | /* Populate elmer_gpo with the register value */ |
122 | t1_tpi_read(adapter, A_ELMER0_GPO, value: &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, value: 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(objp: 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(size: sizeof (*cphy), GFP_KERNEL); |
175 | |
176 | if (!cphy) |
177 | return NULL; |
178 | |
179 | cphy_init(phy: cphy, dev, phy_addr, phy_ops: &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 */ |
187 | static int my3126_phy_reset(adapter_t * adapter) |
188 | { |
189 | u32 val; |
190 | |
191 | t1_tpi_read(adapter, A_ELMER0_GPO, value: &val); |
192 | val &= ~4; |
193 | t1_tpi_write(adapter, A_ELMER0_GPO, value: val); |
194 | msleep(msecs: 100); |
195 | |
196 | t1_tpi_write(adapter, A_ELMER0_GPO, value: val | 4); |
197 | msleep(msecs: 1000); |
198 | |
199 | /* Now lets enable the Laser. Delay 100us */ |
200 | t1_tpi_read(adapter, A_ELMER0_GPO, value: &val); |
201 | val |= 0x8000; |
202 | t1_tpi_write(adapter, A_ELMER0_GPO, value: 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 | }; |
211 | |