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

Commit 619fcb44 authored by Dmitry Bezrukov's avatar Dmitry Bezrukov Committed by David S. Miller
Browse files

net: usb: aqc111: Add implementation of read and write commands 



Read/write command register defines and functions

Signed-off-by: default avatarDmitry Bezrukov <dmitry.bezrukov@aquantia.com>
Signed-off-by: default avatarIgor Russkikh <igor.russkikh@aquantia.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 7cea2d40

drivers/net/usb/aqc111.c

+92 −0
Original line number Diff line number Diff line
@@ -14,6 +14,98 @@ 
#include <linux/usb/cdc.h>

#include <linux/usb/usbnet.h>



#include "aqc111.h"



static int aqc111_read_cmd_nopm(struct usbnet *dev, u8 cmd, u16 value,

				u16 index, u16 size, void *data)

{

	int ret;



	ret = usbnet_read_cmd_nopm(dev, cmd, USB_DIR_IN | USB_TYPE_VENDOR |

				   USB_RECIP_DEVICE, value, index, data, size);



	if (unlikely(ret < 0))

		netdev_warn(dev->net,

			    "Failed to read(0x%x) reg index 0x%04x: %d\n",

			    cmd, index, ret);



	return ret;

}



static int aqc111_read_cmd(struct usbnet *dev, u8 cmd, u16 value,

			   u16 index, u16 size, void *data)

{

	int ret;



	ret = usbnet_read_cmd(dev, cmd, USB_DIR_IN | USB_TYPE_VENDOR |

			      USB_RECIP_DEVICE, value, index, data, size);



	if (unlikely(ret < 0))

		netdev_warn(dev->net,

			    "Failed to read(0x%x) reg index 0x%04x: %d\n",

			    cmd, index, ret);



	return ret;

}



static int __aqc111_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype,

			      u16 value, u16 index, u16 size, const void *data)

{

	int err = -ENOMEM;

	void *buf = NULL;



	netdev_dbg(dev->net,

		   "%s cmd=%#x reqtype=%#x value=%#x index=%#x size=%d\n",

		   __func__, cmd, reqtype, value, index, size);



	if (data) {

		buf = kmemdup(data, size, GFP_KERNEL);

		if (!buf)

			goto out;

	}



	err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),

			      cmd, reqtype, value, index, buf, size,

			      (cmd == AQ_PHY_POWER) ? AQ_USB_PHY_SET_TIMEOUT :

			      AQ_USB_SET_TIMEOUT);



	if (unlikely(err < 0))

		netdev_warn(dev->net,

			    "Failed to write(0x%x) reg index 0x%04x: %d\n",

			    cmd, index, err);

	kfree(buf);



out:

	return err;

}



static int aqc111_write_cmd_nopm(struct usbnet *dev, u8 cmd, u16 value,

				 u16 index, u16 size, void *data)

{

	int ret;



	ret = __aqc111_write_cmd(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |

				 USB_RECIP_DEVICE, value, index, size, data);



	return ret;

}



static int aqc111_write_cmd(struct usbnet *dev, u8 cmd, u16 value,

			    u16 index, u16 size, void *data)

{

	int ret;



	if (usb_autopm_get_interface(dev->intf) < 0)

		return -ENODEV;



	ret = __aqc111_write_cmd(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |

				 USB_RECIP_DEVICE, value, index, size, data);



	usb_autopm_put_interface(dev->intf);



	return ret;

}



static const struct net_device_ops aqc111_netdev_ops = {

	.ndo_open		= usbnet_open,

	.ndo_stop		= usbnet_stop,

drivers/net/usb/aqc111.h

0 → 100644
+18 −0
Original line number Diff line number Diff line 
/* SPDX-License-Identifier: GPL-2.0-or-later

 * Aquantia Corp. Aquantia AQtion USB to 5GbE Controller

 * Copyright (C) 2003-2005 David Hollis <dhollis@davehollis.com>

 * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>

 * Copyright (C) 2002-2003 TiVo Inc.

 * Copyright (C) 2017-2018 ASIX

 * Copyright (C) 2018 Aquantia Corp.

 */



#ifndef __LINUX_USBNET_AQC111_H

#define __LINUX_USBNET_AQC111_H



#define AQ_PHY_POWER			0x31



#define AQ_USB_PHY_SET_TIMEOUT		10000

#define AQ_USB_SET_TIMEOUT		4000



#endif /* __LINUX_USBNET_AQC111_H */