These changes are the raw update to linux-4.4.6-rt14. Kernel sources

[kvmfornfv.git] / kernel / drivers / net / wireless / mediatek / mt7601u / core.c

diff --git a/kernel/drivers/net/wireless/mediatek/mt7601u/core.c b/kernel/drivers/net/wireless/mediatek/mt7601u/core.c
new file mode 100644 (file)
index 0000000..0aabd79
--- /dev/null
+++ b/kernel/drivers/net/wireless/mediatek/mt7601u/core.c
@@ -0,0 +1,78 @@
+/*
+ * Copyright (C) 2014 Felix Fietkau <nbd@openwrt.org>
+ * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2
+ * as published by the Free Software Foundation
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include "mt7601u.h"
+
+int mt7601u_wait_asic_ready(struct mt7601u_dev *dev)
+{
+       int i = 100;
+       u32 val;
+
+       do {
+               if (test_bit(MT7601U_STATE_REMOVED, &dev->state))
+                       return -EIO;
+
+               val = mt7601u_rr(dev, MT_MAC_CSR0);
+               if (val && ~val)
+                       return 0;
+
+               udelay(10);
+       } while (i--);
+
+       return -EIO;
+}
+
+bool mt76_poll(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val,
+              int timeout)
+{
+       u32 cur;
+
+       timeout /= 10;
+       do {
+               if (test_bit(MT7601U_STATE_REMOVED, &dev->state))
+                       return false;
+
+               cur = mt7601u_rr(dev, offset) & mask;
+               if (cur == val)
+                       return true;
+
+               udelay(10);
+       } while (timeout-- > 0);
+
+       dev_err(dev->dev, "Error: Time out with reg %08x\n", offset);
+
+       return false;
+}
+
+bool mt76_poll_msec(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val,
+                   int timeout)
+{
+       u32 cur;
+
+       timeout /= 10;
+       do {
+               if (test_bit(MT7601U_STATE_REMOVED, &dev->state))
+                       return false;
+
+               cur = mt7601u_rr(dev, offset) & mask;
+               if (cur == val)
+                       return true;
+
+               msleep(10);
+       } while (timeout-- > 0);
+
+       dev_err(dev->dev, "Error: Time out with reg %08x\n", offset);
+
+       return false;
+}