Commit dfad2b17 authored by Dmitry Torokhov's avatar Dmitry Torokhov

Input: iforce - use DMA-safe buffores for USB transfers

USB transport has to use cache line-aligned buffers for transfers to avoid
DMA issues; serio doe snot have such restrictions. Let's move "data_in"
buffer from main driver structure into transport modules and make sure USB
requirements are respected.
Tested-by: default avatarTim Schumacher <timschumi@gmx.de>
Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent 6ac0aec6
...@@ -33,6 +33,7 @@ struct iforce_serio { ...@@ -33,6 +33,7 @@ struct iforce_serio {
u8 expect_packet; u8 expect_packet;
u8 cmd_response[IFORCE_MAX_LENGTH]; u8 cmd_response[IFORCE_MAX_LENGTH];
u8 cmd_response_len; u8 cmd_response_len;
u8 data_in[IFORCE_MAX_LENGTH];
}; };
static void iforce_serio_xmit(struct iforce *iforce) static void iforce_serio_xmit(struct iforce *iforce)
...@@ -169,7 +170,7 @@ static irqreturn_t iforce_serio_irq(struct serio *serio, ...@@ -169,7 +170,7 @@ static irqreturn_t iforce_serio_irq(struct serio *serio,
} }
if (iforce_serio->idx < iforce_serio->len) { if (iforce_serio->idx < iforce_serio->len) {
iforce->data[iforce_serio->idx++] = data; iforce_serio->data_in[iforce_serio->idx++] = data;
iforce_serio->csum += data; iforce_serio->csum += data;
goto out; goto out;
} }
...@@ -178,15 +179,16 @@ static irqreturn_t iforce_serio_irq(struct serio *serio, ...@@ -178,15 +179,16 @@ static irqreturn_t iforce_serio_irq(struct serio *serio,
/* Handle command completion */ /* Handle command completion */
if (iforce_serio->expect_packet == iforce_serio->id) { if (iforce_serio->expect_packet == iforce_serio->id) {
iforce_serio->expect_packet = 0; iforce_serio->expect_packet = 0;
memcpy(iforce_serio->cmd_response, iforce->data, memcpy(iforce_serio->cmd_response,
IFORCE_MAX_LENGTH); iforce_serio->data_in, IFORCE_MAX_LENGTH);
iforce_serio->cmd_response_len = iforce_serio->len; iforce_serio->cmd_response_len = iforce_serio->len;
/* Signal that command is done */ /* Signal that command is done */
wake_up(&iforce->wait); wake_up(&iforce->wait);
} else if (likely(iforce->type)) { } else if (likely(iforce->type)) {
iforce_process_packet(iforce, iforce_serio->id, iforce_process_packet(iforce, iforce_serio->id,
iforce->data, iforce_serio->len); iforce_serio->data_in,
iforce_serio->len);
} }
iforce_serio->pkt = 0; iforce_serio->pkt = 0;
......
...@@ -30,6 +30,9 @@ struct iforce_usb { ...@@ -30,6 +30,9 @@ struct iforce_usb {
struct usb_device *usbdev; struct usb_device *usbdev;
struct usb_interface *intf; struct usb_interface *intf;
struct urb *irq, *out; struct urb *irq, *out;
u8 data_in[IFORCE_MAX_LENGTH] ____cacheline_aligned;
u8 data_out[IFORCE_MAX_LENGTH] ____cacheline_aligned;
}; };
static void __iforce_usb_xmit(struct iforce *iforce) static void __iforce_usb_xmit(struct iforce *iforce)
...@@ -171,8 +174,8 @@ static void iforce_usb_irq(struct urb *urb) ...@@ -171,8 +174,8 @@ static void iforce_usb_irq(struct urb *urb)
goto exit; goto exit;
} }
iforce_process_packet(iforce, iforce->data[0], iforce_process_packet(iforce, iforce_usb->data_in[0],
iforce->data + 1, urb->actual_length - 1); iforce_usb->data_in + 1, urb->actual_length - 1);
exit: exit:
status = usb_submit_urb(urb, GFP_ATOMIC); status = usb_submit_urb(urb, GFP_ATOMIC);
...@@ -216,13 +219,16 @@ static int iforce_usb_probe(struct usb_interface *intf, ...@@ -216,13 +219,16 @@ static int iforce_usb_probe(struct usb_interface *intf,
epirq = &interface->endpoint[0].desc; epirq = &interface->endpoint[0].desc;
epout = &interface->endpoint[1].desc; epout = &interface->endpoint[1].desc;
if (!(iforce_usb = kzalloc(sizeof(*iforce_usb) + 32, GFP_KERNEL))) iforce_usb = kzalloc(sizeof(*iforce_usb), GFP_KERNEL);
if (!iforce_usb)
goto fail; goto fail;
if (!(iforce_usb->irq = usb_alloc_urb(0, GFP_KERNEL))) iforce_usb->irq = usb_alloc_urb(0, GFP_KERNEL);
if (!iforce_usb->irq)
goto fail; goto fail;
if (!(iforce_usb->out = usb_alloc_urb(0, GFP_KERNEL))) iforce_usb->out = usb_alloc_urb(0, GFP_KERNEL);
if (!iforce_usb->out)
goto fail; goto fail;
iforce = &iforce_usb->iforce; iforce = &iforce_usb->iforce;
...@@ -233,11 +239,15 @@ static int iforce_usb_probe(struct usb_interface *intf, ...@@ -233,11 +239,15 @@ static int iforce_usb_probe(struct usb_interface *intf,
iforce_usb->usbdev = dev; iforce_usb->usbdev = dev;
iforce_usb->intf = intf; iforce_usb->intf = intf;
usb_fill_int_urb(iforce_usb->irq, dev, usb_rcvintpipe(dev, epirq->bEndpointAddress), usb_fill_int_urb(iforce_usb->irq, dev,
iforce->data, 16, iforce_usb_irq, iforce_usb, epirq->bInterval); usb_rcvintpipe(dev, epirq->bEndpointAddress),
iforce_usb->data_in, sizeof(iforce_usb->data_in),
iforce_usb_irq, iforce_usb, epirq->bInterval);
usb_fill_int_urb(iforce_usb->out, dev, usb_sndintpipe(dev, epout->bEndpointAddress), usb_fill_int_urb(iforce_usb->out, dev,
iforce_usb + 1, 32, iforce_usb_out, iforce_usb, epout->bInterval); usb_sndintpipe(dev, epout->bEndpointAddress),
iforce_usb->data_out, sizeof(iforce_usb->data_out),
iforce_usb_out, iforce_usb, epout->bInterval);
err = iforce_init_device(&intf->dev, BUS_USB, iforce); err = iforce_init_device(&intf->dev, BUS_USB, iforce);
if (err) if (err)
......
...@@ -107,8 +107,6 @@ struct iforce { ...@@ -107,8 +107,6 @@ struct iforce {
const struct iforce_xport_ops *xport_ops; const struct iforce_xport_ops *xport_ops;
int bus; int bus;
unsigned char data[IFORCE_MAX_LENGTH];
spinlock_t xmit_lock; spinlock_t xmit_lock;
/* Buffer used for asynchronous sending of bytes to the device */ /* Buffer used for asynchronous sending of bytes to the device */
struct circ_buf xmit; struct circ_buf xmit;
......
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