rtems/rtems-libbsd
1
0
Fork 0
mirror of https://git.rtems.org/rtems-libbsd/ synced 2025-07-23 00:15:59 +08:00
Code Issues Packages Projects Releases Wiki Activity

dpaa: Get c45 ids

Browse Source
This commit is contained in:
Sebastian Huber 2017-05-24 13:16:11 +02:00
parent 03d142659f
commit 07c8680872
1 changed files with 108 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

108
rtemsbsd/sys/powerpc/fdt_phy.c
View File

@ -331,6 +331,108 @@ find_mdio_bus(const void *fdt, int mdio_node,
return (0);
}
#define MDIO_C45_DEVID1 2
#define MDIO_C45_DEVID2 3
#define MDIO_C45_DEVINPKG1 5
#define MDIO_C45_DEVINPKG2 6
struct phy_c45_device_ids {
uint32_t devices_in_package;
uint32_t device_ids[8];
};
static int
c45_get_devices_in_package(struct phy_device *phy_dev, int dev, uint32_t *dip)
{
int val;
int reg;
reg = (dev << 16) | MDIO_C45_DEVINPKG2;
val = phy_read(phy_dev, reg);
if (val < 0) {
return (-EIO);
}
*dip = (uint32_t)((val & 0xffff) << 16);
reg = (dev << 16) | MDIO_C45_DEVINPKG1;
val = phy_read(phy_dev, reg);
if (val < 0) {
return (-EIO);
}
*dip |= (uint32_t)(val & 0xffff);
return (0);
}
static int
c45_get_id(struct phy_device *phy_dev, int dev, uint32_t *id)
{
int val;
int reg;
reg = (dev << 16) | MDIO_C45_DEVID1;
val = phy_read(phy_dev, reg);
if (val < 0) {
return (-EIO);
}
*id = (uint32_t)((val & 0xffff) << 16);
reg = (dev << 16) | MDIO_C45_DEVID2;
val = phy_read(phy_dev, reg);
if (val < 0) {
return (-EIO);
}
*id |= (uint32_t)(val & 0xffff);
return (0);
}
static bool
c45_has_no_dip(const uint32_t *dip)
{
return ((*dip & 0x1fffffff) == 0x1fffffff);
}
static int
c45_get_ids(struct phy_device *phy_dev, struct phy_c45_device_ids *ids)
{
int i;
int err;
for (i = 1; i < ARRAY_SIZE(ids->device_ids) &&
ids->devices_in_package == 0; ++i) {
err = c45_get_devices_in_package(phy_dev, i,
&ids->devices_in_package);
if (err != 0) {
return (err);
}
if (c45_has_no_dip(&ids->devices_in_package)) {
err = c45_get_devices_in_package(phy_dev, 0,
&ids->devices_in_package);
if (err != 0) {
return (err);
}
if (c45_has_no_dip(&ids->devices_in_package)) {
return (-EIO);
}
break;
}
}
for (i = 1; i < ARRAY_SIZE(ids->device_ids); ++i) {
if ((ids->devices_in_package & (1U << i)) != 0) {
err = c45_get_id(phy_dev, i, &ids->device_ids[i]);
if (err != 0) {
return (err);
}
}
}
return (0);
}
static struct phy_device *
phy_obtain(const void *fdt, int is_c45, int mdio_node, int addr)
{
@ -353,6 +455,12 @@ phy_obtain(const void *fdt, int is_c45, int mdio_node, int addr)
return (NULL);
}
if (is_c45) {
struct phy_c45_device_ids ids = { 0 };
c45_get_ids(phy_dev, &ids);
}
return (phy_dev);
}