While waiting for a <CR> the code would search through prevois received
characters, too. Keep track of what we've already checked to speed this
up.
-static void elm327_parse_rxbuf(struct can327 *elm)
+static void elm327_parse_rxbuf(struct can327 *elm, size_t first_new_char_idx)
lockdep_assert_held(&elm->lock);
lockdep_assert_held(&elm->lock);
case ELM327_STATE_GETDUMMYCHAR:
/* Wait for 'y' or '>' */
case ELM327_STATE_GETDUMMYCHAR:
/* Wait for 'y' or '>' */
- for (i = 0; i < elm->rxfill; i++) {
- if (elm->rxbuf[i] == ELM327_DUMMY_CHAR) {
+ for (pos = 0; pos < elm->rxfill; pos++) {
+ if (elm->rxbuf[pos] == ELM327_DUMMY_CHAR) {
elm327_send(elm, "\r", 1);
elm->state = ELM327_STATE_GETPROMPT;
elm327_send(elm, "\r", 1);
elm->state = ELM327_STATE_GETPROMPT;
- } else if (elm327_is_ready_char(elm->rxbuf[i])) {
+ } else if (elm327_is_ready_char(elm->rxbuf[pos])) {
elm327_send(elm, ELM327_DUMMY_STRING, 1);
elm327_send(elm, ELM327_DUMMY_STRING, 1);
- elm327_drop_bytes(elm, i);
+ elm327_drop_bytes(elm, pos);
break;
case ELM327_STATE_GETPROMPT:
break;
case ELM327_STATE_GETPROMPT:
case ELM327_STATE_RECEIVING:
/* Find <CR> delimiting feedback lines. */
case ELM327_STATE_RECEIVING:
/* Find <CR> delimiting feedback lines. */
+ len = first_new_char_idx;
while (len < elm->rxfill && elm->rxbuf[len] != '\r')
len++;
while (len < elm->rxfill && elm->rxbuf[len] != '\r')
len++;
/* More data to parse? */
if (elm->rxfill)
/* More data to parse? */
if (elm->rxfill)
- elm327_parse_rxbuf(elm);
+ elm327_parse_rxbuf(elm, 0);
#endif
{
struct can327 *elm = (struct can327 *)tty->disc_data;
#endif
{
struct can327 *elm = (struct can327 *)tty->disc_data;
+ size_t first_new_char_idx;
if (elm->uart_side_failure)
return;
spin_lock_bh(&elm->lock);
if (elm->uart_side_failure)
return;
spin_lock_bh(&elm->lock);
+ /* Store old rxfill, so elm327_parse_rxbuf() will have
+ * the option of skipping already checked characters.
+ */
+ first_new_char_idx = elm->rxfill;
+
while (count-- && elm->rxfill < ELM327_SIZE_RXBUF) {
if (fp && *fp++) {
netdev_err(elm->dev, "Error in received character stream. Check your wiring.");
while (count-- && elm->rxfill < ELM327_SIZE_RXBUF) {
if (fp && *fp++) {
netdev_err(elm->dev, "Error in received character stream. Check your wiring.");
- elm327_parse_rxbuf(elm);
+ elm327_parse_rxbuf(elm, first_new_char_idx);
spin_unlock_bh(&elm->lock);
}
spin_unlock_bh(&elm->lock);
}