89 lines
2.9 KiB
C
89 lines
2.9 KiB
C
/******************************************************************************
|
|
* The MIT License
|
|
*
|
|
* Copyright (c) 2011 LeafLabs, LLC.
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person
|
|
* obtaining a copy of this software and associated documentation
|
|
* files (the "Software"), to deal in the Software without
|
|
* restriction, including without limitation the rights to use, copy,
|
|
* modify, merge, publish, distribute, sublicense, and/or sell copies
|
|
* of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be
|
|
* included in all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*****************************************************************************/
|
|
|
|
#include "usb_reg_map.h"
|
|
|
|
/* TODO these could use some improvement; they're fairly
|
|
* straightforward ports of the analogous ST code. The PMA blit
|
|
* routines in particular are obvious targets for performance
|
|
* measurement and tuning. */
|
|
|
|
void usb_copy_to_pma(const uint8 *buf, uint16 len, uint16 pma_offset) {
|
|
uint16 *dst = (uint16*)usb_pma_ptr(pma_offset);
|
|
uint16 n = len >> 1;
|
|
uint16 i;
|
|
for (i = 0; i < n; i++) {
|
|
*dst = (uint16)(*buf) | *(buf + 1) << 8;
|
|
buf += 2;
|
|
dst += 2;
|
|
}
|
|
if (len & 1) {
|
|
*dst = *buf;
|
|
}
|
|
}
|
|
|
|
void usb_copy_from_pma(uint8 *buf, uint16 len, uint16 pma_offset) {
|
|
uint32 *src = (uint32*)usb_pma_ptr(pma_offset);
|
|
uint16 *dst = (uint16*)buf;
|
|
uint16 n = len >> 1;
|
|
uint16 i;
|
|
for (i = 0; i < n; i++) {
|
|
*dst++ = *src++;
|
|
}
|
|
if (len & 1) {
|
|
*dst = *src & 0xFF;
|
|
}
|
|
}
|
|
|
|
static void usb_set_ep_rx_count_common(uint32 *rxc, uint16 count) {
|
|
uint16 nblocks;
|
|
if (count > 62) {
|
|
/* use 32-byte memory block size */
|
|
nblocks = count >> 5;
|
|
if ((count & 0x1F) == 0) {
|
|
nblocks--;
|
|
}
|
|
*rxc = (nblocks << 10) | 0x8000;
|
|
} else {
|
|
/* use 2-byte memory block size */
|
|
nblocks = count >> 1;
|
|
if ((count & 0x1) != 0) {
|
|
nblocks++;
|
|
}
|
|
*rxc = nblocks << 10;
|
|
}
|
|
}
|
|
|
|
void usb_set_ep_rx_buf0_count(uint8 ep, uint16 count) {
|
|
uint32 *rxc = usb_ep_rx_buf0_count_ptr(ep);
|
|
usb_set_ep_rx_count_common(rxc, count);
|
|
}
|
|
|
|
void usb_set_ep_rx_count(uint8 ep, uint16 count) {
|
|
uint32 *rxc = usb_ep_rx_count_ptr(ep);
|
|
usb_set_ep_rx_count_common(rxc, count);
|
|
}
|