2011-02-14 17:01:11 +02:00
|
|
|
/*
|
2011-02-14 17:48:42 +02:00
|
|
|
* fw/usb/atu2.c - Chip-specific driver for Atmel ATxxxU2 USB chips
|
2011-02-14 17:01:11 +02:00
|
|
|
*
|
|
|
|
* Written 2008-2011 by Werner Almesberger
|
|
|
|
* Copyright 2008-2011 Werner Almesberger
|
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Known issues:
|
|
|
|
* - no suspend/resume
|
2011-02-14 17:54:29 +02:00
|
|
|
* - we don't call back after failed transmissions,
|
|
|
|
* - we don't reset the EP buffer after failed receptions
|
|
|
|
* - enumeration often encounters an error -71 (from which it recovers)
|
2011-02-14 17:01:11 +02:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <stdint.h>
|
|
|
|
|
|
|
|
#define F_CPU 8000000UL
|
|
|
|
#include <util/delay.h>
|
|
|
|
|
|
|
|
#include <avr/io.h>
|
|
|
|
#include "usb.h"
|
|
|
|
#include "../board.h"
|
|
|
|
|
|
|
|
|
|
|
|
#ifndef NULL
|
|
|
|
#define NULL 0
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if 1
|
|
|
|
#define BUG_ON(cond) do { if (cond) panic(); } while (0)
|
|
|
|
#else
|
|
|
|
#define BUG_ON(cond)
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#define NUM_EPS 1
|
|
|
|
|
|
|
|
|
|
|
|
struct ep_descr eps[NUM_EPS];
|
|
|
|
|
|
|
|
|
|
|
|
static uint16_t usb_read_word(void)
|
|
|
|
{
|
|
|
|
uint8_t low;
|
|
|
|
|
|
|
|
low = UEDATX;
|
|
|
|
return low | UEDATX << 8;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void enable_addr(void *user)
|
|
|
|
{
|
|
|
|
while (!(UEINTX & (1 << TXINI)));
|
|
|
|
UDADDR |= 1 << ADDEN;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
int set_addr(uint8_t addr)
|
|
|
|
{
|
|
|
|
UDADDR = addr;
|
|
|
|
usb_send(&eps[0], NULL, 0, enable_addr, NULL);
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int ep_setup(void)
|
|
|
|
{
|
|
|
|
struct setup_request setup;
|
|
|
|
|
|
|
|
BUG_ON(UEBCLX < 8);
|
|
|
|
|
|
|
|
setup.bmRequestType = UEDATX;
|
|
|
|
setup.bRequest = UEDATX;
|
|
|
|
setup.wValue = usb_read_word();
|
|
|
|
setup.wIndex = usb_read_word();
|
|
|
|
setup.wLength = usb_read_word();
|
|
|
|
|
|
|
|
if (!handle_setup(&setup))
|
|
|
|
return 0;
|
|
|
|
if (!(setup.bmRequestType & 0x80) && eps[0].state == EP_IDLE)
|
|
|
|
usb_send(&eps[0], NULL, 0, NULL, NULL);
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int ep_rx(struct ep_descr *ep)
|
|
|
|
{
|
|
|
|
uint8_t size;
|
|
|
|
|
|
|
|
size = UEBCLX;
|
|
|
|
if (size > ep->end-ep->buf)
|
|
|
|
return 0;
|
|
|
|
while (size--)
|
|
|
|
*ep->buf++ = UEDATX;
|
|
|
|
if (ep->buf == ep->end) {
|
|
|
|
ep->state = EP_IDLE;
|
|
|
|
if (ep->callback)
|
|
|
|
ep->callback(ep->user);
|
|
|
|
if (ep == &eps[0])
|
|
|
|
usb_send(ep, NULL, 0, NULL, NULL);
|
|
|
|
}
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void ep_tx(struct ep_descr *ep)
|
|
|
|
{
|
|
|
|
uint8_t size = ep->end-ep->buf;
|
|
|
|
uint8_t left;
|
|
|
|
|
|
|
|
if (size > ep->size)
|
|
|
|
size = ep->size;
|
|
|
|
for (left = size; left; left--)
|
|
|
|
UEDATX = *ep->buf++;
|
|
|
|
if (size == ep->size)
|
|
|
|
return;
|
|
|
|
ep->state = EP_IDLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void handle_ep(int n)
|
|
|
|
{
|
|
|
|
struct ep_descr *ep = eps+n;
|
|
|
|
|
|
|
|
UENUM = n;
|
|
|
|
if (UEINTX & (1 << RXSTPI)) {
|
|
|
|
/* @@@ EP_RX. EP_TX: cancel */
|
2011-03-11 22:45:45 +02:00
|
|
|
ep->state = EP_IDLE;
|
2011-02-14 17:01:11 +02:00
|
|
|
if (!ep_setup())
|
|
|
|
goto stall;
|
|
|
|
UEINTX &= ~(1 << RXSTPI);
|
|
|
|
}
|
|
|
|
if (UEINTX & (1 << RXOUTI)) {
|
|
|
|
/* @@ EP_TX: cancel */
|
|
|
|
if (ep->state != EP_RX)
|
|
|
|
goto stall;
|
|
|
|
if (!ep_rx(ep))
|
|
|
|
goto stall;
|
|
|
|
// UEINTX &= ~(1 << RXOUTI);
|
|
|
|
UEINTX &= ~(1 << RXOUTI | 1 << FIFOCON);
|
|
|
|
}
|
|
|
|
if (UEINTX & (1 << STALLEDI)) {
|
|
|
|
ep->state = EP_IDLE;
|
|
|
|
UEINTX &= ~(1 << STALLEDI);
|
|
|
|
}
|
|
|
|
if (UEINTX & (1 << TXINI)) {
|
2011-03-11 22:45:45 +02:00
|
|
|
/* @@ EP_RX: cancel (?) */
|
2011-02-14 17:01:11 +02:00
|
|
|
if (ep->state == EP_TX) {
|
|
|
|
ep_tx(ep);
|
|
|
|
UEINTX &= ~(1 << TXINI);
|
|
|
|
if (ep->state == EP_IDLE && ep->callback)
|
|
|
|
ep->callback(ep->user);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return;
|
|
|
|
|
|
|
|
stall:
|
|
|
|
UEINTX &= ~(1 << RXSTPI | 1 << RXOUTI | 1 << STALLEDI);
|
|
|
|
ep->state = EP_IDLE;
|
|
|
|
UECONX |= 1 << STALLRQ;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void usb_poll(void)
|
|
|
|
{
|
|
|
|
uint8_t flags, i;
|
|
|
|
|
|
|
|
flags = UEINT;
|
|
|
|
for (i = 0; i != NUM_EPS; i++)
|
|
|
|
if (1 || flags & (1 << i))
|
|
|
|
handle_ep(i);
|
|
|
|
/* @@@ USB bus reset */
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void ep_init(void)
|
|
|
|
{
|
|
|
|
UENUM = 0;
|
|
|
|
UECONX = (1 << RSTDT) | (1 << EPEN); /* enable */
|
|
|
|
UECFG0X = 0; /* control, direction is ignored */
|
|
|
|
UECFG1X = 3 << EPSIZE0; /* 64 bytes */
|
|
|
|
UECFG1X |= 1 << ALLOC;
|
|
|
|
|
|
|
|
while (!(UESTA0X & (1 << CFGOK)));
|
|
|
|
|
|
|
|
eps[0].state = EP_IDLE;
|
|
|
|
eps[0].size = 64;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void usb_init(void)
|
|
|
|
{
|
|
|
|
USBCON |= 1 << FRZCLK; /* freeze the clock */
|
|
|
|
|
|
|
|
/* enable the PLL and wait for it to lock */
|
|
|
|
PLLCSR &= ~(1 << PLLP2 | 1 << PLLP1 | 1 << PLLP0);
|
|
|
|
PLLCSR |= 1 << PLLE;
|
|
|
|
while (!(PLLCSR & (1 << PLOCK)));
|
|
|
|
|
|
|
|
USBCON &= ~(1 << USBE); /* reset the controller */
|
|
|
|
USBCON |= 1 << USBE;
|
|
|
|
|
|
|
|
USBCON &= ~(1 << FRZCLK); /* thaw the clock */
|
|
|
|
|
|
|
|
UDCON &= ~(1 << DETACH); /* attach the pull-up */
|
|
|
|
UDCON |= 1 << RSTCPU; /* reset CPU on bus reset */
|
|
|
|
|
|
|
|
ep_init();
|
|
|
|
}
|