RingBuffer.cpp 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566
  1. /*
  2. * Copyright (c) 2021, Sahan Fernando <sahan.h.fernando@gmail.com>.
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <Kernel/Memory/MemoryManager.h>
  7. #include <Kernel/Memory/RingBuffer.h>
  8. #include <Kernel/UserOrKernelBuffer.h>
  9. namespace Kernel::Memory {
  10. RingBuffer::RingBuffer(String region_name, size_t capacity)
  11. : m_region(MM.allocate_contiguous_kernel_region(page_round_up(capacity), move(region_name), Region::Access::Read | Region::Access::Write))
  12. , m_capacity_in_bytes(capacity)
  13. {
  14. }
  15. bool RingBuffer::copy_data_in(const UserOrKernelBuffer& buffer, size_t offset, size_t length, PhysicalAddress& start_of_copied_data, size_t& bytes_copied)
  16. {
  17. size_t start_of_free_area = (m_start_of_used + m_num_used_bytes) % m_capacity_in_bytes;
  18. bytes_copied = min(m_capacity_in_bytes - m_num_used_bytes, min(m_capacity_in_bytes - start_of_free_area, length));
  19. if (bytes_copied == 0)
  20. return false;
  21. if (buffer.read(m_region->vaddr().offset(start_of_free_area).as_ptr(), offset, bytes_copied)) {
  22. m_num_used_bytes += bytes_copied;
  23. start_of_copied_data = m_region->physical_page(start_of_free_area / PAGE_SIZE)->paddr().offset(start_of_free_area % PAGE_SIZE);
  24. return true;
  25. }
  26. return false;
  27. }
  28. KResultOr<size_t> RingBuffer::copy_data_out(size_t size, UserOrKernelBuffer& buffer) const
  29. {
  30. auto start = m_start_of_used % m_capacity_in_bytes;
  31. auto num_bytes = min(min(m_num_used_bytes, size), m_capacity_in_bytes - start);
  32. if (!buffer.write(m_region->vaddr().offset(start).as_ptr(), num_bytes))
  33. return EIO;
  34. return num_bytes;
  35. }
  36. KResultOr<PhysicalAddress> RingBuffer::reserve_space(size_t size)
  37. {
  38. if (m_capacity_in_bytes < m_num_used_bytes + size)
  39. return ENOSPC;
  40. size_t start_of_free_area = (m_start_of_used + m_num_used_bytes) % m_capacity_in_bytes;
  41. m_num_used_bytes += size;
  42. PhysicalAddress start_of_reserved_space = m_region->physical_page(start_of_free_area / PAGE_SIZE)->paddr().offset(start_of_free_area % PAGE_SIZE);
  43. return start_of_reserved_space;
  44. }
  45. void RingBuffer::reclaim_space(PhysicalAddress chunk_start, size_t chunk_size)
  46. {
  47. VERIFY(start_of_used() == chunk_start);
  48. VERIFY(m_num_used_bytes >= chunk_size);
  49. m_num_used_bytes -= chunk_size;
  50. m_start_of_used += chunk_size;
  51. }
  52. PhysicalAddress RingBuffer::start_of_used() const
  53. {
  54. size_t start = m_start_of_used % m_capacity_in_bytes;
  55. return m_region->physical_page(start / PAGE_SIZE)->paddr().offset(start % PAGE_SIZE);
  56. }
  57. }