text: /*
   *  linux/fs/nfs/blocklayout/blocklayout.c
   *
   *  Module for the NFSv4.1 pNFS block layout driver.
   *
   *  Copyright (c) 2006 The Regents of the University of Michigan.
   *  All rights reserved.
   *
   *  Andy Adamson <andros@citi.umich.edu>
   *  Fred Isaman <iisaman@umich.edu>
   *
   * permission is granted to use, copy, create derivative works and
   * redistribute this software and such derivative works for any purpose,
   * so long as the name of the university of michigan is not used in
   * any advertising or publicity pertaining to the use or distribution
   * of this software without specific, written prior authorization.  if
   * the above copyright notice or any other identification of the
   * university of michigan is included in any copy of any portion of
   * this software, then the disclaimer below must also be included.
   *
   * this software is provided as is, without representation from the
   * university of michigan as to its fitness for any purpose, and without
   * warranty by the university of michigan of any kind, either express
   * or implied, including without limitation the implied warranties of
   * merchantability and fitness for a particular purpose.  the regents
   * of the university of michigan shall not be liable for any damages,
   * including special, indirect, incidental, or consequential damages,
   * with respect to any claim arising out or in connection with the use
   * of the software, even if it has been or is hereafter advised of the
   * possibility of such damages.
   */
  
  #include <linux/module.h>
  #include <linux/init.h>
  #include <linux/mount.h>
  #include <linux/namei.h>
  #include <linux/bio.h>		/* struct bio */
  #include <linux/prefetch.h>
  #include <linux/pagevec.h>
  
  #include "../pnfs.h"
  #include "../nfs4session.h"
  #include "../internal.h"
  #include "blocklayout.h"
  
  #define NFSDBG_FACILITY	NFSDBG_PNFS_LD
  
  MODULE_LICENSE("GPL");
  MODULE_AUTHOR("Andy Adamson <andros@citi.umich.edu>");
  MODULE_DESCRIPTION("The NFSv4.1 pNFS Block layout driver");
  
  static bool is_hole(struct pnfs_block_extent *be)
  {
  	switch (be->be_state) {
  	case PNFS_BLOCK_NONE_DATA:
  		return true;
  	case PNFS_BLOCK_INVALID_DATA:
  		return be->be_tag ? false : true;
  	default:
  		return false;
  	}
  }
  
  /* The data we are handed might be spread across several bios.  We need
   * to track when the last one is finished.
   */
  struct parallel_io {
  	struct kref refcnt;
  	void (*pnfs_callback) (void *data);
  	void *data;
  };
  
  static inline struct parallel_io *alloc_parallel(void *data)
  {
  	struct parallel_io *rv;
  
  	rv  = kmalloc(sizeof(*rv), GFP_NOFS);
  	if (rv) {
  		rv->data = data;
  		kref_init(&rv->refcnt);
  	}
  	return rv;
  }
  
  static inline void get_parallel(struct parallel_io *p)
  {
  	kref_get(&p->refcnt);
  }
  
  static void destroy_parallel(struct kref *kref)
  {
  	struct parallel_io *p = container_of(kref, struct parallel_io, refcnt);
  
  	dprintk("%s enter\n", __func__);
  	p->pnfs_callback(p->data);
  	kfree(p);
  }
  
  static inline void put_parallel(struct parallel_io *p)
  {
  	kref_put(&p->refcnt, destroy_parallel);
  }
  
  static struct bio *
  bl_submit_bio(struct bio *bio)
  {
  	if (bio) {
  		get_parallel(bio->bi_private);
  		dprintk("%s submitting %s bio %u@%llu\n", __func__,
  			bio_op(bio) == READ ? "read" : "write",
  			bio->bi_iter.bi_size,
  			(unsigned long long)bio->bi_iter.bi_sector);
  		submit_bio(bio);
  	}
  	return NULL;
  }
  
  static struct bio *
  bl_alloc_init_bio(int npg, struct block_device *bdev, sector_t disk_sector,
  		bio_end_io_t end_io, struct parallel_io *par)
  {
  	struct bio *bio;
  
  	npg = min(npg, BIO_MAX_PAGES);
  	bio = bio_alloc(GFP_NOIO, npg);
  	if (!bio && (current->flags & PF_MEMALLOC)) {
  		while (!bio && (npg /= 2))
  			bio = bio_alloc(GFP_NOIO, npg);
  	}
  
  	if (bio) {
  		bio->bi_iter.bi_sector = disk_sector;
  		bio_set_dev(bio, bdev);
  		bio->bi_end_io = end_io;
  		bio->bi_private = par;
  	}
  	return bio;
  }
  
  static bool offset_in_map(u64 offset, struct pnfs_block_dev_map *map)
  {
  	return offset >= map->start && offset < map->start + map->len;
  }
  
  static struct bio *
  do_add_page_to_bio(struct bio *bio, int npg, int rw, sector_t isect,
  		struct page *page, struct pnfs_block_dev_map *map,
  		struct pnfs_block_extent *be, bio_end_io_t end_io,
  		struct parallel_io *par, unsigned int offset, int *len)
  {
  	struct pnfs_block_dev *dev =
  		container_of(be->be_device, struct pnfs_block_dev, node);
  	u64 disk_addr, end;
  
  	dprintk("%s: npg %d rw %d isect %llu offset %u len %d\n", __func__,
  		npg, rw, (unsigned long long)isect, offset, *len);
  
  	/* translate to device offset */
  	isect += be->be_v_offset;
  	isect -= be->be_f_offset;
  
  	/* translate to physical disk offset */
  	disk_addr = (u64)isect << SECTOR_SHIFT;
  	if (!offset_in_map(disk_addr, map)) {
  		if (!dev->map(dev, disk_addr, map) || !offset_in_map(disk_addr, map))
  			return ERR_PTR(-EIO);
  		bio = bl_submit_bio(bio);
  	}
  	disk_addr += map->disk_offset;
  	disk_addr -= map->start;
  
  	/* limit length to what the device mapping allows */
  	end = disk_addr + *len;
  	if (end >= map->start + map->len)
  		*len = map->start + map->len - disk_addr;
  
  retry:
  	if (!bio) {
  		bio = bl_alloc_init_bio(npg, map->bdev,
  				disk_addr >> SECTOR_SHIFT, end_io, par);
  		if (!bio)
  			return ERR_PTR(-ENOMEM);
  		bio_set_op_attrs(bio, rw, 0);
  	}
  	if (bio_add_page(bio, page, *len, offset) < *len) {
  		bio = bl_submit_bio(bio);
  		goto retry;
  	}
  	return bio;
  }
  
  static void bl_mark_devices_unavailable(struct nfs_pgio_header *header, bool rw)
  {
  	struct pnfs_block_layout *bl = BLK_LSEG2EXT(header->lseg);
  	size_t bytes_left = header->args.count;
  	sector_t isect, extent_length = 0;
  	struct pnfs_block_extent be;
  
  	isect = header->args.offset >> SECTOR_SHIFT;
  	bytes_left += header->args.offset - (isect << SECTOR_SHIFT);
  
  	while (bytes_left > 0) {
  		if (!ext_tree_lookup(bl, isect, &be, rw))
  				return;
  		extent_length = be.be_length - (isect - be.be_f_offset);
  		nfs4_mark_deviceid_unavailable(be.be_device);
  		isect += extent_length;
  		if (bytes_left > extent_length << SECTOR_SHIFT)
  			bytes_left -= extent_length << SECTOR_SHIFT;
  		else
  			bytes_left = 0;
  	}
  }
  
  static void bl_end_io_read(struct bio *bio)
  {
  	struct parallel_io *par = bio->bi_private;
  
  	if (bio->bi_status) {
  		struct nfs_pgio_header *header = par->data;
  
  		if (!header->pnfs_error)
  			header->pnfs_error = -EIO;
  		pnfs_set_lo_fail(header->lseg);
  		bl_mark_devices_unavailable(header, false);
  	}
  
  	bio_put(bio);
  	put_parallel(par);
  }
  
  static void bl_read_cleanup(struct work_struct *work)
  {
  	struct rpc_task *task;
  	struct nfs_pgio_header *hdr;
  	dprintk("%s enter\n", __func__);
  	task = container_of(work, struct rpc_task, u.tk_work);
  	hdr = container_of(task, struct nfs_pgio_header, task);
  	pnfs_ld_read_done(hdr);
  }
  
  static void
  bl_end_par_io_read(void *data)
  {
  	struct nfs_pgio_header *hdr = data;
  
  	hdr->task.tk_status = hdr->pnfs_error;
  	INIT_WORK(&hdr->task.u.tk_work, bl_read_cleanup);
  	schedule_work(&hdr->task.u.tk_work);
  }
  
  static enum pnfs_try_status
  bl_read_pagelist(struct nfs_pgio_header *header)
  {
  	struct pnfs_block_layout *bl = BLK_LSEG2EXT(header->lseg);
  	struct pnfs_block_dev_map map = { .start = NFS4_MAX_UINT64 };
  	struct bio *bio = NULL;
  	struct pnfs_block_extent be;
  	sector_t isect, extent_length = 0;
  	struct parallel_io *par;
  	loff_t f_offset = header->args.offset;
  	size_t bytes_left = header->args.count;
  	unsigned int pg_offset = header->args.pgbase, pg_len;
  	struct page **pages = header->args.pages;
  	int pg_index = header->args.pgbase >> PAGE_SHIFT;
  	const bool is_dio = (header->dreq != NULL);
  	struct blk_plug plug;
  	int i;
  
  	dprintk("%s enter nr_pages %u offset %lld count %u\n", __func__,
  		header->page_array.npages, f_offset,
  		(unsigned int)header->args.count);
  
  	par = alloc_parallel(header);
  	if (!par)
  		return PNFS_NOT_ATTEMPTED;
  	par->pnfs_callback = bl_end_par_io_read;
  
  	blk_start_plug(&plug);
  
  	isect = (sector_t) (f_offset >> SECTOR_SHIFT);
  	/* Code assumes extents are page-aligned */
  	for (i = pg_index; i < header->page_array.npages; i++) {
  		if (extent_length <= 0) {
  			/* We've used up the previous extent */
  			bio = bl_submit_bio(bio);
  
  			/* Get the next one */
  			if (!ext_tree_lookup(bl, isect, &be, false)) {
  				header->pnfs_error = -EIO;
  				goto out;
  			}
  			extent_length = be.be_length - (isect - be.be_f_offset);
  		}
  
  		if (is_dio) {
  			if (pg_offset + bytes_left > PAGE_SIZE)
  				pg_len = PAGE_SIZE - pg_offset;
  			else
  				pg_len = bytes_left;
  		} else {
  			BUG_ON(pg_offset != 0);
  			pg_len = PAGE_SIZE;
  		}
  
  		if (is_hole(&be)) {
  			bio = bl_submit_bio(bio);
  			/* Fill hole w/ zeroes w/o accessing device */
  			dprintk("%s Zeroing page for hole\n", __func__);
  			zero_user_segment(pages[i], pg_offset, pg_len);
  
  			/* invalidate map */
  			map.start = NFS4_MAX_UINT64;
  		} else {
  			bio = do_add_page_to_bio(bio,
  						 header->page_array.npages - i,
  						 READ,
  						 isect, pages[i], &map, &be,
  						 bl_end_io_read, par,
  						 pg_offset, &pg_len);
  			if (IS_ERR(bio)) {
  				header->pnfs_error = PTR_ERR(bio);
  				bio = NULL;
  				goto out;
  			}
  		}
  		isect += (pg_len >> SECTOR_SHIFT);
  		extent_length -= (pg_len >> SECTOR_SHIFT);
  		f_offset += pg_len;
  		bytes_left -= pg_len;
  		pg_offset = 0;
  	}
  	if ((isect << SECTOR_SHIFT) >= header->inode->i_size) {
  		header->res.eof = 1;
  		header->res.count = header->inode->i_size - header->args.offset;
  	} else {
  		header->res.count = (isect << SECTOR_SHIFT) - header->args.offset;
  	}
  out:
  	bl_submit_bio(bio);
  	blk_finish_plug(&plug);
  	put_parallel(par);
  	return PNFS_ATTEMPTED;
  }
  
  static void bl_end_io_write(struct bio *bio)
  {
  	struct parallel_io *par = bio->bi_private;
  	struct nfs_pgio_header *header = par->data;
  
  	if (bio->bi_status) {
  		if (!header->pnfs_error)
  			header->pnfs_error = -EIO;
  		pnfs_set_lo_fail(header->lseg);
  		bl_mark_devices_unavailable(header, true);
  	}
  	bio_put(bio);
  	put_parallel(par);
  }
  
  /* Function scheduled for call during bl_end_par_io_write,
   * it marks sectors as written and extends the commitlist.
   */
  static void bl_write_cleanup(struct work_struct *work)
  {
  	struct rpc_task *task = container_of(work, struct rpc_task, u.tk_work);
  	struct nfs_pgio_header *hdr =
  			container_of(task, struct nfs_pgio_header, task);
  
  	dprintk("%s enter\n", __func__);
  
  	if (likely(!hdr->pnfs_error)) {
  		struct pnfs_block_layout *bl = BLK_LSEG2EXT(hdr->lseg);
  		u64 start = hdr->args.offset & (loff_t)PAGE_MASK;
  		u64 end = (hdr->args.offset + hdr->args.count +
  			PAGE_SIZE - 1) & (loff_t)PAGE_MASK;
  		u64 lwb = hdr->args.offset + hdr->args.count;
  
  		ext_tree_mark_written(bl, start >> SECTOR_SHIFT,
  					(end - start) >> SECTOR_SHIFT, lwb);
  	}
  
  	pnfs_ld_write_done(hdr);
  }
  
  /* Called when last of bios associated with a bl_write_pagelist call finishes */
  static void bl_end_par_io_write(void *data)
  {
  	struct nfs_pgio_header *hdr = data;
  
  	hdr->task.tk_status = hdr->pnfs_error;
  	hdr->verf.committed = NFS_FILE_SYNC;
  	INIT_WORK(&hdr->task.u.tk_work, bl_write_cleanup);
  	schedule_work(&hdr->task.u.tk_work);
  }
  
  static enum pnfs_try_status
  bl_write_pagelist(struct nfs_pgio_header *header, int sync)
  {
  	struct pnfs_block_layout *bl = BLK_LSEG2EXT(header->lseg);
  	struct pnfs_block_dev_map map = { .start = NFS4_MAX_UINT64 };
  	struct bio *bio = NULL;
  	struct pnfs_block_extent be;
  	sector_t isect, extent_length = 0;
  	struct parallel_io *par = NULL;
  	loff_t offset = header->args.offset;
  	size_t count = header->args.count;
  	struct page **pages = header->args.pages;
  	int pg_index = header->args.pgbase >> PAGE_SHIFT;
  	unsigned int pg_len;
  	struct blk_plug plug;
  	int i;
  
  	dprintk("%s enter, %zu@%lld\n", __func__, count, offset);
  
  	/* At this point, header->page_aray is a (sequential) list of nfs_pages.
  	 * We want to write each, and if there is an error set pnfs_error
  	 * to have it redone using nfs.
  	 */
  	par = alloc_parallel(header);
  	if (!par)
  		return PNFS_NOT_ATTEMPTED;
  	par->pnfs_callback = bl_end_par_io_write;
  
  	blk_start_plug(&plug);
  
  	/* we always write out the whole page */
  	offset = offset & (loff_t)PAGE_MASK;
  	isect = offset >> SECTOR_SHIFT;
  
  	for (i = pg_index; i < header->page_array.npages; i++) {
  		if (extent_length <= 0) {
  			/* We've used up the previous extent */
  			bio = bl_submit_bio(bio);
  			/* Get the next one */
  			if (!ext_tree_lookup(bl, isect, &be, true)) {
  				header->pnfs_error = -EINVAL;
  				goto out;
  			}
  
  			extent_length = be.be_length - (isect - be.be_f_offset);
  		}
  
  		pg_len = PAGE_SIZE;
  		bio = do_add_page_to_bio(bio, header->page_array.npages - i,
  					 WRITE, isect, pages[i], &map, &be,
  					 bl_end_io_write, par,
  					 0, &pg_len);
  		if (IS_ERR(bio)) {
  			header->pnfs_error = PTR_ERR(bio);
  			bio = NULL;
  			goto out;
  		}
  
  		offset += pg_len;
  		count -= pg_len;
  		isect += (pg_len >> SECTOR_SHIFT);
  		extent_length -= (pg_len >> SECTOR_SHIFT);
  	}
  
  	header->res.count = header->args.count;
  out:
  	bl_submit_bio(bio);
  	blk_finish_plug(&plug);
  	put_parallel(par);
  	return PNFS_ATTEMPTED;
  }
  
  static void bl_free_layout_hdr(struct pnfs_layout_hdr *lo)
  {
  	struct pnfs_block_layout *bl = BLK_LO2EXT(lo);
  	int err;
  
  	dprintk("%s enter\n", __func__);
  
  	err = ext_tree_remove(bl, true, 0, LLONG_MAX);
  	WARN_ON(err);
  
  	kfree_rcu(bl, bl_layout.plh_rcu);
  }
  
  static struct pnfs_layout_hdr *__bl_alloc_layout_hdr(struct inode *inode,
  		gfp_t gfp_flags, bool is_scsi_layout)
  {
  	struct pnfs_block_layout *bl;
  
  	dprintk("%s enter\n", __func__);
  	bl = kzalloc(sizeof(*bl), gfp_flags);
  	if (!bl)
  		return NULL;
  
  	bl->bl_ext_rw = RB_ROOT;
  	bl->bl_ext_ro = RB_ROOT;
  	spin_lock_init(&bl->bl_ext_lock);
  
  	bl->bl_scsi_layout = is_scsi_layout;
  	return &bl->bl_layout;
  }
  
  static struct pnfs_layout_hdr *bl_alloc_layout_hdr(struct inode *inode,
  						   gfp_t gfp_flags)
  {
  	return __bl_alloc_layout_hdr(inode, gfp_flags, false);
  }
  
  static struct pnfs_layout_hdr *sl_alloc_layout_hdr(struct inode *inode,
  						   gfp_t gfp_flags)
  {
  	return __bl_alloc_layout_hdr(inode, gfp_flags, true);
  }
  
  static void bl_free_lseg(struct pnfs_layout_segment *lseg)
  {
  	dprintk("%s enter\n", __func__);
  	kfree(lseg);
  }
  
  /* Tracks info needed to ensure extents in layout obey constraints of spec */
  struct layout_verification {
  	u32 mode;	/* R or RW */
  	u64 start;	/* Expected start of next non-COW extent */
  	u64 inval;	/* Start of INVAL coverage */
  	u64 cowread;	/* End of COW read coverage */
  };
  
  /* Verify the extent meets the layout requirements of the pnfs-block draft,
   * section 2.3.1.
   */
  static int verify_extent(struct pnfs_block_extent *be,
  			 struct layout_verification *lv)
  {
  	if (lv->mode == IOMODE_READ) {
  		if (be->be_state == PNFS_BLOCK_READWRITE_DATA ||
  		    be->be_state == PNFS_BLOCK_INVALID_DATA)
  			return -EIO;
  		if (be->be_f_offset != lv->start)
  			return -EIO;
  		lv->start += be->be_length;
  		return 0;
  	}
  	/* lv->mode == IOMODE_RW */
  	if (be->be_state == PNFS_BLOCK_READWRITE_DATA) {
  		if (be->be_f_offset != lv->start)
  			return -EIO;
  		if (lv->cowread > lv->start)
  			return -EIO;
  		lv->start += be->be_length;
  		lv->inval = lv->start;
  		return 0;
  	} else if (be->be_state == PNFS_BLOCK_INVALID_DATA) {
  		if (be->be_f_offset != lv->start)
  			return -EIO;
  		lv->start += be->be_length;
  		return 0;
  	} else if (be->be_state == PNFS_BLOCK_READ_DATA) {
  		if (be->be_f_offset > lv->start)
  			return -EIO;
  		if (be->be_f_offset < lv->inval)
  			return -EIO;
  		if (be->be_f_offset < lv->cowread)
  			return -EIO;
  		/* It looks like you might want to min this with lv->start,
  		 * but you really don't.
  		 */
  		lv->inval = lv->inval + be->be_length;
  		lv->cowread = be->be_f_offset + be->be_length;
  		return 0;
  	} else
  		return -EIO;
  }
  
  static int decode_sector_number(__be32 **rp, sector_t *sp)
  {
  	uint64_t s;
  
  	*rp = xdr_decode_hyper(*rp, &s);
  	if (s & 0x1ff) {
  		printk(KERN_WARNING "NFS: %s: sector not aligned\n", __func__);
  		return -1;
  	}
  	*sp = s >> SECTOR_SHIFT;
  	return 0;
  }
  
  static struct nfs4_deviceid_node *
  bl_find_get_deviceid(struct nfs_server *server,
  		const struct nfs4_deviceid *id, const struct cred *cred,
  		gfp_t gfp_mask)
  {
  	struct nfs4_deviceid_node *node;
  	unsigned long start, end;
  
  retry:
  	node = nfs4_find_get_deviceid(server, id, cred, gfp_mask);
  	if (!node)
  		return ERR_PTR(-ENODEV);
  
  	if (test_bit(NFS_DEVICEID_UNAVAILABLE, &node->flags) == 0)
  		return node;
  
  	end = jiffies;
  	start = end - PNFS_DEVICE_RETRY_TIMEOUT;
  	if (!time_in_range(node->timestamp_unavailable, start, end)) {
  		nfs4_delete_deviceid(node->ld, node->nfs_client, id);
  		goto retry;
  	}
  	return ERR_PTR(-ENODEV);
  }
  
  static int
  bl_alloc_extent(struct xdr_stream *xdr, struct pnfs_layout_hdr *lo,
  		struct layout_verification *lv, struct list_head *extents,
  		gfp_t gfp_mask)
  {
  	struct pnfs_block_extent *be;
  	struct nfs4_deviceid id;
  	int error;
  	__be32 *p;
  
  	p = xdr_inline_decode(xdr, 28 + NFS4_DEVICEID4_SIZE);
  	if (!p)
  		return -EIO;
  
  	be = kzalloc(sizeof(*be), GFP_NOFS);
  	if (!be)
  		return -ENOMEM;
  
  	memcpy(&id, p, NFS4_DEVICEID4_SIZE);
  	p += XDR_QUADLEN(NFS4_DEVICEID4_SIZE);
  
  	be->be_device = bl_find_get_deviceid(NFS_SERVER(lo->plh_inode), &id,
  						lo->plh_lc_cred, gfp_mask);
  	if (IS_ERR(be->be_device)) {
  		error = PTR_ERR(be->be_device);
  		goto out_free_be;
  	}
  
  	/*
  	 * The next three values are read in as bytes, but stored in the
  	 * extent structure in 512-byte granularity.
  	 */
  	error = -EIO;
  	if (decode_sector_number(&p, &be->be_f_offset) < 0)
  		goto out_put_deviceid;
  	if (decode_sector_number(&p, &be->be_length) < 0)
  		goto out_put_deviceid;
  	if (decode_sector_number(&p, &be->be_v_offset) < 0)
  		goto out_put_deviceid;
  	be->be_state = be32_to_cpup(p++);
  
  	error = verify_extent(be, lv);
  	if (error) {
  		dprintk("%s: extent verification failed\n", __func__);
  		goto out_put_deviceid;
  	}
  
  	list_add_tail(&be->be_list, extents);
  	return 0;
  
  out_put_deviceid:
  	nfs4_put_deviceid_node(be->be_device);
  out_free_be:
  	kfree(be);
  	return error;
  }
  
  static struct pnfs_layout_segment *
  bl_alloc_lseg(struct pnfs_layout_hdr *lo, struct nfs4_layoutget_res *lgr,
  		gfp_t gfp_mask)
  {
  	struct layout_verification lv = {
  		.mode = lgr->range.iomode,
  		.start = lgr->range.offset >> SECTOR_SHIFT,
  		.inval = lgr->range.offset >> SECTOR_SHIFT,
  		.cowread = lgr->range.offset >> SECTOR_SHIFT,
  	};
  	struct pnfs_block_layout *bl = BLK_LO2EXT(lo);
  	struct pnfs_layout_segment *lseg;
  	struct xdr_buf buf;
  	struct xdr_stream xdr;
  	struct page *scratch;
  	int status, i;
  	uint32_t count;
  	__be32 *p;
  	LIST_HEAD(extents);
  
  	dprintk("---> %s\n", __func__);
  
  	lseg = kzalloc(sizeof(*lseg), gfp_mask);
  	if (!lseg)
  		return ERR_PTR(-ENOMEM);
  
  	status = -ENOMEM;
  	scratch = alloc_page(gfp_mask);
  	if (!scratch)
  		goto out;
  
  	xdr_init_decode_pages(&xdr, &buf,
  			lgr->layoutp->pages, lgr->layoutp->len);
  	xdr_set_scratch_buffer(&xdr, page_address(scratch), PAGE_SIZE);
  
  	status = -EIO;
  	p = xdr_inline_decode(&xdr, 4);
  	if (unlikely(!p))
  		goto out_free_scratch;
  
  	count = be32_to_cpup(p++);
  	dprintk("%s: number of extents %d\n", __func__, count);
  
  	/*
  	 * Decode individual extents, putting them in temporary staging area
  	 * until whole layout is decoded to make error recovery easier.
  	 */
  	for (i = 0; i < count; i++) {
  		status = bl_alloc_extent(&xdr, lo, &lv, &extents, gfp_mask);
  		if (status)
  			goto process_extents;
  	}
  
  	if (lgr->range.offset + lgr->range.length !=
  			lv.start << SECTOR_SHIFT) {
  		dprintk("%s Final length mismatch\n", __func__);
  		status = -EIO;
  		goto process_extents;
  	}
  
  	if (lv.start < lv.cowread) {
  		dprintk("%s Final uncovered COW extent\n", __func__);
  		status = -EIO;
  	}
  
  process_extents:
  	while (!list_empty(&extents)) {
  		struct pnfs_block_extent *be =
  			list_first_entry(&extents, struct pnfs_block_extent,
  					 be_list);
  		list_del(&be->be_list);
  
  		if (!status)
  			status = ext_tree_insert(bl, be);
  
  		if (status) {
  			nfs4_put_deviceid_node(be->be_device);
  			kfree(be);
  		}
  	}
  
  out_free_scratch:
  	__free_page(scratch);
  out:
  	dprintk("%s returns %d\n", __func__, status);
  	switch (status) {
  	case -ENODEV:
  		/* Our extent block devices are unavailable */
  		set_bit(NFS_LSEG_UNAVAILABLE, &lseg->pls_flags);
  		/* Fall through */
  	case 0:
  		return lseg;
  	default:
  		kfree(lseg);
  		return ERR_PTR(status);
  	}
  }
  
  static void
  bl_return_range(struct pnfs_layout_hdr *lo,
  		struct pnfs_layout_range *range)
  {
  	struct pnfs_block_layout *bl = BLK_LO2EXT(lo);
  	sector_t offset = range->offset >> SECTOR_SHIFT, end;
  
  	if (range->offset % 8) {
  		dprintk("%s: offset %lld not block size aligned\n",
  			__func__, range->offset);
  		return;
  	}
  
  	if (range->length != NFS4_MAX_UINT64) {
  		if (range->length % 8) {
  			dprintk("%s: length %lld not block size aligned\n",
  				__func__, range->length);
  			return;
  		}
  
  		end = offset + (range->length >> SECTOR_SHIFT);
  	} else {
  		end = round_down(NFS4_MAX_UINT64, PAGE_SIZE);
  	}
  
  	ext_tree_remove(bl, range->iomode & IOMODE_RW, offset, end);
  }
  
  static int
  bl_prepare_layoutcommit(struct nfs4_layoutcommit_args *arg)
  {
  	return ext_tree_prepare_commit(arg);
  }
  
  static void
  bl_cleanup_layoutcommit(struct nfs4_layoutcommit_data *lcdata)
  {
  	ext_tree_mark_committed(&lcdata->args, lcdata->res.status);
  }
  
  static int
  bl_set_layoutdriver(struct nfs_server *server, const struct nfs_fh *fh)
  {
  	dprintk("%s enter\n", __func__);
  
  	if (server->pnfs_blksize == 0) {
  		dprintk("%s Server did not return blksize\n", __func__);
  		return -EINVAL;
  	}
  	if (server->pnfs_blksize > PAGE_SIZE) {
  		printk(KERN_ERR "%s: pNFS blksize %d not supported.\n",
  			__func__, server->pnfs_blksize);
  		return -EINVAL;
  	}
  
  	return 0;
  }
  
  static bool
  is_aligned_req(struct nfs_pageio_descriptor *pgio,
  		struct nfs_page *req, unsigned int alignment, bool is_write)
  {
  	/*
  	 * Always accept buffered writes, higher layers take care of the
  	 * right alignment.
  	 */
  	if (pgio->pg_dreq == NULL)
  		return true;
  
  	if (!IS_ALIGNED(req->wb_offset, alignment))
  		return false;
  
  	if (IS_ALIGNED(req->wb_bytes, alignment))
  		return true;
  
  	if (is_write &&
  	    (req_offset(req) + req->wb_bytes == i_size_read(pgio->pg_inode))) {
  		/*
  		 * If the write goes up to the inode size, just write
  		 * the full page.  Data past the inode size is
  		 * guaranteed to be zeroed by the higher level client
  		 * code, and this behaviour is mandated by RFC 5663
  		 * section 2.3.2.
  		 */
  		return true;
  	}
  
  	return false;
  }
  
  static void
  bl_pg_init_read(struct nfs_pageio_descriptor *pgio, struct nfs_page *req)
  {
  	if (!is_aligned_req(pgio, req, SECTOR_SIZE, false)) {
  		nfs_pageio_reset_read_mds(pgio);
  		return;
  	}
  
  	pnfs_generic_pg_init_read(pgio, req);
  
  	if (pgio->pg_lseg &&
  		test_bit(NFS_LSEG_UNAVAILABLE, &pgio->pg_lseg->pls_flags)) {
  		pnfs_error_mark_layout_for_return(pgio->pg_inode, pgio->pg_lseg);
  		pnfs_set_lo_fail(pgio->pg_lseg);
  		nfs_pageio_reset_read_mds(pgio);
  	}
  }
  
  /*
   * Return 0 if @req cannot be coalesced into @pgio, otherwise return the number
   * of bytes (maximum @req->wb_bytes) that can be coalesced.
   */
  static size_t
  bl_pg_test_read(struct nfs_pageio_descriptor *pgio, struct nfs_page *prev,
  		struct nfs_page *req)
  {
  	if (!is_aligned_req(pgio, req, SECTOR_SIZE, false))
  		return 0;
  	return pnfs_generic_pg_test(pgio, prev, req);
  }
  
  /*
   * Return the number of contiguous bytes for a given inode
   * starting at page frame idx.
   */
  static u64 pnfs_num_cont_bytes(struct inode *inode, pgoff_t idx)
  {
  	struct address_space *mapping = inode->i_mapping;
  	pgoff_t end;
  
  	/* Optimize common case that writes from 0 to end of file */
  	end = DIV_ROUND_UP(i_size_read(inode), PAGE_SIZE);
  	if (end != inode->i_mapping->nrpages) {
  		rcu_read_lock();
  		end = page_cache_next_miss(mapping, idx + 1, ULONG_MAX);
  		rcu_read_unlock();
  	}
  
  	if (!end)
  		return i_size_read(inode) - (idx << PAGE_SHIFT);
  	else
  		return (end - idx) << PAGE_SHIFT;
  }
  
  static void
  bl_pg_init_write(struct nfs_pageio_descriptor *pgio, struct nfs_page *req)
  {
  	u64 wb_size;
  
  	if (!is_aligned_req(pgio, req, PAGE_SIZE, true)) {
  		nfs_pageio_reset_write_mds(pgio);
  		return;
  	}
  
  	if (pgio->pg_dreq == NULL)
  		wb_size = pnfs_num_cont_bytes(pgio->pg_inode,
  					      req->wb_index);
  	else
  		wb_size = nfs_dreq_bytes_left(pgio->pg_dreq);
  
  	pnfs_generic_pg_init_write(pgio, req, wb_size);
  
  	if (pgio->pg_lseg &&
  		test_bit(NFS_LSEG_UNAVAILABLE, &pgio->pg_lseg->pls_flags)) {
  
  		pnfs_error_mark_layout_for_return(pgio->pg_inode, pgio->pg_lseg);
  		pnfs_set_lo_fail(pgio->pg_lseg);
  		nfs_pageio_reset_write_mds(pgio);
  	}
  }
  
  /*
   * Return 0 if @req cannot be coalesced into @pgio, otherwise return the number
   * of bytes (maximum @req->wb_bytes) that can be coalesced.
   */
  static size_t
  bl_pg_test_write(struct nfs_pageio_descriptor *pgio, struct nfs_page *prev,
  		 struct nfs_page *req)
  {
  	if (!is_aligned_req(pgio, req, PAGE_SIZE, true))
  		return 0;
  	return pnfs_generic_pg_test(pgio, prev, req);
  }
  
  static const struct nfs_pageio_ops bl_pg_read_ops = {
  	.pg_init = bl_pg_init_read,
  	.pg_test = bl_pg_test_read,
  	.pg_doio = pnfs_generic_pg_readpages,
  	.pg_cleanup = pnfs_generic_pg_cleanup,
  };
  
  static const struct nfs_pageio_ops bl_pg_write_ops = {
  	.pg_init = bl_pg_init_write,
  	.pg_test = bl_pg_test_write,
  	.pg_doio = pnfs_generic_pg_writepages,
  	.pg_cleanup = pnfs_generic_pg_cleanup,
  };
  
  static struct pnfs_layoutdriver_type blocklayout_type = {
  	.id				= LAYOUT_BLOCK_VOLUME,
  	.name				= "LAYOUT_BLOCK_VOLUME",
  	.owner				= THIS_MODULE,
  	.flags				= PNFS_LAYOUTRET_ON_SETATTR |
  					  PNFS_LAYOUTRET_ON_ERROR |
  					  PNFS_READ_WHOLE_PAGE,
  	.read_pagelist			= bl_read_pagelist,
  	.write_pagelist			= bl_write_pagelist,
  	.alloc_layout_hdr		= bl_alloc_layout_hdr,
  	.free_layout_hdr		= bl_free_layout_hdr,
  	.alloc_lseg			= bl_alloc_lseg,
  	.free_lseg			= bl_free_lseg,
  	.return_range			= bl_return_range,
  	.prepare_layoutcommit		= bl_prepare_layoutcommit,
  	.cleanup_layoutcommit		= bl_cleanup_layoutcommit,
  	.set_layoutdriver		= bl_set_layoutdriver,
  	.alloc_deviceid_node		= bl_alloc_deviceid_node,
  	.free_deviceid_node		= bl_free_deviceid_node,
  	.pg_read_ops			= &bl_pg_read_ops,
  	.pg_write_ops			= &bl_pg_write_ops,
  	.sync				= pnfs_generic_sync,
  };
  
  static struct pnfs_layoutdriver_type scsilayout_type = {
  	.id				= LAYOUT_SCSI,
  	.name				= "LAYOUT_SCSI",
  	.owner				= THIS_MODULE,
  	.flags				= PNFS_LAYOUTRET_ON_SETATTR |
  					  PNFS_LAYOUTRET_ON_ERROR |
  					  PNFS_READ_WHOLE_PAGE,
  	.read_pagelist			= bl_read_pagelist,
  	.write_pagelist			= bl_write_pagelist,
  	.alloc_layout_hdr		= sl_alloc_layout_hdr,
  	.free_layout_hdr		= bl_free_layout_hdr,
  	.alloc_lseg			= bl_alloc_lseg,
  	.free_lseg			= bl_free_lseg,
  	.return_range			= bl_return_range,
  	.prepare_layoutcommit		= bl_prepare_layoutcommit,
  	.cleanup_layoutcommit		= bl_cleanup_layoutcommit,
  	.set_layoutdriver		= bl_set_layoutdriver,
  	.alloc_deviceid_node		= bl_alloc_deviceid_node,
  	.free_deviceid_node		= bl_free_deviceid_node,
  	.pg_read_ops			= &bl_pg_read_ops,
  	.pg_write_ops			= &bl_pg_write_ops,
  	.sync				= pnfs_generic_sync,
  };
  
  
  static int __init nfs4blocklayout_init(void)
  {
  	int ret;
  
  	dprintk("%s: NFSv4 Block Layout Driver Registering...\n", __func__);
  
  	ret = bl_init_pipefs();
  	if (ret)
  		goto out;
  
  	ret = pnfs_register_layoutdriver(&blocklayout_type);
  	if (ret)
  		goto out_cleanup_pipe;
  
  	ret = pnfs_register_layoutdriver(&scsilayout_type);
  	if (ret)
  		goto out_unregister_block;
  	return 0;
  
  out_unregister_block:
  	pnfs_unregister_layoutdriver(&blocklayout_type);
  out_cleanup_pipe:
  	bl_cleanup_pipefs();
  out:
  	return ret;
  }
  
  static void __exit nfs4blocklayout_exit(void)
  {
  	dprintk("%s: NFSv4 Block Layout Driver Unregistering...\n",
  	       __func__);
  
  	pnfs_unregister_layoutdriver(&scsilayout_type);
  	pnfs_unregister_layoutdriver(&blocklayout_type);
  	bl_cleanup_pipefs();
  }
  
  MODULE_ALIAS("nfs-layouttype4-3");
  MODULE_ALIAS("nfs-layouttype4-5");
  
  module_init(nfs4blocklayout_init);
  module_exit(nfs4blocklayout_exit);
  