mukesh agrawal | 9d2165f | 2016-09-21 11:35:29 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2016 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 | |
mukesh agrawal | fd65102 | 2016-09-21 13:27:07 -0700 | [diff] [blame] | 17 | #include <cinttypes> |
| 18 | #include <cstring> |
| 19 | |
| 20 | #include "android-base/logging.h" |
mukesh agrawal | 9d2165f | 2016-09-21 11:35:29 -0700 | [diff] [blame] | 21 | |
| 22 | #include "wifilogd/message_buffer.h" |
| 23 | |
| 24 | namespace android { |
| 25 | namespace wifilogd { |
| 26 | |
mukesh agrawal | fd65102 | 2016-09-21 13:27:07 -0700 | [diff] [blame] | 27 | MessageBuffer::MessageBuffer(size_t size) |
mukesh agrawal | 6d8e220 | 2016-09-21 14:23:21 -0700 | [diff] [blame] | 28 | : data_(new uint8_t[size]), capacity_(size), read_pos_(0), write_pos_(0) { |
mukesh agrawal | 9d2165f | 2016-09-21 11:35:29 -0700 | [diff] [blame] | 29 | CHECK(size > GetHeaderSize()); |
| 30 | } |
| 31 | |
mukesh agrawal | fd65102 | 2016-09-21 13:27:07 -0700 | [diff] [blame] | 32 | bool MessageBuffer::Append(const uint8_t* message, uint16_t message_len) { |
| 33 | CHECK(message_len); |
| 34 | |
| 35 | if (!CanFitNow(message_len)) { |
| 36 | return false; |
| 37 | } |
| 38 | |
| 39 | AppendHeader(message_len); |
| 40 | AppendRawBytes(message, message_len); |
| 41 | return true; |
| 42 | } |
| 43 | |
mukesh agrawal | 0e465b4 | 2016-09-21 15:19:38 -0700 | [diff] [blame^] | 44 | bool MessageBuffer::CanFitEver(uint16_t length) const { |
| 45 | // This unusual formulation is intended to avoid overflow. |
| 46 | return capacity_ - GetHeaderSize() >= length; |
| 47 | } |
| 48 | |
mukesh agrawal | fd65102 | 2016-09-21 13:27:07 -0700 | [diff] [blame] | 49 | bool MessageBuffer::CanFitNow(uint16_t length) const { |
| 50 | // This unusual formulation is intended to avoid overflow/underflow. |
| 51 | return GetFreeSize() >= GetHeaderSize() && |
| 52 | GetFreeSize() - GetHeaderSize() >= length; |
| 53 | } |
| 54 | |
mukesh agrawal | 6969007 | 2016-09-21 14:34:21 -0700 | [diff] [blame] | 55 | void MessageBuffer::Clear() { |
| 56 | read_pos_ = 0; |
| 57 | write_pos_ = 0; |
| 58 | } |
| 59 | |
mukesh agrawal | 6d8e220 | 2016-09-21 14:23:21 -0700 | [diff] [blame] | 60 | std::tuple<const uint8_t*, size_t> MessageBuffer::ConsumeNextMessage() { |
| 61 | if (read_pos_ >= write_pos_) { |
| 62 | return {nullptr, 0}; |
| 63 | } |
| 64 | |
| 65 | LengthHeader header; |
| 66 | const uint8_t* header_start = data_.get() + read_pos_; |
| 67 | CHECK(header_start + sizeof(header) <= data_.get() + capacity_); |
| 68 | std::memcpy(&header, header_start, sizeof(header)); |
| 69 | read_pos_ += sizeof(header); |
| 70 | |
| 71 | const uint8_t* payload_start = data_.get() + read_pos_; |
| 72 | read_pos_ += header.payload_len; |
| 73 | CHECK(read_pos_ <= capacity_); |
| 74 | |
| 75 | return {payload_start, header.payload_len}; |
| 76 | } |
| 77 | |
mukesh agrawal | 5f88ee7 | 2016-09-21 15:04:09 -0700 | [diff] [blame] | 78 | void MessageBuffer::Rewind() { read_pos_ = 0; } |
| 79 | |
mukesh agrawal | fd65102 | 2016-09-21 13:27:07 -0700 | [diff] [blame] | 80 | // Private methods below. |
| 81 | |
| 82 | void MessageBuffer::AppendHeader(uint16_t message_len) { |
| 83 | LengthHeader header; |
| 84 | header.payload_len = message_len; |
| 85 | AppendRawBytes(&header, sizeof(header)); |
| 86 | } |
| 87 | |
| 88 | void MessageBuffer::AppendRawBytes(const void* data_start, size_t data_len) { |
| 89 | std::memcpy(data_.get() + write_pos_, data_start, data_len); |
| 90 | write_pos_ += data_len; |
| 91 | } |
| 92 | |
mukesh agrawal | 9d2165f | 2016-09-21 11:35:29 -0700 | [diff] [blame] | 93 | } // namespace wifilogd |
| 94 | } // namespace android |