1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
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;
}
|