mt76: mt76u: add {read/write}_extended utility routines

Introduce extended utility routines to read/write data o usb bus. New
devices (e.g. mt7663u) will rely on both upper and lower part of the
register address. Add ext parameter to mt76u_init signature in order to
reuse the code adding mt7663u support.

Co-developed-by: Sean Wang <sean.wang@mediatek.com>
Signed-off-by: Sean Wang <sean.wang@mediatek.com>
Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
Signed-off-by: Felix Fietkau <nbd@nbd.name>

diff --git a/drivers/net/wireless/mediatek/mt76/mt76.h b/drivers/net/wireless/mediatek/mt76/mt76.h
index afcee5a87a098cc8367450424da264feff61933d..4968b596f3df88202b396f36d47e9cab1ab74b27 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt76.h
+++ b/drivers/net/wireless/mediatek/mt76/mt76.h
@@ -359,12 +359,15 @@ struct mt76_rate_power {
 enum mt_vendor_req {
        MT_VEND_DEV_MODE =      0x1,
        MT_VEND_WRITE =         0x2,
+       MT_VEND_POWER_ON =      0x4,
        MT_VEND_MULTI_WRITE =   0x6,
        MT_VEND_MULTI_READ =    0x7,
        MT_VEND_READ_EEPROM =   0x9,
        MT_VEND_WRITE_FCE =     0x42,
        MT_VEND_WRITE_CFG =     0x46,
        MT_VEND_READ_CFG =      0x47,
+       MT_VEND_READ_EXT =      0x63,
+       MT_VEND_WRITE_EXT =     0x66,
 };
 
 enum mt76u_in_ep {
@@ -883,8 +886,9 @@ int mt76u_vendor_request(struct mt76_dev *dev, u8 req,
                         void *buf, size_t len);
 void mt76u_single_wr(struct mt76_dev *dev, const u8 req,
                     const u16 offset, const u32 val);
-int mt76u_init(struct mt76_dev *dev, struct usb_interface *intf);
 void mt76u_deinit(struct mt76_dev *dev);
+int mt76u_init(struct mt76_dev *dev, struct usb_interface *intf,
+              bool ext);
 int mt76u_alloc_mcu_queue(struct mt76_dev *dev);
 int mt76u_alloc_queues(struct mt76_dev *dev);
 void mt76u_stop_tx(struct mt76_dev *dev);

diff --git a/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c
index f70718ce3ae8267c3f423d498448b4309f568ca8..747d21b3ee57c731466ed8dc2c20ee7c53ee9f55 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c
+++ b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c
@@ -242,7 +242,7 @@ static int mt76x0u_probe(struct usb_interface *usb_intf,
        usb_set_intfdata(usb_intf, dev);
 
        mt76x02u_init_mcu(mdev);
-       ret = mt76u_init(mdev, usb_intf);
+       ret = mt76u_init(mdev, usb_intf, false);
        if (ret)
                goto err;
 

diff --git a/drivers/net/wireless/mediatek/mt76/mt76x2/usb.c b/drivers/net/wireless/mediatek/mt76/mt76x2/usb.c
index 2c07063eadfed7aa35a1e9e664c73aa21df19e33..eafa283ca69973d012e1885ce03e1fc358a894e3 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt76x2/usb.c
+++ b/drivers/net/wireless/mediatek/mt76/mt76x2/usb.c
@@ -54,7 +54,7 @@ static int mt76x2u_probe(struct usb_interface *intf,
        usb_set_intfdata(intf, dev);
 
        mt76x02u_init_mcu(mdev);
-       err = mt76u_init(mdev, intf);
+       err = mt76u_init(mdev, intf, false);
        if (err < 0)
                goto err;
 

diff --git a/drivers/net/wireless/mediatek/mt76/usb.c b/drivers/net/wireless/mediatek/mt76/usb.c
index 4e0a115c6fd20ec73c39ab9ba48cb1d3eda247c0..6b31a7a9907219acade41fc47bea97945f9aff0e 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/usb.c
+++ b/drivers/net/wireless/mediatek/mt76/usb.c
@@ -62,12 +62,25 @@ int mt76u_vendor_request(struct mt76_dev *dev, u8 req,
 }
 EXPORT_SYMBOL_GPL(mt76u_vendor_request);
 
-static u32 __mt76u_rr(struct mt76_dev *dev, u32 addr)
+static u32 ___mt76u_rr(struct mt76_dev *dev, u8 req, u32 addr)
 {
        struct mt76_usb *usb = &dev->usb;
        u32 data = ~0;
-       u16 offset;
        int ret;
+
+       ret = __mt76u_vendor_request(dev, req,
+                                    USB_DIR_IN | USB_TYPE_VENDOR,
+                                    addr >> 16, addr, &usb->reg_val,
+                                    sizeof(__le32));
+       if (ret == sizeof(__le32))
+               data = le32_to_cpu(usb->reg_val);
+       trace_usb_reg_rr(dev, addr, data);
+
+       return data;
+}
+
+static u32 __mt76u_rr(struct mt76_dev *dev, u32 addr)
+{
        u8 req;
 
        switch (addr & MT_VEND_TYPE_MASK) {
@@ -81,16 +94,8 @@ static u32 __mt76u_rr(struct mt76_dev *dev, u32 addr)
                req = MT_VEND_MULTI_READ;
                break;
        }
-       offset = addr & ~MT_VEND_TYPE_MASK;
 
-       ret = __mt76u_vendor_request(dev, req,
-                                    USB_DIR_IN | USB_TYPE_VENDOR,
-                                    0, offset, &usb->reg_val, sizeof(__le32));
-       if (ret == sizeof(__le32))
-               data = le32_to_cpu(usb->reg_val);
-       trace_usb_reg_rr(dev, addr, data);
-
-       return data;
+       return ___mt76u_rr(dev, req, addr & ~MT_VEND_TYPE_MASK);
 }
 
 static u32 mt76u_rr(struct mt76_dev *dev, u32 addr)
@@ -104,10 +109,32 @@ static u32 mt76u_rr(struct mt76_dev *dev, u32 addr)
        return ret;
 }
 
-static void __mt76u_wr(struct mt76_dev *dev, u32 addr, u32 val)
+static u32 mt76u_rr_ext(struct mt76_dev *dev, u32 addr)
+{
+       u32 ret;
+
+       mutex_lock(&dev->usb.usb_ctrl_mtx);
+       ret = ___mt76u_rr(dev, MT_VEND_READ_EXT, addr);
+       mutex_unlock(&dev->usb.usb_ctrl_mtx);
+
+       return ret;
+}
+
+static void ___mt76u_wr(struct mt76_dev *dev, u8 req,
+                       u32 addr, u32 val)
 {
        struct mt76_usb *usb = &dev->usb;
-       u16 offset;
+
+       usb->reg_val = cpu_to_le32(val);
+       __mt76u_vendor_request(dev, req,
+                              USB_DIR_OUT | USB_TYPE_VENDOR,
+                              addr >> 16, addr, &usb->reg_val,
+                              sizeof(__le32));
+       trace_usb_reg_wr(dev, addr, val);
+}
+
+static void __mt76u_wr(struct mt76_dev *dev, u32 addr, u32 val)
+{
        u8 req;
 
        switch (addr & MT_VEND_TYPE_MASK) {
@@ -118,13 +145,7 @@ static void __mt76u_wr(struct mt76_dev *dev, u32 addr, u32 val)
                req = MT_VEND_MULTI_WRITE;
                break;
        }
-       offset = addr & ~MT_VEND_TYPE_MASK;
-
-       usb->reg_val = cpu_to_le32(val);
-       __mt76u_vendor_request(dev, req,
-                              USB_DIR_OUT | USB_TYPE_VENDOR, 0,
-                              offset, &usb->reg_val, sizeof(__le32));
-       trace_usb_reg_wr(dev, addr, val);
+       ___mt76u_wr(dev, req, addr & ~MT_VEND_TYPE_MASK, val);
 }
 
 static void mt76u_wr(struct mt76_dev *dev, u32 addr, u32 val)
@@ -134,6 +155,13 @@ static void mt76u_wr(struct mt76_dev *dev, u32 addr, u32 val)
        mutex_unlock(&dev->usb.usb_ctrl_mtx);
 }
 
+static void mt76u_wr_ext(struct mt76_dev *dev, u32 addr, u32 val)
+{
+       mutex_lock(&dev->usb.usb_ctrl_mtx);
+       ___mt76u_wr(dev, MT_VEND_WRITE_EXT, addr, val);
+       mutex_unlock(&dev->usb.usb_ctrl_mtx);
+}
+
 static u32 mt76u_rmw(struct mt76_dev *dev, u32 addr,
                     u32 mask, u32 val)
 {
@@ -145,6 +173,17 @@ static u32 mt76u_rmw(struct mt76_dev *dev, u32 addr,
        return val;
 }
 
+static u32 mt76u_rmw_ext(struct mt76_dev *dev, u32 addr,
+                        u32 mask, u32 val)
+{
+       mutex_lock(&dev->usb.usb_ctrl_mtx);
+       val |= ___mt76u_rr(dev, MT_VEND_READ_EXT, addr) & ~mask;
+       ___mt76u_wr(dev, MT_VEND_WRITE_EXT, addr, val);
+       mutex_unlock(&dev->usb.usb_ctrl_mtx);
+
+       return val;
+}
+
 static void mt76u_copy(struct mt76_dev *dev, u32 offset,
                       const void *data, int len)
 {
@@ -177,6 +216,55 @@ static void mt76u_copy(struct mt76_dev *dev, u32 offset,
        mutex_unlock(&usb->usb_ctrl_mtx);
 }
 
+static void mt76u_copy_ext(struct mt76_dev *dev, u32 offset,
+                          const void *data, int len)
+{
+       struct mt76_usb *usb = &dev->usb;
+       int ret, i = 0, batch_len;
+       const u8 *val = data;
+
+       len = round_up(len, 4);
+       mutex_lock(&usb->usb_ctrl_mtx);
+       while (i < len) {
+               batch_len = min_t(int, usb->data_len, len - i);
+               memcpy(usb->data, val + i, batch_len);
+               ret = __mt76u_vendor_request(dev, MT_VEND_WRITE_EXT,
+                                            USB_DIR_OUT | USB_TYPE_VENDOR,
+                                            (offset + i) >> 16, offset + i,
+                                            usb->data, batch_len);
+               if (ret < 0)
+                       break;
+
+               i += batch_len;
+       }
+       mutex_unlock(&usb->usb_ctrl_mtx);
+}
+
+static void
+mt76u_read_copy_ext(struct mt76_dev *dev, u32 offset,
+                   void *data, int len)
+{
+       struct mt76_usb *usb = &dev->usb;
+       int i = 0, batch_len, ret;
+       u8 *val = data;
+
+       len = round_up(len, 4);
+       mutex_lock(&usb->usb_ctrl_mtx);
+       while (i < len) {
+               batch_len = min_t(int, usb->data_len, len - i);
+               ret = __mt76u_vendor_request(dev, MT_VEND_READ_EXT,
+                                            USB_DIR_IN | USB_TYPE_VENDOR,
+                                            (offset + i) >> 16, offset + i,
+                                            usb->data, batch_len);
+               if (ret < 0)
+                       break;
+
+               memcpy(val + i, usb->data, batch_len);
+               i += batch_len;
+       }
+       mutex_unlock(&usb->usb_ctrl_mtx);
+}
+
 void mt76u_single_wr(struct mt76_dev *dev, const u8 req,
                     const u16 offset, const u32 val)
 {
@@ -1008,13 +1096,10 @@ void mt76u_deinit(struct mt76_dev *dev)
 EXPORT_SYMBOL_GPL(mt76u_deinit);
 
 int mt76u_init(struct mt76_dev *dev,
-              struct usb_interface *intf)
+              struct usb_interface *intf, bool ext)
 {
-       static const struct mt76_bus_ops mt76u_ops = {
-               .rr = mt76u_rr,
-               .wr = mt76u_wr,
-               .rmw = mt76u_rmw,
-               .write_copy = mt76u_copy,
+       static struct mt76_bus_ops mt76u_ops = {
+               .read_copy = mt76u_read_copy_ext,
                .wr_rp = mt76u_wr_rp,
                .rd_rp = mt76u_rd_rp,
                .type = MT76_BUS_USB,
@@ -1022,6 +1107,11 @@ int mt76u_init(struct mt76_dev *dev,
        struct usb_device *udev = interface_to_usbdev(intf);
        struct mt76_usb *usb = &dev->usb;
 
+       mt76u_ops.rr = ext ? mt76u_rr_ext : mt76u_rr;
+       mt76u_ops.wr = ext ? mt76u_wr_ext : mt76u_wr;
+       mt76u_ops.rmw = ext ? mt76u_rmw_ext : mt76u_rmw;
+       mt76u_ops.write_copy = ext ? mt76u_copy_ext : mt76u_copy;
+
        tasklet_init(&usb->rx_tasklet, mt76u_rx_tasklet, (unsigned long)dev);
        tasklet_init(&dev->tx_tasklet, mt76u_tx_tasklet, (unsigned long)dev);
        INIT_WORK(&usb->stat_work, mt76u_tx_status_data);