/*
* Copyright (c) 2021, Liav A. <liavalb@hotmail.co.il>
*
* SPDX-License-Identifier: BSD-2-Clause
*/
#include <Kernel/API/Ioctl.h>
#include <Kernel/API/MajorNumberAllocation.h>
#include <Kernel/Devices/Device.h>
#include <Kernel/Devices/Generic/DeviceControlDevice.h>
#include <Kernel/Devices/Loop/LoopDevice.h>
#include <Kernel/Library/StdLib.h>
namespace Kernel {
UNMAP_AFTER_INIT NonnullRefPtr<DeviceControlDevice> DeviceControlDevice::must_create()
{
return MUST(Device::try_create_device<DeviceControlDevice>());
}
bool DeviceControlDevice::can_read(OpenFileDescription const&, u64) const
{
return Device::event_queue().with([](auto& queue) -> bool {
return !queue.is_empty();
});
}
UNMAP_AFTER_INIT DeviceControlDevice::DeviceControlDevice()
: CharacterDevice(MajorAllocation::CharacterDeviceFamily::DeviceControl, 10)
{
}
UNMAP_AFTER_INIT DeviceControlDevice::~DeviceControlDevice() = default;
ErrorOr<size_t> DeviceControlDevice::read(OpenFileDescription&, u64 offset, UserOrKernelBuffer& buffer, size_t size)
{
if (offset != 0)
return Error::from_errno(EINVAL);
if ((size % sizeof(DeviceEvent)) != 0)
return Error::from_errno(EOVERFLOW);
return Device::event_queue().with([&](auto& queue) -> ErrorOr<size_t> {
size_t nread = 0;
for (size_t event_index = 0; event_index < (size / sizeof(DeviceEvent)); event_index++) {
if (queue.is_empty())
break;
auto event = queue.dequeue();
TRY(buffer.write(&event, nread, sizeof(DeviceEvent)));
nread += sizeof(DeviceEvent);
}
return nread;
});
}
ErrorOr<void> DeviceControlDevice::ioctl(OpenFileDescription&, unsigned request, Userspace<void*> arg)
{
switch (request) {
case DEVCTL_CREATE_LOOP_DEVICE: {
unsigned fd { 0 };
TRY(copy_from_user(&fd, static_ptr_cast<unsigned*>(arg)));
auto file_description = TRY(Process::current().open_file_description(fd));
auto& device = TRY(LoopDevice::create_with_file_description(file_description)).leak_ref();
unsigned index = device.index();
return copy_to_user(static_ptr_cast<unsigned*>(arg), &index);
}
case DEVCTL_DESTROY_LOOP_DEVICE: {
unsigned index { 0 };
TRY(copy_from_user(&index, static_ptr_cast<unsigned*>(arg)));
bool found = false;
Device::run_by_type_and_major_minor_numbers(DeviceNodeType::Block, to_underlying(MajorAllocation::BlockDeviceFamily::Loop), index, [&](RefPtr<Device> device) {
if (device) {
found = true;
static_cast<LoopDevice&>(*device).unref();
}
});
if (!found)
return Error::from_errno(ENODEV);
return {};
}
default:
return Error::from_errno(EINVAL);
};
}
}