Logo Search packages:      
Sourcecode: linux version File versions  Download package

s3c2410_udc.c

/*
 * linux/drivers/usb/gadget/s3c2410_udc.c
 *
 * Samsung S3C24xx series on-chip full speed USB device controllers
 *
 * Copyright (C) 2004-2007 Herbert P÷tzl - Arnaud Patard
 *    Additional cleanups by Ben Dooks <ben-linux@fluff.org>
 *
 * 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 program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/ioport.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/smp_lock.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/timer.h>
#include <linux/list.h>
#include <linux/interrupt.h>
#include <linux/platform_device.h>
#include <linux/version.h>
#include <linux/clk.h>

#include <linux/debugfs.h>
#include <linux/seq_file.h>

#include <linux/usb.h>
#include <linux/usb/gadget.h>

#include <asm/byteorder.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/system.h>
#include <asm/unaligned.h>
#include <asm/arch/irqs.h>

#include <asm/arch/hardware.h>
#include <asm/arch/regs-gpio.h>

#include <asm/plat-s3c24xx/regs-udc.h>
#include <asm/plat-s3c24xx/udc.h>

#include <asm/mach-types.h>

#include "s3c2410_udc.h"

#define DRIVER_DESC     "S3C2410 USB Device Controller Gadget"
#define DRIVER_VERSION  "29 Apr 2007"
#define DRIVER_AUTHOR   "Herbert P÷tzl <herbert@13thfloor.at>, " \
                  "Arnaud Patard <arnaud.patard@rtp-net.org>"

static const char       gadget_name[] = "s3c2410_udc";
static const char       driver_desc[] = DRIVER_DESC;

static struct s3c2410_udc     *the_controller;
static struct clk       *udc_clock;
static struct clk       *usb_bus_clock;
static void __iomem           *base_addr;
static u64              rsrc_start;
static u64              rsrc_len;
static struct dentry          *s3c2410_udc_debugfs_root;

static inline u32 udc_read(u32 reg)
{
      return readb(base_addr + reg);
}

static inline void udc_write(u32 value, u32 reg)
{
      writeb(value, base_addr + reg);
}

static inline void udc_writeb(void __iomem *base, u32 value, u32 reg)
{
      writeb(value, base + reg);
}

static struct s3c2410_udc_mach_info *udc_info;

/*************************** DEBUG FUNCTION ***************************/
#define DEBUG_NORMAL    1
#define DEBUG_VERBOSE   2

#ifdef CONFIG_USB_S3C2410_DEBUG
#define USB_S3C2410_DEBUG_LEVEL 0

static uint32_t s3c2410_ticks = 0;

static int dprintk(int level, const char *fmt, ...)
{
      static char printk_buf[1024];
      static long prevticks;
      static int invocation;
      va_list args;
      int len;

      if (level > USB_S3C2410_DEBUG_LEVEL)
            return 0;

      if (s3c2410_ticks != prevticks) {
            prevticks = s3c2410_ticks;
            invocation = 0;
      }

      len = scnprintf(printk_buf,
                  sizeof(printk_buf), "%1lu.%02d USB: ",
                  prevticks, invocation++);

      va_start(args, fmt);
      len = vscnprintf(printk_buf+len,
                  sizeof(printk_buf)-len, fmt, args);
      va_end(args);

      return printk(KERN_DEBUG "%s", printk_buf);
}
#else
static int dprintk(int level, const char *fmt, ...)
{
      return 0;
}
#endif
static int s3c2410_udc_debugfs_seq_show(struct seq_file *m, void *p)
{
      u32 addr_reg,pwr_reg,ep_int_reg,usb_int_reg;
      u32 ep_int_en_reg, usb_int_en_reg, ep0_csr;
      u32 ep1_i_csr1,ep1_i_csr2,ep1_o_csr1,ep1_o_csr2;
      u32 ep2_i_csr1,ep2_i_csr2,ep2_o_csr1,ep2_o_csr2;

      addr_reg       = udc_read(S3C2410_UDC_FUNC_ADDR_REG);
      pwr_reg        = udc_read(S3C2410_UDC_PWR_REG);
      ep_int_reg     = udc_read(S3C2410_UDC_EP_INT_REG);
      usb_int_reg    = udc_read(S3C2410_UDC_USB_INT_REG);
      ep_int_en_reg  = udc_read(S3C2410_UDC_EP_INT_EN_REG);
      usb_int_en_reg = udc_read(S3C2410_UDC_USB_INT_EN_REG);
      udc_write(0, S3C2410_UDC_INDEX_REG);
      ep0_csr        = udc_read(S3C2410_UDC_IN_CSR1_REG);
      udc_write(1, S3C2410_UDC_INDEX_REG);
      ep1_i_csr1     = udc_read(S3C2410_UDC_IN_CSR1_REG);
      ep1_i_csr2     = udc_read(S3C2410_UDC_IN_CSR2_REG);
      ep1_o_csr1     = udc_read(S3C2410_UDC_IN_CSR1_REG);
      ep1_o_csr2     = udc_read(S3C2410_UDC_IN_CSR2_REG);
      udc_write(2, S3C2410_UDC_INDEX_REG);
      ep2_i_csr1     = udc_read(S3C2410_UDC_IN_CSR1_REG);
      ep2_i_csr2     = udc_read(S3C2410_UDC_IN_CSR2_REG);
      ep2_o_csr1     = udc_read(S3C2410_UDC_IN_CSR1_REG);
      ep2_o_csr2     = udc_read(S3C2410_UDC_IN_CSR2_REG);

      seq_printf(m, "FUNC_ADDR_REG  : 0x%04X\n"
             "PWR_REG        : 0x%04X\n"
             "EP_INT_REG     : 0x%04X\n"
             "USB_INT_REG    : 0x%04X\n"
             "EP_INT_EN_REG  : 0x%04X\n"
             "USB_INT_EN_REG : 0x%04X\n"
             "EP0_CSR        : 0x%04X\n"
             "EP1_I_CSR1     : 0x%04X\n"
             "EP1_I_CSR2     : 0x%04X\n"
             "EP1_O_CSR1     : 0x%04X\n"
             "EP1_O_CSR2     : 0x%04X\n"
             "EP2_I_CSR1     : 0x%04X\n"
             "EP2_I_CSR2     : 0x%04X\n"
             "EP2_O_CSR1     : 0x%04X\n"
             "EP2_O_CSR2     : 0x%04X\n",
                  addr_reg,pwr_reg,ep_int_reg,usb_int_reg,
                  ep_int_en_reg, usb_int_en_reg, ep0_csr,
                  ep1_i_csr1,ep1_i_csr2,ep1_o_csr1,ep1_o_csr2,
                  ep2_i_csr1,ep2_i_csr2,ep2_o_csr1,ep2_o_csr2
            );

      return 0;
}

static int s3c2410_udc_debugfs_fops_open(struct inode *inode,
                               struct file *file)
{
      return single_open(file, s3c2410_udc_debugfs_seq_show, NULL);
}

static const struct file_operations s3c2410_udc_debugfs_fops = {
      .open       = s3c2410_udc_debugfs_fops_open,
      .read       = seq_read,
      .llseek           = seq_lseek,
      .release    = single_release,
      .owner            = THIS_MODULE,
};

/* io macros */

static inline void s3c2410_udc_clear_ep0_opr(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      udc_writeb(base, S3C2410_UDC_EP0_CSR_SOPKTRDY,
                  S3C2410_UDC_EP0_CSR_REG);
}

static inline void s3c2410_udc_clear_ep0_sst(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      writeb(0x00, base + S3C2410_UDC_EP0_CSR_REG);
}

static inline void s3c2410_udc_clear_ep0_se(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      udc_writeb(base, S3C2410_UDC_EP0_CSR_SSE, S3C2410_UDC_EP0_CSR_REG);
}

static inline void s3c2410_udc_set_ep0_ipr(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      udc_writeb(base, S3C2410_UDC_EP0_CSR_IPKRDY, S3C2410_UDC_EP0_CSR_REG);
}

static inline void s3c2410_udc_set_ep0_de(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      udc_writeb(base, S3C2410_UDC_EP0_CSR_DE, S3C2410_UDC_EP0_CSR_REG);
}

inline void s3c2410_udc_set_ep0_ss(void __iomem *b)
{
      udc_writeb(b, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      udc_writeb(b, S3C2410_UDC_EP0_CSR_SENDSTL, S3C2410_UDC_EP0_CSR_REG);
}

static inline void s3c2410_udc_set_ep0_de_out(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);

      udc_writeb(base,(S3C2410_UDC_EP0_CSR_SOPKTRDY
                        | S3C2410_UDC_EP0_CSR_DE),
                  S3C2410_UDC_EP0_CSR_REG);
}

static inline void s3c2410_udc_set_ep0_sse_out(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      udc_writeb(base, (S3C2410_UDC_EP0_CSR_SOPKTRDY
                        | S3C2410_UDC_EP0_CSR_SSE),
                  S3C2410_UDC_EP0_CSR_REG);
}

static inline void s3c2410_udc_set_ep0_de_in(void __iomem *base)
{
      udc_writeb(base, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      udc_writeb(base, (S3C2410_UDC_EP0_CSR_IPKRDY
                  | S3C2410_UDC_EP0_CSR_DE),
            S3C2410_UDC_EP0_CSR_REG);
}

/*------------------------- I/O ----------------------------------*/

/*
 *    s3c2410_udc_done
 */
static void s3c2410_udc_done(struct s3c2410_ep *ep,
            struct s3c2410_request *req, int status)
{
      unsigned halted = ep->halted;

      list_del_init(&req->queue);

      if (likely (req->req.status == -EINPROGRESS))
            req->req.status = status;
      else
            status = req->req.status;

      ep->halted = 1;
      req->req.complete(&ep->ep, &req->req);
      ep->halted = halted;
}

static void s3c2410_udc_nuke(struct s3c2410_udc *udc,
            struct s3c2410_ep *ep, int status)
{
      /* Sanity check */
      if (&ep->queue == NULL)
            return;

      while (!list_empty (&ep->queue)) {
            struct s3c2410_request *req;
            req = list_entry (ep->queue.next, struct s3c2410_request,
                        queue);
            s3c2410_udc_done(ep, req, status);
      }
}

static inline void s3c2410_udc_clear_ep_state(struct s3c2410_udc *dev)
{
      unsigned i;

      /* hardware SET_{CONFIGURATION,INTERFACE} automagic resets endpoint
       * fifos, and pending transactions mustn't be continued in any case.
       */

      for (i = 1; i < S3C2410_ENDPOINTS; i++)
            s3c2410_udc_nuke(dev, &dev->ep[i], -ECONNABORTED);
}

static inline int s3c2410_udc_fifo_count_out(void)
{
      int tmp;

      tmp = udc_read(S3C2410_UDC_OUT_FIFO_CNT2_REG) << 8;
      tmp |= udc_read(S3C2410_UDC_OUT_FIFO_CNT1_REG);
      return tmp;
}

/*
 *    s3c2410_udc_write_packet
 */
static inline int s3c2410_udc_write_packet(int fifo,
            struct s3c2410_request *req,
            unsigned max)
{
      unsigned len = min(req->req.length - req->req.actual, max);
      u8 *buf = req->req.buf + req->req.actual;

      prefetch(buf);

      dprintk(DEBUG_VERBOSE, "%s %d %d %d %d\n", __func__,
            req->req.actual, req->req.length, len, req->req.actual + len);

      req->req.actual += len;

      udelay(5);
      writesb(base_addr + fifo, buf, len);
      return len;
}

/*
 *    s3c2410_udc_write_fifo
 *
 * return:  0 = still running, 1 = completed, negative = errno
 */
static int s3c2410_udc_write_fifo(struct s3c2410_ep *ep,
            struct s3c2410_request *req)
{
      unsigned    count;
      int         is_last;
      u32         idx;
      int         fifo_reg;
      u32         ep_csr;

      idx = ep->bEndpointAddress & 0x7F;
      switch (idx) {
      default:
            idx = 0;
      case 0:
            fifo_reg = S3C2410_UDC_EP0_FIFO_REG;
            break;
      case 1:
            fifo_reg = S3C2410_UDC_EP1_FIFO_REG;
            break;
      case 2:
            fifo_reg = S3C2410_UDC_EP2_FIFO_REG;
            break;
      case 3:
            fifo_reg = S3C2410_UDC_EP3_FIFO_REG;
            break;
      case 4:
            fifo_reg = S3C2410_UDC_EP4_FIFO_REG;
            break;
      }

      count = s3c2410_udc_write_packet(fifo_reg, req, ep->ep.maxpacket);

      /* last packet is often short (sometimes a zlp) */
      if (count != ep->ep.maxpacket)
            is_last = 1;
      else if (req->req.length != req->req.actual || req->req.zero)
            is_last = 0;
      else
            is_last = 2;

      /* Only ep0 debug messages are interesting */
      if (idx == 0)
            dprintk(DEBUG_NORMAL,
                  "Written ep%d %d.%d of %d b [last %d,z %d]\n",
                  idx, count, req->req.actual, req->req.length,
                  is_last, req->req.zero);

      if (is_last) {
            /* The order is important. It prevents sending 2 packets
             * at the same time */

            if (idx == 0) {
                  /* Reset signal => no need to say 'data sent' */
                  if (! (udc_read(S3C2410_UDC_USB_INT_REG)
                              & S3C2410_UDC_USBINT_RESET))
                        s3c2410_udc_set_ep0_de_in(base_addr);
                  ep->dev->ep0state=EP0_IDLE;
            } else {
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  ep_csr = udc_read(S3C2410_UDC_IN_CSR1_REG);
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  udc_write(ep_csr | S3C2410_UDC_ICSR1_PKTRDY,
                              S3C2410_UDC_IN_CSR1_REG);
            }

            s3c2410_udc_done(ep, req, 0);
            is_last = 1;
      } else {
            if (idx == 0) {
                  /* Reset signal => no need to say 'data sent' */
                  if (! (udc_read(S3C2410_UDC_USB_INT_REG)
                              & S3C2410_UDC_USBINT_RESET))
                        s3c2410_udc_set_ep0_ipr(base_addr);
            } else {
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  ep_csr = udc_read(S3C2410_UDC_IN_CSR1_REG);
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  udc_write(ep_csr | S3C2410_UDC_ICSR1_PKTRDY,
                              S3C2410_UDC_IN_CSR1_REG);
            }
      }

      return is_last;
}

static inline int s3c2410_udc_read_packet(int fifo, u8 *buf,
            struct s3c2410_request *req, unsigned avail)
{
      unsigned len;

      len = min(req->req.length - req->req.actual, avail);
      req->req.actual += len;

      readsb(fifo + base_addr, buf, len);
      return len;
}

/*
 * return:  0 = still running, 1 = queue empty, negative = errno
 */
static int s3c2410_udc_read_fifo(struct s3c2410_ep *ep,
                         struct s3c2410_request *req)
{
      u8          *buf;
      u32         ep_csr;
      unsigned    bufferspace;
      int         is_last=1;
      unsigned    avail;
      int         fifo_count = 0;
      u32         idx;
      int         fifo_reg;

      idx = ep->bEndpointAddress & 0x7F;

      switch (idx) {
      default:
            idx = 0;
      case 0:
            fifo_reg = S3C2410_UDC_EP0_FIFO_REG;
            break;
      case 1:
            fifo_reg = S3C2410_UDC_EP1_FIFO_REG;
            break;
      case 2:
            fifo_reg = S3C2410_UDC_EP2_FIFO_REG;
            break;
      case 3:
            fifo_reg = S3C2410_UDC_EP3_FIFO_REG;
            break;
      case 4:
            fifo_reg = S3C2410_UDC_EP4_FIFO_REG;
            break;
      }

      if (!req->req.length)
            return 1;

      buf = req->req.buf + req->req.actual;
      bufferspace = req->req.length - req->req.actual;
      if (!bufferspace) {
            dprintk(DEBUG_NORMAL, "%s: buffer full!\n", __func__);
            return -1;
      }

      udc_write(idx, S3C2410_UDC_INDEX_REG);

      fifo_count = s3c2410_udc_fifo_count_out();
      dprintk(DEBUG_NORMAL, "%s fifo count : %d\n", __func__, fifo_count);

      if (fifo_count > ep->ep.maxpacket)
            avail = ep->ep.maxpacket;
      else
            avail = fifo_count;

      fifo_count = s3c2410_udc_read_packet(fifo_reg, buf, req, avail);

      /* checking this with ep0 is not accurate as we already
       * read a control request
       **/
      if (idx != 0 && fifo_count < ep->ep.maxpacket) {
            is_last = 1;
            /* overflowed this request?  flush extra data */
            if (fifo_count != avail)
                  req->req.status = -EOVERFLOW;
      } else {
            is_last = (req->req.length <= req->req.actual) ? 1 : 0;
      }

      udc_write(idx, S3C2410_UDC_INDEX_REG);
      fifo_count = s3c2410_udc_fifo_count_out();

      /* Only ep0 debug messages are interesting */
      if (idx == 0)
            dprintk(DEBUG_VERBOSE, "%s fifo count : %d [last %d]\n",
                  __func__, fifo_count,is_last);

      if (is_last) {
            if (idx == 0) {
                  s3c2410_udc_set_ep0_de_out(base_addr);
                  ep->dev->ep0state = EP0_IDLE;
            } else {
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  ep_csr = udc_read(S3C2410_UDC_OUT_CSR1_REG);
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  udc_write(ep_csr & ~S3C2410_UDC_OCSR1_PKTRDY,
                              S3C2410_UDC_OUT_CSR1_REG);
            }

            s3c2410_udc_done(ep, req, 0);
      } else {
            if (idx == 0) {
                  s3c2410_udc_clear_ep0_opr(base_addr);
            } else {
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  ep_csr = udc_read(S3C2410_UDC_OUT_CSR1_REG);
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  udc_write(ep_csr & ~S3C2410_UDC_OCSR1_PKTRDY,
                              S3C2410_UDC_OUT_CSR1_REG);
            }
      }

      return is_last;
}

static int s3c2410_udc_read_fifo_crq(struct usb_ctrlrequest *crq)
{
      unsigned char *outbuf = (unsigned char*)crq;
      int bytes_read = 0;

      udc_write(0, S3C2410_UDC_INDEX_REG);

      bytes_read = s3c2410_udc_fifo_count_out();

      dprintk(DEBUG_NORMAL, "%s: fifo_count=%d\n", __func__, bytes_read);

      if (bytes_read > sizeof(struct usb_ctrlrequest))
            bytes_read = sizeof(struct usb_ctrlrequest);

      readsb(S3C2410_UDC_EP0_FIFO_REG + base_addr, outbuf, bytes_read);

      dprintk(DEBUG_VERBOSE, "%s: len=%d %02x:%02x {%x,%x,%x}\n", __func__,
            bytes_read, crq->bRequest, crq->bRequestType,
            crq->wValue, crq->wIndex, crq->wLength);

      return bytes_read;
}

static int s3c2410_udc_get_status(struct s3c2410_udc *dev,
            struct usb_ctrlrequest *crq)
{
      u16 status = 0;
      u8 ep_num = crq->wIndex & 0x7F;
      u8 is_in = crq->wIndex & USB_DIR_IN;

      switch (crq->bRequestType & USB_RECIP_MASK) {
      case USB_RECIP_INTERFACE:
            break;

      case USB_RECIP_DEVICE:
            status = dev->devstatus;
            break;

      case USB_RECIP_ENDPOINT:
            if (ep_num > 4 || crq->wLength > 2)
                  return 1;

            if (ep_num == 0) {
                  udc_write(0, S3C2410_UDC_INDEX_REG);
                  status = udc_read(S3C2410_UDC_IN_CSR1_REG);
                  status = status & S3C2410_UDC_EP0_CSR_SENDSTL;
            } else {
                  udc_write(ep_num, S3C2410_UDC_INDEX_REG);
                  if (is_in) {
                        status = udc_read(S3C2410_UDC_IN_CSR1_REG);
                        status = status & S3C2410_UDC_ICSR1_SENDSTL;
                  } else {
                        status = udc_read(S3C2410_UDC_OUT_CSR1_REG);
                        status = status & S3C2410_UDC_OCSR1_SENDSTL;
                  }
            }

            status = status ? 1 : 0;
            break;

      default:
            return 1;
      }

      /* Seems to be needed to get it working. ouch :( */
      udelay(5);
      udc_write(status & 0xFF, S3C2410_UDC_EP0_FIFO_REG);
      udc_write(status >> 8, S3C2410_UDC_EP0_FIFO_REG);
      s3c2410_udc_set_ep0_de_in(base_addr);

      return 0;
}
/*------------------------- usb state machine -------------------------------*/
static int s3c2410_udc_set_halt(struct usb_ep *_ep, int value);

static void s3c2410_udc_handle_ep0_idle(struct s3c2410_udc *dev,
                              struct s3c2410_ep *ep,
                              struct usb_ctrlrequest *crq,
                              u32 ep0csr)
{
      int len, ret, tmp;

      /* start control request? */
      if (!(ep0csr & S3C2410_UDC_EP0_CSR_OPKRDY))
            return;

      s3c2410_udc_nuke(dev, ep, -EPROTO);

      len = s3c2410_udc_read_fifo_crq(crq);
      if (len != sizeof(*crq)) {
            dprintk(DEBUG_NORMAL, "setup begin: fifo READ ERROR"
                  " wanted %d bytes got %d. Stalling out...\n",
                  sizeof(*crq), len);
            s3c2410_udc_set_ep0_ss(base_addr);
            return;
      }

      dprintk(DEBUG_NORMAL, "bRequest = %d bRequestType %d wLength = %d\n",
            crq->bRequest, crq->bRequestType, crq->wLength);

      /* cope with automagic for some standard requests. */
      dev->req_std = (crq->bRequestType & USB_TYPE_MASK)
            == USB_TYPE_STANDARD;
      dev->req_config = 0;
      dev->req_pending = 1;

      switch (crq->bRequest) {
      case USB_REQ_SET_CONFIGURATION:
            dprintk(DEBUG_NORMAL, "USB_REQ_SET_CONFIGURATION ... \n");

            if (crq->bRequestType == USB_RECIP_DEVICE) {
                  dev->req_config = 1;
                  s3c2410_udc_set_ep0_de_out(base_addr);
            }
            break;

      case USB_REQ_SET_INTERFACE:
            dprintk(DEBUG_NORMAL, "USB_REQ_SET_INTERFACE ... \n");

            if (crq->bRequestType == USB_RECIP_INTERFACE) {
                  dev->req_config = 1;
                  s3c2410_udc_set_ep0_de_out(base_addr);
            }
            break;

      case USB_REQ_SET_ADDRESS:
            dprintk(DEBUG_NORMAL, "USB_REQ_SET_ADDRESS ... \n");

            if (crq->bRequestType == USB_RECIP_DEVICE) {
                  tmp = crq->wValue & 0x7F;
                  dev->address = tmp;
                  udc_write((tmp | S3C2410_UDC_FUNCADDR_UPDATE),
                              S3C2410_UDC_FUNC_ADDR_REG);
                  s3c2410_udc_set_ep0_de_out(base_addr);
                  return;
            }
            break;

      case USB_REQ_GET_STATUS:
            dprintk(DEBUG_NORMAL, "USB_REQ_GET_STATUS ... \n");
            s3c2410_udc_clear_ep0_opr(base_addr);

            if (dev->req_std) {
                  if (!s3c2410_udc_get_status(dev, crq)) {
                        return;
                  }
            }
            break;

      case USB_REQ_CLEAR_FEATURE:
            s3c2410_udc_clear_ep0_opr(base_addr);

            if (crq->bRequestType != USB_RECIP_ENDPOINT)
                  break;

            if (crq->wValue != USB_ENDPOINT_HALT || crq->wLength != 0)
                  break;

            s3c2410_udc_set_halt(&dev->ep[crq->wIndex & 0x7f].ep, 0);
            s3c2410_udc_set_ep0_de_out(base_addr);
            return;

      case USB_REQ_SET_FEATURE:
            s3c2410_udc_clear_ep0_opr(base_addr);

            if (crq->bRequestType != USB_RECIP_ENDPOINT)
                  break;

            if (crq->wValue != USB_ENDPOINT_HALT || crq->wLength != 0)
                  break;

            s3c2410_udc_set_halt(&dev->ep[crq->wIndex & 0x7f].ep, 1);
            s3c2410_udc_set_ep0_de_out(base_addr);
            return;

      default:
            s3c2410_udc_clear_ep0_opr(base_addr);
            break;
      }

      if (crq->bRequestType & USB_DIR_IN)
            dev->ep0state = EP0_IN_DATA_PHASE;
      else
            dev->ep0state = EP0_OUT_DATA_PHASE;

      ret = dev->driver->setup(&dev->gadget, crq);
      if (ret < 0) {
            if (dev->req_config) {
                  dprintk(DEBUG_NORMAL, "config change %02x fail %d?\n",
                        crq->bRequest, ret);
                  return;
            }

            if (ret == -EOPNOTSUPP)
                  dprintk(DEBUG_NORMAL, "Operation not supported\n");
            else
                  dprintk(DEBUG_NORMAL,
                        "dev->driver->setup failed. (%d)\n", ret);

            udelay(5);
            s3c2410_udc_set_ep0_ss(base_addr);
            s3c2410_udc_set_ep0_de_out(base_addr);
            dev->ep0state = EP0_IDLE;
            /* deferred i/o == no response yet */
      } else if (dev->req_pending) {
            dprintk(DEBUG_VERBOSE, "dev->req_pending... what now?\n");
            dev->req_pending=0;
      }

      dprintk(DEBUG_VERBOSE, "ep0state %s\n", ep0states[dev->ep0state]);
}

static void s3c2410_udc_handle_ep0(struct s3c2410_udc *dev)
{
      u32               ep0csr;
      struct s3c2410_ep *ep = &dev->ep[0];
      struct s3c2410_request  *req;
      struct usb_ctrlrequest  crq;

      if (list_empty(&ep->queue))
            req = NULL;
      else
            req = list_entry(ep->queue.next, struct s3c2410_request, queue);

      /* We make the assumption that S3C2410_UDC_IN_CSR1_REG equal to
       * S3C2410_UDC_EP0_CSR_REG when index is zero */

      udc_write(0, S3C2410_UDC_INDEX_REG);
      ep0csr = udc_read(S3C2410_UDC_IN_CSR1_REG);

      dprintk(DEBUG_NORMAL, "ep0csr %x ep0state %s\n",
            ep0csr, ep0states[dev->ep0state]);

      /* clear stall status */
      if (ep0csr & S3C2410_UDC_EP0_CSR_SENTSTL) {
            s3c2410_udc_nuke(dev, ep, -EPIPE);
            dprintk(DEBUG_NORMAL, "... clear SENT_STALL ...\n");
            s3c2410_udc_clear_ep0_sst(base_addr);
            dev->ep0state = EP0_IDLE;
            return;
      }

      /* clear setup end */
      if (ep0csr & S3C2410_UDC_EP0_CSR_SE) {
            dprintk(DEBUG_NORMAL, "... serviced SETUP_END ...\n");
            s3c2410_udc_nuke(dev, ep, 0);
            s3c2410_udc_clear_ep0_se(base_addr);
            dev->ep0state = EP0_IDLE;
      }

      switch (dev->ep0state) {
      case EP0_IDLE:
            s3c2410_udc_handle_ep0_idle(dev, ep, &crq, ep0csr);
            break;

      case EP0_IN_DATA_PHASE:             /* GET_DESCRIPTOR etc */
            dprintk(DEBUG_NORMAL, "EP0_IN_DATA_PHASE ... what now?\n");
            if (!(ep0csr & S3C2410_UDC_EP0_CSR_IPKRDY) && req) {
                  s3c2410_udc_write_fifo(ep, req);
            }
            break;

      case EP0_OUT_DATA_PHASE:            /* SET_DESCRIPTOR etc */
            dprintk(DEBUG_NORMAL, "EP0_OUT_DATA_PHASE ... what now?\n");
            if ((ep0csr & S3C2410_UDC_EP0_CSR_OPKRDY) && req ) {
                  s3c2410_udc_read_fifo(ep,req);
            }
            break;

      case EP0_END_XFER:
            dprintk(DEBUG_NORMAL, "EP0_END_XFER ... what now?\n");
            dev->ep0state = EP0_IDLE;
            break;

      case EP0_STALL:
            dprintk(DEBUG_NORMAL, "EP0_STALL ... what now?\n");
            dev->ep0state = EP0_IDLE;
            break;
      }
}

/*
 *    handle_ep - Manage I/O endpoints
 */

static void s3c2410_udc_handle_ep(struct s3c2410_ep *ep)
{
      struct s3c2410_request  *req;
      int               is_in = ep->bEndpointAddress & USB_DIR_IN;
      u32               ep_csr1;
      u32               idx;

      if (likely (!list_empty(&ep->queue)))
            req = list_entry(ep->queue.next,
                        struct s3c2410_request, queue);
      else
            req = NULL;

      idx = ep->bEndpointAddress & 0x7F;

      if (is_in) {
            udc_write(idx, S3C2410_UDC_INDEX_REG);
            ep_csr1 = udc_read(S3C2410_UDC_IN_CSR1_REG);
            dprintk(DEBUG_VERBOSE, "ep%01d write csr:%02x %d\n",
                  idx, ep_csr1, req ? 1 : 0);

            if (ep_csr1 & S3C2410_UDC_ICSR1_SENTSTL) {
                  dprintk(DEBUG_VERBOSE, "st\n");
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  udc_write(ep_csr1 & ~S3C2410_UDC_ICSR1_SENTSTL,
                              S3C2410_UDC_IN_CSR1_REG);
                  return;
            }

            if (!(ep_csr1 & S3C2410_UDC_ICSR1_PKTRDY) && req) {
                  s3c2410_udc_write_fifo(ep,req);
            }
      } else {
            udc_write(idx, S3C2410_UDC_INDEX_REG);
            ep_csr1 = udc_read(S3C2410_UDC_OUT_CSR1_REG);
            dprintk(DEBUG_VERBOSE, "ep%01d rd csr:%02x\n", idx, ep_csr1);

            if (ep_csr1 & S3C2410_UDC_OCSR1_SENTSTL) {
                  udc_write(idx, S3C2410_UDC_INDEX_REG);
                  udc_write(ep_csr1 & ~S3C2410_UDC_OCSR1_SENTSTL,
                              S3C2410_UDC_OUT_CSR1_REG);
                  return;
            }

            if ((ep_csr1 & S3C2410_UDC_OCSR1_PKTRDY) && req) {
                  s3c2410_udc_read_fifo(ep,req);
            }
      }
}

#include <asm/arch/regs-irq.h>

/*
 *    s3c2410_udc_irq - interrupt handler
 */
static irqreturn_t s3c2410_udc_irq(int irq, void *_dev)
{
      struct s3c2410_udc *dev = _dev;
      int usb_status;
      int usbd_status;
      int pwr_reg;
      int ep0csr;
      int i;
      u32 idx;
      unsigned long flags;

      spin_lock_irqsave(&dev->lock, flags);

      /* Driver connected ? */
      if (!dev->driver) {
            /* Clear interrupts */
            udc_write(udc_read(S3C2410_UDC_USB_INT_REG),
                        S3C2410_UDC_USB_INT_REG);
            udc_write(udc_read(S3C2410_UDC_EP_INT_REG),
                        S3C2410_UDC_EP_INT_REG);
      }

      /* Save index */
      idx = udc_read(S3C2410_UDC_INDEX_REG);

      /* Read status registers */
      usb_status = udc_read(S3C2410_UDC_USB_INT_REG);
      usbd_status = udc_read(S3C2410_UDC_EP_INT_REG);
      pwr_reg = udc_read(S3C2410_UDC_PWR_REG);

      udc_writeb(base_addr, S3C2410_UDC_INDEX_EP0, S3C2410_UDC_INDEX_REG);
      ep0csr = udc_read(S3C2410_UDC_IN_CSR1_REG);

      dprintk(DEBUG_NORMAL, "usbs=%02x, usbds=%02x, pwr=%02x ep0csr=%02x\n",
            usb_status, usbd_status, pwr_reg, ep0csr);

      /*
       * Now, handle interrupts. There's two types :
       * - Reset, Resume, Suspend coming -> usb_int_reg
       * - EP -> ep_int_reg
       */

      /* RESET */
      if (usb_status & S3C2410_UDC_USBINT_RESET) {
            /* two kind of reset :
             * - reset start -> pwr reg = 8
             * - reset end   -> pwr reg = 0
             **/
            dprintk(DEBUG_NORMAL, "USB reset csr %x pwr %x\n",
                  ep0csr, pwr_reg);

            dev->gadget.speed = USB_SPEED_UNKNOWN;
            udc_write(0x00, S3C2410_UDC_INDEX_REG);
            udc_write((dev->ep[0].ep.maxpacket & 0x7ff) >> 3,
                        S3C2410_UDC_MAXP_REG);
            dev->address = 0;

            dev->ep0state = EP0_IDLE;
            dev->gadget.speed = USB_SPEED_FULL;

            /* clear interrupt */
            udc_write(S3C2410_UDC_USBINT_RESET,
                        S3C2410_UDC_USB_INT_REG);

            udc_write(idx, S3C2410_UDC_INDEX_REG);
            spin_unlock_irqrestore(&dev->lock, flags);
            return IRQ_HANDLED;
      }

      /* RESUME */
      if (usb_status & S3C2410_UDC_USBINT_RESUME) {
            dprintk(DEBUG_NORMAL, "USB resume\n");

            /* clear interrupt */
            udc_write(S3C2410_UDC_USBINT_RESUME,
                        S3C2410_UDC_USB_INT_REG);

            if (dev->gadget.speed != USB_SPEED_UNKNOWN
                        && dev->driver
                        && dev->driver->resume)
                  dev->driver->resume(&dev->gadget);
      }

      /* SUSPEND */
      if (usb_status & S3C2410_UDC_USBINT_SUSPEND) {
            dprintk(DEBUG_NORMAL, "USB suspend\n");

            /* clear interrupt */
            udc_write(S3C2410_UDC_USBINT_SUSPEND,
                        S3C2410_UDC_USB_INT_REG);

            if (dev->gadget.speed != USB_SPEED_UNKNOWN
                        && dev->driver
                        && dev->driver->suspend)
                  dev->driver->suspend(&dev->gadget);

            dev->ep0state = EP0_IDLE;
      }

      /* EP */
      /* control traffic */
      /* check on ep0csr != 0 is not a good idea as clearing in_pkt_ready
       * generate an interrupt
       */
      if (usbd_status & S3C2410_UDC_INT_EP0) {
            dprintk(DEBUG_VERBOSE, "USB ep0 irq\n");
            /* Clear the interrupt bit by setting it to 1 */
            udc_write(S3C2410_UDC_INT_EP0, S3C2410_UDC_EP_INT_REG);
            s3c2410_udc_handle_ep0(dev);
      }

      /* endpoint data transfers */
      for (i = 1; i < S3C2410_ENDPOINTS; i++) {
            u32 tmp = 1 << i;
            if (usbd_status & tmp) {
                  dprintk(DEBUG_VERBOSE, "USB ep%d irq\n", i);

                  /* Clear the interrupt bit by setting it to 1 */
                  udc_write(tmp, S3C2410_UDC_EP_INT_REG);
                  s3c2410_udc_handle_ep(&dev->ep[i]);
            }
      }

      dprintk(DEBUG_VERBOSE, "irq: %d s3c2410_udc_done.\n", irq);

      /* Restore old index */
      udc_write(idx, S3C2410_UDC_INDEX_REG);

      spin_unlock_irqrestore(&dev->lock, flags);

      return IRQ_HANDLED;
}
/*------------------------- s3c2410_ep_ops ----------------------------------*/

static inline struct s3c2410_ep *to_s3c2410_ep(struct usb_ep *ep)
{
      return container_of(ep, struct s3c2410_ep, ep);
}

static inline struct s3c2410_udc *to_s3c2410_udc(struct usb_gadget *gadget)
{
      return container_of(gadget, struct s3c2410_udc, gadget);
}

static inline struct s3c2410_request *to_s3c2410_req(struct usb_request *req)
{
      return container_of(req, struct s3c2410_request, req);
}

/*
 *    s3c2410_udc_ep_enable
 */
static int s3c2410_udc_ep_enable(struct usb_ep *_ep,
                         const struct usb_endpoint_descriptor *desc)
{
      struct s3c2410_udc      *dev;
      struct s3c2410_ep *ep;
      u32               max, tmp;
      unsigned long           flags;
      u32               csr1,csr2;
      u32               int_en_reg;

      ep = to_s3c2410_ep(_ep);

      if (!_ep || !desc || ep->desc
                  || _ep->name == ep0name
                  || desc->bDescriptorType != USB_DT_ENDPOINT)
            return -EINVAL;

      dev = ep->dev;
      if (!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN)
            return -ESHUTDOWN;

      max = le16_to_cpu(desc->wMaxPacketSize) & 0x1fff;

      local_irq_save (flags);
      _ep->maxpacket = max & 0x7ff;
      ep->desc = desc;
      ep->halted = 0;
      ep->bEndpointAddress = desc->bEndpointAddress;

      /* set max packet */
      udc_write(ep->num, S3C2410_UDC_INDEX_REG);
      udc_write(max >> 3, S3C2410_UDC_MAXP_REG);

      /* set type, direction, address; reset fifo counters */
      if (desc->bEndpointAddress & USB_DIR_IN) {
            csr1 = S3C2410_UDC_ICSR1_FFLUSH|S3C2410_UDC_ICSR1_CLRDT;
            csr2 = S3C2410_UDC_ICSR2_MODEIN|S3C2410_UDC_ICSR2_DMAIEN;

            udc_write(ep->num, S3C2410_UDC_INDEX_REG);
            udc_write(csr1, S3C2410_UDC_IN_CSR1_REG);
            udc_write(ep->num, S3C2410_UDC_INDEX_REG);
            udc_write(csr2, S3C2410_UDC_IN_CSR2_REG);
      } else {
            /* don't flush in fifo or it will cause endpoint interrupt */
            csr1 = S3C2410_UDC_ICSR1_CLRDT;
            csr2 = S3C2410_UDC_ICSR2_DMAIEN;

            udc_write(ep->num, S3C2410_UDC_INDEX_REG);
            udc_write(csr1, S3C2410_UDC_IN_CSR1_REG);
            udc_write(ep->num, S3C2410_UDC_INDEX_REG);
            udc_write(csr2, S3C2410_UDC_IN_CSR2_REG);

            csr1 = S3C2410_UDC_OCSR1_FFLUSH | S3C2410_UDC_OCSR1_CLRDT;
            csr2 = S3C2410_UDC_OCSR2_DMAIEN;

            udc_write(ep->num, S3C2410_UDC_INDEX_REG);
            udc_write(csr1, S3C2410_UDC_OUT_CSR1_REG);
            udc_write(ep->num, S3C2410_UDC_INDEX_REG);
            udc_write(csr2, S3C2410_UDC_OUT_CSR2_REG);
      }

      /* enable irqs */
      int_en_reg = udc_read(S3C2410_UDC_EP_INT_EN_REG);
      udc_write(int_en_reg | (1 << ep->num), S3C2410_UDC_EP_INT_EN_REG);

      /* print some debug message */
      tmp = desc->bEndpointAddress;
      dprintk (DEBUG_NORMAL, "enable %s(%d) ep%x%s-blk max %02x\n",
             _ep->name,ep->num, tmp,
             desc->bEndpointAddress & USB_DIR_IN ? "in" : "out", max);

      local_irq_restore (flags);
      s3c2410_udc_set_halt(_ep, 0);

      return 0;
}

/*
 * s3c2410_udc_ep_disable
 */
static int s3c2410_udc_ep_disable(struct usb_ep *_ep)
{
      struct s3c2410_ep *ep = to_s3c2410_ep(_ep);
      unsigned long flags;
      u32 int_en_reg;

      if (!_ep || !ep->desc) {
            dprintk(DEBUG_NORMAL, "%s not enabled\n",
                  _ep ? ep->ep.name : NULL);
            return -EINVAL;
      }

      local_irq_save(flags);

      dprintk(DEBUG_NORMAL, "ep_disable: %s\n", _ep->name);

      ep->desc = NULL;
      ep->halted = 1;

      s3c2410_udc_nuke (ep->dev, ep, -ESHUTDOWN);

      /* disable irqs */
      int_en_reg = udc_read(S3C2410_UDC_EP_INT_EN_REG);
      udc_write(int_en_reg & ~(1<<ep->num), S3C2410_UDC_EP_INT_EN_REG);

      local_irq_restore(flags);

      dprintk(DEBUG_NORMAL, "%s disabled\n", _ep->name);

      return 0;
}

/*
 * s3c2410_udc_alloc_request
 */
static struct usb_request *
s3c2410_udc_alloc_request(struct usb_ep *_ep, gfp_t mem_flags)
{
      struct s3c2410_request *req;

      dprintk(DEBUG_VERBOSE,"%s(%p,%d)\n", __func__, _ep, mem_flags);

      if (!_ep)
            return NULL;

      req = kzalloc (sizeof(struct s3c2410_request), mem_flags);
      if (!req)
            return NULL;

      INIT_LIST_HEAD (&req->queue);
      return &req->req;
}

/*
 * s3c2410_udc_free_request
 */
static void
s3c2410_udc_free_request(struct usb_ep *_ep, struct usb_request *_req)
{
      struct s3c2410_ep *ep = to_s3c2410_ep(_ep);
      struct s3c2410_request  *req = to_s3c2410_req(_req);

      dprintk(DEBUG_VERBOSE, "%s(%p,%p)\n", __func__, _ep, _req);

      if (!ep || !_req || (!ep->desc && _ep->name != ep0name))
            return;

      WARN_ON (!list_empty (&req->queue));
      kfree(req);
}

/*
 *    s3c2410_udc_queue
 */
static int s3c2410_udc_queue(struct usb_ep *_ep, struct usb_request *_req,
            gfp_t gfp_flags)
{
      struct s3c2410_request  *req = to_s3c2410_req(_req);
      struct s3c2410_ep *ep = to_s3c2410_ep(_ep);
      struct s3c2410_udc      *dev;
      u32               ep_csr = 0;
      int               fifo_count = 0;
      unsigned long           flags;

      if (unlikely (!_ep || (!ep->desc && ep->ep.name != ep0name))) {
            dprintk(DEBUG_NORMAL, "%s: invalid args\n", __func__);
            return -EINVAL;
      }

      dev = ep->dev;
      if (unlikely (!dev->driver
                  || dev->gadget.speed == USB_SPEED_UNKNOWN)) {
            return -ESHUTDOWN;
      }

      local_irq_save (flags);

      if (unlikely(!_req || !_req->complete
                  || !_req->buf || !list_empty(&req->queue))) {
            if (!_req)
                  dprintk(DEBUG_NORMAL, "%s: 1 X X X\n", __func__);
            else {
                  dprintk(DEBUG_NORMAL, "%s: 0 %01d %01d %01d\n",
                        __func__, !_req->complete,!_req->buf,
                        !list_empty(&req->queue));
            }

            local_irq_restore(flags);
            return -EINVAL;
      }

      _req->status = -EINPROGRESS;
      _req->actual = 0;

      dprintk(DEBUG_VERBOSE, "%s: ep%x len %d\n",
             __func__, ep->bEndpointAddress, _req->length);

      if (ep->bEndpointAddress) {
            udc_write(ep->bEndpointAddress & 0x7F, S3C2410_UDC_INDEX_REG);

            ep_csr = udc_read((ep->bEndpointAddress & USB_DIR_IN)
                        ? S3C2410_UDC_IN_CSR1_REG
                        : S3C2410_UDC_OUT_CSR1_REG);
            fifo_count = s3c2410_udc_fifo_count_out();
      } else {
            udc_write(0, S3C2410_UDC_INDEX_REG);
            ep_csr = udc_read(S3C2410_UDC_IN_CSR1_REG);
            fifo_count = s3c2410_udc_fifo_count_out();
      }

      /* kickstart this i/o queue? */
      if (list_empty(&ep->queue) && !ep->halted) {
            if (ep->bEndpointAddress == 0 /* ep0 */) {
                  switch (dev->ep0state) {
                  case EP0_IN_DATA_PHASE:
                        if (!(ep_csr&S3C2410_UDC_EP0_CSR_IPKRDY)
                                    && s3c2410_udc_write_fifo(ep,
                                          req)) {
                              dev->ep0state = EP0_IDLE;
                              req = NULL;
                        }
                        break;

                  case EP0_OUT_DATA_PHASE:
                        if ((!_req->length)
                              || ((ep_csr & S3C2410_UDC_OCSR1_PKTRDY)
                                    && s3c2410_udc_read_fifo(ep,
                                          req))) {
                              dev->ep0state = EP0_IDLE;
                              req = NULL;
                        }
                        break;

                  default:
                        local_irq_restore(flags);
                        return -EL2HLT;
                  }
            } else if ((ep->bEndpointAddress & USB_DIR_IN) != 0
                        && (!(ep_csr&S3C2410_UDC_OCSR1_PKTRDY))
                        && s3c2410_udc_write_fifo(ep, req)) {
                  req = NULL;
            } else if ((ep_csr & S3C2410_UDC_OCSR1_PKTRDY)
                        && fifo_count
                        && s3c2410_udc_read_fifo(ep, req)) {
                  req = NULL;
            }
      }

      /* pio or dma irq handler advances the queue. */
      if (likely (req != 0))
            list_add_tail(&req->queue, &ep->queue);

      local_irq_restore(flags);

      dprintk(DEBUG_VERBOSE, "%s ok\n", __func__);
      return 0;
}

/*
 *    s3c2410_udc_dequeue
 */
static int s3c2410_udc_dequeue(struct usb_ep *_ep, struct usb_request *_req)
{
      struct s3c2410_ep *ep = to_s3c2410_ep(_ep);
      struct s3c2410_udc      *udc;
      int               retval = -EINVAL;
      unsigned long           flags;
      struct s3c2410_request  *req = NULL;

      dprintk(DEBUG_VERBOSE, "%s(%p,%p)\n", __func__, _ep, _req);

      if (!the_controller->driver)
            return -ESHUTDOWN;

      if (!_ep || !_req)
            return retval;

      udc = to_s3c2410_udc(ep->gadget);

      local_irq_save (flags);

      list_for_each_entry (req, &ep->queue, queue) {
            if (&req->req == _req) {
                  list_del_init (&req->queue);
                  _req->status = -ECONNRESET;
                  retval = 0;
                  break;
            }
      }

      if (retval == 0) {
            dprintk(DEBUG_VERBOSE,
                  "dequeued req %p from %s, len %d buf %p\n",
                  req, _ep->name, _req->length, _req->buf);

            s3c2410_udc_done(ep, req, -ECONNRESET);
      }

      local_irq_restore (flags);
      return retval;
}

/*
 * s3c2410_udc_set_halt
 */
static int s3c2410_udc_set_halt(struct usb_ep *_ep, int value)
{
      struct s3c2410_ep *ep = to_s3c2410_ep(_ep);
      u32               ep_csr = 0;
      unsigned long           flags;
      u32               idx;

      if (unlikely (!_ep || (!ep->desc && ep->ep.name != ep0name))) {
            dprintk(DEBUG_NORMAL, "%s: inval 2\n", __func__);
            return -EINVAL;
      }

      local_irq_save (flags);

      idx = ep->bEndpointAddress & 0x7F;

      if (idx == 0) {
            s3c2410_udc_set_ep0_ss(base_addr);
            s3c2410_udc_set_ep0_de_out(base_addr);
      } else {
            udc_write(idx, S3C2410_UDC_INDEX_REG);
            ep_csr = udc_read((ep->bEndpointAddress &USB_DIR_IN)
                        ? S3C2410_UDC_IN_CSR1_REG
                        : S3C2410_UDC_OUT_CSR1_REG);

            if ((ep->bEndpointAddress & USB_DIR_IN) != 0) {
                  if (value)
                        udc_write(ep_csr | S3C2410_UDC_ICSR1_SENDSTL,
                              S3C2410_UDC_IN_CSR1_REG);
                  else {
                        ep_csr &= ~S3C2410_UDC_ICSR1_SENDSTL;
                        udc_write(ep_csr, S3C2410_UDC_IN_CSR1_REG);
                        ep_csr |= S3C2410_UDC_ICSR1_CLRDT;
                        udc_write(ep_csr, S3C2410_UDC_IN_CSR1_REG);
                  }
            } else {
                  if (value)
                        udc_write(ep_csr | S3C2410_UDC_OCSR1_SENDSTL,
                              S3C2410_UDC_OUT_CSR1_REG);
                  else {
                        ep_csr &= ~S3C2410_UDC_OCSR1_SENDSTL;
                        udc_write(ep_csr, S3C2410_UDC_OUT_CSR1_REG);
                        ep_csr |= S3C2410_UDC_OCSR1_CLRDT;
                        udc_write(ep_csr, S3C2410_UDC_OUT_CSR1_REG);
                  }
            }
      }

      ep->halted = value ? 1 : 0;
      local_irq_restore (flags);

      return 0;
}

static const struct usb_ep_ops s3c2410_ep_ops = {
      .enable           = s3c2410_udc_ep_enable,
      .disable    = s3c2410_udc_ep_disable,

      .alloc_request    = s3c2410_udc_alloc_request,
      .free_request     = s3c2410_udc_free_request,

      .queue            = s3c2410_udc_queue,
      .dequeue    = s3c2410_udc_dequeue,

      .set_halt   = s3c2410_udc_set_halt,
};

/*------------------------- usb_gadget_ops ----------------------------------*/

/*
 *    s3c2410_udc_get_frame
 */
static int s3c2410_udc_get_frame(struct usb_gadget *_gadget)
{
      int tmp;

      dprintk(DEBUG_VERBOSE, "%s()\n", __func__);

      tmp = udc_read(S3C2410_UDC_FRAME_NUM2_REG) << 8;
      tmp |= udc_read(S3C2410_UDC_FRAME_NUM1_REG);
      return tmp;
}

/*
 *    s3c2410_udc_wakeup
 */
static int s3c2410_udc_wakeup(struct usb_gadget *_gadget)
{
      dprintk(DEBUG_NORMAL, "%s()\n", __func__);
      return 0;
}

/*
 *    s3c2410_udc_set_selfpowered
 */
static int s3c2410_udc_set_selfpowered(struct usb_gadget *gadget, int value)
{
      struct s3c2410_udc *udc = to_s3c2410_udc(gadget);

      dprintk(DEBUG_NORMAL, "%s()\n", __func__);

      if (value)
            udc->devstatus |= (1 << USB_DEVICE_SELF_POWERED);
      else
            udc->devstatus &= ~(1 << USB_DEVICE_SELF_POWERED);

      return 0;
}

static void s3c2410_udc_disable(struct s3c2410_udc *dev);
static void s3c2410_udc_enable(struct s3c2410_udc *dev);

static int s3c2410_udc_set_pullup(struct s3c2410_udc *udc, int is_on)
{
      dprintk(DEBUG_NORMAL, "%s()\n", __func__);

      if (udc_info && udc_info->udc_command) {
            if (is_on)
                  s3c2410_udc_enable(udc);
            else {
                  if (udc->gadget.speed != USB_SPEED_UNKNOWN) {
                        if (udc->driver && udc->driver->disconnect)
                              udc->driver->disconnect(&udc->gadget);

                  }
                  s3c2410_udc_disable(udc);
            }
      }
      else
            return -EOPNOTSUPP;

      return 0;
}

static int s3c2410_udc_vbus_session(struct usb_gadget *gadget, int is_active)
{
      struct s3c2410_udc *udc = to_s3c2410_udc(gadget);

      dprintk(DEBUG_NORMAL, "%s()\n", __func__);

      udc->vbus = (is_active != 0);
      s3c2410_udc_set_pullup(udc, is_active);
      return 0;
}

static int s3c2410_udc_pullup(struct usb_gadget *gadget, int is_on)
{
      struct s3c2410_udc *udc = to_s3c2410_udc(gadget);

      dprintk(DEBUG_NORMAL, "%s()\n", __func__);

      s3c2410_udc_set_pullup(udc, is_on ? 0 : 1);
      return 0;
}

static irqreturn_t s3c2410_udc_vbus_irq(int irq, void *_dev)
{
      struct s3c2410_udc      *dev = _dev;
      unsigned int            value;

      dprintk(DEBUG_NORMAL, "%s()\n", __func__);

      /* some cpus cannot read from an line configured to IRQ! */
      s3c2410_gpio_cfgpin(udc_info->vbus_pin, S3C2410_GPIO_INPUT);
      value = s3c2410_gpio_getpin(udc_info->vbus_pin);
      s3c2410_gpio_cfgpin(udc_info->vbus_pin, S3C2410_GPIO_SFN2);

      if (udc_info->vbus_pin_inverted)
            value = !value;

      if (value != dev->vbus)
            s3c2410_udc_vbus_session(&dev->gadget, value);

      return IRQ_HANDLED;
}

static int s3c2410_vbus_draw(struct usb_gadget *_gadget, unsigned ma)
{
      dprintk(DEBUG_NORMAL, "%s()\n", __func__);

      if (udc_info && udc_info->vbus_draw) {
            udc_info->vbus_draw(ma);
            return 0;
      }

      return -ENOTSUPP;
}

static const struct usb_gadget_ops s3c2410_ops = {
      .get_frame        = s3c2410_udc_get_frame,
      .wakeup                 = s3c2410_udc_wakeup,
      .set_selfpowered  = s3c2410_udc_set_selfpowered,
      .pullup                 = s3c2410_udc_pullup,
      .vbus_session           = s3c2410_udc_vbus_session,
      .vbus_draw        = s3c2410_vbus_draw,
};

/*------------------------- gadget driver handling---------------------------*/
/*
 * s3c2410_udc_disable
 */
static void s3c2410_udc_disable(struct s3c2410_udc *dev)
{
      dprintk(DEBUG_NORMAL, "%s()\n", __func__);

      /* Disable all interrupts */
      udc_write(0x00, S3C2410_UDC_USB_INT_EN_REG);
      udc_write(0x00, S3C2410_UDC_EP_INT_EN_REG);

      /* Clear the interrupt registers */
      udc_write(S3C2410_UDC_USBINT_RESET
                        | S3C2410_UDC_USBINT_RESUME
                        | S3C2410_UDC_USBINT_SUSPEND,
                  S3C2410_UDC_USB_INT_REG);

      udc_write(0x1F, S3C2410_UDC_EP_INT_REG);

      /* Good bye, cruel world */
      if (udc_info && udc_info->udc_command)
            udc_info->udc_command(S3C2410_UDC_P_DISABLE);

      /* Set speed to unknown */
      dev->gadget.speed = USB_SPEED_UNKNOWN;
}

/*
 * s3c2410_udc_reinit
 */
static void s3c2410_udc_reinit(struct s3c2410_udc *dev)
{
      u32 i;

      /* device/ep0 records init */
      INIT_LIST_HEAD (&dev->gadget.ep_list);
      INIT_LIST_HEAD (&dev->gadget.ep0->ep_list);
      dev->ep0state = EP0_IDLE;

      for (i = 0; i < S3C2410_ENDPOINTS; i++) {
            struct s3c2410_ep *ep = &dev->ep[i];

            if (i != 0)
                  list_add_tail (&ep->ep.ep_list, &dev->gadget.ep_list);

            ep->dev = dev;
            ep->desc = NULL;
            ep->halted = 0;
            INIT_LIST_HEAD (&ep->queue);
      }
}

/*
 * s3c2410_udc_enable
 */
static void s3c2410_udc_enable(struct s3c2410_udc *dev)
{
      int i;

      dprintk(DEBUG_NORMAL, "s3c2410_udc_enable called\n");

      /* dev->gadget.speed = USB_SPEED_UNKNOWN; */
      dev->gadget.speed = USB_SPEED_FULL;

      /* Set MAXP for all endpoints */
      for (i = 0; i < S3C2410_ENDPOINTS; i++) {
            udc_write(i, S3C2410_UDC_INDEX_REG);
            udc_write((dev->ep[i].ep.maxpacket & 0x7ff) >> 3,
                        S3C2410_UDC_MAXP_REG);
      }

      /* Set default power state */
      udc_write(DEFAULT_POWER_STATE, S3C2410_UDC_PWR_REG);

      /* Enable reset and suspend interrupt interrupts */
      udc_write(S3C2410_UDC_USBINT_RESET | S3C2410_UDC_USBINT_SUSPEND,
                  S3C2410_UDC_USB_INT_EN_REG);

      /* Enable ep0 interrupt */
      udc_write(S3C2410_UDC_INT_EP0, S3C2410_UDC_EP_INT_EN_REG);

      /* time to say "hello, world" */
      if (udc_info && udc_info->udc_command)
            udc_info->udc_command(S3C2410_UDC_P_ENABLE);
}

/*
 *    usb_gadget_register_driver
 */
int usb_gadget_register_driver(struct usb_gadget_driver *driver)
{
      struct s3c2410_udc *udc = the_controller;
      int         retval;

      dprintk(DEBUG_NORMAL, "usb_gadget_register_driver() '%s'\n",
            driver->driver.name);

      /* Sanity checks */
      if (!udc)
            return -ENODEV;

      if (udc->driver)
            return -EBUSY;

      if (!driver->bind || !driver->setup
                  || driver->speed != USB_SPEED_FULL) {
            printk(KERN_ERR "Invalid driver: bind %p setup %p speed %d\n",
                  driver->bind, driver->setup, driver->speed);
            return -EINVAL;
      }
#if defined(MODULE)
      if (!driver->unbind) {
            printk(KERN_ERR "Invalid driver: no unbind method\n");
            return -EINVAL;
      }
#endif

      /* Hook the driver */
      udc->driver = driver;
      udc->gadget.dev.driver = &driver->driver;

      /* Bind the driver */
      if ((retval = device_add(&udc->gadget.dev)) != 0) {
            printk(KERN_ERR "Error in device_add() : %d\n",retval);
            goto register_error;
      }

      dprintk(DEBUG_NORMAL, "binding gadget driver '%s'\n",
            driver->driver.name);

      if ((retval = driver->bind (&udc->gadget)) != 0) {
            device_del(&udc->gadget.dev);
            goto register_error;
      }

      /* Enable udc */
      s3c2410_udc_enable(udc);

      return 0;

register_error:
      udc->driver = NULL;
      udc->gadget.dev.driver = NULL;
      return retval;
}

/*
 *    usb_gadget_unregister_driver
 */
int usb_gadget_unregister_driver(struct usb_gadget_driver *driver)
{
      struct s3c2410_udc *udc = the_controller;

      if (!udc)
            return -ENODEV;

      if (!driver || driver != udc->driver || !driver->unbind)
            return -EINVAL;

      dprintk(DEBUG_NORMAL,"usb_gadget_register_driver() '%s'\n",
            driver->driver.name);

      if (driver->disconnect)
            driver->disconnect(&udc->gadget);

      device_del(&udc->gadget.dev);
      udc->driver = NULL;

      /* Disable udc */
      s3c2410_udc_disable(udc);

      return 0;
}

/*---------------------------------------------------------------------------*/
static struct s3c2410_udc memory = {
      .gadget = {
            .ops        = &s3c2410_ops,
            .ep0        = &memory.ep[0].ep,
            .name       = gadget_name,
            .dev = {
                  .bus_id           = "gadget",
            },
      },

      /* control endpoint */
      .ep[0] = {
            .num        = 0,
            .ep = {
                  .name       = ep0name,
                  .ops        = &s3c2410_ep_ops,
                  .maxpacket  = EP0_FIFO_SIZE,
            },
            .dev        = &memory,
      },

      /* first group of endpoints */
      .ep[1] = {
            .num        = 1,
            .ep = {
                  .name       = "ep1-bulk",
                  .ops        = &s3c2410_ep_ops,
                  .maxpacket  = EP_FIFO_SIZE,
            },
            .dev        = &memory,
            .fifo_size  = EP_FIFO_SIZE,
            .bEndpointAddress = 1,
            .bmAttributes     = USB_ENDPOINT_XFER_BULK,
      },
      .ep[2] = {
            .num        = 2,
            .ep = {
                  .name       = "ep2-bulk",
                  .ops        = &s3c2410_ep_ops,
                  .maxpacket  = EP_FIFO_SIZE,
            },
            .dev        = &memory,
            .fifo_size  = EP_FIFO_SIZE,
            .bEndpointAddress = 2,
            .bmAttributes     = USB_ENDPOINT_XFER_BULK,
      },
      .ep[3] = {
            .num        = 3,
            .ep = {
                  .name       = "ep3-bulk",
                  .ops        = &s3c2410_ep_ops,
                  .maxpacket  = EP_FIFO_SIZE,
            },
            .dev        = &memory,
            .fifo_size  = EP_FIFO_SIZE,
            .bEndpointAddress = 3,
            .bmAttributes     = USB_ENDPOINT_XFER_BULK,
      },
      .ep[4] = {
            .num        = 4,
            .ep = {
                  .name       = "ep4-bulk",
                  .ops        = &s3c2410_ep_ops,
                  .maxpacket  = EP_FIFO_SIZE,
            },
            .dev        = &memory,
            .fifo_size  = EP_FIFO_SIZE,
            .bEndpointAddress = 4,
            .bmAttributes     = USB_ENDPOINT_XFER_BULK,
      }

};

/*
 *    probe - binds to the platform device
 */
static int s3c2410_udc_probe(struct platform_device *pdev)
{
      struct s3c2410_udc *udc = &memory;
      struct device *dev = &pdev->dev;
      int retval;
      unsigned int irq;

      dev_dbg(dev, "%s()\n", __func__);

      usb_bus_clock = clk_get(NULL, "usb-bus-gadget");
      if (IS_ERR(usb_bus_clock)) {
            dev_err(dev, "failed to get usb bus clock source\n");
            return PTR_ERR(usb_bus_clock);
      }

      clk_enable(usb_bus_clock);

      udc_clock = clk_get(NULL, "usb-device");
      if (IS_ERR(udc_clock)) {
            dev_err(dev, "failed to get udc clock source\n");
            return PTR_ERR(udc_clock);
      }

      clk_enable(udc_clock);

      mdelay(10);

      dev_dbg(dev, "got and enabled clocks\n");

      if (strncmp(pdev->name, "s3c2440", 7) == 0) {
            dev_info(dev, "S3C2440: increasing FIFO to 128 bytes\n");
            memory.ep[1].fifo_size = S3C2440_EP_FIFO_SIZE;
            memory.ep[2].fifo_size = S3C2440_EP_FIFO_SIZE;
            memory.ep[3].fifo_size = S3C2440_EP_FIFO_SIZE;
            memory.ep[4].fifo_size = S3C2440_EP_FIFO_SIZE;
      }

      spin_lock_init (&udc->lock);
      udc_info = pdev->dev.platform_data;

      rsrc_start = S3C2410_PA_USBDEV;
      rsrc_len   = S3C24XX_SZ_USBDEV;

      if (!request_mem_region(rsrc_start, rsrc_len, gadget_name))
            return -EBUSY;

      base_addr = ioremap(rsrc_start, rsrc_len);
      if (!base_addr) {
            retval = -ENOMEM;
            goto err_mem;
      }

      device_initialize(&udc->gadget.dev);
      udc->gadget.dev.parent = &pdev->dev;
      udc->gadget.dev.dma_mask = pdev->dev.dma_mask;

      the_controller = udc;
      platform_set_drvdata(pdev, udc);

      s3c2410_udc_disable(udc);
      s3c2410_udc_reinit(udc);

      /* irq setup after old hardware state is cleaned up */
      retval = request_irq(IRQ_USBD, s3c2410_udc_irq,
                  IRQF_DISABLED, gadget_name, udc);

      if (retval != 0) {
            dev_err(dev, "cannot get irq %i, err %d\n", IRQ_USBD, retval);
            retval = -EBUSY;
            goto err_map;
      }

      dev_dbg(dev, "got irq %i\n", IRQ_USBD);

      if (udc_info && udc_info->vbus_pin > 0) {
            irq = s3c2410_gpio_getirq(udc_info->vbus_pin);
            retval = request_irq(irq, s3c2410_udc_vbus_irq,
                             IRQF_DISABLED | IRQF_TRIGGER_RISING
                             | IRQF_TRIGGER_FALLING | IRQF_SHARED,
                             gadget_name, udc);

            if (retval != 0) {
                  dev_err(dev, "can't get vbus irq %i, err %d\n",
                        irq, retval);
                  retval = -EBUSY;
                  goto err_int;
            }

            dev_dbg(dev, "got irq %i\n", irq);
      } else {
            udc->vbus = 1;
      }

      if (s3c2410_udc_debugfs_root) {
            udc->regs_info = debugfs_create_file("registers", S_IRUGO,
                        s3c2410_udc_debugfs_root,
                        udc, &s3c2410_udc_debugfs_fops);
            if (IS_ERR(udc->regs_info)) {
                  dev_warn(dev, "debugfs file creation failed %ld\n",
                         PTR_ERR(udc->regs_info));
                  udc->regs_info = NULL;
            }
      }

      dev_dbg(dev, "probe ok\n");

      return 0;

err_int:
      free_irq(IRQ_USBD, udc);
err_map:
      iounmap(base_addr);
err_mem:
      release_mem_region(rsrc_start, rsrc_len);

      return retval;
}

/*
 *    s3c2410_udc_remove
 */
static int s3c2410_udc_remove(struct platform_device *pdev)
{
      struct s3c2410_udc *udc = platform_get_drvdata(pdev);
      unsigned int irq;

      dev_dbg(&pdev->dev, "%s()\n", __func__);
      if (udc->driver)
            return -EBUSY;

      debugfs_remove(udc->regs_info);

      if (udc_info && udc_info->vbus_pin > 0) {
            irq = s3c2410_gpio_getirq(udc_info->vbus_pin);
            free_irq(irq, udc);
      }

      free_irq(IRQ_USBD, udc);

      iounmap(base_addr);
      release_mem_region(rsrc_start, rsrc_len);

      platform_set_drvdata(pdev, NULL);

      if (!IS_ERR(udc_clock) && udc_clock != NULL) {
            clk_disable(udc_clock);
            clk_put(udc_clock);
            udc_clock = NULL;
      }

      if (!IS_ERR(usb_bus_clock) && usb_bus_clock != NULL) {
            clk_disable(usb_bus_clock);
            clk_put(usb_bus_clock);
            usb_bus_clock = NULL;
      }

      dev_dbg(&pdev->dev, "%s: remove ok\n", __func__);
      return 0;
}

#ifdef CONFIG_PM
static int s3c2410_udc_suspend(struct platform_device *pdev, pm_message_t message)
{
      if (udc_info && udc_info->udc_command)
            udc_info->udc_command(S3C2410_UDC_P_DISABLE);

      return 0;
}

static int s3c2410_udc_resume(struct platform_device *pdev)
{
      if (udc_info && udc_info->udc_command)
            udc_info->udc_command(S3C2410_UDC_P_ENABLE);

      return 0;
}
#else
#define s3c2410_udc_suspend   NULL
#define s3c2410_udc_resume    NULL
#endif

static struct platform_driver udc_driver_2410 = {
      .driver           = {
            .name = "s3c2410-usbgadget",
            .owner      = THIS_MODULE,
      },
      .probe            = s3c2410_udc_probe,
      .remove           = s3c2410_udc_remove,
      .suspend    = s3c2410_udc_suspend,
      .resume           = s3c2410_udc_resume,
};

static struct platform_driver udc_driver_2440 = {
      .driver           = {
            .name = "s3c2440-usbgadget",
            .owner      = THIS_MODULE,
      },
      .probe            = s3c2410_udc_probe,
      .remove           = s3c2410_udc_remove,
      .suspend    = s3c2410_udc_suspend,
      .resume           = s3c2410_udc_resume,
};

static int __init udc_init(void)
{
      int retval;

      dprintk(DEBUG_NORMAL, "%s: version %s\n", gadget_name, DRIVER_VERSION);

      s3c2410_udc_debugfs_root = debugfs_create_dir(gadget_name, NULL);
      if (IS_ERR(s3c2410_udc_debugfs_root)) {
            printk(KERN_ERR "%s: debugfs dir creation failed %ld\n",
                  gadget_name, PTR_ERR(s3c2410_udc_debugfs_root));
            s3c2410_udc_debugfs_root = NULL;
      }

      retval = platform_driver_register(&udc_driver_2410);
      if (retval)
            goto err;

      retval = platform_driver_register(&udc_driver_2440);
      if (retval)
            goto err;

      return 0;

err:
      debugfs_remove(s3c2410_udc_debugfs_root);
      return retval;
}

static void __exit udc_exit(void)
{
      platform_driver_unregister(&udc_driver_2410);
      platform_driver_unregister(&udc_driver_2440);
      debugfs_remove(s3c2410_udc_debugfs_root);
}

EXPORT_SYMBOL(usb_gadget_unregister_driver);
EXPORT_SYMBOL(usb_gadget_register_driver);

module_init(udc_init);
module_exit(udc_exit);

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

Generated by  Doxygen 1.6.0   Back to index