diff options
Diffstat (limited to 'cpukit/libblock/src/blkdev.c')
| -rw-r--r-- | cpukit/libblock/src/blkdev.c | 263 |
1 files changed, 263 insertions, 0 deletions
diff --git a/cpukit/libblock/src/blkdev.c b/cpukit/libblock/src/blkdev.c new file mode 100644 index 0000000000..10c14dfaf2 --- /dev/null +++ b/cpukit/libblock/src/blkdev.c @@ -0,0 +1,263 @@ +/** + * @file + * + * @ingroup rtems_blkdev + * + * Block device management. + */ + +/* + * Copyright (C) 2001 OKTET Ltd., St.-Petersburg, Russia + * Author: Victor V. Vengerov <vvv@oktet.ru> + * + * @(#) $Id$ + */ + +#if HAVE_CONFIG_H +#include "config.h" +#endif + +#include <errno.h> +#include <string.h> + +#include <rtems.h> +#include <rtems/libio.h> +#include <sys/ioctl.h> + +#include "rtems/diskdevs.h" +#include "rtems/bdbuf.h" + +/* rtems_blkdev_generic_read -- + * Generic block device read primitive. Implemented using block device + * buffer management primitives. + */ +rtems_device_driver +rtems_blkdev_generic_read( + rtems_device_major_number major __attribute__((unused)), + rtems_device_minor_number minor __attribute__((unused)), + void * arg) +{ + rtems_status_code rc = RTEMS_SUCCESSFUL; + rtems_libio_rw_args_t *args = arg; + rtems_libio_t *iop = args->iop; + rtems_disk_device *dd = iop->data1; + uint32_t block_size = dd->block_size; + char *buf = args->buffer; + uint32_t count = args->count; + rtems_blkdev_bnum block = (rtems_blkdev_bnum) (args->offset / block_size); + uint32_t blkofs = (uint32_t) (args->offset % block_size); + dev_t dev = dd->dev; + + args->bytes_moved = 0; + + while (count > 0) + { + rtems_bdbuf_buffer *diskbuf; + uint32_t copy; + + rc = rtems_bdbuf_read(dev, block, &diskbuf); + if (rc != RTEMS_SUCCESSFUL) + break; + copy = block_size - blkofs; + if (copy > count) + copy = count; + memcpy(buf, (char *)diskbuf->buffer + blkofs, copy); + rc = rtems_bdbuf_release(diskbuf); + args->bytes_moved += copy; + if (rc != RTEMS_SUCCESSFUL) + break; + count -= copy; + buf += copy; + blkofs = 0; + block++; + } + + return rc; +} + +/* rtems_blkdev_generic_write -- + * Generic block device write primitive. Implemented using block device + * buffer management primitives. + */ +rtems_device_driver +rtems_blkdev_generic_write( + rtems_device_major_number major __attribute__((unused)), + rtems_device_minor_number minor __attribute__((unused)), + void * arg) +{ + rtems_status_code rc = RTEMS_SUCCESSFUL; + rtems_libio_rw_args_t *args = arg; + rtems_libio_t *iop = args->iop; + rtems_disk_device *dd = iop->data1; + uint32_t block_size = dd->block_size; + char *buf = args->buffer; + uint32_t count = args->count; + rtems_blkdev_bnum block = (rtems_blkdev_bnum) (args->offset / block_size); + uint32_t blkofs = (uint32_t) (args->offset % block_size); + dev_t dev = dd->dev; + + args->bytes_moved = 0; + + while (count > 0) + { + rtems_bdbuf_buffer *diskbuf; + uint32_t copy; + + if ((blkofs == 0) && (count >= block_size)) + rc = rtems_bdbuf_get(dev, block, &diskbuf); + else + rc = rtems_bdbuf_read(dev, block, &diskbuf); + if (rc != RTEMS_SUCCESSFUL) + break; + + copy = block_size - blkofs; + if (copy > count) + copy = count; + memcpy((char *)diskbuf->buffer + blkofs, buf, copy); + args->bytes_moved += copy; + + rc = rtems_bdbuf_release_modified(diskbuf); + if (rc != RTEMS_SUCCESSFUL) + break; + + count -= copy; + buf += copy; + blkofs = 0; + block++; + } + + return rc; +} + +/* blkdev_generic_open -- + * Generic block device open primitive. + */ +rtems_device_driver +rtems_blkdev_generic_open( + rtems_device_major_number major, + rtems_device_minor_number minor, + void * arg) +{ + rtems_libio_open_close_args_t *oc = arg; + rtems_libio_t *iop = oc->iop; + dev_t dev = rtems_filesystem_make_dev_t(major, minor); + rtems_disk_device *dd = rtems_disk_obtain(dev); + + iop->data1 = dd; + + if (dd != NULL) + return RTEMS_SUCCESSFUL; + else + return RTEMS_UNSATISFIED; +} + + +/* blkdev_generic_close -- + * Generic block device close primitive. + */ +rtems_device_driver +rtems_blkdev_generic_close( + rtems_device_major_number major __attribute__((unused)), + rtems_device_minor_number minor __attribute__((unused)), + void * arg) +{ + rtems_libio_open_close_args_t *oc = arg; + rtems_libio_t *iop = oc->iop; + rtems_disk_device *dd = iop->data1; + + rtems_disk_release(dd); + + return RTEMS_SUCCESSFUL; +} + +/* blkdev_generic_ioctl -- + * Generic block device ioctl primitive. + */ +rtems_device_driver +rtems_blkdev_generic_ioctl( + rtems_device_major_number major __attribute__((unused)), + rtems_device_minor_number minor __attribute__((unused)), + void * arg) +{ + rtems_libio_ioctl_args_t *args = arg; + rtems_libio_t *iop = args->iop; + rtems_disk_device *dd = iop->data1; + int rc; + + switch (args->command) + { + case RTEMS_BLKIO_GETMEDIABLKSIZE: + *((uint32_t *) args->buffer) = dd->media_block_size; + args->ioctl_return = 0; + break; + + case RTEMS_BLKIO_GETBLKSIZE: + *((uint32_t *) args->buffer) = dd->block_size; + args->ioctl_return = 0; + break; + + case RTEMS_BLKIO_SETBLKSIZE: + dd->block_size = *((uint32_t *) args->buffer); + args->ioctl_return = 0; + break; + + case RTEMS_BLKIO_GETSIZE: + *((rtems_blkdev_bnum *) args->buffer) = dd->size; + args->ioctl_return = 0; + break; + + case RTEMS_BLKIO_SYNCDEV: + rc = rtems_bdbuf_syncdev(dd->dev); + args->ioctl_return = (uint32_t) (rc == RTEMS_SUCCESSFUL ? 0 : -1); + break; + + case RTEMS_BLKIO_REQUEST: + /* + * It is not allowed to directly access the driver circumventing + * the cache. + */ + args->ioctl_return = (uint32_t) -1; + break; + + default: + args->ioctl_return = (uint32_t) dd->ioctl(dd->phys_dev, + args->command, + args->buffer); + break; + } + + return RTEMS_SUCCESSFUL; +} + +int +rtems_blkdev_ioctl(rtems_disk_device *dd, uint32_t req, void *argp) +{ + size_t *arg_size = argp; + int rc = 0; + + switch (req) + { + case RTEMS_BLKIO_GETMEDIABLKSIZE: + *arg_size = dd->media_block_size; + break; + + case RTEMS_BLKIO_GETBLKSIZE: + *arg_size = dd->block_size; + break; + + case RTEMS_BLKIO_SETBLKSIZE: + dd->block_size = *arg_size; + break; + + case RTEMS_BLKIO_GETSIZE: + *arg_size = dd->size; + break; + + default: + errno = EINVAL; + rc = -1; + break; + } + + return rc; +} |