|
@@ -81,25 +81,25 @@ static void gigaset_disconnect(struct usb_interface *interface);
|
|
/*==============================================================================*/
|
|
/*==============================================================================*/
|
|
|
|
|
|
struct bas_cardstate {
|
|
struct bas_cardstate {
|
|
- struct usb_device *udev; /* USB device pointer */
|
|
|
|
- struct usb_interface *interface; /* interface for this device */
|
|
|
|
|
|
+ struct usb_device *udev; /* USB device pointer */
|
|
|
|
+ struct usb_interface *interface; /* interface for this device */
|
|
unsigned char minor; /* starting minor number */
|
|
unsigned char minor; /* starting minor number */
|
|
|
|
|
|
- struct urb *urb_ctrl; /* control pipe default URB */
|
|
|
|
|
|
+ struct urb *urb_ctrl; /* control pipe default URB */
|
|
struct usb_ctrlrequest dr_ctrl;
|
|
struct usb_ctrlrequest dr_ctrl;
|
|
struct timer_list timer_ctrl; /* control request timeout */
|
|
struct timer_list timer_ctrl; /* control request timeout */
|
|
|
|
|
|
struct timer_list timer_atrdy; /* AT command ready timeout */
|
|
struct timer_list timer_atrdy; /* AT command ready timeout */
|
|
- struct urb *urb_cmd_out; /* for sending AT commands */
|
|
|
|
|
|
+ struct urb *urb_cmd_out; /* for sending AT commands */
|
|
struct usb_ctrlrequest dr_cmd_out;
|
|
struct usb_ctrlrequest dr_cmd_out;
|
|
int retry_cmd_out;
|
|
int retry_cmd_out;
|
|
|
|
|
|
- struct urb *urb_cmd_in; /* for receiving AT replies */
|
|
|
|
|
|
+ struct urb *urb_cmd_in; /* for receiving AT replies */
|
|
struct usb_ctrlrequest dr_cmd_in;
|
|
struct usb_ctrlrequest dr_cmd_in;
|
|
struct timer_list timer_cmd_in; /* receive request timeout */
|
|
struct timer_list timer_cmd_in; /* receive request timeout */
|
|
- unsigned char *rcvbuf; /* AT reply receive buffer */
|
|
|
|
|
|
+ unsigned char *rcvbuf; /* AT reply receive buffer */
|
|
|
|
|
|
- struct urb *urb_int_in; /* URB for interrupt pipe */
|
|
|
|
|
|
+ struct urb *urb_int_in; /* URB for interrupt pipe */
|
|
unsigned char int_in_buf[3];
|
|
unsigned char int_in_buf[3];
|
|
|
|
|
|
spinlock_t lock; /* locks all following */
|
|
spinlock_t lock; /* locks all following */
|
|
@@ -201,54 +201,55 @@ static inline char *usb_pipetype_str(int pipe)
|
|
* write content of URB to syslog for debugging
|
|
* write content of URB to syslog for debugging
|
|
*/
|
|
*/
|
|
static inline void dump_urb(enum debuglevel level, const char *tag,
|
|
static inline void dump_urb(enum debuglevel level, const char *tag,
|
|
- struct urb *urb)
|
|
|
|
|
|
+ struct urb *urb)
|
|
{
|
|
{
|
|
#ifdef CONFIG_GIGASET_DEBUG
|
|
#ifdef CONFIG_GIGASET_DEBUG
|
|
int i;
|
|
int i;
|
|
IFNULLRET(tag);
|
|
IFNULLRET(tag);
|
|
- dbg(level, "%s urb(0x%08lx)->{", tag, (unsigned long) urb);
|
|
|
|
|
|
+ gig_dbg(level, "%s urb(0x%08lx)->{", tag, (unsigned long) urb);
|
|
if (urb) {
|
|
if (urb) {
|
|
- dbg(level,
|
|
|
|
- " dev=0x%08lx, pipe=%s:EP%d/DV%d:%s, "
|
|
|
|
- "status=%d, hcpriv=0x%08lx, transfer_flags=0x%x,",
|
|
|
|
- (unsigned long) urb->dev,
|
|
|
|
- usb_pipetype_str(urb->pipe),
|
|
|
|
- usb_pipeendpoint(urb->pipe), usb_pipedevice(urb->pipe),
|
|
|
|
- usb_pipein(urb->pipe) ? "in" : "out",
|
|
|
|
- urb->status, (unsigned long) urb->hcpriv,
|
|
|
|
- urb->transfer_flags);
|
|
|
|
- dbg(level,
|
|
|
|
- " transfer_buffer=0x%08lx[%d], actual_length=%d, "
|
|
|
|
- "bandwidth=%d, setup_packet=0x%08lx,",
|
|
|
|
- (unsigned long) urb->transfer_buffer,
|
|
|
|
- urb->transfer_buffer_length, urb->actual_length,
|
|
|
|
- urb->bandwidth, (unsigned long) urb->setup_packet);
|
|
|
|
- dbg(level,
|
|
|
|
- " start_frame=%d, number_of_packets=%d, interval=%d, "
|
|
|
|
- "error_count=%d,",
|
|
|
|
- urb->start_frame, urb->number_of_packets, urb->interval,
|
|
|
|
- urb->error_count);
|
|
|
|
- dbg(level,
|
|
|
|
- " context=0x%08lx, complete=0x%08lx, iso_frame_desc[]={",
|
|
|
|
- (unsigned long) urb->context,
|
|
|
|
- (unsigned long) urb->complete);
|
|
|
|
|
|
+ gig_dbg(level,
|
|
|
|
+ " dev=0x%08lx, pipe=%s:EP%d/DV%d:%s, "
|
|
|
|
+ "status=%d, hcpriv=0x%08lx, transfer_flags=0x%x,",
|
|
|
|
+ (unsigned long) urb->dev,
|
|
|
|
+ usb_pipetype_str(urb->pipe),
|
|
|
|
+ usb_pipeendpoint(urb->pipe), usb_pipedevice(urb->pipe),
|
|
|
|
+ usb_pipein(urb->pipe) ? "in" : "out",
|
|
|
|
+ urb->status, (unsigned long) urb->hcpriv,
|
|
|
|
+ urb->transfer_flags);
|
|
|
|
+ gig_dbg(level,
|
|
|
|
+ " transfer_buffer=0x%08lx[%d], actual_length=%d, "
|
|
|
|
+ "bandwidth=%d, setup_packet=0x%08lx,",
|
|
|
|
+ (unsigned long) urb->transfer_buffer,
|
|
|
|
+ urb->transfer_buffer_length, urb->actual_length,
|
|
|
|
+ urb->bandwidth, (unsigned long) urb->setup_packet);
|
|
|
|
+ gig_dbg(level,
|
|
|
|
+ " start_frame=%d, number_of_packets=%d, interval=%d, "
|
|
|
|
+ "error_count=%d,",
|
|
|
|
+ urb->start_frame, urb->number_of_packets, urb->interval,
|
|
|
|
+ urb->error_count);
|
|
|
|
+ gig_dbg(level,
|
|
|
|
+ " context=0x%08lx, complete=0x%08lx, "
|
|
|
|
+ "iso_frame_desc[]={",
|
|
|
|
+ (unsigned long) urb->context,
|
|
|
|
+ (unsigned long) urb->complete);
|
|
for (i = 0; i < urb->number_of_packets; i++) {
|
|
for (i = 0; i < urb->number_of_packets; i++) {
|
|
struct usb_iso_packet_descriptor *pifd
|
|
struct usb_iso_packet_descriptor *pifd
|
|
= &urb->iso_frame_desc[i];
|
|
= &urb->iso_frame_desc[i];
|
|
- dbg(level,
|
|
|
|
- " {offset=%u, length=%u, actual_length=%u, "
|
|
|
|
- "status=%u}",
|
|
|
|
- pifd->offset, pifd->length, pifd->actual_length,
|
|
|
|
- pifd->status);
|
|
|
|
|
|
+ gig_dbg(level,
|
|
|
|
+ " {offset=%u, length=%u, actual_length=%u, "
|
|
|
|
+ "status=%u}",
|
|
|
|
+ pifd->offset, pifd->length, pifd->actual_length,
|
|
|
|
+ pifd->status);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
- dbg(level, "}}");
|
|
|
|
|
|
+ gig_dbg(level, "}}");
|
|
#endif
|
|
#endif
|
|
}
|
|
}
|
|
|
|
|
|
/* read/set modem control bits etc. (m10x only) */
|
|
/* read/set modem control bits etc. (m10x only) */
|
|
static int gigaset_set_modem_ctrl(struct cardstate *cs, unsigned old_state,
|
|
static int gigaset_set_modem_ctrl(struct cardstate *cs, unsigned old_state,
|
|
- unsigned new_state)
|
|
|
|
|
|
+ unsigned new_state)
|
|
{
|
|
{
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
@@ -274,8 +275,8 @@ static inline void error_hangup(struct bc_state *bcs)
|
|
{
|
|
{
|
|
struct cardstate *cs = bcs->cs;
|
|
struct cardstate *cs = bcs->cs;
|
|
|
|
|
|
- dbg(DEBUG_ANY,
|
|
|
|
- "%s: scheduling HUP for channel %d", __func__, bcs->channel);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ANY, "%s: scheduling HUP for channel %d",
|
|
|
|
+ __func__, bcs->channel);
|
|
|
|
|
|
if (!gigaset_add_event(cs, &bcs->at_state, EV_HUP, NULL, 0, NULL)) {
|
|
if (!gigaset_add_event(cs, &bcs->at_state, EV_HUP, NULL, 0, NULL)) {
|
|
//FIXME what should we do?
|
|
//FIXME what should we do?
|
|
@@ -295,21 +296,20 @@ static inline void error_hangup(struct bc_state *bcs)
|
|
static inline void error_reset(struct cardstate *cs)
|
|
static inline void error_reset(struct cardstate *cs)
|
|
{
|
|
{
|
|
//FIXME try to recover without bothering the user
|
|
//FIXME try to recover without bothering the user
|
|
- err("unrecoverable error - please disconnect the Gigaset base to reset");
|
|
|
|
|
|
+ dev_err(cs->dev,
|
|
|
|
+ "unrecoverable error - please disconnect Gigaset base to reset\n");
|
|
}
|
|
}
|
|
|
|
|
|
/* check_pending
|
|
/* check_pending
|
|
* check for completion of pending control request
|
|
* check for completion of pending control request
|
|
* parameter:
|
|
* parameter:
|
|
- * urb USB request block of completed request
|
|
|
|
- * urb->context = hardware specific controller state structure
|
|
|
|
|
|
+ * ucs hardware specific controller state structure
|
|
*/
|
|
*/
|
|
static void check_pending(struct bas_cardstate *ucs)
|
|
static void check_pending(struct bas_cardstate *ucs)
|
|
{
|
|
{
|
|
unsigned long flags;
|
|
unsigned long flags;
|
|
|
|
|
|
IFNULLRET(ucs);
|
|
IFNULLRET(ucs);
|
|
- IFNULLRET(cardstate);
|
|
|
|
|
|
|
|
spin_lock_irqsave(&ucs->lock, flags);
|
|
spin_lock_irqsave(&ucs->lock, flags);
|
|
switch (ucs->pending) {
|
|
switch (ucs->pending) {
|
|
@@ -330,8 +330,6 @@ static void check_pending(struct bas_cardstate *ucs)
|
|
case HD_CLOSE_ATCHANNEL:
|
|
case HD_CLOSE_ATCHANNEL:
|
|
if (!(atomic_read(&ucs->basstate) & BS_ATOPEN))
|
|
if (!(atomic_read(&ucs->basstate) & BS_ATOPEN))
|
|
ucs->pending = 0;
|
|
ucs->pending = 0;
|
|
- //wake_up_interruptible(cs->initwait);
|
|
|
|
- //FIXME need own wait queue?
|
|
|
|
break;
|
|
break;
|
|
case HD_CLOSE_B1CHANNEL:
|
|
case HD_CLOSE_B1CHANNEL:
|
|
if (!(atomic_read(&ucs->basstate) & BS_B1OPEN))
|
|
if (!(atomic_read(&ucs->basstate) & BS_B1OPEN))
|
|
@@ -348,7 +346,9 @@ static void check_pending(struct bas_cardstate *ucs)
|
|
* are handled separately and should never end up here
|
|
* are handled separately and should never end up here
|
|
*/
|
|
*/
|
|
default:
|
|
default:
|
|
- warn("unknown pending request 0x%02x cleared", ucs->pending);
|
|
|
|
|
|
+ dev_warn(&ucs->interface->dev,
|
|
|
|
+ "unknown pending request 0x%02x cleared\n",
|
|
|
|
+ ucs->pending);
|
|
ucs->pending = 0;
|
|
ucs->pending = 0;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -374,19 +374,19 @@ static void cmd_in_timeout(unsigned long data)
|
|
IFNULLRET(ucs);
|
|
IFNULLRET(ucs);
|
|
|
|
|
|
spin_lock_irqsave(&cs->lock, flags);
|
|
spin_lock_irqsave(&cs->lock, flags);
|
|
- if (!atomic_read(&cs->connected)) {
|
|
|
|
- dbg(DEBUG_USBREQ, "%s: disconnected", __func__);
|
|
|
|
|
|
+ if (unlikely(!atomic_read(&cs->connected))) {
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "%s: disconnected", __func__);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
if (!ucs->rcvbuf_size) {
|
|
if (!ucs->rcvbuf_size) {
|
|
- dbg(DEBUG_USBREQ, "%s: no receive in progress", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "%s: no receive in progress", __func__);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
|
|
|
|
- err("timeout reading AT response");
|
|
|
|
|
|
+ dev_err(cs->dev, "timeout reading AT response\n");
|
|
error_reset(cs); //FIXME retry?
|
|
error_reset(cs); //FIXME retry?
|
|
}
|
|
}
|
|
|
|
|
|
@@ -414,10 +414,12 @@ static int atread_submit(struct cardstate *cs, int timeout)
|
|
IFNULLRETVAL(ucs, -EINVAL);
|
|
IFNULLRETVAL(ucs, -EINVAL);
|
|
IFNULLRETVAL(ucs->urb_cmd_in, -EINVAL);
|
|
IFNULLRETVAL(ucs->urb_cmd_in, -EINVAL);
|
|
|
|
|
|
- dbg(DEBUG_USBREQ, "-------> HD_READ_ATMESSAGE (%d)", ucs->rcvbuf_size);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "-------> HD_READ_ATMESSAGE (%d)",
|
|
|
|
+ ucs->rcvbuf_size);
|
|
|
|
|
|
if (ucs->urb_cmd_in->status == -EINPROGRESS) {
|
|
if (ucs->urb_cmd_in->status == -EINPROGRESS) {
|
|
- err("could not submit HD_READ_ATMESSAGE: URB busy");
|
|
|
|
|
|
+ dev_err(cs->dev,
|
|
|
|
+ "could not submit HD_READ_ATMESSAGE: URB busy\n");
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -427,19 +429,19 @@ static int atread_submit(struct cardstate *cs, int timeout)
|
|
ucs->dr_cmd_in.wIndex = 0;
|
|
ucs->dr_cmd_in.wIndex = 0;
|
|
ucs->dr_cmd_in.wLength = cpu_to_le16(ucs->rcvbuf_size);
|
|
ucs->dr_cmd_in.wLength = cpu_to_le16(ucs->rcvbuf_size);
|
|
usb_fill_control_urb(ucs->urb_cmd_in, ucs->udev,
|
|
usb_fill_control_urb(ucs->urb_cmd_in, ucs->udev,
|
|
- usb_rcvctrlpipe(ucs->udev, 0),
|
|
|
|
- (unsigned char*) & ucs->dr_cmd_in,
|
|
|
|
- ucs->rcvbuf, ucs->rcvbuf_size,
|
|
|
|
- read_ctrl_callback, cs->inbuf);
|
|
|
|
|
|
+ usb_rcvctrlpipe(ucs->udev, 0),
|
|
|
|
+ (unsigned char*) & ucs->dr_cmd_in,
|
|
|
|
+ ucs->rcvbuf, ucs->rcvbuf_size,
|
|
|
|
+ read_ctrl_callback, cs->inbuf);
|
|
|
|
|
|
if ((ret = usb_submit_urb(ucs->urb_cmd_in, SLAB_ATOMIC)) != 0) {
|
|
if ((ret = usb_submit_urb(ucs->urb_cmd_in, SLAB_ATOMIC)) != 0) {
|
|
- err("could not submit HD_READ_ATMESSAGE: %s",
|
|
|
|
- get_usb_statmsg(ret));
|
|
|
|
|
|
+ dev_err(cs->dev, "could not submit HD_READ_ATMESSAGE: %s\n",
|
|
|
|
+ get_usb_statmsg(ret));
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
if (timeout > 0) {
|
|
if (timeout > 0) {
|
|
- dbg(DEBUG_USBREQ, "setting timeout of %d/10 secs", timeout);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "setting timeout of %d/10 secs", timeout);
|
|
ucs->timer_cmd_in.expires = jiffies + timeout * HZ / 10;
|
|
ucs->timer_cmd_in.expires = jiffies + timeout * HZ / 10;
|
|
ucs->timer_cmd_in.data = (unsigned long) cs;
|
|
ucs->timer_cmd_in.data = (unsigned long) cs;
|
|
ucs->timer_cmd_in.function = cmd_in_timeout;
|
|
ucs->timer_cmd_in.function = cmd_in_timeout;
|
|
@@ -503,11 +505,12 @@ static void read_int_callback(struct urb *urb, struct pt_regs *regs)
|
|
case -ECONNRESET: /* canceled (async) */
|
|
case -ECONNRESET: /* canceled (async) */
|
|
case -EINPROGRESS: /* pending */
|
|
case -EINPROGRESS: /* pending */
|
|
/* ignore silently */
|
|
/* ignore silently */
|
|
- dbg(DEBUG_USBREQ,
|
|
|
|
- "%s: %s", __func__, get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "%s: %s",
|
|
|
|
+ __func__, get_usb_statmsg(urb->status));
|
|
return;
|
|
return;
|
|
default: /* severe trouble */
|
|
default: /* severe trouble */
|
|
- warn("interrupt read: %s", get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ dev_warn(cs->dev, "interrupt read: %s\n",
|
|
|
|
+ get_usb_statmsg(urb->status));
|
|
//FIXME corrective action? resubmission always ok?
|
|
//FIXME corrective action? resubmission always ok?
|
|
goto resubmit;
|
|
goto resubmit;
|
|
}
|
|
}
|
|
@@ -515,10 +518,9 @@ static void read_int_callback(struct urb *urb, struct pt_regs *regs)
|
|
l = (unsigned) ucs->int_in_buf[1] +
|
|
l = (unsigned) ucs->int_in_buf[1] +
|
|
(((unsigned) ucs->int_in_buf[2]) << 8);
|
|
(((unsigned) ucs->int_in_buf[2]) << 8);
|
|
|
|
|
|
- dbg(DEBUG_USBREQ,
|
|
|
|
- "<-------%d: 0x%02x (%u [0x%02x 0x%02x])", urb->actual_length,
|
|
|
|
- (int)ucs->int_in_buf[0], l,
|
|
|
|
- (int)ucs->int_in_buf[1], (int)ucs->int_in_buf[2]);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "<-------%d: 0x%02x (%u [0x%02x 0x%02x])",
|
|
|
|
+ urb->actual_length, (int)ucs->int_in_buf[0], l,
|
|
|
|
+ (int)ucs->int_in_buf[1], (int)ucs->int_in_buf[2]);
|
|
|
|
|
|
channel = 0;
|
|
channel = 0;
|
|
|
|
|
|
@@ -564,28 +566,30 @@ static void read_int_callback(struct urb *urb, struct pt_regs *regs)
|
|
case HD_B1_FLOW_CONTROL:
|
|
case HD_B1_FLOW_CONTROL:
|
|
bcs = cs->bcs + channel;
|
|
bcs = cs->bcs + channel;
|
|
atomic_add((l - BAS_NORMFRAME) * BAS_CORRFRAMES,
|
|
atomic_add((l - BAS_NORMFRAME) * BAS_CORRFRAMES,
|
|
- &bcs->hw.bas->corrbytes);
|
|
|
|
- dbg(DEBUG_ISO,
|
|
|
|
- "Flow control (channel %d, sub %d): 0x%02x => %d",
|
|
|
|
- channel, bcs->hw.bas->numsub, l,
|
|
|
|
- atomic_read(&bcs->hw.bas->corrbytes));
|
|
|
|
|
|
+ &bcs->hw.bas->corrbytes);
|
|
|
|
+ gig_dbg(DEBUG_ISO,
|
|
|
|
+ "Flow control (channel %d, sub %d): 0x%02x => %d",
|
|
|
|
+ channel, bcs->hw.bas->numsub, l,
|
|
|
|
+ atomic_read(&bcs->hw.bas->corrbytes));
|
|
break;
|
|
break;
|
|
|
|
|
|
case HD_RECEIVEATDATA_ACK: /* AT response ready to be received */
|
|
case HD_RECEIVEATDATA_ACK: /* AT response ready to be received */
|
|
if (!l) {
|
|
if (!l) {
|
|
- warn("HD_RECEIVEATDATA_ACK with length 0 ignored");
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "HD_RECEIVEATDATA_ACK with length 0 ignored\n");
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
spin_lock_irqsave(&cs->lock, flags);
|
|
spin_lock_irqsave(&cs->lock, flags);
|
|
if (ucs->rcvbuf_size) {
|
|
if (ucs->rcvbuf_size) {
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
- err("receive AT data overrun, %d bytes lost", l);
|
|
|
|
|
|
+ dev_err(cs->dev,
|
|
|
|
+ "receive AT data overrun, %d bytes lost\n", l);
|
|
error_reset(cs); //FIXME reschedule
|
|
error_reset(cs); //FIXME reschedule
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
if ((ucs->rcvbuf = kmalloc(l, GFP_ATOMIC)) == NULL) {
|
|
if ((ucs->rcvbuf = kmalloc(l, GFP_ATOMIC)) == NULL) {
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
- err("%s: out of memory, %d bytes lost", __func__, l);
|
|
|
|
|
|
+ dev_err(cs->dev, "out of memory, %d bytes lost\n", l);
|
|
error_reset(cs); //FIXME reschedule
|
|
error_reset(cs); //FIXME reschedule
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
@@ -601,16 +605,17 @@ static void read_int_callback(struct urb *urb, struct pt_regs *regs)
|
|
break;
|
|
break;
|
|
|
|
|
|
case HD_RESET_INTERRUPT_PIPE_ACK:
|
|
case HD_RESET_INTERRUPT_PIPE_ACK:
|
|
- dbg(DEBUG_USBREQ, "HD_RESET_INTERRUPT_PIPE_ACK");
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "HD_RESET_INTERRUPT_PIPE_ACK");
|
|
break;
|
|
break;
|
|
|
|
|
|
case HD_SUSPEND_END:
|
|
case HD_SUSPEND_END:
|
|
- dbg(DEBUG_USBREQ, "HD_SUSPEND_END");
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "HD_SUSPEND_END");
|
|
break;
|
|
break;
|
|
|
|
|
|
default:
|
|
default:
|
|
- warn("unknown Gigaset signal 0x%02x (%u) ignored",
|
|
|
|
- (int) ucs->int_in_buf[0], l);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "unknown Gigaset signal 0x%02x (%u) ignored\n",
|
|
|
|
+ (int) ucs->int_in_buf[0], l);
|
|
}
|
|
}
|
|
|
|
|
|
check_pending(ucs);
|
|
check_pending(ucs);
|
|
@@ -618,8 +623,8 @@ static void read_int_callback(struct urb *urb, struct pt_regs *regs)
|
|
resubmit:
|
|
resubmit:
|
|
status = usb_submit_urb(urb, SLAB_ATOMIC);
|
|
status = usb_submit_urb(urb, SLAB_ATOMIC);
|
|
if (unlikely(status)) {
|
|
if (unlikely(status)) {
|
|
- err("could not resubmit interrupt URB: %s",
|
|
|
|
- get_usb_statmsg(status));
|
|
|
|
|
|
+ dev_err(cs->dev, "could not resubmit interrupt URB: %s\n",
|
|
|
|
+ get_usb_statmsg(status));
|
|
error_reset(cs);
|
|
error_reset(cs);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -649,14 +654,14 @@ static void read_ctrl_callback(struct urb *urb, struct pt_regs *regs)
|
|
IFNULLRET(ucs);
|
|
IFNULLRET(ucs);
|
|
|
|
|
|
spin_lock_irqsave(&cs->lock, flags);
|
|
spin_lock_irqsave(&cs->lock, flags);
|
|
- if (!atomic_read(&cs->connected)) {
|
|
|
|
|
|
+ if (unlikely(!atomic_read(&cs->connected))) {
|
|
warn("%s: disconnected", __func__);
|
|
warn("%s: disconnected", __func__);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
|
|
|
|
if (!ucs->rcvbuf_size) {
|
|
if (!ucs->rcvbuf_size) {
|
|
- warn("%s: no receive in progress", __func__);
|
|
|
|
|
|
+ dev_warn(cs->dev, "%s: no receive in progress\n", __func__);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
@@ -667,12 +672,14 @@ static void read_ctrl_callback(struct urb *urb, struct pt_regs *regs)
|
|
case 0: /* normal completion */
|
|
case 0: /* normal completion */
|
|
numbytes = urb->actual_length;
|
|
numbytes = urb->actual_length;
|
|
if (unlikely(numbytes == 0)) {
|
|
if (unlikely(numbytes == 0)) {
|
|
- warn("control read: empty block received");
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "control read: empty block received\n");
|
|
goto retry;
|
|
goto retry;
|
|
}
|
|
}
|
|
if (unlikely(numbytes != ucs->rcvbuf_size)) {
|
|
if (unlikely(numbytes != ucs->rcvbuf_size)) {
|
|
- warn("control read: received %d chars, expected %d",
|
|
|
|
- numbytes, ucs->rcvbuf_size);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "control read: received %d chars, expected %d\n",
|
|
|
|
+ numbytes, ucs->rcvbuf_size);
|
|
if (numbytes > ucs->rcvbuf_size)
|
|
if (numbytes > ucs->rcvbuf_size)
|
|
numbytes = ucs->rcvbuf_size;
|
|
numbytes = ucs->rcvbuf_size;
|
|
}
|
|
}
|
|
@@ -692,23 +699,26 @@ static void read_ctrl_callback(struct urb *urb, struct pt_regs *regs)
|
|
case -ECONNRESET: /* canceled (async) */
|
|
case -ECONNRESET: /* canceled (async) */
|
|
case -EINPROGRESS: /* pending */
|
|
case -EINPROGRESS: /* pending */
|
|
/* no action necessary */
|
|
/* no action necessary */
|
|
- dbg(DEBUG_USBREQ,
|
|
|
|
- "%s: %s", __func__, get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "%s: %s",
|
|
|
|
+ __func__, get_usb_statmsg(urb->status));
|
|
break;
|
|
break;
|
|
|
|
|
|
default: /* severe trouble */
|
|
default: /* severe trouble */
|
|
- warn("control read: %s", get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ dev_warn(cs->dev, "control read: %s\n",
|
|
|
|
+ get_usb_statmsg(urb->status));
|
|
retry:
|
|
retry:
|
|
if (ucs->retry_cmd_in++ < BAS_RETRY) {
|
|
if (ucs->retry_cmd_in++ < BAS_RETRY) {
|
|
- notice("control read: retry %d", ucs->retry_cmd_in);
|
|
|
|
|
|
+ dev_notice(cs->dev, "control read: retry %d\n",
|
|
|
|
+ ucs->retry_cmd_in);
|
|
if (atread_submit(cs, BAS_TIMEOUT) >= 0) {
|
|
if (atread_submit(cs, BAS_TIMEOUT) >= 0) {
|
|
/* resubmitted - bypass regular exit block */
|
|
/* resubmitted - bypass regular exit block */
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
} else {
|
|
} else {
|
|
- err("control read: giving up after %d tries",
|
|
|
|
- ucs->retry_cmd_in);
|
|
|
|
|
|
+ dev_err(cs->dev,
|
|
|
|
+ "control read: giving up after %d tries\n",
|
|
|
|
+ ucs->retry_cmd_in);
|
|
}
|
|
}
|
|
error_reset(cs);
|
|
error_reset(cs);
|
|
}
|
|
}
|
|
@@ -718,7 +728,7 @@ static void read_ctrl_callback(struct urb *urb, struct pt_regs *regs)
|
|
ucs->rcvbuf_size = 0;
|
|
ucs->rcvbuf_size = 0;
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
spin_unlock_irqrestore(&cs->lock, flags);
|
|
if (have_data) {
|
|
if (have_data) {
|
|
- dbg(DEBUG_INTR, "%s-->BH", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_INTR, "%s-->BH", __func__);
|
|
gigaset_schedule_event(cs);
|
|
gigaset_schedule_event(cs);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -743,9 +753,9 @@ static void read_iso_callback(struct urb *urb, struct pt_regs *regs)
|
|
|
|
|
|
/* status codes not worth bothering the tasklet with */
|
|
/* status codes not worth bothering the tasklet with */
|
|
if (unlikely(urb->status == -ENOENT || urb->status == -ECONNRESET ||
|
|
if (unlikely(urb->status == -ENOENT || urb->status == -ECONNRESET ||
|
|
- urb->status == -EINPROGRESS)) {
|
|
|
|
- dbg(DEBUG_ISO,
|
|
|
|
- "%s: %s", __func__, get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ urb->status == -EINPROGRESS)) {
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: %s",
|
|
|
|
+ __func__, get_usb_statmsg(urb->status));
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -771,15 +781,17 @@ static void read_iso_callback(struct urb *urb, struct pt_regs *regs)
|
|
urb->iso_frame_desc[i].actual_length = 0;
|
|
urb->iso_frame_desc[i].actual_length = 0;
|
|
}
|
|
}
|
|
if (likely(atomic_read(&ubc->running))) {
|
|
if (likely(atomic_read(&ubc->running))) {
|
|
- urb->dev = bcs->cs->hw.bas->udev; /* clobbered by USB subsystem */
|
|
|
|
|
|
+ /* urb->dev is clobbered by USB subsystem */
|
|
|
|
+ urb->dev = bcs->cs->hw.bas->udev;
|
|
urb->transfer_flags = URB_ISO_ASAP;
|
|
urb->transfer_flags = URB_ISO_ASAP;
|
|
urb->number_of_packets = BAS_NUMFRAMES;
|
|
urb->number_of_packets = BAS_NUMFRAMES;
|
|
- dbg(DEBUG_ISO, "%s: isoc read overrun/resubmit",
|
|
|
|
- __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: isoc read overrun/resubmit",
|
|
|
|
+ __func__);
|
|
rc = usb_submit_urb(urb, SLAB_ATOMIC);
|
|
rc = usb_submit_urb(urb, SLAB_ATOMIC);
|
|
if (unlikely(rc != 0)) {
|
|
if (unlikely(rc != 0)) {
|
|
- err("could not resubmit isochronous read URB: %s",
|
|
|
|
- get_usb_statmsg(rc));
|
|
|
|
|
|
+ dev_err(bcs->cs->dev,
|
|
|
|
+ "could not resubmit isochronous read "
|
|
|
|
+ "URB: %s\n", get_usb_statmsg(rc));
|
|
dump_urb(DEBUG_ISO, "isoc read", urb);
|
|
dump_urb(DEBUG_ISO, "isoc read", urb);
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
}
|
|
}
|
|
@@ -807,9 +819,9 @@ static void write_iso_callback(struct urb *urb, struct pt_regs *regs)
|
|
|
|
|
|
/* status codes not worth bothering the tasklet with */
|
|
/* status codes not worth bothering the tasklet with */
|
|
if (unlikely(urb->status == -ENOENT || urb->status == -ECONNRESET ||
|
|
if (unlikely(urb->status == -ENOENT || urb->status == -ECONNRESET ||
|
|
- urb->status == -EINPROGRESS)) {
|
|
|
|
- dbg(DEBUG_ISO,
|
|
|
|
- "%s: %s", __func__, get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ urb->status == -EINPROGRESS)) {
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: %s",
|
|
|
|
+ __func__, get_usb_statmsg(urb->status));
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -854,7 +866,7 @@ static int starturbs(struct bc_state *bcs)
|
|
for (k = 0; k < BAS_INURBS; k++) {
|
|
for (k = 0; k < BAS_INURBS; k++) {
|
|
urb = ubc->isoinurbs[k];
|
|
urb = ubc->isoinurbs[k];
|
|
if (!urb) {
|
|
if (!urb) {
|
|
- err("isoinurbs[%d]==NULL", k);
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "isoinurbs[%d]==NULL\n", k);
|
|
rc = -EFAULT;
|
|
rc = -EFAULT;
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
@@ -877,8 +889,9 @@ static int starturbs(struct bc_state *bcs)
|
|
|
|
|
|
dump_urb(DEBUG_ISO, "Initial isoc read", urb);
|
|
dump_urb(DEBUG_ISO, "Initial isoc read", urb);
|
|
if ((rc = usb_submit_urb(urb, SLAB_ATOMIC)) != 0) {
|
|
if ((rc = usb_submit_urb(urb, SLAB_ATOMIC)) != 0) {
|
|
- err("could not submit isochronous read URB %d: %s",
|
|
|
|
- k, get_usb_statmsg(rc));
|
|
|
|
|
|
+ dev_err(bcs->cs->dev,
|
|
|
|
+ "could not submit isochronous read URB %d: %s\n",
|
|
|
|
+ k, get_usb_statmsg(rc));
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -890,7 +903,7 @@ static int starturbs(struct bc_state *bcs)
|
|
for (k = 0; k < BAS_OUTURBS; ++k) {
|
|
for (k = 0; k < BAS_OUTURBS; ++k) {
|
|
urb = ubc->isoouturbs[k].urb;
|
|
urb = ubc->isoouturbs[k].urb;
|
|
if (!urb) {
|
|
if (!urb) {
|
|
- err("isoouturbs[%d].urb==NULL", k);
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "isoouturbs[%d].urb==NULL\n", k);
|
|
rc = -EFAULT;
|
|
rc = -EFAULT;
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
@@ -917,8 +930,9 @@ static int starturbs(struct bc_state *bcs)
|
|
dump_urb(DEBUG_ISO, "Initial isoc write", urb);
|
|
dump_urb(DEBUG_ISO, "Initial isoc write", urb);
|
|
rc = usb_submit_urb(ubc->isoouturbs[k].urb, SLAB_ATOMIC);
|
|
rc = usb_submit_urb(ubc->isoouturbs[k].urb, SLAB_ATOMIC);
|
|
if (rc != 0) {
|
|
if (rc != 0) {
|
|
- err("could not submit isochronous write URB %d: %s",
|
|
|
|
- k, get_usb_statmsg(rc));
|
|
|
|
|
|
+ dev_err(bcs->cs->dev,
|
|
|
|
+ "could not submit isochronous write URB %d: %s\n",
|
|
|
|
+ k, get_usb_statmsg(rc));
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -947,14 +961,16 @@ static void stopurbs(struct bas_bc_state *ubc)
|
|
|
|
|
|
for (k = 0; k < BAS_INURBS; ++k) {
|
|
for (k = 0; k < BAS_INURBS; ++k) {
|
|
rc = usb_unlink_urb(ubc->isoinurbs[k]);
|
|
rc = usb_unlink_urb(ubc->isoinurbs[k]);
|
|
- dbg(DEBUG_ISO, "%s: isoc input URB %d unlinked, result = %d",
|
|
|
|
- __func__, k, rc);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO,
|
|
|
|
+ "%s: isoc input URB %d unlinked, result = %d",
|
|
|
|
+ __func__, k, rc);
|
|
}
|
|
}
|
|
|
|
|
|
for (k = 0; k < BAS_OUTURBS; ++k) {
|
|
for (k = 0; k < BAS_OUTURBS; ++k) {
|
|
rc = usb_unlink_urb(ubc->isoouturbs[k].urb);
|
|
rc = usb_unlink_urb(ubc->isoouturbs[k].urb);
|
|
- dbg(DEBUG_ISO, "%s: isoc output URB %d unlinked, result = %d",
|
|
|
|
- __func__, k, rc);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO,
|
|
|
|
+ "%s: isoc output URB %d unlinked, result = %d",
|
|
|
|
+ __func__, k, rc);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
@@ -984,7 +1000,8 @@ static int submit_iso_write_urb(struct isow_urbctx_t *ucx)
|
|
ubc = ucx->bcs->hw.bas;
|
|
ubc = ucx->bcs->hw.bas;
|
|
IFNULLRETVAL(ubc, -EFAULT);
|
|
IFNULLRETVAL(ubc, -EFAULT);
|
|
|
|
|
|
- urb->dev = ucx->bcs->cs->hw.bas->udev; /* clobbered by USB subsystem */
|
|
|
|
|
|
+ /* urb->dev is clobbered by USB subsystem */
|
|
|
|
+ urb->dev = ucx->bcs->cs->hw.bas->udev;
|
|
urb->transfer_flags = URB_ISO_ASAP;
|
|
urb->transfer_flags = URB_ISO_ASAP;
|
|
urb->transfer_buffer = ubc->isooutbuf->data;
|
|
urb->transfer_buffer = ubc->isooutbuf->data;
|
|
urb->transfer_buffer_length = sizeof(ubc->isooutbuf->data);
|
|
urb->transfer_buffer_length = sizeof(ubc->isooutbuf->data);
|
|
@@ -995,7 +1012,8 @@ static int submit_iso_write_urb(struct isow_urbctx_t *ucx)
|
|
/* compute frame length according to flow control */
|
|
/* compute frame length according to flow control */
|
|
ifd->length = BAS_NORMFRAME;
|
|
ifd->length = BAS_NORMFRAME;
|
|
if ((corrbytes = atomic_read(&ubc->corrbytes)) != 0) {
|
|
if ((corrbytes = atomic_read(&ubc->corrbytes)) != 0) {
|
|
- dbg(DEBUG_ISO, "%s: corrbytes=%d", __func__, corrbytes);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: corrbytes=%d",
|
|
|
|
+ __func__, corrbytes);
|
|
if (corrbytes > BAS_HIGHFRAME - BAS_NORMFRAME)
|
|
if (corrbytes > BAS_HIGHFRAME - BAS_NORMFRAME)
|
|
corrbytes = BAS_HIGHFRAME - BAS_NORMFRAME;
|
|
corrbytes = BAS_HIGHFRAME - BAS_NORMFRAME;
|
|
else if (corrbytes < BAS_LOWFRAME - BAS_NORMFRAME)
|
|
else if (corrbytes < BAS_LOWFRAME - BAS_NORMFRAME)
|
|
@@ -1003,19 +1021,21 @@ static int submit_iso_write_urb(struct isow_urbctx_t *ucx)
|
|
ifd->length += corrbytes;
|
|
ifd->length += corrbytes;
|
|
atomic_add(-corrbytes, &ubc->corrbytes);
|
|
atomic_add(-corrbytes, &ubc->corrbytes);
|
|
}
|
|
}
|
|
- //dbg(DEBUG_ISO, "%s: frame %d length=%d", __func__, nframe, ifd->length);
|
|
|
|
|
|
|
|
/* retrieve block of data to send */
|
|
/* retrieve block of data to send */
|
|
ifd->offset = gigaset_isowbuf_getbytes(ubc->isooutbuf,
|
|
ifd->offset = gigaset_isowbuf_getbytes(ubc->isooutbuf,
|
|
ifd->length);
|
|
ifd->length);
|
|
if (ifd->offset < 0) {
|
|
if (ifd->offset < 0) {
|
|
if (ifd->offset == -EBUSY) {
|
|
if (ifd->offset == -EBUSY) {
|
|
- dbg(DEBUG_ISO, "%s: buffer busy at frame %d",
|
|
|
|
- __func__, nframe);
|
|
|
|
- /* tasklet will be restarted from gigaset_send_skb() */
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO,
|
|
|
|
+ "%s: buffer busy at frame %d",
|
|
|
|
+ __func__, nframe);
|
|
|
|
+ /* tasklet will be restarted from
|
|
|
|
+ gigaset_send_skb() */
|
|
} else {
|
|
} else {
|
|
- err("%s: buffer error %d at frame %d",
|
|
|
|
- __func__, ifd->offset, nframe);
|
|
|
|
|
|
+ dev_err(ucx->bcs->cs->dev,
|
|
|
|
+ "%s: buffer error %d at frame %d\n",
|
|
|
|
+ __func__, ifd->offset, nframe);
|
|
return ifd->offset;
|
|
return ifd->offset;
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
@@ -1026,8 +1046,9 @@ static int submit_iso_write_urb(struct isow_urbctx_t *ucx)
|
|
}
|
|
}
|
|
if ((urb->number_of_packets = nframe) > 0) {
|
|
if ((urb->number_of_packets = nframe) > 0) {
|
|
if ((rc = usb_submit_urb(urb, SLAB_ATOMIC)) != 0) {
|
|
if ((rc = usb_submit_urb(urb, SLAB_ATOMIC)) != 0) {
|
|
- err("could not submit isochronous write URB: %s",
|
|
|
|
- get_usb_statmsg(rc));
|
|
|
|
|
|
+ dev_err(ucx->bcs->cs->dev,
|
|
|
|
+ "could not submit isochronous write URB: %s\n",
|
|
|
|
+ get_usb_statmsg(rc));
|
|
dump_urb(DEBUG_ISO, "isoc write", urb);
|
|
dump_urb(DEBUG_ISO, "isoc write", urb);
|
|
return rc;
|
|
return rc;
|
|
}
|
|
}
|
|
@@ -1071,7 +1092,7 @@ static void write_iso_tasklet(unsigned long data)
|
|
}
|
|
}
|
|
|
|
|
|
if (unlikely(!(atomic_read(&ubc->running)))) {
|
|
if (unlikely(!(atomic_read(&ubc->running)))) {
|
|
- dbg(DEBUG_ISO, "%s: not running", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: not running", __func__);
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1083,7 +1104,7 @@ static void write_iso_tasklet(unsigned long data)
|
|
ubc->isooutovfl = NULL;
|
|
ubc->isooutovfl = NULL;
|
|
spin_unlock_irqrestore(&ubc->isooutlock, flags);
|
|
spin_unlock_irqrestore(&ubc->isooutlock, flags);
|
|
if (ovfl) {
|
|
if (ovfl) {
|
|
- err("isochronous write buffer underrun - buy a faster machine :-)");
|
|
|
|
|
|
+ dev_err(cs->dev, "isochronous write buffer underrun\n");
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
@@ -1106,7 +1127,8 @@ static void write_iso_tasklet(unsigned long data)
|
|
spin_unlock_irqrestore(&ubc->isooutlock, flags);
|
|
spin_unlock_irqrestore(&ubc->isooutlock, flags);
|
|
if (next) {
|
|
if (next) {
|
|
/* couldn't put it back */
|
|
/* couldn't put it back */
|
|
- err("losing isochronous write URB");
|
|
|
|
|
|
+ dev_err(cs->dev,
|
|
|
|
+ "losing isochronous write URB\n");
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -1123,19 +1145,21 @@ static void write_iso_tasklet(unsigned long data)
|
|
* successfully sent
|
|
* successfully sent
|
|
* - all following frames are not sent at all
|
|
* - all following frames are not sent at all
|
|
*/
|
|
*/
|
|
- dbg(DEBUG_ISO, "%s: URB partially completed", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: URB partially completed",
|
|
|
|
+ __func__);
|
|
offset = done->limit; /* just in case */
|
|
offset = done->limit; /* just in case */
|
|
for (i = 0; i < BAS_NUMFRAMES; i++) {
|
|
for (i = 0; i < BAS_NUMFRAMES; i++) {
|
|
ifd = &urb->iso_frame_desc[i];
|
|
ifd = &urb->iso_frame_desc[i];
|
|
if (ifd->status ||
|
|
if (ifd->status ||
|
|
ifd->actual_length != ifd->length) {
|
|
ifd->actual_length != ifd->length) {
|
|
- warn("isochronous write: frame %d: %s, "
|
|
|
|
- "only %d of %d bytes sent",
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous write: frame %d: %s, "
|
|
|
|
+ "only %d of %d bytes sent\n",
|
|
i, get_usb_statmsg(ifd->status),
|
|
i, get_usb_statmsg(ifd->status),
|
|
ifd->actual_length, ifd->length);
|
|
ifd->actual_length, ifd->length);
|
|
offset = (ifd->offset +
|
|
offset = (ifd->offset +
|
|
- ifd->actual_length)
|
|
|
|
- % BAS_OUTBUFSIZE;
|
|
|
|
|
|
+ ifd->actual_length)
|
|
|
|
+ % BAS_OUTBUFSIZE;
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -1145,25 +1169,26 @@ static void write_iso_tasklet(unsigned long data)
|
|
ifd = &urb->iso_frame_desc[i];
|
|
ifd = &urb->iso_frame_desc[i];
|
|
if (ifd->status != -EINPROGRESS
|
|
if (ifd->status != -EINPROGRESS
|
|
|| ifd->actual_length != 0) {
|
|
|| ifd->actual_length != 0) {
|
|
- warn("isochronous write: frame %d: %s, "
|
|
|
|
- "%d of %d bytes sent",
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous write: frame %d: %s, "
|
|
|
|
+ "%d of %d bytes sent\n",
|
|
i, get_usb_statmsg(ifd->status),
|
|
i, get_usb_statmsg(ifd->status),
|
|
ifd->actual_length, ifd->length);
|
|
ifd->actual_length, ifd->length);
|
|
offset = (ifd->offset +
|
|
offset = (ifd->offset +
|
|
- ifd->actual_length)
|
|
|
|
- % BAS_OUTBUFSIZE;
|
|
|
|
|
|
+ ifd->actual_length)
|
|
|
|
+ % BAS_OUTBUFSIZE;
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
break;
|
|
break;
|
|
- case -EPIPE: //FIXME is this the code for "underrun"?
|
|
|
|
- err("isochronous write stalled");
|
|
|
|
|
|
+ case -EPIPE: //FIXME is this the code for "underrun"?
|
|
|
|
+ dev_err(cs->dev, "isochronous write stalled\n");
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
break;
|
|
break;
|
|
default: /* severe trouble */
|
|
default: /* severe trouble */
|
|
- warn("isochronous write: %s",
|
|
|
|
- get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ dev_warn(cs->dev, "isochronous write: %s\n",
|
|
|
|
+ get_usb_statmsg(urb->status));
|
|
}
|
|
}
|
|
|
|
|
|
/* mark the write buffer area covered by this URB as free */
|
|
/* mark the write buffer area covered by this URB as free */
|
|
@@ -1191,8 +1216,8 @@ static void write_iso_tasklet(unsigned long data)
|
|
if (gigaset_isoc_buildframe(bcs, skb->data, len) == -EAGAIN) {
|
|
if (gigaset_isoc_buildframe(bcs, skb->data, len) == -EAGAIN) {
|
|
/* insufficient buffer space, push back onto queue */
|
|
/* insufficient buffer space, push back onto queue */
|
|
skb_queue_head(&bcs->squeue, skb);
|
|
skb_queue_head(&bcs->squeue, skb);
|
|
- dbg(DEBUG_ISO, "%s: skb requeued, qlen=%d",
|
|
|
|
- __func__, skb_queue_len(&bcs->squeue));
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: skb requeued, qlen=%d",
|
|
|
|
+ __func__, skb_queue_len(&bcs->squeue));
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
skb_pull(skb, len);
|
|
skb_pull(skb, len);
|
|
@@ -1229,7 +1254,7 @@ static void read_iso_tasklet(unsigned long data)
|
|
|
|
|
|
/* loop while more completed URBs arrive in the meantime */
|
|
/* loop while more completed URBs arrive in the meantime */
|
|
for (;;) {
|
|
for (;;) {
|
|
- if (!atomic_read(&cs->connected)) {
|
|
|
|
|
|
+ if (unlikely(!atomic_read(&cs->connected))) {
|
|
warn("%s: disconnected", __func__);
|
|
warn("%s: disconnected", __func__);
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
@@ -1242,15 +1267,20 @@ static void read_iso_tasklet(unsigned long data)
|
|
}
|
|
}
|
|
ubc->isoindone = NULL;
|
|
ubc->isoindone = NULL;
|
|
if (unlikely(ubc->loststatus != -EINPROGRESS)) {
|
|
if (unlikely(ubc->loststatus != -EINPROGRESS)) {
|
|
- warn("isochronous read overrun, dropped URB with status: %s, %d bytes lost",
|
|
|
|
- get_usb_statmsg(ubc->loststatus), ubc->isoinlost);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous read overrun, "
|
|
|
|
+ "dropped URB with status: %s, %d bytes lost\n",
|
|
|
|
+ get_usb_statmsg(ubc->loststatus),
|
|
|
|
+ ubc->isoinlost);
|
|
ubc->loststatus = -EINPROGRESS;
|
|
ubc->loststatus = -EINPROGRESS;
|
|
}
|
|
}
|
|
spin_unlock_irqrestore(&ubc->isoinlock, flags);
|
|
spin_unlock_irqrestore(&ubc->isoinlock, flags);
|
|
|
|
|
|
if (unlikely(!(atomic_read(&ubc->running)))) {
|
|
if (unlikely(!(atomic_read(&ubc->running)))) {
|
|
- dbg(DEBUG_ISO, "%s: channel not running, dropped URB with status: %s",
|
|
|
|
- __func__, get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO,
|
|
|
|
+ "%s: channel not running, "
|
|
|
|
+ "dropped URB with status: %s",
|
|
|
|
+ __func__, get_usb_statmsg(urb->status));
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1259,22 +1289,23 @@ static void read_iso_tasklet(unsigned long data)
|
|
break;
|
|
break;
|
|
case -EXDEV: /* inspect individual frames
|
|
case -EXDEV: /* inspect individual frames
|
|
(we do that anyway) */
|
|
(we do that anyway) */
|
|
- dbg(DEBUG_ISO, "%s: URB partially completed", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: URB partially completed",
|
|
|
|
+ __func__);
|
|
break;
|
|
break;
|
|
case -ENOENT:
|
|
case -ENOENT:
|
|
case -ECONNRESET:
|
|
case -ECONNRESET:
|
|
- dbg(DEBUG_ISO, "%s: URB canceled", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: URB canceled", __func__);
|
|
continue; /* -> skip */
|
|
continue; /* -> skip */
|
|
case -EINPROGRESS: /* huh? */
|
|
case -EINPROGRESS: /* huh? */
|
|
- dbg(DEBUG_ISO, "%s: URB still pending", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ISO, "%s: URB still pending", __func__);
|
|
continue; /* -> skip */
|
|
continue; /* -> skip */
|
|
case -EPIPE:
|
|
case -EPIPE:
|
|
- err("isochronous read stalled");
|
|
|
|
|
|
+ dev_err(cs->dev, "isochronous read stalled\n");
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
continue; /* -> skip */
|
|
continue; /* -> skip */
|
|
default: /* severe trouble */
|
|
default: /* severe trouble */
|
|
- warn("isochronous read: %s",
|
|
|
|
- get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ dev_warn(cs->dev, "isochronous read: %s\n",
|
|
|
|
+ get_usb_statmsg(urb->status));
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1282,33 +1313,44 @@ static void read_iso_tasklet(unsigned long data)
|
|
totleft = urb->actual_length;
|
|
totleft = urb->actual_length;
|
|
for (frame = 0; totleft > 0 && frame < BAS_NUMFRAMES; frame++) {
|
|
for (frame = 0; totleft > 0 && frame < BAS_NUMFRAMES; frame++) {
|
|
if (unlikely(urb->iso_frame_desc[frame].status)) {
|
|
if (unlikely(urb->iso_frame_desc[frame].status)) {
|
|
- warn("isochronous read: frame %d: %s", frame,
|
|
|
|
- get_usb_statmsg(urb->iso_frame_desc[frame].status));
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous read: frame %d: %s\n",
|
|
|
|
+ frame,
|
|
|
|
+ get_usb_statmsg(
|
|
|
|
+ urb->iso_frame_desc[frame].status));
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
numbytes = urb->iso_frame_desc[frame].actual_length;
|
|
numbytes = urb->iso_frame_desc[frame].actual_length;
|
|
if (unlikely(numbytes > BAS_MAXFRAME)) {
|
|
if (unlikely(numbytes > BAS_MAXFRAME)) {
|
|
- warn("isochronous read: frame %d: numbytes (%d) > BAS_MAXFRAME",
|
|
|
|
- frame, numbytes);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous read: frame %d: "
|
|
|
|
+ "numbytes (%d) > BAS_MAXFRAME\n",
|
|
|
|
+ frame, numbytes);
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
if (unlikely(numbytes > totleft)) {
|
|
if (unlikely(numbytes > totleft)) {
|
|
- warn("isochronous read: frame %d: numbytes (%d) > totleft (%d)",
|
|
|
|
- frame, numbytes, totleft);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous read: frame %d: "
|
|
|
|
+ "numbytes (%d) > totleft (%d)\n",
|
|
|
|
+ frame, numbytes, totleft);
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
offset = urb->iso_frame_desc[frame].offset;
|
|
offset = urb->iso_frame_desc[frame].offset;
|
|
if (unlikely(offset + numbytes > BAS_INBUFSIZE)) {
|
|
if (unlikely(offset + numbytes > BAS_INBUFSIZE)) {
|
|
- warn("isochronous read: frame %d: offset (%d) + numbytes (%d) > BAS_INBUFSIZE",
|
|
|
|
- frame, offset, numbytes);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous read: frame %d: "
|
|
|
|
+ "offset (%d) + numbytes (%d) "
|
|
|
|
+ "> BAS_INBUFSIZE\n",
|
|
|
|
+ frame, offset, numbytes);
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
gigaset_isoc_receive(rcvbuf + offset, numbytes, bcs);
|
|
gigaset_isoc_receive(rcvbuf + offset, numbytes, bcs);
|
|
totleft -= numbytes;
|
|
totleft -= numbytes;
|
|
}
|
|
}
|
|
if (unlikely(totleft > 0))
|
|
if (unlikely(totleft > 0))
|
|
- warn("isochronous read: %d data bytes missing",
|
|
|
|
- totleft);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "isochronous read: %d data bytes missing\n",
|
|
|
|
+ totleft);
|
|
|
|
|
|
error:
|
|
error:
|
|
/* URB processed, resubmit */
|
|
/* URB processed, resubmit */
|
|
@@ -1316,12 +1358,14 @@ static void read_iso_tasklet(unsigned long data)
|
|
urb->iso_frame_desc[frame].status = 0;
|
|
urb->iso_frame_desc[frame].status = 0;
|
|
urb->iso_frame_desc[frame].actual_length = 0;
|
|
urb->iso_frame_desc[frame].actual_length = 0;
|
|
}
|
|
}
|
|
- urb->dev = bcs->cs->hw.bas->udev; /* clobbered by USB subsystem */
|
|
|
|
|
|
+ /* urb->dev is clobbered by USB subsystem */
|
|
|
|
+ urb->dev = bcs->cs->hw.bas->udev;
|
|
urb->transfer_flags = URB_ISO_ASAP;
|
|
urb->transfer_flags = URB_ISO_ASAP;
|
|
urb->number_of_packets = BAS_NUMFRAMES;
|
|
urb->number_of_packets = BAS_NUMFRAMES;
|
|
if ((rc = usb_submit_urb(urb, SLAB_ATOMIC)) != 0) {
|
|
if ((rc = usb_submit_urb(urb, SLAB_ATOMIC)) != 0) {
|
|
- err("could not resubmit isochronous read URB: %s",
|
|
|
|
- get_usb_statmsg(rc));
|
|
|
|
|
|
+ dev_err(cs->dev,
|
|
|
|
+ "could not resubmit isochronous read URB: %s\n",
|
|
|
|
+ get_usb_statmsg(rc));
|
|
dump_urb(DEBUG_ISO, "resubmit iso read", urb);
|
|
dump_urb(DEBUG_ISO, "resubmit iso read", urb);
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
}
|
|
}
|
|
@@ -1357,33 +1401,34 @@ static void req_timeout(unsigned long data)
|
|
|
|
|
|
switch (pending) {
|
|
switch (pending) {
|
|
case 0: /* no pending request */
|
|
case 0: /* no pending request */
|
|
- dbg(DEBUG_USBREQ, "%s: no request pending", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "%s: no request pending", __func__);
|
|
break;
|
|
break;
|
|
|
|
|
|
case HD_OPEN_ATCHANNEL:
|
|
case HD_OPEN_ATCHANNEL:
|
|
- err("timeout opening AT channel");
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "timeout opening AT channel\n");
|
|
error_reset(bcs->cs);
|
|
error_reset(bcs->cs);
|
|
break;
|
|
break;
|
|
|
|
|
|
case HD_OPEN_B2CHANNEL:
|
|
case HD_OPEN_B2CHANNEL:
|
|
case HD_OPEN_B1CHANNEL:
|
|
case HD_OPEN_B1CHANNEL:
|
|
- err("timeout opening channel %d", bcs->channel + 1);
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "timeout opening channel %d\n",
|
|
|
|
+ bcs->channel + 1);
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
break;
|
|
break;
|
|
|
|
|
|
case HD_CLOSE_ATCHANNEL:
|
|
case HD_CLOSE_ATCHANNEL:
|
|
- err("timeout closing AT channel");
|
|
|
|
- //wake_up_interruptible(cs->initwait);
|
|
|
|
- //FIXME need own wait queue?
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "timeout closing AT channel\n");
|
|
break;
|
|
break;
|
|
|
|
|
|
case HD_CLOSE_B2CHANNEL:
|
|
case HD_CLOSE_B2CHANNEL:
|
|
case HD_CLOSE_B1CHANNEL:
|
|
case HD_CLOSE_B1CHANNEL:
|
|
- err("timeout closing channel %d", bcs->channel + 1);
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "timeout closing channel %d\n",
|
|
|
|
+ bcs->channel + 1);
|
|
break;
|
|
break;
|
|
|
|
|
|
default:
|
|
default:
|
|
- warn("request 0x%02x timed out, clearing", pending);
|
|
|
|
|
|
+ dev_warn(bcs->cs->dev, "request 0x%02x timed out, clearing\n",
|
|
|
|
+ pending);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1406,8 +1451,9 @@ static void write_ctrl_callback(struct urb *urb, struct pt_regs *regs)
|
|
ucs = (struct bas_cardstate *) urb->context;
|
|
ucs = (struct bas_cardstate *) urb->context;
|
|
spin_lock_irqsave(&ucs->lock, flags);
|
|
spin_lock_irqsave(&ucs->lock, flags);
|
|
if (urb->status && ucs->pending) {
|
|
if (urb->status && ucs->pending) {
|
|
- err("control request 0x%02x failed: %s",
|
|
|
|
- ucs->pending, get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ dev_err(&ucs->interface->dev,
|
|
|
|
+ "control request 0x%02x failed: %s\n",
|
|
|
|
+ ucs->pending, get_usb_statmsg(urb->status));
|
|
del_timer(&ucs->timer_ctrl);
|
|
del_timer(&ucs->timer_ctrl);
|
|
ucs->pending = 0;
|
|
ucs->pending = 0;
|
|
}
|
|
}
|
|
@@ -1446,18 +1492,21 @@ static int req_submit(struct bc_state *bcs, int req, int val, int timeout)
|
|
IFNULLRETVAL(ucs, -EINVAL);
|
|
IFNULLRETVAL(ucs, -EINVAL);
|
|
IFNULLRETVAL(ucs->urb_ctrl, -EINVAL);
|
|
IFNULLRETVAL(ucs->urb_ctrl, -EINVAL);
|
|
|
|
|
|
- dbg(DEBUG_USBREQ, "-------> 0x%02x (%d)", req, val);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "-------> 0x%02x (%d)", req, val);
|
|
|
|
|
|
spin_lock_irqsave(&ucs->lock, flags);
|
|
spin_lock_irqsave(&ucs->lock, flags);
|
|
if (ucs->pending) {
|
|
if (ucs->pending) {
|
|
spin_unlock_irqrestore(&ucs->lock, flags);
|
|
spin_unlock_irqrestore(&ucs->lock, flags);
|
|
- err("submission of request 0x%02x failed: request 0x%02x still pending",
|
|
|
|
- req, ucs->pending);
|
|
|
|
|
|
+ dev_err(bcs->cs->dev,
|
|
|
|
+ "submission of request 0x%02x failed: "
|
|
|
|
+ "request 0x%02x still pending\n",
|
|
|
|
+ req, ucs->pending);
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
if (ucs->urb_ctrl->status == -EINPROGRESS) {
|
|
if (ucs->urb_ctrl->status == -EINPROGRESS) {
|
|
spin_unlock_irqrestore(&ucs->lock, flags);
|
|
spin_unlock_irqrestore(&ucs->lock, flags);
|
|
- err("could not submit request 0x%02x: URB busy", req);
|
|
|
|
|
|
+ dev_err(bcs->cs->dev,
|
|
|
|
+ "could not submit request 0x%02x: URB busy\n", req);
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1467,19 +1516,19 @@ static int req_submit(struct bc_state *bcs, int req, int val, int timeout)
|
|
ucs->dr_ctrl.wIndex = 0;
|
|
ucs->dr_ctrl.wIndex = 0;
|
|
ucs->dr_ctrl.wLength = 0;
|
|
ucs->dr_ctrl.wLength = 0;
|
|
usb_fill_control_urb(ucs->urb_ctrl, ucs->udev,
|
|
usb_fill_control_urb(ucs->urb_ctrl, ucs->udev,
|
|
- usb_sndctrlpipe(ucs->udev, 0),
|
|
|
|
- (unsigned char*) &ucs->dr_ctrl, NULL, 0,
|
|
|
|
- write_ctrl_callback, ucs);
|
|
|
|
|
|
+ usb_sndctrlpipe(ucs->udev, 0),
|
|
|
|
+ (unsigned char*) &ucs->dr_ctrl, NULL, 0,
|
|
|
|
+ write_ctrl_callback, ucs);
|
|
if ((ret = usb_submit_urb(ucs->urb_ctrl, SLAB_ATOMIC)) != 0) {
|
|
if ((ret = usb_submit_urb(ucs->urb_ctrl, SLAB_ATOMIC)) != 0) {
|
|
- err("could not submit request 0x%02x: %s",
|
|
|
|
- req, get_usb_statmsg(ret));
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "could not submit request 0x%02x: %s\n",
|
|
|
|
+ req, get_usb_statmsg(ret));
|
|
spin_unlock_irqrestore(&ucs->lock, flags);
|
|
spin_unlock_irqrestore(&ucs->lock, flags);
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
ucs->pending = req;
|
|
ucs->pending = req;
|
|
|
|
|
|
if (timeout > 0) {
|
|
if (timeout > 0) {
|
|
- dbg(DEBUG_USBREQ, "setting timeout of %d/10 secs", timeout);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "setting timeout of %d/10 secs", timeout);
|
|
ucs->timer_ctrl.expires = jiffies + timeout * HZ / 10;
|
|
ucs->timer_ctrl.expires = jiffies + timeout * HZ / 10;
|
|
ucs->timer_ctrl.data = (unsigned long) bcs;
|
|
ucs->timer_ctrl.data = (unsigned long) bcs;
|
|
ucs->timer_ctrl.function = req_timeout;
|
|
ucs->timer_ctrl.function = req_timeout;
|
|
@@ -1505,16 +1554,17 @@ static int gigaset_init_bchannel(struct bc_state *bcs)
|
|
IFNULLRETVAL(bcs, -EINVAL);
|
|
IFNULLRETVAL(bcs, -EINVAL);
|
|
|
|
|
|
if ((ret = starturbs(bcs)) < 0) {
|
|
if ((ret = starturbs(bcs)) < 0) {
|
|
- err("could not start isochronous I/O for channel %d",
|
|
|
|
- bcs->channel + 1);
|
|
|
|
|
|
+ dev_err(bcs->cs->dev,
|
|
|
|
+ "could not start isochronous I/O for channel %d\n",
|
|
|
|
+ bcs->channel + 1);
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
req = bcs->channel ? HD_OPEN_B2CHANNEL : HD_OPEN_B1CHANNEL;
|
|
req = bcs->channel ? HD_OPEN_B2CHANNEL : HD_OPEN_B1CHANNEL;
|
|
if ((ret = req_submit(bcs, req, 0, BAS_TIMEOUT)) < 0) {
|
|
if ((ret = req_submit(bcs, req, 0, BAS_TIMEOUT)) < 0) {
|
|
- err("could not open channel %d: %s",
|
|
|
|
- bcs->channel + 1, get_usb_statmsg(ret));
|
|
|
|
|
|
+ dev_err(bcs->cs->dev, "could not open channel %d: %s\n",
|
|
|
|
+ bcs->channel + 1, get_usb_statmsg(ret));
|
|
stopurbs(bcs->hw.bas);
|
|
stopurbs(bcs->hw.bas);
|
|
error_hangup(bcs);
|
|
error_hangup(bcs);
|
|
}
|
|
}
|
|
@@ -1546,8 +1596,9 @@ static int gigaset_close_bchannel(struct bc_state *bcs)
|
|
|
|
|
|
req = bcs->channel ? HD_CLOSE_B2CHANNEL : HD_CLOSE_B1CHANNEL;
|
|
req = bcs->channel ? HD_CLOSE_B2CHANNEL : HD_CLOSE_B1CHANNEL;
|
|
if ((ret = req_submit(bcs, req, 0, BAS_TIMEOUT)) < 0)
|
|
if ((ret = req_submit(bcs, req, 0, BAS_TIMEOUT)) < 0)
|
|
- err("could not submit HD_CLOSE_BxCHANNEL request: %s",
|
|
|
|
- get_usb_statmsg(ret));
|
|
|
|
|
|
+ dev_err(bcs->cs->dev,
|
|
|
|
+ "could not submit HD_CLOSE_BxCHANNEL request: %s\n",
|
|
|
|
+ get_usb_statmsg(ret));
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1570,9 +1621,9 @@ static void complete_cb(struct cardstate *cs)
|
|
|
|
|
|
/* unqueue completed buffer */
|
|
/* unqueue completed buffer */
|
|
cs->cmdbytes -= cs->curlen;
|
|
cs->cmdbytes -= cs->curlen;
|
|
- dbg(DEBUG_TRANSCMD | DEBUG_LOCKCMD,
|
|
|
|
- "write_command: sent %u bytes, %u left",
|
|
|
|
- cs->curlen, cs->cmdbytes);
|
|
|
|
|
|
+ gig_dbg(DEBUG_TRANSCMD|DEBUG_LOCKCMD,
|
|
|
|
+ "write_command: sent %u bytes, %u left",
|
|
|
|
+ cs->curlen, cs->cmdbytes);
|
|
if ((cs->cmdbuf = cb->next) != NULL) {
|
|
if ((cs->cmdbuf = cb->next) != NULL) {
|
|
cs->cmdbuf->prev = NULL;
|
|
cs->cmdbuf->prev = NULL;
|
|
cs->curlen = cs->cmdbuf->len;
|
|
cs->curlen = cs->cmdbuf->len;
|
|
@@ -1616,22 +1667,27 @@ static void write_command_callback(struct urb *urb, struct pt_regs *regs)
|
|
case -ECONNRESET: /* canceled (async) */
|
|
case -ECONNRESET: /* canceled (async) */
|
|
case -EINPROGRESS: /* pending */
|
|
case -EINPROGRESS: /* pending */
|
|
/* ignore silently */
|
|
/* ignore silently */
|
|
- dbg(DEBUG_USBREQ,
|
|
|
|
- "%s: %s", __func__, get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "%s: %s",
|
|
|
|
+ __func__, get_usb_statmsg(urb->status));
|
|
return;
|
|
return;
|
|
default: /* any failure */
|
|
default: /* any failure */
|
|
if (++ucs->retry_cmd_out > BAS_RETRY) {
|
|
if (++ucs->retry_cmd_out > BAS_RETRY) {
|
|
- warn("command write: %s, giving up after %d retries",
|
|
|
|
- get_usb_statmsg(urb->status), ucs->retry_cmd_out);
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "command write: %s, "
|
|
|
|
+ "giving up after %d retries\n",
|
|
|
|
+ get_usb_statmsg(urb->status),
|
|
|
|
+ ucs->retry_cmd_out);
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
if (cs->cmdbuf == NULL) {
|
|
if (cs->cmdbuf == NULL) {
|
|
- warn("command write: %s, cannot retry - cmdbuf gone",
|
|
|
|
- get_usb_statmsg(urb->status));
|
|
|
|
|
|
+ dev_warn(cs->dev,
|
|
|
|
+ "command write: %s, "
|
|
|
|
+ "cannot retry - cmdbuf gone\n",
|
|
|
|
+ get_usb_statmsg(urb->status));
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
- notice("command write: %s, retry %d",
|
|
|
|
- get_usb_statmsg(urb->status), ucs->retry_cmd_out);
|
|
|
|
|
|
+ dev_notice(cs->dev, "command write: %s, retry %d\n",
|
|
|
|
+ get_usb_statmsg(urb->status), ucs->retry_cmd_out);
|
|
if (atwrite_submit(cs, cs->cmdbuf->buf, cs->cmdbuf->len) >= 0)
|
|
if (atwrite_submit(cs, cs->cmdbuf->buf, cs->cmdbuf->len) >= 0)
|
|
/* resubmitted - bypass regular exit block */
|
|
/* resubmitted - bypass regular exit block */
|
|
return;
|
|
return;
|
|
@@ -1659,7 +1715,7 @@ static void atrdy_timeout(unsigned long data)
|
|
ucs = cs->hw.bas;
|
|
ucs = cs->hw.bas;
|
|
IFNULLRET(ucs);
|
|
IFNULLRET(ucs);
|
|
|
|
|
|
- warn("timeout waiting for HD_READY_SEND_ATDATA");
|
|
|
|
|
|
+ dev_warn(cs->dev, "timeout waiting for HD_READY_SEND_ATDATA\n");
|
|
|
|
|
|
/* fake the missing signal - what else can I do? */
|
|
/* fake the missing signal - what else can I do? */
|
|
update_basstate(ucs, BS_ATREADY, BS_ATTIMER);
|
|
update_basstate(ucs, BS_ATREADY, BS_ATTIMER);
|
|
@@ -1688,10 +1744,11 @@ static int atwrite_submit(struct cardstate *cs, unsigned char *buf, int len)
|
|
IFNULLRETVAL(ucs, -EFAULT);
|
|
IFNULLRETVAL(ucs, -EFAULT);
|
|
IFNULLRETVAL(ucs->urb_cmd_out, -EFAULT);
|
|
IFNULLRETVAL(ucs->urb_cmd_out, -EFAULT);
|
|
|
|
|
|
- dbg(DEBUG_USBREQ, "-------> HD_WRITE_ATMESSAGE (%d)", len);
|
|
|
|
|
|
+ gig_dbg(DEBUG_USBREQ, "-------> HD_WRITE_ATMESSAGE (%d)", len);
|
|
|
|
|
|
if (ucs->urb_cmd_out->status == -EINPROGRESS) {
|
|
if (ucs->urb_cmd_out->status == -EINPROGRESS) {
|
|
- err("could not submit HD_WRITE_ATMESSAGE: URB busy");
|
|
|
|
|
|
+ dev_err(cs->dev,
|
|
|
|
+ "could not submit HD_WRITE_ATMESSAGE: URB busy\n");
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1706,8 +1763,8 @@ static int atwrite_submit(struct cardstate *cs, unsigned char *buf, int len)
|
|
write_command_callback, cs);
|
|
write_command_callback, cs);
|
|
|
|
|
|
if ((ret = usb_submit_urb(ucs->urb_cmd_out, SLAB_ATOMIC)) != 0) {
|
|
if ((ret = usb_submit_urb(ucs->urb_cmd_out, SLAB_ATOMIC)) != 0) {
|
|
- err("could not submit HD_WRITE_ATMESSAGE: %s",
|
|
|
|
- get_usb_statmsg(ret));
|
|
|
|
|
|
+ dev_err(cs->dev, "could not submit HD_WRITE_ATMESSAGE: %s\n",
|
|
|
|
+ get_usb_statmsg(ret));
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1716,8 +1773,8 @@ static int atwrite_submit(struct cardstate *cs, unsigned char *buf, int len)
|
|
|
|
|
|
/* start timeout if necessary */
|
|
/* start timeout if necessary */
|
|
if (!(atomic_read(&ucs->basstate) & BS_ATTIMER)) {
|
|
if (!(atomic_read(&ucs->basstate) & BS_ATTIMER)) {
|
|
- dbg(DEBUG_OUTPUT,
|
|
|
|
- "setting ATREADY timeout of %d/10 secs", ATRDY_TIMEOUT);
|
|
|
|
|
|
+ gig_dbg(DEBUG_OUTPUT, "setting ATREADY timeout of %d/10 secs",
|
|
|
|
+ ATRDY_TIMEOUT);
|
|
ucs->timer_atrdy.expires = jiffies + ATRDY_TIMEOUT * HZ / 10;
|
|
ucs->timer_atrdy.expires = jiffies + ATRDY_TIMEOUT * HZ / 10;
|
|
ucs->timer_atrdy.data = (unsigned long) cs;
|
|
ucs->timer_atrdy.data = (unsigned long) cs;
|
|
ucs->timer_atrdy.function = atrdy_timeout;
|
|
ucs->timer_atrdy.function = atrdy_timeout;
|
|
@@ -1749,10 +1806,10 @@ static int start_cbsend(struct cardstate *cs)
|
|
|
|
|
|
/* check if AT channel is open */
|
|
/* check if AT channel is open */
|
|
if (!(atomic_read(&ucs->basstate) & BS_ATOPEN)) {
|
|
if (!(atomic_read(&ucs->basstate) & BS_ATOPEN)) {
|
|
- dbg(DEBUG_TRANSCMD | DEBUG_LOCKCMD, "AT channel not open");
|
|
|
|
|
|
+ gig_dbg(DEBUG_TRANSCMD|DEBUG_LOCKCMD, "AT channel not open");
|
|
rc = req_submit(cs->bcs, HD_OPEN_ATCHANNEL, 0, BAS_TIMEOUT);
|
|
rc = req_submit(cs->bcs, HD_OPEN_ATCHANNEL, 0, BAS_TIMEOUT);
|
|
if (rc < 0) {
|
|
if (rc < 0) {
|
|
- err("could not open AT channel");
|
|
|
|
|
|
+ dev_err(cs->dev, "could not open AT channel\n");
|
|
/* flush command queue */
|
|
/* flush command queue */
|
|
spin_lock_irqsave(&cs->cmdlock, flags);
|
|
spin_lock_irqsave(&cs->cmdlock, flags);
|
|
while (cs->cmdbuf != NULL)
|
|
while (cs->cmdbuf != NULL)
|
|
@@ -1797,19 +1854,19 @@ static int start_cbsend(struct cardstate *cs)
|
|
* error code < 0 on error
|
|
* error code < 0 on error
|
|
*/
|
|
*/
|
|
static int gigaset_write_cmd(struct cardstate *cs,
|
|
static int gigaset_write_cmd(struct cardstate *cs,
|
|
- const unsigned char *buf, int len,
|
|
|
|
- struct tasklet_struct *wake_tasklet)
|
|
|
|
|
|
+ const unsigned char *buf, int len,
|
|
|
|
+ struct tasklet_struct *wake_tasklet)
|
|
{
|
|
{
|
|
struct cmdbuf_t *cb;
|
|
struct cmdbuf_t *cb;
|
|
unsigned long flags;
|
|
unsigned long flags;
|
|
int status;
|
|
int status;
|
|
|
|
|
|
gigaset_dbg_buffer(atomic_read(&cs->mstate) != MS_LOCKED ?
|
|
gigaset_dbg_buffer(atomic_read(&cs->mstate) != MS_LOCKED ?
|
|
- DEBUG_TRANSCMD : DEBUG_LOCKCMD,
|
|
|
|
- "CMD Transmit", len, buf, 0);
|
|
|
|
|
|
+ DEBUG_TRANSCMD : DEBUG_LOCKCMD,
|
|
|
|
+ "CMD Transmit", len, buf, 0);
|
|
|
|
|
|
- if (!atomic_read(&cs->connected)) {
|
|
|
|
- err("%s: not connected", __func__);
|
|
|
|
|
|
+ if (unlikely(!atomic_read(&cs->connected))) {
|
|
|
|
+ err("%s: disconnected", __func__);
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1819,7 +1876,7 @@ static int gigaset_write_cmd(struct cardstate *cs,
|
|
if (len > IF_WRITEBUF)
|
|
if (len > IF_WRITEBUF)
|
|
len = IF_WRITEBUF;
|
|
len = IF_WRITEBUF;
|
|
if (!(cb = kmalloc(sizeof(struct cmdbuf_t) + len, GFP_ATOMIC))) {
|
|
if (!(cb = kmalloc(sizeof(struct cmdbuf_t) + len, GFP_ATOMIC))) {
|
|
- err("%s: out of memory", __func__);
|
|
|
|
|
|
+ dev_err(cs->dev, "%s: out of memory\n", __func__);
|
|
return -ENOMEM;
|
|
return -ENOMEM;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1947,7 +2004,7 @@ static int gigaset_initbcshw(struct bc_state *bcs)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
tasklet_init(&ubc->sent_tasklet,
|
|
tasklet_init(&ubc->sent_tasklet,
|
|
- &write_iso_tasklet, (unsigned long) bcs);
|
|
|
|
|
|
+ &write_iso_tasklet, (unsigned long) bcs);
|
|
|
|
|
|
spin_lock_init(&ubc->isoinlock);
|
|
spin_lock_init(&ubc->isoinlock);
|
|
for (i = 0; i < BAS_INURBS; ++i)
|
|
for (i = 0; i < BAS_INURBS; ++i)
|
|
@@ -1968,7 +2025,7 @@ static int gigaset_initbcshw(struct bc_state *bcs)
|
|
ubc->shared0s = 0;
|
|
ubc->shared0s = 0;
|
|
ubc->stolen0s = 0;
|
|
ubc->stolen0s = 0;
|
|
tasklet_init(&ubc->rcvd_tasklet,
|
|
tasklet_init(&ubc->rcvd_tasklet,
|
|
- &read_iso_tasklet, (unsigned long) bcs);
|
|
|
|
|
|
+ &read_iso_tasklet, (unsigned long) bcs);
|
|
return 1;
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -2041,43 +2098,47 @@ static void freeurbs(struct cardstate *cs)
|
|
for (i = 0; i < BAS_OUTURBS; ++i)
|
|
for (i = 0; i < BAS_OUTURBS; ++i)
|
|
if (ubc->isoouturbs[i].urb) {
|
|
if (ubc->isoouturbs[i].urb) {
|
|
usb_kill_urb(ubc->isoouturbs[i].urb);
|
|
usb_kill_urb(ubc->isoouturbs[i].urb);
|
|
- dbg(DEBUG_INIT,
|
|
|
|
- "%s: isoc output URB %d/%d unlinked",
|
|
|
|
- __func__, j, i);
|
|
|
|
|
|
+ gig_dbg(DEBUG_INIT,
|
|
|
|
+ "%s: isoc output URB %d/%d unlinked",
|
|
|
|
+ __func__, j, i);
|
|
usb_free_urb(ubc->isoouturbs[i].urb);
|
|
usb_free_urb(ubc->isoouturbs[i].urb);
|
|
ubc->isoouturbs[i].urb = NULL;
|
|
ubc->isoouturbs[i].urb = NULL;
|
|
}
|
|
}
|
|
for (i = 0; i < BAS_INURBS; ++i)
|
|
for (i = 0; i < BAS_INURBS; ++i)
|
|
if (ubc->isoinurbs[i]) {
|
|
if (ubc->isoinurbs[i]) {
|
|
usb_kill_urb(ubc->isoinurbs[i]);
|
|
usb_kill_urb(ubc->isoinurbs[i]);
|
|
- dbg(DEBUG_INIT,
|
|
|
|
- "%s: isoc input URB %d/%d unlinked",
|
|
|
|
- __func__, j, i);
|
|
|
|
|
|
+ gig_dbg(DEBUG_INIT,
|
|
|
|
+ "%s: isoc input URB %d/%d unlinked",
|
|
|
|
+ __func__, j, i);
|
|
usb_free_urb(ubc->isoinurbs[i]);
|
|
usb_free_urb(ubc->isoinurbs[i]);
|
|
ubc->isoinurbs[i] = NULL;
|
|
ubc->isoinurbs[i] = NULL;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
if (ucs->urb_int_in) {
|
|
if (ucs->urb_int_in) {
|
|
usb_kill_urb(ucs->urb_int_in);
|
|
usb_kill_urb(ucs->urb_int_in);
|
|
- dbg(DEBUG_INIT, "%s: interrupt input URB unlinked", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_INIT, "%s: interrupt input URB unlinked",
|
|
|
|
+ __func__);
|
|
usb_free_urb(ucs->urb_int_in);
|
|
usb_free_urb(ucs->urb_int_in);
|
|
ucs->urb_int_in = NULL;
|
|
ucs->urb_int_in = NULL;
|
|
}
|
|
}
|
|
if (ucs->urb_cmd_out) {
|
|
if (ucs->urb_cmd_out) {
|
|
usb_kill_urb(ucs->urb_cmd_out);
|
|
usb_kill_urb(ucs->urb_cmd_out);
|
|
- dbg(DEBUG_INIT, "%s: command output URB unlinked", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_INIT, "%s: command output URB unlinked",
|
|
|
|
+ __func__);
|
|
usb_free_urb(ucs->urb_cmd_out);
|
|
usb_free_urb(ucs->urb_cmd_out);
|
|
ucs->urb_cmd_out = NULL;
|
|
ucs->urb_cmd_out = NULL;
|
|
}
|
|
}
|
|
if (ucs->urb_cmd_in) {
|
|
if (ucs->urb_cmd_in) {
|
|
usb_kill_urb(ucs->urb_cmd_in);
|
|
usb_kill_urb(ucs->urb_cmd_in);
|
|
- dbg(DEBUG_INIT, "%s: command input URB unlinked", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_INIT, "%s: command input URB unlinked",
|
|
|
|
+ __func__);
|
|
usb_free_urb(ucs->urb_cmd_in);
|
|
usb_free_urb(ucs->urb_cmd_in);
|
|
ucs->urb_cmd_in = NULL;
|
|
ucs->urb_cmd_in = NULL;
|
|
}
|
|
}
|
|
if (ucs->urb_ctrl) {
|
|
if (ucs->urb_ctrl) {
|
|
usb_kill_urb(ucs->urb_ctrl);
|
|
usb_kill_urb(ucs->urb_ctrl);
|
|
- dbg(DEBUG_INIT, "%s: control output URB unlinked", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_INIT, "%s: control output URB unlinked",
|
|
|
|
+ __func__);
|
|
usb_free_urb(ucs->urb_ctrl);
|
|
usb_free_urb(ucs->urb_ctrl);
|
|
ucs->urb_ctrl = NULL;
|
|
ucs->urb_ctrl = NULL;
|
|
}
|
|
}
|
|
@@ -2101,10 +2162,10 @@ static int gigaset_probe(struct usb_interface *interface,
|
|
|
|
|
|
IFNULLRETVAL(udev, -ENODEV);
|
|
IFNULLRETVAL(udev, -ENODEV);
|
|
|
|
|
|
- dbg(DEBUG_ANY,
|
|
|
|
- "%s: Check if device matches .. (Vendor: 0x%x, Product: 0x%x)",
|
|
|
|
- __func__, le16_to_cpu(udev->descriptor.idVendor),
|
|
|
|
- le16_to_cpu(udev->descriptor.idProduct));
|
|
|
|
|
|
+ gig_dbg(DEBUG_ANY,
|
|
|
|
+ "%s: Check if device matches .. (Vendor: 0x%x, Product: 0x%x)",
|
|
|
|
+ __func__, le16_to_cpu(udev->descriptor.idVendor),
|
|
|
|
+ le16_to_cpu(udev->descriptor.idProduct));
|
|
|
|
|
|
/* See if the device offered us matches what we can accept */
|
|
/* See if the device offered us matches what we can accept */
|
|
if ((le16_to_cpu(udev->descriptor.idVendor) != USB_GIGA_VENDOR_ID) ||
|
|
if ((le16_to_cpu(udev->descriptor.idVendor) != USB_GIGA_VENDOR_ID) ||
|
|
@@ -2112,20 +2173,21 @@ static int gigaset_probe(struct usb_interface *interface,
|
|
le16_to_cpu(udev->descriptor.idProduct) != USB_4175_PRODUCT_ID &&
|
|
le16_to_cpu(udev->descriptor.idProduct) != USB_4175_PRODUCT_ID &&
|
|
le16_to_cpu(udev->descriptor.idProduct) != USB_SX303_PRODUCT_ID &&
|
|
le16_to_cpu(udev->descriptor.idProduct) != USB_SX303_PRODUCT_ID &&
|
|
le16_to_cpu(udev->descriptor.idProduct) != USB_SX353_PRODUCT_ID)) {
|
|
le16_to_cpu(udev->descriptor.idProduct) != USB_SX353_PRODUCT_ID)) {
|
|
- dbg(DEBUG_ANY, "%s: unmatched ID - exiting", __func__);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ANY, "%s: unmatched ID - exiting", __func__);
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
|
|
/* set required alternate setting */
|
|
/* set required alternate setting */
|
|
hostif = interface->cur_altsetting;
|
|
hostif = interface->cur_altsetting;
|
|
if (hostif->desc.bAlternateSetting != 3) {
|
|
if (hostif->desc.bAlternateSetting != 3) {
|
|
- dbg(DEBUG_ANY,
|
|
|
|
- "%s: wrong alternate setting %d - trying to switch",
|
|
|
|
- __func__, hostif->desc.bAlternateSetting);
|
|
|
|
|
|
+ gig_dbg(DEBUG_ANY,
|
|
|
|
+ "%s: wrong alternate setting %d - trying to switch",
|
|
|
|
+ __func__, hostif->desc.bAlternateSetting);
|
|
if (usb_set_interface(udev, hostif->desc.bInterfaceNumber, 3) < 0) {
|
|
if (usb_set_interface(udev, hostif->desc.bInterfaceNumber, 3) < 0) {
|
|
- warn("usb_set_interface failed, device %d interface %d altsetting %d",
|
|
|
|
- udev->devnum, hostif->desc.bInterfaceNumber,
|
|
|
|
- hostif->desc.bAlternateSetting);
|
|
|
|
|
|
+ dev_warn(&udev->dev, "usb_set_interface failed, "
|
|
|
|
+ "device %d interface %d altsetting %d\n",
|
|
|
|
+ udev->devnum, hostif->desc.bInterfaceNumber,
|
|
|
|
+ hostif->desc.bAlternateSetting);
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
hostif = interface->cur_altsetting;
|
|
hostif = interface->cur_altsetting;
|
|
@@ -2134,23 +2196,28 @@ static int gigaset_probe(struct usb_interface *interface,
|
|
/* Reject application specific interfaces
|
|
/* Reject application specific interfaces
|
|
*/
|
|
*/
|
|
if (hostif->desc.bInterfaceClass != 255) {
|
|
if (hostif->desc.bInterfaceClass != 255) {
|
|
- warn("%s: bInterfaceClass == %d",
|
|
|
|
- __func__, hostif->desc.bInterfaceClass);
|
|
|
|
|
|
+ dev_warn(&udev->dev, "%s: bInterfaceClass == %d\n",
|
|
|
|
+ __func__, hostif->desc.bInterfaceClass);
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
|
|
- info("%s: Device matched (Vendor: 0x%x, Product: 0x%x)",
|
|
|
|
- __func__, le16_to_cpu(udev->descriptor.idVendor),
|
|
|
|
- le16_to_cpu(udev->descriptor.idProduct));
|
|
|
|
|
|
+ dev_info(&udev->dev,
|
|
|
|
+ "%s: Device matched (Vendor: 0x%x, Product: 0x%x)\n",
|
|
|
|
+ __func__, le16_to_cpu(udev->descriptor.idVendor),
|
|
|
|
+ le16_to_cpu(udev->descriptor.idProduct));
|
|
|
|
|
|
cs = gigaset_getunassignedcs(driver);
|
|
cs = gigaset_getunassignedcs(driver);
|
|
if (!cs) {
|
|
if (!cs) {
|
|
- err("%s: no free cardstate", __func__);
|
|
|
|
|
|
+ dev_err(&udev->dev, "no free cardstate\n");
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
ucs = cs->hw.bas;
|
|
ucs = cs->hw.bas;
|
|
|
|
+
|
|
|
|
+ /* save off device structure ptrs for later use */
|
|
|
|
+ usb_get_dev(udev);
|
|
ucs->udev = udev;
|
|
ucs->udev = udev;
|
|
ucs->interface = interface;
|
|
ucs->interface = interface;
|
|
|
|
+ cs->dev = &udev->dev;
|
|
|
|
|
|
/* allocate URBs:
|
|
/* allocate URBs:
|
|
* - one for the interrupt pipe
|
|
* - one for the interrupt pipe
|
|
@@ -2159,22 +2226,22 @@ static int gigaset_probe(struct usb_interface *interface,
|
|
*/
|
|
*/
|
|
ucs->urb_int_in = usb_alloc_urb(0, SLAB_KERNEL);
|
|
ucs->urb_int_in = usb_alloc_urb(0, SLAB_KERNEL);
|
|
if (!ucs->urb_int_in) {
|
|
if (!ucs->urb_int_in) {
|
|
- err("No free urbs available");
|
|
|
|
|
|
+ dev_err(cs->dev, "no free urbs available\n");
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
ucs->urb_cmd_in = usb_alloc_urb(0, SLAB_KERNEL);
|
|
ucs->urb_cmd_in = usb_alloc_urb(0, SLAB_KERNEL);
|
|
if (!ucs->urb_cmd_in) {
|
|
if (!ucs->urb_cmd_in) {
|
|
- err("No free urbs available");
|
|
|
|
|
|
+ dev_err(cs->dev, "no free urbs available\n");
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
ucs->urb_cmd_out = usb_alloc_urb(0, SLAB_KERNEL);
|
|
ucs->urb_cmd_out = usb_alloc_urb(0, SLAB_KERNEL);
|
|
if (!ucs->urb_cmd_out) {
|
|
if (!ucs->urb_cmd_out) {
|
|
- err("No free urbs available");
|
|
|
|
|
|
+ dev_err(cs->dev, "no free urbs available\n");
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
ucs->urb_ctrl = usb_alloc_urb(0, SLAB_KERNEL);
|
|
ucs->urb_ctrl = usb_alloc_urb(0, SLAB_KERNEL);
|
|
if (!ucs->urb_ctrl) {
|
|
if (!ucs->urb_ctrl) {
|
|
- err("No free urbs available");
|
|
|
|
|
|
+ dev_err(cs->dev, "no free urbs available\n");
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -2184,7 +2251,7 @@ static int gigaset_probe(struct usb_interface *interface,
|
|
ubc->isoouturbs[i].urb =
|
|
ubc->isoouturbs[i].urb =
|
|
usb_alloc_urb(BAS_NUMFRAMES, SLAB_KERNEL);
|
|
usb_alloc_urb(BAS_NUMFRAMES, SLAB_KERNEL);
|
|
if (!ubc->isoouturbs[i].urb) {
|
|
if (!ubc->isoouturbs[i].urb) {
|
|
- err("No free urbs available");
|
|
|
|
|
|
+ dev_err(cs->dev, "no free urbs available\n");
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -2192,7 +2259,7 @@ static int gigaset_probe(struct usb_interface *interface,
|
|
ubc->isoinurbs[i] =
|
|
ubc->isoinurbs[i] =
|
|
usb_alloc_urb(BAS_NUMFRAMES, SLAB_KERNEL);
|
|
usb_alloc_urb(BAS_NUMFRAMES, SLAB_KERNEL);
|
|
if (!ubc->isoinurbs[i]) {
|
|
if (!ubc->isoinurbs[i]) {
|
|
- err("No free urbs available");
|
|
|
|
|
|
+ dev_err(cs->dev, "no free urbs available\n");
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -2204,13 +2271,14 @@ static int gigaset_probe(struct usb_interface *interface,
|
|
/* Fill the interrupt urb and send it to the core */
|
|
/* Fill the interrupt urb and send it to the core */
|
|
endpoint = &hostif->endpoint[0].desc;
|
|
endpoint = &hostif->endpoint[0].desc;
|
|
usb_fill_int_urb(ucs->urb_int_in, udev,
|
|
usb_fill_int_urb(ucs->urb_int_in, udev,
|
|
- usb_rcvintpipe(udev,
|
|
|
|
- (endpoint->bEndpointAddress) & 0x0f),
|
|
|
|
- ucs->int_in_buf, 3, read_int_callback, cs,
|
|
|
|
- endpoint->bInterval);
|
|
|
|
|
|
+ usb_rcvintpipe(udev,
|
|
|
|
+ (endpoint->bEndpointAddress) & 0x0f),
|
|
|
|
+ ucs->int_in_buf, 3, read_int_callback, cs,
|
|
|
|
+ endpoint->bInterval);
|
|
ret = usb_submit_urb(ucs->urb_int_in, SLAB_KERNEL);
|
|
ret = usb_submit_urb(ucs->urb_int_in, SLAB_KERNEL);
|
|
if (ret) {
|
|
if (ret) {
|
|
- err("could not submit interrupt URB: %s", get_usb_statmsg(ret));
|
|
|
|
|
|
+ dev_err(cs->dev, "could not submit interrupt URB: %s\n",
|
|
|
|
+ get_usb_statmsg(ret));
|
|
goto error;
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -2255,7 +2323,7 @@ static void gigaset_disconnect(struct usb_interface *interface)
|
|
ucs = cs->hw.bas;
|
|
ucs = cs->hw.bas;
|
|
IFNULLRET(ucs);
|
|
IFNULLRET(ucs);
|
|
|
|
|
|
- info("disconnecting GigaSet base");
|
|
|
|
|
|
+ dev_info(cs->dev, "disconnecting GigaSet base");
|
|
gigaset_stop(cs);
|
|
gigaset_stop(cs);
|
|
freeurbs(cs);
|
|
freeurbs(cs);
|
|
kfree(ucs->rcvbuf);
|
|
kfree(ucs->rcvbuf);
|
|
@@ -2293,9 +2361,9 @@ static int __init bas_gigaset_init(void)
|
|
|
|
|
|
/* allocate memory for our driver state and intialize it */
|
|
/* allocate memory for our driver state and intialize it */
|
|
if ((driver = gigaset_initdriver(GIGASET_MINOR, GIGASET_MINORS,
|
|
if ((driver = gigaset_initdriver(GIGASET_MINOR, GIGASET_MINORS,
|
|
- GIGASET_MODULENAME, GIGASET_DEVNAME,
|
|
|
|
- GIGASET_DEVFSNAME, &gigops,
|
|
|
|
- THIS_MODULE)) == NULL)
|
|
|
|
|
|
+ GIGASET_MODULENAME, GIGASET_DEVNAME,
|
|
|
|
+ GIGASET_DEVFSNAME, &gigops,
|
|
|
|
+ THIS_MODULE)) == NULL)
|
|
goto error;
|
|
goto error;
|
|
|
|
|
|
/* allocate memory for our device state and intialize it */
|
|
/* allocate memory for our device state and intialize it */
|
|
@@ -2330,19 +2398,18 @@ error: if (cardstate)
|
|
static void __exit bas_gigaset_exit(void)
|
|
static void __exit bas_gigaset_exit(void)
|
|
{
|
|
{
|
|
gigaset_blockdriver(driver); /* => probe will fail
|
|
gigaset_blockdriver(driver); /* => probe will fail
|
|
- * => no gigaset_start any more
|
|
|
|
- */
|
|
|
|
|
|
+ * => no gigaset_start any more
|
|
|
|
+ */
|
|
|
|
|
|
gigaset_shutdown(cardstate);
|
|
gigaset_shutdown(cardstate);
|
|
/* from now on, no isdn callback should be possible */
|
|
/* from now on, no isdn callback should be possible */
|
|
|
|
|
|
if (atomic_read(&cardstate->hw.bas->basstate) & BS_ATOPEN) {
|
|
if (atomic_read(&cardstate->hw.bas->basstate) & BS_ATOPEN) {
|
|
- dbg(DEBUG_ANY, "closing AT channel");
|
|
|
|
|
|
+ gig_dbg(DEBUG_ANY, "closing AT channel");
|
|
if (req_submit(cardstate->bcs,
|
|
if (req_submit(cardstate->bcs,
|
|
- HD_CLOSE_ATCHANNEL, 0, BAS_TIMEOUT) >= 0) {
|
|
|
|
- /* successfully submitted - wait for completion */
|
|
|
|
- //wait_event_interruptible(cs->initwait, !cs->hw.bas->pending);
|
|
|
|
- //FIXME need own wait queue? wakeup?
|
|
|
|
|
|
+ HD_CLOSE_ATCHANNEL, 0, BAS_TIMEOUT) >= 0) {
|
|
|
|
+ /* successfully submitted */
|
|
|
|
+ //FIXME wait for completion?
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|