Subversion Repositories or1k

/*
 * BRIEF MODULE DESCRIPTION
 *	Au1x00 USB Device-Side Raw Block Driver (function layer)
 *
 * Copyright 2001-2002 MontaVista Software Inc.
 * Author: MontaVista Software, Inc.
 *		stevel@mvista.com or source@mvista.com
 *
 *  This program is free software; you can redistribute	 it and/or modify it
 *  under  the terms of	 the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the	License, or (at your
 *  option) any later version.
 *
 *  THIS  SOFTWARE  IS PROVIDED	  ``AS	IS'' AND   ANY	EXPRESS OR IMPLIED
 *  WARRANTIES,	  INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
 *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
 *  NO	EVENT  SHALL   THE AUTHOR  BE	 LIABLE FOR ANY	  DIRECT, INDIRECT,
 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 *  NOT LIMITED	  TO, PROCUREMENT OF  SUBSTITUTE GOODS	OR SERVICES; LOSS OF
 *  USE, DATA,	OR PROFITS; OR	BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
 *  ANY THEORY OF LIABILITY, WHETHER IN	 CONTRACT, STRICT LIABILITY, OR TORT
 *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *  You should have received a copy of the  GNU General Public License along
 *  with this program; if not, write  to the Free Software Foundation, Inc.,
 *  675 Mass Ave, Cambridge, MA 02139, USA.
 */
 
#include <linux/config.h>
#include <linux/kernel.h>
#include <linux/ioport.h>
#include <linux/sched.h>
#include <linux/signal.h>
#include <linux/errno.h>
#include <linux/poll.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/fcntl.h>
#include <linux/module.h>
#include <linux/spinlock.h>
#include <linux/list.h>
#include <linux/smp_lock.h>
#undef DEBUG
#include <linux/usb.h>
 
#include <asm/io.h>
#include <asm/uaccess.h>
#include <asm/irq.h>
#include <asm/au1000.h>
#include <asm/au1000_usbdev.h>
 
#define USBRAW_MAJOR 190 // FIXME: need a legal major
#define USBRAW_NAME "usbraw"
 
#define MAX_NUM_PORTS 2
 
#define IN_MAX_PACKET_SIZE  64
#define OUT_MAX_PACKET_SIZE 64
 
// FIXME: when Au1x00 endpoints 3 and 5 are fixed, make NUM_PORTS=2
#define NUM_PORTS 1
#define NUM_EP 2*NUM_PORTS
 
#define CONFIG_DESC_LEN \
 USB_DT_CONFIG_SIZE + USB_DT_INTERFACE_SIZE + NUM_EP*USB_DT_ENDPOINT_SIZE
 
/* must be power of two */
#define READ_BUF_SIZE (1<<12)
 
struct usb_raw_port {
	unsigned char number;
	spinlock_t port_lock;
 
	struct usb_endpoint_descriptor* out_desc;
	struct usb_endpoint_descriptor* in_desc;
 
	int out_ep_addr; /* endpoint address of OUT endpoint */
	int in_ep_addr;  /* endpoint address of IN endpoint */
 
	__u8 read_buf[READ_BUF_SIZE]; // FIXME: allocate with get_free_pages
	int read_nextin, read_nextout;
	int read_count;
 
	wait_queue_head_t wait;
	struct fasync_struct *fasync;     // asynch notification
 
	int active;	/* someone has this device open */
	int open_count;	/* number of times this port has been opened */
};
 
static struct usb_serial {
	struct usb_device_descriptor* dev_desc;
	struct usb_config_descriptor* config_desc;
	struct usb_interface_descriptor* if_desc;
	struct usb_string_descriptor * str_desc[6];
	void* str_desc_buf;
 
	usbdev_state_t dev_state;
 
	struct usb_raw_port port[NUM_PORTS];
} usbraw;
 
static struct usb_device_descriptor dev_desc = {
	bLength:USB_DT_DEVICE_SIZE,
	bDescriptorType:USB_DT_DEVICE,
	bcdUSB:USBDEV_REV,		//usb rev
	bDeviceClass:USB_CLASS_PER_INTERFACE,	//class    (none)
	bDeviceSubClass:0x00,	//subclass (none)
	bDeviceProtocol:0x00,	//protocol (none)
	bMaxPacketSize0:USBDEV_EP0_MAX_PACKET_SIZE, //max packet size for ep0
	idVendor:0x6d04,	//vendor  id
	idProduct:0x0bc0,	//product id
	bcdDevice:0x0001,	//BCD rev 0.1
	iManufacturer:0x01,	//manufactuer string index
	iProduct:0x02,		//product string index
	iSerialNumber:0x03,	//serial# string index
	bNumConfigurations:0x01	//num configurations
};
 
static struct usb_endpoint_descriptor ep_desc[] = {
	{
		// Bulk IN for Port 0
		bLength:USB_DT_ENDPOINT_SIZE,
		bDescriptorType:USB_DT_ENDPOINT,
		bEndpointAddress:USB_DIR_IN,
		bmAttributes:USB_ENDPOINT_XFER_BULK,
		wMaxPacketSize:IN_MAX_PACKET_SIZE,
		bInterval:0x00	// ignored for bulk
	},
	{
		// Bulk OUT for Port 0
		bLength:USB_DT_ENDPOINT_SIZE,
		bDescriptorType:USB_DT_ENDPOINT,
		bEndpointAddress:USB_DIR_OUT,
		bmAttributes:USB_ENDPOINT_XFER_BULK,
		wMaxPacketSize:OUT_MAX_PACKET_SIZE,
		bInterval:0x00	// ignored for bulk
	},
	{
		// Bulk IN for Port 1
		bLength:USB_DT_ENDPOINT_SIZE,
		bDescriptorType:USB_DT_ENDPOINT,
		bEndpointAddress:USB_DIR_IN,
		bmAttributes:USB_ENDPOINT_XFER_BULK,
		wMaxPacketSize:IN_MAX_PACKET_SIZE,
		bInterval:0x00	// ignored for bulk
	},
	{
		// Bulk OUT for Port 1
		bLength:USB_DT_ENDPOINT_SIZE,
		bDescriptorType:USB_DT_ENDPOINT,
		bEndpointAddress:USB_DIR_OUT,
		bmAttributes:USB_ENDPOINT_XFER_BULK,
		wMaxPacketSize:OUT_MAX_PACKET_SIZE,
		bInterval:0x00	// ignored for bulk
	}
};
 
static struct usb_interface_descriptor if_desc = {
	bLength:USB_DT_INTERFACE_SIZE,
	bDescriptorType:USB_DT_INTERFACE,
	bInterfaceNumber:0x00,
	bAlternateSetting:0x00,
	bNumEndpoints:NUM_EP,
	bInterfaceClass:0xff,
	bInterfaceSubClass:0xab,
	bInterfaceProtocol:0x00,
	iInterface:0x05
};
 
static struct usb_config_descriptor config_desc = {
	bLength:USB_DT_CONFIG_SIZE,
	bDescriptorType:USB_DT_CONFIG,
	wTotalLength:CONFIG_DESC_LEN,
	bNumInterfaces:0x01,
	bConfigurationValue:0x01,
	iConfiguration:0x04,	// configuration string
	bmAttributes:0xc0,	// self-powered
	MaxPower:20		// 40 mA
};
 
// String[0] is a list of Language IDs supported by this device
static struct usb_string_descriptor string_desc0 = {
	bLength:4,
	bDescriptorType:USB_DT_STRING,
	wData:{0x0409} // English, US
};
 
// These strings will be converted to Unicode in string_desc[]
static char *strings[5] = {
	"Alchemy Semiconductor",  // iManufacturer
	"USB Raw Block Device",   // iProduct
	"0.1",                    // iSerialNumber
	"USB Raw Config",         // iConfiguration
	"USB Raw Interface"       // iInterface
};
 
 
static void
receive_callback(struct usb_raw_port *port)
{
	int i, pkt_size;
	usbdev_pkt_t* pkt;
 
	if ((pkt_size = usbdev_receive_packet(port->out_ep_addr,
					      &pkt)) <= 0) {
		dbg(__FUNCTION__ ": usbdev_receive_packet returns %d",
		    pkt_size);
		return;
	}
 
	dbg(__FUNCTION__ ": ep%d, size=%d", port->out_ep_addr, pkt_size);
 
	spin_lock(&port->port_lock);
	for (i=0; i < pkt_size; i++) {
		port->read_buf[port->read_nextin++] = pkt->payload[i];
		port->read_nextin &= (READ_BUF_SIZE - 1);
		if (++port->read_count == READ_BUF_SIZE)
			break;
	}
	spin_unlock(&port->port_lock);
 
	/* free the packet */
	kfree(pkt);
 
	// async notify
	if (port->fasync)
		kill_fasync(&port->fasync, SIGIO, POLL_IN);
	// wake up any read call
	if (waitqueue_active(&port->wait))
		wake_up_interruptible(&port->wait);
}
 
static void
transmit_callback(struct usb_raw_port *port, usbdev_pkt_t* pkt)
{
	dbg(__FUNCTION__ ": ep%d", port->in_ep_addr);
	/* just free the returned packet */
	kfree(pkt);
}
 
 
static void
usbraw_callback(usbdev_cb_type_t cb_type, unsigned long arg, void* data)
{
	usbdev_pkt_t* pkt;
	int i;
 
	switch (cb_type) {
	case CB_NEW_STATE:
		usbraw.dev_state = (usbdev_state_t)arg;
		break;
	case CB_PKT_COMPLETE:
		pkt = (usbdev_pkt_t*)arg;
		for (i=0; i<NUM_PORTS; i++) {
			struct usb_raw_port *port = &usbraw.port[i];
			if (pkt->ep_addr == port->in_ep_addr) {
				transmit_callback(port, pkt);
				break;
			} else if (pkt->ep_addr == port->out_ep_addr) {
				receive_callback(port);
				break;
			}
		}
		break;
	}
}
 
/*****************************************************************************
 * Here begins the driver interface functions
 *****************************************************************************/
 
static unsigned int usbraw_poll(struct file * filp, poll_table * wait)
{
	struct usb_raw_port *port = (struct usb_raw_port *)filp->private_data;
	unsigned long flags;
	int count;
 
	poll_wait(filp, &port->wait, wait);
 
	spin_lock_irqsave(&port->port_lock, flags);
	count = port->read_count;
	spin_unlock_irqrestore(&port->port_lock, flags);
 
	if (count > 0) {
		dbg(__FUNCTION__ ": count=%d", count);
		return POLLIN | POLLRDNORM;
	}
 
	return 0;
}
 
static int usbraw_fasync(int fd, struct file *filp, int mode)
{
	struct usb_raw_port *port = (struct usb_raw_port *)filp->private_data;
	return fasync_helper(fd, filp, mode, &port->fasync);
}
 
static int usbraw_open(struct inode * inode, struct file *filp)
{
	int portNumber;
	struct usb_raw_port *port;
	unsigned long flags;
 
	/*
	 * the device-layer must be in the configured state before the
	 * function layer can operate.
	 */
	if (usbraw.dev_state != CONFIGURED)
		return -ENODEV;
 
	MOD_INC_USE_COUNT;
 
	/* set up our port structure making the tty driver remember
	   our port object, and us it */
	portNumber = MINOR(inode->i_rdev);
	port = &usbraw.port[portNumber];
	filp->private_data = port;
 
	dbg(__FUNCTION__ ": port %d", port->number);
 
	spin_lock_irqsave(&port->port_lock, flags);
 
	++port->open_count;
 
	if (!port->active) {
		port->active = 1;
	}
 
	/* flush read buffer */
	port->read_nextin = port->read_nextout = port->read_count = 0;
 
	spin_unlock_irqrestore(&port->port_lock, flags);
 
	return 0;
}
 
static int usbraw_release(struct inode * inode, struct file * filp)
{
	struct usb_raw_port *port = (struct usb_raw_port *)filp->private_data;
	unsigned long flags;
 
	dbg(__FUNCTION__ ": port %d", port->number);
 
	if (!port->active) {
		err(__FUNCTION__ ": port not opened");
		return -ENODEV;
	}
 
	usbraw_fasync(-1, filp, 0);
 
	spin_lock_irqsave(&port->port_lock, flags);
 
	--port->open_count;
 
	if (port->open_count <= 0) {
		port->active = 0;
		port->open_count = 0;
	}
 
	spin_unlock_irqrestore(&port->port_lock, flags);
	MOD_DEC_USE_COUNT;
	return 0;
}
 
 
static ssize_t usbraw_read(struct file * filp, char * buf,
			   size_t count, loff_t * l)
{
	struct usb_raw_port *port = (struct usb_raw_port *)filp->private_data;
	unsigned long flags;
	int i, cnt;
 
	/*
	 * the device-layer must be in the configured state before the
	 * function layer can operate.
	 */
	if (usbraw.dev_state != CONFIGURED)
		return -ENODEV;
 
	do { 
		spin_lock_irqsave(&port->port_lock, flags);
		cnt = port->read_count;
		spin_unlock_irqrestore(&port->port_lock, flags);
		if (cnt == 0) {
			if (filp->f_flags & O_NONBLOCK)
				return -EAGAIN;
			interruptible_sleep_on(&port->wait);
			if (signal_pending(current))
				return -ERESTARTSYS;
		}
	} while (cnt == 0);
 
	count = (count > cnt) ? cnt : count;
 
	for (i=0; i<count; i++) {
		put_user(port->read_buf[port->read_nextout++], &buf[i]);
		port->read_nextout &= (READ_BUF_SIZE - 1);
		spin_lock_irqsave(&port->port_lock, flags);
		port->read_count--;
		spin_unlock_irqrestore(&port->port_lock, flags);
		if (port->read_count == 0)
			break;
	}
 
	return i+1;
}
 
static ssize_t usbraw_write(struct file * filp, const char * buf,
			    size_t count, loff_t *ppos)
{
	struct usb_raw_port *port = (struct usb_raw_port *)filp->private_data;
	usbdev_pkt_t* pkt;
	int ret, max_pkt_sz;
 
	/*
	 * the device-layer must be in the configured state before the
	 * function layer can operate.
	 */
	if (usbraw.dev_state != CONFIGURED)
		return -ENODEV;
 
	if (!port->active) {
		err(__FUNCTION__ ": port not opened");
		return -EINVAL;
	}
 
	if (count == 0) {
		dbg(__FUNCTION__ ": write request of 0 bytes");
		return (0);
	}
 
	max_pkt_sz = port->in_desc->wMaxPacketSize;
	count = (count > max_pkt_sz) ? max_pkt_sz : count;
 
	if ((ret = usbdev_alloc_packet(port->in_ep_addr, count, &pkt)) < 0)
		return ret;
 
	copy_from_user(pkt->payload, buf, count);
 
	return usbdev_send_packet(port->in_ep_addr, pkt);
}
 
static int usbraw_ioctl(struct inode *inode, struct file *filp,
			unsigned int cmd, unsigned long arg)
{
	struct usb_raw_port *port = (struct usb_raw_port *)filp->private_data;
 
	if (!port->active) {
		err(__FUNCTION__ ": port not open");
		return -ENODEV;
	}
	// FIXME: need any IOCTLs?
 
	return -ENOIOCTLCMD;
}
 
 
static struct file_operations usbraw_fops = {
        owner:          THIS_MODULE,
        write:          usbraw_write,
	read:           usbraw_read,
	poll:           usbraw_poll,
	ioctl:		usbraw_ioctl,
	fasync:         usbraw_fasync,
	open:		usbraw_open,
	release:	usbraw_release,
};
 
void usbfn_raw_exit(void)
{
	/* kill the device layer */
	usbdev_exit();
 
	unregister_chrdev(USBRAW_MAJOR, USBRAW_NAME);
 
	if (usbraw.str_desc_buf)
		kfree(usbraw.str_desc_buf);
}
 
 
int usbfn_raw_init(void)
{
	int ret = 0, i, str_desc_len;
 
	/* register our character device */
	if ((ret = register_chrdev(USBRAW_MAJOR, USBRAW_NAME,
				   &usbraw_fops)) < 0) {
		err("can't get major number");
		return ret;
	}
	info("registered");
 
	/*
	 * initialize pointers to descriptors
	 */
	usbraw.dev_desc = &dev_desc;
	usbraw.config_desc = &config_desc;
	usbraw.if_desc = &if_desc;
 
	/*
	 * initialize the string descriptors
	 */
 
	/* alloc buffer big enough for all string descriptors */
	str_desc_len = string_desc0.bLength;
	for (i = 0; i < 5; i++)
		str_desc_len += 2 + 2 * strlen(strings[i]);
	usbraw.str_desc_buf = (void *) kmalloc(str_desc_len, GFP_KERNEL);
	if (!usbraw.str_desc_buf) {
		err(__FUNCTION__ ": failed to alloc string descriptors");
		ret = -ENOMEM;
		goto out;
	}
 
	usbraw.str_desc[0] =
		(struct usb_string_descriptor *)usbraw.str_desc_buf;
	memcpy(usbraw.str_desc[0], &string_desc0, string_desc0.bLength);
	usbraw.str_desc[1] = (struct usb_string_descriptor *)
		(usbraw.str_desc_buf + string_desc0.bLength);
	for (i = 1; i < 6; i++) {
		struct usb_string_descriptor *desc = usbraw.str_desc[i];
		char *str = strings[i - 1];
		int j, str_len = strlen(str);
 
		desc->bLength = 2 + 2 * str_len;
		desc->bDescriptorType = USB_DT_STRING;
		for (j = 0; j < str_len; j++) {
			desc->wData[j] = (u16) str[j];
		}
		if (i < 5)
			usbraw.str_desc[i + 1] =
				(struct usb_string_descriptor *)
				((u8 *) desc + desc->bLength);
	}
 
	/*
	 * start the device layer. The device layer assigns us
	 * our endpoint addresses
	 */
	if ((ret = usbdev_init(&dev_desc, &config_desc, &if_desc, ep_desc,
			       usbraw.str_desc, usbraw_callback, NULL))) {
		err(__FUNCTION__ ": device-layer init failed");
		goto out;
	}
 
	/* initialize the devfs nodes for this device and let the user
	   know what ports we are bound to */
	for (i = 0; i < NUM_PORTS; ++i) {
		struct usb_raw_port *port = &usbraw.port[i];
 
		port->number = i;
		port->in_desc = &ep_desc[NUM_PORTS*i];
		port->out_desc = &ep_desc[NUM_PORTS*i + 1];
		port->in_ep_addr = port->in_desc->bEndpointAddress & 0x0f;
		port->out_ep_addr = port->out_desc->bEndpointAddress & 0x0f;
		init_waitqueue_head(&port->wait);
		spin_lock_init(&port->port_lock);
	}
 
 out:
	if (ret)
		usbfn_raw_exit();
	return ret;
}
 
 
/* Module information */
MODULE_AUTHOR("Steve Longerbeam, stevel@mvista.com, www.mvista.com");
MODULE_DESCRIPTION("Au1x00 USB Device-Side Raw Block Driver");
MODULE_LICENSE("GPL");
 
module_init(usbfn_raw_init);
module_exit(usbfn_raw_exit);