SysFSPCI.cpp 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293
  1. /*
  2. * Copyright (c) 2021, Liav A. <liavalb@hotmail.co.il>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <Kernel/Bus/PCI/API.h>
  7. #include <Kernel/Bus/PCI/Access.h>
  8. #include <Kernel/Bus/PCI/SysFSPCI.h>
  9. #include <Kernel/Debug.h>
  10. #include <Kernel/Sections.h>
  11. namespace Kernel::PCI {
  12. UNMAP_AFTER_INIT NonnullRefPtr<PCIDeviceSysFSDirectory> PCIDeviceSysFSDirectory::create(const SysFSDirectory& parent_directory, Address address)
  13. {
  14. return adopt_ref(*new (nothrow) PCIDeviceSysFSDirectory(parent_directory, address));
  15. }
  16. UNMAP_AFTER_INIT PCIDeviceSysFSDirectory::PCIDeviceSysFSDirectory(const SysFSDirectory& parent_directory, Address address)
  17. : SysFSDirectory(String::formatted("{:04x}:{:02x}:{:02x}.{}", address.domain(), address.bus(), address.device(), address.function()), parent_directory)
  18. , m_address(address)
  19. {
  20. m_components.append(PCIDeviceAttributeSysFSComponent::create("vendor", *this, PCI::RegisterOffset::VENDOR_ID, 2));
  21. m_components.append(PCIDeviceAttributeSysFSComponent::create("device_id", *this, PCI::RegisterOffset::DEVICE_ID, 2));
  22. m_components.append(PCIDeviceAttributeSysFSComponent::create("class", *this, PCI::RegisterOffset::CLASS, 1));
  23. m_components.append(PCIDeviceAttributeSysFSComponent::create("subclass", *this, PCI::RegisterOffset::SUBCLASS, 1));
  24. m_components.append(PCIDeviceAttributeSysFSComponent::create("revision", *this, PCI::RegisterOffset::REVISION_ID, 1));
  25. m_components.append(PCIDeviceAttributeSysFSComponent::create("progif", *this, PCI::RegisterOffset::PROG_IF, 1));
  26. m_components.append(PCIDeviceAttributeSysFSComponent::create("subsystem_vendor", *this, PCI::RegisterOffset::SUBSYSTEM_VENDOR_ID, 2));
  27. m_components.append(PCIDeviceAttributeSysFSComponent::create("subsystem_id", *this, PCI::RegisterOffset::SUBSYSTEM_ID, 2));
  28. }
  29. UNMAP_AFTER_INIT void PCIBusSysFSDirectory::initialize()
  30. {
  31. auto pci_directory = adopt_ref(*new (nothrow) PCIBusSysFSDirectory());
  32. SysFSComponentRegistry::the().register_new_bus_directory(pci_directory);
  33. }
  34. UNMAP_AFTER_INIT PCIBusSysFSDirectory::PCIBusSysFSDirectory()
  35. : SysFSDirectory("pci", SysFSComponentRegistry::the().buses_directory())
  36. {
  37. PCI::enumerate([&](DeviceIdentifier const& device_identifier) {
  38. auto pci_device = PCI::PCIDeviceSysFSDirectory::create(*this, device_identifier.address());
  39. m_components.append(pci_device);
  40. });
  41. }
  42. NonnullRefPtr<PCIDeviceAttributeSysFSComponent> PCIDeviceAttributeSysFSComponent::create(String name, const PCIDeviceSysFSDirectory& device, PCI::RegisterOffset offset, size_t field_bytes_width)
  43. {
  44. return adopt_ref(*new (nothrow) PCIDeviceAttributeSysFSComponent(name, device, offset, field_bytes_width));
  45. }
  46. PCIDeviceAttributeSysFSComponent::PCIDeviceAttributeSysFSComponent(String name, const PCIDeviceSysFSDirectory& device, PCI::RegisterOffset offset, size_t field_bytes_width)
  47. : SysFSComponent(name)
  48. , m_device(device)
  49. , m_offset(offset)
  50. , m_field_bytes_width(field_bytes_width)
  51. {
  52. }
  53. KResultOr<size_t> PCIDeviceAttributeSysFSComponent::read_bytes(off_t offset, size_t count, UserOrKernelBuffer& buffer, OpenFileDescription*) const
  54. {
  55. auto blob = TRY(try_to_generate_buffer());
  56. if ((size_t)offset >= blob->size())
  57. return KSuccess;
  58. ssize_t nread = min(static_cast<off_t>(blob->size() - offset), static_cast<off_t>(count));
  59. TRY(buffer.write(blob->data() + offset, nread));
  60. return nread;
  61. }
  62. KResultOr<NonnullOwnPtr<KBuffer>> PCIDeviceAttributeSysFSComponent::try_to_generate_buffer() const
  63. {
  64. String value;
  65. switch (m_field_bytes_width) {
  66. case 1:
  67. value = String::formatted("{:#x}", PCI::read8(m_device->address(), m_offset));
  68. break;
  69. case 2:
  70. value = String::formatted("{:#x}", PCI::read16(m_device->address(), m_offset));
  71. break;
  72. case 4:
  73. value = String::formatted("{:#x}", PCI::read32(m_device->address(), m_offset));
  74. break;
  75. default:
  76. VERIFY_NOT_REACHED();
  77. }
  78. return KBuffer::try_create_with_bytes(value.substring_view(0).bytes());
  79. }
  80. }