[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/navigation/sensor/2.0/test/MakeTool b/src/navigation/sensor/2.0/test/MakeTool
new file mode 100644
index 0000000..46ba4f6
--- /dev/null
+++ b/src/navigation/sensor/2.0/test/MakeTool
@@ -0,0 +1,33 @@
+TARGET = high_freq_sensor_tool
+CFLAGS += -Wall -O2 -std=c++11 -pthread
+
+INCLUDES := ./
+
+CPP_FILES := main.cpp
+LIBFLAGS := -llog -lhfmanager
+
+C_FILES := $(patsubst ./%,%,$(C_FILES))
+C_OBJS := $(sort $(C_FILES:%.c=%.o))
+
+CPP_FILES := $(patsubst ./%,%,$(CPP_FILES))
+CPP_OBJS := $(sort $(CPP_FILES:%.cpp=%.o))
+
+TMP_OBJS += $(CPP_OBJS)
+TMP_OBJS += $(C_OBJS)
+OBJS += $(sort $(TMP_OBJS))
+
+INCLUDES := $(patsubst %,-I%,$(patsubst -I%,%,$(INCLUDES)))
+
+${TARGET}: ${OBJS}
+ ${CXX} ${CFLAGS} ${LDFLAGS} ${INCLUDES} -o $@ $^ -Wl,--start-group ${LIBFLAGS} -Wl,--end-group
+${CPP_OBJS}: %.o: %.cpp
+ @mkdir -p $(dir $@)
+ ${CXX} ${CFLAGS} ${LDFLAGS} ${INCLUDES} -c $^ -o $@
+${C_OBJS}: %.o: %.c
+ @mkdir -p $(dir $@)
+ ${CXX} ${CFLAGS} ${LDFLAGS} ${INCLUDES} -c $^ -o $@
+
+.PHONY: clean
+clean:
+ @rm -rf ${TARGET} ${OBJS}
+ @echo Clean done
diff --git a/src/navigation/sensor/2.0/test/MakeToolWrapper b/src/navigation/sensor/2.0/test/MakeToolWrapper
new file mode 100644
index 0000000..9d99d0e
--- /dev/null
+++ b/src/navigation/sensor/2.0/test/MakeToolWrapper
@@ -0,0 +1,33 @@
+TARGET = high_freq_sensor_tool_c_wrapper
+CFLAGS += -Wall -O2 -std=c++11 -pthread
+
+INCLUDES := ./
+
+C_FILES := main.c
+LIBFLAGS := -llog -lhfmanager
+
+C_FILES := $(patsubst ./%,%,$(C_FILES))
+C_OBJS := $(sort $(C_FILES:%.c=%.o))
+
+CPP_FILES := $(patsubst ./%,%,$(CPP_FILES))
+CPP_OBJS := $(sort $(CPP_FILES:%.cpp=%.o))
+
+TMP_OBJS += $(CPP_OBJS)
+TMP_OBJS += $(C_OBJS)
+OBJS += $(sort $(TMP_OBJS))
+
+INCLUDES := $(patsubst %,-I%,$(patsubst -I%,%,$(INCLUDES)))
+
+${TARGET}: ${OBJS}
+ ${CXX} ${CFLAGS} ${LDFLAGS} ${INCLUDES} -o $@ $^ -Wl,--start-group ${LIBFLAGS} -Wl,--end-group
+${CPP_OBJS}: %.o: %.cpp
+ @mkdir -p $(dir $@)
+ ${CXX} ${CFLAGS} ${LDFLAGS} ${INCLUDES} -c $^ -o $@
+${C_OBJS}: %.o: %.c
+ @mkdir -p $(dir $@)
+ ${CXX} ${CFLAGS} ${LDFLAGS} ${INCLUDES} -c $^ -o $@
+
+.PHONY: clean
+clean:
+ @rm -rf ${TARGET} ${OBJS}
+ @echo Clean done
diff --git a/src/navigation/sensor/2.0/test/MediatekProprietary b/src/navigation/sensor/2.0/test/MediatekProprietary
new file mode 100644
index 0000000..6e16090
--- /dev/null
+++ b/src/navigation/sensor/2.0/test/MediatekProprietary
@@ -0,0 +1,31 @@
+Copyright Statement:
+
+This software/firmware and related documentation ("MediaTek Software") are
+protected under relevant copyright laws. The information contained herein is
+confidential and proprietary to MediaTek Inc. and/or its licensors. Without
+the prior written permission of MediaTek inc. and/or its licensors, any
+reproduction, modification, use or disclosure of MediaTek Software, and
+information contained herein, in whole or in part, shall be strictly
+prohibited.
+
+MediaTek Inc. (C) 2017. All rights reserved.
+
+BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
+THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
+RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
+ON AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL
+WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
+WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
+NONINFRINGEMENT. NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH
+RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
+INCORPORATED IN, OR SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES
+TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
+RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
+OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN MEDIATEK
+SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE
+RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
+STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S
+ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE
+RELEASED HEREUNDER WILL BE, AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE
+MEDIATEK SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
+CHARGE PAID BY RECEIVER TO MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
diff --git a/src/navigation/sensor/2.0/test/main.c b/src/navigation/sensor/2.0/test/main.c
new file mode 100644
index 0000000..275c2f0
--- /dev/null
+++ b/src/navigation/sensor/2.0/test/main.c
@@ -0,0 +1,94 @@
+/*
+* Copyright Statement:
+*
+* This software/firmware and related documentation ("MediaTek Software") are
+* protected under relevant copyright laws. The information contained herein is
+* confidential and proprietary to MediaTek Inc. and/or its licensors. Without
+* the prior written permission of MediaTek inc. and/or its licensors, any
+* reproduction, modification, use or disclosure of MediaTek Software, and
+* information contained herein, in whole or in part, shall be strictly
+* prohibited.
+*
+* MediaTek Inc. (C) 2017. All rights reserved.
+*
+* BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
+* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
+* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
+* ON AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL
+* WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
+* WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
+* NONINFRINGEMENT. NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH
+* RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
+* INCORPORATED IN, OR SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES
+* TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
+* RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
+* OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN MEDIATEK
+* SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE
+* RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
+* STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S
+* ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE
+* RELEASED HEREUNDER WILL BE, AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE
+* MEDIATEK SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
+* CHARGE PAID BY RECEIVER TO MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
+*/
+
+
+#include <stdio.h>
+#include <stdint.h>
+#include <errno.h>
+#include <unistd.h>
+#include <string.h>
+#include <inttypes.h>
+#include <stdlib.h>
+#include <functional>
+
+#include <HfManagerWrapper.h>
+
+int main(int argc, char **argv) {
+ int sensor = 0, action = 0, delay = 0, latency = 0;
+ sensors_event_t data[32];
+
+ if (argc != 5) {
+ fprintf(stderr, "usage: execute sensor action delay latency\n");
+ fprintf(stderr, " ./high_freq_sensor_tool 1 1 5000000 0\n");
+ return -1;
+ }
+
+ sensor = atoi(argv[1]);
+ action = atoi(argv[2]);
+ delay = atoi(argv[3]);
+ latency = atoi(argv[4]);
+
+ fprintf(stderr, "cwrapper command: [%d,%d,%d,%d]\n", sensor, action, delay, latency);
+
+ void *mHfManager = HfManagerCreate();
+ void *mHfLooper = HfLooperCreate(HfManagerGetFd(mHfManager), 64);
+
+ if (HfManagerFindSensor(mHfManager, sensor) < 0)
+ return -2;
+ switch (action) {
+ case HF_MANAGER_SENSOR_DISABLE:
+ HfManagerDisableSensor(mHfManager, sensor);
+ break;
+ case HF_MANAGER_SENSOR_ENABLE:
+ HfManagerEnableSensor(mHfManager, sensor, delay, latency);
+ break;
+ case HF_MANAGER_SENSOR_RAWDATA:
+ HfManagerEnableRawData(mHfManager, sensor);
+ break;
+ }
+ while (1) {
+ int err = HfLooperEventLooper(mHfLooper, data, 32);
+ switch (err) {
+ case -ENODEV:
+ fprintf(stderr, "cwrapper looper stop nodevice error\n");
+ return -3;
+ }
+ for (int i = 0; i < err; ++i) {
+ fprintf(stderr, "cwrapper data: [%d,%d,%" PRId64 ",%f,%f,%f]\n",
+ data[i].sensor, data[i].reserved0, data[i].timestamp,
+ data[i].data[0], data[i].data[1], data[i].data[2]);
+ }
+ }
+ return 0;
+}
diff --git a/src/navigation/sensor/2.0/test/main.cpp b/src/navigation/sensor/2.0/test/main.cpp
new file mode 100644
index 0000000..1126b7d
--- /dev/null
+++ b/src/navigation/sensor/2.0/test/main.cpp
@@ -0,0 +1,102 @@
+/*
+* Copyright Statement:
+*
+* This software/firmware and related documentation ("MediaTek Software") are
+* protected under relevant copyright laws. The information contained herein is
+* confidential and proprietary to MediaTek Inc. and/or its licensors. Without
+* the prior written permission of MediaTek inc. and/or its licensors, any
+* reproduction, modification, use or disclosure of MediaTek Software, and
+* information contained herein, in whole or in part, shall be strictly
+* prohibited.
+*
+* MediaTek Inc. (C) 2017. All rights reserved.
+*
+* BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
+* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
+* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
+* ON AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL
+* WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
+* WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
+* NONINFRINGEMENT. NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH
+* RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
+* INCORPORATED IN, OR SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES
+* TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
+* RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
+* OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN MEDIATEK
+* SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE
+* RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
+* STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S
+* ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE
+* RELEASED HEREUNDER WILL BE, AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE
+* MEDIATEK SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
+* CHARGE PAID BY RECEIVER TO MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
+*/
+
+#include <stdint.h>
+#include <errno.h>
+#include <unistd.h>
+#include <string.h>
+#include <inttypes.h>
+
+#include <memory>
+#include <thread>
+#include <functional>
+
+#include <HfManager.h>
+
+int main(int argc, char **argv) {
+ int fd = -1;
+ int sensor = 0, action = 0, delay = 0, latency = 0;
+
+ if (argc != 5) {
+ fprintf(stderr, "usage: execute sensor action delay latency\n");
+ fprintf(stderr, " ./high_freq_sensor_tool 1 1 5000000 0\n");
+ return -1;
+ }
+
+ sensor = atoi(argv[1]);
+ action = atoi(argv[2]);
+ delay = atoi(argv[3]);
+ latency = atoi(argv[4]);
+
+ fprintf(stderr, "command: [%d,%d,%d,%d]\n", sensor, action, delay, latency);
+
+ std::unique_ptr<HfManager> mHfManager(new HfManager());
+ fd = mHfManager->getFd();
+ std::thread looperThread([fd]() {
+ std::unique_ptr<HfLooper> mHfLooper(new HfLooper(fd, 64));
+ while (1) {
+ int err = mHfLooper->eventLooper([](sensors_event_t const * event) {
+ fprintf(stderr, "data: [%d,%d,%" PRId64 ",%f,%f,%f]\n",
+ event->sensor, event->reserved0, event->timestamp,
+ event->data[0], event->data[1], event->data[2]);
+ });
+ switch (err) {
+ case -ENODEV:
+ fprintf(stderr, "looper stop nodevice error\n");
+ return;
+ }
+ };
+ });
+ looperThread.detach();
+ if (mHfManager->findSensor(sensor) < 0)
+ return -2;
+ switch (action) {
+ case HF_MANAGER_SENSOR_DISABLE:
+ mHfManager->disableSensor(sensor);
+ break;
+ case HF_MANAGER_SENSOR_ENABLE:
+ mHfManager->enableSensor(sensor, delay, latency);
+ break;
+ case HF_MANAGER_SENSOR_ENABLE_CALI:
+ mHfManager->requestFactoryCalibration(sensor, true);
+ mHfManager->enableFactoryCalibration(sensor);
+ break;
+ case HF_MANAGER_SENSOR_RAWDATA:
+ mHfManager->enableRawData(sensor);
+ break;
+ }
+ while (1)
+ sleep(1);
+ return 0;
+}