t500usb.c

Epson BA-T500USB在Linux 2.4下的设备驱动

	/* verify that the device wasn't unplugged */
	if (dev->udev == NULL) {
		up (&dev->sem);
		return -ENODEV;
	}
	
	/* do an immediate bulk read to get data from the device */
	retval = usb_bulk_msg (dev->udev,
			       usb_rcvbulkpipe (dev->udev, 
						dev->bulk_in_endpointAddr),
			       dev->bulk_in_buffer, dev->bulk_in_size,
			       &count, HZ*10);

	/* if the read was successful, copy the data to userspace */
	if (!retval) {
		if (copy_to_user (buffer, dev->bulk_in_buffer, count))
			retval = -EFAULT;
		else
			retval = count;
	}
	
	/* unlock the device */
	up (&dev->sem);
	return retval;
}


/**
 *	t500u_write
 */
static ssize_t t500u_write (struct file *file, const char *buffer, size_t count, loff_t *ppos)
{
	struct usb_t500u *dev;
	ssize_t bytes_written = 0;
	int retval = 0; 
	size_t count_temp = count;
	char *buffer_temp;

	/* make a new buffer_tmp to point buffer address */
	buffer_temp = buffer;			
	
	printk(buffer_temp);

	dev = (struct usb_t500u *)file->private_data;

	/* lock this object */
	down (&dev->sem);

	/* verify that the device wasn't unplugged */
	if (dev->udev == NULL) {
		retval = -ENODEV;
		goto exit;
	}

	/* verify that we actually have some data to write */
	if (count == 0) {
		goto exit;
	}

	/* see if we are already in the middle of a write */
	if (dev->write_urb->status == -EINPROGRESS) {
		goto exit;
	}

	/* send the data out the bulk port */
	do
	{
		/* we can only write as much as 1 urb will hold */
		bytes_written = (count > dev->bulk_out_size) ? 
					dev->bulk_out_size : count;

		printk("before=%d:%d\n", bytes_written, count);
		count_temp = count;	
	
		/* copy the data from userspace into our bulk_out_buffer */
		if (copy_from_user(dev->bulk_out_buffer, buffer_temp, 
				   bytes_written)) {
				retval = -EFAULT;
				goto exit;
		}
		
		retval = usb_bulk_msg( dev->udev,
                              	       usb_sndbulkpipe(dev->udev,
				       dev->bulk_out_endpointAddr),
			      	       dev->bulk_out_buffer,
			      	       bytes_written,
			      	       &count_temp, HZ*10);

		count -= bytes_written;
		buffer_temp += bytes_written;
			
		printk("after=%d:%d\n", bytes_written, count);

		if (retval) {
			/* err */
		} else {
			retval = bytes_written;
		}
	
	}while( count > 0);

exit:
	/* unlock the device */
	up (&dev->sem);

	return retval;
}


/**
 *	t500u_ioctl
 */
static int t500u_ioctl (struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
	struct usb_t500u *dev;

	dev = (struct usb_t500u *)file->private_data;

	/* lock this object */
	down (&dev->sem);

	/* verify that the device wasn't unplugged */
	if (dev->udev == NULL) {
		up (&dev->sem);
		return -ENODEV;
	}

	/* fill in your device specific stuff here */
	
	/* unlock the device */
	up (&dev->sem);
	
	/* return that we did not understand this ioctl call */
	return -ENOTTY;
}


/**
 *	t500u_write_bulk_callback
 */
static void t500u_write_bulk_callback (struct urb *urb)
{
	struct usb_t500u *dev = (struct usb_t500u *)urb->context;

	if (urb->status &&
	    (urb->status != -ENOENT) && 
	    (urb->status != -ECONNRESET) &&
	    (urb->status != -ESHUTDOWN)) {
		return;
	}

	return;
}


/**
 *	t500u_probe
 *
 *	Called by the usb core when a new device is connected that it thinks
 *	this driver might be interested in.
 */
static void * t500u_probe(struct usb_device *udev, unsigned int ifnum, const struct usb_device_id *id)
{
	struct usb_t500u *dev = NULL;
	struct usb_interface *interface;
	struct usb_interface_descriptor *iface_desc;
	struct usb_endpoint_descriptor *endpoint;
	int minor;
	int buffer_size;
	int i;
	char name[10];

	
	/* See if the device offered us matches what we can accept */
	if ((udev->descriptor.idVendor != USB_T500U_VENDOR_ID) ||
	    (udev->descriptor.idProduct != USB_T500U_PRODUCT_ID)) {
		return NULL;
	}

	/* select a "subminor" number (part of a minor number) */
	down (&minor_table_mutex);
	for (minor = 0; minor < MAX_DEVICES; ++minor) {
		if (minor_table[minor] == NULL)
			break;
	}
	if (minor >= MAX_DEVICES) {
		info ("Too many devices plugged in, can not handle this device.");
		goto exit;
	}

	/* allocate memory for our device state and intialize it */
	dev = kmalloc (sizeof(struct usb_t500u), GFP_KERNEL);
	if (dev == NULL) {
		err ("Out of memory");
		goto exit;
	}
	memset (dev, 0x00, sizeof (*dev));
	minor_table[minor] = dev;

	interface = &udev->actconfig->interface[ifnum];

	init_MUTEX (&dev->sem);
	dev->udev = udev;
	dev->interface = interface;
	dev->minor = minor;

	/* set up the endpoint information */
	/* check out the endpoints */
	iface_desc = &interface->altsetting[0];
	for (i = 0; i < iface_desc->bNumEndpoints; ++i) {
		endpoint = &iface_desc->endpoint[i];

		if ((endpoint->bEndpointAddress & 0x80) &&
		    ((endpoint->bmAttributes & 3) == 0x02)) {
			/* we found a bulk in endpoint */
			buffer_size = endpoint->wMaxPacketSize;
			dev->bulk_in_size = buffer_size;
			dev->bulk_in_endpointAddr = endpoint->bEndpointAddress;
			dev->bulk_in_buffer = kmalloc (buffer_size, GFP_KERNEL);
			if (!dev->bulk_in_buffer) {
				err("Couldn't allocate bulk_in_buffer");
				goto error;
			}
		}
		
		if (((endpoint->bEndpointAddress & 0x80) == 0x00) &&
		    ((endpoint->bmAttributes & 3) == 0x02)) {
			/* we found a bulk out endpoint */
			dev->write_urb = usb_alloc_urb(0);
			if (!dev->write_urb) {
				err("No free urbs available");
				goto error;
			}
			buffer_size = endpoint->wMaxPacketSize;
			dev->bulk_out_size = buffer_size;
			dev->bulk_out_endpointAddr = endpoint->bEndpointAddress;
			dev->bulk_out_buffer = kmalloc (buffer_size, GFP_KERNEL);
			if (!dev->bulk_out_buffer) {
				err("Couldn't allocate bulk_out_buffer");
				goto error;
			}
			FILL_BULK_URB(dev->write_urb, udev, 
				      usb_sndbulkpipe(udev, 
						      endpoint->bEndpointAddress),
				      dev->bulk_out_buffer, buffer_size,
				      t500u_write_bulk_callback, dev);
		}
	}

	/* initialize the devfs node for this device and register it */
	sprintf(name, "t500u%d", dev->minor);
	
	dev->devfs = devfs_register (usb_devfs_handle, name,
				     DEVFS_FL_DEFAULT, USB_MAJOR,
				     USB_T500U_MINOR_BASE + dev->minor,
				     S_IFCHR | S_IRUSR | S_IWUSR | 
				     S_IRGRP | S_IWGRP | S_IROTH, 
				     &t500u_fops, NULL);

	/* let the user know what node this device is now attached to */
	info ("Epson BA-T500USB now attached to USBt500u%d", dev->minor);
	goto exit;
	
error:
	t500u_delete (dev);
	dev = NULL;

exit:
	up (&minor_table_mutex);
	return dev;
}


/**
 *	t500u_disconnect
 *
 *	Called by the usb core when the device is removed from the system.
 */
static void t500u_disconnect(struct usb_device *udev, void *ptr)
{
	struct usb_t500u *dev;
	int minor;

	dev = (struct usb_t500u *)ptr;
	
	down (&minor_table_mutex);
	down (&dev->sem);
		
	minor = dev->minor;

	/* remove our devfs node */
	devfs_unregister(dev->devfs);

	/* if the device is not opened, then we clean up right now */
	if (!dev->open_count) {
		up (&dev->sem);
		t500u_delete (dev);
	} else {
		dev->udev = NULL;
		up (&dev->sem);
	}

	info("Epson BA-T500USB #%d now disconnected", minor);
	up (&minor_table_mutex);
}



/**
 *	usb_t500u_init
 */
static int __init usb_t500u_init(void)
{
	int result;

	/* register this driver with the USB subsystem */
	result = usb_register(&t500u_driver);
	if (result < 0) {
		err("usb_register failed for the "__FILE__" driver. Error number %d",
		    result);
		return -1;
	}

	info(DRIVER_DESC " " DRIVER_VERSION);
	return 0;
}


/**
 *	usb_t500u_exit
 */
static void __exit usb_t500u_exit(void)
{
	/* deregister this driver with the USB subsystem */
	usb_deregister(&t500u_driver);
}


module_init (usb_t500u_init);
module_exit (usb_t500u_exit);

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");