#include <avr/io.h>
#include <avr/pgmspace.h>
#include <stdint.h>
#include "usb_common.h"
#include "usb_private.h"
#include "usb_api.h"
#include "wiring.h"
int usb_rawhid_class::available(void)
{
uint8_t n=0, intr_state;
intr_state = SREG;
cli();
if (usb_configuration) {
UENUM = RAWHID_RX_ENDPOINT;
n = UEBCLX;
}
SREG = intr_state;
return n;
}
int usb_rawhid_class::recv(void *ptr, uint16_t timeout)
{
uint8_t *buffer = (uint8_t *)ptr;
uint8_t intr_state;
if (!usb_configuration) return -1;
intr_state = SREG;
cli();
rawhid_rx_timeout_count = timeout;
UENUM = RAWHID_RX_ENDPOINT;
while (1) {
if (UEINTX & (1<<RWAL)) break;
SREG = intr_state;
if (rawhid_rx_timeout_count == 0) return 0;
if (!usb_configuration) return -1;
intr_state = SREG;
cli();
UENUM = RAWHID_RX_ENDPOINT;
}
#if (RAWHID_RX_SIZE >= 64)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 63)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 62)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 61)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 60)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 59)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 58)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 57)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 56)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 55)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 54)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 53)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 52)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 51)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 50)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 49)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 48)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 47)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 46)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 45)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 44)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 43)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 42)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 41)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 40)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 39)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 38)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 37)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 36)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 35)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 34)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 33)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 32)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 31)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 30)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 29)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 28)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 27)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 26)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 25)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 24)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 23)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 22)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 21)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 20)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 19)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 18)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 17)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 16)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 15)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 14)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 13)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 12)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 11)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 10)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 9)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 8)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 7)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 6)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 5)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 4)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 3)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 2)
*buffer++ = UEDATX;
#endif
#if (RAWHID_RX_SIZE >= 1)
*buffer++ = UEDATX;
#endif
UEINTX = 0x6B;
SREG = intr_state;
return RAWHID_RX_SIZE;
}
int usb_rawhid_class::send(const void *ptr, uint16_t timeout)
{
const uint8_t *buffer = (const uint8_t *)ptr;
uint8_t intr_state;
if (!usb_configuration) return -1;
intr_state = SREG;
cli();
rawhid_tx_timeout_count = timeout;
UENUM = RAWHID_TX_ENDPOINT;
while (1) {
if (UEINTX & (1<<RWAL)) break;
SREG = intr_state;
if (rawhid_tx_timeout_count == 0) return 0;
if (!usb_configuration) return -1;
intr_state = SREG;
cli();
UENUM = RAWHID_TX_ENDPOINT;
}
#if (RAWHID_TX_SIZE >= 64)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 63)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 62)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 61)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 60)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 59)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 58)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 57)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 56)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 55)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 54)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 53)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 52)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 51)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 50)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 49)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 48)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 47)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 46)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 45)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 44)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 43)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 42)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 41)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 40)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 39)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 38)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 37)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 36)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 35)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 34)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 33)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 32)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 31)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 30)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 29)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 28)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 27)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 26)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 25)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 24)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 23)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 22)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 21)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 20)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 19)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 18)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 17)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 16)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 15)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 14)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 13)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 12)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 11)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 10)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 9)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 8)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 7)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 6)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 5)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 4)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 3)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 2)
UEDATX = *buffer++;
#endif
#if (RAWHID_TX_SIZE >= 1)
UEDATX = *buffer++;
#endif
UEINTX = 0x3A;
SREG = intr_state;
return RAWHID_TX_SIZE;
}
static volatile uint8_t prev_byte=0;
void usb_serial_class::begin(long speed)
{
usb_init();
uint16_t begin_wait = (uint16_t)millis();
while (1) {
if (usb_configuration) {
delay(200); return;
}
if (usb_suspended) {
uint16_t begin_suspend = (uint16_t)millis();
while (usb_suspended) {
if ((uint16_t)millis() - begin_suspend > 250) {
return;
}
}
}
if ((uint16_t)millis() - begin_wait > 2500) return;
}
prev_byte = 0;
}
void usb_serial_class::end()
{
usb_shutdown();
delay(25);
}
int usb_serial_class::available()
{
uint8_t c;
c = prev_byte; if (c) return 1;
c = readnext();
if (c) {
prev_byte = c;
return 1;
}
return 0;
}
int usb_serial_class::read()
{
uint8_t c;
c = prev_byte;
if (c) {
prev_byte = 0;
return c;
}
c = readnext();
if (c) return c;
return -1;
}
int usb_serial_class::peek()
{
uint8_t c;
c = prev_byte;
if (c) return c;
c = readnext();
if (c) {
prev_byte = c;
return c;
}
return -1;
}
uint8_t usb_serial_class::readnext(void)
{
uint8_t c, intr_state;
intr_state = SREG;
cli();
if (!usb_configuration) {
SREG = intr_state;
return 0;
}
UENUM = DEBUG_RX_ENDPOINT;
try_again:
if (!(UEINTX & (1<<RWAL))) {
SREG = intr_state;
return 0;
}
c = UEDATX;
if (c == 0) {
UEINTX = 0x6B;
goto try_again;
}
if (!(UEINTX & (1<<RWAL))) UEINTX = 0x6B;
SREG = intr_state;
return c;
}
void usb_serial_class::flush()
{
uint8_t intr_state;
if (usb_configuration) {
intr_state = SREG;
cli();
UENUM = DEBUG_RX_ENDPOINT;
while ((UEINTX & (1<<RWAL))) {
UEINTX = 0x6B;
}
SREG = intr_state;
}
prev_byte = 0;
}
#if ARDUINO >= 100
size_t usb_serial_class::write(uint8_t c)
#else
void usb_serial_class::write(uint8_t c)
#endif
{
uint8_t timeout, intr_state;
if (!usb_configuration) goto error;
intr_state = SREG;
cli();
UENUM = DEBUG_TX_ENDPOINT;
#if 0#endif
timeout = UDFNUML + TRANSMIT_TIMEOUT;
while (1) {
if (UEINTX & (1<<RWAL)) break;
SREG = intr_state;
if (UDFNUML == timeout) {
goto error;
}
if (!usb_configuration) goto error;
intr_state = SREG;
cli();
UENUM = DEBUG_TX_ENDPOINT;
}
UEDATX = c;
if (!(UEINTX & (1<<RWAL))) {
UEINTX = 0x3A;
debug_flush_timer = 0;
} else {
debug_flush_timer = TRANSMIT_FLUSH_TIMEOUT;
}
SREG = intr_state;
#if ARDUINO >= 100
return 1;
#endif
error:
#if ARDUINO >= 100
setWriteError();
return 0;
#else
return;
#endif
}
void usb_serial_class::send_now(void)
{
uint8_t intr_state;
intr_state = SREG;
cli();
if (debug_flush_timer) {
UENUM = DEBUG_TX_ENDPOINT;
while ((UEINTX & (1<<RWAL))) {
UEDATX = 0;
}
UEINTX = 0x3A;
debug_flush_timer = 0;
}
SREG = intr_state;
}
uint32_t usb_serial_class::baud(void)
{
return ((uint32_t)DEBUG_TX_SIZE * 10000 / DEBUG_TX_INTERVAL);
}
uint8_t usb_serial_class::stopbits(void)
{
return 1;
}
uint8_t usb_serial_class::paritytype(void)
{
return 0;
}
uint8_t usb_serial_class::numbits(void)
{
return 8;
}
uint8_t usb_serial_class::dtr(void)
{
return 1;
}
uint8_t usb_serial_class::rts(void)
{
return 1;
}
usb_serial_class::operator bool()
{
if (usb_configuration) return true;
return false;
}
usb_serial_class Serial = usb_serial_class();
usb_rawhid_class RawHID = usb_rawhid_class();