Skip to content

L
linux
Commit a041d8e4 authored by Arvid Brodin's avatar Arvid Brodin Committed by Greg Kroah-Hartman
Browse files
Options

usb/isp1760: Clean up payload address handling 

Encapsulate payload addresses within qtds.
Signed-off-by: default avatarArvid Brodin <arvid.brodin@enea.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent fd436aee
Hide whitespace changes
Inline Side-by-side
Showing with 95 additions and 111 deletions
drivers/usb/host/isp1760-hcd.c
View file @ a041d8e4
...@@ -85,6 +85,8 @@ struct isp1760_qtd { ...@@ -85,6 +85,8 @@ struct isp1760_qtd {
u8 toggle; u8 toggle;
void *data_buffer; void *data_buffer;
u32 payload_addr;
/* the rest is HCD-private */ /* the rest is HCD-private */
struct list_head qtd_list; struct list_head qtd_list;
struct urb *urb; struct urb *urb;
...@@ -256,54 +258,56 @@ static void ptd_write(void __iomem *base, u32 ptd_offset, u32 slot, ...@@ -256,54 +258,56 @@ static void ptd_write(void __iomem *base, u32 ptd_offset, u32 slot,
/* memory management of the 60kb on the chip from 0x1000 to 0xffff */ /* memory management of the 60kb on the chip from 0x1000 to 0xffff */
static void init_memory(struct isp1760_hcd *priv) static void init_memory(struct isp1760_hcd *priv)
{ {
int i; int i, curr;
u32 payload; u32 payload_addr;
payload = 0x1000; payload_addr = PAYLOAD_OFFSET;
for (i = 0; i < BLOCK_1_NUM; i++) { for (i = 0; i < BLOCK_1_NUM; i++) {
priv->memory_pool[i].start = payload; priv->memory_pool[i].start = payload_addr;
priv->memory_pool[i].size = BLOCK_1_SIZE; priv->memory_pool[i].size = BLOCK_1_SIZE;
priv->memory_pool[i].free = 1; priv->memory_pool[i].free = 1;
payload += priv->memory_pool[i].size; payload_addr += priv->memory_pool[i].size;
} }
curr = i;
for (i = BLOCK_1_NUM; i < BLOCK_1_NUM + BLOCK_2_NUM; i++) { for (i = 0; i < BLOCK_2_NUM; i++) {
priv->memory_pool[i].start = payload; priv->memory_pool[curr + i].start = payload_addr;
priv->memory_pool[i].size = BLOCK_2_SIZE; priv->memory_pool[curr + i].size = BLOCK_2_SIZE;
priv->memory_pool[i].free = 1; priv->memory_pool[curr + i].free = 1;
payload += priv->memory_pool[i].size; payload_addr += priv->memory_pool[curr + i].size;
} }
curr = i;
for (i = BLOCK_1_NUM + BLOCK_2_NUM; i < BLOCKS; i++) { for (i = 0; i < BLOCK_3_NUM; i++) {
priv->memory_pool[i].start = payload; priv->memory_pool[curr + i].start = payload_addr;
priv->memory_pool[i].size = BLOCK_3_SIZE; priv->memory_pool[curr + i].size = BLOCK_3_SIZE;
priv->memory_pool[i].free = 1; priv->memory_pool[curr + i].free = 1;
payload += priv->memory_pool[i].size; payload_addr += priv->memory_pool[curr + i].size;
} }
BUG_ON(payload - priv->memory_pool[i - 1].size > PAYLOAD_SIZE); BUG_ON(payload_addr - priv->memory_pool[0].start > PAYLOAD_AREA_SIZE);
} }
static u32 alloc_mem(struct isp1760_hcd *priv, u32 size) static void alloc_mem(struct isp1760_hcd *priv, struct isp1760_qtd *qtd)
{ {
int i; int i;
if (!size) BUG_ON(qtd->payload_addr);
return ISP1760_NULL_POINTER;
if (!qtd->length)
return;
for (i = 0; i < BLOCKS; i++) { for (i = 0; i < BLOCKS; i++) {
if (priv->memory_pool[i].size >= size && if (priv->memory_pool[i].size >= qtd->length &&
priv->memory_pool[i].free) { priv->memory_pool[i].free) {
priv->memory_pool[i].free = 0; priv->memory_pool[i].free = 0;
return priv->memory_pool[i].start; qtd->payload_addr = priv->memory_pool[i].start;
return;
} }
} }
printk(KERN_ERR "ISP1760 MEM: can not allocate %d bytes of memory\n", printk(KERN_ERR "ISP1760 MEM: can not allocate %lu bytes of memory\n",
size); qtd->length);
printk(KERN_ERR "Current memory map:\n"); printk(KERN_ERR "Current memory map:\n");
for (i = 0; i < BLOCKS; i++) { for (i = 0; i < BLOCKS; i++) {
printk(KERN_ERR "Pool %2d size %4d status: %d\n", printk(KERN_ERR "Pool %2d size %4d status: %d\n",
...@@ -312,28 +316,27 @@ static u32 alloc_mem(struct isp1760_hcd *priv, u32 size) ...@@ -312,28 +316,27 @@ static u32 alloc_mem(struct isp1760_hcd *priv, u32 size)
} }
/* XXX maybe -ENOMEM could be possible */ /* XXX maybe -ENOMEM could be possible */
BUG(); BUG();
return 0; return;
} }
static void free_mem(struct isp1760_hcd *priv, u32 mem) static void free_mem(struct isp1760_hcd *priv, struct isp1760_qtd *qtd)
{ {
int i; int i;
if (mem == ISP1760_NULL_POINTER) if (!qtd->payload_addr)
return; return;
for (i = 0; i < BLOCKS; i++) { for (i = 0; i < BLOCKS; i++) {
if (priv->memory_pool[i].start == mem) { if (priv->memory_pool[i].start == qtd->payload_addr) {
BUG_ON(priv->memory_pool[i].free); BUG_ON(priv->memory_pool[i].free);
priv->memory_pool[i].free = 1; priv->memory_pool[i].free = 1;
return ; qtd->payload_addr = 0;
return;
} }
} }
printk(KERN_ERR "Trying to free not-here-allocated memory :%08x\n", printk(KERN_ERR "%s: Invalid pointer: %08x\n", __func__,
mem); qtd->payload_addr);
BUG(); BUG();
} }
...@@ -596,8 +599,7 @@ static u32 base_to_chip(u32 base) ...@@ -596,8 +599,7 @@ static u32 base_to_chip(u32 base)
} }
static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh, static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh,
struct isp1760_qtd *qtd, struct urb *urb, struct isp1760_qtd *qtd, struct ptd *ptd)
u32 payload, struct ptd *ptd)
{ {
u32 maxpacket; u32 maxpacket;
u32 multi; u32 multi;
...@@ -608,7 +610,8 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh, ...@@ -608,7 +610,8 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh,
memset(ptd, 0, sizeof(*ptd)); memset(ptd, 0, sizeof(*ptd));
/* according to 3.6.2, max packet len can not be > 0x400 */ /* according to 3.6.2, max packet len can not be > 0x400 */
maxpacket = usb_maxpacket(urb->dev, urb->pipe, usb_pipeout(urb->pipe)); maxpacket = usb_maxpacket(qtd->urb->dev, qtd->urb->pipe,
usb_pipeout(qtd->urb->pipe));
multi = 1 + ((maxpacket >> 11) & 0x3); multi = 1 + ((maxpacket >> 11) & 0x3);
maxpacket &= 0x7ff; maxpacket &= 0x7ff;
...@@ -616,33 +619,33 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh, ...@@ -616,33 +619,33 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh,
ptd->dw0 = PTD_VALID; ptd->dw0 = PTD_VALID;
ptd->dw0 |= PTD_LENGTH(qtd->length); ptd->dw0 |= PTD_LENGTH(qtd->length);
ptd->dw0 |= PTD_MAXPACKET(maxpacket); ptd->dw0 |= PTD_MAXPACKET(maxpacket);
ptd->dw0 |= PTD_ENDPOINT(usb_pipeendpoint(urb->pipe)); ptd->dw0 |= PTD_ENDPOINT(usb_pipeendpoint(qtd->urb->pipe));
ptd->dw1 = usb_pipeendpoint(urb->pipe) >> 1;
/* DW1 */ /* DW1 */
ptd->dw1 |= PTD_DEVICE_ADDR(usb_pipedevice(urb->pipe)); ptd->dw1 = usb_pipeendpoint(qtd->urb->pipe) >> 1;
ptd->dw1 |= PTD_DEVICE_ADDR(usb_pipedevice(qtd->urb->pipe));
pid_code = qtd->packet_type; pid_code = qtd->packet_type;
ptd->dw1 |= PTD_PID_TOKEN(pid_code); ptd->dw1 |= PTD_PID_TOKEN(pid_code);
if (usb_pipebulk(urb->pipe)) if (usb_pipebulk(qtd->urb->pipe))
ptd->dw1 |= PTD_TRANS_BULK; ptd->dw1 |= PTD_TRANS_BULK;
else if (usb_pipeint(urb->pipe)) else if (usb_pipeint(qtd->urb->pipe))
ptd->dw1 |= PTD_TRANS_INT; ptd->dw1 |= PTD_TRANS_INT;
if (urb->dev->speed != USB_SPEED_HIGH) { if (qtd->urb->dev->speed != USB_SPEED_HIGH) {
/* split transaction */ /* split transaction */
ptd->dw1 |= PTD_TRANS_SPLIT; ptd->dw1 |= PTD_TRANS_SPLIT;
if (urb->dev->speed == USB_SPEED_LOW) if (qtd->urb->dev->speed == USB_SPEED_LOW)
ptd->dw1 |= PTD_SE_USB_LOSPEED; ptd->dw1 |= PTD_SE_USB_LOSPEED;
ptd->dw1 |= PTD_PORT_NUM(urb->dev->ttport); ptd->dw1 |= PTD_PORT_NUM(qtd->urb->dev->ttport);
ptd->dw1 |= PTD_HUB_NUM(urb->dev->tt->hub->devnum); ptd->dw1 |= PTD_HUB_NUM(qtd->urb->dev->tt->hub->devnum);
/* SE bit for Split INT transfers */ /* SE bit for Split INT transfers */
if (usb_pipeint(urb->pipe) && if (usb_pipeint(qtd->urb->pipe) &&
(urb->dev->speed == USB_SPEED_LOW)) (qtd->urb->dev->speed == USB_SPEED_LOW))
ptd->dw1 |= 2 << 16; ptd->dw1 |= 2 << 16;
ptd->dw3 = 0; ptd->dw3 = 0;
...@@ -650,19 +653,20 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh, ...@@ -650,19 +653,20 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh,
nak = 0; nak = 0;
} else { } else {
ptd->dw0 |= PTD_MULTI(multi); ptd->dw0 |= PTD_MULTI(multi);
if (usb_pipecontrol(urb->pipe) || usb_pipebulk(urb->pipe)) if (usb_pipecontrol(qtd->urb->pipe) ||
usb_pipebulk(qtd->urb->pipe))
ptd->dw3 = qh->ping; ptd->dw3 = qh->ping;
else else
ptd->dw3 = 0; ptd->dw3 = 0;
} }
/* DW2 */ /* DW2 */
ptd->dw2 = 0; ptd->dw2 = 0;
ptd->dw2 |= PTD_DATA_START_ADDR(base_to_chip(payload)); ptd->dw2 |= PTD_DATA_START_ADDR(base_to_chip(qtd->payload_addr));
ptd->dw2 |= PTD_RL_CNT(rl); ptd->dw2 |= PTD_RL_CNT(rl);
ptd->dw3 |= PTD_NAC_CNT(nak); ptd->dw3 |= PTD_NAC_CNT(nak);
/* DW3 */ /* DW3 */
if (usb_pipecontrol(urb->pipe)) if (usb_pipecontrol(qtd->urb->pipe))
ptd->dw3 |= PTD_DATA_TOGGLE(qtd->toggle); ptd->dw3 |= PTD_DATA_TOGGLE(qtd->toggle);
else else
ptd->dw3 |= qh->toggle; ptd->dw3 |= qh->toggle;
...@@ -674,8 +678,7 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh, ...@@ -674,8 +678,7 @@ static void transform_into_atl(struct isp1760_hcd *priv, struct isp1760_qh *qh,
} }
static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh, static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh,
struct isp1760_qtd *qtd, struct urb *urb, struct isp1760_qtd *qtd, struct ptd *ptd)
u32 payload, struct ptd *ptd)
{ {
u32 maxpacket; u32 maxpacket;
u32 multi; u32 multi;
...@@ -684,14 +687,15 @@ static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh, ...@@ -684,14 +687,15 @@ static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh,
u32 usofmask, usof; u32 usofmask, usof;
u32 period; u32 period;
maxpacket = usb_maxpacket(urb->dev, urb->pipe, usb_pipeout(urb->pipe)); maxpacket = usb_maxpacket(qtd->urb->dev, qtd->urb->pipe,
usb_pipeout(qtd->urb->pipe));
multi = 1 + ((maxpacket >> 11) & 0x3); multi = 1 + ((maxpacket >> 11) & 0x3);
maxpacket &= 0x7ff; maxpacket &= 0x7ff;
/* length of the data per uframe */ /* length of the data per uframe */
maxpacket = multi * maxpacket; maxpacket = multi * maxpacket;
numberofusofs = urb->transfer_buffer_length / maxpacket; numberofusofs = qtd->urb->transfer_buffer_length / maxpacket;
if (urb->transfer_buffer_length % maxpacket) if (qtd->urb->transfer_buffer_length % maxpacket)
numberofusofs += 1; numberofusofs += 1;
usofmask = 1; usofmask = 1;
...@@ -701,7 +705,7 @@ static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh, ...@@ -701,7 +705,7 @@ static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh,
usofmask <<= 1; usofmask <<= 1;
} }
if (urb->dev->speed != USB_SPEED_HIGH) { if (qtd->urb->dev->speed != USB_SPEED_HIGH) {
/* split */ /* split */
ptd->dw5 = 0x1c; ptd->dw5 = 0x1c;
...@@ -735,11 +739,10 @@ static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh, ...@@ -735,11 +739,10 @@ static void transform_add_int(struct isp1760_hcd *priv, struct isp1760_qh *qh,
} }
static void transform_into_int(struct isp1760_hcd *priv, struct isp1760_qh *qh, static void transform_into_int(struct isp1760_hcd *priv, struct isp1760_qh *qh,
struct isp1760_qtd *qtd, struct urb *urb, struct isp1760_qtd *qtd, struct ptd *ptd)
u32 payload, struct ptd *ptd)
{ {
transform_into_atl(priv, qh, qtd, urb, payload, ptd); transform_into_atl(priv, qh, qtd, ptd);
transform_add_int(priv, qh, qtd, urb, payload, ptd); transform_add_int(priv, qh, qtd, ptd);
} }
static int qtd_fill(struct isp1760_qtd *qtd, void *databuffer, size_t len, static int qtd_fill(struct isp1760_qtd *qtd, void *databuffer, size_t len,
...@@ -751,8 +754,8 @@ static int qtd_fill(struct isp1760_qtd *qtd, void *databuffer, size_t len, ...@@ -751,8 +754,8 @@ static int qtd_fill(struct isp1760_qtd *qtd, void *databuffer, size_t len,
qtd->packet_type = GET_QTD_TOKEN_TYPE(token); qtd->packet_type = GET_QTD_TOKEN_TYPE(token);
qtd->toggle = GET_DATA_TOGGLE(token); qtd->toggle = GET_DATA_TOGGLE(token);
if (len > HC_ATL_PL_SIZE) if (len > MAX_PAYLOAD_SIZE)
count = HC_ATL_PL_SIZE; count = MAX_PAYLOAD_SIZE;
else else
count = len; count = len;
...@@ -804,60 +807,56 @@ static void check_int_err_status(u32 dw4) ...@@ -804,60 +807,56 @@ static void check_int_err_status(u32 dw4)
} }
} }
static void enqueue_one_qtd(struct isp1760_qtd *qtd, struct isp1760_hcd *priv, static void enqueue_one_qtd(struct isp1760_qtd *qtd, struct isp1760_hcd *priv)
u32 payload)
{ {
u32 token;
struct usb_hcd *hcd = priv_to_hcd(priv); struct usb_hcd *hcd = priv_to_hcd(priv);
token = qtd->packet_type; if (qtd->length && (qtd->length <= MAX_PAYLOAD_SIZE)) {
switch (qtd->packet_type) {
if (qtd->length && (qtd->length <= HC_ATL_PL_SIZE)) {
switch (token) {
case IN_PID: case IN_PID:
break; break;
case OUT_PID: case OUT_PID:
case SETUP_PID: case SETUP_PID:
mem_writes8(hcd->regs, payload, qtd->data_buffer, mem_writes8(hcd->regs, qtd->payload_addr,
qtd->length); qtd->data_buffer, qtd->length);
} }
} }
} }
static void enqueue_one_atl_qtd(u32 payload, static void enqueue_one_atl_qtd(struct isp1760_hcd *priv,
struct isp1760_hcd *priv, struct isp1760_qh *qh, struct isp1760_qh *qh, u32 slot,
struct urb *urb, u32 slot, struct isp1760_qtd *qtd) struct isp1760_qtd *qtd)
{ {
struct ptd ptd; struct ptd ptd;
struct usb_hcd *hcd = priv_to_hcd(priv); struct usb_hcd *hcd = priv_to_hcd(priv);
transform_into_atl(priv, qh, qtd, urb, payload, &ptd); alloc_mem(priv, qtd);
transform_into_atl(priv, qh, qtd, &ptd);
ptd_write(hcd->regs, ATL_PTD_OFFSET, slot, &ptd); ptd_write(hcd->regs, ATL_PTD_OFFSET, slot, &ptd);
enqueue_one_qtd(qtd, priv, payload); enqueue_one_qtd(qtd, priv);
priv->atl_ints[slot].qh = qh; priv->atl_ints[slot].qh = qh;
priv->atl_ints[slot].qtd = qtd; priv->atl_ints[slot].qtd = qtd;
priv->atl_ints[slot].data_buffer = qtd->data_buffer; priv->atl_ints[slot].data_buffer = qtd->data_buffer;
priv->atl_ints[slot].payload = payload;
qtd->status |= URB_ENQUEUED; qtd->status |= URB_ENQUEUED;
qtd->status |= slot << 16; qtd->status |= slot << 16;
} }
static void enqueue_one_int_qtd(u32 payload, static void enqueue_one_int_qtd(struct isp1760_hcd *priv,
struct isp1760_hcd *priv, struct isp1760_qh *qh, struct isp1760_qh *qh, u32 slot,
struct urb *urb, u32 slot, struct isp1760_qtd *qtd) struct isp1760_qtd *qtd)
{ {
struct ptd ptd; struct ptd ptd;
struct usb_hcd *hcd = priv_to_hcd(priv); struct usb_hcd *hcd = priv_to_hcd(priv);
transform_into_int(priv, qh, qtd, urb, payload, &ptd); alloc_mem(priv, qtd);
transform_into_int(priv, qh, qtd, &ptd);
ptd_write(hcd->regs, INT_PTD_OFFSET, slot, &ptd); ptd_write(hcd->regs, INT_PTD_OFFSET, slot, &ptd);
enqueue_one_qtd(qtd, priv, payload); enqueue_one_qtd(qtd, priv);
priv->int_ints[slot].qh = qh; priv->int_ints[slot].qh = qh;
priv->int_ints[slot].qtd = qtd; priv->int_ints[slot].qtd = qtd;
priv->int_ints[slot].data_buffer = qtd->data_buffer; priv->int_ints[slot].data_buffer = qtd->data_buffer;
priv->int_ints[slot].payload = payload;
qtd->status |= URB_ENQUEUED; qtd->status |= URB_ENQUEUED;
qtd->status |= slot << 16; qtd->status |= slot << 16;
} }
...@@ -869,7 +868,6 @@ static void enqueue_an_ATL_packet(struct usb_hcd *hcd, struct isp1760_qh *qh, ...@@ -869,7 +868,6 @@ static void enqueue_an_ATL_packet(struct usb_hcd *hcd, struct isp1760_qh *qh,
u32 skip_map, or_map; u32 skip_map, or_map;
u32 queue_entry; u32 queue_entry;
u32 slot; u32 slot;
u32 payload;
u32 buffstatus; u32 buffstatus;
/* /*
...@@ -886,9 +884,7 @@ static void enqueue_an_ATL_packet(struct usb_hcd *hcd, struct isp1760_qh *qh, ...@@ -886,9 +884,7 @@ static void enqueue_an_ATL_packet(struct usb_hcd *hcd, struct isp1760_qh *qh,
slot = __ffs(skip_map); slot = __ffs(skip_map);
queue_entry = 1 << slot; queue_entry = 1 << slot;
payload = alloc_mem(priv, qtd->length); enqueue_one_atl_qtd(priv, qh, slot, qtd);
enqueue_one_atl_qtd(payload, priv, qh, qtd->urb, slot, qtd);
or_map = reg_read32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG); or_map = reg_read32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG);
or_map |= queue_entry; or_map |= queue_entry;
...@@ -914,7 +910,6 @@ static void enqueue_an_INT_packet(struct usb_hcd *hcd, struct isp1760_qh *qh, ...@@ -914,7 +910,6 @@ static void enqueue_an_INT_packet(struct usb_hcd *hcd, struct isp1760_qh *qh,
u32 skip_map, or_map; u32 skip_map, or_map;
u32 queue_entry; u32 queue_entry;
u32 slot; u32 slot;
u32 payload;
u32 buffstatus; u32 buffstatus;
/* /*
...@@ -931,9 +926,7 @@ static void enqueue_an_INT_packet(struct usb_hcd *hcd, struct isp1760_qh *qh, ...@@ -931,9 +926,7 @@ static void enqueue_an_INT_packet(struct usb_hcd *hcd, struct isp1760_qh *qh,
slot = __ffs(skip_map); slot = __ffs(skip_map);
queue_entry = 1 << slot; queue_entry = 1 << slot;
payload = alloc_mem(priv, qtd->length); enqueue_one_int_qtd(priv, qh, slot, qtd);
enqueue_one_int_qtd(payload, priv, qh, qtd->urb, slot, qtd);
or_map = reg_read32(hcd->regs, HC_INT_IRQ_MASK_OR_REG); or_map = reg_read32(hcd->regs, HC_INT_IRQ_MASK_OR_REG);
or_map |= queue_entry; or_map |= queue_entry;
...@@ -974,6 +967,7 @@ __acquires(priv->lock) ...@@ -974,6 +967,7 @@ __acquires(priv->lock)
static void isp1760_qtd_free(struct isp1760_qtd *qtd) static void isp1760_qtd_free(struct isp1760_qtd *qtd)
{ {
BUG_ON(qtd->payload_addr);
kmem_cache_free(qtd_cachep, qtd); kmem_cache_free(qtd_cachep, qtd);
} }
...@@ -1029,7 +1023,6 @@ static void do_atl_int(struct usb_hcd *hcd) ...@@ -1029,7 +1023,6 @@ static void do_atl_int(struct usb_hcd *hcd)
struct ptd ptd; struct ptd ptd;
struct urb *urb = NULL; struct urb *urb = NULL;
u32 queue_entry; u32 queue_entry;
u32 payload;
u32 length; u32 length;
u32 or_map; u32 or_map;
u32 status = -EINVAL; u32 status = -EINVAL;
...@@ -1057,7 +1050,6 @@ static void do_atl_int(struct usb_hcd *hcd) ...@@ -1057,7 +1050,6 @@ static void do_atl_int(struct usb_hcd *hcd)
qtd = priv->atl_ints[queue_entry].qtd; qtd = priv->atl_ints[queue_entry].qtd;
urb = qtd->urb; urb = qtd->urb;
qh = priv->atl_ints[queue_entry].qh; qh = priv->atl_ints[queue_entry].qh;
payload = priv->atl_ints[queue_entry].payload;
if (!qh) { if (!qh) {
printk(KERN_ERR "qh is 0\n"); printk(KERN_ERR "qh is 0\n");
...@@ -1154,7 +1146,7 @@ static void do_atl_int(struct usb_hcd *hcd) ...@@ -1154,7 +1146,7 @@ static void do_atl_int(struct usb_hcd *hcd)
if (length) { if (length) {
switch (DW1_GET_PID(ptd.dw1)) { switch (DW1_GET_PID(ptd.dw1)) {
case IN_PID: case IN_PID:
mem_reads8(hcd->regs, payload, mem_reads8(hcd->regs, qtd->payload_addr,
priv->atl_ints[queue_entry].data_buffer, priv->atl_ints[queue_entry].data_buffer,
length); length);
...@@ -1171,7 +1163,7 @@ static void do_atl_int(struct usb_hcd *hcd) ...@@ -1171,7 +1163,7 @@ static void do_atl_int(struct usb_hcd *hcd)
priv->atl_ints[queue_entry].qtd = NULL; priv->atl_ints[queue_entry].qtd = NULL;
priv->atl_ints[queue_entry].qh = NULL; priv->atl_ints[queue_entry].qh = NULL;
free_mem(priv, payload); free_mem(priv, qtd);
reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, skip_map); reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, skip_map);
...@@ -1230,7 +1222,6 @@ static void do_intl_int(struct usb_hcd *hcd) ...@@ -1230,7 +1222,6 @@ static void do_intl_int(struct usb_hcd *hcd)
u32 done_map, skip_map; u32 done_map, skip_map;
struct ptd ptd; struct ptd ptd;
struct urb *urb = NULL; struct urb *urb = NULL;
u32 payload;
u32 length; u32 length;
u32 or_map; u32 or_map;
int error; int error;
...@@ -1253,7 +1244,6 @@ static void do_intl_int(struct usb_hcd *hcd) ...@@ -1253,7 +1244,6 @@ static void do_intl_int(struct usb_hcd *hcd)
qtd = priv->int_ints[queue_entry].qtd; qtd = priv->int_ints[queue_entry].qtd;
urb = qtd->urb; urb = qtd->urb;
qh = priv->int_ints[queue_entry].qh; qh = priv->int_ints[queue_entry].qh;
payload = priv->int_ints[queue_entry].payload;
if (!qh) { if (!qh) {
printk(KERN_ERR "(INT) qh is 0\n"); printk(KERN_ERR "(INT) qh is 0\n");
...@@ -1292,7 +1282,7 @@ static void do_intl_int(struct usb_hcd *hcd) ...@@ -1292,7 +1282,7 @@ static void do_intl_int(struct usb_hcd *hcd)
if (length) { if (length) {
switch (DW1_GET_PID(ptd.dw1)) { switch (DW1_GET_PID(ptd.dw1)) {
case IN_PID: case IN_PID:
mem_reads8(hcd->regs, payload, mem_reads8(hcd->regs, qtd->payload_addr,
priv->int_ints[queue_entry].data_buffer, priv->int_ints[queue_entry].data_buffer,
length); length);
case OUT_PID: case OUT_PID:
...@@ -1309,7 +1299,7 @@ static void do_intl_int(struct usb_hcd *hcd) ...@@ -1309,7 +1299,7 @@ static void do_intl_int(struct usb_hcd *hcd)
priv->int_ints[queue_entry].qh = NULL; priv->int_ints[queue_entry].qh = NULL;
reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, skip_map); reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, skip_map);
free_mem(priv, payload); free_mem(priv, qtd);
if (urb->status == -EPIPE) { if (urb->status == -EPIPE) {
/* HALT received */ /* HALT received */
...@@ -1704,14 +1694,13 @@ static int isp1760_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, ...@@ -1704,14 +1694,13 @@ static int isp1760_urb_dequeue(struct usb_hcd *hcd, struct urb *urb,
qtd = ints->qtd; qtd = ints->qtd;
qh = ints[i].qh; qh = ints[i].qh;
qtd = clean_up_qtdlist(qtd, qh);
free_mem(priv, ints->payload); free_mem(priv, qtd);
qtd = clean_up_qtdlist(qtd, qh);
ints->qh = NULL; ints->qh = NULL;
ints->qtd = NULL; ints->qtd = NULL;
ints->data_buffer = NULL; ints->data_buffer = NULL;
ints->payload = 0;
isp1760_urb_done(priv, urb, status); isp1760_urb_done(priv, urb, status);
if (qtd) if (qtd)
......
drivers/usb/host/isp1760-hcd.h
View file @ a041d8e4
...@@ -108,7 +108,6 @@ struct ptd { ...@@ -108,7 +108,6 @@ struct ptd {
struct inter_packet_info { struct inter_packet_info {
void *data_buffer; void *data_buffer;
u32 payload;
#define PTD_FIRE_NEXT (1 << 0) #define PTD_FIRE_NEXT (1 << 0)
#define PTD_URB_FINISHED (1 << 1) #define PTD_URB_FINISHED (1 << 1)
struct isp1760_qh *qh; struct isp1760_qh *qh;
...@@ -164,10 +163,8 @@ struct memory_chunk { ...@@ -164,10 +163,8 @@ struct memory_chunk {
#define BLOCK_2_SIZE 1024 #define BLOCK_2_SIZE 1024
#define BLOCK_3_SIZE 8192 #define BLOCK_3_SIZE 8192
#define BLOCKS (BLOCK_1_NUM + BLOCK_2_NUM + BLOCK_3_NUM) #define BLOCKS (BLOCK_1_NUM + BLOCK_2_NUM + BLOCK_3_NUM)
#define PAYLOAD_SIZE 0xf000 #define MAX_PAYLOAD_SIZE BLOCK_3_SIZE
#define PAYLOAD_AREA_SIZE 0xf000
/* I saw if some reloads if the pointer was negative */
#define ISP1760_NULL_POINTER (0x400)
/* ATL */ /* ATL */
/* DW0 */ /* DW0 */
...@@ -221,6 +218,4 @@ struct memory_chunk { ...@@ -221,6 +218,4 @@ struct memory_chunk {
#define NAK_COUNTER (0) #define NAK_COUNTER (0)
#define ERR_COUNTER (2) #define ERR_COUNTER (2)
#define HC_ATL_PL_SIZE (8192)
#endif #endif
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7