Merge branch 'dsa2-pdata'
Florian Fainelli says: ==================== net: dsa: Support for pdata in dsa2 This is not exactly new, and was sent before, although back then, I did not have an user of the pre-declared MDIO board information, but now we do. Note that I have additional changes queued up to have b53 register platform data for MIPS bcm47xx and bcm63xx. Yes I know that we should have the Orion platforms eventually be converted to Device Tree, but until that happens, I don't want any remaining users of the old "dsa" platform device (hence the previous DTS submissions for ARM/mvebu) and, there will be platforms out there that most likely won't never see DT coming their way (BCM47xx is almost 100% sure, BCM63xx maybe not in a distant future). We would probably want the whole series to be merged via David Miller's tree to simplify things. Thanks! Changes in v5: - dropped changes to drivers/base/ because after more than a month, we cannot get any answer from Greg KH Changes in v4: - Changed device_find_class() to device_find_in_class_name() - Added kerneldoc above device_find_in_class_name() to explain what it does and the calling convention regarding device reference counts - Changed dev_to_net_device to device_to_net_device() added comments about what it does and the caller conventions regarding reference counts Changes in v3: - Tested EPROBE_DEFER from a mockup MDIO/DSA switch driver and everything is fine, once the driver finally probes we have access to platform data as expected - added comment above dsa_port_is_valid() that port->name is mandatory for platform data cases - added an extra check in dsa_parse_member() for a NULL pdata pointer - fixed a bunch of checkpatch errors and warnings Changes in v2: - Rebased against latest net-next/master - Moved dev_find_class() to device_find_class() into drivers/base/core.c - Moved dev_to_net_device into net/core/dev.c - Utilize dsa_chip_data directly instead of dsa_platform_data - Augmented dsa_chip_data to be multi-CPU port ready Changes from last submission (few months back): - rebased against latest net-next - do not introduce dsa2_platform_data which was overkill and was meant to allow us to do exaclty the same things with platform data and Device Tree we use the existing dsa_platform_data instead - properly register MDIO devices when the MDIO bus is registered and associate platform_data with them - add a change to the Orion platform code to demonstrate how this can be used Thank you ==================== Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
commit
521613c568
@ -105,7 +105,7 @@ void __init orion5x_eth_init(struct mv643xx_eth_platform_data *eth_data)
|
||||
/*****************************************************************************
|
||||
* Ethernet switch
|
||||
****************************************************************************/
|
||||
void __init orion5x_eth_switch_init(struct dsa_platform_data *d)
|
||||
void __init orion5x_eth_switch_init(struct dsa_chip_data *d)
|
||||
{
|
||||
orion_ge00_switch_init(d);
|
||||
}
|
||||
|
@ -3,7 +3,7 @@
|
||||
|
||||
#include <linux/reboot.h>
|
||||
|
||||
struct dsa_platform_data;
|
||||
struct dsa_chip_data;
|
||||
struct mv643xx_eth_platform_data;
|
||||
struct mv_sata_platform_data;
|
||||
|
||||
@ -41,7 +41,7 @@ void orion5x_setup_wins(void);
|
||||
void orion5x_ehci0_init(void);
|
||||
void orion5x_ehci1_init(void);
|
||||
void orion5x_eth_init(struct mv643xx_eth_platform_data *eth_data);
|
||||
void orion5x_eth_switch_init(struct dsa_platform_data *d);
|
||||
void orion5x_eth_switch_init(struct dsa_chip_data *d);
|
||||
void orion5x_i2c_init(void);
|
||||
void orion5x_sata_init(struct mv_sata_platform_data *sata_data);
|
||||
void orion5x_spi_init(void);
|
||||
|
@ -101,11 +101,6 @@ static struct dsa_chip_data rd88f5181l_fxo_switch_chip_data = {
|
||||
.port_names[7] = "lan3",
|
||||
};
|
||||
|
||||
static struct dsa_platform_data __initdata rd88f5181l_fxo_switch_plat_data = {
|
||||
.nr_chips = 1,
|
||||
.chip = &rd88f5181l_fxo_switch_chip_data,
|
||||
};
|
||||
|
||||
static void __init rd88f5181l_fxo_init(void)
|
||||
{
|
||||
/*
|
||||
@ -120,7 +115,7 @@ static void __init rd88f5181l_fxo_init(void)
|
||||
*/
|
||||
orion5x_ehci0_init();
|
||||
orion5x_eth_init(&rd88f5181l_fxo_eth_data);
|
||||
orion5x_eth_switch_init(&rd88f5181l_fxo_switch_plat_data);
|
||||
orion5x_eth_switch_init(&rd88f5181l_fxo_switch_chip_data);
|
||||
orion5x_uart0_init();
|
||||
|
||||
mvebu_mbus_add_window_by_id(ORION_MBUS_DEVBUS_BOOT_TARGET,
|
||||
|
@ -102,11 +102,6 @@ static struct dsa_chip_data rd88f5181l_ge_switch_chip_data = {
|
||||
.port_names[7] = "lan3",
|
||||
};
|
||||
|
||||
static struct dsa_platform_data __initdata rd88f5181l_ge_switch_plat_data = {
|
||||
.nr_chips = 1,
|
||||
.chip = &rd88f5181l_ge_switch_chip_data,
|
||||
};
|
||||
|
||||
static struct i2c_board_info __initdata rd88f5181l_ge_i2c_rtc = {
|
||||
I2C_BOARD_INFO("ds1338", 0x68),
|
||||
};
|
||||
@ -125,7 +120,7 @@ static void __init rd88f5181l_ge_init(void)
|
||||
*/
|
||||
orion5x_ehci0_init();
|
||||
orion5x_eth_init(&rd88f5181l_ge_eth_data);
|
||||
orion5x_eth_switch_init(&rd88f5181l_ge_switch_plat_data);
|
||||
orion5x_eth_switch_init(&rd88f5181l_ge_switch_chip_data);
|
||||
orion5x_i2c_init();
|
||||
orion5x_uart0_init();
|
||||
|
||||
|
@ -40,11 +40,6 @@ static struct dsa_chip_data rd88f6183ap_ge_switch_chip_data = {
|
||||
.port_names[5] = "cpu",
|
||||
};
|
||||
|
||||
static struct dsa_platform_data __initdata rd88f6183ap_ge_switch_plat_data = {
|
||||
.nr_chips = 1,
|
||||
.chip = &rd88f6183ap_ge_switch_chip_data,
|
||||
};
|
||||
|
||||
static struct mtd_partition rd88f6183ap_ge_partitions[] = {
|
||||
{
|
||||
.name = "kernel",
|
||||
@ -89,7 +84,7 @@ static void __init rd88f6183ap_ge_init(void)
|
||||
*/
|
||||
orion5x_ehci0_init();
|
||||
orion5x_eth_init(&rd88f6183ap_ge_eth_data);
|
||||
orion5x_eth_switch_init(&rd88f6183ap_ge_switch_plat_data);
|
||||
orion5x_eth_switch_init(&rd88f6183ap_ge_switch_chip_data);
|
||||
spi_register_board_info(rd88f6183ap_ge_spi_slave_info,
|
||||
ARRAY_SIZE(rd88f6183ap_ge_spi_slave_info));
|
||||
orion5x_spi_init();
|
||||
|
@ -124,7 +124,7 @@ static void __init wnr854t_init(void)
|
||||
* Configure peripherals.
|
||||
*/
|
||||
orion5x_eth_init(&wnr854t_eth_data);
|
||||
orion5x_eth_switch_init(&wnr854t_switch_plat_data);
|
||||
orion5x_eth_switch_init(&wnr854t_switch_chip_data);
|
||||
orion5x_uart0_init();
|
||||
|
||||
mvebu_mbus_add_window_by_id(ORION_MBUS_DEVBUS_BOOT_TARGET,
|
||||
|
@ -191,11 +191,6 @@ static struct dsa_chip_data wrt350n_v2_switch_chip_data = {
|
||||
.port_names[7] = "lan4",
|
||||
};
|
||||
|
||||
static struct dsa_platform_data __initdata wrt350n_v2_switch_plat_data = {
|
||||
.nr_chips = 1,
|
||||
.chip = &wrt350n_v2_switch_chip_data,
|
||||
};
|
||||
|
||||
static void __init wrt350n_v2_init(void)
|
||||
{
|
||||
/*
|
||||
@ -210,7 +205,7 @@ static void __init wrt350n_v2_init(void)
|
||||
*/
|
||||
orion5x_ehci0_init();
|
||||
orion5x_eth_init(&wrt350n_v2_eth_data);
|
||||
orion5x_eth_switch_init(&wrt350n_v2_switch_plat_data);
|
||||
orion5x_eth_switch_init(&wrt350n_v2_switch_chip_data);
|
||||
orion5x_uart0_init();
|
||||
|
||||
mvebu_mbus_add_window_by_id(ORION_MBUS_DEVBUS_BOOT_TARGET,
|
||||
|
@ -22,6 +22,7 @@
|
||||
#include <linux/platform_data/dma-mv_xor.h>
|
||||
#include <linux/platform_data/usb-ehci-orion.h>
|
||||
#include <plat/common.h>
|
||||
#include <linux/phy.h>
|
||||
|
||||
/* Create a clkdev entry for a given device/clk */
|
||||
void __init orion_clkdev_add(const char *con_id, const char *dev_id,
|
||||
@ -470,15 +471,27 @@ void __init orion_ge11_init(struct mv643xx_eth_platform_data *eth_data,
|
||||
/*****************************************************************************
|
||||
* Ethernet switch
|
||||
****************************************************************************/
|
||||
void __init orion_ge00_switch_init(struct dsa_platform_data *d)
|
||||
static __initconst const char *orion_ge00_mvmdio_bus_name = "orion-mii";
|
||||
static __initdata struct mdio_board_info
|
||||
orion_ge00_switch_board_info;
|
||||
|
||||
void __init orion_ge00_switch_init(struct dsa_chip_data *d)
|
||||
{
|
||||
int i;
|
||||
struct mdio_board_info *bd;
|
||||
unsigned int i;
|
||||
|
||||
d->netdev = &orion_ge00.dev;
|
||||
for (i = 0; i < d->nr_chips; i++)
|
||||
d->chip[i].host_dev = &orion_ge_mvmdio.dev;
|
||||
for (i = 0; i < ARRAY_SIZE(d->port_names); i++)
|
||||
if (!strcmp(d->port_names[i], "cpu"))
|
||||
break;
|
||||
|
||||
platform_device_register_data(NULL, "dsa", 0, d, sizeof(d));
|
||||
bd = &orion_ge00_switch_board_info;
|
||||
bd->bus_id = orion_ge00_mvmdio_bus_name;
|
||||
bd->mdio_addr = d->sw_addr;
|
||||
d->netdev[i] = &orion_ge00.dev;
|
||||
strcpy(bd->modalias, "mv88e6085");
|
||||
bd->platform_data = d;
|
||||
|
||||
mdiobus_register_board_info(&orion_ge00_switch_board_info, 1);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
@ -12,7 +12,7 @@
|
||||
#include <linux/mv643xx_eth.h>
|
||||
#include <linux/platform_data/usb-ehci-orion.h>
|
||||
|
||||
struct dsa_platform_data;
|
||||
struct dsa_chip_data;
|
||||
struct mv_sata_platform_data;
|
||||
|
||||
void __init orion_uart0_init(void __iomem *membase,
|
||||
@ -57,7 +57,7 @@ void __init orion_ge11_init(struct mv643xx_eth_platform_data *eth_data,
|
||||
unsigned long mapbase,
|
||||
unsigned long irq);
|
||||
|
||||
void __init orion_ge00_switch_init(struct dsa_platform_data *d);
|
||||
void __init orion_ge00_switch_init(struct dsa_chip_data *d);
|
||||
|
||||
void __init orion_i2c_init(unsigned long mapbase,
|
||||
unsigned long irq,
|
||||
|
@ -1,6 +1,7 @@
|
||||
# Makefile for Linux PHY drivers and MDIO bus drivers
|
||||
|
||||
libphy-y := phy.o phy_device.o mdio_bus.o mdio_device.o
|
||||
libphy-y := phy.o phy_device.o mdio_bus.o mdio_device.o \
|
||||
mdio-boardinfo.o
|
||||
libphy-$(CONFIG_SWPHY) += swphy.o
|
||||
libphy-$(CONFIG_LED_TRIGGER_PHY) += phy_led_triggers.o
|
||||
|
||||
|
86
drivers/net/phy/mdio-boardinfo.c
Normal file
86
drivers/net/phy/mdio-boardinfo.c
Normal file
@ -0,0 +1,86 @@
|
||||
/*
|
||||
* mdio-boardinfo - Collect pre-declarations for MDIO devices
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/export.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/list.h>
|
||||
|
||||
#include "mdio-boardinfo.h"
|
||||
|
||||
static LIST_HEAD(mdio_board_list);
|
||||
static DEFINE_MUTEX(mdio_board_lock);
|
||||
|
||||
/**
|
||||
* mdiobus_setup_mdiodev_from_board_info - create and setup MDIO devices
|
||||
* from pre-collected board specific MDIO information
|
||||
* @mdiodev: MDIO device pointer
|
||||
* Context: can sleep
|
||||
*/
|
||||
void mdiobus_setup_mdiodev_from_board_info(struct mii_bus *bus)
|
||||
{
|
||||
struct mdio_board_entry *be;
|
||||
struct mdio_device *mdiodev;
|
||||
struct mdio_board_info *bi;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&mdio_board_lock);
|
||||
list_for_each_entry(be, &mdio_board_list, list) {
|
||||
bi = &be->board_info;
|
||||
|
||||
if (strcmp(bus->id, bi->bus_id))
|
||||
continue;
|
||||
|
||||
mdiodev = mdio_device_create(bus, bi->mdio_addr);
|
||||
if (IS_ERR(mdiodev))
|
||||
continue;
|
||||
|
||||
strncpy(mdiodev->modalias, bi->modalias,
|
||||
sizeof(mdiodev->modalias));
|
||||
mdiodev->bus_match = mdio_device_bus_match;
|
||||
mdiodev->dev.platform_data = (void *)bi->platform_data;
|
||||
|
||||
ret = mdio_device_register(mdiodev);
|
||||
if (ret) {
|
||||
mdio_device_free(mdiodev);
|
||||
continue;
|
||||
}
|
||||
}
|
||||
mutex_unlock(&mdio_board_lock);
|
||||
}
|
||||
|
||||
/**
|
||||
* mdio_register_board_info - register MDIO devices for a given board
|
||||
* @info: array of devices descriptors
|
||||
* @n: number of descriptors provided
|
||||
* Context: can sleep
|
||||
*
|
||||
* The board info passed can be marked with __initdata but be pointers
|
||||
* such as platform_data etc. are copied as-is
|
||||
*/
|
||||
int mdiobus_register_board_info(const struct mdio_board_info *info,
|
||||
unsigned int n)
|
||||
{
|
||||
struct mdio_board_entry *be;
|
||||
unsigned int i;
|
||||
|
||||
be = kcalloc(n, sizeof(*be), GFP_KERNEL);
|
||||
if (!be)
|
||||
return -ENOMEM;
|
||||
|
||||
for (i = 0; i < n; i++, be++, info++) {
|
||||
memcpy(&be->board_info, info, sizeof(*info));
|
||||
mutex_lock(&mdio_board_lock);
|
||||
list_add_tail(&be->list, &mdio_board_list);
|
||||
mutex_unlock(&mdio_board_lock);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
19
drivers/net/phy/mdio-boardinfo.h
Normal file
19
drivers/net/phy/mdio-boardinfo.h
Normal file
@ -0,0 +1,19 @@
|
||||
/*
|
||||
* mdio-boardinfo.h - board info interface internal to the mdio_bus
|
||||
* component
|
||||
*/
|
||||
|
||||
#ifndef __MDIO_BOARD_INFO_H
|
||||
#define __MDIO_BOARD_INFO_H
|
||||
|
||||
#include <linux/phy.h>
|
||||
#include <linux/mutex.h>
|
||||
|
||||
struct mdio_board_entry {
|
||||
struct list_head list;
|
||||
struct mdio_board_info board_info;
|
||||
};
|
||||
|
||||
void mdiobus_setup_mdiodev_from_board_info(struct mii_bus *bus);
|
||||
|
||||
#endif /* __MDIO_BOARD_INFO_H */
|
@ -41,6 +41,8 @@
|
||||
#define CREATE_TRACE_POINTS
|
||||
#include <trace/events/mdio.h>
|
||||
|
||||
#include "mdio-boardinfo.h"
|
||||
|
||||
int mdiobus_register_device(struct mdio_device *mdiodev)
|
||||
{
|
||||
if (mdiodev->bus->mdio_map[mdiodev->addr])
|
||||
@ -343,6 +345,8 @@ int __mdiobus_register(struct mii_bus *bus, struct module *owner)
|
||||
}
|
||||
}
|
||||
|
||||
mdiobus_setup_mdiodev_from_board_info(bus);
|
||||
|
||||
bus->state = MDIOBUS_REGISTERED;
|
||||
pr_info("%s: probed\n", bus->name);
|
||||
return 0;
|
||||
|
@ -34,6 +34,17 @@ static void mdio_device_release(struct device *dev)
|
||||
kfree(to_mdio_device(dev));
|
||||
}
|
||||
|
||||
int mdio_device_bus_match(struct device *dev, struct device_driver *drv)
|
||||
{
|
||||
struct mdio_device *mdiodev = to_mdio_device(dev);
|
||||
struct mdio_driver *mdiodrv = to_mdio_driver(drv);
|
||||
|
||||
if (mdiodrv->mdiodrv.flags & MDIO_DEVICE_IS_PHY)
|
||||
return 0;
|
||||
|
||||
return strcmp(mdiodev->modalias, drv->name) == 0;
|
||||
}
|
||||
|
||||
struct mdio_device *mdio_device_create(struct mii_bus *bus, int addr)
|
||||
{
|
||||
struct mdio_device *mdiodev;
|
||||
|
@ -10,6 +10,7 @@
|
||||
#define __LINUX_MDIO_H__
|
||||
|
||||
#include <uapi/linux/mdio.h>
|
||||
#include <linux/mod_devicetable.h>
|
||||
|
||||
struct mii_bus;
|
||||
|
||||
@ -29,6 +30,7 @@ struct mdio_device {
|
||||
|
||||
const struct dev_pm_ops *pm_ops;
|
||||
struct mii_bus *bus;
|
||||
char modalias[MDIO_NAME_SIZE];
|
||||
|
||||
int (*bus_match)(struct device *dev, struct device_driver *drv);
|
||||
void (*device_free)(struct mdio_device *mdiodev);
|
||||
@ -71,6 +73,7 @@ int mdio_device_register(struct mdio_device *mdiodev);
|
||||
void mdio_device_remove(struct mdio_device *mdiodev);
|
||||
int mdio_driver_register(struct mdio_driver *drv);
|
||||
void mdio_driver_unregister(struct mdio_driver *drv);
|
||||
int mdio_device_bus_match(struct device *dev, struct device_driver *drv);
|
||||
|
||||
static inline bool mdio_phy_id_is_c45(int phy_id)
|
||||
{
|
||||
|
@ -501,6 +501,7 @@ struct platform_device_id {
|
||||
kernel_ulong_t driver_data;
|
||||
};
|
||||
|
||||
#define MDIO_NAME_SIZE 32
|
||||
#define MDIO_MODULE_PREFIX "mdio:"
|
||||
|
||||
#define MDIO_ID_FMT "%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d%d"
|
||||
|
@ -886,6 +886,25 @@ void mdio_bus_exit(void);
|
||||
|
||||
extern struct bus_type mdio_bus_type;
|
||||
|
||||
struct mdio_board_info {
|
||||
const char *bus_id;
|
||||
char modalias[MDIO_NAME_SIZE];
|
||||
int mdio_addr;
|
||||
const void *platform_data;
|
||||
};
|
||||
|
||||
#if IS_ENABLED(CONFIG_PHYLIB)
|
||||
int mdiobus_register_board_info(const struct mdio_board_info *info,
|
||||
unsigned int n);
|
||||
#else
|
||||
static inline int mdiobus_register_board_info(const struct mdio_board_info *i,
|
||||
unsigned int n)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/**
|
||||
* module_phy_driver() - Helper macro for registering PHY drivers
|
||||
* @__phy_drivers: array of PHY drivers to register
|
||||
|
@ -45,6 +45,11 @@ struct dsa_chip_data {
|
||||
struct device *host_dev;
|
||||
int sw_addr;
|
||||
|
||||
/*
|
||||
* Reference to network devices
|
||||
*/
|
||||
struct device *netdev[DSA_MAX_PORTS];
|
||||
|
||||
/* set to size of eeprom if supported by the switch */
|
||||
int eeprom_len;
|
||||
|
||||
@ -170,6 +175,7 @@ struct dsa_mall_tc_entry {
|
||||
struct dsa_port {
|
||||
struct dsa_switch *ds;
|
||||
unsigned int index;
|
||||
const char *name;
|
||||
struct net_device *netdev;
|
||||
struct device_node *dn;
|
||||
unsigned int ageing_time;
|
||||
@ -445,6 +451,7 @@ struct dsa_switch_driver {
|
||||
void register_switch_driver(struct dsa_switch_driver *type);
|
||||
void unregister_switch_driver(struct dsa_switch_driver *type);
|
||||
struct mii_bus *dsa_host_dev_to_mii_bus(struct device *dev);
|
||||
struct net_device *dsa_dev_to_net_device(struct device *dev);
|
||||
|
||||
static inline bool dsa_uses_tagged_protocol(struct dsa_switch_tree *dst)
|
||||
{
|
||||
|
@ -492,7 +492,7 @@ struct mii_bus *dsa_host_dev_to_mii_bus(struct device *dev)
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(dsa_host_dev_to_mii_bus);
|
||||
|
||||
static struct net_device *dev_to_net_device(struct device *dev)
|
||||
struct net_device *dsa_dev_to_net_device(struct device *dev)
|
||||
{
|
||||
struct device *d;
|
||||
|
||||
@ -509,6 +509,7 @@ static struct net_device *dev_to_net_device(struct device *dev)
|
||||
|
||||
return NULL;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(dsa_dev_to_net_device);
|
||||
|
||||
#ifdef CONFIG_OF
|
||||
static int dsa_of_setup_routing_table(struct dsa_platform_data *pd,
|
||||
@ -817,7 +818,7 @@ static int dsa_probe(struct platform_device *pdev)
|
||||
dev = pd->of_netdev;
|
||||
dev_hold(dev);
|
||||
} else {
|
||||
dev = dev_to_net_device(pd->netdev);
|
||||
dev = dsa_dev_to_net_device(pd->netdev);
|
||||
}
|
||||
if (dev == NULL) {
|
||||
ret = -EPROBE_DEFER;
|
||||
|
102
net/dsa/dsa2.c
102
net/dsa/dsa2.c
@ -78,19 +78,28 @@ static void dsa_dst_del_ds(struct dsa_switch_tree *dst,
|
||||
kref_put(&dst->refcount, dsa_free_dst);
|
||||
}
|
||||
|
||||
/* For platform data configurations, we need to have a valid name argument to
|
||||
* differentiate a disabled port from an enabled one
|
||||
*/
|
||||
static bool dsa_port_is_valid(struct dsa_port *port)
|
||||
{
|
||||
return !!port->dn;
|
||||
return !!(port->dn || port->name);
|
||||
}
|
||||
|
||||
static bool dsa_port_is_dsa(struct dsa_port *port)
|
||||
{
|
||||
return !!of_parse_phandle(port->dn, "link", 0);
|
||||
if (port->name && !strcmp(port->name, "dsa"))
|
||||
return true;
|
||||
else
|
||||
return !!of_parse_phandle(port->dn, "link", 0);
|
||||
}
|
||||
|
||||
static bool dsa_port_is_cpu(struct dsa_port *port)
|
||||
{
|
||||
return !!of_parse_phandle(port->dn, "ethernet", 0);
|
||||
if (port->name && !strcmp(port->name, "cpu"))
|
||||
return true;
|
||||
else
|
||||
return !!of_parse_phandle(port->dn, "ethernet", 0);
|
||||
}
|
||||
|
||||
static bool dsa_ds_find_port_dn(struct dsa_switch *ds,
|
||||
@ -250,10 +259,11 @@ static void dsa_cpu_port_unapply(struct dsa_port *port, u32 index,
|
||||
static int dsa_user_port_apply(struct dsa_port *port, u32 index,
|
||||
struct dsa_switch *ds)
|
||||
{
|
||||
const char *name;
|
||||
const char *name = port->name;
|
||||
int err;
|
||||
|
||||
name = of_get_property(port->dn, "label", NULL);
|
||||
if (port->dn)
|
||||
name = of_get_property(port->dn, "label", NULL);
|
||||
if (!name)
|
||||
name = "eth%d";
|
||||
|
||||
@ -444,11 +454,16 @@ static int dsa_cpu_parse(struct dsa_port *port, u32 index,
|
||||
struct net_device *ethernet_dev;
|
||||
struct device_node *ethernet;
|
||||
|
||||
ethernet = of_parse_phandle(port->dn, "ethernet", 0);
|
||||
if (!ethernet)
|
||||
return -EINVAL;
|
||||
if (port->dn) {
|
||||
ethernet = of_parse_phandle(port->dn, "ethernet", 0);
|
||||
if (!ethernet)
|
||||
return -EINVAL;
|
||||
ethernet_dev = of_find_net_device_by_node(ethernet);
|
||||
} else {
|
||||
ethernet_dev = dsa_dev_to_net_device(ds->cd->netdev[index]);
|
||||
dev_put(ethernet_dev);
|
||||
}
|
||||
|
||||
ethernet_dev = of_find_net_device_by_node(ethernet);
|
||||
if (!ethernet_dev)
|
||||
return -EPROBE_DEFER;
|
||||
|
||||
@ -551,6 +566,33 @@ static int dsa_parse_ports_dn(struct device_node *ports, struct dsa_switch *ds)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dsa_parse_ports(struct dsa_chip_data *cd, struct dsa_switch *ds)
|
||||
{
|
||||
bool valid_name_found = false;
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < DSA_MAX_PORTS; i++) {
|
||||
if (!cd->port_names[i])
|
||||
continue;
|
||||
|
||||
ds->ports[i].name = cd->port_names[i];
|
||||
|
||||
/* Initialize enabled_port_mask now for drv->setup()
|
||||
* to have access to a correct value, just like what
|
||||
* net/dsa/dsa.c::dsa_switch_setup_one does.
|
||||
*/
|
||||
if (!dsa_port_is_cpu(&ds->ports[i]))
|
||||
ds->enabled_port_mask |= 1 << i;
|
||||
|
||||
valid_name_found = true;
|
||||
}
|
||||
|
||||
if (!valid_name_found && i == DSA_MAX_PORTS)
|
||||
return -EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dsa_parse_member_dn(struct device_node *np, u32 *tree, u32 *index)
|
||||
{
|
||||
int err;
|
||||
@ -575,6 +617,18 @@ static int dsa_parse_member_dn(struct device_node *np, u32 *tree, u32 *index)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dsa_parse_member(struct dsa_chip_data *pd, u32 *tree, u32 *index)
|
||||
{
|
||||
if (!pd)
|
||||
return -ENODEV;
|
||||
|
||||
/* We do not support complex trees with dsa_chip_data */
|
||||
*tree = 0;
|
||||
*index = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct device_node *dsa_get_ports(struct dsa_switch *ds,
|
||||
struct device_node *np)
|
||||
{
|
||||
@ -591,23 +645,34 @@ static struct device_node *dsa_get_ports(struct dsa_switch *ds,
|
||||
|
||||
static int _dsa_register_switch(struct dsa_switch *ds, struct device *dev)
|
||||
{
|
||||
struct dsa_chip_data *pdata = dev->platform_data;
|
||||
struct device_node *np = dev->of_node;
|
||||
struct dsa_switch_tree *dst;
|
||||
struct device_node *ports;
|
||||
u32 tree, index;
|
||||
int i, err;
|
||||
|
||||
err = dsa_parse_member_dn(np, &tree, &index);
|
||||
if (err)
|
||||
return err;
|
||||
if (np) {
|
||||
err = dsa_parse_member_dn(np, &tree, &index);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ports = dsa_get_ports(ds, np);
|
||||
if (IS_ERR(ports))
|
||||
return PTR_ERR(ports);
|
||||
ports = dsa_get_ports(ds, np);
|
||||
if (IS_ERR(ports))
|
||||
return PTR_ERR(ports);
|
||||
|
||||
err = dsa_parse_ports_dn(ports, ds);
|
||||
if (err)
|
||||
return err;
|
||||
err = dsa_parse_ports_dn(ports, ds);
|
||||
if (err)
|
||||
return err;
|
||||
} else {
|
||||
err = dsa_parse_member(pdata, &tree, &index);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = dsa_parse_ports(pdata, ds);
|
||||
if (err)
|
||||
return err;
|
||||
}
|
||||
|
||||
dst = dsa_get_dst(tree);
|
||||
if (!dst) {
|
||||
@ -623,6 +688,7 @@ static int _dsa_register_switch(struct dsa_switch *ds, struct device *dev)
|
||||
|
||||
ds->dst = dst;
|
||||
ds->index = index;
|
||||
ds->cd = pdata;
|
||||
|
||||
/* Initialize the routing table */
|
||||
for (i = 0; i < DSA_MAX_SWITCHES; ++i)
|
||||
|
Loading…
Reference in New Issue
Block a user