MotionLib  1.0.0
SamBuCa motion library
RingBuffer.cpp
1 /*
2  * Copyright (C) 2022 CERN
3  *
4  * This software is provided 'as-is', without any express or implied
5  * warranty. In no event will the authors be held liable for any damages
6  * arising from the use of this software.
7  *
8  * Permission is granted to anyone to use this software for any purpose,
9  * including commercial applications, and to alter it and redistribute it
10  * freely, subject to the following restrictions:
11  *
12  * 1. The origin of this software must not be misrepresented; you must not
13  * claim that you wrote the original software. If you use this software
14  * in a product, an acknowledgment in the product documentation would be
15  * appreciated but is not required.
16  * 2. Altered source versions must be plainly marked as such, and must not be
17  * misrepresented as being the original software.
18  * 3. This notice may not be removed or altered from any source distribution.
19  *
20  * Created on: 2022-04-07
21  * Author: Michal Mysior <mmysior> <michal.mysior@cern.ch>
22  *
23  */
24 
25 #include "RingBuffer.hpp"
26 
27 namespace smc {
28 namespace internal {
29 
30 RingBuffer::RingBuffer(std::size_t size) :
31  m_buff(size),
32  m_ridx{0},
33  m_widx{0},
34  m_full{false}
35 {}
36 
37 std::size_t RingBuffer::write(const char *data, std::size_t sz)
38 {
39  for (std::size_t i = 0; i < sz; i++)
40  {
41  if (m_full)
42  return i;
43  m_buff[m_widx] = data[i];
44  if (++m_widx >= m_buff.size())
45  m_widx = 0;
46  if (m_widx == m_ridx)
47  m_full = true;
48  }
49  return sz;
50 }
51 
52 std::size_t RingBuffer::read(char *data, std::size_t sz)
53 {
54  for (std::size_t i = 0; i < sz; i++)
55  {
56  if ((m_widx == m_ridx) && !m_full)
57  return i;
58  m_full = false;
59  data[i] = m_buff[m_ridx];
60  m_ridx = (m_ridx + 1) % m_buff.size();
61  }
62  return sz;
63 }
64 
65 std::size_t RingBuffer::bytesFree() const
66 {
67  if (m_full)
68  return 0;
69  return ((m_widx >= m_ridx) ? (m_buff.size() - m_widx + m_ridx) :
70  (m_ridx - m_widx));
71 }
72 
73 } // namespace internal
74 } // namespace smc
main motion-lib namespace
Definition: Client.cpp:30