Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 81f95103 authored by Dmitry Eremin-Solenikov's avatar Dmitry Eremin-Solenikov
Browse files

fakehard: add binding to wpan-phy device 



Make fakehard create and maintain wpan-phy node, thus representing
it's phy in the sysfs.

Signed-off-by: default avatarDmitry Eremin-Solenikov <dbaryshkov@gmail.com>
parent 2bfb1070

drivers/ieee802154/fakehard.c

+46 −6
Original line number Diff line number Diff line
@@ -30,6 +30,12 @@ 
#include <net/ieee802154_netdev.h>

#include <net/ieee802154.h>

#include <net/nl802154.h>

#include <net/wpan-phy.h>



struct wpan_phy *net_to_phy(struct net_device *dev)

{

	return container_of(dev->dev.parent, struct wpan_phy, dev);

}



/**

 * fake_get_pan_id - Retrieve the PAN ID of the device.
@@ -115,6 +121,12 @@ static u8 fake_get_bsn(struct net_device *dev) 
static int fake_assoc_req(struct net_device *dev,

		struct ieee802154_addr *addr, u8 channel, u8 cap)

{

	struct wpan_phy *phy = net_to_phy(dev);



	mutex_lock(&phy->pib_lock);

	phy->current_channel = channel;

	mutex_unlock(&phy->pib_lock);



	/* We simply emulate it here */

	return ieee802154_nl_assoc_confirm(dev, fake_get_short_addr(dev),

			IEEE802154_SUCCESS);
@@ -183,6 +195,12 @@ static int fake_start_req(struct net_device *dev, struct ieee802154_addr *addr, 
				u8 bcn_ord, u8 sf_ord, u8 pan_coord, u8 blx,

				u8 coord_realign)

{

	struct wpan_phy *phy = net_to_phy(dev);



	mutex_lock(&phy->pib_lock);

	phy->current_channel = channel;

	mutex_unlock(&phy->pib_lock);



	/* We don't emulate beacons here at all, so START should fail */

	ieee802154_nl_start_confirm(dev, IEEE802154_INVALID_PARAMETER);

	return 0;
@@ -290,6 +308,14 @@ static const struct net_device_ops fake_ops = { 
	.ndo_set_mac_address	= ieee802154_fake_mac_addr,

};



static void ieee802154_fake_destruct(struct net_device *dev)

{

	struct wpan_phy *phy = net_to_phy(dev);



	wpan_phy_unregister(phy);

	free_netdev(dev);

	wpan_phy_free(phy);

}



static void ieee802154_fake_setup(struct net_device *dev)

{
@@ -302,22 +328,34 @@ static void ieee802154_fake_setup(struct net_device *dev) 
	dev->type		= ARPHRD_IEEE802154;

	dev->flags		= IFF_NOARP | IFF_BROADCAST;

	dev->watchdog_timeo	= 0;

	dev->destructor		= ieee802154_fake_destruct;

}





static int __devinit ieee802154fake_probe(struct platform_device *pdev)

{

	struct net_device *dev =

		alloc_netdev(0, "hardwpan%d", ieee802154_fake_setup);

	struct net_device *dev;

	struct wpan_phy *phy = wpan_phy_alloc(0);

	int err;



	if (!dev)

	if (!phy)

		return -ENOMEM;



	dev = alloc_netdev(0, "hardwpan%d", ieee802154_fake_setup);

	if (!dev) {

		wpan_phy_free(phy);

		return -ENOMEM;

	}



	phy->dev.platform_data = dev;



	memcpy(dev->dev_addr, "\xba\xbe\xca\xfe\xde\xad\xbe\xef",

			dev->addr_len);

	memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);



	phy->channels_supported = (1 << 27) - 1;

	phy->transmit_power = 0xbf;



	dev->netdev_ops = &fake_ops;

	dev->ml_priv = &fake_mlme;
@@ -331,15 +369,18 @@ static int __devinit ieee802154fake_probe(struct platform_device *pdev) 
			goto out;

	}



	SET_NETDEV_DEV(dev, &pdev->dev);

	SET_NETDEV_DEV(dev, &phy->dev);



	platform_set_drvdata(pdev, dev);



	err = wpan_phy_register(&pdev->dev, phy);

	if (err)

		goto out;



	err = register_netdev(dev);

	if (err < 0)

		goto out;





	dev_info(&pdev->dev, "Added ieee802154 HardMAC hardware\n");

	return 0;
@@ -352,7 +393,6 @@ static int __devexit ieee802154fake_remove(struct platform_device *pdev) 
{

	struct net_device *dev = platform_get_drvdata(pdev);

	unregister_netdev(dev);

	free_netdev(dev);

	return 0;

}