wash/mango
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

dev: implement block device registration

Browse Source
This commit is contained in:
max 🍓
2023-07-08 15:55:43 +01:00
parent ce40a4f57d
commit d9b9c0d4e7
4 changed files with 58 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

46
dev/block.c
View File

@@ -1,4 +1,10 @@
#include <socks/device.h>
#include <socks/util.h>
#include <socks/printk.h>
#include <socks/libc/stdio.h>
static DECLARE_BITMAP(block_device_ids, BLOCK_DEVICE_MAX);
static spin_lock_t block_device_ids_lock = SPIN_LOCK_INIT;
struct block_device *block_device_create(void)
{
@@ -17,3 +23,43 @@ struct block_device *block_device_from_generic(struct device *dev)
dev->dev_type = DEV_TYPE_BLOCK;
return BLOCK_DEVICE(dev);
}
kern_status_t block_device_read(struct device *dev, void *buf, size_t size, size_t *bytes_read, socks_flags_t flags)
{
return KERN_UNIMPLEMENTED;
}
static kern_status_t generate_name(struct block_device *dev, char out[DEV_NAME_MAX])
{
snprintf(out, DEV_NAME_MAX, "disk%u", dev->b_id);
return KERN_OK;
}
kern_status_t block_device_register(struct device *dev)
{
unsigned long flags;
spin_lock_irqsave(&block_device_ids_lock, &flags);
unsigned int id = bitmap_lowest_clear(block_device_ids, BLOCK_DEVICE_MAX);
bitmap_set(block_device_ids, id);
spin_unlock_irqrestore(&block_device_ids_lock, flags);
struct block_device *blockdev = &dev->blk;
blockdev->b_id = id;
char name[DEV_NAME_MAX];
generate_name(blockdev, name);
char path[OBJECT_PATH_MAX];
snprintf(path, sizeof path, "/dev/block/%s", name);
char size_string[32];
data_size_to_string(blockdev->sector_size * blockdev->capacity, size_string, sizeof size_string);
printk("dev: found %s %s block device '%s'", size_string, dev->dev_owner->drv_name, dev->dev_model_name);
return object_namespace_create_link(global_namespace(), path, &dev->dev_base);
}
struct device_type_ops block_type_ops = {
.register_device = block_device_register,
.read = block_device_read,
};

3
dev/core.c
View File

@@ -20,13 +20,14 @@ static kern_status_t device_object_get_child_named(struct object *, const char *
extern kern_status_t init_driver_tree(void);
extern struct device_type_ops char_type_ops;
extern struct device_type_ops block_type_ops;
extern struct device_type_ops input_type_ops;
extern struct device_type_ops framebuffer_type_ops;
extern struct device_type_ops bus_type_ops;
static struct device_type_ops *type_ops[] = {
[DEV_TYPE_UNKNOWN] = NULL,
[DEV_TYPE_BLOCK] = NULL,
[DEV_TYPE_BLOCK] = &block_type_ops,
[DEV_TYPE_CHAR] = &char_type_ops,
[DEV_TYPE_NET] = NULL,
[DEV_TYPE_INPUT] = &input_type_ops,