Whamcloud - gitweb
libext2fs: factor out I/O buffer allocation
[tools/e2fsprogs.git] / lib / ext2fs / unix_io.c
index 8497a41..2ce0563 100644 (file)
@@ -4,20 +4,24 @@
  *
  * Implements a one-block write-through cache.
  *
- * Includes support for Windows NT support under Cygwin. 
+ * Includes support for Windows NT support under Cygwin.
  *
  * Copyright (C) 1993, 1994, 1995, 1996, 1997, 1998, 1999, 2000, 2001,
  *     2002 by Theodore Ts'o.
  *
  * %Begin-Header%
- * This file may be redistributed under the terms of the GNU Public
- * License.
+ * This file may be redistributed under the terms of the GNU Library
+ * General Public License, version 2.
  * %End-Header%
  */
 
 #define _LARGEFILE_SOURCE
 #define _LARGEFILE64_SOURCE
+#ifndef _GNU_SOURCE
+#define _GNU_SOURCE
+#endif
 
+#include "config.h"
 #include <stdio.h>
 #include <string.h>
 #if HAVE_UNISTD_H
 #ifdef __linux__
 #include <sys/utsname.h>
 #endif
+#ifdef HAVE_SYS_IOCTL_H
+#include <sys/ioctl.h>
+#endif
+#ifdef HAVE_SYS_MOUNT_H
+#include <sys/mount.h>
+#endif
 #if HAVE_SYS_STAT_H
 #include <sys/stat.h>
 #endif
 #if HAVE_SYS_RESOURCE_H
 #include <sys/resource.h>
 #endif
+#if HAVE_LINUX_FALLOC_H
+#include <linux/falloc.h>
+#endif
+
+#if defined(__linux__) && defined(_IO) && !defined(BLKROGET)
+#define BLKROGET   _IO(0x12, 94) /* Get read-only status (0 = read_write).  */
+#endif
+
+#undef ALIGN_DEBUG
 
 #include "ext2_fs.h"
 #include "ext2fs.h"
@@ -67,12 +86,17 @@ struct unix_private_data {
        int     magic;
        int     dev;
        int     flags;
+       int     align;
        int     access_time;
        ext2_loff_t offset;
        struct unix_cache cache[CACHE_SIZE];
+       void    *bounce;
        struct struct_io_stats io_stats;
 };
 
+#define IS_ALIGNED(n, align) ((((unsigned long) n) & \
+                              ((unsigned long) ((align)-1))) == 0)
+
 static errcode_t unix_open(const char *name, int flags, io_channel *channel);
 static errcode_t unix_close(io_channel channel);
 static errcode_t unix_set_blksize(io_channel channel, int blksize);
@@ -83,20 +107,18 @@ static errcode_t unix_write_blk(io_channel channel, unsigned long block,
 static errcode_t unix_flush(io_channel channel);
 static errcode_t unix_write_byte(io_channel channel, unsigned long offset,
                                int size, const void *data);
-static errcode_t unix_set_option(io_channel channel, const char *option, 
+static errcode_t unix_set_option(io_channel channel, const char *option,
                                 const char *arg);
 static errcode_t unix_get_stats(io_channel channel, io_stats *stats)
 ;
 static void reuse_cache(io_channel channel, struct unix_private_data *data,
-                struct unix_cache *cache, unsigned long block);
-
-/* __FreeBSD_kernel__ is defined by GNU/kFreeBSD - the FreeBSD kernel
- * does not know buffered block devices - everything is raw. */
-#if defined(__CYGWIN__) || defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
-#define NEED_BOUNCE_BUFFER
-#else
-#undef NEED_BOUNCE_BUFFER
-#endif
+                struct unix_cache *cache, unsigned long long block);
+static errcode_t unix_read_blk64(io_channel channel, unsigned long long block,
+                              int count, void *data);
+static errcode_t unix_write_blk64(io_channel channel, unsigned long long block,
+                               int count, const void *data);
+static errcode_t unix_discard(io_channel channel, unsigned long long block,
+                             unsigned long long count);
 
 static struct struct_io_manager struct_unix_manager = {
        EXT2_ET_MAGIC_IO_MANAGER,
@@ -107,13 +129,12 @@ static struct struct_io_manager struct_unix_manager = {
        unix_read_blk,
        unix_write_blk,
        unix_flush,
-#ifdef NEED_BOUNCE_BUFFER
-       0,
-#else
        unix_write_byte,
-#endif
        unix_set_option,
        unix_get_stats,
+       unix_read_blk64,
+       unix_write_blk64,
+       unix_discard,
 };
 
 io_manager unix_io_manager = &struct_unix_manager;
@@ -137,16 +158,16 @@ static errcode_t unix_get_stats(io_channel channel, io_stats *stats)
 /*
  * Here are the raw I/O functions
  */
-#ifndef NEED_BOUNCE_BUFFER
 static errcode_t raw_read_blk(io_channel channel,
                              struct unix_private_data *data,
-                             unsigned long block,
-                             int count, void *buf)
+                             unsigned long long block,
+                             int count, void *bufv)
 {
        errcode_t       retval;
        ssize_t         size;
        ext2_loff_t     location;
        int             actual = 0;
+       unsigned char   *buf = bufv;
 
        size = (count < 0) ? -count : count * channel->block_size;
        data->io_stats.bytes_read += size;
@@ -155,87 +176,60 @@ static errcode_t raw_read_blk(io_channel channel,
                retval = errno ? errno : EXT2_ET_LLSEEK_FAILED;
                goto error_out;
        }
-       actual = read(data->dev, buf, size);
-       if (actual != size) {
-               if (actual < 0)
-                       actual = 0;
-               retval = EXT2_ET_SHORT_READ;
-               goto error_out;
+       if ((channel->align == 0) ||
+           (IS_ALIGNED(buf, channel->align) &&
+            IS_ALIGNED(size, channel->align))) {
+               actual = read(data->dev, buf, size);
+               if (actual != size) {
+               short_read:
+                       if (actual < 0)
+                               actual = 0;
+                       retval = EXT2_ET_SHORT_READ;
+                       goto error_out;
+               }
+               return 0;
        }
-       return 0;
-       
-error_out:
-       memset((char *) buf+actual, 0, size-actual);
-       if (channel->read_error)
-               retval = (channel->read_error)(channel, block, count, buf,
-                                              size, actual, retval);
-       return retval;
-}
-#else /* NEED_BOUNCE_BUFFER */
-/*
- * Windows and FreeBSD block devices only allow sector alignment IO in offset and size
- */
-static errcode_t raw_read_blk(io_channel channel,
-                             struct unix_private_data *data,
-                             unsigned long block,
-                             int count, void *buf)
-{
-       errcode_t       retval;
-       size_t          size, alignsize, fragment;
-       ext2_loff_t     location;
-       int             total = 0, actual;
-#define BLOCKALIGN 512
-       char            sector[BLOCKALIGN];
 
-       size = (count < 0) ? -count : count * channel->block_size;
-       data->io_stats.bytes_read += size;
-       location = ((ext2_loff_t) block * channel->block_size) + data->offset;
-#ifdef DEBUG
-       printf("count=%d, size=%d, block=%lu, blk_size=%d, location=%llx\n",
-                       count, size, block, channel->block_size, (long long)location);
+#ifdef ALIGN_DEBUG
+       printf("raw_read_blk: O_DIRECT fallback: %p %lu\n", buf,
+              (unsigned long) size);
 #endif
-       if (ext2fs_llseek(data->dev, location, SEEK_SET) != location) {
-               retval = errno ? errno : EXT2_ET_LLSEEK_FAILED;
-               goto error_out;
-       }
-       fragment = size % BLOCKALIGN;
-       alignsize = size - fragment;
-       if (alignsize) {
-               actual = read(data->dev, buf, alignsize);
-               if (actual != alignsize)
-                       goto short_read;
-       }
-       if (fragment) {
-               actual = read(data->dev, sector, BLOCKALIGN);
-               if (actual != BLOCKALIGN)
+
+       /*
+        * The buffer or size which we're trying to read isn't aligned
+        * to the O_DIRECT rules, so we need to do this the hard way...
+        */
+       while (size > 0) {
+               actual = read(data->dev, data->bounce, channel->block_size);
+               if (actual != channel->block_size)
                        goto short_read;
-               memcpy(buf+alignsize, sector, fragment);
+               actual = size;
+               if (size > channel->block_size)
+                       actual = channel->block_size;
+               memcpy(buf, data->bounce, actual);
+               size -= actual;
+               buf += actual;
        }
        return 0;
 
-short_read:
-       if (actual>0)
-               total += actual;
-       retval = EXT2_ET_SHORT_READ;
-
 error_out:
-       memset((char *) buf+total, 0, size-actual);
+       memset((char *) buf+actual, 0, size-actual);
        if (channel->read_error)
                retval = (channel->read_error)(channel, block, count, buf,
                                               size, actual, retval);
        return retval;
 }
-#endif
 
 static errcode_t raw_write_blk(io_channel channel,
                               struct unix_private_data *data,
-                              unsigned long block,
-                              int count, const void *buf)
+                              unsigned long long block,
+                              int count, const void *bufv)
 {
        ssize_t         size;
        ext2_loff_t     location;
        int             actual = 0;
        errcode_t       retval;
+       const unsigned char *buf = bufv;
 
        if (count == 1)
                size = channel->block_size;
@@ -252,14 +246,48 @@ static errcode_t raw_write_blk(io_channel channel,
                retval = errno ? errno : EXT2_ET_LLSEEK_FAILED;
                goto error_out;
        }
-       
-       actual = write(data->dev, buf, size);
-       if (actual != size) {
-               retval = EXT2_ET_SHORT_WRITE;
-               goto error_out;
+
+       if ((channel->align == 0) ||
+           (IS_ALIGNED(buf, channel->align) &&
+            IS_ALIGNED(size, channel->align))) {
+               actual = write(data->dev, buf, size);
+               if (actual != size) {
+               short_write:
+                       retval = EXT2_ET_SHORT_WRITE;
+                       goto error_out;
+               }
+               return 0;
+       }
+
+#ifdef ALIGN_DEBUG
+       printf("raw_write_blk: O_DIRECT fallback: %p %lu\n", buf,
+              (unsigned long) size);
+#endif
+       /*
+        * The buffer or size which we're trying to write isn't aligned
+        * to the O_DIRECT rules, so we need to do this the hard way...
+        */
+       while (size > 0) {
+               if (size < channel->block_size) {
+                       actual = read(data->dev, data->bounce,
+                                     channel->block_size);
+                       if (actual != channel->block_size) {
+                               retval = EXT2_ET_SHORT_READ;
+                               goto error_out;
+                       }
+               }
+               actual = size;
+               if (size > channel->block_size)
+                       actual = channel->block_size;
+               memcpy(data->bounce, buf, actual);
+               actual = write(data->dev, data->bounce, channel->block_size);
+               if (actual != channel->block_size)
+                       goto short_write;
+               size -= actual;
+               buf += actual;
        }
        return 0;
-       
+
 error_out:
        if (channel->write_error)
                retval = (channel->write_error)(channel, block, count, buf,
@@ -279,18 +307,25 @@ static errcode_t alloc_cache(io_channel channel,
        errcode_t               retval;
        struct unix_cache       *cache;
        int                     i;
-       
+
        data->access_time = 0;
        for (i=0, cache = data->cache; i < CACHE_SIZE; i++, cache++) {
                cache->block = 0;
                cache->access_time = 0;
                cache->dirty = 0;
                cache->in_use = 0;
-               if ((retval = ext2fs_get_mem(channel->block_size,
-                                            &cache->buf)))
+               if (cache->buf)
+                       ext2fs_free_mem(&cache->buf);
+               retval = io_channel_alloc_buf(channel, 0, &cache->buf);
+               if (retval)
                        return retval;
        }
-       return 0;
+       if (channel->align) {
+               if (data->bounce)
+                       ext2fs_free_mem(&data->bounce);
+               retval = io_channel_alloc_buf(channel, 0, &data->bounce);
+       }
+       return retval;
 }
 
 /* Free the cache buffers */
@@ -298,7 +333,7 @@ static void free_cache(struct unix_private_data *data)
 {
        struct unix_cache       *cache;
        int                     i;
-       
+
        data->access_time = 0;
        for (i=0, cache = data->cache; i < CACHE_SIZE; i++, cache++) {
                cache->block = 0;
@@ -307,8 +342,9 @@ static void free_cache(struct unix_private_data *data)
                cache->in_use = 0;
                if (cache->buf)
                        ext2fs_free_mem(&cache->buf);
-               cache->buf = 0;
        }
+       if (data->bounce)
+               ext2fs_free_mem(&data->bounce);
 }
 
 #ifndef NO_IO_CACHE
@@ -318,12 +354,12 @@ static void free_cache(struct unix_private_data *data)
  * entry to that should be reused.
  */
 static struct unix_cache *find_cached_block(struct unix_private_data *data,
-                                           unsigned long block,
+                                           unsigned long long block,
                                            struct unix_cache **eldest)
 {
        struct unix_cache       *cache, *unused_cache, *oldest_cache;
        int                     i;
-       
+
        unused_cache = oldest_cache = 0;
        for (i=0, cache = data->cache; i < CACHE_SIZE; i++, cache++) {
                if (!cache->in_use) {
@@ -348,7 +384,7 @@ static struct unix_cache *find_cached_block(struct unix_private_data *data,
  * Reuse a particular cache entry for another block.
  */
 static void reuse_cache(io_channel channel, struct unix_private_data *data,
-                struct unix_cache *cache, unsigned long block)
+                struct unix_cache *cache, unsigned long long block)
 {
        if (cache->dirty && cache->in_use)
                raw_write_blk(channel, data, cache->block, 1, cache->buf);
@@ -370,18 +406,18 @@ static errcode_t flush_cached_blocks(io_channel channel,
        struct unix_cache       *cache;
        errcode_t               retval, retval2;
        int                     i;
-       
+
        retval2 = 0;
        for (i=0, cache = data->cache; i < CACHE_SIZE; i++, cache++) {
                if (!cache->in_use)
                        continue;
-               
+
                if (invalidate)
                        cache->in_use = 0;
-               
+
                if (!cache->dirty)
                        continue;
-               
+
                retval = raw_write_blk(channel, data,
                                       cache->block, 1, cache->buf);
                if (retval)
@@ -393,13 +429,20 @@ static errcode_t flush_cached_blocks(io_channel channel,
 }
 #endif /* NO_IO_CACHE */
 
+#ifdef __linux__
+#ifndef BLKDISCARDZEROES
+#define BLKDISCARDZEROES _IO(0x12,124)
+#endif
+#endif
+
 static errcode_t unix_open(const char *name, int flags, io_channel *channel)
 {
        io_channel      io = NULL;
        struct unix_private_data *data = NULL;
        errcode_t       retval;
-       int             open_flags;
-       struct stat     st;
+       int             open_flags, zeroes = 0;
+       int             f_nocache = 0;
+       ext2fs_struct_stat st;
 #ifdef __linux__
        struct          utsname ut;
 #endif
@@ -408,7 +451,7 @@ static errcode_t unix_open(const char *name, int flags, io_channel *channel)
                return EXT2_ET_BAD_DEVICE_NAME;
        retval = ext2fs_get_mem(sizeof(struct struct_io_channel), &io);
        if (retval)
-               return retval;
+               goto cleanup;
        memset(io, 0, sizeof(struct struct_io_channel));
        io->magic = EXT2_ET_MAGIC_IO_CHANNEL;
        retval = ext2fs_get_mem(sizeof(struct unix_private_data), &data);
@@ -431,21 +474,81 @@ static errcode_t unix_open(const char *name, int flags, io_channel *channel)
        data->magic = EXT2_ET_MAGIC_UNIX_IO_CHANNEL;
        data->io_stats.num_fields = 2;
 
-       if ((retval = alloc_cache(io, data)))
-               goto cleanup;
-
        open_flags = (flags & IO_FLAG_RW) ? O_RDWR : O_RDONLY;
        if (flags & IO_FLAG_EXCLUSIVE)
                open_flags |= O_EXCL;
-#ifdef HAVE_OPEN64
-       data->dev = open64(io->name, open_flags);
-#else
-       data->dev = open(io->name, open_flags);
+#if defined(O_DIRECT)
+       if (flags & IO_FLAG_DIRECT_IO) {
+               open_flags |= O_DIRECT;
+               io->align = ext2fs_get_dio_alignment(data->dev);
+       }
+#elif defined(F_NOCACHE)
+       if (flags & IO_FLAG_DIRECT_IO) {
+               f_nocache = F_NOCACHE;
+               io->align = 4096;
+       }
 #endif
+       data->flags = flags;
+
+       data->dev = ext2fs_open_file(io->name, open_flags, 0);
        if (data->dev < 0) {
                retval = errno;
                goto cleanup;
        }
+       if (f_nocache) {
+               if (fcntl(data->dev, f_nocache, 1) < 0) {
+                       retval = errno;
+                       goto cleanup;
+               }
+       }
+
+       /*
+        * If the device is really a block device, then set the
+        * appropriate flag, otherwise we can set DISCARD_ZEROES flag
+        * because we are going to use punch hole instead of discard
+        * and if it succeed, subsequent read from sparse area returns
+        * zero.
+        */
+       if (ext2fs_stat(io->name, &st) == 0) {
+               if (S_ISBLK(st.st_mode))
+                       io->flags |= CHANNEL_FLAGS_BLOCK_DEVICE;
+               else
+                       io->flags |= CHANNEL_FLAGS_DISCARD_ZEROES;
+       }
+
+#ifdef BLKDISCARDZEROES
+       ioctl(data->dev, BLKDISCARDZEROES, &zeroes);
+       if (zeroes)
+               io->flags |= CHANNEL_FLAGS_DISCARD_ZEROES;
+#endif
+
+#if defined(__CYGWIN__) || defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
+       /*
+        * Some operating systems require that the buffers be aligned,
+        * regardless of O_DIRECT
+        */
+       if (!io->align)
+               io->align = 512;
+#endif
+
+
+       if ((retval = alloc_cache(io, data)))
+               goto cleanup;
+
+#ifdef BLKROGET
+       if (flags & IO_FLAG_RW) {
+               int error;
+               int readonly = 0;
+
+               /* Is the block device actually writable? */
+               error = ioctl(data->dev, BLKROGET, &readonly);
+               if (!error && readonly) {
+                       close(data->dev);
+                       retval = EPERM;
+                       goto cleanup;
+               }
+       }
+#endif
 
 #ifdef __linux__
 #undef RLIM_INFINITY
@@ -459,7 +562,7 @@ static errcode_t unix_open(const char *name, int flags, io_channel *channel)
         * block devices are wrongly getting hit by the filesize
         * limit.  This workaround isn't perfect, since it won't work
         * if glibc wasn't built against 2.2 header files.  (Sigh.)
-        * 
+        *
         */
        if ((flags & IO_FLAG_RW) &&
            (uname(&ut) == 0) &&
@@ -467,10 +570,10 @@ static errcode_t unix_open(const char *name, int flags, io_channel *channel)
             (ut.release[2] == '4') && (ut.release[3] == '.') &&
             (ut.release[4] == '1') && (ut.release[5] >= '0') &&
             (ut.release[5] < '8')) &&
-           (fstat(data->dev, &st) == 0) &&
+           (ext2fs_stat(io->name, &st) == 0) &&
            (S_ISBLK(st.st_mode))) {
                struct rlimit   rlim;
-               
+
                rlim.rlim_cur = rlim.rlim_max = (unsigned long) RLIM_INFINITY;
                setrlimit(RLIMIT_FSIZE, &rlim);
                getrlimit(RLIMIT_FSIZE, &rlim);
@@ -535,7 +638,7 @@ static errcode_t unix_set_blksize(io_channel channel, int blksize)
                if ((retval = flush_cached_blocks(channel, data, 0)))
                        return retval;
 #endif
-               
+
                channel->block_size = blksize;
                free_cache(data);
                if ((retval = alloc_cache(channel, data)))
@@ -545,7 +648,7 @@ static errcode_t unix_set_blksize(io_channel channel, int blksize)
 }
 
 
-static errcode_t unix_read_blk(io_channel channel, unsigned long block,
+static errcode_t unix_read_blk64(io_channel channel, unsigned long long block,
                               int count, void *buf)
 {
        struct unix_private_data *data;
@@ -584,6 +687,22 @@ static errcode_t unix_read_blk(io_channel channel, unsigned long block,
                        cp += channel->block_size;
                        continue;
                }
+               if (count == 1) {
+                       /*
+                        * Special case where we read directly into the
+                        * cache buffer; important in the O_DIRECT case
+                        */
+                       cache = reuse[0];
+                       reuse_cache(channel, data, cache, block);
+                       if ((retval = raw_read_blk(channel, data, block, 1,
+                                                  cache->buf))) {
+                               cache->in_use = 0;
+                               return retval;
+                       }
+                       memcpy(cp, cache->buf, channel->block_size);
+                       return 0;
+               }
+
                /*
                 * Find the number of uncached blocks so we can do a
                 * single read request
@@ -596,7 +715,7 @@ static errcode_t unix_read_blk(io_channel channel, unsigned long block,
 #endif
                if ((retval = raw_read_blk(channel, data, block, i, cp)))
                        return retval;
-               
+
                /* Save the results in the cache */
                for (j=0; j < i; j++) {
                        count--;
@@ -610,7 +729,13 @@ static errcode_t unix_read_blk(io_channel channel, unsigned long block,
 #endif /* NO_IO_CACHE */
 }
 
-static errcode_t unix_write_blk(io_channel channel, unsigned long block,
+static errcode_t unix_read_blk(io_channel channel, unsigned long block,
+                              int count, void *buf)
+{
+       return unix_read_blk64(channel, block, count, buf);
+}
+
+static errcode_t unix_write_blk64(io_channel channel, unsigned long long block,
                                int count, const void *buf)
 {
        struct unix_private_data *data;
@@ -625,7 +750,7 @@ static errcode_t unix_write_blk(io_channel channel, unsigned long block,
 
 #ifdef NO_IO_CACHE
        return raw_write_blk(channel, data, block, count, buf);
-#else  
+#else
        /*
         * If we're doing an odd-sized write or a very large write,
         * flush out the cache completely and then do a direct write.
@@ -644,7 +769,7 @@ static errcode_t unix_write_blk(io_channel channel, unsigned long block,
        writethrough = channel->flags & CHANNEL_FLAGS_WRITETHROUGH;
        if (writethrough)
                retval = raw_write_blk(channel, data, block, count, buf);
-       
+
        cp = buf;
        while (count > 0) {
                cache = find_cached_block(data, block, &reuse);
@@ -662,6 +787,12 @@ static errcode_t unix_write_blk(io_channel channel, unsigned long block,
 #endif /* NO_IO_CACHE */
 }
 
+static errcode_t unix_write_blk(io_channel channel, unsigned long block,
+                               int count, const void *buf)
+{
+       return unix_write_blk64(channel, block, count, buf);
+}
+
 static errcode_t unix_write_byte(io_channel channel, unsigned long offset,
                                 int size, const void *buf)
 {
@@ -673,6 +804,13 @@ static errcode_t unix_write_byte(io_channel channel, unsigned long offset,
        data = (struct unix_private_data *) channel->private_data;
        EXT2_CHECK_MAGIC(data, EXT2_ET_MAGIC_UNIX_IO_CHANNEL);
 
+       if (channel->align != 0) {
+#ifdef ALIGN_DEBUG
+               printf("unix_write_byte: O_DIRECT fallback\n");
+#endif
+               return EXT2_ET_UNIMPLEMENTED;
+       }
+
 #ifndef NO_IO_CACHE
        /*
         * Flush out the cache completely
@@ -683,7 +821,7 @@ static errcode_t unix_write_byte(io_channel channel, unsigned long offset,
 
        if (lseek(data->dev, offset + data->offset, SEEK_SET) < 0)
                return errno;
-       
+
        actual = write(data->dev, buf, size);
        if (actual != size)
                return EXT2_ET_SHORT_WRITE;
@@ -692,13 +830,13 @@ static errcode_t unix_write_byte(io_channel channel, unsigned long offset,
 }
 
 /*
- * Flush data buffers to disk.  
+ * Flush data buffers to disk.
  */
 static errcode_t unix_flush(io_channel channel)
 {
        struct unix_private_data *data;
        errcode_t retval = 0;
-       
+
        EXT2_CHECK_MAGIC(channel, EXT2_ET_MAGIC_IO_CHANNEL);
        data = (struct unix_private_data *) channel->private_data;
        EXT2_CHECK_MAGIC(data, EXT2_ET_MAGIC_UNIX_IO_CHANNEL);
@@ -710,7 +848,7 @@ static errcode_t unix_flush(io_channel channel)
        return retval;
 }
 
-static errcode_t unix_set_option(io_channel channel, const char *option, 
+static errcode_t unix_set_option(io_channel channel, const char *option,
                                 const char *arg)
 {
        struct unix_private_data *data;
@@ -735,3 +873,51 @@ static errcode_t unix_set_option(io_channel channel, const char *option,
        }
        return EXT2_ET_INVALID_ARGUMENT;
 }
+
+#if defined(__linux__) && !defined(BLKDISCARD)
+#define BLKDISCARD             _IO(0x12,119)
+#endif
+
+static errcode_t unix_discard(io_channel channel, unsigned long long block,
+                             unsigned long long count)
+{
+       struct unix_private_data *data;
+       __uint64_t      range[2];
+       int             ret;
+
+       EXT2_CHECK_MAGIC(channel, EXT2_ET_MAGIC_IO_CHANNEL);
+       data = (struct unix_private_data *) channel->private_data;
+       EXT2_CHECK_MAGIC(data, EXT2_ET_MAGIC_UNIX_IO_CHANNEL);
+
+       if (channel->flags & CHANNEL_FLAGS_BLOCK_DEVICE) {
+#ifdef BLKDISCARD
+               range[0] = (__uint64_t)(block) * channel->block_size;
+               range[1] = (__uint64_t)(count) * channel->block_size;
+
+               ret = ioctl(data->dev, BLKDISCARD, &range);
+#else
+               goto unimplemented;
+#endif
+       } else {
+#if defined(HAVE_FALLOCATE) && defined(FALLOC_FL_PUNCH_HOLE)
+               /*
+                * If we are not on block device, try to use punch hole
+                * to reclaim free space.
+                */
+               ret = fallocate(data->dev,
+                               FALLOC_FL_PUNCH_HOLE | FALLOC_FL_KEEP_SIZE,
+                               (off_t)(block) * channel->block_size,
+                               (off_t)(count) * channel->block_size);
+#else
+               goto unimplemented;
+#endif
+       }
+       if (ret < 0) {
+               if (errno == EOPNOTSUPP)
+                       goto unimplemented;
+               return errno;
+       }
+       return 0;
+unimplemented:
+       return EXT2_ET_UNIMPLEMENTED;
+}