1*61c4878aSAndroid Build Coastguard Worker // Copyright 2020 The Pigweed Authors
2*61c4878aSAndroid Build Coastguard Worker //
3*61c4878aSAndroid Build Coastguard Worker // Licensed under the Apache License, Version 2.0 (the "License"); you may not
4*61c4878aSAndroid Build Coastguard Worker // use this file except in compliance with the License. You may obtain a copy of
5*61c4878aSAndroid Build Coastguard Worker // the License at
6*61c4878aSAndroid Build Coastguard Worker //
7*61c4878aSAndroid Build Coastguard Worker // https://www.apache.org/licenses/LICENSE-2.0
8*61c4878aSAndroid Build Coastguard Worker //
9*61c4878aSAndroid Build Coastguard Worker // Unless required by applicable law or agreed to in writing, software
10*61c4878aSAndroid Build Coastguard Worker // distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
11*61c4878aSAndroid Build Coastguard Worker // WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
12*61c4878aSAndroid Build Coastguard Worker // License for the specific language governing permissions and limitations under
13*61c4878aSAndroid Build Coastguard Worker // the License.
14*61c4878aSAndroid Build Coastguard Worker //==============================================================================
15*61c4878aSAndroid Build Coastguard Worker //
16*61c4878aSAndroid Build Coastguard Worker #include "pw_trace_tokenized/trace_buffer.h"
17*61c4878aSAndroid Build Coastguard Worker
18*61c4878aSAndroid Build Coastguard Worker #include "pw_ring_buffer/prefixed_entry_ring_buffer.h"
19*61c4878aSAndroid Build Coastguard Worker #include "pw_span/span.h"
20*61c4878aSAndroid Build Coastguard Worker #include "pw_trace_tokenized/trace_callback.h"
21*61c4878aSAndroid Build Coastguard Worker
22*61c4878aSAndroid Build Coastguard Worker namespace pw {
23*61c4878aSAndroid Build Coastguard Worker namespace trace {
24*61c4878aSAndroid Build Coastguard Worker namespace {
25*61c4878aSAndroid Build Coastguard Worker
26*61c4878aSAndroid Build Coastguard Worker class TraceBuffer {
27*61c4878aSAndroid Build Coastguard Worker public:
TraceBuffer(Callbacks & callbacks)28*61c4878aSAndroid Build Coastguard Worker TraceBuffer(Callbacks& callbacks) : callbacks_(callbacks) {
29*61c4878aSAndroid Build Coastguard Worker ring_buffer_.SetBuffer(raw_buffer_)
30*61c4878aSAndroid Build Coastguard Worker .IgnoreError(); // TODO: b/242598609 - Handle Status properly
31*61c4878aSAndroid Build Coastguard Worker callbacks_
32*61c4878aSAndroid Build Coastguard Worker .RegisterSink(
33*61c4878aSAndroid Build Coastguard Worker TraceSinkStartBlock, TraceSinkAddBytes, TraceSinkEndBlock, this)
34*61c4878aSAndroid Build Coastguard Worker .IgnoreError(); // TODO: b/242598609 - Handle Status properly
35*61c4878aSAndroid Build Coastguard Worker }
36*61c4878aSAndroid Build Coastguard Worker
TraceSinkStartBlock(void * user_data,size_t size)37*61c4878aSAndroid Build Coastguard Worker static void TraceSinkStartBlock(void* user_data, size_t size) {
38*61c4878aSAndroid Build Coastguard Worker TraceBuffer* buffer = reinterpret_cast<TraceBuffer*>(user_data);
39*61c4878aSAndroid Build Coastguard Worker if (size > PW_TRACE_BUFFER_MAX_BLOCK_SIZE_BYTES) {
40*61c4878aSAndroid Build Coastguard Worker buffer->block_size_ = 0; // Skip this block
41*61c4878aSAndroid Build Coastguard Worker return;
42*61c4878aSAndroid Build Coastguard Worker }
43*61c4878aSAndroid Build Coastguard Worker buffer->block_size_ = static_cast<uint16_t>(size);
44*61c4878aSAndroid Build Coastguard Worker buffer->block_idx_ = 0;
45*61c4878aSAndroid Build Coastguard Worker }
46*61c4878aSAndroid Build Coastguard Worker
TraceSinkAddBytes(void * user_data,const void * bytes,size_t size)47*61c4878aSAndroid Build Coastguard Worker static void TraceSinkAddBytes(void* user_data,
48*61c4878aSAndroid Build Coastguard Worker const void* bytes,
49*61c4878aSAndroid Build Coastguard Worker size_t size) {
50*61c4878aSAndroid Build Coastguard Worker TraceBuffer* buffer = reinterpret_cast<TraceBuffer*>(user_data);
51*61c4878aSAndroid Build Coastguard Worker if (buffer->block_size_ == 0 ||
52*61c4878aSAndroid Build Coastguard Worker buffer->block_idx_ + size > buffer->block_size_) {
53*61c4878aSAndroid Build Coastguard Worker return; // Block is too large, skipping.
54*61c4878aSAndroid Build Coastguard Worker }
55*61c4878aSAndroid Build Coastguard Worker memcpy(&buffer->current_block_[buffer->block_idx_], bytes, size);
56*61c4878aSAndroid Build Coastguard Worker buffer->block_idx_ += size;
57*61c4878aSAndroid Build Coastguard Worker }
58*61c4878aSAndroid Build Coastguard Worker
TraceSinkEndBlock(void * user_data)59*61c4878aSAndroid Build Coastguard Worker static void TraceSinkEndBlock(void* user_data) {
60*61c4878aSAndroid Build Coastguard Worker TraceBuffer* buffer = reinterpret_cast<TraceBuffer*>(user_data);
61*61c4878aSAndroid Build Coastguard Worker if (buffer->block_idx_ != buffer->block_size_) {
62*61c4878aSAndroid Build Coastguard Worker return; // Block is too large, skipping.
63*61c4878aSAndroid Build Coastguard Worker }
64*61c4878aSAndroid Build Coastguard Worker buffer->ring_buffer_
65*61c4878aSAndroid Build Coastguard Worker .PushBack(span<const std::byte>(&buffer->current_block_[0],
66*61c4878aSAndroid Build Coastguard Worker buffer->block_size_))
67*61c4878aSAndroid Build Coastguard Worker .IgnoreError(); // TODO: b/242598609 - Handle Status properly
68*61c4878aSAndroid Build Coastguard Worker }
69*61c4878aSAndroid Build Coastguard Worker
RingBuffer()70*61c4878aSAndroid Build Coastguard Worker pw::ring_buffer::PrefixedEntryRingBuffer& RingBuffer() {
71*61c4878aSAndroid Build Coastguard Worker return ring_buffer_;
72*61c4878aSAndroid Build Coastguard Worker }
73*61c4878aSAndroid Build Coastguard Worker
DeringAndViewRawBuffer()74*61c4878aSAndroid Build Coastguard Worker ConstByteSpan DeringAndViewRawBuffer() {
75*61c4878aSAndroid Build Coastguard Worker ring_buffer_.Dering()
76*61c4878aSAndroid Build Coastguard Worker .IgnoreError(); // TODO: b/242598609 - Handle Status properly
77*61c4878aSAndroid Build Coastguard Worker return ByteSpan(raw_buffer_, ring_buffer_.TotalUsedBytes());
78*61c4878aSAndroid Build Coastguard Worker }
79*61c4878aSAndroid Build Coastguard Worker
80*61c4878aSAndroid Build Coastguard Worker private:
81*61c4878aSAndroid Build Coastguard Worker Callbacks& callbacks_;
82*61c4878aSAndroid Build Coastguard Worker uint16_t block_size_ = 0;
83*61c4878aSAndroid Build Coastguard Worker uint16_t block_idx_ = 0;
84*61c4878aSAndroid Build Coastguard Worker std::byte current_block_[PW_TRACE_BUFFER_MAX_BLOCK_SIZE_BYTES];
85*61c4878aSAndroid Build Coastguard Worker std::byte raw_buffer_[PW_TRACE_BUFFER_SIZE_BYTES];
86*61c4878aSAndroid Build Coastguard Worker pw::ring_buffer::PrefixedEntryRingBuffer ring_buffer_{false};
87*61c4878aSAndroid Build Coastguard Worker };
88*61c4878aSAndroid Build Coastguard Worker
89*61c4878aSAndroid Build Coastguard Worker #if PW_TRACE_BUFFER_SIZE_BYTES > 0
90*61c4878aSAndroid Build Coastguard Worker TraceBuffer trace_buffer_instance(GetCallbacks());
91*61c4878aSAndroid Build Coastguard Worker #endif // PW_TRACE_BUFFER_SIZE_BYTES > 0
92*61c4878aSAndroid Build Coastguard Worker
93*61c4878aSAndroid Build Coastguard Worker } // namespace
94*61c4878aSAndroid Build Coastguard Worker
ClearBuffer()95*61c4878aSAndroid Build Coastguard Worker void ClearBuffer() { trace_buffer_instance.RingBuffer().Clear(); }
96*61c4878aSAndroid Build Coastguard Worker
GetBuffer()97*61c4878aSAndroid Build Coastguard Worker pw::ring_buffer::PrefixedEntryRingBuffer* GetBuffer() {
98*61c4878aSAndroid Build Coastguard Worker return &trace_buffer_instance.RingBuffer();
99*61c4878aSAndroid Build Coastguard Worker }
100*61c4878aSAndroid Build Coastguard Worker
DeringAndViewRawBuffer()101*61c4878aSAndroid Build Coastguard Worker ConstByteSpan DeringAndViewRawBuffer() {
102*61c4878aSAndroid Build Coastguard Worker return trace_buffer_instance.DeringAndViewRawBuffer();
103*61c4878aSAndroid Build Coastguard Worker }
104*61c4878aSAndroid Build Coastguard Worker
105*61c4878aSAndroid Build Coastguard Worker } // namespace trace
106*61c4878aSAndroid Build Coastguard Worker } // namespace pw
107