1 /*
2 * Copyright (C) 2017 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17 #define LOG_TAG "SocketComm"
18
19 #include <android/hardware/automotive/vehicle/2.0/IVehicle.h>
20 #include <android/log.h>
21 #include <log/log.h>
22 #include <netinet/in.h>
23 #include <sys/socket.h>
24
25 #include "SocketComm.h"
26
27 // Socket to use when communicating with Host PC
28 static constexpr int DEBUG_SOCKET = 33452;
29
30 namespace android {
31 namespace hardware {
32 namespace automotive {
33 namespace vehicle {
34 namespace V2_0 {
35
36 namespace impl {
37
SocketComm()38 SocketComm::SocketComm() {
39 // Initialize member vars
40 mCurSockFd = -1;
41 mExit = 0;
42 mSockFd = -1;
43 }
44
45
~SocketComm()46 SocketComm::~SocketComm() {
47 stop();
48 }
49
connect()50 int SocketComm::connect() {
51 sockaddr_in cliAddr;
52 socklen_t cliLen = sizeof(cliAddr);
53 int cSockFd = accept(mSockFd, reinterpret_cast<struct sockaddr*>(&cliAddr), &cliLen);
54
55 if (cSockFd >= 0) {
56 {
57 std::lock_guard<std::mutex> lock(mMutex);
58 mCurSockFd = cSockFd;
59 }
60 ALOGD("%s: Incoming connection received on socket %d", __FUNCTION__, cSockFd);
61 } else {
62 cSockFd = -1;
63 }
64
65 return cSockFd;
66 }
67
open()68 int SocketComm::open() {
69 int retVal;
70 struct sockaddr_in servAddr;
71
72 mSockFd = socket(AF_INET, SOCK_STREAM, 0);
73 if (mSockFd < 0) {
74 ALOGE("%s: socket() failed, mSockFd=%d, errno=%d", __FUNCTION__, mSockFd, errno);
75 mSockFd = -1;
76 return -errno;
77 }
78
79 memset(&servAddr, 0, sizeof(servAddr));
80 servAddr.sin_family = AF_INET;
81 servAddr.sin_addr.s_addr = INADDR_ANY;
82 servAddr.sin_port = htons(DEBUG_SOCKET);
83
84 retVal = bind(mSockFd, reinterpret_cast<struct sockaddr*>(&servAddr), sizeof(servAddr));
85 if(retVal < 0) {
86 ALOGE("%s: Error on binding: retVal=%d, errno=%d", __FUNCTION__, retVal, errno);
87 close(mSockFd);
88 mSockFd = -1;
89 return -errno;
90 }
91
92 listen(mSockFd, 1);
93
94 // Set the socket to be non-blocking so we can poll it continouously
95 fcntl(mSockFd, F_SETFL, O_NONBLOCK);
96
97 return 0;
98 }
99
read()100 std::vector<uint8_t> SocketComm::read() {
101 int32_t msgSize;
102 int numBytes = 0;
103
104 // This is a variable length message.
105 // Read the number of bytes to rx over the socket
106 numBytes = ::read(mCurSockFd, &msgSize, sizeof(msgSize));
107 msgSize = ntohl(msgSize);
108
109 if (numBytes != sizeof(msgSize)) {
110 // This happens when connection is closed
111 ALOGD("%s: numBytes=%d, expected=4", __FUNCTION__, numBytes);
112 ALOGD("%s: Connection terminated on socket %d", __FUNCTION__, mCurSockFd);
113 {
114 std::lock_guard<std::mutex> lock(mMutex);
115 mCurSockFd = -1;
116 }
117
118 return std::vector<uint8_t>();
119 }
120
121 std::vector<uint8_t> msg = std::vector<uint8_t>(msgSize);
122
123 numBytes = ::read(mCurSockFd, msg.data(), msgSize);
124
125 if ((numBytes == msgSize) && (msgSize > 0)) {
126 // Received a message.
127 return msg;
128 } else {
129 // This happens when connection is closed
130 ALOGD("%s: numBytes=%d, msgSize=%d", __FUNCTION__, numBytes, msgSize);
131 ALOGD("%s: Connection terminated on socket %d", __FUNCTION__, mCurSockFd);
132 {
133 std::lock_guard<std::mutex> lock(mMutex);
134 mCurSockFd = -1;
135 }
136
137 return std::vector<uint8_t>();
138 }
139 }
140
stop()141 void SocketComm::stop() {
142 if (mExit == 0) {
143 std::lock_guard<std::mutex> lock(mMutex);
144 mExit = 1;
145
146 // Close emulator socket if it is open
147 if (mCurSockFd != -1) {
148 close(mCurSockFd);
149 mCurSockFd = -1;
150 }
151
152 if (mSockFd != -1) {
153 close(mSockFd);
154 mSockFd = -1;
155 }
156 }
157 }
158
write(const std::vector<uint8_t> & data)159 int SocketComm::write(const std::vector<uint8_t>& data) {
160 static constexpr int MSG_HEADER_LEN = 4;
161 int retVal = 0;
162 union {
163 uint32_t msgLen;
164 uint8_t msgLenBytes[MSG_HEADER_LEN];
165 };
166
167 // Prepare header for the message
168 msgLen = static_cast<uint32_t>(data.size());
169 msgLen = htonl(msgLen);
170
171 std::lock_guard<std::mutex> lock(mMutex);
172 if (mCurSockFd != -1) {
173 retVal = ::write(mCurSockFd, msgLenBytes, MSG_HEADER_LEN);
174
175 if (retVal == MSG_HEADER_LEN) {
176 retVal = ::write(mCurSockFd, data.data(), data.size());
177 }
178 }
179
180 return retVal;
181 }
182
183
184 } // impl
185
186 } // namespace V2_0
187 } // namespace vehicle
188 } // namespace automotive
189 } // namespace hardware
190 } // namespace android
191
192