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 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, &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, 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, &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 };
211