blob: 1398c7812ea62539397698a78f954e9b02c1f3aa (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
|
#include <kapi/devices/bus.hpp>
#include <kapi/devices.hpp>
#include <kapi/devices/bus_protocol.hpp>
#include <kapi/devices/driver_registry.hpp>
#include <kapi/system.hpp>
#include <kstd/memory.hpp>
#include <kstd/mutex.hpp>
#include <kstd/string.hpp>
#include <kstd/vector.hpp>
#include <algorithm>
#include <utility>
namespace kapi::devices
{
bus::bus(kstd::string const & name)
: device{name}
{}
bus::bus(kstd::string const & name, bus_protocol & protocol)
: device{name}
, m_protocol{&protocol}
{}
bus::~bus()
{
auto children = m_devices;
for (auto const & child : children)
{
remove_child(*child);
}
}
auto bus::add_child(kstd::shared_ptr<device> child) -> void
{
{
auto guard = kstd::lock_guard{m_lock};
child->set_parent(kstd::static_pointer_cast<bus>(shared_from_this()));
}
if (!kapi::devices::device_registry::get().add(child))
{
kapi::system::panic("[OS:DEV] Failed to register child device {}", child->name());
}
auto attached = kstd::shared_ptr<device>{};
{
auto guard = kstd::lock_guard{m_lock};
attached = m_devices.emplace_back(std::move(child));
}
attached->set_state(state::present);
driver_registry::get().device_attached(attached);
}
auto bus::remove_child(device & device) -> bool // NOLINT(misc-no-recursion)
{
auto lifeline = kstd::shared_ptr<struct device>{};
{
auto guard = kstd::lock_guard{m_lock};
auto found = std::ranges::find_if(m_devices, [&](auto const & d) { return d.get() == &device; });
if (found == m_devices.end())
{
return false;
}
lifeline = *found;
m_devices.erase(found);
}
do_remove_child(*lifeline);
return true;
}
[[nodiscard]] auto bus::children() const -> kstd::vector<kstd::shared_ptr<device>>
{
auto guard = kstd::lock_guard{m_lock};
return m_devices;
}
auto bus::query_facet(kapi::capabilities::facet_id facet) -> void *
{
if (facet == bus::id)
{
return this;
}
else if (facet == bus_protocol::id)
{
return m_protocol;
}
return device::query_facet(facet);
}
auto bus::do_remove_child(device & device) -> void // NOLINT(misc-no-recursion)
{
if (device.state() == state::removed)
{
return;
}
if (auto child_bus = device.facet<bus>())
{
auto grandchildren = kstd::vector<kstd::shared_ptr<kapi::devices::device>>{};
{
auto guard = kstd::lock_guard{child_bus->m_lock};
// NOTE: this could be more efficient one vector::assign is implemented.
grandchildren = kstd::vector(child_bus->m_devices.begin(), child_bus->m_devices.end());
}
for (auto & grandchild : grandchildren)
{
child_bus->remove_child(*grandchild);
}
}
device.set_state(state::removed);
if (auto bound_driver = device.bound_driver())
{
bound_driver->unbind(device);
}
facet_registry::get().withdraw_all_for(device);
device_registry::get().remove(device);
device.set_parent(kstd::weak_ptr<bus>{});
}
} // namespace kapi::devices
|
