geneve: avoid using stale geneve socket.
[cascardo/linux.git] / arch / mips / cavium-octeon / executive / cvmx-helper-board.c
1 /***********************license start***************
2  * Author: Cavium Networks
3  *
4  * Contact: support@caviumnetworks.com
5  * This file is part of the OCTEON SDK
6  *
7  * Copyright (c) 2003-2008 Cavium Networks
8  *
9  * This file is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License, Version 2, as
11  * published by the Free Software Foundation.
12  *
13  * This file is distributed in the hope that it will be useful, but
14  * AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty
15  * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or
16  * NONINFRINGEMENT.  See the GNU General Public License for more
17  * details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this file; if not, write to the Free Software
21  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
22  * or visit http://www.gnu.org/licenses/.
23  *
24  * This file may also be available under a different license from Cavium.
25  * Contact Cavium Networks for more information
26  ***********************license end**************************************/
27
28 /*
29  *
30  * Helper functions to abstract board specific data about
31  * network ports from the rest of the cvmx-helper files.
32  */
33
34 #include <asm/octeon/octeon.h>
35 #include <asm/octeon/cvmx-bootinfo.h>
36
37 #include <asm/octeon/cvmx-config.h>
38
39 #include <asm/octeon/cvmx-mdio.h>
40
41 #include <asm/octeon/cvmx-helper.h>
42 #include <asm/octeon/cvmx-helper-util.h>
43 #include <asm/octeon/cvmx-helper-board.h>
44
45 #include <asm/octeon/cvmx-gmxx-defs.h>
46 #include <asm/octeon/cvmx-asxx-defs.h>
47
48 /**
49  * cvmx_override_board_link_get(int ipd_port) is a function
50  * pointer. It is meant to allow customization of the process of
51  * talking to a PHY to determine link speed. It is called every
52  * time a PHY must be polled for link status. Users should set
53  * this pointer to a function before calling any cvmx-helper
54  * operations.
55  */
56 cvmx_helper_link_info_t(*cvmx_override_board_link_get) (int ipd_port) =
57     NULL;
58
59 /**
60  * Return the MII PHY address associated with the given IPD
61  * port. A result of -1 means there isn't a MII capable PHY
62  * connected to this port. On chips supporting multiple MII
63  * busses the bus number is encoded in bits <15:8>.
64  *
65  * This function must be modified for every new Octeon board.
66  * Internally it uses switch statements based on the cvmx_sysinfo
67  * data to determine board types and revisions. It replies on the
68  * fact that every Octeon board receives a unique board type
69  * enumeration from the bootloader.
70  *
71  * @ipd_port: Octeon IPD port to get the MII address for.
72  *
73  * Returns MII PHY address and bus number or -1.
74  */
75 int cvmx_helper_board_get_mii_address(int ipd_port)
76 {
77         switch (cvmx_sysinfo_get()->board_type) {
78         case CVMX_BOARD_TYPE_SIM:
79                 /* Simulator doesn't have MII */
80                 return -1;
81         case CVMX_BOARD_TYPE_EBT3000:
82         case CVMX_BOARD_TYPE_EBT5800:
83         case CVMX_BOARD_TYPE_THUNDER:
84         case CVMX_BOARD_TYPE_NICPRO2:
85                 /* Interface 0 is SPI4, interface 1 is RGMII */
86                 if ((ipd_port >= 16) && (ipd_port < 20))
87                         return ipd_port - 16;
88                 else
89                         return -1;
90         case CVMX_BOARD_TYPE_KODAMA:
91         case CVMX_BOARD_TYPE_EBH3100:
92         case CVMX_BOARD_TYPE_HIKARI:
93         case CVMX_BOARD_TYPE_CN3010_EVB_HS5:
94         case CVMX_BOARD_TYPE_CN3005_EVB_HS5:
95         case CVMX_BOARD_TYPE_CN3020_EVB_HS5:
96                 /*
97                  * Port 0 is WAN connected to a PHY, Port 1 is GMII
98                  * connected to a switch
99                  */
100                 if (ipd_port == 0)
101                         return 4;
102                 else if (ipd_port == 1)
103                         return 9;
104                 else
105                         return -1;
106         case CVMX_BOARD_TYPE_NAC38:
107                 /* Board has 8 RGMII ports PHYs are 0-7 */
108                 if ((ipd_port >= 0) && (ipd_port < 4))
109                         return ipd_port;
110                 else if ((ipd_port >= 16) && (ipd_port < 20))
111                         return ipd_port - 16 + 4;
112                 else
113                         return -1;
114         case CVMX_BOARD_TYPE_EBH3000:
115                 /* Board has dual SPI4 and no PHYs */
116                 return -1;
117         case CVMX_BOARD_TYPE_EBH5200:
118         case CVMX_BOARD_TYPE_EBH5201:
119         case CVMX_BOARD_TYPE_EBT5200:
120                 /* Board has 2 management ports */
121                 if ((ipd_port >= CVMX_HELPER_BOARD_MGMT_IPD_PORT) &&
122                     (ipd_port < (CVMX_HELPER_BOARD_MGMT_IPD_PORT + 2)))
123                         return ipd_port - CVMX_HELPER_BOARD_MGMT_IPD_PORT;
124                 /*
125                  * Board has 4 SGMII ports. The PHYs start right after the MII
126                  * ports MII0 = 0, MII1 = 1, SGMII = 2-5.
127                  */
128                 if ((ipd_port >= 0) && (ipd_port < 4))
129                         return ipd_port + 2;
130                 else
131                         return -1;
132         case CVMX_BOARD_TYPE_EBH5600:
133         case CVMX_BOARD_TYPE_EBH5601:
134         case CVMX_BOARD_TYPE_EBH5610:
135                 /* Board has 1 management port */
136                 if (ipd_port == CVMX_HELPER_BOARD_MGMT_IPD_PORT)
137                         return 0;
138                 /*
139                  * Board has 8 SGMII ports. 4 connect out, two connect
140                  * to a switch, and 2 loop to each other
141                  */
142                 if ((ipd_port >= 0) && (ipd_port < 4))
143                         return ipd_port + 1;
144                 else
145                         return -1;
146         case CVMX_BOARD_TYPE_CUST_NB5:
147                 if (ipd_port == 2)
148                         return 4;
149                 else
150                         return -1;
151         case CVMX_BOARD_TYPE_NIC_XLE_4G:
152                 /* Board has 4 SGMII ports. connected QLM3(interface 1) */
153                 if ((ipd_port >= 16) && (ipd_port < 20))
154                         return ipd_port - 16 + 1;
155                 else
156                         return -1;
157         case CVMX_BOARD_TYPE_NIC_XLE_10G:
158         case CVMX_BOARD_TYPE_NIC10E:
159                 return -1;
160         case CVMX_BOARD_TYPE_NIC4E:
161                 if (ipd_port >= 0 && ipd_port <= 3)
162                         return (ipd_port + 0x1f) & 0x1f;
163                 else
164                         return -1;
165         case CVMX_BOARD_TYPE_NIC2E:
166                 if (ipd_port >= 0 && ipd_port <= 1)
167                         return ipd_port + 1;
168                 else
169                         return -1;
170         case CVMX_BOARD_TYPE_BBGW_REF:
171                 /*
172                  * No PHYs are connected to Octeon, everything is
173                  * through switch.
174                  */
175                 return -1;
176
177         case CVMX_BOARD_TYPE_CUST_WSX16:
178                 if (ipd_port >= 0 && ipd_port <= 3)
179                         return ipd_port;
180                 else if (ipd_port >= 16 && ipd_port <= 19)
181                         return ipd_port - 16 + 4;
182                 else
183                         return -1;
184         case CVMX_BOARD_TYPE_UBNT_E100:
185                 if (ipd_port >= 0 && ipd_port <= 2)
186                         return 7 - ipd_port;
187                 else
188                         return -1;
189         case CVMX_BOARD_TYPE_KONTRON_S1901:
190                 if (ipd_port == CVMX_HELPER_BOARD_MGMT_IPD_PORT)
191                         return 1;
192                 else
193                         return -1;
194
195         }
196
197         /* Some unknown board. Somebody forgot to update this function... */
198         cvmx_dprintf
199             ("cvmx_helper_board_get_mii_address: Unknown board type %d\n",
200              cvmx_sysinfo_get()->board_type);
201         return -1;
202 }
203
204 /**
205  * This function is the board specific method of determining an
206  * ethernet ports link speed. Most Octeon boards have Marvell PHYs
207  * and are handled by the fall through case. This function must be
208  * updated for boards that don't have the normal Marvell PHYs.
209  *
210  * This function must be modified for every new Octeon board.
211  * Internally it uses switch statements based on the cvmx_sysinfo
212  * data to determine board types and revisions. It relies on the
213  * fact that every Octeon board receives a unique board type
214  * enumeration from the bootloader.
215  *
216  * @ipd_port: IPD input port associated with the port we want to get link
217  *                 status for.
218  *
219  * Returns The ports link status. If the link isn't fully resolved, this must
220  *         return zero.
221  */
222 cvmx_helper_link_info_t __cvmx_helper_board_link_get(int ipd_port)
223 {
224         cvmx_helper_link_info_t result;
225         int phy_addr;
226         int is_broadcom_phy = 0;
227
228         /* Give the user a chance to override the processing of this function */
229         if (cvmx_override_board_link_get)
230                 return cvmx_override_board_link_get(ipd_port);
231
232         /* Unless we fix it later, all links are defaulted to down */
233         result.u64 = 0;
234
235         /*
236          * This switch statement should handle all ports that either don't use
237          * Marvell PHYS, or don't support in-band status.
238          */
239         switch (cvmx_sysinfo_get()->board_type) {
240         case CVMX_BOARD_TYPE_SIM:
241                 /* The simulator gives you a simulated 1Gbps full duplex link */
242                 result.s.link_up = 1;
243                 result.s.full_duplex = 1;
244                 result.s.speed = 1000;
245                 return result;
246         case CVMX_BOARD_TYPE_EBH3100:
247         case CVMX_BOARD_TYPE_CN3010_EVB_HS5:
248         case CVMX_BOARD_TYPE_CN3005_EVB_HS5:
249         case CVMX_BOARD_TYPE_CN3020_EVB_HS5:
250                 /* Port 1 on these boards is always Gigabit */
251                 if (ipd_port == 1) {
252                         result.s.link_up = 1;
253                         result.s.full_duplex = 1;
254                         result.s.speed = 1000;
255                         return result;
256                 }
257                 /* Fall through to the generic code below */
258                 break;
259         case CVMX_BOARD_TYPE_CUST_NB5:
260                 /* Port 1 on these boards is always Gigabit */
261                 if (ipd_port == 1) {
262                         result.s.link_up = 1;
263                         result.s.full_duplex = 1;
264                         result.s.speed = 1000;
265                         return result;
266                 } else          /* The other port uses a broadcom PHY */
267                         is_broadcom_phy = 1;
268                 break;
269         case CVMX_BOARD_TYPE_BBGW_REF:
270                 /* Port 1 on these boards is always Gigabit */
271                 if (ipd_port == 2) {
272                         /* Port 2 is not hooked up */
273                         result.u64 = 0;
274                         return result;
275                 } else {
276                         /* Ports 0 and 1 connect to the switch */
277                         result.s.link_up = 1;
278                         result.s.full_duplex = 1;
279                         result.s.speed = 1000;
280                         return result;
281                 }
282                 break;
283         }
284
285         phy_addr = cvmx_helper_board_get_mii_address(ipd_port);
286         if (phy_addr != -1) {
287                 if (is_broadcom_phy) {
288                         /*
289                          * Below we are going to read SMI/MDIO
290                          * register 0x19 which works on Broadcom
291                          * parts
292                          */
293                         int phy_status =
294                             cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
295                                            0x19);
296                         switch ((phy_status >> 8) & 0x7) {
297                         case 0:
298                                 result.u64 = 0;
299                                 break;
300                         case 1:
301                                 result.s.link_up = 1;
302                                 result.s.full_duplex = 0;
303                                 result.s.speed = 10;
304                                 break;
305                         case 2:
306                                 result.s.link_up = 1;
307                                 result.s.full_duplex = 1;
308                                 result.s.speed = 10;
309                                 break;
310                         case 3:
311                                 result.s.link_up = 1;
312                                 result.s.full_duplex = 0;
313                                 result.s.speed = 100;
314                                 break;
315                         case 4:
316                                 result.s.link_up = 1;
317                                 result.s.full_duplex = 1;
318                                 result.s.speed = 100;
319                                 break;
320                         case 5:
321                                 result.s.link_up = 1;
322                                 result.s.full_duplex = 1;
323                                 result.s.speed = 100;
324                                 break;
325                         case 6:
326                                 result.s.link_up = 1;
327                                 result.s.full_duplex = 0;
328                                 result.s.speed = 1000;
329                                 break;
330                         case 7:
331                                 result.s.link_up = 1;
332                                 result.s.full_duplex = 1;
333                                 result.s.speed = 1000;
334                                 break;
335                         }
336                 } else {
337                         /*
338                          * This code assumes we are using a Marvell
339                          * Gigabit PHY. All the speed information can
340                          * be read from register 17 in one
341                          * go. Somebody using a different PHY will
342                          * need to handle it above in the board
343                          * specific area.
344                          */
345                         int phy_status =
346                             cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff, 17);
347
348                         /*
349                          * If the resolve bit 11 isn't set, see if
350                          * autoneg is turned off (bit 12, reg 0). The
351                          * resolve bit doesn't get set properly when
352                          * autoneg is off, so force it.
353                          */
354                         if ((phy_status & (1 << 11)) == 0) {
355                                 int auto_status =
356                                     cvmx_mdio_read(phy_addr >> 8,
357                                                    phy_addr & 0xff, 0);
358                                 if ((auto_status & (1 << 12)) == 0)
359                                         phy_status |= 1 << 11;
360                         }
361
362                         /*
363                          * Only return a link if the PHY has finished
364                          * auto negotiation and set the resolved bit
365                          * (bit 11)
366                          */
367                         if (phy_status & (1 << 11)) {
368                                 result.s.link_up = 1;
369                                 result.s.full_duplex = ((phy_status >> 13) & 1);
370                                 switch ((phy_status >> 14) & 3) {
371                                 case 0: /* 10 Mbps */
372                                         result.s.speed = 10;
373                                         break;
374                                 case 1: /* 100 Mbps */
375                                         result.s.speed = 100;
376                                         break;
377                                 case 2: /* 1 Gbps */
378                                         result.s.speed = 1000;
379                                         break;
380                                 case 3: /* Illegal */
381                                         result.u64 = 0;
382                                         break;
383                                 }
384                         }
385                 }
386         } else if (OCTEON_IS_MODEL(OCTEON_CN3XXX)
387                    || OCTEON_IS_MODEL(OCTEON_CN58XX)
388                    || OCTEON_IS_MODEL(OCTEON_CN50XX)) {
389                 /*
390                  * We don't have a PHY address, so attempt to use
391                  * in-band status. It is really important that boards
392                  * not supporting in-band status never get
393                  * here. Reading broken in-band status tends to do bad
394                  * things
395                  */
396                 union cvmx_gmxx_rxx_rx_inbnd inband_status;
397                 int interface = cvmx_helper_get_interface_num(ipd_port);
398                 int index = cvmx_helper_get_interface_index_num(ipd_port);
399                 inband_status.u64 =
400                     cvmx_read_csr(CVMX_GMXX_RXX_RX_INBND(index, interface));
401
402                 result.s.link_up = inband_status.s.status;
403                 result.s.full_duplex = inband_status.s.duplex;
404                 switch (inband_status.s.speed) {
405                 case 0: /* 10 Mbps */
406                         result.s.speed = 10;
407                         break;
408                 case 1: /* 100 Mbps */
409                         result.s.speed = 100;
410                         break;
411                 case 2: /* 1 Gbps */
412                         result.s.speed = 1000;
413                         break;
414                 case 3: /* Illegal */
415                         result.u64 = 0;
416                         break;
417                 }
418         } else {
419                 /*
420                  * We don't have a PHY address and we don't have
421                  * in-band status. There is no way to determine the
422                  * link speed. Return down assuming this port isn't
423                  * wired
424                  */
425                 result.u64 = 0;
426         }
427
428         /* If link is down, return all fields as zero. */
429         if (!result.s.link_up)
430                 result.u64 = 0;
431
432         return result;
433 }
434
435 /**
436  * This function as a board specific method of changing the PHY
437  * speed, duplex, and auto-negotiation. This programs the PHY and
438  * not Octeon. This can be used to force Octeon's links to
439  * specific settings.
440  *
441  * @phy_addr:  The address of the PHY to program
442  * @enable_autoneg:
443  *                  Non zero if you want to enable auto-negotiation.
444  * @link_info: Link speed to program. If the speed is zero and auto-negotiation
445  *                  is enabled, all possible negotiation speeds are advertised.
446  *
447  * Returns Zero on success, negative on failure
448  */
449 int cvmx_helper_board_link_set_phy(int phy_addr,
450                                    cvmx_helper_board_set_phy_link_flags_types_t
451                                    link_flags,
452                                    cvmx_helper_link_info_t link_info)
453 {
454
455         /* Set the flow control settings based on link_flags */
456         if ((link_flags & set_phy_link_flags_flow_control_mask) !=
457             set_phy_link_flags_flow_control_dont_touch) {
458                 cvmx_mdio_phy_reg_autoneg_adver_t reg_autoneg_adver;
459                 reg_autoneg_adver.u16 =
460                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
461                                    CVMX_MDIO_PHY_REG_AUTONEG_ADVER);
462                 reg_autoneg_adver.s.asymmetric_pause =
463                     (link_flags & set_phy_link_flags_flow_control_mask) ==
464                     set_phy_link_flags_flow_control_enable;
465                 reg_autoneg_adver.s.pause =
466                     (link_flags & set_phy_link_flags_flow_control_mask) ==
467                     set_phy_link_flags_flow_control_enable;
468                 cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
469                                 CVMX_MDIO_PHY_REG_AUTONEG_ADVER,
470                                 reg_autoneg_adver.u16);
471         }
472
473         /* If speed isn't set and autoneg is on advertise all supported modes */
474         if ((link_flags & set_phy_link_flags_autoneg)
475             && (link_info.s.speed == 0)) {
476                 cvmx_mdio_phy_reg_control_t reg_control;
477                 cvmx_mdio_phy_reg_status_t reg_status;
478                 cvmx_mdio_phy_reg_autoneg_adver_t reg_autoneg_adver;
479                 cvmx_mdio_phy_reg_extended_status_t reg_extended_status;
480                 cvmx_mdio_phy_reg_control_1000_t reg_control_1000;
481
482                 reg_status.u16 =
483                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
484                                    CVMX_MDIO_PHY_REG_STATUS);
485                 reg_autoneg_adver.u16 =
486                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
487                                    CVMX_MDIO_PHY_REG_AUTONEG_ADVER);
488                 reg_autoneg_adver.s.advert_100base_t4 =
489                     reg_status.s.capable_100base_t4;
490                 reg_autoneg_adver.s.advert_10base_tx_full =
491                     reg_status.s.capable_10_full;
492                 reg_autoneg_adver.s.advert_10base_tx_half =
493                     reg_status.s.capable_10_half;
494                 reg_autoneg_adver.s.advert_100base_tx_full =
495                     reg_status.s.capable_100base_x_full;
496                 reg_autoneg_adver.s.advert_100base_tx_half =
497                     reg_status.s.capable_100base_x_half;
498                 cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
499                                 CVMX_MDIO_PHY_REG_AUTONEG_ADVER,
500                                 reg_autoneg_adver.u16);
501                 if (reg_status.s.capable_extended_status) {
502                         reg_extended_status.u16 =
503                             cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
504                                            CVMX_MDIO_PHY_REG_EXTENDED_STATUS);
505                         reg_control_1000.u16 =
506                             cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
507                                            CVMX_MDIO_PHY_REG_CONTROL_1000);
508                         reg_control_1000.s.advert_1000base_t_full =
509                             reg_extended_status.s.capable_1000base_t_full;
510                         reg_control_1000.s.advert_1000base_t_half =
511                             reg_extended_status.s.capable_1000base_t_half;
512                         cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
513                                         CVMX_MDIO_PHY_REG_CONTROL_1000,
514                                         reg_control_1000.u16);
515                 }
516                 reg_control.u16 =
517                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
518                                    CVMX_MDIO_PHY_REG_CONTROL);
519                 reg_control.s.autoneg_enable = 1;
520                 reg_control.s.restart_autoneg = 1;
521                 cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
522                                 CVMX_MDIO_PHY_REG_CONTROL, reg_control.u16);
523         } else if ((link_flags & set_phy_link_flags_autoneg)) {
524                 cvmx_mdio_phy_reg_control_t reg_control;
525                 cvmx_mdio_phy_reg_status_t reg_status;
526                 cvmx_mdio_phy_reg_autoneg_adver_t reg_autoneg_adver;
527                 cvmx_mdio_phy_reg_control_1000_t reg_control_1000;
528
529                 reg_status.u16 =
530                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
531                                    CVMX_MDIO_PHY_REG_STATUS);
532                 reg_autoneg_adver.u16 =
533                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
534                                    CVMX_MDIO_PHY_REG_AUTONEG_ADVER);
535                 reg_autoneg_adver.s.advert_100base_t4 = 0;
536                 reg_autoneg_adver.s.advert_10base_tx_full = 0;
537                 reg_autoneg_adver.s.advert_10base_tx_half = 0;
538                 reg_autoneg_adver.s.advert_100base_tx_full = 0;
539                 reg_autoneg_adver.s.advert_100base_tx_half = 0;
540                 if (reg_status.s.capable_extended_status) {
541                         reg_control_1000.u16 =
542                             cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
543                                            CVMX_MDIO_PHY_REG_CONTROL_1000);
544                         reg_control_1000.s.advert_1000base_t_full = 0;
545                         reg_control_1000.s.advert_1000base_t_half = 0;
546                 }
547                 switch (link_info.s.speed) {
548                 case 10:
549                         reg_autoneg_adver.s.advert_10base_tx_full =
550                             link_info.s.full_duplex;
551                         reg_autoneg_adver.s.advert_10base_tx_half =
552                             !link_info.s.full_duplex;
553                         break;
554                 case 100:
555                         reg_autoneg_adver.s.advert_100base_tx_full =
556                             link_info.s.full_duplex;
557                         reg_autoneg_adver.s.advert_100base_tx_half =
558                             !link_info.s.full_duplex;
559                         break;
560                 case 1000:
561                         reg_control_1000.s.advert_1000base_t_full =
562                             link_info.s.full_duplex;
563                         reg_control_1000.s.advert_1000base_t_half =
564                             !link_info.s.full_duplex;
565                         break;
566                 }
567                 cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
568                                 CVMX_MDIO_PHY_REG_AUTONEG_ADVER,
569                                 reg_autoneg_adver.u16);
570                 if (reg_status.s.capable_extended_status)
571                         cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
572                                         CVMX_MDIO_PHY_REG_CONTROL_1000,
573                                         reg_control_1000.u16);
574                 reg_control.u16 =
575                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
576                                    CVMX_MDIO_PHY_REG_CONTROL);
577                 reg_control.s.autoneg_enable = 1;
578                 reg_control.s.restart_autoneg = 1;
579                 cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
580                                 CVMX_MDIO_PHY_REG_CONTROL, reg_control.u16);
581         } else {
582                 cvmx_mdio_phy_reg_control_t reg_control;
583                 reg_control.u16 =
584                     cvmx_mdio_read(phy_addr >> 8, phy_addr & 0xff,
585                                    CVMX_MDIO_PHY_REG_CONTROL);
586                 reg_control.s.autoneg_enable = 0;
587                 reg_control.s.restart_autoneg = 1;
588                 reg_control.s.duplex = link_info.s.full_duplex;
589                 if (link_info.s.speed == 1000) {
590                         reg_control.s.speed_msb = 1;
591                         reg_control.s.speed_lsb = 0;
592                 } else if (link_info.s.speed == 100) {
593                         reg_control.s.speed_msb = 0;
594                         reg_control.s.speed_lsb = 1;
595                 } else if (link_info.s.speed == 10) {
596                         reg_control.s.speed_msb = 0;
597                         reg_control.s.speed_lsb = 0;
598                 }
599                 cvmx_mdio_write(phy_addr >> 8, phy_addr & 0xff,
600                                 CVMX_MDIO_PHY_REG_CONTROL, reg_control.u16);
601         }
602         return 0;
603 }
604
605 /**
606  * This function is called by cvmx_helper_interface_probe() after it
607  * determines the number of ports Octeon can support on a specific
608  * interface. This function is the per board location to override
609  * this value. It is called with the number of ports Octeon might
610  * support and should return the number of actual ports on the
611  * board.
612  *
613  * This function must be modifed for every new Octeon board.
614  * Internally it uses switch statements based on the cvmx_sysinfo
615  * data to determine board types and revisions. It relys on the
616  * fact that every Octeon board receives a unique board type
617  * enumeration from the bootloader.
618  *
619  * @interface: Interface to probe
620  * @supported_ports:
621  *                  Number of ports Octeon supports.
622  *
623  * Returns Number of ports the actual board supports. Many times this will
624  *         simple be "support_ports".
625  */
626 int __cvmx_helper_board_interface_probe(int interface, int supported_ports)
627 {
628         switch (cvmx_sysinfo_get()->board_type) {
629         case CVMX_BOARD_TYPE_CN3005_EVB_HS5:
630                 if (interface == 0)
631                         return 2;
632                 break;
633         case CVMX_BOARD_TYPE_BBGW_REF:
634                 if (interface == 0)
635                         return 2;
636                 break;
637         case CVMX_BOARD_TYPE_NIC_XLE_4G:
638                 if (interface == 0)
639                         return 0;
640                 break;
641                 /* The 2nd interface on the EBH5600 is connected to the Marvel switch,
642                    which we don't support. Disable ports connected to it */
643         case CVMX_BOARD_TYPE_EBH5600:
644                 if (interface == 1)
645                         return 0;
646                 break;
647         }
648         return supported_ports;
649 }
650
651 /**
652  * Enable packet input/output from the hardware. This function is
653  * called after by cvmx_helper_packet_hardware_enable() to
654  * perform board specific initialization. For most boards
655  * nothing is needed.
656  *
657  * @interface: Interface to enable
658  *
659  * Returns Zero on success, negative on failure
660  */
661 int __cvmx_helper_board_hardware_enable(int interface)
662 {
663         if (cvmx_sysinfo_get()->board_type == CVMX_BOARD_TYPE_CN3005_EVB_HS5) {
664                 if (interface == 0) {
665                         /* Different config for switch port */
666                         cvmx_write_csr(CVMX_ASXX_TX_CLK_SETX(1, interface), 0);
667                         cvmx_write_csr(CVMX_ASXX_RX_CLK_SETX(1, interface), 0);
668                         /*
669                          * Boards with gigabit WAN ports need a
670                          * different setting that is compatible with
671                          * 100 Mbit settings
672                          */
673                         cvmx_write_csr(CVMX_ASXX_TX_CLK_SETX(0, interface),
674                                        0xc);
675                         cvmx_write_csr(CVMX_ASXX_RX_CLK_SETX(0, interface),
676                                        0xc);
677                 }
678         } else if (cvmx_sysinfo_get()->board_type ==
679                    CVMX_BOARD_TYPE_CN3010_EVB_HS5) {
680                 /*
681                  * Broadcom PHYs require differnet ASX
682                  * clocks. Unfortunately many boards don't define a
683                  * new board Id and simply mangle the
684                  * CN3010_EVB_HS5
685                  */
686                 if (interface == 0) {
687                         /*
688                          * Some boards use a hacked up bootloader that
689                          * identifies them as CN3010_EVB_HS5
690                          * evaluation boards.  This leads to all kinds
691                          * of configuration problems.  Detect one
692                          * case, and print warning, while trying to do
693                          * the right thing.
694                          */
695                         int phy_addr = cvmx_helper_board_get_mii_address(0);
696                         if (phy_addr != -1) {
697                                 int phy_identifier =
698                                     cvmx_mdio_read(phy_addr >> 8,
699                                                    phy_addr & 0xff, 0x2);
700                                 /* Is it a Broadcom PHY? */
701                                 if (phy_identifier == 0x0143) {
702                                         cvmx_dprintf("\n");
703                                         cvmx_dprintf("ERROR:\n");
704                                         cvmx_dprintf
705                                             ("ERROR: Board type is CVMX_BOARD_TYPE_CN3010_EVB_HS5, but Broadcom PHY found.\n");
706                                         cvmx_dprintf
707                                             ("ERROR: The board type is mis-configured, and software malfunctions are likely.\n");
708                                         cvmx_dprintf
709                                             ("ERROR: All boards require a unique board type to identify them.\n");
710                                         cvmx_dprintf("ERROR:\n");
711                                         cvmx_dprintf("\n");
712                                         cvmx_wait(1000000000);
713                                         cvmx_write_csr(CVMX_ASXX_RX_CLK_SETX
714                                                        (0, interface), 5);
715                                         cvmx_write_csr(CVMX_ASXX_TX_CLK_SETX
716                                                        (0, interface), 5);
717                                 }
718                         }
719                 }
720         } else if (cvmx_sysinfo_get()->board_type ==
721                         CVMX_BOARD_TYPE_UBNT_E100) {
722                 cvmx_write_csr(CVMX_ASXX_RX_CLK_SETX(0, interface), 0);
723                 cvmx_write_csr(CVMX_ASXX_TX_CLK_SETX(0, interface), 0x10);
724                 cvmx_write_csr(CVMX_ASXX_RX_CLK_SETX(1, interface), 0);
725                 cvmx_write_csr(CVMX_ASXX_TX_CLK_SETX(1, interface), 0x10);
726                 cvmx_write_csr(CVMX_ASXX_RX_CLK_SETX(2, interface), 0);
727                 cvmx_write_csr(CVMX_ASXX_TX_CLK_SETX(2, interface), 0x10);
728         }
729         return 0;
730 }
731
732 /**
733  * Get the clock type used for the USB block based on board type.
734  * Used by the USB code for auto configuration of clock type.
735  *
736  * Return USB clock type enumeration
737  */
738 enum cvmx_helper_board_usb_clock_types __cvmx_helper_board_usb_get_clock_type(void)
739 {
740         switch (cvmx_sysinfo_get()->board_type) {
741         case CVMX_BOARD_TYPE_BBGW_REF:
742         case CVMX_BOARD_TYPE_LANAI2_A:
743         case CVMX_BOARD_TYPE_LANAI2_U:
744         case CVMX_BOARD_TYPE_LANAI2_G:
745         case CVMX_BOARD_TYPE_NIC10E_66:
746         case CVMX_BOARD_TYPE_UBNT_E100:
747                 return USB_CLOCK_TYPE_CRYSTAL_12;
748         case CVMX_BOARD_TYPE_NIC10E:
749                 return USB_CLOCK_TYPE_REF_12;
750         default:
751                 break;
752         }
753         /* Most boards except NIC10e use a 12MHz crystal */
754         if (OCTEON_IS_OCTEON2())
755                 return USB_CLOCK_TYPE_CRYSTAL_12;
756         return USB_CLOCK_TYPE_REF_48;
757 }