Home | History | Annotate | Line # | Download | only in udf
udf_strat_rmw.c revision 1.5
      1  1.5  reinoud /* $NetBSD: udf_strat_rmw.c,v 1.5 2008/07/07 18:45:27 reinoud Exp $ */
      2  1.1  reinoud 
      3  1.1  reinoud /*
      4  1.1  reinoud  * Copyright (c) 2006, 2008 Reinoud Zandijk
      5  1.1  reinoud  * All rights reserved.
      6  1.1  reinoud  *
      7  1.1  reinoud  * Redistribution and use in source and binary forms, with or without
      8  1.1  reinoud  * modification, are permitted provided that the following conditions
      9  1.1  reinoud  * are met:
     10  1.1  reinoud  * 1. Redistributions of source code must retain the above copyright
     11  1.1  reinoud  *    notice, this list of conditions and the following disclaimer.
     12  1.1  reinoud  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  reinoud  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  reinoud  *    documentation and/or other materials provided with the distribution.
     15  1.1  reinoud  *
     16  1.1  reinoud  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  1.1  reinoud  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  1.1  reinoud  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  1.1  reinoud  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  1.1  reinoud  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21  1.1  reinoud  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22  1.1  reinoud  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23  1.1  reinoud  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24  1.1  reinoud  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25  1.1  reinoud  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26  1.1  reinoud  *
     27  1.1  reinoud  */
     28  1.1  reinoud 
     29  1.1  reinoud #include <sys/cdefs.h>
     30  1.1  reinoud #ifndef lint
     31  1.5  reinoud __KERNEL_RCSID(0, "$NetBSD: udf_strat_rmw.c,v 1.5 2008/07/07 18:45:27 reinoud Exp $");
     32  1.1  reinoud #endif /* not lint */
     33  1.1  reinoud 
     34  1.1  reinoud 
     35  1.1  reinoud #if defined(_KERNEL_OPT)
     36  1.1  reinoud #include "opt_quota.h"
     37  1.1  reinoud #include "opt_compat_netbsd.h"
     38  1.1  reinoud #endif
     39  1.1  reinoud 
     40  1.1  reinoud #include <sys/param.h>
     41  1.1  reinoud #include <sys/systm.h>
     42  1.1  reinoud #include <sys/sysctl.h>
     43  1.1  reinoud #include <sys/namei.h>
     44  1.1  reinoud #include <sys/proc.h>
     45  1.1  reinoud #include <sys/kernel.h>
     46  1.1  reinoud #include <sys/vnode.h>
     47  1.1  reinoud #include <miscfs/genfs/genfs_node.h>
     48  1.1  reinoud #include <sys/mount.h>
     49  1.1  reinoud #include <sys/buf.h>
     50  1.1  reinoud #include <sys/file.h>
     51  1.1  reinoud #include <sys/device.h>
     52  1.1  reinoud #include <sys/disklabel.h>
     53  1.1  reinoud #include <sys/ioctl.h>
     54  1.1  reinoud #include <sys/malloc.h>
     55  1.1  reinoud #include <sys/dirent.h>
     56  1.1  reinoud #include <sys/stat.h>
     57  1.1  reinoud #include <sys/conf.h>
     58  1.1  reinoud #include <sys/kauth.h>
     59  1.1  reinoud #include <sys/kthread.h>
     60  1.1  reinoud #include <dev/clock_subr.h>
     61  1.1  reinoud 
     62  1.1  reinoud #include <fs/udf/ecma167-udf.h>
     63  1.1  reinoud #include <fs/udf/udf_mount.h>
     64  1.1  reinoud 
     65  1.1  reinoud #if defined(_KERNEL_OPT)
     66  1.1  reinoud #include "opt_udf.h"
     67  1.1  reinoud #endif
     68  1.1  reinoud 
     69  1.1  reinoud #include "udf.h"
     70  1.1  reinoud #include "udf_subr.h"
     71  1.1  reinoud #include "udf_bswap.h"
     72  1.1  reinoud 
     73  1.1  reinoud 
     74  1.1  reinoud #define VTOI(vnode) ((struct udf_node *) (vnode)->v_data)
     75  1.1  reinoud #define PRIV(ump) ((struct strat_private *) (ump)->strategy_private)
     76  1.1  reinoud #define BTOE(buf) ((struct udf_eccline *) ((buf)->b_private))
     77  1.1  reinoud 
     78  1.1  reinoud /* --------------------------------------------------------------------- */
     79  1.1  reinoud 
     80  1.1  reinoud #define UDF_MAX_PACKET_SIZE	64			/* DONT change this */
     81  1.1  reinoud 
     82  1.1  reinoud /* sheduler states */
     83  1.1  reinoud #define UDF_SHED_MAX		6
     84  1.1  reinoud #define UDF_SHED_READING	1
     85  1.1  reinoud #define UDF_SHED_WRITING	2
     86  1.1  reinoud #define UDF_SHED_SEQWRITING	3
     87  1.1  reinoud #define UDF_SHED_IDLE		4			/* resting */
     88  1.1  reinoud #define UDF_SHED_FREE		5			/* recycleable */
     89  1.1  reinoud 
     90  1.1  reinoud /* flags */
     91  1.1  reinoud #define ECC_LOCKED		0x01			/* prevent access   */
     92  1.1  reinoud #define ECC_WANTED		0x02			/* trying access    */
     93  1.1  reinoud #define ECC_SEQWRITING		0x04			/* sequential queue */
     94  1.1  reinoud #define ECC_FLOATING		0x08			/* not queued yet   */
     95  1.1  reinoud 
     96  1.1  reinoud 
     97  1.1  reinoud TAILQ_HEAD(ecclineq, udf_eccline);
     98  1.1  reinoud struct udf_eccline {
     99  1.1  reinoud 	struct udf_mount	 *ump;
    100  1.1  reinoud 	uint64_t		  present;		/* preserve these */
    101  1.1  reinoud 	uint64_t		  readin;		/* bitmap */
    102  1.1  reinoud 	uint64_t		  dirty;		/* bitmap */
    103  1.1  reinoud 	uint64_t		  error;		/* bitmap */
    104  1.1  reinoud 	uint32_t		  refcnt;
    105  1.1  reinoud 
    106  1.1  reinoud 	uint32_t		  flags;
    107  1.1  reinoud 	uint32_t		  start_sector;		/* physical */
    108  1.1  reinoud 
    109  1.1  reinoud 	struct buf		 *buf;
    110  1.1  reinoud 	void			 *blob;
    111  1.1  reinoud 
    112  1.1  reinoud 	struct buf		 *bufs[UDF_MAX_PACKET_SIZE];
    113  1.1  reinoud 	uint32_t		  bufs_bpos[UDF_MAX_PACKET_SIZE];
    114  1.1  reinoud 	int			  bufs_len[UDF_MAX_PACKET_SIZE];
    115  1.1  reinoud 
    116  1.1  reinoud 	int			  queued_on;		/* on which BUFQ list */
    117  1.1  reinoud 	LIST_ENTRY(udf_eccline)   hashchain;		/* on sector lookup  */
    118  1.1  reinoud };
    119  1.1  reinoud 
    120  1.1  reinoud 
    121  1.1  reinoud struct strat_private {
    122  1.1  reinoud 	lwp_t			 *queue_lwp;
    123  1.1  reinoud 	kcondvar_t		  discstrat_cv;		/* to wait on       */
    124  1.1  reinoud 	kmutex_t		  discstrat_mutex;	/* disc strategy    */
    125  1.1  reinoud 	kmutex_t		  seqwrite_mutex;	/* protect mappings */
    126  1.1  reinoud 
    127  1.1  reinoud 	int			  run_thread;		/* thread control */
    128  1.1  reinoud 	int			  thread_finished;	/* thread control */
    129  1.1  reinoud 	int			  cur_queue;
    130  1.1  reinoud 
    131  1.1  reinoud 	int			  num_floating;
    132  1.1  reinoud 	int			  num_queued[UDF_SHED_MAX];
    133  1.1  reinoud 	struct bufq_state	 *queues[UDF_SHED_MAX];
    134  1.1  reinoud 	struct timespec		  last_queued[UDF_SHED_MAX];
    135  1.1  reinoud 	struct disk_strategy	  old_strategy_setting;
    136  1.1  reinoud 
    137  1.1  reinoud 	struct pool		  eccline_pool;
    138  1.1  reinoud 	struct pool		  ecclineblob_pool;
    139  1.1  reinoud 	LIST_HEAD(, udf_eccline)  eccline_hash[UDF_ECCBUF_HASHSIZE];
    140  1.1  reinoud };
    141  1.1  reinoud 
    142  1.1  reinoud /* --------------------------------------------------------------------- */
    143  1.1  reinoud 
    144  1.1  reinoud #define UDF_LOCK_ECCLINE(eccline) udf_lock_eccline(eccline)
    145  1.1  reinoud #define UDF_UNLOCK_ECCLINE(eccline) udf_unlock_eccline(eccline)
    146  1.1  reinoud 
    147  1.1  reinoud /* can be called with or without discstrat lock */
    148  1.1  reinoud static void
    149  1.1  reinoud udf_lock_eccline(struct udf_eccline *eccline)
    150  1.1  reinoud {
    151  1.1  reinoud 	struct strat_private *priv = PRIV(eccline->ump);
    152  1.1  reinoud 	int waslocked, ret;
    153  1.1  reinoud 
    154  1.1  reinoud 	waslocked = mutex_owned(&priv->discstrat_mutex);
    155  1.1  reinoud 	if (!waslocked)
    156  1.1  reinoud 		mutex_enter(&priv->discstrat_mutex);
    157  1.1  reinoud 
    158  1.1  reinoud 	/* wait until its unlocked first */
    159  1.1  reinoud 	while (eccline->flags & ECC_LOCKED) {
    160  1.1  reinoud 		eccline->flags |= ECC_WANTED;
    161  1.1  reinoud 		ret = cv_timedwait(&priv->discstrat_cv, &priv->discstrat_mutex,
    162  1.1  reinoud 			hz/8);
    163  1.1  reinoud 		if (ret == EWOULDBLOCK)
    164  1.1  reinoud 			DPRINTF(LOCKING, ("eccline lock helt, waiting for "
    165  1.1  reinoud 				"release"));
    166  1.1  reinoud 	}
    167  1.1  reinoud 	eccline->flags |= ECC_LOCKED;
    168  1.1  reinoud 	eccline->flags &= ~ECC_WANTED;
    169  1.1  reinoud 
    170  1.1  reinoud 	if (!waslocked)
    171  1.1  reinoud 		mutex_exit(&priv->discstrat_mutex);
    172  1.1  reinoud }
    173  1.1  reinoud 
    174  1.1  reinoud 
    175  1.1  reinoud /* can be called with or without discstrat lock */
    176  1.1  reinoud static void
    177  1.1  reinoud udf_unlock_eccline(struct udf_eccline *eccline)
    178  1.1  reinoud {
    179  1.1  reinoud 	struct strat_private *priv = PRIV(eccline->ump);
    180  1.1  reinoud 	int waslocked;
    181  1.1  reinoud 
    182  1.1  reinoud 	KASSERT(mutex_owned(&priv->discstrat_mutex));
    183  1.1  reinoud 
    184  1.1  reinoud 	waslocked = mutex_owned(&priv->discstrat_mutex);
    185  1.1  reinoud 	if (!waslocked)
    186  1.1  reinoud 		mutex_enter(&priv->discstrat_mutex);
    187  1.1  reinoud 
    188  1.1  reinoud 	eccline->flags &= ~ECC_LOCKED;
    189  1.1  reinoud 	cv_broadcast(&priv->discstrat_cv);
    190  1.1  reinoud 
    191  1.1  reinoud 	if (!waslocked)
    192  1.1  reinoud 		mutex_exit(&priv->discstrat_mutex);
    193  1.1  reinoud }
    194  1.1  reinoud 
    195  1.1  reinoud 
    196  1.1  reinoud /* NOTE discstrat_mutex should be held! */
    197  1.1  reinoud static void
    198  1.1  reinoud udf_dispose_eccline(struct udf_eccline *eccline)
    199  1.1  reinoud {
    200  1.1  reinoud 	struct strat_private *priv = PRIV(eccline->ump);
    201  1.1  reinoud 	struct buf *ret;
    202  1.1  reinoud 
    203  1.1  reinoud 	KASSERT(mutex_owned(&priv->discstrat_mutex));
    204  1.1  reinoud 
    205  1.1  reinoud 	KASSERT(eccline->refcnt == 0);
    206  1.1  reinoud 	KASSERT(eccline->dirty  == 0);
    207  1.1  reinoud 
    208  1.3  reinoud 	DPRINTF(ECCLINE, ("dispose eccline with start sector %d, "
    209  1.1  reinoud 		"present %0"PRIx64"\n", eccline->start_sector,
    210  1.1  reinoud 		eccline->present));
    211  1.1  reinoud 
    212  1.1  reinoud 	if (eccline->queued_on) {
    213  1.1  reinoud 		ret = BUFQ_CANCEL(priv->queues[eccline->queued_on], eccline->buf);
    214  1.1  reinoud 		KASSERT(ret == eccline->buf);
    215  1.1  reinoud 		priv->num_queued[eccline->queued_on]--;
    216  1.1  reinoud 	}
    217  1.1  reinoud 	LIST_REMOVE(eccline, hashchain);
    218  1.1  reinoud 
    219  1.1  reinoud 	if (eccline->flags & ECC_FLOATING) {
    220  1.1  reinoud 		eccline->flags &= ~ECC_FLOATING;
    221  1.1  reinoud 		priv->num_floating--;
    222  1.1  reinoud 	}
    223  1.1  reinoud 
    224  1.1  reinoud 	putiobuf(eccline->buf);
    225  1.1  reinoud 	pool_put(&priv->ecclineblob_pool, eccline->blob);
    226  1.1  reinoud 	pool_put(&priv->eccline_pool, eccline);
    227  1.1  reinoud }
    228  1.1  reinoud 
    229  1.1  reinoud 
    230  1.1  reinoud /* NOTE discstrat_mutex should be held! */
    231  1.1  reinoud static void
    232  1.1  reinoud udf_push_eccline(struct udf_eccline *eccline, int newqueue)
    233  1.1  reinoud {
    234  1.1  reinoud 	struct strat_private *priv = PRIV(eccline->ump);
    235  1.1  reinoud 	struct buf *ret;
    236  1.1  reinoud 	int curqueue;
    237  1.1  reinoud 
    238  1.1  reinoud 	KASSERT(mutex_owned(&priv->discstrat_mutex));
    239  1.1  reinoud 
    240  1.1  reinoud 	DPRINTF(PARANOIA, ("DEBUG: buf %p pushed on queue %d\n", eccline->buf, newqueue));
    241  1.1  reinoud 
    242  1.1  reinoud 	/* requeue */
    243  1.1  reinoud 	curqueue = eccline->queued_on;
    244  1.1  reinoud 	if (curqueue) {
    245  1.1  reinoud 		ret = BUFQ_CANCEL(priv->queues[curqueue], eccline->buf);
    246  1.1  reinoud 
    247  1.1  reinoud 		DPRINTF(PARANOIA, ("push_eccline BUFQ_CANCEL returned %p when "
    248  1.1  reinoud 			"requested to remove %p from queue %d\n", ret,
    249  1.1  reinoud 			eccline->buf, curqueue));
    250  1.1  reinoud #ifdef DIAGNOSTIC
    251  1.1  reinoud 		if (ret == NULL) {
    252  1.1  reinoud 			int i;
    253  1.1  reinoud 
    254  1.1  reinoud 			printf("udf_push_eccline: bufq_cancel can't find "
    255  1.1  reinoud 				"buffer; dumping queues\n");
    256  1.1  reinoud 			for (i = 1; i < UDF_SHED_MAX; i++) {
    257  1.1  reinoud 				printf("queue %d\n\t", i);
    258  1.1  reinoud 				ret = BUFQ_GET(priv->queues[i]);
    259  1.1  reinoud 				while (ret) {
    260  1.1  reinoud 					printf("%p ", ret);
    261  1.1  reinoud 					if (ret == eccline->buf)
    262  1.1  reinoud 						printf("[<-] ");
    263  1.1  reinoud 					ret = BUFQ_GET(priv->queues[i]);
    264  1.1  reinoud 				}
    265  1.1  reinoud 				printf("\n");
    266  1.1  reinoud 			}
    267  1.1  reinoud 			panic("fatal queue bug; exit");
    268  1.1  reinoud 		}
    269  1.1  reinoud #endif
    270  1.1  reinoud 
    271  1.1  reinoud 		KASSERT(ret == eccline->buf);
    272  1.1  reinoud 		priv->num_queued[curqueue]--;
    273  1.1  reinoud 	}
    274  1.1  reinoud 
    275  1.1  reinoud 	BUFQ_PUT(priv->queues[newqueue], eccline->buf);
    276  1.1  reinoud 	eccline->queued_on = newqueue;
    277  1.1  reinoud 	priv->num_queued[newqueue]++;
    278  1.1  reinoud 	vfs_timestamp(&priv->last_queued[newqueue]);
    279  1.1  reinoud 
    280  1.1  reinoud 	if (eccline->flags & ECC_FLOATING) {
    281  1.1  reinoud 		eccline->flags &= ~ECC_FLOATING;
    282  1.1  reinoud 		priv->num_floating--;
    283  1.1  reinoud 	}
    284  1.1  reinoud 
    285  1.1  reinoud 	if ((newqueue != UDF_SHED_FREE) && (newqueue != UDF_SHED_IDLE))
    286  1.1  reinoud 		cv_signal(&priv->discstrat_cv);
    287  1.1  reinoud }
    288  1.1  reinoud 
    289  1.1  reinoud 
    290  1.1  reinoud static struct udf_eccline *
    291  1.1  reinoud udf_pop_eccline(struct strat_private *priv, int queued_on)
    292  1.1  reinoud {
    293  1.1  reinoud 	struct udf_eccline *eccline;
    294  1.1  reinoud 	struct buf *buf;
    295  1.1  reinoud 
    296  1.1  reinoud 	KASSERT(mutex_owned(&priv->discstrat_mutex));
    297  1.1  reinoud 
    298  1.1  reinoud 	buf = BUFQ_GET(priv->queues[queued_on]);
    299  1.1  reinoud 	if (!buf) {
    300  1.1  reinoud 		KASSERT(priv->num_queued[queued_on] == 0);
    301  1.1  reinoud 		return NULL;
    302  1.1  reinoud 	}
    303  1.1  reinoud 
    304  1.1  reinoud 	eccline = BTOE(buf);
    305  1.1  reinoud 	KASSERT(eccline->queued_on == queued_on);
    306  1.1  reinoud 	eccline->queued_on = 0;
    307  1.1  reinoud 	priv->num_queued[queued_on]--;
    308  1.1  reinoud 
    309  1.1  reinoud 	if (eccline->flags & ECC_FLOATING)
    310  1.1  reinoud 		panic("popping already marked floating eccline");
    311  1.1  reinoud 	eccline->flags |= ECC_FLOATING;
    312  1.1  reinoud 	priv->num_floating++;
    313  1.1  reinoud 
    314  1.1  reinoud 	DPRINTF(PARANOIA, ("DEBUG: buf %p popped from queue %d\n",
    315  1.1  reinoud 		eccline->buf, queued_on));
    316  1.1  reinoud 
    317  1.1  reinoud 	return eccline;
    318  1.1  reinoud }
    319  1.1  reinoud 
    320  1.1  reinoud 
    321  1.1  reinoud static struct udf_eccline *
    322  1.1  reinoud udf_geteccline(struct udf_mount *ump, uint32_t sector, int flags)
    323  1.1  reinoud {
    324  1.1  reinoud 	struct strat_private *priv = PRIV(ump);
    325  1.1  reinoud 	struct udf_eccline *eccline;
    326  1.1  reinoud 	uint32_t start_sector, lb_size, blobsize;
    327  1.1  reinoud 	uint8_t *eccline_blob;
    328  1.1  reinoud 	int line, line_offset;
    329  1.1  reinoud 	int num_busy, ret;
    330  1.1  reinoud 
    331  1.1  reinoud 	line_offset  = sector % ump->packet_size;
    332  1.1  reinoud 	start_sector = sector - line_offset;
    333  1.1  reinoud 	line = (start_sector/ump->packet_size) & UDF_ECCBUF_HASHMASK;
    334  1.1  reinoud 
    335  1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
    336  1.1  reinoud 
    337  1.1  reinoud retry:
    338  1.3  reinoud 	DPRINTF(ECCLINE, ("get line sector %d, line %d\n", sector, line));
    339  1.1  reinoud 	LIST_FOREACH(eccline, &priv->eccline_hash[line], hashchain) {
    340  1.1  reinoud 		if (eccline->start_sector == start_sector) {
    341  1.3  reinoud 			DPRINTF(ECCLINE, ("\tfound eccline, start_sector %d\n",
    342  1.1  reinoud 				eccline->start_sector));
    343  1.1  reinoud 
    344  1.1  reinoud 			UDF_LOCK_ECCLINE(eccline);
    345  1.1  reinoud 			/* move from freelist (!) */
    346  1.1  reinoud 			if (eccline->queued_on == UDF_SHED_FREE) {
    347  1.3  reinoud 				DPRINTF(ECCLINE, ("was on freelist\n"));
    348  1.1  reinoud 				KASSERT(eccline->refcnt == 0);
    349  1.1  reinoud 				udf_push_eccline(eccline, UDF_SHED_IDLE);
    350  1.1  reinoud 			}
    351  1.1  reinoud 			eccline->refcnt++;
    352  1.1  reinoud 			mutex_exit(&priv->discstrat_mutex);
    353  1.1  reinoud 			return eccline;
    354  1.1  reinoud 		}
    355  1.1  reinoud 	}
    356  1.1  reinoud 
    357  1.3  reinoud 	DPRINTF(ECCLINE, ("\tnot found in eccline cache\n"));
    358  1.1  reinoud 	/* not found in eccline cache */
    359  1.1  reinoud 
    360  1.1  reinoud 	lb_size  = udf_rw32(ump->logical_vol->lb_size);
    361  1.1  reinoud 	blobsize = ump->packet_size * lb_size;
    362  1.1  reinoud 
    363  1.1  reinoud 	/* dont allow too many pending requests */
    364  1.3  reinoud 	DPRINTF(ECCLINE, ("\tallocating new eccline\n"));
    365  1.1  reinoud 	num_busy = (priv->num_queued[UDF_SHED_SEQWRITING] + priv->num_floating);
    366  1.1  reinoud 	if ((flags & ECC_SEQWRITING) && (num_busy > UDF_ECCLINE_MAXBUSY)) {
    367  1.1  reinoud 		ret = cv_timedwait(&priv->discstrat_cv,
    368  1.1  reinoud 			&priv->discstrat_mutex, hz/8);
    369  1.1  reinoud 		goto retry;
    370  1.1  reinoud 	}
    371  1.1  reinoud 
    372  1.1  reinoud 	eccline_blob = pool_get(&priv->ecclineblob_pool, PR_NOWAIT);
    373  1.1  reinoud 	eccline = pool_get(&priv->eccline_pool, PR_NOWAIT);
    374  1.1  reinoud 	if ((eccline_blob == NULL) || (eccline == NULL)) {
    375  1.1  reinoud 		if (eccline_blob)
    376  1.1  reinoud 			pool_put(&priv->ecclineblob_pool, eccline_blob);
    377  1.1  reinoud 		if (eccline)
    378  1.1  reinoud 			pool_put(&priv->eccline_pool, eccline);
    379  1.1  reinoud 
    380  1.1  reinoud 		/* out of memory for now; canibalise freelist */
    381  1.1  reinoud 		eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
    382  1.1  reinoud 		if (eccline == NULL) {
    383  1.1  reinoud 			/* serious trouble; wait and retry */
    384  1.1  reinoud 			cv_timedwait(&priv->discstrat_cv,
    385  1.1  reinoud 				&priv->discstrat_mutex, hz/8);
    386  1.1  reinoud 			goto retry;
    387  1.1  reinoud 		}
    388  1.1  reinoud 		/* push back line if we're waiting for it */
    389  1.1  reinoud 		if (eccline->flags & ECC_WANTED) {
    390  1.1  reinoud 			udf_push_eccline(eccline, UDF_SHED_IDLE);
    391  1.1  reinoud 			goto retry;
    392  1.1  reinoud 		}
    393  1.1  reinoud 
    394  1.1  reinoud 		/* unlink this entry */
    395  1.1  reinoud 		LIST_REMOVE(eccline, hashchain);
    396  1.1  reinoud 
    397  1.1  reinoud 		KASSERT(eccline->flags & ECC_FLOATING);
    398  1.1  reinoud 
    399  1.1  reinoud 		eccline_blob = eccline->blob;
    400  1.1  reinoud 		memset(eccline, 0, sizeof(struct udf_eccline));
    401  1.1  reinoud 		eccline->flags = ECC_FLOATING;
    402  1.1  reinoud 	} else {
    403  1.1  reinoud 		memset(eccline, 0, sizeof(struct udf_eccline));
    404  1.1  reinoud 		eccline->flags = ECC_FLOATING;
    405  1.1  reinoud 		priv->num_floating++;
    406  1.1  reinoud 	}
    407  1.1  reinoud 
    408  1.1  reinoud 	eccline->queued_on = 0;
    409  1.1  reinoud 	eccline->blob = eccline_blob;
    410  1.1  reinoud 	eccline->buf  = getiobuf(NULL, true);
    411  1.1  reinoud 	eccline->buf->b_private = eccline;	/* IMPORTANT */
    412  1.1  reinoud 
    413  1.1  reinoud 	/* initialise eccline blob */
    414  1.1  reinoud 	memset(eccline->blob, 0, blobsize);
    415  1.1  reinoud 
    416  1.1  reinoud 	eccline->ump = ump;
    417  1.1  reinoud 	eccline->present = eccline->readin = eccline->dirty = 0;
    418  1.1  reinoud 	eccline->error = 0;
    419  1.1  reinoud 	eccline->refcnt = 0;
    420  1.1  reinoud 	eccline->start_sector = start_sector;
    421  1.1  reinoud 
    422  1.1  reinoud 	LIST_INSERT_HEAD(&priv->eccline_hash[line], eccline, hashchain);
    423  1.1  reinoud 
    424  1.1  reinoud 	/*
    425  1.1  reinoud 	 * TODO possible optimalisation for checking overlap with partitions
    426  1.1  reinoud 	 * to get a clue on future eccline usage
    427  1.1  reinoud 	 */
    428  1.1  reinoud 	eccline->refcnt++;
    429  1.1  reinoud 	UDF_LOCK_ECCLINE(eccline);
    430  1.1  reinoud 
    431  1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
    432  1.1  reinoud 
    433  1.1  reinoud 	return eccline;
    434  1.1  reinoud }
    435  1.1  reinoud 
    436  1.1  reinoud 
    437  1.1  reinoud static void
    438  1.1  reinoud udf_puteccline(struct udf_eccline *eccline)
    439  1.1  reinoud {
    440  1.1  reinoud 	struct strat_private *priv = PRIV(eccline->ump);
    441  1.1  reinoud 	struct udf_eccline *deccline;
    442  1.1  reinoud 	struct udf_mount *ump = eccline->ump;
    443  1.1  reinoud 	uint64_t allbits = ((uint64_t) 1 << ump->packet_size)-1;
    444  1.1  reinoud 	int newqueue, tries;
    445  1.1  reinoud 
    446  1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
    447  1.1  reinoud 
    448  1.1  reinoud 	/* clear directly all readin requests from present ones */
    449  1.1  reinoud 	if (eccline->readin & eccline->present) {
    450  1.1  reinoud 		/* clear all read bits that are already read in */
    451  1.1  reinoud 		eccline->readin &= (~eccline->present) & allbits;
    452  1.1  reinoud 		wakeup(eccline);
    453  1.1  reinoud 	}
    454  1.1  reinoud 
    455  1.3  reinoud 	DPRINTF(ECCLINE, ("put eccline start sector %d, refcnt %d\n",
    456  1.1  reinoud 		eccline->start_sector, eccline->refcnt));
    457  1.1  reinoud 
    458  1.1  reinoud 	/* requeue */
    459  1.1  reinoud 	newqueue = UDF_SHED_FREE;
    460  1.1  reinoud 	if (eccline->refcnt > 1)
    461  1.1  reinoud 		newqueue = UDF_SHED_IDLE;
    462  1.1  reinoud 	if (eccline->flags & ECC_WANTED)
    463  1.1  reinoud 		newqueue = UDF_SHED_IDLE;
    464  1.1  reinoud 	if (eccline->dirty) {
    465  1.1  reinoud 		newqueue = UDF_SHED_WRITING;
    466  1.1  reinoud 		if (eccline->flags & ECC_SEQWRITING)
    467  1.1  reinoud 			newqueue = UDF_SHED_SEQWRITING;
    468  1.1  reinoud 	}
    469  1.1  reinoud 
    470  1.1  reinoud 	/* if we have active nodes */
    471  1.1  reinoud 	if (eccline->refcnt > 1) {
    472  1.1  reinoud 		/* we dont set it on seqwriting */
    473  1.1  reinoud 		eccline->flags &= ~ECC_SEQWRITING;
    474  1.1  reinoud 	}
    475  1.1  reinoud 
    476  1.1  reinoud 	/* if we need reading in or not all is yet present, queue reading */
    477  1.1  reinoud 	if ((eccline->readin) || (eccline->present != allbits))
    478  1.1  reinoud 		newqueue = UDF_SHED_READING;
    479  1.1  reinoud 
    480  1.1  reinoud 	/* reduce the number of kept free buffers */
    481  1.1  reinoud 	tries = priv->num_queued[UDF_SHED_FREE] - UDF_ECCLINE_MAXFREE;
    482  1.1  reinoud 	while (tries > 0 /* priv->num_queued[UDF_SHED_FREE] > UDF_ECCLINE_MAXFREE */) {
    483  1.1  reinoud 		deccline = udf_pop_eccline(priv, UDF_SHED_FREE);
    484  1.1  reinoud 		KASSERT(deccline);
    485  1.1  reinoud 		KASSERT(deccline->refcnt == 0);
    486  1.1  reinoud 		if (deccline->flags & ECC_WANTED) {
    487  1.1  reinoud 			udf_push_eccline(deccline, UDF_SHED_IDLE);
    488  1.3  reinoud 			DPRINTF(ECCLINE, ("Tried removing, pushed back to free list\n"));
    489  1.1  reinoud 		} else {
    490  1.3  reinoud 			DPRINTF(ECCLINE, ("Removing entry from free list\n"));
    491  1.1  reinoud 			udf_dispose_eccline(deccline);
    492  1.1  reinoud 		}
    493  1.1  reinoud 		tries--;
    494  1.1  reinoud 	}
    495  1.1  reinoud 
    496  1.1  reinoud 	udf_push_eccline(eccline, newqueue);
    497  1.1  reinoud 
    498  1.1  reinoud 	KASSERT(eccline->refcnt >= 1);
    499  1.1  reinoud 	eccline->refcnt--;
    500  1.1  reinoud 	UDF_UNLOCK_ECCLINE(eccline);
    501  1.1  reinoud 
    502  1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
    503  1.1  reinoud }
    504  1.1  reinoud 
    505  1.1  reinoud /* --------------------------------------------------------------------- */
    506  1.1  reinoud 
    507  1.1  reinoud static int
    508  1.5  reinoud udf_create_nodedscr_rmw(struct udf_strat_args *args)
    509  1.1  reinoud {
    510  1.1  reinoud 	union dscrptr   **dscrptr  = &args->dscr;
    511  1.1  reinoud 	struct udf_mount *ump      = args->ump;
    512  1.1  reinoud 	struct long_ad   *icb      = args->icb;
    513  1.1  reinoud 	struct udf_eccline *eccline;
    514  1.1  reinoud 	uint64_t bit;
    515  1.1  reinoud 	uint32_t sectornr, lb_size, dummy;
    516  1.1  reinoud 	uint8_t *mem;
    517  1.1  reinoud 	int error, eccsect;
    518  1.1  reinoud 
    519  1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    520  1.1  reinoud 	if (error)
    521  1.1  reinoud 		return error;
    522  1.1  reinoud 
    523  1.1  reinoud 	lb_size  = udf_rw32(ump->logical_vol->lb_size);
    524  1.1  reinoud 
    525  1.1  reinoud 	/* get our eccline */
    526  1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    527  1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    528  1.1  reinoud 
    529  1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    530  1.1  reinoud 	eccline->readin  &= ~bit;	/* just in case */
    531  1.1  reinoud 	eccline->present |=  bit;
    532  1.1  reinoud 	eccline->dirty   &= ~bit;	/* Err... euhm... clean? */
    533  1.1  reinoud 
    534  1.1  reinoud 	eccline->refcnt++;
    535  1.1  reinoud 
    536  1.1  reinoud 	/* clear space */
    537  1.1  reinoud 	mem = ((uint8_t *) eccline->blob) + eccsect * lb_size;
    538  1.1  reinoud 	memset(mem, 0, lb_size);
    539  1.1  reinoud 
    540  1.1  reinoud 	udf_puteccline(eccline);
    541  1.1  reinoud 
    542  1.1  reinoud 	*dscrptr = (union dscrptr *) mem;
    543  1.1  reinoud 	return 0;
    544  1.1  reinoud }
    545  1.1  reinoud 
    546  1.1  reinoud 
    547  1.1  reinoud static void
    548  1.5  reinoud udf_free_nodedscr_rmw(struct udf_strat_args *args)
    549  1.1  reinoud {
    550  1.1  reinoud 	struct udf_mount *ump  = args->ump;
    551  1.1  reinoud 	struct long_ad   *icb  = args->icb;
    552  1.1  reinoud 	struct udf_eccline *eccline;
    553  1.1  reinoud 	uint64_t bit;
    554  1.1  reinoud 	uint32_t sectornr, dummy;
    555  1.1  reinoud 	int error, eccsect;
    556  1.1  reinoud 
    557  1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    558  1.1  reinoud 	if (error)
    559  1.1  reinoud 		return;
    560  1.1  reinoud 
    561  1.1  reinoud 	/* get our eccline */
    562  1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    563  1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    564  1.1  reinoud 
    565  1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    566  1.1  reinoud 	eccline->readin &= ~bit;	/* just in case */
    567  1.1  reinoud 
    568  1.1  reinoud 	KASSERT(eccline->refcnt >= 1);
    569  1.1  reinoud 	eccline->refcnt--;
    570  1.1  reinoud 
    571  1.1  reinoud 	udf_puteccline(eccline);
    572  1.1  reinoud }
    573  1.1  reinoud 
    574  1.1  reinoud 
    575  1.1  reinoud static int
    576  1.5  reinoud udf_read_nodedscr_rmw(struct udf_strat_args *args)
    577  1.1  reinoud {
    578  1.1  reinoud 	union dscrptr   **dscrptr = &args->dscr;
    579  1.1  reinoud 	struct udf_mount *ump = args->ump;
    580  1.1  reinoud 	struct long_ad   *icb = args->icb;
    581  1.1  reinoud 	struct udf_eccline *eccline;
    582  1.1  reinoud 	uint64_t bit;
    583  1.1  reinoud 	uint32_t sectornr, dummy;
    584  1.1  reinoud 	uint8_t *pos;
    585  1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    586  1.1  reinoud 	int lb_size = udf_rw32(ump->logical_vol->lb_size);
    587  1.1  reinoud 	int i, error, dscrlen, eccsect;
    588  1.1  reinoud 
    589  1.1  reinoud 	lb_size = lb_size;
    590  1.1  reinoud 	KASSERT(sector_size == lb_size);
    591  1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    592  1.1  reinoud 	if (error)
    593  1.1  reinoud 		return error;
    594  1.1  reinoud 
    595  1.1  reinoud 	/* get our eccline */
    596  1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    597  1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    598  1.1  reinoud 
    599  1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    600  1.1  reinoud 	if ((eccline->present & bit) == 0) {
    601  1.1  reinoud 		/* mark bit for readin */
    602  1.1  reinoud 		eccline->readin |= bit;
    603  1.1  reinoud 		eccline->refcnt++;	/* prevent recycling */
    604  1.1  reinoud 		KASSERT(eccline->bufs[eccsect] == NULL);
    605  1.1  reinoud 		udf_puteccline(eccline);
    606  1.1  reinoud 
    607  1.1  reinoud 		/* wait for completion; XXX remodel to lock bit code */
    608  1.1  reinoud 		error = 0;
    609  1.1  reinoud 		while ((eccline->present & bit) == 0) {
    610  1.1  reinoud 			tsleep(eccline, PRIBIO+1, "udflvdrd", hz/8);
    611  1.1  reinoud 			if (eccline->error & bit) {
    612  1.1  reinoud 				KASSERT(eccline->refcnt >= 1);
    613  1.1  reinoud 				eccline->refcnt--;	/* undo temp refcnt */
    614  1.1  reinoud 				*dscrptr = NULL;
    615  1.1  reinoud 				return EIO;		/* XXX error code */
    616  1.1  reinoud 			}
    617  1.1  reinoud 		}
    618  1.1  reinoud 
    619  1.1  reinoud 		/* reget our line */
    620  1.1  reinoud 		eccline = udf_geteccline(ump, sectornr, 0);
    621  1.1  reinoud 		KASSERT(eccline->refcnt >= 1);
    622  1.1  reinoud 		eccline->refcnt--;	/* undo refcnt */
    623  1.1  reinoud 	}
    624  1.1  reinoud 
    625  1.1  reinoud 	*dscrptr = (union dscrptr *)
    626  1.1  reinoud 		(((uint8_t *) eccline->blob) + eccsect * sector_size);
    627  1.1  reinoud 
    628  1.1  reinoud 	/* code from read_phys_descr */
    629  1.1  reinoud 	/* check if its a valid tag */
    630  1.1  reinoud 	error = udf_check_tag(*dscrptr);
    631  1.1  reinoud 	if (error) {
    632  1.1  reinoud 		/* check if its an empty block */
    633  1.1  reinoud 		pos = (uint8_t *) *dscrptr;
    634  1.1  reinoud 		for (i = 0; i < sector_size; i++, pos++) {
    635  1.1  reinoud 			if (*pos) break;
    636  1.1  reinoud 		}
    637  1.1  reinoud 		if (i == sector_size) {
    638  1.1  reinoud 			/* return no error but with no dscrptr */
    639  1.1  reinoud 			error = 0;
    640  1.1  reinoud 		}
    641  1.1  reinoud 		*dscrptr = NULL;
    642  1.1  reinoud 		udf_puteccline(eccline);
    643  1.1  reinoud 		return error;
    644  1.1  reinoud 	}
    645  1.1  reinoud 
    646  1.1  reinoud 	/* calculate descriptor size */
    647  1.1  reinoud 	dscrlen = udf_tagsize(*dscrptr, sector_size);
    648  1.1  reinoud 	error = udf_check_tag_payload(*dscrptr, dscrlen);
    649  1.1  reinoud 	if (error) {
    650  1.1  reinoud 		*dscrptr = NULL;
    651  1.1  reinoud 		udf_puteccline(eccline);
    652  1.1  reinoud 		return error;
    653  1.1  reinoud 	}
    654  1.1  reinoud 
    655  1.1  reinoud 	eccline->refcnt++;
    656  1.1  reinoud 	udf_puteccline(eccline);
    657  1.1  reinoud 
    658  1.1  reinoud 	return 0;
    659  1.1  reinoud }
    660  1.1  reinoud 
    661  1.1  reinoud 
    662  1.1  reinoud static int
    663  1.5  reinoud udf_write_nodedscr_rmw(struct udf_strat_args *args)
    664  1.1  reinoud {
    665  1.1  reinoud 	union dscrptr    *dscrptr = args->dscr;
    666  1.1  reinoud 	struct udf_mount *ump = args->ump;
    667  1.1  reinoud 	struct long_ad   *icb = args->icb;
    668  1.1  reinoud 	struct udf_node *udf_node = args->udf_node;
    669  1.1  reinoud 	struct udf_eccline *eccline;
    670  1.1  reinoud 	uint64_t bit;
    671  1.1  reinoud 	uint32_t sectornr, logsectornr, dummy;
    672  1.1  reinoud 	// int waitfor  = args->waitfor;
    673  1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    674  1.1  reinoud 	int lb_size = udf_rw32(ump->logical_vol->lb_size);
    675  1.1  reinoud 	int error, eccsect;
    676  1.1  reinoud 
    677  1.1  reinoud 	lb_size = lb_size;
    678  1.1  reinoud 	KASSERT(sector_size == lb_size);
    679  1.1  reinoud 	sectornr    = 0;
    680  1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    681  1.1  reinoud 	if (error)
    682  1.1  reinoud 		return error;
    683  1.1  reinoud 
    684  1.5  reinoud 	/* add reference to the vnode to prevent recycling */
    685  1.5  reinoud 	vhold(udf_node->vnode);
    686  1.5  reinoud 
    687  1.1  reinoud 	/* get our eccline */
    688  1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    689  1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    690  1.1  reinoud 
    691  1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    692  1.1  reinoud 
    693  1.1  reinoud 	/* old callback still pending? */
    694  1.1  reinoud 	if (eccline->bufs[eccsect]) {
    695  1.5  reinoud 		DPRINTF(WRITE, ("udf_write_nodedscr_rmw: writing descriptor"
    696  1.1  reinoud 					" over buffer?\n"));
    697  1.1  reinoud 		nestiobuf_done(eccline->bufs[eccsect],
    698  1.1  reinoud 				eccline->bufs_len[eccsect],
    699  1.1  reinoud 				0);
    700  1.1  reinoud 		eccline->bufs[eccsect] = NULL;
    701  1.1  reinoud 	}
    702  1.1  reinoud 
    703  1.1  reinoud 	/* set sector number in the descriptor and validate */
    704  1.1  reinoud 	dscrptr = (union dscrptr *)
    705  1.1  reinoud 		(((uint8_t *) eccline->blob) + eccsect * sector_size);
    706  1.1  reinoud 	KASSERT(dscrptr == args->dscr);
    707  1.1  reinoud 
    708  1.1  reinoud 	logsectornr = udf_rw32(icb->loc.lb_num);
    709  1.1  reinoud 	dscrptr->tag.tag_loc = udf_rw32(logsectornr);
    710  1.1  reinoud 	udf_validate_tag_and_crc_sums(dscrptr);
    711  1.1  reinoud 
    712  1.1  reinoud 	udf_fixup_node_internals(ump, (uint8_t *) dscrptr, UDF_C_NODE);
    713  1.1  reinoud 
    714  1.1  reinoud 	/* set our flags */
    715  1.1  reinoud 	KASSERT(eccline->present & bit);
    716  1.1  reinoud 	eccline->dirty |= bit;
    717  1.1  reinoud 
    718  1.1  reinoud 	KASSERT(udf_tagsize(dscrptr, sector_size) <= sector_size);
    719  1.1  reinoud 
    720  1.1  reinoud 	udf_puteccline(eccline);
    721  1.1  reinoud 
    722  1.5  reinoud 	holdrele(udf_node->vnode);
    723  1.5  reinoud 	udf_node->outstanding_nodedscr--;
    724  1.5  reinoud 	if (udf_node->outstanding_nodedscr == 0) {
    725  1.5  reinoud 		UDF_UNLOCK_NODE(udf_node, udf_node->i_flags & IN_CALLBACK_ULK);
    726  1.5  reinoud 		wakeup(&udf_node->outstanding_nodedscr);
    727  1.5  reinoud 	}
    728  1.5  reinoud 
    729  1.1  reinoud 	/* XXX waitfor not used */
    730  1.1  reinoud 	return 0;
    731  1.1  reinoud }
    732  1.1  reinoud 
    733  1.1  reinoud 
    734  1.1  reinoud static void
    735  1.1  reinoud udf_queuebuf_rmw(struct udf_strat_args *args)
    736  1.1  reinoud {
    737  1.1  reinoud 	struct udf_mount *ump = args->ump;
    738  1.1  reinoud 	struct buf *buf = args->nestbuf;
    739  1.1  reinoud 	struct strat_private *priv = PRIV(ump);
    740  1.1  reinoud 	struct udf_eccline *eccline;
    741  1.1  reinoud 	struct long_ad *node_ad_cpy;
    742  1.1  reinoud 	uint64_t bit, *lmapping, *pmapping, *lmappos, *pmappos, blknr;
    743  1.1  reinoud 	uint32_t buf_len, len, sectornr, our_sectornr;
    744  1.1  reinoud 	uint32_t bpos;
    745  1.1  reinoud 	uint8_t *fidblk, *src, *dst;
    746  1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    747  1.1  reinoud 	int blks = sector_size / DEV_BSIZE;
    748  1.1  reinoud 	int eccsect, what, queue, error;
    749  1.1  reinoud 
    750  1.1  reinoud 	KASSERT(ump);
    751  1.1  reinoud 	KASSERT(buf);
    752  1.1  reinoud 	KASSERT(buf->b_iodone == nestiobuf_iodone);
    753  1.1  reinoud 
    754  1.1  reinoud 	blknr        = buf->b_blkno;
    755  1.1  reinoud 	our_sectornr = blknr / blks;
    756  1.1  reinoud 
    757  1.1  reinoud 	what = buf->b_udf_c_type;
    758  1.1  reinoud 	queue = UDF_SHED_READING;
    759  1.1  reinoud 	if ((buf->b_flags & B_READ) == 0) {
    760  1.1  reinoud 		/* writing */
    761  1.1  reinoud 		queue = UDF_SHED_SEQWRITING;
    762  1.1  reinoud 		if (what == UDF_C_DSCR)
    763  1.1  reinoud 			queue = UDF_SHED_WRITING;
    764  1.1  reinoud 		if (what == UDF_C_NODE)
    765  1.1  reinoud 			queue = UDF_SHED_WRITING;
    766  1.1  reinoud 	}
    767  1.1  reinoud 
    768  1.1  reinoud 	if (queue == UDF_SHED_READING) {
    769  1.3  reinoud 		DPRINTF(SHEDULE, ("\nudf_queuebuf_rmw READ %p : sector %d type %d,"
    770  1.1  reinoud 			"b_resid %d, b_bcount %d, b_bufsize %d\n",
    771  1.1  reinoud 			buf, (uint32_t) buf->b_blkno / blks, buf->b_udf_c_type,
    772  1.1  reinoud 			buf->b_resid, buf->b_bcount, buf->b_bufsize));
    773  1.1  reinoud 
    774  1.1  reinoud 		/* mark bits for reading */
    775  1.1  reinoud 		buf_len = buf->b_bcount;
    776  1.1  reinoud 		sectornr = our_sectornr;
    777  1.1  reinoud 		eccline = udf_geteccline(ump, sectornr, 0);
    778  1.1  reinoud 		eccsect = sectornr - eccline->start_sector;
    779  1.1  reinoud 		bpos = 0;
    780  1.1  reinoud 		while (buf_len) {
    781  1.1  reinoud 			len = MIN(buf_len, sector_size);
    782  1.1  reinoud 			if (eccsect == ump->packet_size) {
    783  1.1  reinoud 				udf_puteccline(eccline);
    784  1.1  reinoud 				eccline = udf_geteccline(ump, sectornr, 0);
    785  1.1  reinoud 				eccsect = sectornr - eccline->start_sector;
    786  1.1  reinoud 			}
    787  1.1  reinoud 			bit = (uint64_t) 1 << eccsect;
    788  1.1  reinoud 			error = eccline->error & bit ? EIO : 0;
    789  1.1  reinoud 			if (eccline->present & bit) {
    790  1.1  reinoud 				src = (uint8_t *) eccline->blob +
    791  1.1  reinoud 					eccsect * sector_size;
    792  1.1  reinoud 				dst = (uint8_t *) buf->b_data + bpos;
    793  1.1  reinoud 				if (!error)
    794  1.1  reinoud 					memcpy(dst, src, len);
    795  1.1  reinoud 				nestiobuf_done(buf, len, error);
    796  1.1  reinoud 			} else {
    797  1.1  reinoud 				eccline->readin |= bit;
    798  1.1  reinoud 				KASSERT(eccline->bufs[eccsect] == NULL);
    799  1.1  reinoud 				eccline->bufs[eccsect] = buf;
    800  1.1  reinoud 				eccline->bufs_bpos[eccsect] = bpos;
    801  1.1  reinoud 				eccline->bufs_len[eccsect] = len;
    802  1.1  reinoud 			}
    803  1.1  reinoud 			bpos += sector_size;
    804  1.1  reinoud 			eccsect++;
    805  1.1  reinoud 			sectornr++;
    806  1.1  reinoud 			buf_len -= len;
    807  1.1  reinoud 		}
    808  1.1  reinoud 		udf_puteccline(eccline);
    809  1.1  reinoud 		return;
    810  1.1  reinoud 	}
    811  1.1  reinoud 
    812  1.1  reinoud 	if (queue == UDF_SHED_WRITING) {
    813  1.3  reinoud 		DPRINTF(SHEDULE, ("\nudf_queuebuf_rmw WRITE %p : sector %d "
    814  1.1  reinoud 			"type %d, b_resid %d, b_bcount %d, b_bufsize %d\n",
    815  1.1  reinoud 			buf, (uint32_t) buf->b_blkno / blks, buf->b_udf_c_type,
    816  1.1  reinoud 			buf->b_resid, buf->b_bcount, buf->b_bufsize));
    817  1.1  reinoud 		/* if we have FIDs fixup using buffer's sector number(s) */
    818  1.1  reinoud 		if (buf->b_udf_c_type == UDF_C_FIDS) {
    819  1.1  reinoud 			panic("UDF_C_FIDS in SHED_WRITING!\n");
    820  1.1  reinoud #if 0
    821  1.1  reinoud 			buf_len = buf->b_bcount;
    822  1.1  reinoud 			sectornr = our_sectornr;
    823  1.1  reinoud 			bpos = 0;
    824  1.1  reinoud 			while (buf_len) {
    825  1.1  reinoud 				len = MIN(buf_len, sector_size);
    826  1.1  reinoud 				fidblk = (uint8_t *) buf->b_data + bpos;
    827  1.1  reinoud 				udf_fixup_fid_block(fidblk, sector_size,
    828  1.1  reinoud 					0, len, sectornr);
    829  1.1  reinoud 				sectornr++;
    830  1.1  reinoud 				bpos += len;
    831  1.1  reinoud 				buf_len -= len;
    832  1.1  reinoud 			}
    833  1.1  reinoud #endif
    834  1.1  reinoud 		}
    835  1.1  reinoud 		udf_fixup_node_internals(ump, buf->b_data, buf->b_udf_c_type);
    836  1.1  reinoud 
    837  1.1  reinoud 		/* copy parts into the bufs and set for writing */
    838  1.1  reinoud 		buf_len = buf->b_bcount;
    839  1.1  reinoud 		sectornr = our_sectornr;
    840  1.1  reinoud 		eccline = udf_geteccline(ump, sectornr, 0);
    841  1.1  reinoud 		eccsect = sectornr - eccline->start_sector;
    842  1.1  reinoud 		bpos = 0;
    843  1.1  reinoud 		while (buf_len) {
    844  1.1  reinoud 			len = MIN(buf_len, sector_size);
    845  1.1  reinoud 			if (eccsect == ump->packet_size) {
    846  1.1  reinoud 				udf_puteccline(eccline);
    847  1.1  reinoud 				eccline = udf_geteccline(ump, sectornr, 0);
    848  1.1  reinoud 				eccsect = sectornr - eccline->start_sector;
    849  1.1  reinoud 			}
    850  1.1  reinoud 			bit = (uint64_t) 1 << eccsect;
    851  1.1  reinoud 			KASSERT((eccline->readin & bit) == 0);
    852  1.1  reinoud 			eccline->present |= bit;
    853  1.1  reinoud 			eccline->dirty   |= bit;
    854  1.1  reinoud 			if (eccline->bufs[eccsect]) {
    855  1.1  reinoud 				/* old callback still pending */
    856  1.1  reinoud 				nestiobuf_done(eccline->bufs[eccsect],
    857  1.1  reinoud 						eccline->bufs_len[eccsect],
    858  1.1  reinoud 						0);
    859  1.1  reinoud 				eccline->bufs[eccsect] = NULL;
    860  1.1  reinoud 			}
    861  1.1  reinoud 
    862  1.2  reinoud 			src = (uint8_t *) buf->b_data + bpos;
    863  1.2  reinoud 			dst = (uint8_t *) eccline->blob + eccsect * sector_size;
    864  1.2  reinoud 			if (len != sector_size)
    865  1.2  reinoud 				memset(dst, 0, sector_size);
    866  1.2  reinoud 			memcpy(dst, src, len);
    867  1.2  reinoud 
    868  1.1  reinoud 			/* note that its finished for this extent */
    869  1.1  reinoud 			eccline->bufs[eccsect] = NULL;
    870  1.1  reinoud 			nestiobuf_done(buf, len, 0);
    871  1.1  reinoud 
    872  1.1  reinoud 			bpos += sector_size;
    873  1.1  reinoud 			eccsect++;
    874  1.1  reinoud 			sectornr++;
    875  1.1  reinoud 			buf_len -= len;
    876  1.1  reinoud 		}
    877  1.1  reinoud 		udf_puteccline(eccline);
    878  1.1  reinoud 		return;
    879  1.1  reinoud 
    880  1.1  reinoud 	}
    881  1.1  reinoud 
    882  1.1  reinoud 	/* sequential writing */
    883  1.1  reinoud 	KASSERT(queue == UDF_SHED_SEQWRITING);
    884  1.3  reinoud 	DPRINTF(SHEDULE, ("\nudf_queuebuf_rmw SEQWRITE %p : sector XXXX "
    885  1.1  reinoud 		"type %d, b_resid %d, b_bcount %d, b_bufsize %d\n",
    886  1.1  reinoud 		buf, buf->b_udf_c_type, buf->b_resid, buf->b_bcount,
    887  1.1  reinoud 		buf->b_bufsize));
    888  1.1  reinoud 	/*
    889  1.1  reinoud 	 * Buffers should not have been allocated to disc addresses yet on
    890  1.1  reinoud 	 * this queue. Note that a buffer can get multiple extents allocated.
    891  1.1  reinoud 	 * Note that it *looks* like the normal writing but its different in
    892  1.1  reinoud 	 * the details.
    893  1.1  reinoud 	 *
    894  1.1  reinoud 	 * lmapping contains lb_num relative to base partition.  pmapping
    895  1.1  reinoud 	 * contains lb_num as used for disc adressing.
    896  1.1  reinoud 	 */
    897  1.1  reinoud 	mutex_enter(&priv->seqwrite_mutex);
    898  1.1  reinoud 
    899  1.1  reinoud 	lmapping    = ump->la_lmapping;
    900  1.1  reinoud 	pmapping    = ump->la_pmapping;
    901  1.1  reinoud 	node_ad_cpy = ump->la_node_ad_cpy;
    902  1.1  reinoud 
    903  1.1  reinoud 	/*
    904  1.1  reinoud 	 * XXX should we try to claim/organize the allocated memory to block
    905  1.1  reinoud 	 * aligned pieces?
    906  1.1  reinoud 	 */
    907  1.1  reinoud 	/* allocate buf and get its logical and physical mappings */
    908  1.1  reinoud 	udf_late_allocate_buf(ump, buf, lmapping, pmapping, node_ad_cpy);
    909  1.1  reinoud 
    910  1.1  reinoud 	/* if we have FIDs, fixup using the new allocation table */
    911  1.1  reinoud 	if (buf->b_udf_c_type == UDF_C_FIDS) {
    912  1.1  reinoud 		buf_len = buf->b_bcount;
    913  1.1  reinoud 		bpos = 0;
    914  1.1  reinoud 		lmappos = lmapping;
    915  1.1  reinoud 		while (buf_len) {
    916  1.1  reinoud 			sectornr = *lmappos++;
    917  1.1  reinoud 			len = MIN(buf_len, sector_size);
    918  1.1  reinoud 			fidblk = (uint8_t *) buf->b_data + bpos;
    919  1.1  reinoud 			udf_fixup_fid_block(fidblk, sector_size,
    920  1.1  reinoud 				0, len, sectornr);
    921  1.1  reinoud 			bpos += len;
    922  1.1  reinoud 			buf_len -= len;
    923  1.1  reinoud 		}
    924  1.1  reinoud 	}
    925  1.1  reinoud 	udf_fixup_node_internals(ump, buf->b_data, buf->b_udf_c_type);
    926  1.1  reinoud 
    927  1.1  reinoud 	/* copy parts into the bufs and set for writing */
    928  1.1  reinoud 	pmappos = pmapping;
    929  1.1  reinoud 	buf_len = buf->b_bcount;
    930  1.1  reinoud 	sectornr = *pmappos++;
    931  1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, ECC_SEQWRITING);
    932  1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    933  1.1  reinoud 	bpos = 0;
    934  1.1  reinoud 	while (buf_len) {
    935  1.1  reinoud 		len = MIN(buf_len, sector_size);
    936  1.1  reinoud 		eccsect = sectornr - eccline->start_sector;
    937  1.1  reinoud 		if ((eccsect < 0) || (eccsect >= ump->packet_size)) {
    938  1.1  reinoud 			eccline->flags |= ECC_SEQWRITING;
    939  1.1  reinoud 			udf_puteccline(eccline);
    940  1.1  reinoud 			eccline = udf_geteccline(ump, sectornr, ECC_SEQWRITING);
    941  1.1  reinoud 			eccsect = sectornr - eccline->start_sector;
    942  1.1  reinoud 		}
    943  1.1  reinoud 		bit = (uint64_t) 1 << eccsect;
    944  1.1  reinoud 		KASSERT((eccline->readin & bit) == 0);
    945  1.1  reinoud 		eccline->present |= bit;
    946  1.1  reinoud 		eccline->dirty   |= bit;
    947  1.1  reinoud 		eccline->bufs[eccsect] = NULL;
    948  1.1  reinoud 
    949  1.1  reinoud 		src = (uint8_t *) buf->b_data + bpos;
    950  1.1  reinoud 		dst = (uint8_t *)
    951  1.1  reinoud 			eccline->blob + eccsect * sector_size;
    952  1.1  reinoud 		if (len != sector_size)
    953  1.1  reinoud 			memset(dst, 0, sector_size);
    954  1.1  reinoud 		memcpy(dst, src, len);
    955  1.1  reinoud 
    956  1.1  reinoud 		/* note that its finished for this extent */
    957  1.1  reinoud 		nestiobuf_done(buf, len, 0);
    958  1.1  reinoud 
    959  1.1  reinoud 		bpos += sector_size;
    960  1.1  reinoud 		sectornr = *pmappos++;
    961  1.1  reinoud 		buf_len -= len;
    962  1.1  reinoud 	}
    963  1.1  reinoud 	eccline->flags |= ECC_SEQWRITING;
    964  1.1  reinoud 	udf_puteccline(eccline);
    965  1.1  reinoud 	mutex_exit(&priv->seqwrite_mutex);
    966  1.1  reinoud }
    967  1.1  reinoud 
    968  1.1  reinoud /* --------------------------------------------------------------------- */
    969  1.1  reinoud 
    970  1.1  reinoud static void
    971  1.1  reinoud udf_shedule_read_callback(struct buf *buf)
    972  1.1  reinoud {
    973  1.1  reinoud 	struct udf_eccline *eccline = BTOE(buf);
    974  1.1  reinoud 	struct udf_mount *ump = eccline->ump;
    975  1.1  reinoud 	uint64_t bit;
    976  1.1  reinoud 	uint8_t *src, *dst;
    977  1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    978  1.1  reinoud 	int error, i, len;
    979  1.1  reinoud 
    980  1.3  reinoud 	DPRINTF(ECCLINE, ("read callback called\n"));
    981  1.1  reinoud 	/* post process read action */
    982  1.1  reinoud 	error = buf->b_error;
    983  1.1  reinoud 	for (i = 0; i < ump->packet_size; i++) {
    984  1.1  reinoud 		bit = (uint64_t) 1 << i;
    985  1.1  reinoud 		src = (uint8_t *) buf->b_data +   i * sector_size;
    986  1.1  reinoud 		dst = (uint8_t *) eccline->blob + i * sector_size;
    987  1.1  reinoud 		if (eccline->present & bit)
    988  1.1  reinoud 			continue;
    989  1.1  reinoud 		if (error) {
    990  1.1  reinoud 			eccline->error |= bit;
    991  1.1  reinoud 		} else {
    992  1.1  reinoud 			eccline->present |= bit;
    993  1.1  reinoud 		}
    994  1.1  reinoud 		if (eccline->bufs[i]) {
    995  1.1  reinoud 			dst = (uint8_t *) eccline->bufs[i]->b_data +
    996  1.1  reinoud 				eccline->bufs_bpos[i];
    997  1.1  reinoud 			len = eccline->bufs_len[i];
    998  1.1  reinoud 			if (!error)
    999  1.1  reinoud 				memcpy(dst, src, len);
   1000  1.1  reinoud 			nestiobuf_done(eccline->bufs[i], len, error);
   1001  1.1  reinoud 			eccline->bufs[i] = NULL;
   1002  1.1  reinoud 		}
   1003  1.1  reinoud 
   1004  1.1  reinoud 	}
   1005  1.1  reinoud 	KASSERT(buf->b_data == eccline->blob);
   1006  1.1  reinoud 	KASSERT(eccline->present == ((uint64_t) 1 << ump->packet_size)-1);
   1007  1.1  reinoud 
   1008  1.1  reinoud 	/*
   1009  1.1  reinoud 	 * XXX TODO what to do on read errors? read in all sectors
   1010  1.1  reinoud 	 * synchronously and allocate a sparable entry?
   1011  1.1  reinoud 	 */
   1012  1.1  reinoud 
   1013  1.1  reinoud 	wakeup(eccline);
   1014  1.1  reinoud 	udf_puteccline(eccline);
   1015  1.3  reinoud 	DPRINTF(ECCLINE, ("read callback finished\n"));
   1016  1.1  reinoud }
   1017  1.1  reinoud 
   1018  1.1  reinoud 
   1019  1.1  reinoud static void
   1020  1.1  reinoud udf_shedule_write_callback(struct buf *buf)
   1021  1.1  reinoud {
   1022  1.1  reinoud 	struct udf_eccline *eccline = BTOE(buf);
   1023  1.1  reinoud 	struct udf_mount *ump = eccline->ump;
   1024  1.1  reinoud 	uint64_t bit;
   1025  1.1  reinoud 	int error, i, len;
   1026  1.1  reinoud 
   1027  1.3  reinoud 	DPRINTF(ECCLINE, ("write callback called\n"));
   1028  1.1  reinoud 	/* post process write action */
   1029  1.1  reinoud 	error = buf->b_error;
   1030  1.1  reinoud 	for (i = 0; i < ump->packet_size; i++) {
   1031  1.1  reinoud 		bit = (uint64_t) 1 << i;
   1032  1.1  reinoud 		if ((eccline->dirty & bit) == 0)
   1033  1.1  reinoud 			continue;
   1034  1.1  reinoud 		if (error) {
   1035  1.1  reinoud 			eccline->error |= bit;
   1036  1.1  reinoud 		} else {
   1037  1.1  reinoud 			eccline->dirty &= ~bit;
   1038  1.1  reinoud 		}
   1039  1.1  reinoud 		if (eccline->bufs[i]) {
   1040  1.1  reinoud 			len = eccline->bufs_len[i];
   1041  1.1  reinoud 			nestiobuf_done(eccline->bufs[i], len, error);
   1042  1.1  reinoud 			eccline->bufs[i] = NULL;
   1043  1.1  reinoud 		}
   1044  1.1  reinoud 	}
   1045  1.1  reinoud 	KASSERT(eccline->dirty == 0);
   1046  1.1  reinoud 
   1047  1.1  reinoud 	KASSERT(error == 0);
   1048  1.1  reinoud 	/*
   1049  1.1  reinoud 	 * XXX TODO on write errors allocate a sparable entry
   1050  1.1  reinoud 	 */
   1051  1.1  reinoud 
   1052  1.1  reinoud 	wakeup(eccline);
   1053  1.1  reinoud 	udf_puteccline(eccline);
   1054  1.1  reinoud }
   1055  1.1  reinoud 
   1056  1.1  reinoud 
   1057  1.1  reinoud static void
   1058  1.1  reinoud udf_issue_eccline(struct udf_eccline *eccline, int queued_on)
   1059  1.1  reinoud {
   1060  1.1  reinoud 	struct udf_mount *ump = eccline->ump;
   1061  1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1062  1.1  reinoud 	struct buf *buf, *nestbuf;
   1063  1.1  reinoud 	uint64_t bit, allbits = ((uint64_t) 1 << ump->packet_size)-1;
   1064  1.1  reinoud 	uint32_t start;
   1065  1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
   1066  1.1  reinoud 	int blks = sector_size / DEV_BSIZE;
   1067  1.1  reinoud 	int i;
   1068  1.1  reinoud 
   1069  1.1  reinoud 	if (queued_on == UDF_SHED_READING) {
   1070  1.3  reinoud 		DPRINTF(SHEDULE, ("udf_issue_eccline reading : "));
   1071  1.1  reinoud 		/* read all bits that are not yet present */
   1072  1.1  reinoud 		eccline->readin = (~eccline->present) & allbits;
   1073  1.1  reinoud 		KASSERT(eccline->readin);
   1074  1.1  reinoud 		start = eccline->start_sector;
   1075  1.1  reinoud 		buf = eccline->buf;
   1076  1.1  reinoud 		buf_init(buf);
   1077  1.1  reinoud 		buf->b_flags    = B_READ | B_ASYNC;
   1078  1.4  reinoud 		SET(buf->b_cflags, BC_BUSY);	/* mark buffer busy */
   1079  1.1  reinoud 		buf->b_oflags   = 0;
   1080  1.1  reinoud 		buf->b_iodone   = udf_shedule_read_callback;
   1081  1.1  reinoud 		buf->b_data     = eccline->blob;
   1082  1.1  reinoud 		buf->b_bcount   = ump->packet_size * sector_size;
   1083  1.1  reinoud 		buf->b_resid    = buf->b_bcount;
   1084  1.1  reinoud 		buf->b_bufsize  = buf->b_bcount;
   1085  1.1  reinoud 		buf->b_private  = eccline;
   1086  1.1  reinoud 		BIO_SETPRIO(buf, BPRIO_DEFAULT);
   1087  1.1  reinoud 		buf->b_lblkno   = buf->b_blkno = buf->b_rawblkno = start * blks;
   1088  1.1  reinoud 		buf->b_proc     = NULL;
   1089  1.1  reinoud 
   1090  1.1  reinoud 		if (eccline->present != 0) {
   1091  1.1  reinoud 			for (i = 0; i < ump->packet_size; i++) {
   1092  1.1  reinoud 				bit = (uint64_t) 1 << i;
   1093  1.1  reinoud 				if (eccline->present & bit) {
   1094  1.1  reinoud 					nestiobuf_done(buf, sector_size, 0);
   1095  1.1  reinoud 					continue;
   1096  1.1  reinoud 				}
   1097  1.1  reinoud 				nestbuf = getiobuf(NULL, true);
   1098  1.1  reinoud 				nestiobuf_setup(buf, nestbuf, i * sector_size,
   1099  1.1  reinoud 					sector_size);
   1100  1.1  reinoud 				/* adjust blocknumber to read */
   1101  1.1  reinoud 				nestbuf->b_blkno = buf->b_blkno + i*blks;
   1102  1.1  reinoud 				nestbuf->b_rawblkno = buf->b_rawblkno + i*blks;
   1103  1.1  reinoud 
   1104  1.3  reinoud 				DPRINTF(SHEDULE, ("sector %d ",
   1105  1.3  reinoud 					start + i));
   1106  1.1  reinoud 				/* call asynchronous */
   1107  1.1  reinoud 				VOP_STRATEGY(ump->devvp, nestbuf);
   1108  1.1  reinoud 			}
   1109  1.3  reinoud 			DPRINTF(SHEDULE, ("\n"));
   1110  1.1  reinoud 			return;
   1111  1.1  reinoud 		}
   1112  1.1  reinoud 	} else {
   1113  1.1  reinoud 		/* write or seqwrite */
   1114  1.3  reinoud 		DPRINTF(SHEDULE, ("udf_issue_eccline writing or seqwriting : "));
   1115  1.1  reinoud 		if (eccline->present != allbits) {
   1116  1.1  reinoud 			/* requeue to read-only */
   1117  1.3  reinoud 			DPRINTF(SHEDULE, ("\n\t-> not complete, requeue to "
   1118  1.3  reinoud 				"reading\n"));
   1119  1.1  reinoud 			udf_push_eccline(eccline, UDF_SHED_READING);
   1120  1.1  reinoud 			return;
   1121  1.1  reinoud 		}
   1122  1.1  reinoud 		start = eccline->start_sector;
   1123  1.1  reinoud 		buf = eccline->buf;
   1124  1.1  reinoud 		buf_init(buf);
   1125  1.1  reinoud 		buf->b_flags    = B_WRITE | B_ASYNC;
   1126  1.4  reinoud 		SET(buf->b_cflags, BC_BUSY);	/* mark buffer busy */
   1127  1.1  reinoud 		buf->b_oflags   = 0;
   1128  1.1  reinoud 		buf->b_iodone   = udf_shedule_write_callback;
   1129  1.1  reinoud 		buf->b_data     = eccline->blob;
   1130  1.1  reinoud 		buf->b_bcount   = ump->packet_size * sector_size;
   1131  1.1  reinoud 		buf->b_resid    = buf->b_bcount;
   1132  1.1  reinoud 		buf->b_bufsize  = buf->b_bcount;
   1133  1.1  reinoud 		buf->b_private  = eccline;
   1134  1.1  reinoud 		BIO_SETPRIO(buf, BPRIO_DEFAULT);
   1135  1.1  reinoud 		buf->b_lblkno   = buf->b_blkno = buf->b_rawblkno = start * blks;
   1136  1.1  reinoud 		buf->b_proc     = NULL;
   1137  1.1  reinoud 	}
   1138  1.1  reinoud 
   1139  1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
   1140  1.1  reinoud 		/* call asynchronous */
   1141  1.3  reinoud 		DPRINTF(SHEDULE, ("sector %d for %d\n",
   1142  1.3  reinoud 			start, ump->packet_size));
   1143  1.1  reinoud 		VOP_STRATEGY(ump->devvp, buf);
   1144  1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
   1145  1.1  reinoud }
   1146  1.1  reinoud 
   1147  1.1  reinoud 
   1148  1.1  reinoud static void
   1149  1.1  reinoud udf_discstrat_thread(void *arg)
   1150  1.1  reinoud {
   1151  1.1  reinoud 	struct udf_mount *ump = (struct udf_mount *) arg;
   1152  1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1153  1.1  reinoud 	struct udf_eccline *eccline;
   1154  1.1  reinoud 	struct timespec now, *last;
   1155  1.1  reinoud 	int new_queue, wait, work;
   1156  1.1  reinoud 
   1157  1.1  reinoud 	work = 1;
   1158  1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
   1159  1.1  reinoud 	priv->num_floating = 0;
   1160  1.1  reinoud 	while (priv->run_thread || work || priv->num_floating) {
   1161  1.1  reinoud 		/* process the current selected queue */
   1162  1.1  reinoud 		/* maintenance: free exess ecclines */
   1163  1.1  reinoud 		while (priv->num_queued[UDF_SHED_FREE] > UDF_ECCLINE_MAXFREE) {
   1164  1.1  reinoud 			eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
   1165  1.1  reinoud 			KASSERT(eccline);
   1166  1.1  reinoud 			KASSERT(eccline->refcnt == 0);
   1167  1.3  reinoud 			DPRINTF(ECCLINE, ("Removing entry from free list\n"));
   1168  1.1  reinoud 			udf_dispose_eccline(eccline);
   1169  1.1  reinoud 		}
   1170  1.1  reinoud 
   1171  1.1  reinoud 		/* get our time */
   1172  1.1  reinoud 		vfs_timestamp(&now);
   1173  1.1  reinoud 		last = &priv->last_queued[priv->cur_queue];
   1174  1.1  reinoud 
   1175  1.1  reinoud 		/* don't shedule too quickly when there is only one */
   1176  1.1  reinoud 		if (priv->cur_queue == UDF_SHED_WRITING) {
   1177  1.1  reinoud 			if (priv->num_queued[priv->cur_queue] <= 2) {
   1178  1.1  reinoud 				if (now.tv_sec - last->tv_sec < 2) {
   1179  1.1  reinoud 					/* wait some time */
   1180  1.1  reinoud 					cv_timedwait(&priv->discstrat_cv,
   1181  1.1  reinoud 						&priv->discstrat_mutex, hz);
   1182  1.1  reinoud 				}
   1183  1.1  reinoud 			}
   1184  1.1  reinoud 		}
   1185  1.1  reinoud 
   1186  1.1  reinoud 		/* get our line */
   1187  1.1  reinoud 		eccline = udf_pop_eccline(priv, priv->cur_queue);
   1188  1.1  reinoud 		if (eccline) {
   1189  1.1  reinoud 			wait = 0;
   1190  1.1  reinoud 			new_queue = priv->cur_queue;
   1191  1.3  reinoud 			DPRINTF(ECCLINE, ("UDF_ISSUE_ECCLINE\n"));
   1192  1.1  reinoud 
   1193  1.1  reinoud 			/* complete the `get' by locking and refcounting it */
   1194  1.1  reinoud 			UDF_LOCK_ECCLINE(eccline);
   1195  1.1  reinoud 			eccline->refcnt++;
   1196  1.1  reinoud 
   1197  1.1  reinoud 			udf_issue_eccline(eccline, priv->cur_queue);
   1198  1.1  reinoud 		} else {
   1199  1.1  reinoud 			wait = 1;
   1200  1.1  reinoud 			/* check if we can/should switch */
   1201  1.1  reinoud 			new_queue = priv->cur_queue;
   1202  1.1  reinoud 			if (BUFQ_PEEK(priv->queues[UDF_SHED_READING]))
   1203  1.1  reinoud 				new_queue = UDF_SHED_READING;
   1204  1.1  reinoud 			if (BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]))
   1205  1.1  reinoud 				new_queue = UDF_SHED_WRITING;
   1206  1.1  reinoud 			if (BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]))
   1207  1.1  reinoud 				new_queue = UDF_SHED_SEQWRITING;
   1208  1.1  reinoud 
   1209  1.1  reinoud 			/* dont switch seqwriting too fast */
   1210  1.1  reinoud 			if (priv->cur_queue == UDF_SHED_READING) {
   1211  1.1  reinoud 				if (now.tv_sec - last->tv_sec < 1)
   1212  1.1  reinoud 					new_queue = priv->cur_queue;
   1213  1.1  reinoud 			}
   1214  1.1  reinoud 			if (priv->cur_queue == UDF_SHED_WRITING) {
   1215  1.1  reinoud 				if (now.tv_sec - last->tv_sec < 2)
   1216  1.1  reinoud 					new_queue = priv->cur_queue;
   1217  1.1  reinoud 			}
   1218  1.1  reinoud 			if (priv->cur_queue == UDF_SHED_SEQWRITING) {
   1219  1.1  reinoud 				if (now.tv_sec - last->tv_sec < 4)
   1220  1.1  reinoud 					new_queue = priv->cur_queue;
   1221  1.1  reinoud 			}
   1222  1.1  reinoud 		}
   1223  1.1  reinoud 
   1224  1.1  reinoud 		/* give room */
   1225  1.1  reinoud 		mutex_exit(&priv->discstrat_mutex);
   1226  1.1  reinoud 
   1227  1.1  reinoud 		if (new_queue != priv->cur_queue) {
   1228  1.1  reinoud 			wait = 0;
   1229  1.1  reinoud 			DPRINTF(SHEDULE, ("switching from %d to %d\n",
   1230  1.1  reinoud 				priv->cur_queue, new_queue));
   1231  1.1  reinoud 			priv->cur_queue = new_queue;
   1232  1.1  reinoud 		}
   1233  1.1  reinoud 		mutex_enter(&priv->discstrat_mutex);
   1234  1.1  reinoud 
   1235  1.1  reinoud 		/* wait for more if needed */
   1236  1.1  reinoud 		if (wait)
   1237  1.1  reinoud 			cv_timedwait(&priv->discstrat_cv,
   1238  1.1  reinoud 				&priv->discstrat_mutex, hz);	/* /8 */
   1239  1.1  reinoud 
   1240  1.1  reinoud 		work  = (BUFQ_PEEK(priv->queues[UDF_SHED_READING]) != NULL);
   1241  1.1  reinoud 		work |= (BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]) != NULL);
   1242  1.1  reinoud 		work |= (BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]) != NULL);
   1243  1.1  reinoud 
   1244  1.1  reinoud 		DPRINTF(PARANOIA, ("work : (%d, %d, %d) -> work %d, float %d\n",
   1245  1.1  reinoud 			(BUFQ_PEEK(priv->queues[UDF_SHED_READING]) != NULL),
   1246  1.1  reinoud 			(BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]) != NULL),
   1247  1.1  reinoud 			(BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]) != NULL),
   1248  1.1  reinoud 			work, priv->num_floating));
   1249  1.1  reinoud 	}
   1250  1.1  reinoud 
   1251  1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
   1252  1.1  reinoud 
   1253  1.1  reinoud 	/* tear down remaining ecclines */
   1254  1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
   1255  1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_IDLE] == 0);
   1256  1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_READING] == 0);
   1257  1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_WRITING] == 0);
   1258  1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_SEQWRITING] == 0);
   1259  1.1  reinoud 
   1260  1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_IDLE]) == NULL);
   1261  1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_READING]) == NULL);
   1262  1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]) == NULL);
   1263  1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]) == NULL);
   1264  1.1  reinoud 	eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
   1265  1.1  reinoud 	while (eccline) {
   1266  1.1  reinoud 		udf_dispose_eccline(eccline);
   1267  1.1  reinoud 		eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
   1268  1.1  reinoud 	}
   1269  1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_FREE] == 0);
   1270  1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
   1271  1.1  reinoud 
   1272  1.1  reinoud 	priv->thread_finished = 1;
   1273  1.1  reinoud 	wakeup(&priv->run_thread);
   1274  1.1  reinoud 	kthread_exit(0);
   1275  1.1  reinoud 	/* not reached */
   1276  1.1  reinoud }
   1277  1.1  reinoud 
   1278  1.1  reinoud /* --------------------------------------------------------------------- */
   1279  1.1  reinoud 
   1280  1.1  reinoud /*
   1281  1.1  reinoud  * Buffer memory pool allocator.
   1282  1.1  reinoud  */
   1283  1.1  reinoud 
   1284  1.1  reinoud static void *
   1285  1.1  reinoud ecclinepool_page_alloc(struct pool *pp, int flags)
   1286  1.1  reinoud {
   1287  1.1  reinoud         return (void *)uvm_km_alloc(kernel_map,
   1288  1.1  reinoud             MAXBSIZE, MAXBSIZE,
   1289  1.1  reinoud             ((flags & PR_WAITOK) ? 0 : UVM_KMF_NOWAIT | UVM_KMF_TRYLOCK)
   1290  1.1  reinoud 	    	| UVM_KMF_WIRED /* UVM_KMF_PAGABLE? */);
   1291  1.1  reinoud }
   1292  1.1  reinoud 
   1293  1.1  reinoud static void
   1294  1.1  reinoud ecclinepool_page_free(struct pool *pp, void *v)
   1295  1.1  reinoud {
   1296  1.1  reinoud         uvm_km_free(kernel_map, (vaddr_t)v, MAXBSIZE, UVM_KMF_WIRED);
   1297  1.1  reinoud }
   1298  1.1  reinoud 
   1299  1.1  reinoud static struct pool_allocator ecclinepool_allocator = {
   1300  1.1  reinoud         .pa_alloc = ecclinepool_page_alloc,
   1301  1.1  reinoud         .pa_free  = ecclinepool_page_free,
   1302  1.1  reinoud         .pa_pagesz = MAXBSIZE,
   1303  1.1  reinoud };
   1304  1.1  reinoud 
   1305  1.1  reinoud 
   1306  1.1  reinoud static void
   1307  1.1  reinoud udf_discstrat_init_rmw(struct udf_strat_args *args)
   1308  1.1  reinoud {
   1309  1.1  reinoud 	struct udf_mount *ump = args->ump;
   1310  1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1311  1.1  reinoud 	uint32_t lb_size, blobsize, hashline;
   1312  1.1  reinoud 	int i;
   1313  1.1  reinoud 
   1314  1.1  reinoud 	KASSERT(ump);
   1315  1.1  reinoud 	KASSERT(ump->logical_vol);
   1316  1.1  reinoud 	KASSERT(priv == NULL);
   1317  1.1  reinoud 
   1318  1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   1319  1.1  reinoud 	blobsize = ump->packet_size * lb_size;
   1320  1.1  reinoud 	KASSERT(lb_size > 0);
   1321  1.1  reinoud 	KASSERT(ump->packet_size <= 64);
   1322  1.1  reinoud 
   1323  1.1  reinoud 	/* initialise our memory space */
   1324  1.1  reinoud 	ump->strategy_private = malloc(sizeof(struct strat_private),
   1325  1.1  reinoud 		M_UDFTEMP, M_WAITOK);
   1326  1.1  reinoud 	priv = ump->strategy_private;
   1327  1.1  reinoud 	memset(priv, 0 , sizeof(struct strat_private));
   1328  1.1  reinoud 
   1329  1.1  reinoud 	/* initialise locks */
   1330  1.1  reinoud 	cv_init(&priv->discstrat_cv, "udfstrat");
   1331  1.1  reinoud 	mutex_init(&priv->discstrat_mutex, MUTEX_DRIVER, IPL_BIO);
   1332  1.1  reinoud 	mutex_init(&priv->seqwrite_mutex, MUTEX_DEFAULT, IPL_NONE);
   1333  1.1  reinoud 
   1334  1.1  reinoud 	/* initialise struct eccline pool */
   1335  1.1  reinoud 	pool_init(&priv->eccline_pool, sizeof(struct udf_eccline),
   1336  1.1  reinoud 		0, 0, 0, "udf_eccline_pool", NULL, IPL_NONE);
   1337  1.1  reinoud 
   1338  1.1  reinoud 	/* initialise eccline blob pool */
   1339  1.1  reinoud 	pool_init(&priv->ecclineblob_pool, blobsize,
   1340  1.1  reinoud 		0,0,0, "udf_eccline_blob", &ecclinepool_allocator, IPL_NONE);
   1341  1.1  reinoud 
   1342  1.1  reinoud 	/* initialise main queues */
   1343  1.1  reinoud 	for (i = 0; i < UDF_SHED_MAX; i++) {
   1344  1.1  reinoud 		priv->num_queued[i] = 0;
   1345  1.1  reinoud 		vfs_timestamp(&priv->last_queued[i]);
   1346  1.1  reinoud 	}
   1347  1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_READING], "disksort",
   1348  1.1  reinoud 		BUFQ_SORT_RAWBLOCK);
   1349  1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_WRITING], "disksort",
   1350  1.1  reinoud 		BUFQ_SORT_RAWBLOCK);
   1351  1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_SEQWRITING], "disksort", 0);
   1352  1.1  reinoud 
   1353  1.1  reinoud 	/* initialise administrative queues */
   1354  1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_IDLE], "fcfs", 0);
   1355  1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_FREE], "fcfs", 0);
   1356  1.1  reinoud 
   1357  1.1  reinoud 	for (hashline = 0; hashline < UDF_ECCBUF_HASHSIZE; hashline++) {
   1358  1.1  reinoud 		LIST_INIT(&priv->eccline_hash[hashline]);
   1359  1.1  reinoud 	}
   1360  1.1  reinoud 
   1361  1.1  reinoud 	/* create our disk strategy thread */
   1362  1.1  reinoud 	priv->cur_queue = UDF_SHED_READING;
   1363  1.1  reinoud 	priv->thread_finished = 0;
   1364  1.1  reinoud 	priv->run_thread      = 1;
   1365  1.1  reinoud 	if (kthread_create(PRI_NONE, 0 /* KTHREAD_MPSAFE*/, NULL /* cpu_info*/,
   1366  1.1  reinoud 		udf_discstrat_thread, ump, &priv->queue_lwp,
   1367  1.1  reinoud 		"%s", "udf_rw")) {
   1368  1.1  reinoud 		panic("fork udf_rw");
   1369  1.1  reinoud 	}
   1370  1.1  reinoud }
   1371  1.1  reinoud 
   1372  1.1  reinoud 
   1373  1.1  reinoud static void
   1374  1.1  reinoud udf_discstrat_finish_rmw(struct udf_strat_args *args)
   1375  1.1  reinoud {
   1376  1.1  reinoud 	struct udf_mount *ump = args->ump;
   1377  1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1378  1.1  reinoud 	int error;
   1379  1.1  reinoud 
   1380  1.1  reinoud 	if (ump == NULL)
   1381  1.1  reinoud 		return;
   1382  1.1  reinoud 
   1383  1.1  reinoud 	/* stop our sheduling thread */
   1384  1.1  reinoud 	KASSERT(priv->run_thread == 1);
   1385  1.1  reinoud 	priv->run_thread = 0;
   1386  1.1  reinoud 	wakeup(priv->queue_lwp);
   1387  1.1  reinoud 	while (!priv->thread_finished) {
   1388  1.1  reinoud 		error = tsleep(&priv->run_thread, PRIBIO+1,
   1389  1.1  reinoud 			"udfshedfin", hz);
   1390  1.1  reinoud 	}
   1391  1.1  reinoud 	/* kthread should be finished now */
   1392  1.1  reinoud 
   1393  1.1  reinoud 	/* cleanup our pools */
   1394  1.1  reinoud 	pool_destroy(&priv->eccline_pool);
   1395  1.1  reinoud 	pool_destroy(&priv->ecclineblob_pool);
   1396  1.1  reinoud 
   1397  1.1  reinoud 	cv_destroy(&priv->discstrat_cv);
   1398  1.1  reinoud 	mutex_destroy(&priv->discstrat_mutex);
   1399  1.1  reinoud 	mutex_destroy(&priv->seqwrite_mutex);
   1400  1.1  reinoud 
   1401  1.1  reinoud 	/* free our private space */
   1402  1.1  reinoud 	free(ump->strategy_private, M_UDFTEMP);
   1403  1.1  reinoud 	ump->strategy_private = NULL;
   1404  1.1  reinoud }
   1405  1.1  reinoud 
   1406  1.1  reinoud /* --------------------------------------------------------------------- */
   1407  1.1  reinoud 
   1408  1.1  reinoud struct udf_strategy udf_strat_rmw =
   1409  1.1  reinoud {
   1410  1.5  reinoud 	udf_create_nodedscr_rmw,
   1411  1.5  reinoud 	udf_free_nodedscr_rmw,
   1412  1.5  reinoud 	udf_read_nodedscr_rmw,
   1413  1.5  reinoud 	udf_write_nodedscr_rmw,
   1414  1.1  reinoud 	udf_queuebuf_rmw,
   1415  1.1  reinoud 	udf_discstrat_init_rmw,
   1416  1.1  reinoud 	udf_discstrat_finish_rmw
   1417  1.1  reinoud };
   1418  1.1  reinoud 
   1419