| /* |
| * Copyright (C) 2015 The Android Open Source Project |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in |
| * the documentation and/or other materials provided with the |
| * distribution. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS |
| * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
| * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT |
| * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| * SUCH DAMAGE. |
| */ |
| |
| // This file implements the fastboot UDP protocol; see fastboot_protocol.txt for documentation. |
| |
| #include "udp.h" |
| |
| #include <errno.h> |
| #include <stdio.h> |
| |
| #include <list> |
| #include <memory> |
| #include <vector> |
| |
| #include <android-base/macros.h> |
| #include <android-base/stringprintf.h> |
| |
| #include "socket.h" |
| |
| namespace udp { |
| |
| using namespace internal; |
| |
| constexpr size_t kMinPacketSize = 512; |
| constexpr size_t kHeaderSize = 4; |
| |
| enum Index { |
| kIndexId = 0, |
| kIndexFlags = 1, |
| kIndexSeqH = 2, |
| kIndexSeqL = 3, |
| }; |
| |
| // Extracts a big-endian uint16_t from a byte array. |
| static uint16_t ExtractUint16(const uint8_t* bytes) { |
| return (static_cast<uint16_t>(bytes[0]) << 8) | bytes[1]; |
| } |
| |
| // Packet header handling. |
| class Header { |
| public: |
| Header(); |
| ~Header() = default; |
| |
| uint8_t id() const { return bytes_[kIndexId]; } |
| const uint8_t* bytes() const { return bytes_; } |
| |
| void Set(uint8_t id, uint16_t sequence, Flag flag); |
| |
| // Checks whether |response| is a match for this header. |
| bool Matches(const uint8_t* response); |
| |
| private: |
| uint8_t bytes_[kHeaderSize]; |
| }; |
| |
| Header::Header() { |
| Set(kIdError, 0, kFlagNone); |
| } |
| |
| void Header::Set(uint8_t id, uint16_t sequence, Flag flag) { |
| bytes_[kIndexId] = id; |
| bytes_[kIndexFlags] = flag; |
| bytes_[kIndexSeqH] = sequence >> 8; |
| bytes_[kIndexSeqL] = sequence; |
| } |
| |
| bool Header::Matches(const uint8_t* response) { |
| // Sequence numbers must be the same to match, but the response ID can either be the same |
| // or an error response which is always accepted. |
| return bytes_[kIndexSeqH] == response[kIndexSeqH] && |
| bytes_[kIndexSeqL] == response[kIndexSeqL] && |
| (bytes_[kIndexId] == response[kIndexId] || response[kIndexId] == kIdError); |
| } |
| |
| // Implements the Transport interface to work with the fastboot engine. |
| class UdpTransport : public Transport { |
| public: |
| // Factory function so we can return nullptr if initialization fails. |
| static std::unique_ptr<UdpTransport> NewTransport(std::unique_ptr<Socket> socket, |
| std::string* error); |
| ~UdpTransport() override = default; |
| |
| ssize_t Read(void* data, size_t length) override; |
| ssize_t Write(const void* data, size_t length) override; |
| int Close() override; |
| |
| private: |
| explicit UdpTransport(std::unique_ptr<Socket> socket) : socket_(std::move(socket)) {} |
| |
| // Performs the UDP initialization procedure. Returns true on success. |
| bool InitializeProtocol(std::string* error); |
| |
| // Sends |length| bytes from |data| and waits for the response packet up to |attempts| times. |
| // Continuation packets are handled automatically and any return data is written to |rx_data|. |
| // Excess bytes that cannot fit in |rx_data| are dropped. |
| // On success, returns the number of response data bytes received, which may be greater than |
| // |rx_length|. On failure, returns -1 and fills |error| on failure. |
| ssize_t SendData(Id id, const uint8_t* tx_data, size_t tx_length, uint8_t* rx_data, |
| size_t rx_length, int attempts, std::string* error); |
| |
| // Helper for SendData(); sends a single packet and handles the response. |header| specifies |
| // the initial outgoing packet information but may be modified by this function. |
| ssize_t SendSinglePacketHelper(Header* header, const uint8_t* tx_data, size_t tx_length, |
| uint8_t* rx_data, size_t rx_length, int attempts, |
| std::string* error); |
| |
| std::unique_ptr<Socket> socket_; |
| int sequence_ = -1; |
| size_t max_data_length_ = kMinPacketSize - kHeaderSize; |
| std::vector<uint8_t> rx_packet_; |
| |
| DISALLOW_COPY_AND_ASSIGN(UdpTransport); |
| }; |
| |
| std::unique_ptr<UdpTransport> UdpTransport::NewTransport(std::unique_ptr<Socket> socket, |
| std::string* error) { |
| std::unique_ptr<UdpTransport> transport(new UdpTransport(std::move(socket))); |
| |
| if (!transport->InitializeProtocol(error)) { |
| return nullptr; |
| } |
| |
| return transport; |
| } |
| |
| bool UdpTransport::InitializeProtocol(std::string* error) { |
| uint8_t rx_data[4]; |
| |
| sequence_ = 0; |
| rx_packet_.resize(kMinPacketSize); |
| |
| // First send the query packet to sync with the target. Only attempt this a small number of |
| // times so we can fail out quickly if the target isn't available. |
| ssize_t rx_bytes = SendData(kIdDeviceQuery, nullptr, 0, rx_data, sizeof(rx_data), |
| kMaxConnectAttempts, error); |
| if (rx_bytes == -1) { |
| return false; |
| } else if (rx_bytes < 2) { |
| *error = "invalid query response from target"; |
| return false; |
| } |
| // The first two bytes contain the next expected sequence number. |
| sequence_ = ExtractUint16(rx_data); |
| |
| // Now send the initialization packet with our version and maximum packet size. |
| uint8_t init_data[] = {kProtocolVersion >> 8, kProtocolVersion & 0xFF, |
| kHostMaxPacketSize >> 8, kHostMaxPacketSize & 0xFF}; |
| rx_bytes = SendData(kIdInitialization, init_data, sizeof(init_data), rx_data, sizeof(rx_data), |
| kMaxTransmissionAttempts, error); |
| if (rx_bytes == -1) { |
| return false; |
| } else if (rx_bytes < 4) { |
| *error = "invalid initialization response from target"; |
| return false; |
| } |
| |
| // The first two data bytes contain the version, the second two bytes contain the target max |
| // supported packet size, which must be at least 512 bytes. |
| uint16_t version = ExtractUint16(rx_data); |
| if (version < kProtocolVersion) { |
| *error = android::base::StringPrintf("target reported invalid protocol version %d", |
| version); |
| return false; |
| } |
| uint16_t packet_size = ExtractUint16(rx_data + 2); |
| if (packet_size < kMinPacketSize) { |
| *error = android::base::StringPrintf("target reported invalid packet size %d", packet_size); |
| return false; |
| } |
| |
| packet_size = std::min(kHostMaxPacketSize, packet_size); |
| max_data_length_ = packet_size - kHeaderSize; |
| rx_packet_.resize(packet_size); |
| |
| return true; |
| } |
| |
| // SendData() is just responsible for chunking |data| into packets until it's all been sent. |
| // Per-packet timeout/retransmission logic is done in SendSinglePacketHelper(). |
| ssize_t UdpTransport::SendData(Id id, const uint8_t* tx_data, size_t tx_length, uint8_t* rx_data, |
| size_t rx_length, int attempts, std::string* error) { |
| if (socket_ == nullptr) { |
| *error = "socket is closed"; |
| return -1; |
| } |
| |
| Header header; |
| size_t packet_data_length; |
| ssize_t ret = 0; |
| // We often send header-only packets with no data as part of the protocol, so always send at |
| // least once even if |length| == 0, then repeat until we've sent all of |data|. |
| do { |
| // Set the continuation flag and truncate packet data if needed. |
| if (tx_length > max_data_length_) { |
| packet_data_length = max_data_length_; |
| header.Set(id, sequence_, kFlagContinuation); |
| } else { |
| packet_data_length = tx_length; |
| header.Set(id, sequence_, kFlagNone); |
| } |
| |
| ssize_t bytes = SendSinglePacketHelper(&header, tx_data, packet_data_length, rx_data, |
| rx_length, attempts, error); |
| |
| // Advance our read and write buffers for the next packet. Keep going even if we run out |
| // of receive buffer space so we can detect overflows. |
| if (bytes == -1) { |
| return -1; |
| } else if (static_cast<size_t>(bytes) < rx_length) { |
| rx_data += bytes; |
| rx_length -= bytes; |
| } else { |
| rx_data = nullptr; |
| rx_length = 0; |
| } |
| |
| tx_length -= packet_data_length; |
| tx_data += packet_data_length; |
| |
| ret += bytes; |
| } while (tx_length > 0); |
| |
| return ret; |
| } |
| |
| ssize_t UdpTransport::SendSinglePacketHelper( |
| Header* header, const uint8_t* tx_data, size_t tx_length, uint8_t* rx_data, |
| size_t rx_length, const int attempts, std::string* error) { |
| ssize_t total_data_bytes = 0; |
| error->clear(); |
| |
| int attempts_left = attempts; |
| while (attempts_left > 0) { |
| if (!socket_->Send({{header->bytes(), kHeaderSize}, {tx_data, tx_length}})) { |
| *error = Socket::GetErrorMessage(); |
| return -1; |
| } |
| |
| // Keep receiving until we get a matching response or we timeout. |
| ssize_t bytes = 0; |
| do { |
| bytes = socket_->Receive(rx_packet_.data(), rx_packet_.size(), kResponseTimeoutMs); |
| if (bytes == -1) { |
| if (socket_->ReceiveTimedOut()) { |
| break; |
| } |
| *error = Socket::GetErrorMessage(); |
| return -1; |
| } else if (bytes < static_cast<ssize_t>(kHeaderSize)) { |
| *error = "protocol error: incomplete header"; |
| return -1; |
| } |
| } while (!header->Matches(rx_packet_.data())); |
| |
| if (socket_->ReceiveTimedOut()) { |
| --attempts_left; |
| continue; |
| } |
| ++sequence_; |
| |
| // Save to |error| or |rx_data| as appropriate. |
| if (rx_packet_[kIndexId] == kIdError) { |
| error->append(rx_packet_.data() + kHeaderSize, rx_packet_.data() + bytes); |
| } else { |
| total_data_bytes += bytes - kHeaderSize; |
| size_t rx_data_bytes = std::min<size_t>(bytes - kHeaderSize, rx_length); |
| if (rx_data_bytes > 0) { |
| memcpy(rx_data, rx_packet_.data() + kHeaderSize, rx_data_bytes); |
| rx_data += rx_data_bytes; |
| rx_length -= rx_data_bytes; |
| } |
| } |
| |
| // If the response has a continuation flag we need to prompt for more data by sending |
| // an empty packet. |
| if (rx_packet_[kIndexFlags] & kFlagContinuation) { |
| // We got a valid response so reset our attempt counter. |
| attempts_left = attempts; |
| header->Set(rx_packet_[kIndexId], sequence_, kFlagNone); |
| tx_data = nullptr; |
| tx_length = 0; |
| continue; |
| } |
| |
| break; |
| } |
| |
| if (attempts_left <= 0) { |
| *error = "no response from target"; |
| return -1; |
| } |
| |
| if (rx_packet_[kIndexId] == kIdError) { |
| *error = "target reported error: " + *error; |
| return -1; |
| } |
| |
| return total_data_bytes; |
| } |
| |
| ssize_t UdpTransport::Read(void* data, size_t length) { |
| // Read from the target by sending an empty packet. |
| std::string error; |
| ssize_t bytes = SendData(kIdFastboot, nullptr, 0, reinterpret_cast<uint8_t*>(data), length, |
| kMaxTransmissionAttempts, &error); |
| |
| if (bytes == -1) { |
| fprintf(stderr, "UDP error: %s\n", error.c_str()); |
| return -1; |
| } else if (static_cast<size_t>(bytes) > length) { |
| // Fastboot protocol error: the target sent more data than our fastboot engine was prepared |
| // to receive. |
| fprintf(stderr, "UDP error: receive overflow, target sent too much fastboot data\n"); |
| return -1; |
| } |
| |
| return bytes; |
| } |
| |
| ssize_t UdpTransport::Write(const void* data, size_t length) { |
| std::string error; |
| ssize_t bytes = SendData(kIdFastboot, reinterpret_cast<const uint8_t*>(data), length, nullptr, |
| 0, kMaxTransmissionAttempts, &error); |
| |
| if (bytes == -1) { |
| fprintf(stderr, "UDP error: %s\n", error.c_str()); |
| return -1; |
| } else if (bytes > 0) { |
| // UDP protocol error: only empty ACK packets are allowed when writing to a device. |
| fprintf(stderr, "UDP error: target sent fastboot data out-of-turn\n"); |
| return -1; |
| } |
| |
| return length; |
| } |
| |
| int UdpTransport::Close() { |
| if (socket_ == nullptr) { |
| return 0; |
| } |
| |
| int result = socket_->Close(); |
| socket_.reset(); |
| return result; |
| } |
| |
| std::unique_ptr<Transport> Connect(const std::string& hostname, int port, std::string* error) { |
| return internal::Connect(Socket::NewClient(Socket::Protocol::kUdp, hostname, port, error), |
| error); |
| } |
| |
| namespace internal { |
| |
| std::unique_ptr<Transport> Connect(std::unique_ptr<Socket> sock, std::string* error) { |
| if (sock == nullptr) { |
| // If Socket creation failed |error| is already set. |
| return nullptr; |
| } |
| |
| return UdpTransport::NewTransport(std::move(sock), error); |
| } |
| |
| } // namespace internal |
| |
| } // namespace udp |