summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--ftm5/fts.c5
-rw-r--r--ftm5/fts_lib/ftsSoftware.h1
2 files changed, 6 insertions, 0 deletions
diff --git a/ftm5/fts.c b/ftm5/fts.c
index 9d26a60..889d3ae 100644
--- a/ftm5/fts.c
+++ b/ftm5/fts.c
@@ -4007,6 +4007,11 @@ static irqreturn_t fts_interrupt_handler(int irq, void *handle)
for (count = 0; count < events_remaining + 1; count++) {
evt_data = &data[count * FIFO_EVENT_SIZE];
+ if (!VALID_EVENT_TYPE(evt_data[0])) {
+ dev_err(info->dev, "Got invalid event type: %*ph\n", 8, evt_data);
+ goto exit;
+ }
+
switch (GET_EVENT_TYPE(evt_data[0])) {
case EVT_ID_CONTROLLER_READY:
case EVT_ID_ERROR:
diff --git a/ftm5/fts_lib/ftsSoftware.h b/ftm5/fts_lib/ftsSoftware.h
index c5adb31..9f1c30c 100644
--- a/ftm5/fts_lib/ftsSoftware.h
+++ b/ftm5/fts_lib/ftsSoftware.h
@@ -375,6 +375,7 @@ enum {
/** @}*/
/* bit2 and bit3 are for major data so skip it. */
#define GET_EVENT_TYPE(event_data) (event_data & 0xF3)
+#define VALID_EVENT_TYPE(event_data) ((event_data & 0x03) == 0x03)
/* EVENT ID */
/** @defgroup events_group FW Event IDs and Types
* Event IDs and Types pushed by the FW into the FIFO