81 lines · c
1// SPDX-License-Identifier: GPL-2.0+2/*3 * mdio-boardinfo - Collect pre-declarations for MDIO devices4 */5 6#include <linux/kernel.h>7#include <linux/slab.h>8#include <linux/export.h>9#include <linux/mutex.h>10#include <linux/list.h>11 12#include "mdio-boardinfo.h"13 14static LIST_HEAD(mdio_board_list);15static DEFINE_MUTEX(mdio_board_lock);16 17/**18 * mdiobus_setup_mdiodev_from_board_info - create and setup MDIO devices19 * from pre-collected board specific MDIO information20 * @bus: Bus the board_info belongs to21 * @cb: Callback to create device on bus22 * Context: can sleep23 */24void mdiobus_setup_mdiodev_from_board_info(struct mii_bus *bus,25 int (*cb)26 (struct mii_bus *bus,27 struct mdio_board_info *bi))28{29 struct mdio_board_entry *be;30 struct mdio_board_entry *tmp;31 struct mdio_board_info *bi;32 int ret;33 34 mutex_lock(&mdio_board_lock);35 list_for_each_entry_safe(be, tmp, &mdio_board_list, list) {36 bi = &be->board_info;37 38 if (strcmp(bus->id, bi->bus_id))39 continue;40 41 mutex_unlock(&mdio_board_lock);42 ret = cb(bus, bi);43 mutex_lock(&mdio_board_lock);44 if (ret)45 continue;46 47 }48 mutex_unlock(&mdio_board_lock);49}50EXPORT_SYMBOL(mdiobus_setup_mdiodev_from_board_info);51 52/**53 * mdiobus_register_board_info - register MDIO devices for a given board54 * @info: array of devices descriptors55 * @n: number of descriptors provided56 * Context: can sleep57 *58 * The board info passed can be marked with __initdata but be pointers59 * such as platform_data etc. are copied as-is60 */61int mdiobus_register_board_info(const struct mdio_board_info *info,62 unsigned int n)63{64 struct mdio_board_entry *be;65 unsigned int i;66 67 be = kcalloc(n, sizeof(*be), GFP_KERNEL);68 if (!be)69 return -ENOMEM;70 71 for (i = 0; i < n; i++, be++, info++) {72 memcpy(&be->board_info, info, sizeof(*info));73 mutex_lock(&mdio_board_lock);74 list_add_tail(&be->list, &mdio_board_list);75 mutex_unlock(&mdio_board_lock);76 }77 78 return 0;79}80EXPORT_SYMBOL(mdiobus_register_board_info);81