projects / fw / altos / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
altos/stmf0: Stop shadowing USB tx buffers in system RAM
[fw/altos] / src / stmf0 / ao_usb_stm.c
diff --git a/src/stmf0/ao_usb_stm.c b/src/stmf0/ao_usb_stm.c
index 652b3b6ca9facebaa742a57392f542f62e4958fa..0595c2b8cbf602e31eb317583e093a3b99ed41c5 100644 (file)
--- a/src/stmf0/ao_usb_stm.c
+++ b/src/stmf0/ao_usb_stm.c
@@ -99,12 +99,9 @@ static uint16_t ao_usb_int_tx_offset;
 
 /* Pointer to bulk data tx/rx buffers in USB memory */
 #if AO_USB_HAS_IN
-static uint16_t ao_usb_in_tx_offset;
-static uint16_t        *ao_usb_in_tx_buffer;
-
-/* System ram shadow of USB buffer; writing individual bytes is
- * too much of a pain (sigh) */
-static uint8_t ao_usb_tx_buffer[AO_USB_IN_SIZE];
+static uint16_t ao_usb_in_tx_offset[2];
+static uint16_t        *ao_usb_in_tx_buffer[2];
+static uint8_t ao_usb_in_tx_which;
 static uint8_t ao_usb_tx_count;
 
 #endif
@@ -119,12 +116,9 @@ static uint8_t     ao_usb_rx_count, ao_usb_rx_pos;
 
 #endif
 #if AO_USB_HAS_IN2
-static uint16_t ao_usb_in2_tx_offset;
-static uint16_t *ao_usb_in2_tx_buffer;
-
-/* System ram shadow of USB buffer; writing individual bytes is
- * too much of a pain (sigh) */
-static uint8_t ao_usb_tx2_buffer[AO_USB_IN_SIZE];
+static uint16_t ao_usb_in2_tx_offset[2];
+static uint16_t *ao_usb_in2_tx_buffer[2];
+static uint8_t ao_usb_in_tx2_which;
 static uint8_t ao_usb_tx2_count;
 #endif
 
@@ -378,29 +372,44 @@ ao_usb_alloc_buffers(void)
 
 
 #if AO_USB_HAS_INT
+       sram_addr += (sram_addr & 1);
        ao_usb_int_tx_offset = sram_addr;
        sram_addr += AO_USB_INT_SIZE;
 #endif
 
 #if AO_USB_HAS_OUT
+       sram_addr += (sram_addr & 1);
        ao_usb_out_rx_buffer = ao_usb_packet_buffer_addr(sram_addr);
        ao_usb_out_rx_offset = sram_addr;
        sram_addr += AO_USB_OUT_SIZE;
 #endif
 
 #if AO_USB_HAS_IN
-       ao_usb_in_tx_buffer = ao_usb_packet_buffer_addr(sram_addr);
-       ao_usb_in_tx_offset = sram_addr;
+       sram_addr += (sram_addr & 1);
+       ao_usb_in_tx_buffer[0] = ao_usb_packet_buffer_addr(sram_addr);
+       ao_usb_in_tx_offset[0] = sram_addr;
+       sram_addr += AO_USB_IN_SIZE;
+       ao_usb_in_tx_buffer[1] = ao_usb_packet_buffer_addr(sram_addr);
+       ao_usb_in_tx_offset[1] = sram_addr;
        sram_addr += AO_USB_IN_SIZE;
+       ao_usb_in_tx_which = 0;
 #endif
 
 #if AO_USB_HAS_IN2
-       ao_usb_in2_tx_buffer = ao_usb_packet_buffer_addr(sram_addr);
-       ao_usb_in2_tx_offset = sram_addr;
+       sram_addr += (sram_addr & 1);
+       ao_usb_in2_tx_buffer[0] = ao_usb_packet_buffer_addr(sram_addr);
+       ao_usb_in2_tx_offset[0] = sram_addr;
        sram_addr += AO_USB_IN_SIZE;
+
+       sram_addr += (sram_addr & 1);
+       ao_usb_in2_tx_buffer[1] = ao_usb_packet_buffer_addr(sram_addr);
+       ao_usb_in2_tx_offset[1] = sram_addr;
+       sram_addr += AO_USB_IN_SIZE;
+       ao_usb_in2_tx_which = 0;
 #endif
 
 #if AO_USB_DIRECTIO
+       sram_addr += (sram_addr & 1);
        ao_usb_sram_addr = sram_addr;
 #endif
 }
@@ -489,7 +498,7 @@ ao_usb_set_configuration(void)
 
 #if AO_USB_HAS_IN
        /* Set up the IN end point */
-       ao_usb_bdt[AO_USB_IN_EPR].single.addr_tx = ao_usb_in_tx_offset;
+       ao_usb_bdt[AO_USB_IN_EPR].single.addr_tx = 0;
        ao_usb_bdt[AO_USB_IN_EPR].single.count_tx = 0;
 
        ao_usb_init_ep(AO_USB_IN_EPR,
@@ -501,7 +510,7 @@ ao_usb_set_configuration(void)
 
 #if AO_USB_HAS_IN2
        /* Set up the IN2 end point */
-       ao_usb_bdt[AO_USB_IN2_EPR].single.addr_tx = ao_usb_in2_tx_offset;
+       ao_usb_bdt[AO_USB_IN2_EPR].single.addr_tx = 0;
        ao_usb_bdt[AO_USB_IN2_EPR].single.count_tx = 0;
 
        ao_usb_init_ep(AO_USB_IN2_EPR,
@@ -531,11 +540,13 @@ ao_usb_set_configuration(void)
 #endif
 }
 
+#if USB_STATUS
 static uint16_t        control_count;
 static uint16_t int_count;
 static uint16_t        in_count;
 static uint16_t        out_count;
 static uint16_t        reset_count;
+#endif
 
 /* The USB memory must be accessed in 16-bit units
  */
@@ -566,6 +577,16 @@ ao_usb_copy_rx(uint8_t *dst, uint16_t *base, uint16_t bytes)
                *dst = *base;
 }
 
+static uint8_t
+ao_usb_tx_byte(uint16_t *base, uint8_t tx_count, char byte)
+{
+       if (tx_count & 1)
+               base[tx_count >> 1] |= ((uint16_t) byte) << 8;
+       else
+               base[tx_count >> 1] = (uint16_t) (uint8_t) byte;
+       return tx_count + 1;
+}
+
 /* Send an IN data packet */
 static void
 ao_usb_ep0_flush(void)
@@ -655,7 +676,7 @@ ao_usb_ep0_in_start(uint16_t max)
        ao_usb_ep0_flush();
 }
 
-static struct ao_usb_line_coding ao_usb_line_coding = {115200, 0, 0, 8};
+struct ao_usb_line_coding ao_usb_line_coding = {115200, 0, 0, 8};
 
 #if AO_USB_DEVICE_ID_SERIAL
 static uint8_t ao_usb_serial[2 + 48];
@@ -895,7 +916,9 @@ stm_usb_isr(void)
 
                switch (ep) {
                case 0:
+#if USB_STATUS
                        ++control_count;
+#endif
                        if (ao_usb_epr_ctr_rx(epr)) {
                                if (ao_usb_epr_setup(epr))
                                        ao_usb_ep0_receive |= AO_USB_EP0_GOT_SETUP;
@@ -907,7 +930,9 @@ stm_usb_isr(void)
                        ao_usb_ep0_handle(ao_usb_ep0_receive);
                        break;
                case AO_USB_OUT_EPR:
+#if USB_STATUS
                        ++out_count;
+#endif
                        if (ao_usb_epr_ctr_rx(epr)) {
                                _rx_dbg1("RX ISR", epr);
                                ao_usb_out_avail = 1;
@@ -917,7 +942,9 @@ stm_usb_isr(void)
                        }
                        break;
                case AO_USB_IN_EPR:
+#if USB_STATUS
                        ++in_count;
+#endif
                        _tx_dbg1("TX ISR", epr);
                        if (ao_usb_epr_ctr_tx(epr)) {
                                ao_usb_in_pending = 0;
@@ -935,7 +962,9 @@ stm_usb_isr(void)
                        break;
 #endif
                case AO_USB_INT_EPR:
+#if USB_STATUS
                        ++int_count;
+#endif
                        if (ao_usb_epr_ctr_tx(epr))
                                _ao_usb_set_stat_tx(AO_USB_INT_EPR, STM_USB_EPR_STAT_TX_NAK);
                        break;
@@ -944,7 +973,9 @@ stm_usb_isr(void)
        }
 
        if (istr & (1 << STM_USB_ISTR_RESET)) {
+#if USB_STATUS
                ++reset_count;
+#endif
                debug ("\treset\n");
                ao_usb_set_ep0();
        }
@@ -972,10 +1003,10 @@ _ao_usb_in_send(void)
        ao_usb_in_pending = 1;
        if (ao_usb_tx_count != AO_USB_IN_SIZE)
                ao_usb_in_flushed = 1;
-       ao_usb_copy_tx(ao_usb_tx_buffer, ao_usb_in_tx_buffer, ao_usb_tx_count);
-       ao_usb_bdt[AO_USB_IN_EPR].single.addr_tx = ao_usb_in_tx_offset;
+       ao_usb_bdt[AO_USB_IN_EPR].single.addr_tx = ao_usb_in_tx_offset[ao_usb_in_tx_which];
        ao_usb_bdt[AO_USB_IN_EPR].single.count_tx = ao_usb_tx_count;
        ao_usb_tx_count = 0;
+       ao_usb_in_tx_which = 1 - ao_usb_in_tx_which;
        _ao_usb_set_stat_tx(AO_USB_IN_EPR, STM_USB_EPR_STAT_TX_VALID);
        _tx_dbg0("in_send end");
 }
@@ -1029,7 +1060,7 @@ ao_usb_putchar(char c)
        _ao_usb_in_wait();
 
        ao_usb_in_flushed = 0;
-       ao_usb_tx_buffer[ao_usb_tx_count++] = (uint8_t) c;
+       ao_usb_tx_count = ao_usb_tx_byte(ao_usb_in_tx_buffer[ao_usb_in_tx_which], ao_usb_tx_count, c);
 
        /* Send the packet when full */
        if (ao_usb_tx_count == AO_USB_IN_SIZE) {
@@ -1053,10 +1084,10 @@ _ao_usb_in2_send(void)
        ao_usb_in2_pending = 1;
        if (ao_usb_tx2_count != AO_USB_IN_SIZE)
                ao_usb_in2_flushed = 1;
-       ao_usb_copy_tx(ao_usb_tx2_buffer, ao_usb_in2_tx_buffer, ao_usb_tx2_count);
-       ao_usb_bdt[AO_USB_IN2_EPR].single.addr_tx = ao_usb_in_tx_offset;
-       ao_usb_bdt[AO_USB_IN2_EPR].single.count_tx = ao_usb_tx_count;
+       ao_usb_bdt[AO_USB_IN2_EPR].single.addr_tx = ao_usb_in2_tx_offset[ao_usb_in2_tx_which];
+       ao_usb_bdt[AO_USB_IN2_EPR].single.count_tx = ao_usb_tx2_count;
        ao_usb_tx2_count = 0;
+       ao_usb_in2_tx_which = 1 - ao_usb_in2_tx_which;
        _ao_usb_set_stat_tx(AO_USB_IN2_EPR, STM_USB_EPR_STAT_TX_VALID);
        _tx_dbg0("in2_send end");
 }
@@ -1110,7 +1141,7 @@ ao_usb_putchar2(char c)
        _ao_usb_in2_wait();
 
        ao_usb_in2_flushed = 0;
-       ao_usb_tx2_buffer[ao_usb_tx2_count++] = (uint8_t) c;
+       ao_usb_tx2_count = ao_usb_tx_byte(ao_usb_in2_tx_buffer[ao_usb_in2_tx_which], ao_usb_tx2_count, c);
 
        /* Send the packet when full */
        if (ao_usb_tx2_count == AO_USB_IN_SIZE) {
AltOS - the operating system for Altus Metrum products