/*
* support more than 64 bytes command on ep4
*/
void usb_reg_out_patch(void)
{
uint16_t usbfifolen;
uint16_t ii;
uint32_t ep4_data;
static volatile uint32_t *regaddr;
static uint16_t cmd_len;
static VBUF *buf;
BOOLEAN cmd_is_last = FALSE;
static BOOLEAN cmd_is_new = TRUE;
/* get the size of this transcation */
usbfifolen = USB_BYTE_REG_READ(ZM_EP4_BYTE_COUNT_LOW_OFFSET);
if (usbfifolen > USB_EP4_MAX_PKT_SIZE) {
A_PRINTF("EP4 FIFO Bug? Buffer is too big: %x\n", usbfifolen);
cold_reboot();
}
/* check is command is new */
if(cmd_is_new) {
buf = usbFifoConf.get_command_buf();
cmd_len = 0;
if(!buf) {
A_PRINTF("%s: Filed to get new buffer.\n", __func__);
goto err;
}
/* copy free, assignment buffer of the address */
regaddr = (uint32_t *)buf->desc_list->buf_addr;
cmd_is_new = FALSE;
}
/* just in case, suppose should not happen */
if(!buf)
goto err;
/* if size is smaller, this is the last command!
* zero-length supposed should be set through 0x27/bit7->0x19/bit4, not here
*/
if(usbfifolen < USB_EP4_MAX_PKT_SIZE)
cmd_is_last = TRUE;
/* accumulate the size */
cmd_len += usbfifolen;
if (cmd_len > buf->desc_list->buf_size) {
A_PRINTF("%s: Data length on EP4 FIFO is bigger as "
"allocated buffer data! Drop it!\n", __func__);
goto err;
}
/* round it to alignment */
if(usbfifolen % 4)
usbfifolen = (usbfifolen >> 2) + 1;
else
/*
* -- support more than 64 bytes command on ep4 --
*/
void vUsb_Reg_Out_patch(void)
{
uint16_t usbfifolen;
uint16_t ii;
uint32_t ep4_data;
static volatile uint32_t *regaddr;
static uint16_t cmdLen;
static VBUF *buf;
BOOLEAN cmd_is_last = FALSE;
static BOOLEAN cmd_is_new = TRUE;
// get the size of this transcation
usbfifolen = USB_BYTE_REG_READ(ZM_EP4_BYTE_COUNT_LOW_OFFSET);
// check is command is new
if( cmd_is_new ){
buf = usbFifoConf.get_command_buf();
cmdLen = 0;
if( !buf )
goto ERR;
// copy free, assignment buffer of the address
regaddr = (uint32_t *)buf->desc_list->buf_addr;
cmd_is_new = FALSE;
}
// just in case, suppose should not happen
if( !buf )
goto ERR;
// if size is smaller, this is the last command!
// zero-length supposed should be set through 0x27/bit7->0x19/bit4, not here
if( usbfifolen<64 ) {
cmd_is_last = TRUE;
}
// accumulate the size
cmdLen += usbfifolen;
// round it to alignment
if(usbfifolen % 4)
usbfifolen = (usbfifolen >> 2) + 1;
else
/*
* support more than 64 bytes command on ep3
*/
void usb_status_in_patch(void)
{
uint16_t count;
uint16_t remainder;
uint16_t reg_buf_len;
static uint16_t buf_len;
static VBUF *evntbuf = NULL;
static volatile uint32_t *regaddr;
static BOOLEAN cmd_is_new = TRUE;
BOOLEAN cmd_end = FALSE;
if (cmd_is_new) {
evntbuf = usbFifoConf.get_event_buf();
if (evntbuf != NULL) {
regaddr = (uint32_t *)VBUF_GET_DATA_ADDR(evntbuf);
buf_len = evntbuf->buf_length;
} else {
mUSB_STATUS_IN_INT_DISABLE();
return;
}
cmd_is_new = FALSE;
}
if (buf_len > USB_EP3_MAX_PKT_SIZE) {
reg_buf_len = USB_EP3_MAX_PKT_SIZE;
buf_len -= USB_EP3_MAX_PKT_SIZE;
}
/* TODO: 64 bytes...
* controller supposed will take care of zero-length? */
else {
reg_buf_len = buf_len;
cmd_end = TRUE;
}
/* INT use EP3 */
for (count = 0; count < (reg_buf_len / 4); count++)
{
USB_WORD_REG_WRITE(ZM_EP3_DATA_OFFSET, *regaddr);
regaddr++;
}
remainder = reg_buf_len % 4;
if (remainder) {
switch(remainder) {
case 3:
USB_WORD_REG_WRITE(ZM_CBUS_FIFO_SIZE_OFFSET, 0x7);
break;
case 2:
USB_WORD_REG_WRITE(ZM_CBUS_FIFO_SIZE_OFFSET, 0x3);
break;
case 1:
USB_WORD_REG_WRITE(ZM_CBUS_FIFO_SIZE_OFFSET, 0x1);
break;
}
USB_WORD_REG_WRITE(ZM_EP3_DATA_OFFSET, *regaddr);
/* Restore CBus FIFO size to word size */
USB_WORD_REG_WRITE(ZM_CBUS_FIFO_SIZE_OFFSET, 0xF);
}
mUSB_EP3_XFER_DONE();
if (evntbuf != NULL && cmd_end) {
usbFifoConf.send_event_done(evntbuf);
cmd_is_new = TRUE;
}
}
