/* * block.c * * Created on: Jun 26, 2019 * Author: fred */ #include "dnbd3.h" #include "block.h" static int dnbd3_open(struct block_device *bdev, fmode_t mode) { dnbd3_device_t *dev = bdev->bd_disk->private_data; printk(KERN_DEBUG "dnbd3: open device %i\n", dev->minor); //TODO can be removed? return 0; } static void dnbd3_release(struct gendisk *disk, fmode_t mode) { dnbd3_device_t *dev = disk->private_data; printk(KERN_DEBUG "dnbd3: release device %i\n", dev->minor); //TODO can be removed? } void dnbd3_blk_fail_all_requests(dnbd3_device_t *dev) { printk(KERN_DEBUG "dnbd3: fail all requests device %i\n", dev->minor); } int dnbd3_net_connect(dnbd3_device_t *dev) { printk(KERN_DEBUG "dnbd3: net connect device %i\n", dev->minor); return 0; } int dnbd3_net_disconnect(dnbd3_device_t *dev) { printk(KERN_DEBUG "dnbd3: net disconnect device %i\n", dev->minor); return 0; } static int dnbd3_ioctl(struct block_device *bdev, fmode_t mode, unsigned int cmd, unsigned long arg) { int result = -100; dnbd3_device_t *dev = bdev->bd_disk->private_data; char *imgname = NULL; dnbd3_ioctl_t *msg = NULL; printk(KERN_DEBUG "dnbd3: ioctl device %i, cmd %i, arg %lu\n", dev->minor, cmd, arg); //unsigned long irqflags; while (dev->disconnecting) { // do nothing } if (arg != 0) { msg = kmalloc(sizeof(*msg), GFP_KERNEL); if (msg == NULL) return -ENOMEM; if (copy_from_user((char *)msg, (char *)arg, 2) != 0 || msg->len != sizeof(*msg)) { result = -ENOEXEC; goto cleanup_return; } if (copy_from_user((char *)msg, (char *)arg, sizeof(*msg)) != 0) { result = -ENOENT; goto cleanup_return; } if (msg->imgname != NULL && msg->imgnamelen > 0) { imgname = kmalloc(msg->imgnamelen + 1, GFP_KERNEL); if (imgname == NULL) { result = -ENOMEM; goto cleanup_return; } if (copy_from_user(imgname, msg->imgname, msg->imgnamelen) != 0) { result = -ENOENT; goto cleanup_return; } imgname[msg->imgnamelen] = '\0'; printk(KERN_DEBUG "dnbd3: ioctl image name of len %i is %s\n", (int)msg->imgnamelen, imgname); } } switch (cmd) { case IOCTL_OPEN: printk(KERN_DEBUG "dnbd3: ioctl open\n"); if (dev->imgname != NULL) { result = -EBUSY; } else if (imgname == NULL) { result = -EINVAL; } else if (msg == NULL) { result = -EINVAL; } else { if (sizeof(msg->host) != sizeof(dev->cur_server.host)) { printk(KERN_INFO "dnbd3: odd size bug#1 triggered in ioctl\n"); } memcpy(&dev->cur_server.host, &msg->host, sizeof(msg->host)); dev->cur_server.failures = 0; memcpy(&dev->initial_server, &dev->cur_server, sizeof(dev->initial_server)); dev->imgname = imgname; dev->rid = msg->rid; dev->use_server_provided_alts = msg->use_server_provided_alts; // Forget all alt servers on explicit connect, set first al server to initial server memset(dev->alt_servers, 0, sizeof(dev->alt_servers[0])*NUMBER_SERVERS); memcpy(dev->alt_servers, &dev->initial_server, sizeof(dev->alt_servers[0])); //#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0) // if (blk_queue->backing_dev_info != NULL) { // blk_queue->backing_dev_info->ra_pages = (msg->read_ahead_kb * 1024) / PAGE_SIZE; // } //#else // blk_queue->backing_dev_info.ra_pages = (msg->read_ahead_kb * 1024) / PAGE_SIZE; //#endif if (dnbd3_net_connect(dev) == 0) { result = 0; imgname = NULL; // Prevent kfree at the end } else { result = -ENOENT; dev->imgname = NULL; } } break; case IOCTL_CLOSE: printk(KERN_DEBUG "dnbd3: ioctl close\n"); dnbd3_blk_fail_all_requests(dev); result = dnbd3_net_disconnect(dev); dnbd3_blk_fail_all_requests(dev); set_capacity(dev->disk, 0); if (dev->imgname) { kfree(dev->imgname); dev->imgname = NULL; } break; case IOCTL_SWITCH: printk(KERN_DEBUG "dnbd3: ioctl switch\n"); result = -EINVAL; break; case IOCTL_ADD_SRV: case IOCTL_REM_SRV: printk(KERN_DEBUG "dnbd3: ioctl add/rem srv\n"); if (dev->imgname == NULL) { result = -ENOENT; } else if (dev->new_servers_num >= NUMBER_SERVERS) { result = -EAGAIN; } else if (msg == NULL) { result = -EINVAL; } else { memcpy(&dev->new_servers[dev->new_servers_num].host, &msg->host, sizeof(msg->host)); dev->new_servers[dev->new_servers_num].failures = (cmd == IOCTL_ADD_SRV ? 0 : 1); // 0 = ADD, 1 = REM ++dev->new_servers_num; result = 0; } break; case BLKFLSBUF: printk(KERN_DEBUG "dnbd3: ioctl blkflsbuf\n"); result = 0; break; default: printk(KERN_DEBUG "dnbd3: ioctl unhandled cmd\n"); result = -EIO; break; } cleanup_return: if (msg) kfree(msg); if (imgname) kfree(imgname); return result; } struct block_device_operations dnbd3_fops = { .owner = THIS_MODULE, .open = dnbd3_open, .release = dnbd3_release, .ioctl = dnbd3_ioctl, .compat_ioctl = dnbd3_ioctl, };