bt/vendor_libs/test_vendor_lib/src/packet_stream.cc

//
// Copyright 2015 The Android Open Source Project
//
// 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.
//

#define LOG_TAG "packet_stream"

#include "packet_stream.h"

#include "base/logging.h"

#include <errno.h>
#include <unistd.h>

#include "osi/include/log.h"

using std::vector;

namespace test_vendor_lib {

std::unique_ptr<CommandPacket> PacketStream::ReceiveCommand(int fd) const {
  vector<uint8_t> header;
  vector<uint8_t> params_size;
  vector<uint8_t> payload;

  if (!ReceiveAll(header, CommandPacket::kCommandHeaderSize, fd)) {
    LOG_ERROR(LOG_TAG, "Error: receiving command header.");
    return std::unique_ptr<CommandPacket>(nullptr);
  }

  if (!ReceiveAll(params_size, 1, fd)) {
    LOG_ERROR(LOG_TAG, "Error: receiving params size.");
    return std::unique_ptr<CommandPacket>(nullptr);
  }

  if (!ReceiveAll(payload, params_size[0], fd)) {
    LOG_ERROR(LOG_TAG, "Error: receiving command payload.");
    return std::unique_ptr<CommandPacket>(nullptr);
  }
  return std::unique_ptr<CommandPacket>(new CommandPacket(header, payload));
}

serial_data_type_t PacketStream::ReceivePacketType(int fd) const {
  vector<uint8_t> raw_type_octet;

  if (!ReceiveAll(raw_type_octet, 1, fd)) {
    // TODO(dennischeng): Proper error handling.
    LOG_ERROR(LOG_TAG, "Error: Could not receive packet type.");
  }

  // Check that the type octet received is in the valid range, i.e. the packet
  // must be a command or data packet.
  const serial_data_type_t type =
      static_cast<serial_data_type_t>(raw_type_octet[0]);
  if (!ValidateTypeOctet(type)) {
    // TODO(dennischeng): Proper error handling.
    LOG_ERROR(LOG_TAG, "Error: Received invalid packet type.");
  }
  return type;
}

bool PacketStream::SendEvent(std::unique_ptr<EventPacket> event, int fd) const {
  if (event->GetPayload()[0] != event->GetPayloadSize() - 1)
    LOG_WARN(LOG_TAG, "Malformed event: 0x%04X, payload size %zu, reported %u",
             event->GetEventCode(), event->GetPacketSize(),
             event->GetPayload()[0]);

  if (!SendAll({static_cast<uint8_t>(event->GetType())}, 1, fd)) {
    LOG_ERROR(LOG_TAG, "Error: Could not send event type.");
    return false;
  }

  if (!SendAll(event->GetHeader(), event->GetHeaderSize(), fd)) {
    LOG_ERROR(LOG_TAG, "Error: Could not send event header.");
    return false;
  }

  if (!SendAll(event->GetPayload(), event->GetPayloadSize(), fd)) {
    LOG_ERROR(LOG_TAG, "Error: Could not send event payload.");
    return false;
  }
  return true;
}

bool PacketStream::ValidateTypeOctet(serial_data_type_t type) const {
  // The only types of packets that should be received from the HCI are command
  // packets and data packets.
  return (type >= DATA_TYPE_COMMAND) && (type <= DATA_TYPE_SCO);
}

bool PacketStream::ReceiveAll(vector<uint8_t>& destination,
                              size_t num_octets_to_receive, int fd) const {
  destination.resize(num_octets_to_receive);
  size_t octets_remaining = num_octets_to_receive;
  while (octets_remaining > 0) {
    const int num_octets_received =
        read(fd, &destination[num_octets_to_receive - octets_remaining],
             octets_remaining);
    if (num_octets_received < 0) return false;
    octets_remaining -= num_octets_received;
  }
  return true;
}

bool PacketStream::SendAll(const vector<uint8_t>& source,
                           size_t num_octets_to_send, int fd) const {
  CHECK(source.size() >= num_octets_to_send);
  size_t octets_remaining = num_octets_to_send;
  while (octets_remaining > 0) {
    const int num_octets_sent = write(
        fd, &source[num_octets_to_send - octets_remaining], octets_remaining);
    if (num_octets_sent < 0) return false;
    octets_remaining -= num_octets_sent;
  }
  return true;
}

}  // namespace test_vendor_lib