renamed 349 -> 397
This commit is contained in:
Tiago Batista Cardoso
419
src/ch397_driver.c
Normal file
419
src/ch397_driver.c
Normal file
@@ -0,0 +1,419 @@
|
||||
/*
|
||||
* dependencies:
|
||||
*
|
||||
* libusb-dev
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/etherdevice.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/usb.h>
|
||||
|
||||
#define CH397_VENDOR_ID 0x1a86
|
||||
#define CH397_PRODUCT_ID 0x5397
|
||||
|
||||
struct ch397_device {
|
||||
struct usb_device *udev;
|
||||
struct usb_interface *interface;
|
||||
struct mutex io_mutex;
|
||||
|
||||
__u8 bulk_in_endpointAddr;
|
||||
__u8 bulk_out_endpointAddr;
|
||||
size_t bulk_in_size;
|
||||
unsigned char *bulk_in_buffer;
|
||||
struct urb *rx_urb;
|
||||
struct net_device *netdev;
|
||||
};
|
||||
|
||||
static const struct usb_device_id ch397_table[] = {
|
||||
{ USB_DEVICE_AND_INTERFACE_INFO(CH397_VENDOR_ID, CH397_PRODUCT_ID,
|
||||
USB_CLASS_CDC_DATA, 0, 0) },
|
||||
{}
|
||||
};
|
||||
MODULE_DEVICE_TABLE(usb, ch397_table);
|
||||
|
||||
// Fonction pour récupérer la MAC
|
||||
static int ch397_get_mac_address(struct ch397_device *dev, u8 *mac)
|
||||
{
|
||||
char buf[13];
|
||||
int ret, i;
|
||||
|
||||
ret = usb_string(dev->udev, 3, buf, sizeof(buf));
|
||||
if (ret != 12) {
|
||||
dev_err(&dev->interface->dev,
|
||||
"Cannot read MAC (got %d bytes)\n", ret);
|
||||
// MAC par défaut si échec
|
||||
eth_random_addr(mac);
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Convertir "DC3262229393" -> DC:32:62:22:93:93
|
||||
for (i = 0; i < 6; i++) {
|
||||
char hex[3] = { buf[i * 2], buf[i * 2 + 1], 0 };
|
||||
if (kstrtou8(hex, 16, &mac[i])) {
|
||||
dev_err(&dev->interface->dev, "Invalid MAC format\n");
|
||||
eth_random_addr(mac);
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void ch397_hexdump(const struct device *dev, const char *prefix,
|
||||
const void *data, size_t len)
|
||||
{
|
||||
const unsigned char *buf = data;
|
||||
char line[80];
|
||||
size_t i, j;
|
||||
|
||||
for (i = 0; i < len; i += 16) {
|
||||
char *p = line;
|
||||
p += sprintf(p, "%s %04zx: ", prefix, i);
|
||||
|
||||
// Hexa
|
||||
for (j = 0; j < 16; j++) {
|
||||
if (i + j < len)
|
||||
p += sprintf(p, "%02x ", buf[i + j]);
|
||||
else
|
||||
p += sprintf(p, " ");
|
||||
}
|
||||
|
||||
p += sprintf(p, " ");
|
||||
|
||||
// ASCII
|
||||
for (j = 0; j < 16 && i + j < len; j++) {
|
||||
unsigned char c = buf[i + j];
|
||||
p += sprintf(p, "%c", (c >= 32 && c < 127) ? c : '.');
|
||||
}
|
||||
|
||||
dev_info(dev, "%s\n", line);
|
||||
}
|
||||
}
|
||||
|
||||
static void ch397_read_callback(struct urb *urb)
|
||||
{
|
||||
struct ch397_device *dev = urb->context;
|
||||
struct net_device *netdev = dev->netdev;
|
||||
struct sk_buff *skb;
|
||||
struct ethhdr *eth;
|
||||
int status = urb->status;
|
||||
|
||||
switch (status) {
|
||||
case 0: // Success!
|
||||
if (urb->actual_length > 0) {
|
||||
dev_info(&dev->interface->dev,
|
||||
"ch397: Received %d bytes\n",
|
||||
urb->actual_length);
|
||||
ch397_hexdump(&dev->interface->dev, "RX",
|
||||
urb->transfer_buffer, urb->actual_length);
|
||||
|
||||
// Créer un sk_buff et passer au network stack
|
||||
skb = netdev_alloc_skb(netdev, urb->actual_length + 2);
|
||||
if (skb) {
|
||||
skb_reserve(skb,
|
||||
2); // Alignement IP
|
||||
skb_put_data(skb, urb->transfer_buffer,
|
||||
urb->actual_length);
|
||||
skb->protocol = eth_type_trans(skb, netdev);
|
||||
|
||||
// Passer au kernel network stack
|
||||
netif_rx(skb);
|
||||
|
||||
netdev->stats.rx_packets++;
|
||||
netdev->stats.rx_bytes += urb->actual_length;
|
||||
|
||||
printk(KERN_INFO
|
||||
"ch397: Packet passed to network stack\n");
|
||||
} else {
|
||||
netdev->stats.rx_dropped++;
|
||||
printk(KERN_ERR "ch397: Cannot allocate skb\n");
|
||||
}
|
||||
}
|
||||
break;
|
||||
|
||||
case -ENOENT:
|
||||
case -ECONNRESET:
|
||||
case -ESHUTDOWN:
|
||||
return;
|
||||
|
||||
default:
|
||||
dev_err(&dev->interface->dev, "RX URB error: %d\n", status);
|
||||
netdev->stats.rx_errors++;
|
||||
break;
|
||||
}
|
||||
|
||||
// Resoumettre l'URB
|
||||
status = usb_submit_urb(urb, GFP_ATOMIC);
|
||||
if (status) {
|
||||
dev_err(&dev->interface->dev, "Failed to resubmit URB: %d\n",
|
||||
status);
|
||||
netdev->stats.rx_errors++;
|
||||
}
|
||||
}
|
||||
|
||||
// Fonction pour démarrer la lecture
|
||||
static int ch397_start_rx(struct ch397_device *dev)
|
||||
{
|
||||
struct urb *urb;
|
||||
int retval;
|
||||
|
||||
// Allouer un URB
|
||||
urb = usb_alloc_urb(0, GFP_KERNEL);
|
||||
if (!urb) {
|
||||
dev_err(&dev->interface->dev, "Cannot allocate URB\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
// En CDC-ECM, les packets peuvent être jusqu'à ~1600 bytes
|
||||
|
||||
// Préparer l'URB
|
||||
usb_fill_bulk_urb(urb, dev->udev,
|
||||
usb_rcvbulkpipe(dev->udev, dev->bulk_in_endpointAddr),
|
||||
dev->bulk_in_buffer, dev->bulk_in_size,
|
||||
ch397_read_callback, dev);
|
||||
|
||||
// Sauvegarder l'URB dans la structure
|
||||
dev->rx_urb = urb;
|
||||
|
||||
// Soumettre l'URB
|
||||
retval = usb_submit_urb(urb, GFP_KERNEL);
|
||||
if (retval) {
|
||||
dev_err(&dev->interface->dev, "Failed to submit URB: %d\n",
|
||||
retval);
|
||||
usb_free_urb(urb);
|
||||
dev->rx_urb = NULL;
|
||||
return retval;
|
||||
}
|
||||
|
||||
dev_info(&dev->interface->dev, "RX started, waiting for packets...\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Fonction pour arrêter la lecture
|
||||
static void ch397_stop_rx(struct ch397_device *dev)
|
||||
{
|
||||
if (dev->rx_urb) {
|
||||
usb_kill_urb(dev->rx_urb);
|
||||
usb_free_urb(dev->rx_urb);
|
||||
dev->rx_urb = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
static int ch397_net_open(struct net_device *netdev)
|
||||
{
|
||||
struct ch397_device *dev = netdev_priv(netdev);
|
||||
int retval;
|
||||
|
||||
printk(KERN_INFO "ch397: Interface UP\n");
|
||||
|
||||
retval = ch397_start_rx(dev);
|
||||
if (retval)
|
||||
return retval;
|
||||
|
||||
netif_start_queue(netdev);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ch397_net_stop(struct net_device *netdev)
|
||||
{
|
||||
struct ch397_device *dev = netdev_priv(netdev);
|
||||
|
||||
printk(KERN_INFO "ch397: Interface DOWN\n");
|
||||
|
||||
netif_stop_queue(netdev);
|
||||
ch397_stop_rx(dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static netdev_tx_t ch397_start_xmit(struct sk_buff *skb,
|
||||
struct net_device *netdev)
|
||||
{
|
||||
// Pour l'instant, on drop juste les packets TX
|
||||
dev_kfree_skb(skb);
|
||||
netdev->stats.tx_dropped++;
|
||||
return NETDEV_TX_OK;
|
||||
}
|
||||
|
||||
static const struct net_device_ops ch397_netdev_ops = {
|
||||
.ndo_open = ch397_net_open,
|
||||
.ndo_stop = ch397_net_stop,
|
||||
.ndo_start_xmit = ch397_start_xmit,
|
||||
.ndo_validate_addr = eth_validate_addr,
|
||||
.ndo_set_mac_address = eth_mac_addr,
|
||||
};
|
||||
|
||||
static int ch397_probe(struct usb_interface *interface,
|
||||
const struct usb_device_id *id)
|
||||
{
|
||||
struct ch397_device *dev;
|
||||
struct net_device *netdev;
|
||||
struct usb_endpoint_descriptor *endpoint;
|
||||
u8 mac[ETH_ALEN];
|
||||
int i;
|
||||
int retval = -ENOMEM;
|
||||
|
||||
dev_info(&interface->dev, "Probing CH397 device\n");
|
||||
|
||||
// Allouer net_device + notre structure
|
||||
netdev = alloc_etherdev(sizeof(struct ch397_device));
|
||||
if (!netdev) {
|
||||
dev_err(&interface->dev, "Cannot allocate netdev\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
dev = netdev_priv(netdev);
|
||||
dev->netdev = netdev;
|
||||
|
||||
mutex_init(&dev->io_mutex);
|
||||
dev->udev = usb_get_dev(interface_to_usbdev(interface));
|
||||
dev->interface = interface;
|
||||
|
||||
// Sélectionne l'altsetting 1
|
||||
retval = usb_set_interface(
|
||||
dev->udev, interface->cur_altsetting->desc.bInterfaceNumber, 1);
|
||||
if (retval) {
|
||||
dev_err(&interface->dev, "Cannot set altsetting 1: %d\n",
|
||||
retval);
|
||||
goto error;
|
||||
}
|
||||
|
||||
dev_info(&interface->dev, "Interface obtained\n");
|
||||
|
||||
for (i = 0; i < interface->cur_altsetting->desc.bNumEndpoints; i++) {
|
||||
endpoint = &interface->cur_altsetting->endpoint[i].desc;
|
||||
|
||||
dev_info(&interface->dev, "Found endpoint 0x%02x\n",
|
||||
endpoint->bEndpointAddress); // Debugging line
|
||||
|
||||
if (!dev->bulk_in_endpointAddr &&
|
||||
usb_endpoint_is_bulk_in(endpoint)) {
|
||||
dev->bulk_in_endpointAddr = endpoint->bEndpointAddress;
|
||||
dev->bulk_in_size = 2048; // Buffer ethernet
|
||||
dev->bulk_in_buffer =
|
||||
kmalloc(dev->bulk_in_size, GFP_KERNEL);
|
||||
if (!dev->bulk_in_buffer) {
|
||||
dev_err(&interface->dev,
|
||||
"Could not allocate bulk_in_buffer\n");
|
||||
goto error;
|
||||
}
|
||||
dev_info(&interface->dev,
|
||||
"Bulk IN endpoint found: 0x%02x\n",
|
||||
dev->bulk_in_endpointAddr);
|
||||
}
|
||||
|
||||
if (!dev->bulk_out_endpointAddr &&
|
||||
usb_endpoint_is_bulk_out(endpoint)) {
|
||||
dev->bulk_out_endpointAddr = endpoint->bEndpointAddress;
|
||||
dev_info(&interface->dev,
|
||||
"Bulk OUT endpoint found: 0x%02x\n",
|
||||
dev->bulk_out_endpointAddr);
|
||||
}
|
||||
}
|
||||
|
||||
if (!(dev->bulk_in_endpointAddr && dev->bulk_out_endpointAddr)) {
|
||||
dev_err(&interface->dev,
|
||||
"Could not find both bulk-in and bulk-out endpoints\n");
|
||||
goto error;
|
||||
}
|
||||
|
||||
// Récupère la MAC
|
||||
ch397_get_mac_address(dev, mac);
|
||||
eth_hw_addr_set(netdev, mac);
|
||||
|
||||
// Configure net_device
|
||||
netdev->netdev_ops = &ch397_netdev_ops;
|
||||
netdev->watchdog_timeo = 5 * HZ;
|
||||
|
||||
usb_set_intfdata(interface, dev);
|
||||
|
||||
// Enregistre l'interface réseau
|
||||
retval = register_netdev(netdev);
|
||||
if (retval) {
|
||||
dev_err(&interface->dev, "Cannot register netdev: %d\n",
|
||||
retval);
|
||||
goto error;
|
||||
}
|
||||
|
||||
dev_info(&interface->dev, "CH397 attached as %s (MAC: %pM)\n",
|
||||
netdev->name, mac);
|
||||
|
||||
//if (retval)
|
||||
// goto error;
|
||||
|
||||
return 0;
|
||||
|
||||
error:
|
||||
if (dev) {
|
||||
kfree(dev->bulk_in_buffer);
|
||||
usb_put_dev(dev->udev);
|
||||
}
|
||||
if (netdev)
|
||||
free_netdev(netdev);
|
||||
return retval;
|
||||
}
|
||||
|
||||
static void ch397_disconnect(struct usb_interface *interface)
|
||||
{
|
||||
struct ch397_device *dev;
|
||||
struct net_device *netdev;
|
||||
|
||||
dev = usb_get_intfdata(interface);
|
||||
if (!dev)
|
||||
return;
|
||||
|
||||
netdev = dev->netdev;
|
||||
usb_set_intfdata(interface, NULL);
|
||||
|
||||
unregister_netdev(netdev);
|
||||
ch397_stop_rx(dev);
|
||||
|
||||
kfree(dev->bulk_in_buffer);
|
||||
usb_put_dev(dev->udev);
|
||||
free_netdev(netdev);
|
||||
|
||||
dev_info(&interface->dev, "CH397 device now disconnected\n");
|
||||
}
|
||||
|
||||
static int ch397_suspend(struct usb_interface *intf, pm_message_t message)
|
||||
{
|
||||
struct ch397_device *dev = usb_get_intfdata(intf);
|
||||
|
||||
if (!dev)
|
||||
return 0;
|
||||
|
||||
mutex_lock(&dev->io_mutex);
|
||||
mutex_unlock(&dev->io_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ch397_resume(struct usb_interface *intf)
|
||||
{
|
||||
struct ch397_device *dev = usb_get_intfdata(intf);
|
||||
|
||||
if (!dev)
|
||||
return 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct usb_driver ch397_driver = {
|
||||
.name = "ch397",
|
||||
.probe = ch397_probe,
|
||||
.disconnect = ch397_disconnect,
|
||||
.suspend = ch397_suspend,
|
||||
.resume = ch397_resume,
|
||||
.id_table = ch397_table,
|
||||
.supports_autosuspend = 1,
|
||||
};
|
||||
|
||||
module_usb_driver(ch397_driver);
|
||||
|
||||
MODULE_AUTHOR("bob industries");
|
||||
MODULE_DESCRIPTION("Driver USB pour CH397A");
|
||||
MODULE_LICENSE("GPL");
|
||||
Reference in New Issue
Block a user