From 64108d4ba0c5ddb141014b813dd978d4ed4303cf Mon Sep 17 00:00:00 2001 From: rbandi Date: Fri, 2 Nov 2018 15:36:18 -0700 Subject: [PATCH] HID: Filtering mag data depending on timestamp Need this fix to filter updated mag data. Change-Id: Idaa4f18c6473182c3ac6b81f4f15bcde5526834c Signed-off-by: rbandi --- drivers/hid/hid-qvr.c | 5 ++++- 1 file changed, 4 insertions(+), 1 deletion(-) diff --git a/drivers/hid/hid-qvr.c b/drivers/hid/hid-qvr.c index b0107c727c92..dd4e1c4d31aa 100644 --- a/drivers/hid/hid-qvr.c +++ b/drivers/hid/hid-qvr.c @@ -112,8 +112,11 @@ int qvr_send_package_wrap(u8 *message, int msize, struct hid_device *hid) data->ats = ts_base + ((ts_offset - imuData.gts0) * 100); else data->ats = ts_base + ((imuData.gts0 - ts_offset) * 100); + if (imuData.mts0 == 0) + data->mts = 0; + else + data->mts = data->ats; data->gts = data->ats; - data->mts = data->ats; data->ax = -imuData.ax0; data->ay = imuData.ay0; data->az = -imuData.az0;