xref: /aosp_15_r20/system/core/fastboot/tcp.cpp (revision 00c7fec1bb09f3284aad6a6f96d2f63dfc3650ad)
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