90 lines
2.2 KiB
C
90 lines
2.2 KiB
C
|
// SPDX-License-Identifier: GPL-2.0+
|
||
|
|
/*
|
||
|
|
* Copyright 2011-2015 Freescale Semiconductor, Inc.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <common.h>
|
||
|
|
#include <linux/libfdt.h>
|
||
|
|
#include <linux/libfdt_env.h>
|
||
|
|
#include <fdt_support.h>
|
||
|
|
|
||
|
|
#include <fm_eth.h>
|
||
|
|
#ifdef CONFIG_FSL_LAYERSCAPE
|
||
|
|
#include <asm/arch/fsl_serdes.h>
|
||
|
|
#else
|
||
|
|
#include <asm/fsl_serdes.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Given the following ...
|
||
|
|
*
|
||
|
|
* 1) A pointer to an Fman Ethernet node (as identified by the 'compat'
|
||
|
|
* compatible string and 'addr' physical address)
|
||
|
|
*
|
||
|
|
* 2) The name of an alias that points to the ethernet-phy node (usually inside
|
||
|
|
* a virtual MDIO node)
|
||
|
|
*
|
||
|
|
* ... update that Ethernet node's phy-handle property to point to the
|
||
|
|
* ethernet-phy node. This is how we link an Ethernet node to its PHY, so each
|
||
|
|
* PHY in a virtual MDIO node must have an alias.
|
||
|
|
*
|
||
|
|
* Returns 0 on success, or a negative FDT error code on error.
|
||
|
|
*/
|
||
|
|
int fdt_set_phy_handle(void *fdt, char *compat, phys_addr_t addr,
|
||
|
|
const char *alias)
|
||
|
|
{
|
||
|
|
int offset;
|
||
|
|
unsigned int ph;
|
||
|
|
const char *path;
|
||
|
|
|
||
|
|
/* Get a path to the node that 'alias' points to */
|
||
|
|
path = fdt_get_alias(fdt, alias);
|
||
|
|
if (!path)
|
||
|
|
return -FDT_ERR_BADPATH;
|
||
|
|
|
||
|
|
/* Get the offset of that node */
|
||
|
|
offset = fdt_path_offset(fdt, path);
|
||
|
|
if (offset < 0)
|
||
|
|
return offset;
|
||
|
|
|
||
|
|
ph = fdt_create_phandle(fdt, offset);
|
||
|
|
if (!ph)
|
||
|
|
return -FDT_ERR_BADPHANDLE;
|
||
|
|
|
||
|
|
ph = cpu_to_fdt32(ph);
|
||
|
|
|
||
|
|
offset = fdt_node_offset_by_compat_reg(fdt, compat, addr);
|
||
|
|
if (offset < 0)
|
||
|
|
return offset;
|
||
|
|
|
||
|
|
return fdt_setprop(fdt, offset, "phy-handle", &ph, sizeof(ph));
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Return the SerDes device enum for a given Fman port
|
||
|
|
*
|
||
|
|
* This function just maps the fm_port namespace to the srds_prtcl namespace.
|
||
|
|
*/
|
||
|
|
enum srds_prtcl serdes_device_from_fm_port(enum fm_port port)
|
||
|
|
{
|
||
|
|
static const enum srds_prtcl srds_table[] = {
|
||
|
|
[FM1_DTSEC1] = SGMII_FM1_DTSEC1,
|
||
|
|
[FM1_DTSEC2] = SGMII_FM1_DTSEC2,
|
||
|
|
[FM1_DTSEC3] = SGMII_FM1_DTSEC3,
|
||
|
|
[FM1_DTSEC4] = SGMII_FM1_DTSEC4,
|
||
|
|
[FM1_DTSEC5] = SGMII_FM1_DTSEC5,
|
||
|
|
[FM1_10GEC1] = XAUI_FM1,
|
||
|
|
[FM2_DTSEC1] = SGMII_FM2_DTSEC1,
|
||
|
|
[FM2_DTSEC2] = SGMII_FM2_DTSEC2,
|
||
|
|
[FM2_DTSEC3] = SGMII_FM2_DTSEC3,
|
||
|
|
[FM2_DTSEC4] = SGMII_FM2_DTSEC4,
|
||
|
|
[FM2_DTSEC5] = SGMII_FM2_DTSEC5,
|
||
|
|
[FM2_10GEC1] = XAUI_FM2,
|
||
|
|
};
|
||
|
|
|
||
|
|
if ((port < FM1_DTSEC1) || (port > FM2_10GEC1))
|
||
|
|
return NONE;
|
||
|
|
else
|
||
|
|
return srds_table[port];
|
||
|
|
}
|