A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-09 05:39:54 -04:00
Code Issues Projects Releases Packages Wiki Activity

Merge "HID: qvr: Removing axis orientation"

Browse source
This commit is contained in:
qctecmdr 2020-03-29 00:33:17 -07:00 • committed by Gerrit - the friendly Code Review server
commit e96549e852
1 changed files with 18 additions and 26 deletions
Download patch file Download diff file Expand all files Collapse all files

44
drivers/hid/hid-qvr.c
View file

@ -106,7 +106,6 @@ struct qvr_external_sensor {
static DECLARE_WAIT_QUEUE_HEAD(wq);
static struct qvr_external_sensor qvr_external_sensor;
static uint8_t DEBUG_ORIENTATION;
static int read_calibration_len(void)
{
@ -256,10 +255,6 @@ static int qvr_send_package_wrap(u8 *message, int msize, struct hid_device *hid)
memcpy((void *)&imuData, (void *)message,
sizeof(struct external_imu_format));
if (!sensor->ts_base) {
if (imuData.gNumerator == 1 && imuData.aNumerator == 1)
DEBUG_ORIENTATION = 1;
else
DEBUG_ORIENTATION = 0;
pr_debug("qvr msize = %d reportID=%d padding=%d\n"
"qvr version=%d numImu=%d nspip=%d pSize=%d\n"
"qvr imuID=%d sampleID=%d temp=%d\n",
@ -303,27 +298,24 @@ static int qvr_send_package_wrap(u8 *message, int msize, struct hid_device *hid)
data->mts = data->ats;
data->gts = data->ats;
if (DEBUG_ORIENTATION == 1) {
data->ax = -imuData.ax0;
data->ay = imuData.ay0;
data->az = -imuData.az0;
data->gx = -imuData.gx0;
data->gy = imuData.gy0;
data->gz = -imuData.gz0;
data->mx = -imuData.my0;
data->my = -imuData.mx0;
data->mz = -imuData.mz0;
} else {
data->ax = -imuData.ay0;
data->ay = -imuData.ax0;
data->az = -imuData.az0;
data->gx = -imuData.gy0;
data->gy = -imuData.gx0;
data->gz = -imuData.gz0;
data->mx = -imuData.my0;
data->my = -imuData.mx0;
data->mz = -imuData.mz0;
}
data->ax = imuData.ax0;
data->ay = imuData.ay0;
data->az = imuData.az0;
data->gx = imuData.gx0;
data->gy = imuData.gy0;
data->gz = imuData.gz0;
data->mx = imuData.my0;
data->my = imuData.mx0;
data->mz = imuData.mz0;
data->ax = imuData.ax0;
data->ay = imuData.ay0;
data->az = imuData.az0;
data->gx = imuData.gx0;
data->gy = imuData.gy0;
data->gz = imuData.gz0;
data->mx = imuData.my0;
data->my = imuData.mx0;
data->mz = imuData.mz0;
trace_qvr_recv_sensor("gyro", data->gts, data->gx, data->gy, data->gz);
trace_qvr_recv_sensor("accel", data->ats, data->ax, data->ay, data->az);