Sensor: Invensense: 6515: fix step counter corrupting event queue
am: f332a4e508

* commit 'f332a4e508430e15266bb7019f7132a7f7eb6dfb':
  Sensor: Invensense: 6515: fix step counter corrupting event queue
diff --git a/6515/libsensors_iio/MPLSensor.cpp b/6515/libsensors_iio/MPLSensor.cpp
index bf0fdb9..5a57d0b 100644
--- a/6515/libsensors_iio/MPLSensor.cpp
+++ b/6515/libsensors_iio/MPLSensor.cpp
@@ -3902,6 +3902,7 @@
                             count--;
                             numEventReceived++;
                             data->timestamp = mStepSensorTimestamp;
+                            data++;
                             mLastTimestamp[i] = mStepSensorTimestamp;
                         } else {
                             ALOGE("Event from type=%d with duplicate timestamp %lld discarded",
@@ -4565,6 +4566,9 @@
                 LOGV_IF(INPUT_DATA,
                     "HAL:input build step: 1 - %lld", mStepSensorTimestamp);
             } else {
+                LOGV_IF(ENG_VERBOSE, "Step data OUT OF ORDER, "
+                        "mPedUpdate = 0x%x last = %lld, ts = %lld",
+                        mPedUpdate, mStepSensorTimestamp, latestTimestamp);
                 mPedUpdate = 0;
             }
         }