430 lines
12 KiB
C
430 lines
12 KiB
C
|
/***************************************************************************
|
||
|
|
* __________ __ ___.
|
||
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
||
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
||
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
||
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
||
|
|
* \/ \/ \/ \/ \/
|
||
|
|
* $Id$
|
||
|
|
*
|
||
|
|
* Copyright (C) 2009 by Michael Sparmann
|
||
|
|
*
|
||
|
|
* 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 distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
||
|
|
* KIND, either express or implied.
|
||
|
|
*
|
||
|
|
****************************************************************************/
|
||
|
|
|
||
|
|
#include "config.h"
|
||
|
|
#include "usb.h"
|
||
|
|
|
||
|
|
#define OTGBASE 0x38800000
|
||
|
|
#define PHYBASE 0x3C400000
|
||
|
|
#include "usb-s3c6400x.h"
|
||
|
|
|
||
|
|
#include "cpu.h"
|
||
|
|
#include "system.h"
|
||
|
|
#include "kernel.h"
|
||
|
|
#include "panic.h"
|
||
|
|
|
||
|
|
#ifdef HAVE_USBSTACK
|
||
|
|
#include "usb_ch9.h"
|
||
|
|
#include "usb_core.h"
|
||
|
|
#include <inttypes.h>
|
||
|
|
#include "sprintf.h"
|
||
|
|
#include "power.h"
|
||
|
|
|
||
|
|
struct ep_type
|
||
|
|
{
|
||
|
|
bool active;
|
||
|
|
bool busy;
|
||
|
|
bool done;
|
||
|
|
int rc;
|
||
|
|
int size;
|
||
|
|
struct wakeup complete;
|
||
|
|
} ;
|
||
|
|
|
||
|
|
static struct ep_type endpoints[5];
|
||
|
|
static struct usb_ctrlrequest ctrlreq USB_DEVBSS_ATTR;
|
||
|
|
|
||
|
|
int usb_drv_port_speed(void)
|
||
|
|
{
|
||
|
|
return (DSTS & 2) == 0 ? 1 : 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void reset_endpoints(int reinit)
|
||
|
|
{
|
||
|
|
unsigned int i;
|
||
|
|
for (i = 0; i < sizeof(endpoints)/sizeof(struct ep_type); i++)
|
||
|
|
{
|
||
|
|
if (reinit) endpoints[i].active = false;
|
||
|
|
endpoints[i].busy = false;
|
||
|
|
endpoints[i].rc = -1;
|
||
|
|
endpoints[i].done = true;
|
||
|
|
wakeup_signal(&endpoints[i].complete);
|
||
|
|
}
|
||
|
|
DIEPCTL0 = 0x8800; /* EP0 IN ACTIVE NEXT=1 */
|
||
|
|
DOEPCTL0 = 0x8000; /* EP0 OUT ACTIVE */
|
||
|
|
DOEPTSIZ0 = 0x20080040; /* EP0 OUT Transfer Size:
|
||
|
|
64 Bytes, 1 Packet, 1 Setup Packet */
|
||
|
|
DOEPDMA0 = (uint32_t)&ctrlreq;
|
||
|
|
DOEPCTL0 |= 0x84000000; /* EP0 OUT ENABLE CLEARNAK */
|
||
|
|
if (reinit)
|
||
|
|
{
|
||
|
|
/* The size is getting set to zero, because we don't know
|
||
|
|
whether we are Full Speed or High Speed at this stage */
|
||
|
|
/* EP1 IN INACTIVE DATA0 SIZE=0 NEXT=3 */
|
||
|
|
DIEPCTL1 = 0x10001800;
|
||
|
|
/* EP2 OUT INACTIVE DATA0 SIZE=0 */
|
||
|
|
DOEPCTL2 = 0x10000000;
|
||
|
|
/* EP3 IN INACTIVE DATA0 SIZE=0 NEXT=0 */
|
||
|
|
DIEPCTL3 = 0x10000000;
|
||
|
|
/* EP4 OUT INACTIVE DATA0 SIZE=0 */
|
||
|
|
DOEPCTL4 = 0x10000000;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
/* INACTIVE DATA0 */
|
||
|
|
DIEPCTL1 = (DIEPCTL1 & ~0x00008000) | 0x10000000;
|
||
|
|
DOEPCTL2 = (DOEPCTL2 & ~0x00008000) | 0x10000000;
|
||
|
|
DIEPCTL3 = (DIEPCTL3 & ~0x00008000) | 0x10000000;
|
||
|
|
DOEPCTL4 = (DOEPCTL4 & ~0x00008000) | 0x10000000;
|
||
|
|
}
|
||
|
|
DAINTMSK = 0xFFFFFFFF; /* Enable interrupts on all EPs */
|
||
|
|
}
|
||
|
|
|
||
|
|
int usb_drv_request_endpoint(int type, int dir)
|
||
|
|
{
|
||
|
|
size_t ep;
|
||
|
|
int ret = -1;
|
||
|
|
|
||
|
|
if (dir == USB_DIR_IN) ep = 1;
|
||
|
|
else ep = 2;
|
||
|
|
|
||
|
|
while (ep < 5)
|
||
|
|
{
|
||
|
|
if (!endpoints[ep].active)
|
||
|
|
{
|
||
|
|
endpoints[ep].active = true;
|
||
|
|
ret = ep | dir;
|
||
|
|
uint32_t newbits = (type << 18) | 0x10000000;
|
||
|
|
if (dir) DIEPCTL(ep) = (DIEPCTL(ep) & ~0x000C0000) | newbits;
|
||
|
|
else DOEPCTL(ep) = (DOEPCTL(ep) & ~0x000C0000) | newbits;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
ep += 2;
|
||
|
|
}
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_drv_release_endpoint(int ep)
|
||
|
|
{
|
||
|
|
ep = ep & 0x7f;
|
||
|
|
|
||
|
|
if (ep < 1 || ep > USB_NUM_ENDPOINTS) return;
|
||
|
|
|
||
|
|
endpoints[ep].active = false;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void usb_reset(void)
|
||
|
|
{
|
||
|
|
volatile int i;
|
||
|
|
|
||
|
|
DCTL = 0x802; /* Soft Disconnect */
|
||
|
|
|
||
|
|
OPHYPWR = 0; /* PHY: Power up */
|
||
|
|
ORSTCON = 1; /* PHY: Assert Software Reset */
|
||
|
|
for (i = 0; i < 50; i++);
|
||
|
|
ORSTCON = 0; /* PHY: Deassert Software Reset */
|
||
|
|
OPHYCLK = 0; /* PHY: 48MHz clock */
|
||
|
|
|
||
|
|
GRSTCTL = 1; /* OTG: Assert Software Reset */
|
||
|
|
while (GRSTCTL & 1); /* Wait for OTG to ack reset */
|
||
|
|
while (!(GRSTCTL & 0x80000000)); /* Wait for OTG AHB master idle */
|
||
|
|
|
||
|
|
GAHBCFG = 0x27; /* OTG AHB config: Unmask ints, burst length 4, DMA on */
|
||
|
|
GUSBCFG = 0x1408; /* OTG: 16bit PHY and some reserved bits */
|
||
|
|
|
||
|
|
DCFG = 4; /* Address 0 */
|
||
|
|
DCTL = 0x800; /* Soft Reconnect */
|
||
|
|
DIEPMSK = 0x0D; /* IN EP interrupt mask */
|
||
|
|
DOEPMSK = 0x0D; /* IN EP interrupt mask */
|
||
|
|
GINTMSK = 0xC3000; /* Interrupt mask: IN event, OUT event, bus reset */
|
||
|
|
|
||
|
|
reset_endpoints(1);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* IRQ handler */
|
||
|
|
void INT_USB_FUNC(void)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
if (GINTSTS & 0x1000) /* bus reset */
|
||
|
|
{
|
||
|
|
DCFG = 4; /* Address 0 */
|
||
|
|
reset_endpoints(1);
|
||
|
|
usb_core_bus_reset();
|
||
|
|
}
|
||
|
|
|
||
|
|
if (GINTSTS & 0x2000) /* enumeration done, we now know the speed */
|
||
|
|
{
|
||
|
|
/* Set up the maximum packet sizes accordingly */
|
||
|
|
uint32_t maxpacket = usb_drv_port_speed() ? 512 : 64;
|
||
|
|
DIEPCTL1 = (DIEPCTL1 & ~0x000003FF) | maxpacket;
|
||
|
|
DOEPCTL2 = (DOEPCTL2 & ~0x000003FF) | maxpacket;
|
||
|
|
DIEPCTL3 = (DIEPCTL3 & ~0x000003FF) | maxpacket;
|
||
|
|
DOEPCTL4 = (DOEPCTL4 & ~0x000003FF) | maxpacket;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (GINTSTS & 0x40000) /* IN EP event */
|
||
|
|
for (i = 0; i < 5; i ++)
|
||
|
|
if (i != 2 && i != 4 && DIEPINT(i))
|
||
|
|
{
|
||
|
|
if (DIEPINT(i) & 1) /* Transfer completed */
|
||
|
|
{
|
||
|
|
invalidate_dcache();
|
||
|
|
int bytes = endpoints[i].size - (DIEPTSIZ(i) & 0x3FFFF);
|
||
|
|
if (endpoints[i].busy)
|
||
|
|
{
|
||
|
|
endpoints[i].busy = false;
|
||
|
|
endpoints[i].rc = 0;
|
||
|
|
endpoints[i].done = true;
|
||
|
|
usb_core_transfer_complete(i, USB_DIR_IN, 0, bytes);
|
||
|
|
wakeup_signal(&endpoints[i].complete);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
if (DIEPINT(i) & 4) /* AHB error */
|
||
|
|
panicf("USB: AHB error on IN EP%d", i);
|
||
|
|
if (DIEPINT(i) & 8) /* Timeout */
|
||
|
|
{
|
||
|
|
if (endpoints[i].busy)
|
||
|
|
{
|
||
|
|
endpoints[i].busy = false;
|
||
|
|
endpoints[i].rc = 1;
|
||
|
|
endpoints[i].done = true;
|
||
|
|
wakeup_signal(&endpoints[i].complete);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
DIEPINT(i) = DIEPINT(i);
|
||
|
|
}
|
||
|
|
|
||
|
|
if (GINTSTS & 0x80000) /* OUT EP event */
|
||
|
|
for (i = 0; i < 5; i += 2)
|
||
|
|
if (DOEPINT(i))
|
||
|
|
{
|
||
|
|
if (DOEPINT(i) & 1) /* Transfer completed */
|
||
|
|
{
|
||
|
|
invalidate_dcache();
|
||
|
|
int bytes = endpoints[i].size - (DOEPTSIZ(i) & 0x3FFFF);
|
||
|
|
if (endpoints[i].busy)
|
||
|
|
{
|
||
|
|
endpoints[i].busy = false;
|
||
|
|
endpoints[i].rc = 0;
|
||
|
|
endpoints[i].done = true;
|
||
|
|
usb_core_transfer_complete(i, USB_DIR_OUT, 0, bytes);
|
||
|
|
wakeup_signal(&endpoints[i].complete);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
if (DOEPINT(i) & 4) /* AHB error */
|
||
|
|
panicf("USB: AHB error on OUT EP%d", i);
|
||
|
|
if (DOEPINT(i) & 8) /* SETUP phase done */
|
||
|
|
{
|
||
|
|
invalidate_dcache();
|
||
|
|
if (i == 0)
|
||
|
|
{
|
||
|
|
if (ctrlreq.bRequest == 5)
|
||
|
|
{
|
||
|
|
/* Already set the new address here,
|
||
|
|
before passing the packet to the core.
|
||
|
|
See below (usb_drv_set_address) for details. */
|
||
|
|
DCFG = (DCFG & ~0x7F0) | (ctrlreq.wValue << 4);
|
||
|
|
}
|
||
|
|
usb_core_control_request(&ctrlreq);
|
||
|
|
}
|
||
|
|
else panicf("USB: SETUP done on OUT EP%d!?", i);
|
||
|
|
}
|
||
|
|
/* Make sure EP0 OUT is set up to accept the next request */
|
||
|
|
if (!i)
|
||
|
|
{
|
||
|
|
DOEPTSIZ0 = 0x20080040;
|
||
|
|
DOEPDMA0 = (uint32_t)&ctrlreq;
|
||
|
|
DOEPCTL0 |= 0x84000000;
|
||
|
|
}
|
||
|
|
DOEPINT(i) = DOEPINT(i);
|
||
|
|
}
|
||
|
|
|
||
|
|
GINTSTS = GINTSTS;
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_drv_set_address(int address)
|
||
|
|
{
|
||
|
|
(void)address;
|
||
|
|
/* Ignored intentionally, because the controller requires us to set the
|
||
|
|
new address before sending the response for some reason. So we'll
|
||
|
|
already set it when the control request arrives, before passing that
|
||
|
|
into the USB core, which will then call this dummy function. */
|
||
|
|
}
|
||
|
|
|
||
|
|
void ep_send(int ep, void *ptr, int length)
|
||
|
|
{
|
||
|
|
endpoints[ep].busy = true;
|
||
|
|
endpoints[ep].size = length;
|
||
|
|
DIEPCTL(ep) |= 0x8000; /* EPx OUT ACTIVE */
|
||
|
|
int blocksize = usb_drv_port_speed() ? 512 : 64;
|
||
|
|
int packets = (length + blocksize - 1) / blocksize;
|
||
|
|
if (!length) DIEPTSIZ(ep) = 1 << 19; /* one empty packet */
|
||
|
|
else DIEPTSIZ(ep) = length | (packets << 19);
|
||
|
|
DIEPDMA(ep) = (uint32_t)ptr;
|
||
|
|
clean_dcache();
|
||
|
|
DIEPCTL(ep) |= 0x84000000; /* EPx OUT ENABLE CLEARNAK */
|
||
|
|
}
|
||
|
|
|
||
|
|
void ep_recv(int ep, void *ptr, int length)
|
||
|
|
{
|
||
|
|
endpoints[ep].busy = true;
|
||
|
|
endpoints[ep].size = length;
|
||
|
|
DOEPCTL(ep) &= ~0x20000; /* EPx UNSTALL */
|
||
|
|
DOEPCTL(ep) |= 0x8000; /* EPx OUT ACTIVE */
|
||
|
|
int blocksize = usb_drv_port_speed() ? 512 : 64;
|
||
|
|
int packets = (length + blocksize - 1) / blocksize;
|
||
|
|
if (!length) DIEPTSIZ(ep) = 1 << 19; /* one empty packet */
|
||
|
|
else DOEPTSIZ(ep) = length | (packets << 19);
|
||
|
|
DOEPDMA(ep) = (uint32_t)ptr;
|
||
|
|
clean_dcache();
|
||
|
|
DOEPCTL(ep) |= 0x84000000; /* EPx OUT ENABLE CLEARNAK */
|
||
|
|
}
|
||
|
|
|
||
|
|
int usb_drv_send(int endpoint, void *ptr, int length)
|
||
|
|
{
|
||
|
|
endpoint &= 0x7f;
|
||
|
|
endpoints[endpoint].done = false;
|
||
|
|
ep_send(endpoint, ptr, length);
|
||
|
|
while (!endpoints[endpoint].done && endpoints[endpoint].busy)
|
||
|
|
wakeup_wait(&endpoints[endpoint].complete, TIMEOUT_BLOCK);
|
||
|
|
return endpoints[endpoint].rc;
|
||
|
|
}
|
||
|
|
|
||
|
|
int usb_drv_send_nonblocking(int endpoint, void *ptr, int length)
|
||
|
|
{
|
||
|
|
ep_send(endpoint & 0x7f, ptr, length);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int usb_drv_recv(int endpoint, void* ptr, int length)
|
||
|
|
{
|
||
|
|
ep_recv(endpoint & 0x7f, ptr, length);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_drv_cancel_all_transfers(void)
|
||
|
|
{
|
||
|
|
int flags = disable_irq_save();
|
||
|
|
reset_endpoints(0);
|
||
|
|
restore_irq(flags);
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_drv_set_test_mode(int mode)
|
||
|
|
{
|
||
|
|
(void)mode;
|
||
|
|
}
|
||
|
|
|
||
|
|
bool usb_drv_stalled(int endpoint, bool in)
|
||
|
|
{
|
||
|
|
if (in) return DIEPCTL(endpoint) & 0x00200000 ? true : false;
|
||
|
|
else return DOEPCTL(endpoint) & 0x00200000 ? true : false;
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_drv_stall(int endpoint, bool stall, bool in)
|
||
|
|
{
|
||
|
|
if (in)
|
||
|
|
{
|
||
|
|
if (stall) DIEPCTL(endpoint) |= 0x00200000;
|
||
|
|
else DIEPCTL(endpoint) &= ~0x00200000;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
if (stall) DOEPCTL(endpoint) |= 0x00200000;
|
||
|
|
else DOEPCTL(endpoint) &= ~0x00200000;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_drv_init(void)
|
||
|
|
{
|
||
|
|
/* Enable USB clock */
|
||
|
|
PWRCON &= ~0x4000;
|
||
|
|
PWRCONEXT &= ~0x800;
|
||
|
|
PCGCCTL = 0;
|
||
|
|
|
||
|
|
/* unmask irq */
|
||
|
|
INTMSK |= INTMSK_USB_OTG;
|
||
|
|
|
||
|
|
/* reset the beast */
|
||
|
|
usb_reset();
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_drv_exit(void)
|
||
|
|
{
|
||
|
|
DCTL = 0x802; /* Soft Disconnect */
|
||
|
|
|
||
|
|
OPHYPWR = 0xF; /* PHY: Power down */
|
||
|
|
|
||
|
|
PCGCCTL = 1; /* Mask clocks */
|
||
|
|
PWRCON |= 0x4000;
|
||
|
|
PWRCONEXT |= 0x800;
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_init_device(void)
|
||
|
|
{
|
||
|
|
unsigned int i;
|
||
|
|
for (i = 0; i < sizeof(endpoints)/sizeof(struct ep_type); i++)
|
||
|
|
wakeup_init(&endpoints[i].complete);
|
||
|
|
usb_drv_exit();
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_enable(bool on)
|
||
|
|
{
|
||
|
|
if (on) usb_core_init();
|
||
|
|
else usb_core_exit();
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_attach(void)
|
||
|
|
{
|
||
|
|
usb_enable(true);
|
||
|
|
}
|
||
|
|
|
||
|
|
int usb_detect(void)
|
||
|
|
{
|
||
|
|
if (charger_inserted())
|
||
|
|
return USB_INSERTED;
|
||
|
|
return USB_EXTRACTED;
|
||
|
|
}
|
||
|
|
|
||
|
|
#else
|
||
|
|
void usb_init_device(void)
|
||
|
|
{
|
||
|
|
/* simply switch USB off for now */
|
||
|
|
DCTL = 0x802; /* Soft Disconnect */
|
||
|
|
|
||
|
|
OPHYPWR = 0xF; /* PHY: Power down */
|
||
|
|
|
||
|
|
PCGCCTL = 1; /* Mask clocks */
|
||
|
|
PWRCON |= 0x4000;
|
||
|
|
PWRCONEXT |= 0x800;
|
||
|
|
}
|
||
|
|
|
||
|
|
void usb_enable(bool on)
|
||
|
|
{
|
||
|
|
(void)on;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Always return false for now */
|
||
|
|
int usb_detect(void)
|
||
|
|
{
|
||
|
|
return USB_EXTRACTED;
|
||
|
|
}
|
||
|
|
#endif
|