1*00c7fec1SAndroid Build Coastguard Worker /*
2*00c7fec1SAndroid Build Coastguard Worker * Copyright (C) 2016 The Android Open Source Project
3*00c7fec1SAndroid Build Coastguard Worker * All rights reserved.
4*00c7fec1SAndroid Build Coastguard Worker *
5*00c7fec1SAndroid Build Coastguard Worker * Redistribution and use in source and binary forms, with or without
6*00c7fec1SAndroid Build Coastguard Worker * modification, are permitted provided that the following conditions
7*00c7fec1SAndroid Build Coastguard Worker * are met:
8*00c7fec1SAndroid Build Coastguard Worker * * Redistributions of source code must retain the above copyright
9*00c7fec1SAndroid Build Coastguard Worker * notice, this list of conditions and the following disclaimer.
10*00c7fec1SAndroid Build Coastguard Worker * * Redistributions in binary form must reproduce the above copyright
11*00c7fec1SAndroid Build Coastguard Worker * notice, this list of conditions and the following disclaimer in
12*00c7fec1SAndroid Build Coastguard Worker * the documentation and/or other materials provided with the
13*00c7fec1SAndroid Build Coastguard Worker * distribution.
14*00c7fec1SAndroid Build Coastguard Worker *
15*00c7fec1SAndroid Build Coastguard Worker * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
16*00c7fec1SAndroid Build Coastguard Worker * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
17*00c7fec1SAndroid Build Coastguard Worker * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
18*00c7fec1SAndroid Build Coastguard Worker * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
19*00c7fec1SAndroid Build Coastguard Worker * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
20*00c7fec1SAndroid Build Coastguard Worker * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21*00c7fec1SAndroid Build Coastguard Worker * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
22*00c7fec1SAndroid Build Coastguard Worker * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23*00c7fec1SAndroid Build Coastguard Worker * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24*00c7fec1SAndroid Build Coastguard Worker * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
25*00c7fec1SAndroid Build Coastguard Worker * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26*00c7fec1SAndroid Build Coastguard Worker * SUCH DAMAGE.
27*00c7fec1SAndroid Build Coastguard Worker */
28*00c7fec1SAndroid Build Coastguard Worker
29*00c7fec1SAndroid Build Coastguard Worker #include "tcp.h"
30*00c7fec1SAndroid Build Coastguard Worker
31*00c7fec1SAndroid Build Coastguard Worker #include <android-base/parseint.h>
32*00c7fec1SAndroid Build Coastguard Worker #include <android-base/stringprintf.h>
33*00c7fec1SAndroid Build Coastguard Worker
34*00c7fec1SAndroid Build Coastguard Worker namespace tcp {
35*00c7fec1SAndroid Build Coastguard Worker
36*00c7fec1SAndroid Build Coastguard Worker static constexpr int kProtocolVersion = 1;
37*00c7fec1SAndroid Build Coastguard Worker static constexpr size_t kHandshakeLength = 4;
38*00c7fec1SAndroid Build Coastguard Worker static constexpr int kHandshakeTimeoutMs = 2000;
39*00c7fec1SAndroid Build Coastguard Worker
40*00c7fec1SAndroid Build Coastguard Worker // Extract the big-endian 8-byte message length into a 64-bit number.
ExtractMessageLength(const void * buffer)41*00c7fec1SAndroid Build Coastguard Worker static uint64_t ExtractMessageLength(const void* buffer) {
42*00c7fec1SAndroid Build Coastguard Worker uint64_t ret = 0;
43*00c7fec1SAndroid Build Coastguard Worker for (int i = 0; i < 8; ++i) {
44*00c7fec1SAndroid Build Coastguard Worker ret |= uint64_t{reinterpret_cast<const uint8_t*>(buffer)[i]} << (56 - i * 8);
45*00c7fec1SAndroid Build Coastguard Worker }
46*00c7fec1SAndroid Build Coastguard Worker return ret;
47*00c7fec1SAndroid Build Coastguard Worker }
48*00c7fec1SAndroid Build Coastguard Worker
49*00c7fec1SAndroid Build Coastguard Worker // Encode the 64-bit number into a big-endian 8-byte message length.
EncodeMessageLength(uint64_t length,void * buffer)50*00c7fec1SAndroid Build Coastguard Worker static void EncodeMessageLength(uint64_t length, void* buffer) {
51*00c7fec1SAndroid Build Coastguard Worker for (int i = 0; i < 8; ++i) {
52*00c7fec1SAndroid Build Coastguard Worker reinterpret_cast<uint8_t*>(buffer)[i] = length >> (56 - i * 8);
53*00c7fec1SAndroid Build Coastguard Worker }
54*00c7fec1SAndroid Build Coastguard Worker }
55*00c7fec1SAndroid Build Coastguard Worker
56*00c7fec1SAndroid Build Coastguard Worker class TcpTransport : public Transport {
57*00c7fec1SAndroid Build Coastguard Worker public:
58*00c7fec1SAndroid Build Coastguard Worker // Factory function so we can return nullptr if initialization fails.
59*00c7fec1SAndroid Build Coastguard Worker static std::unique_ptr<TcpTransport> NewTransport(std::unique_ptr<Socket> socket,
60*00c7fec1SAndroid Build Coastguard Worker std::string* error);
61*00c7fec1SAndroid Build Coastguard Worker
62*00c7fec1SAndroid Build Coastguard Worker ~TcpTransport() override = default;
63*00c7fec1SAndroid Build Coastguard Worker
64*00c7fec1SAndroid Build Coastguard Worker ssize_t Read(void* data, size_t length) override;
65*00c7fec1SAndroid Build Coastguard Worker ssize_t Write(const void* data, size_t length) override;
66*00c7fec1SAndroid Build Coastguard Worker int Close() override;
67*00c7fec1SAndroid Build Coastguard Worker int Reset() override;
68*00c7fec1SAndroid Build Coastguard Worker
69*00c7fec1SAndroid Build Coastguard Worker private:
TcpTransport(std::unique_ptr<Socket> sock)70*00c7fec1SAndroid Build Coastguard Worker explicit TcpTransport(std::unique_ptr<Socket> sock) : socket_(std::move(sock)) {}
71*00c7fec1SAndroid Build Coastguard Worker
72*00c7fec1SAndroid Build Coastguard Worker // Connects to the device and performs the initial handshake. Returns false and fills |error|
73*00c7fec1SAndroid Build Coastguard Worker // on failure.
74*00c7fec1SAndroid Build Coastguard Worker bool InitializeProtocol(std::string* error);
75*00c7fec1SAndroid Build Coastguard Worker
76*00c7fec1SAndroid Build Coastguard Worker std::unique_ptr<Socket> socket_;
77*00c7fec1SAndroid Build Coastguard Worker uint64_t message_bytes_left_ = 0;
78*00c7fec1SAndroid Build Coastguard Worker
79*00c7fec1SAndroid Build Coastguard Worker DISALLOW_COPY_AND_ASSIGN(TcpTransport);
80*00c7fec1SAndroid Build Coastguard Worker };
81*00c7fec1SAndroid Build Coastguard Worker
NewTransport(std::unique_ptr<Socket> socket,std::string * error)82*00c7fec1SAndroid Build Coastguard Worker std::unique_ptr<TcpTransport> TcpTransport::NewTransport(std::unique_ptr<Socket> socket,
83*00c7fec1SAndroid Build Coastguard Worker std::string* error) {
84*00c7fec1SAndroid Build Coastguard Worker std::unique_ptr<TcpTransport> transport(new TcpTransport(std::move(socket)));
85*00c7fec1SAndroid Build Coastguard Worker
86*00c7fec1SAndroid Build Coastguard Worker if (!transport->InitializeProtocol(error)) {
87*00c7fec1SAndroid Build Coastguard Worker return nullptr;
88*00c7fec1SAndroid Build Coastguard Worker }
89*00c7fec1SAndroid Build Coastguard Worker
90*00c7fec1SAndroid Build Coastguard Worker return transport;
91*00c7fec1SAndroid Build Coastguard Worker }
92*00c7fec1SAndroid Build Coastguard Worker
93*00c7fec1SAndroid Build Coastguard Worker // These error strings are checked in tcp_test.cpp and should be kept in sync.
InitializeProtocol(std::string * error)94*00c7fec1SAndroid Build Coastguard Worker bool TcpTransport::InitializeProtocol(std::string* error) {
95*00c7fec1SAndroid Build Coastguard Worker std::string handshake_message(android::base::StringPrintf("FB%02d", kProtocolVersion));
96*00c7fec1SAndroid Build Coastguard Worker
97*00c7fec1SAndroid Build Coastguard Worker if (!socket_->Send(handshake_message.c_str(), kHandshakeLength)) {
98*00c7fec1SAndroid Build Coastguard Worker *error = android::base::StringPrintf("Failed to send initialization message (%s)",
99*00c7fec1SAndroid Build Coastguard Worker Socket::GetErrorMessage().c_str());
100*00c7fec1SAndroid Build Coastguard Worker return false;
101*00c7fec1SAndroid Build Coastguard Worker }
102*00c7fec1SAndroid Build Coastguard Worker
103*00c7fec1SAndroid Build Coastguard Worker char buffer[kHandshakeLength + 1];
104*00c7fec1SAndroid Build Coastguard Worker buffer[kHandshakeLength] = '\0';
105*00c7fec1SAndroid Build Coastguard Worker if (socket_->ReceiveAll(buffer, kHandshakeLength, kHandshakeTimeoutMs) != kHandshakeLength) {
106*00c7fec1SAndroid Build Coastguard Worker *error = android::base::StringPrintf(
107*00c7fec1SAndroid Build Coastguard Worker "No initialization message received (%s). Target may not support TCP fastboot",
108*00c7fec1SAndroid Build Coastguard Worker Socket::GetErrorMessage().c_str());
109*00c7fec1SAndroid Build Coastguard Worker return false;
110*00c7fec1SAndroid Build Coastguard Worker }
111*00c7fec1SAndroid Build Coastguard Worker
112*00c7fec1SAndroid Build Coastguard Worker if (memcmp(buffer, "FB", 2) != 0) {
113*00c7fec1SAndroid Build Coastguard Worker *error = "Unrecognized initialization message. Target may not support TCP fastboot";
114*00c7fec1SAndroid Build Coastguard Worker return false;
115*00c7fec1SAndroid Build Coastguard Worker }
116*00c7fec1SAndroid Build Coastguard Worker
117*00c7fec1SAndroid Build Coastguard Worker int version = 0;
118*00c7fec1SAndroid Build Coastguard Worker if (!android::base::ParseInt(buffer + 2, &version) || version < kProtocolVersion) {
119*00c7fec1SAndroid Build Coastguard Worker *error = android::base::StringPrintf("Unknown TCP protocol version %s (host version %02d)",
120*00c7fec1SAndroid Build Coastguard Worker buffer + 2, kProtocolVersion);
121*00c7fec1SAndroid Build Coastguard Worker return false;
122*00c7fec1SAndroid Build Coastguard Worker }
123*00c7fec1SAndroid Build Coastguard Worker
124*00c7fec1SAndroid Build Coastguard Worker error->clear();
125*00c7fec1SAndroid Build Coastguard Worker return true;
126*00c7fec1SAndroid Build Coastguard Worker }
127*00c7fec1SAndroid Build Coastguard Worker
Read(void * data,size_t length)128*00c7fec1SAndroid Build Coastguard Worker ssize_t TcpTransport::Read(void* data, size_t length) {
129*00c7fec1SAndroid Build Coastguard Worker if (socket_ == nullptr) {
130*00c7fec1SAndroid Build Coastguard Worker return -1;
131*00c7fec1SAndroid Build Coastguard Worker }
132*00c7fec1SAndroid Build Coastguard Worker
133*00c7fec1SAndroid Build Coastguard Worker // Unless we're mid-message, read the next 8-byte message length.
134*00c7fec1SAndroid Build Coastguard Worker if (message_bytes_left_ == 0) {
135*00c7fec1SAndroid Build Coastguard Worker char buffer[8];
136*00c7fec1SAndroid Build Coastguard Worker if (socket_->ReceiveAll(buffer, 8, 0) != 8) {
137*00c7fec1SAndroid Build Coastguard Worker Close();
138*00c7fec1SAndroid Build Coastguard Worker return -1;
139*00c7fec1SAndroid Build Coastguard Worker }
140*00c7fec1SAndroid Build Coastguard Worker message_bytes_left_ = ExtractMessageLength(buffer);
141*00c7fec1SAndroid Build Coastguard Worker }
142*00c7fec1SAndroid Build Coastguard Worker
143*00c7fec1SAndroid Build Coastguard Worker // Now read the message (up to |length| bytes).
144*00c7fec1SAndroid Build Coastguard Worker if (length > message_bytes_left_) {
145*00c7fec1SAndroid Build Coastguard Worker length = message_bytes_left_;
146*00c7fec1SAndroid Build Coastguard Worker }
147*00c7fec1SAndroid Build Coastguard Worker ssize_t bytes_read = socket_->ReceiveAll(data, length, 0);
148*00c7fec1SAndroid Build Coastguard Worker if (bytes_read == -1) {
149*00c7fec1SAndroid Build Coastguard Worker Close();
150*00c7fec1SAndroid Build Coastguard Worker } else {
151*00c7fec1SAndroid Build Coastguard Worker message_bytes_left_ -= bytes_read;
152*00c7fec1SAndroid Build Coastguard Worker }
153*00c7fec1SAndroid Build Coastguard Worker return bytes_read;
154*00c7fec1SAndroid Build Coastguard Worker }
155*00c7fec1SAndroid Build Coastguard Worker
Write(const void * data,size_t length)156*00c7fec1SAndroid Build Coastguard Worker ssize_t TcpTransport::Write(const void* data, size_t length) {
157*00c7fec1SAndroid Build Coastguard Worker if (socket_ == nullptr) {
158*00c7fec1SAndroid Build Coastguard Worker return -1;
159*00c7fec1SAndroid Build Coastguard Worker }
160*00c7fec1SAndroid Build Coastguard Worker
161*00c7fec1SAndroid Build Coastguard Worker // Use multi-buffer writes for better performance.
162*00c7fec1SAndroid Build Coastguard Worker char header[8];
163*00c7fec1SAndroid Build Coastguard Worker EncodeMessageLength(length, header);
164*00c7fec1SAndroid Build Coastguard Worker if (!socket_->Send(std::vector<cutils_socket_buffer_t>{{header, 8}, {data, length}})) {
165*00c7fec1SAndroid Build Coastguard Worker Close();
166*00c7fec1SAndroid Build Coastguard Worker return -1;
167*00c7fec1SAndroid Build Coastguard Worker }
168*00c7fec1SAndroid Build Coastguard Worker
169*00c7fec1SAndroid Build Coastguard Worker return length;
170*00c7fec1SAndroid Build Coastguard Worker }
171*00c7fec1SAndroid Build Coastguard Worker
Close()172*00c7fec1SAndroid Build Coastguard Worker int TcpTransport::Close() {
173*00c7fec1SAndroid Build Coastguard Worker if (socket_ == nullptr) {
174*00c7fec1SAndroid Build Coastguard Worker return 0;
175*00c7fec1SAndroid Build Coastguard Worker }
176*00c7fec1SAndroid Build Coastguard Worker
177*00c7fec1SAndroid Build Coastguard Worker int result = socket_->Close();
178*00c7fec1SAndroid Build Coastguard Worker socket_.reset();
179*00c7fec1SAndroid Build Coastguard Worker return result;
180*00c7fec1SAndroid Build Coastguard Worker }
181*00c7fec1SAndroid Build Coastguard Worker
Reset()182*00c7fec1SAndroid Build Coastguard Worker int TcpTransport::Reset() {
183*00c7fec1SAndroid Build Coastguard Worker return 0;
184*00c7fec1SAndroid Build Coastguard Worker }
185*00c7fec1SAndroid Build Coastguard Worker
Connect(const std::string & hostname,int port,std::string * error)186*00c7fec1SAndroid Build Coastguard Worker std::unique_ptr<Transport> Connect(const std::string& hostname, int port, std::string* error) {
187*00c7fec1SAndroid Build Coastguard Worker return internal::Connect(Socket::NewClient(Socket::Protocol::kTcp, hostname, port, error),
188*00c7fec1SAndroid Build Coastguard Worker error);
189*00c7fec1SAndroid Build Coastguard Worker }
190*00c7fec1SAndroid Build Coastguard Worker
191*00c7fec1SAndroid Build Coastguard Worker namespace internal {
192*00c7fec1SAndroid Build Coastguard Worker
Connect(std::unique_ptr<Socket> sock,std::string * error)193*00c7fec1SAndroid Build Coastguard Worker std::unique_ptr<Transport> Connect(std::unique_ptr<Socket> sock, std::string* error) {
194*00c7fec1SAndroid Build Coastguard Worker if (sock == nullptr) {
195*00c7fec1SAndroid Build Coastguard Worker // If Socket creation failed |error| is already set.
196*00c7fec1SAndroid Build Coastguard Worker return nullptr;
197*00c7fec1SAndroid Build Coastguard Worker }
198*00c7fec1SAndroid Build Coastguard Worker
199*00c7fec1SAndroid Build Coastguard Worker return TcpTransport::NewTransport(std::move(sock), error);
200*00c7fec1SAndroid Build Coastguard Worker }
201*00c7fec1SAndroid Build Coastguard Worker
202*00c7fec1SAndroid Build Coastguard Worker } // namespace internal
203*00c7fec1SAndroid Build Coastguard Worker
204*00c7fec1SAndroid Build Coastguard Worker } // namespace tcp
205