ieee802154/at86rf230: Implement hardware address filter callback.

[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / net / ieee802154 / at86rf230.c

diff --git a/drivers/net/ieee802154/at86rf230.c b/drivers/net/ieee802154/at86rf230.c
index fc1687ea4a42438ff096d1c71dd2ce9355693cd5..2ff1f204af8dc823f8daead9504dbb79bb05d58e 100644 (file)
--- a/drivers/net/ieee802154/at86rf230.c
+++ b/drivers/net/ieee802154/at86rf230.c
@@ -619,6 +619,52 @@ err:
        return -EINVAL;
 }
 
+static int
+at86rf230_set_hw_addr_filt(struct ieee802154_dev *dev,
+                          struct ieee802154_hw_addr_filt *filt,
+                          unsigned long changed)
+{
+       struct at86rf230_local *lp = dev->priv;
+
+       if (changed & IEEE802515_AFILT_SADDR_CHANGED) {
+               dev_vdbg(&lp->spi->dev,
+                       "at86rf230_set_hw_addr_filt called for saddr\n");
+               __at86rf230_write(lp, RG_SHORT_ADDR_0, filt->short_addr);
+               __at86rf230_write(lp, RG_SHORT_ADDR_1, filt->short_addr >> 8);
+       }
+
+       if (changed & IEEE802515_AFILT_PANID_CHANGED) {
+               dev_vdbg(&lp->spi->dev,
+                       "at86rf230_set_hw_addr_filt called for pan id\n");
+               __at86rf230_write(lp, RG_PAN_ID_0, filt->pan_id);
+               __at86rf230_write(lp, RG_PAN_ID_1, filt->pan_id >> 8);
+       }
+
+       if (changed & IEEE802515_AFILT_IEEEADDR_CHANGED) {
+               dev_vdbg(&lp->spi->dev,
+                       "at86rf230_set_hw_addr_filt called for IEEE addr\n");
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_0, filt->ieee_addr[7]);
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_1, filt->ieee_addr[6]);
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_2, filt->ieee_addr[5]);
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_3, filt->ieee_addr[4]);
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_4, filt->ieee_addr[3]);
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_5, filt->ieee_addr[2]);
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_6, filt->ieee_addr[1]);
+               at86rf230_write_subreg(lp, SR_IEEE_ADDR_7, filt->ieee_addr[0]);
+       }
+
+       if (changed & IEEE802515_AFILT_PANC_CHANGED) {
+               dev_vdbg(&lp->spi->dev,
+                       "at86rf230_set_hw_addr_filt called for panc change\n");
+               if (filt->pan_coord)
+                       at86rf230_write_subreg(lp, SR_AACK_I_AM_COORD, 1);
+               else
+                       at86rf230_write_subreg(lp, SR_AACK_I_AM_COORD, 0);
+       }
+
+       return 0;
+}
+
 static struct ieee802154_ops at86rf230_ops = {
        .owner = THIS_MODULE,
        .xmit = at86rf230_xmit,
@@ -626,6 +672,7 @@ static struct ieee802154_ops at86rf230_ops = {
        .set_channel = at86rf230_channel,
        .start = at86rf230_start,
        .stop = at86rf230_stop,
+       .set_hw_addr_filt = at86rf230_set_hw_addr_filt,
 };
 
 static void at86rf230_irqwork(struct work_struct *work)