Newer
Older
minerva / Kernel / Devices / Generic / DeviceControlDevice.cpp
@minerva minerva on 13 Jul 2 KB Initial commit
/*
 * 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);
    };
}

}