mirror of
https://github.com/hathach/tinyusb.git
synced 2025-01-17 05:32:55 +08:00
dcd_fomu: nearly there
Signed-off-by: Sean Cross <sean@xobs.io>
This commit is contained in:
parent
835a72c595
commit
913032ae1d
@ -24,11 +24,11 @@
|
|||||||
* This file is part of the TinyUSB stack.
|
* This file is part of the TinyUSB stack.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#ifndef DEBUG
|
||||||
|
#define DEBUG 1
|
||||||
|
#endif
|
||||||
#include "tusb_option.h"
|
#include "tusb_option.h"
|
||||||
|
|
||||||
#ifndef DEBUG
|
|
||||||
#define DEBUG 0
|
|
||||||
#endif
|
|
||||||
|
|
||||||
// #if TUSB_OPT_DEVICE_ENABLED && (CFG_TUSB_MCU == OPT_MCU_FOMU_EPTRI)
|
// #if TUSB_OPT_DEVICE_ENABLED && (CFG_TUSB_MCU == OPT_MCU_FOMU_EPTRI)
|
||||||
#if 1
|
#if 1
|
||||||
@ -41,6 +41,8 @@ void fomu_error(uint32_t line);
|
|||||||
void mputs(const char *str);
|
void mputs(const char *str);
|
||||||
void mputln(const char *str);
|
void mputln(const char *str);
|
||||||
|
|
||||||
|
static uint8_t last_address;
|
||||||
|
|
||||||
//--------------------------------------------------------------------+
|
//--------------------------------------------------------------------+
|
||||||
// SIE Command
|
// SIE Command
|
||||||
//--------------------------------------------------------------------+
|
//--------------------------------------------------------------------+
|
||||||
@ -58,11 +60,11 @@ uint8_t volatile * tx_buffer[16];
|
|||||||
volatile uint16_t tx_buffer_max[16];
|
volatile uint16_t tx_buffer_max[16];
|
||||||
volatile uint8_t reset_count;
|
volatile uint8_t reset_count;
|
||||||
|
|
||||||
#ifdef DEBUG
|
#if DEBUG
|
||||||
__attribute__((used)) uint8_t volatile * last_tx_buffer;
|
__attribute__((used)) uint8_t volatile * last_tx_buffer;
|
||||||
__attribute__((used)) volatile uint8_t last_tx_ep;
|
__attribute__((used)) volatile uint8_t last_tx_ep;
|
||||||
#endif
|
|
||||||
uint8_t setup_packet_bfr[10];
|
uint8_t setup_packet_bfr[10];
|
||||||
|
#endif
|
||||||
//--------------------------------------------------------------------+
|
//--------------------------------------------------------------------+
|
||||||
// PIPE HELPER
|
// PIPE HELPER
|
||||||
//--------------------------------------------------------------------+
|
//--------------------------------------------------------------------+
|
||||||
@ -82,15 +84,15 @@ static bool advance_tx_ep(void) {
|
|||||||
static void tx_more_data(void) {
|
static void tx_more_data(void) {
|
||||||
// Send more data
|
// Send more data
|
||||||
uint8_t added_bytes;
|
uint8_t added_bytes;
|
||||||
for (added_bytes = 0; (added_bytes < EP_SIZE) && (added_bytes + tx_buffer_offset[tx_ep] < tx_buffer_max[tx_ep]); added_bytes++) {
|
for (added_bytes = 0; (added_bytes < EP_SIZE) && (tx_buffer_offset[tx_ep] < tx_buffer_max[tx_ep]); added_bytes++) {
|
||||||
usb_in_data_write(tx_buffer[tx_ep][added_bytes + tx_buffer_offset[tx_ep]]);
|
usb_in_data_write(tx_buffer[tx_ep][tx_buffer_offset[tx_ep]++]);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Updating the epno queues the data
|
// Updating the epno queues the data
|
||||||
usb_in_ctrl_write(tx_ep & 0xf);
|
usb_in_ctrl_write(tx_ep & 0xf);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void process_tx(bool in_isr) {
|
static void process_tx(void) {
|
||||||
#if DEBUG
|
#if DEBUG
|
||||||
// If the system isn't idle, then something is very wrong.
|
// If the system isn't idle, then something is very wrong.
|
||||||
uint8_t in_status = usb_in_status_read();
|
uint8_t in_status = usb_in_status_read();
|
||||||
@ -107,18 +109,20 @@ static void process_tx(bool in_isr) {
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
tx_buffer_offset[tx_ep] += EP_SIZE;
|
|
||||||
|
|
||||||
if (tx_buffer_offset[tx_ep] >= tx_buffer_max[tx_ep]) {
|
if (tx_buffer_offset[tx_ep] >= tx_buffer_max[tx_ep]) {
|
||||||
#if DEBUG
|
#if DEBUG
|
||||||
last_tx_buffer = tx_buffer[tx_ep];
|
last_tx_buffer = tx_buffer[tx_ep];
|
||||||
last_tx_ep = tx_ep;
|
last_tx_ep = tx_ep;
|
||||||
#endif
|
#endif
|
||||||
tx_buffer[tx_ep] = NULL;
|
tx_buffer[tx_ep] = NULL;
|
||||||
|
uint16_t xferred_bytes = tx_buffer_max[tx_ep];
|
||||||
|
uint8_t xferred_ep = tx_ep;
|
||||||
|
|
||||||
if (!advance_tx_ep())
|
if (!advance_tx_ep())
|
||||||
tx_active = false;
|
tx_active = false;
|
||||||
dcd_event_xfer_complete(0, tu_edpt_addr(tx_ep, TUSB_DIR_IN), tx_buffer_max[tx_ep], XFER_RESULT_SUCCESS, in_isr);
|
if ((xferred_bytes == 13) && (tx_buffer_max[tx_ep] == 512))
|
||||||
|
fomu_error(__LINE__);
|
||||||
|
dcd_event_xfer_complete(0, tu_edpt_addr(xferred_ep, TUSB_DIR_IN), xferred_bytes, XFER_RESULT_SUCCESS, true);
|
||||||
if (!tx_active)
|
if (!tx_active)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@ -127,7 +131,7 @@ static void process_tx(bool in_isr) {
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void process_rx(bool in_isr) {
|
static void process_rx(void) {
|
||||||
uint8_t out_status = usb_out_status_read();
|
uint8_t out_status = usb_out_status_read();
|
||||||
#if DEBUG
|
#if DEBUG
|
||||||
// If the OUT handler is still waiting to send, don't do anything.
|
// If the OUT handler is still waiting to send, don't do anything.
|
||||||
@ -190,15 +194,15 @@ static void process_rx(bool in_isr) {
|
|||||||
int i;
|
int i;
|
||||||
for (i = 0; i < 16; i++) {
|
for (i = 0; i < 16; i++) {
|
||||||
if ((!!(ep_en_mask & (1 << i))) ^ (!!(rx_buffer[i]))) {
|
if ((!!(ep_en_mask & (1 << i))) ^ (!!(rx_buffer[i]))) {
|
||||||
uint8_t new_status = usb_out_status_read();
|
// uint8_t new_status = usb_out_status_read();
|
||||||
// Another IRQ came in while we were processing, so ignore this endpoint.
|
// // Another IRQ came in while we were processing, so ignore this endpoint.
|
||||||
if ((new_status & 0x20) && ((new_status & 0xf) == i))
|
// if ((new_status & 0x20) && ((new_status & 0xf) == i))
|
||||||
continue;
|
// continue;
|
||||||
fomu_error(__LINE__);
|
fomu_error(__LINE__);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
dcd_event_xfer_complete(0, tu_edpt_addr(rx_ep, TUSB_DIR_OUT), len, XFER_RESULT_SUCCESS, in_isr);
|
dcd_event_xfer_complete(0, tu_edpt_addr(rx_ep, TUSB_DIR_OUT), len, XFER_RESULT_SUCCESS, true);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
// If there's more data, re-enable data reception on this endpoint
|
// If there's more data, re-enable data reception on this endpoint
|
||||||
@ -220,6 +224,8 @@ static void dcd_reset(void)
|
|||||||
usb_in_ev_enable_write(0);
|
usb_in_ev_enable_write(0);
|
||||||
usb_out_ev_enable_write(0);
|
usb_out_ev_enable_write(0);
|
||||||
|
|
||||||
|
if (last_address)
|
||||||
|
asm("ebreak");
|
||||||
usb_address_write(0);
|
usb_address_write(0);
|
||||||
|
|
||||||
// Reset all three FIFO handlers
|
// Reset all three FIFO handlers
|
||||||
@ -294,6 +300,7 @@ void dcd_set_address(uint8_t rhport, uint8_t dev_addr)
|
|||||||
|
|
||||||
// Activate the new address
|
// Activate the new address
|
||||||
usb_address_write(dev_addr);
|
usb_address_write(dev_addr);
|
||||||
|
last_address = dev_addr;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Called when the device received SET_CONFIG request, you can leave this
|
// Called when the device received SET_CONFIG request, you can leave this
|
||||||
@ -387,11 +394,13 @@ bool dcd_edpt_xfer (uint8_t rhport, uint8_t ep_addr, uint8_t* buffer, uint16_t t
|
|||||||
while (tx_buffer[ep_num] != NULL)
|
while (tx_buffer[ep_num] != NULL)
|
||||||
;
|
;
|
||||||
|
|
||||||
|
dcd_int_disable(0);
|
||||||
|
if (total_bytes == 499)
|
||||||
|
asm("ebreak");
|
||||||
// If a reset happens while we're waiting, abort the transfer
|
// If a reset happens while we're waiting, abort the transfer
|
||||||
if (previous_reset_count != reset_count)
|
if (previous_reset_count != reset_count)
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
dcd_int_disable(0);
|
|
||||||
TU_ASSERT(tx_buffer[ep_num] == NULL);
|
TU_ASSERT(tx_buffer[ep_num] == NULL);
|
||||||
tx_buffer_offset[ep_num] = 0;
|
tx_buffer_offset[ep_num] = 0;
|
||||||
tx_buffer_max[ep_num] = total_bytes;
|
tx_buffer_max[ep_num] = total_bytes;
|
||||||
@ -419,18 +428,19 @@ bool dcd_edpt_xfer (uint8_t rhport, uint8_t ep_addr, uint8_t* buffer, uint16_t t
|
|||||||
rx_buffer_offset[ep_num] = 0;
|
rx_buffer_offset[ep_num] = 0;
|
||||||
rx_buffer_max[ep_num] = total_bytes;
|
rx_buffer_max[ep_num] = total_bytes;
|
||||||
|
|
||||||
|
// Enable receiving on this particular endpoint
|
||||||
usb_out_ctrl_write((1 << CSR_USB_OUT_CTRL_ENABLE_OFFSET) | ep_num);
|
usb_out_ctrl_write((1 << CSR_USB_OUT_CTRL_ENABLE_OFFSET) | ep_num);
|
||||||
#if DEBUG
|
// #if DEBUG
|
||||||
uint16_t ep_en_mask = usb_out_enable_status_read();
|
// uint16_t ep_en_mask = usb_out_enable_status_read();
|
||||||
int i;
|
// int i;
|
||||||
for (i = 0; i < 16; i++) {
|
// for (i = 0; i < 16; i++) {
|
||||||
if ((!!(ep_en_mask & (1 << i))) ^ (!!(rx_buffer[i]))) {
|
// if ((!!(ep_en_mask & (1 << i))) ^ (!!(rx_buffer[i]))) {
|
||||||
if (rx_buffer[i] && usb_out_ev_pending_read() && (usb_out_status_read() & 0xf) == i)
|
// if (rx_buffer[i] && usb_out_ev_pending_read() && (usb_out_status_read() & 0xf) == i)
|
||||||
continue;
|
// continue;
|
||||||
fomu_error(__LINE__);
|
// fomu_error(__LINE__);
|
||||||
}
|
// }
|
||||||
}
|
// }
|
||||||
#endif
|
// #endif
|
||||||
dcd_int_enable(0);
|
dcd_int_enable(0);
|
||||||
}
|
}
|
||||||
return true;
|
return true;
|
||||||
@ -442,9 +452,12 @@ bool dcd_edpt_xfer (uint8_t rhport, uint8_t ep_addr, uint8_t* buffer, uint16_t t
|
|||||||
|
|
||||||
void hal_dcd_isr(uint8_t rhport)
|
void hal_dcd_isr(uint8_t rhport)
|
||||||
{
|
{
|
||||||
uint8_t setup_pending = usb_setup_ev_pending_read();
|
uint8_t setup_pending = usb_setup_ev_pending_read() & usb_setup_ev_enable_read();
|
||||||
uint8_t in_pending = usb_in_ev_pending_read();
|
uint8_t in_pending = usb_in_ev_pending_read() & usb_in_ev_enable_read();
|
||||||
uint8_t out_pending = usb_out_ev_pending_read();
|
uint8_t out_pending = usb_out_ev_pending_read() & usb_out_ev_enable_read();
|
||||||
|
#if !DEBUG
|
||||||
|
uint8_t setup_packet_bfr[10];
|
||||||
|
#endif
|
||||||
usb_setup_ev_pending_write(setup_pending);
|
usb_setup_ev_pending_write(setup_pending);
|
||||||
|
|
||||||
// This event means a bus reset occurred. Reset everything, and
|
// This event means a bus reset occurred. Reset everything, and
|
||||||
@ -454,17 +467,6 @@ void hal_dcd_isr(uint8_t rhport)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
// An "OUT" transaction just completed so we have new data.
|
|
||||||
// (But only if we can accept the data)
|
|
||||||
// if (out_pending) {
|
|
||||||
if (out_pending) {
|
|
||||||
#if DEBUG
|
|
||||||
if (!usb_out_ev_enable_read())
|
|
||||||
fomu_error(__LINE__);
|
|
||||||
#endif
|
|
||||||
process_rx(true);
|
|
||||||
}
|
|
||||||
|
|
||||||
// An "IN" transaction just completed.
|
// An "IN" transaction just completed.
|
||||||
// Note that due to the way tinyusb's callback system is implemented,
|
// Note that due to the way tinyusb's callback system is implemented,
|
||||||
// we must handle IN and OUT packets before we handle SETUP packets.
|
// we must handle IN and OUT packets before we handle SETUP packets.
|
||||||
@ -478,7 +480,18 @@ void hal_dcd_isr(uint8_t rhport)
|
|||||||
fomu_error(__LINE__);
|
fomu_error(__LINE__);
|
||||||
#endif
|
#endif
|
||||||
usb_in_ev_pending_write(in_pending);
|
usb_in_ev_pending_write(in_pending);
|
||||||
process_tx(true);
|
process_tx();
|
||||||
|
}
|
||||||
|
|
||||||
|
// An "OUT" transaction just completed so we have new data.
|
||||||
|
// (But only if we can accept the data)
|
||||||
|
// if (out_pending) {
|
||||||
|
if (out_pending) {
|
||||||
|
#if DEBUG
|
||||||
|
if (!usb_out_ev_enable_read())
|
||||||
|
fomu_error(__LINE__);
|
||||||
|
#endif
|
||||||
|
process_rx();
|
||||||
}
|
}
|
||||||
|
|
||||||
// We got a SETUP packet. Copy it to the setup buffer and clear
|
// We got a SETUP packet. Copy it to the setup buffer and clear
|
||||||
|
Loading…
x
Reference in New Issue
Block a user