DoubleBuffer.cpp 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104
  1. /*
  2. * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <AK/StringView.h>
  7. #include <Kernel/Arch/x86/InterruptDisabler.h>
  8. #include <Kernel/DoubleBuffer.h>
  9. namespace Kernel {
  10. inline void DoubleBuffer::compute_lockfree_metadata()
  11. {
  12. InterruptDisabler disabler;
  13. m_empty = m_read_buffer_index >= m_read_buffer->size && m_write_buffer->size == 0;
  14. m_space_for_writing = m_capacity - m_write_buffer->size;
  15. }
  16. OwnPtr<DoubleBuffer> DoubleBuffer::try_create(size_t capacity)
  17. {
  18. auto storage = KBuffer::try_create_with_size(capacity * 2, Memory::Region::Access::ReadWrite, "DoubleBuffer");
  19. if (!storage)
  20. return {};
  21. return adopt_own_if_nonnull(new (nothrow) DoubleBuffer(capacity, storage.release_nonnull()));
  22. }
  23. DoubleBuffer::DoubleBuffer(size_t capacity, NonnullOwnPtr<KBuffer> storage)
  24. : m_write_buffer(&m_buffer1)
  25. , m_read_buffer(&m_buffer2)
  26. , m_storage(move(storage))
  27. , m_capacity(capacity)
  28. {
  29. m_buffer1.data = m_storage->data();
  30. m_buffer1.size = 0;
  31. m_buffer2.data = m_storage->data() + capacity;
  32. m_buffer2.size = 0;
  33. m_space_for_writing = capacity;
  34. }
  35. void DoubleBuffer::flip()
  36. {
  37. if (m_storage->is_null())
  38. return;
  39. VERIFY(m_read_buffer_index == m_read_buffer->size);
  40. swap(m_read_buffer, m_write_buffer);
  41. m_write_buffer->size = 0;
  42. m_read_buffer_index = 0;
  43. compute_lockfree_metadata();
  44. }
  45. KResultOr<size_t> DoubleBuffer::write(const UserOrKernelBuffer& data, size_t size)
  46. {
  47. if (!size || m_storage->is_null())
  48. return 0;
  49. MutexLocker locker(m_lock);
  50. size_t bytes_to_write = min(size, m_space_for_writing);
  51. u8* write_ptr = m_write_buffer->data + m_write_buffer->size;
  52. TRY(data.read(write_ptr, bytes_to_write));
  53. m_write_buffer->size += bytes_to_write;
  54. compute_lockfree_metadata();
  55. if (m_unblock_callback && !m_empty)
  56. m_unblock_callback();
  57. return bytes_to_write;
  58. }
  59. KResultOr<size_t> DoubleBuffer::read(UserOrKernelBuffer& data, size_t size)
  60. {
  61. if (!size || m_storage->is_null())
  62. return 0;
  63. MutexLocker locker(m_lock);
  64. if (m_read_buffer_index >= m_read_buffer->size && m_write_buffer->size != 0)
  65. flip();
  66. if (m_read_buffer_index >= m_read_buffer->size)
  67. return 0;
  68. size_t nread = min(m_read_buffer->size - m_read_buffer_index, size);
  69. TRY(data.write(m_read_buffer->data + m_read_buffer_index, nread));
  70. m_read_buffer_index += nread;
  71. compute_lockfree_metadata();
  72. if (m_unblock_callback && m_space_for_writing > 0)
  73. m_unblock_callback();
  74. return nread;
  75. }
  76. KResultOr<size_t> DoubleBuffer::peek(UserOrKernelBuffer& data, size_t size)
  77. {
  78. if (!size || m_storage->is_null())
  79. return 0;
  80. MutexLocker locker(m_lock);
  81. if (m_read_buffer_index >= m_read_buffer->size && m_write_buffer->size != 0) {
  82. flip();
  83. }
  84. if (m_read_buffer_index >= m_read_buffer->size)
  85. return 0;
  86. size_t nread = min(m_read_buffer->size - m_read_buffer_index, size);
  87. TRY(data.write(m_read_buffer->data + m_read_buffer_index, nread));
  88. compute_lockfree_metadata();
  89. if (m_unblock_callback && m_space_for_writing > 0)
  90. m_unblock_callback();
  91. return nread;
  92. }
  93. }