1 files changed, 77 insertions, 0 deletions
diff --git a/input_hal/src/input_util.cpp b/input_hal/src/input_util.cpp
new file mode 100644
index 00000000..bb349ebd
--- /dev/null
+++ b/input_hal/src/input_util.cpp
@@ -0,0 +1,77 @@
+/*
+ * @copyright Copyright (c) 2018-2020 TOYOTA MOTOR CORPORATION.
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *      http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+#include "input_util.h"
+
+#include <native_service/ns_message_center_if.h>
+#include <stdio.h>
+
+#include "input_hal.h"
+#include "input_hal_debug.h"
+
+#define INPUT_UTIL_MESSAGE_SEND_RETRY    3
+#define INPUT_UTIL_MESSAGE_SEND_WAIT     10000   /* RetryWait:10ms */
+/*
+ * InputUtilListAdd
+ */
+void InputUtilListAdd(struct InputUtilList *node_new, struct InputUtilList *node_head) {
+  node_new->prev = node_head;
+  node_new->next  = node_head->next;
+  node_head->next = node_new;
+  node_new->next->prev = node_new;
+}
+
+/*
+ * InputUtilListDelete
+ */
+void InputUtilListDelete(struct InputUtilList *node) {
+  node->prev->next = node->next;
+  node->next->prev = node->prev;
+}
+
+/*
+ * InputUtilMCSend
+ */
+int InputUtilMCSend(HANDLE h_message, PCSTR source, UI_32 cmd, UI_32 length, PCVOID data) {
+  int       i = 0;
+  EFrameworkunifiedStatus      e_status;                              /* return value */
+
+  do {
+    e_status = McSend(h_message, source, cmd, length, data);
+    if (eFrameworkunifiedStatusOK == e_status) {
+      break;
+    }
+    InputUtilSleep(INPUT_UTIL_MESSAGE_SEND_WAIT);
+  } while (i++ < INPUT_UTIL_MESSAGE_SEND_RETRY);
+
+  if (e_status != eFrameworkunifiedStatusOK) {
+    INPUT_ERROR_LOG("ERR: MessageSend=%d \n", e_status);
+  }
+
+  return e_status;
+}
+
+/*
+ * InputUtilSleep
+ */
+int InputUtilSleep(int usec) {
+  struct timespec  req;
+
+  req.tv_sec = 0;
+  req.tv_nsec = usec * 1000;
+  nanosleep(&req, NULL);
+
+  return HAL_INPUT_RET_NORMAL;
+}