#include <linux/list.h>
#include <linux/phy.h>
#include <linux/slab.h>
#include <linux/string.h>
#include "phylib-internal.h"
static struct list_head phy_fixup_list __ro_after_init =
LIST_HEAD_INIT(phy_fixup_list);
struct phy_fixup {
struct list_head list;
char bus_id[MII_BUS_ID_SIZE + 3];
u32 phy_uid;
u32 phy_uid_mask;
int (*run)(struct phy_device *phydev);
};
static void __init phy_register_fixup(const char *bus_id, u32 phy_uid,
u32 phy_uid_mask,
int (*run)(struct phy_device *))
{
struct phy_fixup *fixup = kzalloc_obj(*fixup);
if (!fixup)
return;
if (bus_id)
strscpy(fixup->bus_id, bus_id);
fixup->phy_uid = phy_uid;
fixup->phy_uid_mask = phy_uid_mask;
fixup->run = run;
list_add_tail(&fixup->list, &phy_fixup_list);
}
void __init phy_register_fixup_for_uid(u32 phy_uid, u32 phy_uid_mask,
int (*run)(struct phy_device *))
{
phy_register_fixup(NULL, phy_uid, phy_uid_mask, run);
}
void __init phy_register_fixup_for_id(const char *bus_id,
int (*run)(struct phy_device *))
{
phy_register_fixup(bus_id, 0, 0, run);
}
static bool phy_needs_fixup(struct phy_device *phydev, struct phy_fixup *fixup)
{
if (!strcmp(fixup->bus_id, phydev_name(phydev)))
return true;
if (fixup->phy_uid_mask &&
phy_id_compare(phydev->phy_id, fixup->phy_uid, fixup->phy_uid_mask))
return true;
return false;
}
int phy_scan_fixups(struct phy_device *phydev)
{
struct phy_fixup *fixup;
list_for_each_entry(fixup, &phy_fixup_list, list) {
if (phy_needs_fixup(phydev, fixup)) {
int err = fixup->run(phydev);
if (err < 0)
return err;
phydev->has_fixups = true;
}
}
return 0;
}
EXPORT_SYMBOL_GPL