USBPipe.cpp 7.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153
  1. /*
  2. * Copyright (c) 2021, Jesse Buhagiar <jooster669@gmail.com>
  3. * Copyright (c) 2022, blackcat <b14ckcat@protonmail.com>
  4. *
  5. * SPDX-License-Identifier: BSD-2-Clause
  6. */
  7. #include <AK/StdLibExtras.h>
  8. #include <Kernel/Bus/USB/PacketTypes.h>
  9. #include <Kernel/Bus/USB/UHCI/UHCIController.h>
  10. #include <Kernel/Bus/USB/USBPipe.h>
  11. #include <Kernel/Bus/USB/USBTransfer.h>
  12. namespace Kernel::USB {
  13. Pipe::Pipe(USBController const& controller, Type type, Direction direction, u8 endpoint_address, u16 max_packet_size, i8 device_address, NonnullOwnPtr<Memory::Region> dma_buffer)
  14. : m_controller(controller)
  15. , m_type(type)
  16. , m_direction(direction)
  17. , m_device_address(device_address)
  18. , m_endpoint_address(endpoint_address)
  19. , m_max_packet_size(max_packet_size)
  20. , m_data_toggle(false)
  21. , m_dma_buffer(move(dma_buffer))
  22. {
  23. }
  24. ErrorOr<NonnullOwnPtr<ControlPipe>> ControlPipe::create(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, size_t buffer_size)
  25. {
  26. auto dma_buffer = TRY(MM.allocate_dma_buffer_pages(TRY(Memory::page_round_up(buffer_size)), "USB device DMA buffer"sv, Memory::Region::Access::ReadWrite));
  27. return adopt_nonnull_own_or_enomem(new (nothrow) ControlPipe(controller, endpoint_address, max_packet_size, device_address, move(dma_buffer)));
  28. }
  29. ControlPipe::ControlPipe(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, NonnullOwnPtr<Memory::Region> dma_buffer)
  30. : Pipe(controller, Type::Control, Direction::Bidirectional, endpoint_address, max_packet_size, device_address, move(dma_buffer))
  31. {
  32. }
  33. ErrorOr<size_t> ControlPipe::control_transfer(u8 request_type, u8 request, u16 value, u16 index, size_t length, void* data)
  34. {
  35. VERIFY(length <= m_dma_buffer->size());
  36. MutexLocker lock(m_dma_buffer_lock);
  37. USBRequestData usb_request;
  38. usb_request.request_type = request_type;
  39. usb_request.request = request;
  40. usb_request.value = value;
  41. usb_request.index = index;
  42. usb_request.length = length;
  43. auto transfer = TRY(Transfer::try_create(*this, length, *m_dma_buffer));
  44. transfer->set_setup_packet(usb_request);
  45. dbgln_if(USB_DEBUG, "ControlPipe: Transfer allocated @ {}", transfer->buffer_physical());
  46. auto transfer_length = TRY(m_controller->submit_control_transfer(*transfer));
  47. // TODO: Check transfer for completion and copy data from transfer buffer into data
  48. if (length > 0)
  49. memcpy(reinterpret_cast<u8*>(data), transfer->buffer().as_ptr() + sizeof(USBRequestData), length);
  50. dbgln_if(USB_DEBUG, "Pipe: Control Transfer complete!");
  51. return transfer_length;
  52. }
  53. ErrorOr<NonnullOwnPtr<BulkInPipe>> BulkInPipe::create(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, size_t buffer_size)
  54. {
  55. VERIFY(buffer_size >= max_packet_size);
  56. auto dma_buffer = TRY(MM.allocate_dma_buffer_pages(TRY(Memory::page_round_up(buffer_size)), "USB pipe DMA buffer"sv, Memory::Region::Access::ReadWrite));
  57. return adopt_nonnull_own_or_enomem(new (nothrow) BulkInPipe(controller, endpoint_address, max_packet_size, device_address, move(dma_buffer)));
  58. }
  59. BulkInPipe::BulkInPipe(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, NonnullOwnPtr<Memory::Region> dma_buffer)
  60. : Pipe(controller, Pipe::Type::Bulk, Direction::In, endpoint_address, max_packet_size, device_address, move(dma_buffer))
  61. {
  62. }
  63. ErrorOr<size_t> BulkInPipe::bulk_in_transfer(size_t length, void* data)
  64. {
  65. VERIFY(length <= m_dma_buffer->size());
  66. MutexLocker lock(m_dma_buffer_lock);
  67. size_t transfer_length = 0;
  68. auto transfer = TRY(Transfer::try_create(*this, length, *m_dma_buffer));
  69. dbgln_if(USB_DEBUG, "Pipe: Bulk in transfer allocated @ {}", transfer->buffer_physical());
  70. transfer_length = TRY(m_controller->submit_bulk_transfer(*transfer));
  71. memcpy(data, transfer->buffer().as_ptr(), min(length, transfer_length));
  72. dbgln_if(USB_DEBUG, "Pipe: Bulk in transfer complete!");
  73. return transfer_length;
  74. }
  75. ErrorOr<NonnullOwnPtr<BulkOutPipe>> BulkOutPipe::create(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, size_t buffer_size)
  76. {
  77. VERIFY(buffer_size >= max_packet_size);
  78. auto dma_buffer = TRY(MM.allocate_dma_buffer_pages(TRY(Memory::page_round_up(buffer_size)), "USB pipe DMA buffer"sv, Memory::Region::Access::ReadWrite));
  79. return adopt_nonnull_own_or_enomem(new (nothrow) BulkOutPipe(controller, endpoint_address, max_packet_size, device_address, move(dma_buffer)));
  80. }
  81. BulkOutPipe::BulkOutPipe(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, NonnullOwnPtr<Memory::Region> dma_buffer)
  82. : Pipe(controller, Type::Bulk, Direction::Out, endpoint_address, max_packet_size, device_address, move(dma_buffer))
  83. {
  84. }
  85. ErrorOr<size_t> BulkOutPipe::bulk_out_transfer(size_t length, void* data)
  86. {
  87. VERIFY(length <= m_dma_buffer->size());
  88. MutexLocker lock(m_dma_buffer_lock);
  89. size_t transfer_length = 0;
  90. auto transfer = TRY(Transfer::try_create(*this, length, *m_dma_buffer));
  91. TRY(transfer->write_buffer(length, data));
  92. dbgln_if(USB_DEBUG, "Pipe: Bulk out transfer allocated @ {}", transfer->buffer_physical());
  93. transfer_length = TRY(m_controller->submit_bulk_transfer(*transfer));
  94. dbgln_if(USB_DEBUG, "Pipe: Bulk out transfer complete!");
  95. return transfer_length;
  96. }
  97. ErrorOr<NonnullOwnPtr<InterruptInPipe>> InterruptInPipe::create(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, u16 poll_interval, size_t buffer_size)
  98. {
  99. VERIFY(buffer_size >= max_packet_size);
  100. auto dma_buffer = TRY(MM.allocate_dma_buffer_pages(TRY(Memory::page_round_up(buffer_size)), "USB pipe DMA buffer"sv, Memory::Region::Access::ReadWrite));
  101. return adopt_nonnull_own_or_enomem(new (nothrow) InterruptInPipe(controller, endpoint_address, max_packet_size, device_address, poll_interval, move(dma_buffer)));
  102. }
  103. InterruptInPipe::InterruptInPipe(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, u16 poll_interval, NonnullOwnPtr<Memory::Region> dma_buffer)
  104. : Pipe(controller, Type::Interrupt, Direction::In, endpoint_address, max_packet_size, device_address, move(dma_buffer))
  105. , m_poll_interval(poll_interval)
  106. {
  107. }
  108. ErrorOr<NonnullOwnPtr<InterruptOutPipe>> InterruptOutPipe::create(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, u16 poll_interval, size_t buffer_size)
  109. {
  110. VERIFY(buffer_size >= max_packet_size);
  111. auto dma_buffer = TRY(MM.allocate_dma_buffer_pages(TRY(Memory::page_round_up(buffer_size)), "USB pipe DMA buffer"sv, Memory::Region::Access::ReadWrite));
  112. return adopt_nonnull_own_or_enomem(new (nothrow) InterruptOutPipe(controller, endpoint_address, max_packet_size, device_address, poll_interval, move(dma_buffer)));
  113. }
  114. InterruptOutPipe::InterruptOutPipe(USBController const& controller, u8 endpoint_address, u16 max_packet_size, i8 device_address, u16 poll_interval, NonnullOwnPtr<Memory::Region> dma_buffer)
  115. : Pipe(controller, Type::Interrupt, Direction::In, endpoint_address, max_packet_size, device_address, move(dma_buffer))
  116. , m_poll_interval(poll_interval)
  117. {
  118. }
  119. }