static int send_status_packet(struct r8a66597 *r8a66597, unsigned long pipe) { r8a66597_bset(r8a66597, SQSET, DCPCTR); r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR); if (usb_pipein(pipe)) { r8a66597_bset(r8a66597, R8A66597_DIR, DCPCFG); r8a66597_mdfy(r8a66597, ISEL, ISEL | CURPIPE, CFIFOSEL); r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0); r8a66597_write(r8a66597, ~BEMP0, BEMPSTS); r8a66597_write(r8a66597, BCLR | BVAL, CFIFOCTR); } else { r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG); r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL); r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0); r8a66597_write(r8a66597, BCLR, CFIFOCTR); } r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR); while (!(r8a66597_read(r8a66597, BEMPSTS) & 0x0001)) if (ctrlc()) return -1; return 0; }
/* this function must be called with interrupt disabled */ static inline void cfifo_change(struct r8a66597 *r8a66597, u16 pipenum) { unsigned short mbw = mbw_value(r8a66597); r8a66597_mdfy(r8a66597, mbw | pipenum, mbw | CURPIPE, CFIFOSEL); r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, pipenum); }
static int receive_control_packet(struct r8a66597 *r8a66597, struct usb_device *dev, void *buffer, int transfer_len) { u16 tmp; int rcv_len; /* FIXME: limit transfer size : 64byte or less */ r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG); r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL); r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0); r8a66597_bset(r8a66597, SQSET, DCPCTR); r8a66597_write(r8a66597, BCLR, CFIFOCTR); r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR); while (!(r8a66597_read(r8a66597, BRDYSTS) & 0x0001)) if (ctrlc()) return -1; r8a66597_write(r8a66597, ~0x0001, BRDYSTS); r8a66597_mdfy(r8a66597, MBW, MBW | CURPIPE, CFIFOSEL); r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0); tmp = r8a66597_read(r8a66597, CFIFOCTR); if ((tmp & FRDY) == 0) { printf("%s FRDY is not set. (%x)\n", __func__, tmp); return -1; } rcv_len = tmp & DTLN; dev->act_len += rcv_len; r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR); if (buffer) { if (rcv_len == 0) r8a66597_write(r8a66597, BCLR, DCPCTR); else r8a66597_read_fifo(r8a66597, CFIFO, buffer, rcv_len); } return 0; }
static int receive_bulk_packet(struct r8a66597 *r8a66597, struct usb_device *dev, unsigned long pipe, void *buffer, int transfer_len) { u16 tmp; u16 *buf; const u16 pipenum = BULK_IN_PIPENUM; int rcv_len; int maxpacket = dev->epmaxpacketin[usb_pipeendpoint(pipe)]; R8A66597_DPRINT("%s\n", __func__); /* prepare */ if (dev->act_len == 0) { r8a66597_mdfy(r8a66597, PID_NAK, PID, get_pipectr_addr(pipenum)); r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS); r8a66597_write(r8a66597, TRCLR, get_pipetre_addr(pipenum)); r8a66597_write(r8a66597, (transfer_len + maxpacket - 1) / maxpacket, get_pipetrn_addr(pipenum)); r8a66597_bset(r8a66597, TRENB, get_pipetre_addr(pipenum)); r8a66597_mdfy(r8a66597, PID_BUF, PID, get_pipectr_addr(pipenum)); } r8a66597_mdfy(r8a66597, MBW | pipenum, MBW | CURPIPE, CFIFOSEL); r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, pipenum); while (!(r8a66597_read(r8a66597, BRDYSTS) & (1 << pipenum))) if (ctrlc()) return -1; r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS); tmp = r8a66597_read(r8a66597, CFIFOCTR); if ((tmp & FRDY) == 0) { printf("%s FRDY is not set. (%x)\n", __func__, tmp); return -1; } buf = (u16 *)(buffer + dev->act_len); rcv_len = tmp & DTLN; dev->act_len += rcv_len; if (buffer) { if (rcv_len == 0) r8a66597_write(r8a66597, BCLR, CFIFOCTR); else r8a66597_read_fifo(r8a66597, CFIFO, buf, rcv_len); } return 0; }
/* this function must be called with interrupt disabled */ static void pipe_stop(struct r8a66597 *r8a66597, struct r8a66597_pipe *pipe) { u16 tmp; tmp = r8a66597_read(r8a66597, pipe->pipectr) & PID; if ((tmp & PID_STALL11) != PID_STALL11) /* force stall? */ r8a66597_mdfy(r8a66597, PID_STALL, PID, pipe->pipectr); r8a66597_mdfy(r8a66597, PID_NAK, PID, pipe->pipectr); r8a66597_reg_wait(r8a66597, pipe->pipectr, PBUSY, 0); }
/* this function must be called with interrupt disabled */ static inline void fifo_change_from_pipe(struct r8a66597 *r8a66597, struct r8a66597_pipe *pipe) { unsigned short mbw = mbw_value(r8a66597); cfifo_change(r8a66597, 0); r8a66597_mdfy(r8a66597, mbw | 0, mbw | CURPIPE, D0FIFOSEL); r8a66597_mdfy(r8a66597, mbw | 0, mbw | CURPIPE, D1FIFOSEL); r8a66597_mdfy(r8a66597, mbw | pipe->info.pipenum, mbw | CURPIPE, pipe->fifosel); r8a66597_reg_wait(r8a66597, pipe->fifosel, CURPIPE, pipe->info.pipenum); }
static int send_bulk_packet(struct r8a66597 *r8a66597, struct usb_device *dev, unsigned long pipe, void *buffer, int transfer_len) { u16 tmp, bufsize; u16 *buf; size_t size; R8A66597_DPRINT("%s\n", __func__); r8a66597_mdfy(r8a66597, MBW | BULK_OUT_PIPENUM, MBW | CURPIPE, CFIFOSEL); r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, BULK_OUT_PIPENUM); tmp = r8a66597_read(r8a66597, CFIFOCTR); if ((tmp & FRDY) == 0) { printf("%s FRDY is not set (%x)\n", __func__, tmp); return -1; } /* prepare parameters */ bufsize = dev->epmaxpacketout[usb_pipeendpoint(pipe)]; buf = (u16 *)(buffer + dev->act_len); size = min((int)bufsize, transfer_len - dev->act_len); /* write fifo */ r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS); if (buffer) { r8a66597_write_fifo(r8a66597, CFIFO, buf, size); r8a66597_write(r8a66597, BVAL, CFIFOCTR); } /* update parameters */ dev->act_len += size; r8a66597_mdfy(r8a66597, PID_BUF, PID, get_pipectr_addr(BULK_OUT_PIPENUM)); while (!(r8a66597_read(r8a66597, BEMPSTS) & (1 << BULK_OUT_PIPENUM))) if (ctrlc()) return -1; r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS); if (dev->act_len >= transfer_len) r8a66597_mdfy(r8a66597, PID_NAK, PID, get_pipectr_addr(BULK_OUT_PIPENUM)); return 0; }
/* this function must be called with interrupt disabled */ static void enable_r8a66597_pipe_dma(struct r8a66597 *r8a66597, struct r8a66597_device *dev, struct r8a66597_pipe *pipe, struct urb *urb) { int i; struct r8a66597_pipe_info *info = &pipe->info; unsigned short mbw = mbw_value(r8a66597); /* pipe dma is only for external controlles */ if (r8a66597->pdata->on_chip) return; if ((pipe->info.pipenum != 0) && (info->type != R8A66597_INT)) { for (i = 0; i < R8A66597_MAX_DMA_CHANNEL; i++) { if ((r8a66597->dma_map & (1 << i)) != 0) continue; dev_info(&dev->udev->dev, "address %d, EndpointAddress 0x%02x use " "DMA FIFO\n", usb_pipedevice(urb->pipe), info->dir_in ? USB_ENDPOINT_DIR_MASK + info->epnum : info->epnum); r8a66597->dma_map |= 1 << i; dev->dma_map |= 1 << i; set_pipe_reg_addr(pipe, i); cfifo_change(r8a66597, 0); r8a66597_mdfy(r8a66597, mbw | pipe->info.pipenum, mbw | CURPIPE, pipe->fifosel); r8a66597_reg_wait(r8a66597, pipe->fifosel, CURPIPE, pipe->info.pipenum); r8a66597_bset(r8a66597, BCLR, pipe->fifoctr); break; } } }