Home | History | Annotate | Line # | Download | only in udf
udf_strat_rmw.c revision 1.12
      1  1.12  reinoud /* $NetBSD: udf_strat_rmw.c,v 1.12 2008/11/15 18:26:50 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.12  reinoud __KERNEL_RCSID(0, "$NetBSD: udf_strat_rmw.c,v 1.12 2008/11/15 18:26:50 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 #include "udf.h"
     66   1.1  reinoud #include "udf_subr.h"
     67   1.1  reinoud #include "udf_bswap.h"
     68   1.1  reinoud 
     69   1.1  reinoud 
     70   1.1  reinoud #define VTOI(vnode) ((struct udf_node *) (vnode)->v_data)
     71   1.1  reinoud #define PRIV(ump) ((struct strat_private *) (ump)->strategy_private)
     72   1.1  reinoud #define BTOE(buf) ((struct udf_eccline *) ((buf)->b_private))
     73   1.1  reinoud 
     74   1.1  reinoud /* --------------------------------------------------------------------- */
     75   1.1  reinoud 
     76   1.1  reinoud #define UDF_MAX_PACKET_SIZE	64			/* DONT change this */
     77   1.1  reinoud 
     78   1.1  reinoud /* sheduler states */
     79  1.11  reinoud #define UDF_SHED_WAITING	1			/* waiting on timeout */
     80  1.11  reinoud #define UDF_SHED_READING	2
     81  1.11  reinoud #define UDF_SHED_WRITING	3
     82  1.11  reinoud #define UDF_SHED_SEQWRITING	4
     83  1.11  reinoud #define UDF_SHED_IDLE		5			/* resting */
     84  1.11  reinoud #define UDF_SHED_FREE		6			/* recycleable */
     85  1.11  reinoud #define UDF_SHED_MAX		6+1
     86   1.1  reinoud 
     87   1.1  reinoud /* flags */
     88   1.1  reinoud #define ECC_LOCKED		0x01			/* prevent access   */
     89   1.1  reinoud #define ECC_WANTED		0x02			/* trying access    */
     90   1.1  reinoud #define ECC_SEQWRITING		0x04			/* sequential queue */
     91   1.1  reinoud #define ECC_FLOATING		0x08			/* not queued yet   */
     92   1.1  reinoud 
     93  1.11  reinoud #define ECC_WAITTIME		5
     94  1.11  reinoud 
     95   1.1  reinoud 
     96   1.1  reinoud TAILQ_HEAD(ecclineq, udf_eccline);
     97   1.1  reinoud struct udf_eccline {
     98   1.1  reinoud 	struct udf_mount	 *ump;
     99   1.1  reinoud 	uint64_t		  present;		/* preserve these */
    100   1.1  reinoud 	uint64_t		  readin;		/* bitmap */
    101   1.1  reinoud 	uint64_t		  dirty;		/* bitmap */
    102   1.1  reinoud 	uint64_t		  error;		/* bitmap */
    103   1.1  reinoud 	uint32_t		  refcnt;
    104   1.1  reinoud 
    105  1.11  reinoud 	struct timespec		  wait_time;
    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.10  reinoud 	/* set buffer block numbers to make sure its queued correctly */
    276  1.10  reinoud 	eccline->buf->b_lblkno   = eccline->start_sector;
    277  1.10  reinoud 	eccline->buf->b_blkno    = eccline->start_sector;
    278  1.10  reinoud 	eccline->buf->b_rawblkno = eccline->start_sector;
    279  1.10  reinoud 
    280   1.1  reinoud 	BUFQ_PUT(priv->queues[newqueue], eccline->buf);
    281   1.1  reinoud 	eccline->queued_on = newqueue;
    282   1.1  reinoud 	priv->num_queued[newqueue]++;
    283   1.1  reinoud 	vfs_timestamp(&priv->last_queued[newqueue]);
    284   1.1  reinoud 
    285   1.1  reinoud 	if (eccline->flags & ECC_FLOATING) {
    286   1.1  reinoud 		eccline->flags &= ~ECC_FLOATING;
    287   1.1  reinoud 		priv->num_floating--;
    288   1.1  reinoud 	}
    289   1.1  reinoud 
    290   1.1  reinoud 	if ((newqueue != UDF_SHED_FREE) && (newqueue != UDF_SHED_IDLE))
    291   1.1  reinoud 		cv_signal(&priv->discstrat_cv);
    292   1.1  reinoud }
    293   1.1  reinoud 
    294   1.1  reinoud 
    295   1.1  reinoud static struct udf_eccline *
    296   1.1  reinoud udf_pop_eccline(struct strat_private *priv, int queued_on)
    297   1.1  reinoud {
    298   1.1  reinoud 	struct udf_eccline *eccline;
    299   1.1  reinoud 	struct buf *buf;
    300   1.1  reinoud 
    301   1.1  reinoud 	KASSERT(mutex_owned(&priv->discstrat_mutex));
    302   1.1  reinoud 
    303   1.1  reinoud 	buf = BUFQ_GET(priv->queues[queued_on]);
    304   1.1  reinoud 	if (!buf) {
    305   1.1  reinoud 		KASSERT(priv->num_queued[queued_on] == 0);
    306   1.1  reinoud 		return NULL;
    307   1.1  reinoud 	}
    308   1.1  reinoud 
    309   1.1  reinoud 	eccline = BTOE(buf);
    310   1.1  reinoud 	KASSERT(eccline->queued_on == queued_on);
    311   1.1  reinoud 	eccline->queued_on = 0;
    312   1.1  reinoud 	priv->num_queued[queued_on]--;
    313   1.1  reinoud 
    314   1.1  reinoud 	if (eccline->flags & ECC_FLOATING)
    315   1.1  reinoud 		panic("popping already marked floating eccline");
    316   1.1  reinoud 	eccline->flags |= ECC_FLOATING;
    317   1.1  reinoud 	priv->num_floating++;
    318   1.1  reinoud 
    319   1.1  reinoud 	DPRINTF(PARANOIA, ("DEBUG: buf %p popped from queue %d\n",
    320   1.1  reinoud 		eccline->buf, queued_on));
    321   1.1  reinoud 
    322   1.1  reinoud 	return eccline;
    323   1.1  reinoud }
    324   1.1  reinoud 
    325   1.1  reinoud 
    326   1.1  reinoud static struct udf_eccline *
    327   1.1  reinoud udf_geteccline(struct udf_mount *ump, uint32_t sector, int flags)
    328   1.1  reinoud {
    329   1.1  reinoud 	struct strat_private *priv = PRIV(ump);
    330   1.1  reinoud 	struct udf_eccline *eccline;
    331   1.1  reinoud 	uint32_t start_sector, lb_size, blobsize;
    332   1.1  reinoud 	uint8_t *eccline_blob;
    333   1.1  reinoud 	int line, line_offset;
    334   1.1  reinoud 	int num_busy, ret;
    335   1.1  reinoud 
    336   1.1  reinoud 	line_offset  = sector % ump->packet_size;
    337   1.1  reinoud 	start_sector = sector - line_offset;
    338   1.1  reinoud 	line = (start_sector/ump->packet_size) & UDF_ECCBUF_HASHMASK;
    339   1.1  reinoud 
    340   1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
    341   1.1  reinoud 
    342   1.1  reinoud retry:
    343   1.3  reinoud 	DPRINTF(ECCLINE, ("get line sector %d, line %d\n", sector, line));
    344   1.1  reinoud 	LIST_FOREACH(eccline, &priv->eccline_hash[line], hashchain) {
    345   1.1  reinoud 		if (eccline->start_sector == start_sector) {
    346   1.3  reinoud 			DPRINTF(ECCLINE, ("\tfound eccline, start_sector %d\n",
    347   1.1  reinoud 				eccline->start_sector));
    348   1.1  reinoud 
    349   1.1  reinoud 			UDF_LOCK_ECCLINE(eccline);
    350   1.1  reinoud 			/* move from freelist (!) */
    351   1.1  reinoud 			if (eccline->queued_on == UDF_SHED_FREE) {
    352   1.3  reinoud 				DPRINTF(ECCLINE, ("was on freelist\n"));
    353   1.1  reinoud 				KASSERT(eccline->refcnt == 0);
    354   1.1  reinoud 				udf_push_eccline(eccline, UDF_SHED_IDLE);
    355   1.1  reinoud 			}
    356   1.1  reinoud 			eccline->refcnt++;
    357   1.1  reinoud 			mutex_exit(&priv->discstrat_mutex);
    358   1.1  reinoud 			return eccline;
    359   1.1  reinoud 		}
    360   1.1  reinoud 	}
    361   1.1  reinoud 
    362   1.3  reinoud 	DPRINTF(ECCLINE, ("\tnot found in eccline cache\n"));
    363   1.1  reinoud 	/* not found in eccline cache */
    364   1.1  reinoud 
    365   1.1  reinoud 	lb_size  = udf_rw32(ump->logical_vol->lb_size);
    366   1.1  reinoud 	blobsize = ump->packet_size * lb_size;
    367   1.1  reinoud 
    368   1.1  reinoud 	/* dont allow too many pending requests */
    369   1.3  reinoud 	DPRINTF(ECCLINE, ("\tallocating new eccline\n"));
    370   1.1  reinoud 	num_busy = (priv->num_queued[UDF_SHED_SEQWRITING] + priv->num_floating);
    371   1.1  reinoud 	if ((flags & ECC_SEQWRITING) && (num_busy > UDF_ECCLINE_MAXBUSY)) {
    372   1.1  reinoud 		ret = cv_timedwait(&priv->discstrat_cv,
    373   1.1  reinoud 			&priv->discstrat_mutex, hz/8);
    374   1.1  reinoud 		goto retry;
    375   1.1  reinoud 	}
    376   1.1  reinoud 
    377   1.1  reinoud 	eccline_blob = pool_get(&priv->ecclineblob_pool, PR_NOWAIT);
    378   1.1  reinoud 	eccline = pool_get(&priv->eccline_pool, PR_NOWAIT);
    379   1.1  reinoud 	if ((eccline_blob == NULL) || (eccline == NULL)) {
    380   1.1  reinoud 		if (eccline_blob)
    381   1.1  reinoud 			pool_put(&priv->ecclineblob_pool, eccline_blob);
    382   1.1  reinoud 		if (eccline)
    383   1.1  reinoud 			pool_put(&priv->eccline_pool, eccline);
    384   1.1  reinoud 
    385   1.1  reinoud 		/* out of memory for now; canibalise freelist */
    386   1.1  reinoud 		eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
    387   1.1  reinoud 		if (eccline == NULL) {
    388   1.1  reinoud 			/* serious trouble; wait and retry */
    389   1.1  reinoud 			cv_timedwait(&priv->discstrat_cv,
    390   1.1  reinoud 				&priv->discstrat_mutex, hz/8);
    391   1.1  reinoud 			goto retry;
    392   1.1  reinoud 		}
    393   1.1  reinoud 		/* push back line if we're waiting for it */
    394   1.1  reinoud 		if (eccline->flags & ECC_WANTED) {
    395   1.1  reinoud 			udf_push_eccline(eccline, UDF_SHED_IDLE);
    396   1.1  reinoud 			goto retry;
    397   1.1  reinoud 		}
    398   1.1  reinoud 
    399   1.1  reinoud 		/* unlink this entry */
    400   1.1  reinoud 		LIST_REMOVE(eccline, hashchain);
    401   1.1  reinoud 
    402   1.1  reinoud 		KASSERT(eccline->flags & ECC_FLOATING);
    403   1.1  reinoud 
    404   1.1  reinoud 		eccline_blob = eccline->blob;
    405   1.1  reinoud 		memset(eccline, 0, sizeof(struct udf_eccline));
    406   1.1  reinoud 		eccline->flags = ECC_FLOATING;
    407   1.1  reinoud 	} else {
    408   1.1  reinoud 		memset(eccline, 0, sizeof(struct udf_eccline));
    409   1.1  reinoud 		eccline->flags = ECC_FLOATING;
    410   1.1  reinoud 		priv->num_floating++;
    411   1.1  reinoud 	}
    412   1.1  reinoud 
    413   1.1  reinoud 	eccline->queued_on = 0;
    414   1.1  reinoud 	eccline->blob = eccline_blob;
    415   1.1  reinoud 	eccline->buf  = getiobuf(NULL, true);
    416   1.1  reinoud 	eccline->buf->b_private = eccline;	/* IMPORTANT */
    417   1.1  reinoud 
    418   1.1  reinoud 	/* initialise eccline blob */
    419   1.1  reinoud 	memset(eccline->blob, 0, blobsize);
    420   1.1  reinoud 
    421   1.1  reinoud 	eccline->ump = ump;
    422   1.1  reinoud 	eccline->present = eccline->readin = eccline->dirty = 0;
    423   1.1  reinoud 	eccline->error = 0;
    424   1.1  reinoud 	eccline->refcnt = 0;
    425  1.10  reinoud 
    426  1.10  reinoud 	eccline->start_sector    = start_sector;
    427  1.10  reinoud 	eccline->buf->b_lblkno   = start_sector;
    428  1.10  reinoud 	eccline->buf->b_blkno    = start_sector;
    429  1.10  reinoud 	eccline->buf->b_rawblkno = start_sector;
    430   1.1  reinoud 
    431   1.1  reinoud 	LIST_INSERT_HEAD(&priv->eccline_hash[line], eccline, hashchain);
    432   1.1  reinoud 
    433   1.1  reinoud 	/*
    434   1.1  reinoud 	 * TODO possible optimalisation for checking overlap with partitions
    435   1.1  reinoud 	 * to get a clue on future eccline usage
    436   1.1  reinoud 	 */
    437   1.1  reinoud 	eccline->refcnt++;
    438   1.1  reinoud 	UDF_LOCK_ECCLINE(eccline);
    439   1.1  reinoud 
    440   1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
    441   1.1  reinoud 
    442   1.1  reinoud 	return eccline;
    443   1.1  reinoud }
    444   1.1  reinoud 
    445   1.1  reinoud 
    446   1.1  reinoud static void
    447   1.1  reinoud udf_puteccline(struct udf_eccline *eccline)
    448   1.1  reinoud {
    449   1.1  reinoud 	struct strat_private *priv = PRIV(eccline->ump);
    450   1.1  reinoud 	struct udf_mount *ump = eccline->ump;
    451   1.1  reinoud 	uint64_t allbits = ((uint64_t) 1 << ump->packet_size)-1;
    452   1.1  reinoud 
    453   1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
    454   1.1  reinoud 
    455   1.1  reinoud 	/* clear directly all readin requests from present ones */
    456   1.1  reinoud 	if (eccline->readin & eccline->present) {
    457   1.1  reinoud 		/* clear all read bits that are already read in */
    458   1.1  reinoud 		eccline->readin &= (~eccline->present) & allbits;
    459   1.1  reinoud 		wakeup(eccline);
    460   1.1  reinoud 	}
    461   1.1  reinoud 
    462   1.3  reinoud 	DPRINTF(ECCLINE, ("put eccline start sector %d, refcnt %d\n",
    463   1.1  reinoud 		eccline->start_sector, eccline->refcnt));
    464   1.1  reinoud 
    465  1.11  reinoud 	/* if we have active nodes we dont set it on seqwriting */
    466   1.1  reinoud 	if (eccline->refcnt > 1)
    467   1.1  reinoud 		eccline->flags &= ~ECC_SEQWRITING;
    468   1.1  reinoud 
    469  1.11  reinoud 	vfs_timestamp(&eccline->wait_time);
    470  1.11  reinoud 	eccline->wait_time.tv_sec += ECC_WAITTIME;
    471  1.11  reinoud 	udf_push_eccline(eccline, UDF_SHED_WAITING);
    472   1.1  reinoud 
    473   1.1  reinoud 	KASSERT(eccline->refcnt >= 1);
    474   1.1  reinoud 	eccline->refcnt--;
    475   1.1  reinoud 	UDF_UNLOCK_ECCLINE(eccline);
    476   1.1  reinoud 
    477   1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
    478   1.1  reinoud }
    479   1.1  reinoud 
    480   1.1  reinoud /* --------------------------------------------------------------------- */
    481   1.1  reinoud 
    482   1.1  reinoud static int
    483   1.5  reinoud udf_create_nodedscr_rmw(struct udf_strat_args *args)
    484   1.1  reinoud {
    485   1.1  reinoud 	union dscrptr   **dscrptr  = &args->dscr;
    486   1.1  reinoud 	struct udf_mount *ump      = args->ump;
    487   1.1  reinoud 	struct long_ad   *icb      = args->icb;
    488   1.1  reinoud 	struct udf_eccline *eccline;
    489   1.1  reinoud 	uint64_t bit;
    490   1.1  reinoud 	uint32_t sectornr, lb_size, dummy;
    491   1.1  reinoud 	uint8_t *mem;
    492   1.1  reinoud 	int error, eccsect;
    493   1.1  reinoud 
    494   1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    495   1.1  reinoud 	if (error)
    496   1.1  reinoud 		return error;
    497   1.1  reinoud 
    498   1.1  reinoud 	lb_size  = udf_rw32(ump->logical_vol->lb_size);
    499   1.1  reinoud 
    500   1.1  reinoud 	/* get our eccline */
    501   1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    502   1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    503   1.1  reinoud 
    504   1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    505   1.1  reinoud 	eccline->readin  &= ~bit;	/* just in case */
    506   1.1  reinoud 	eccline->present |=  bit;
    507   1.1  reinoud 	eccline->dirty   &= ~bit;	/* Err... euhm... clean? */
    508   1.1  reinoud 
    509   1.1  reinoud 	eccline->refcnt++;
    510   1.1  reinoud 
    511   1.1  reinoud 	/* clear space */
    512   1.1  reinoud 	mem = ((uint8_t *) eccline->blob) + eccsect * lb_size;
    513   1.1  reinoud 	memset(mem, 0, lb_size);
    514   1.1  reinoud 
    515   1.1  reinoud 	udf_puteccline(eccline);
    516   1.1  reinoud 
    517   1.1  reinoud 	*dscrptr = (union dscrptr *) mem;
    518   1.1  reinoud 	return 0;
    519   1.1  reinoud }
    520   1.1  reinoud 
    521   1.1  reinoud 
    522   1.1  reinoud static void
    523   1.5  reinoud udf_free_nodedscr_rmw(struct udf_strat_args *args)
    524   1.1  reinoud {
    525   1.1  reinoud 	struct udf_mount *ump  = args->ump;
    526   1.1  reinoud 	struct long_ad   *icb  = args->icb;
    527   1.1  reinoud 	struct udf_eccline *eccline;
    528   1.1  reinoud 	uint64_t bit;
    529   1.1  reinoud 	uint32_t sectornr, dummy;
    530   1.1  reinoud 	int error, eccsect;
    531   1.1  reinoud 
    532   1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    533   1.1  reinoud 	if (error)
    534   1.1  reinoud 		return;
    535   1.1  reinoud 
    536   1.1  reinoud 	/* get our eccline */
    537   1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    538   1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    539   1.1  reinoud 
    540   1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    541   1.1  reinoud 	eccline->readin &= ~bit;	/* just in case */
    542   1.1  reinoud 
    543   1.1  reinoud 	KASSERT(eccline->refcnt >= 1);
    544   1.1  reinoud 	eccline->refcnt--;
    545   1.1  reinoud 
    546   1.1  reinoud 	udf_puteccline(eccline);
    547   1.1  reinoud }
    548   1.1  reinoud 
    549   1.1  reinoud 
    550   1.1  reinoud static int
    551   1.5  reinoud udf_read_nodedscr_rmw(struct udf_strat_args *args)
    552   1.1  reinoud {
    553   1.1  reinoud 	union dscrptr   **dscrptr = &args->dscr;
    554   1.1  reinoud 	struct udf_mount *ump = args->ump;
    555   1.1  reinoud 	struct long_ad   *icb = args->icb;
    556   1.1  reinoud 	struct udf_eccline *eccline;
    557   1.1  reinoud 	uint64_t bit;
    558   1.1  reinoud 	uint32_t sectornr, dummy;
    559   1.1  reinoud 	uint8_t *pos;
    560   1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    561   1.1  reinoud 	int lb_size = udf_rw32(ump->logical_vol->lb_size);
    562   1.1  reinoud 	int i, error, dscrlen, eccsect;
    563   1.1  reinoud 
    564   1.1  reinoud 	lb_size = lb_size;
    565   1.1  reinoud 	KASSERT(sector_size == lb_size);
    566   1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    567   1.1  reinoud 	if (error)
    568   1.1  reinoud 		return error;
    569   1.1  reinoud 
    570   1.1  reinoud 	/* get our eccline */
    571   1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    572   1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    573   1.1  reinoud 
    574   1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    575   1.1  reinoud 	if ((eccline->present & bit) == 0) {
    576   1.1  reinoud 		/* mark bit for readin */
    577   1.1  reinoud 		eccline->readin |= bit;
    578   1.1  reinoud 		eccline->refcnt++;	/* prevent recycling */
    579   1.1  reinoud 		KASSERT(eccline->bufs[eccsect] == NULL);
    580   1.1  reinoud 		udf_puteccline(eccline);
    581   1.1  reinoud 
    582   1.1  reinoud 		/* wait for completion; XXX remodel to lock bit code */
    583   1.1  reinoud 		error = 0;
    584   1.1  reinoud 		while ((eccline->present & bit) == 0) {
    585   1.1  reinoud 			tsleep(eccline, PRIBIO+1, "udflvdrd", hz/8);
    586   1.1  reinoud 			if (eccline->error & bit) {
    587   1.1  reinoud 				KASSERT(eccline->refcnt >= 1);
    588   1.1  reinoud 				eccline->refcnt--;	/* undo temp refcnt */
    589   1.1  reinoud 				*dscrptr = NULL;
    590   1.1  reinoud 				return EIO;		/* XXX error code */
    591   1.1  reinoud 			}
    592   1.1  reinoud 		}
    593   1.1  reinoud 
    594   1.1  reinoud 		/* reget our line */
    595   1.1  reinoud 		eccline = udf_geteccline(ump, sectornr, 0);
    596   1.1  reinoud 		KASSERT(eccline->refcnt >= 1);
    597   1.1  reinoud 		eccline->refcnt--;	/* undo refcnt */
    598   1.1  reinoud 	}
    599   1.1  reinoud 
    600   1.1  reinoud 	*dscrptr = (union dscrptr *)
    601   1.1  reinoud 		(((uint8_t *) eccline->blob) + eccsect * sector_size);
    602   1.1  reinoud 
    603   1.1  reinoud 	/* code from read_phys_descr */
    604   1.1  reinoud 	/* check if its a valid tag */
    605   1.1  reinoud 	error = udf_check_tag(*dscrptr);
    606   1.1  reinoud 	if (error) {
    607   1.1  reinoud 		/* check if its an empty block */
    608   1.1  reinoud 		pos = (uint8_t *) *dscrptr;
    609   1.1  reinoud 		for (i = 0; i < sector_size; i++, pos++) {
    610   1.1  reinoud 			if (*pos) break;
    611   1.1  reinoud 		}
    612   1.1  reinoud 		if (i == sector_size) {
    613   1.1  reinoud 			/* return no error but with no dscrptr */
    614   1.1  reinoud 			error = 0;
    615   1.1  reinoud 		}
    616   1.1  reinoud 		*dscrptr = NULL;
    617   1.1  reinoud 		udf_puteccline(eccline);
    618   1.1  reinoud 		return error;
    619   1.1  reinoud 	}
    620   1.1  reinoud 
    621   1.1  reinoud 	/* calculate descriptor size */
    622   1.1  reinoud 	dscrlen = udf_tagsize(*dscrptr, sector_size);
    623   1.1  reinoud 	error = udf_check_tag_payload(*dscrptr, dscrlen);
    624   1.1  reinoud 	if (error) {
    625   1.1  reinoud 		*dscrptr = NULL;
    626   1.1  reinoud 		udf_puteccline(eccline);
    627   1.1  reinoud 		return error;
    628   1.1  reinoud 	}
    629   1.1  reinoud 
    630   1.1  reinoud 	eccline->refcnt++;
    631   1.1  reinoud 	udf_puteccline(eccline);
    632   1.1  reinoud 
    633   1.1  reinoud 	return 0;
    634   1.1  reinoud }
    635   1.1  reinoud 
    636   1.1  reinoud 
    637   1.1  reinoud static int
    638   1.5  reinoud udf_write_nodedscr_rmw(struct udf_strat_args *args)
    639   1.1  reinoud {
    640   1.1  reinoud 	union dscrptr    *dscrptr = args->dscr;
    641   1.1  reinoud 	struct udf_mount *ump = args->ump;
    642   1.1  reinoud 	struct long_ad   *icb = args->icb;
    643   1.1  reinoud 	struct udf_node *udf_node = args->udf_node;
    644   1.1  reinoud 	struct udf_eccline *eccline;
    645   1.1  reinoud 	uint64_t bit;
    646   1.1  reinoud 	uint32_t sectornr, logsectornr, dummy;
    647   1.1  reinoud 	// int waitfor  = args->waitfor;
    648   1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    649   1.1  reinoud 	int lb_size = udf_rw32(ump->logical_vol->lb_size);
    650   1.1  reinoud 	int error, eccsect;
    651   1.1  reinoud 
    652   1.1  reinoud 	lb_size = lb_size;
    653   1.1  reinoud 	KASSERT(sector_size == lb_size);
    654   1.1  reinoud 	sectornr    = 0;
    655   1.1  reinoud 	error = udf_translate_vtop(ump, icb, &sectornr, &dummy);
    656   1.1  reinoud 	if (error)
    657   1.1  reinoud 		return error;
    658   1.1  reinoud 
    659   1.5  reinoud 	/* add reference to the vnode to prevent recycling */
    660   1.5  reinoud 	vhold(udf_node->vnode);
    661   1.5  reinoud 
    662   1.1  reinoud 	/* get our eccline */
    663   1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, 0);
    664   1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    665   1.1  reinoud 
    666   1.1  reinoud 	bit = (uint64_t) 1 << eccsect;
    667   1.1  reinoud 
    668   1.1  reinoud 	/* old callback still pending? */
    669   1.1  reinoud 	if (eccline->bufs[eccsect]) {
    670   1.5  reinoud 		DPRINTF(WRITE, ("udf_write_nodedscr_rmw: writing descriptor"
    671   1.1  reinoud 					" over buffer?\n"));
    672   1.1  reinoud 		nestiobuf_done(eccline->bufs[eccsect],
    673   1.1  reinoud 				eccline->bufs_len[eccsect],
    674   1.1  reinoud 				0);
    675   1.1  reinoud 		eccline->bufs[eccsect] = NULL;
    676   1.1  reinoud 	}
    677   1.1  reinoud 
    678   1.1  reinoud 	/* set sector number in the descriptor and validate */
    679   1.1  reinoud 	dscrptr = (union dscrptr *)
    680   1.1  reinoud 		(((uint8_t *) eccline->blob) + eccsect * sector_size);
    681   1.1  reinoud 	KASSERT(dscrptr == args->dscr);
    682   1.1  reinoud 
    683   1.1  reinoud 	logsectornr = udf_rw32(icb->loc.lb_num);
    684   1.1  reinoud 	dscrptr->tag.tag_loc = udf_rw32(logsectornr);
    685   1.1  reinoud 	udf_validate_tag_and_crc_sums(dscrptr);
    686   1.1  reinoud 
    687   1.1  reinoud 	udf_fixup_node_internals(ump, (uint8_t *) dscrptr, UDF_C_NODE);
    688   1.1  reinoud 
    689   1.1  reinoud 	/* set our flags */
    690   1.1  reinoud 	KASSERT(eccline->present & bit);
    691   1.1  reinoud 	eccline->dirty |= bit;
    692   1.1  reinoud 
    693   1.1  reinoud 	KASSERT(udf_tagsize(dscrptr, sector_size) <= sector_size);
    694   1.1  reinoud 
    695   1.1  reinoud 	udf_puteccline(eccline);
    696   1.1  reinoud 
    697   1.5  reinoud 	holdrele(udf_node->vnode);
    698   1.5  reinoud 	udf_node->outstanding_nodedscr--;
    699   1.5  reinoud 	if (udf_node->outstanding_nodedscr == 0) {
    700   1.5  reinoud 		UDF_UNLOCK_NODE(udf_node, udf_node->i_flags & IN_CALLBACK_ULK);
    701   1.5  reinoud 		wakeup(&udf_node->outstanding_nodedscr);
    702   1.5  reinoud 	}
    703   1.5  reinoud 
    704   1.1  reinoud 	/* XXX waitfor not used */
    705   1.1  reinoud 	return 0;
    706   1.1  reinoud }
    707   1.1  reinoud 
    708   1.1  reinoud 
    709   1.1  reinoud static void
    710   1.1  reinoud udf_queuebuf_rmw(struct udf_strat_args *args)
    711   1.1  reinoud {
    712   1.1  reinoud 	struct udf_mount *ump = args->ump;
    713   1.1  reinoud 	struct buf *buf = args->nestbuf;
    714   1.6  reinoud 	struct desc_tag *tag;
    715   1.1  reinoud 	struct strat_private *priv = PRIV(ump);
    716   1.1  reinoud 	struct udf_eccline *eccline;
    717   1.1  reinoud 	struct long_ad *node_ad_cpy;
    718   1.1  reinoud 	uint64_t bit, *lmapping, *pmapping, *lmappos, *pmappos, blknr;
    719   1.6  reinoud 	uint32_t buf_len, len, sectors, sectornr, our_sectornr;
    720   1.1  reinoud 	uint32_t bpos;
    721   1.6  reinoud 	uint16_t vpart_num;
    722   1.1  reinoud 	uint8_t *fidblk, *src, *dst;
    723   1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    724   1.1  reinoud 	int blks = sector_size / DEV_BSIZE;
    725   1.1  reinoud 	int eccsect, what, queue, error;
    726   1.1  reinoud 
    727   1.1  reinoud 	KASSERT(ump);
    728   1.1  reinoud 	KASSERT(buf);
    729   1.1  reinoud 	KASSERT(buf->b_iodone == nestiobuf_iodone);
    730   1.1  reinoud 
    731   1.1  reinoud 	blknr        = buf->b_blkno;
    732   1.1  reinoud 	our_sectornr = blknr / blks;
    733   1.1  reinoud 
    734   1.1  reinoud 	what = buf->b_udf_c_type;
    735   1.1  reinoud 	queue = UDF_SHED_READING;
    736   1.1  reinoud 	if ((buf->b_flags & B_READ) == 0) {
    737   1.1  reinoud 		/* writing */
    738   1.1  reinoud 		queue = UDF_SHED_SEQWRITING;
    739   1.1  reinoud 		if (what == UDF_C_DSCR)
    740   1.1  reinoud 			queue = UDF_SHED_WRITING;
    741   1.1  reinoud 		if (what == UDF_C_NODE)
    742   1.1  reinoud 			queue = UDF_SHED_WRITING;
    743   1.1  reinoud 	}
    744   1.1  reinoud 
    745   1.1  reinoud 	if (queue == UDF_SHED_READING) {
    746   1.3  reinoud 		DPRINTF(SHEDULE, ("\nudf_queuebuf_rmw READ %p : sector %d type %d,"
    747   1.1  reinoud 			"b_resid %d, b_bcount %d, b_bufsize %d\n",
    748   1.1  reinoud 			buf, (uint32_t) buf->b_blkno / blks, buf->b_udf_c_type,
    749   1.1  reinoud 			buf->b_resid, buf->b_bcount, buf->b_bufsize));
    750   1.1  reinoud 
    751   1.1  reinoud 		/* mark bits for reading */
    752   1.1  reinoud 		buf_len = buf->b_bcount;
    753   1.1  reinoud 		sectornr = our_sectornr;
    754   1.1  reinoud 		eccline = udf_geteccline(ump, sectornr, 0);
    755   1.1  reinoud 		eccsect = sectornr - eccline->start_sector;
    756   1.1  reinoud 		bpos = 0;
    757   1.1  reinoud 		while (buf_len) {
    758   1.1  reinoud 			len = MIN(buf_len, sector_size);
    759   1.1  reinoud 			if (eccsect == ump->packet_size) {
    760   1.1  reinoud 				udf_puteccline(eccline);
    761   1.1  reinoud 				eccline = udf_geteccline(ump, sectornr, 0);
    762   1.1  reinoud 				eccsect = sectornr - eccline->start_sector;
    763   1.1  reinoud 			}
    764   1.1  reinoud 			bit = (uint64_t) 1 << eccsect;
    765   1.1  reinoud 			error = eccline->error & bit ? EIO : 0;
    766   1.1  reinoud 			if (eccline->present & bit) {
    767   1.1  reinoud 				src = (uint8_t *) eccline->blob +
    768   1.1  reinoud 					eccsect * sector_size;
    769   1.1  reinoud 				dst = (uint8_t *) buf->b_data + bpos;
    770   1.1  reinoud 				if (!error)
    771   1.1  reinoud 					memcpy(dst, src, len);
    772   1.1  reinoud 				nestiobuf_done(buf, len, error);
    773   1.1  reinoud 			} else {
    774   1.1  reinoud 				eccline->readin |= bit;
    775   1.1  reinoud 				KASSERT(eccline->bufs[eccsect] == NULL);
    776   1.1  reinoud 				eccline->bufs[eccsect] = buf;
    777   1.1  reinoud 				eccline->bufs_bpos[eccsect] = bpos;
    778   1.1  reinoud 				eccline->bufs_len[eccsect] = len;
    779   1.1  reinoud 			}
    780   1.1  reinoud 			bpos += sector_size;
    781   1.1  reinoud 			eccsect++;
    782   1.1  reinoud 			sectornr++;
    783   1.1  reinoud 			buf_len -= len;
    784   1.1  reinoud 		}
    785   1.1  reinoud 		udf_puteccline(eccline);
    786   1.1  reinoud 		return;
    787   1.1  reinoud 	}
    788   1.1  reinoud 
    789   1.1  reinoud 	if (queue == UDF_SHED_WRITING) {
    790   1.3  reinoud 		DPRINTF(SHEDULE, ("\nudf_queuebuf_rmw WRITE %p : sector %d "
    791   1.1  reinoud 			"type %d, b_resid %d, b_bcount %d, b_bufsize %d\n",
    792   1.1  reinoud 			buf, (uint32_t) buf->b_blkno / blks, buf->b_udf_c_type,
    793   1.1  reinoud 			buf->b_resid, buf->b_bcount, buf->b_bufsize));
    794   1.1  reinoud 		/* if we have FIDs fixup using buffer's sector number(s) */
    795   1.1  reinoud 		if (buf->b_udf_c_type == UDF_C_FIDS) {
    796   1.1  reinoud 			panic("UDF_C_FIDS in SHED_WRITING!\n");
    797   1.1  reinoud #if 0
    798   1.1  reinoud 			buf_len = buf->b_bcount;
    799   1.1  reinoud 			sectornr = our_sectornr;
    800   1.1  reinoud 			bpos = 0;
    801   1.1  reinoud 			while (buf_len) {
    802   1.1  reinoud 				len = MIN(buf_len, sector_size);
    803   1.1  reinoud 				fidblk = (uint8_t *) buf->b_data + bpos;
    804   1.1  reinoud 				udf_fixup_fid_block(fidblk, sector_size,
    805   1.1  reinoud 					0, len, sectornr);
    806   1.1  reinoud 				sectornr++;
    807   1.1  reinoud 				bpos += len;
    808   1.1  reinoud 				buf_len -= len;
    809   1.1  reinoud 			}
    810   1.1  reinoud #endif
    811   1.1  reinoud 		}
    812   1.1  reinoud 		udf_fixup_node_internals(ump, buf->b_data, buf->b_udf_c_type);
    813   1.1  reinoud 
    814   1.1  reinoud 		/* copy parts into the bufs and set for writing */
    815   1.1  reinoud 		buf_len = buf->b_bcount;
    816   1.1  reinoud 		sectornr = our_sectornr;
    817   1.1  reinoud 		eccline = udf_geteccline(ump, sectornr, 0);
    818   1.1  reinoud 		eccsect = sectornr - eccline->start_sector;
    819   1.1  reinoud 		bpos = 0;
    820   1.1  reinoud 		while (buf_len) {
    821   1.1  reinoud 			len = MIN(buf_len, sector_size);
    822   1.1  reinoud 			if (eccsect == ump->packet_size) {
    823   1.1  reinoud 				udf_puteccline(eccline);
    824   1.1  reinoud 				eccline = udf_geteccline(ump, sectornr, 0);
    825   1.1  reinoud 				eccsect = sectornr - eccline->start_sector;
    826   1.1  reinoud 			}
    827   1.1  reinoud 			bit = (uint64_t) 1 << eccsect;
    828   1.1  reinoud 			KASSERT((eccline->readin & bit) == 0);
    829   1.1  reinoud 			eccline->present |= bit;
    830   1.1  reinoud 			eccline->dirty   |= bit;
    831   1.1  reinoud 			if (eccline->bufs[eccsect]) {
    832   1.1  reinoud 				/* old callback still pending */
    833   1.1  reinoud 				nestiobuf_done(eccline->bufs[eccsect],
    834   1.1  reinoud 						eccline->bufs_len[eccsect],
    835   1.1  reinoud 						0);
    836   1.1  reinoud 				eccline->bufs[eccsect] = NULL;
    837   1.1  reinoud 			}
    838   1.1  reinoud 
    839   1.2  reinoud 			src = (uint8_t *) buf->b_data + bpos;
    840   1.2  reinoud 			dst = (uint8_t *) eccline->blob + eccsect * sector_size;
    841   1.2  reinoud 			if (len != sector_size)
    842   1.2  reinoud 				memset(dst, 0, sector_size);
    843   1.2  reinoud 			memcpy(dst, src, len);
    844   1.2  reinoud 
    845   1.1  reinoud 			/* note that its finished for this extent */
    846   1.1  reinoud 			eccline->bufs[eccsect] = NULL;
    847   1.1  reinoud 			nestiobuf_done(buf, len, 0);
    848   1.1  reinoud 
    849   1.1  reinoud 			bpos += sector_size;
    850   1.1  reinoud 			eccsect++;
    851   1.1  reinoud 			sectornr++;
    852   1.1  reinoud 			buf_len -= len;
    853   1.1  reinoud 		}
    854   1.1  reinoud 		udf_puteccline(eccline);
    855   1.1  reinoud 		return;
    856   1.1  reinoud 
    857   1.1  reinoud 	}
    858   1.1  reinoud 
    859   1.1  reinoud 	/* sequential writing */
    860   1.1  reinoud 	KASSERT(queue == UDF_SHED_SEQWRITING);
    861   1.3  reinoud 	DPRINTF(SHEDULE, ("\nudf_queuebuf_rmw SEQWRITE %p : sector XXXX "
    862   1.1  reinoud 		"type %d, b_resid %d, b_bcount %d, b_bufsize %d\n",
    863   1.1  reinoud 		buf, buf->b_udf_c_type, buf->b_resid, buf->b_bcount,
    864   1.1  reinoud 		buf->b_bufsize));
    865   1.1  reinoud 	/*
    866   1.1  reinoud 	 * Buffers should not have been allocated to disc addresses yet on
    867   1.1  reinoud 	 * this queue. Note that a buffer can get multiple extents allocated.
    868   1.1  reinoud 	 * Note that it *looks* like the normal writing but its different in
    869   1.1  reinoud 	 * the details.
    870   1.1  reinoud 	 *
    871   1.6  reinoud 	 * lmapping contains lb_num relative to base partition.
    872   1.6  reinoud 	 *
    873   1.6  reinoud 	 * XXX should we try to claim/organize the allocated memory to
    874   1.6  reinoud 	 * block-aligned pieces?
    875   1.1  reinoud 	 */
    876   1.1  reinoud 	mutex_enter(&priv->seqwrite_mutex);
    877   1.1  reinoud 
    878   1.1  reinoud 	lmapping    = ump->la_lmapping;
    879   1.1  reinoud 	node_ad_cpy = ump->la_node_ad_cpy;
    880   1.1  reinoud 
    881   1.6  reinoud 	/* logically allocate buf and map it in the file */
    882   1.6  reinoud 	udf_late_allocate_buf(ump, buf, lmapping, node_ad_cpy, &vpart_num);
    883   1.1  reinoud 
    884   1.1  reinoud 	/* if we have FIDs, fixup using the new allocation table */
    885   1.1  reinoud 	if (buf->b_udf_c_type == UDF_C_FIDS) {
    886   1.1  reinoud 		buf_len = buf->b_bcount;
    887   1.1  reinoud 		bpos = 0;
    888   1.1  reinoud 		lmappos = lmapping;
    889   1.1  reinoud 		while (buf_len) {
    890   1.1  reinoud 			sectornr = *lmappos++;
    891   1.1  reinoud 			len = MIN(buf_len, sector_size);
    892   1.1  reinoud 			fidblk = (uint8_t *) buf->b_data + bpos;
    893   1.1  reinoud 			udf_fixup_fid_block(fidblk, sector_size,
    894   1.1  reinoud 				0, len, sectornr);
    895   1.1  reinoud 			bpos += len;
    896   1.1  reinoud 			buf_len -= len;
    897   1.1  reinoud 		}
    898   1.1  reinoud 	}
    899   1.6  reinoud 	if (buf->b_udf_c_type == UDF_C_METADATA_SBM) {
    900   1.6  reinoud 		if (buf->b_lblkno == 0) {
    901   1.6  reinoud 			/* update the tag location inside */
    902   1.6  reinoud 			tag = (struct desc_tag *) buf->b_data;
    903   1.7  reinoud 			tag->tag_loc = udf_rw32(*lmapping);
    904   1.6  reinoud 			udf_validate_tag_and_crc_sums(buf->b_data);
    905   1.6  reinoud 		}
    906   1.6  reinoud 	}
    907   1.1  reinoud 	udf_fixup_node_internals(ump, buf->b_data, buf->b_udf_c_type);
    908   1.1  reinoud 
    909   1.6  reinoud 	/*
    910   1.6  reinoud 	 * Translate new mappings in lmapping to pmappings.
    911   1.6  reinoud 	 * pmapping to contain lb_nums as used for disc adressing.
    912   1.6  reinoud 	 */
    913   1.6  reinoud 	pmapping = ump->la_pmapping;
    914   1.6  reinoud 	sectors  = (buf->b_bcount + sector_size -1) / sector_size;
    915   1.6  reinoud 	udf_translate_vtop_list(ump, sectors, vpart_num, lmapping, pmapping);
    916   1.6  reinoud 
    917   1.1  reinoud 	/* copy parts into the bufs and set for writing */
    918   1.1  reinoud 	pmappos = pmapping;
    919   1.1  reinoud 	buf_len = buf->b_bcount;
    920   1.1  reinoud 	sectornr = *pmappos++;
    921   1.1  reinoud 	eccline = udf_geteccline(ump, sectornr, ECC_SEQWRITING);
    922   1.1  reinoud 	eccsect = sectornr - eccline->start_sector;
    923   1.1  reinoud 	bpos = 0;
    924   1.1  reinoud 	while (buf_len) {
    925   1.1  reinoud 		len = MIN(buf_len, sector_size);
    926   1.1  reinoud 		eccsect = sectornr - eccline->start_sector;
    927   1.1  reinoud 		if ((eccsect < 0) || (eccsect >= ump->packet_size)) {
    928   1.1  reinoud 			eccline->flags |= ECC_SEQWRITING;
    929   1.1  reinoud 			udf_puteccline(eccline);
    930   1.1  reinoud 			eccline = udf_geteccline(ump, sectornr, ECC_SEQWRITING);
    931   1.1  reinoud 			eccsect = sectornr - eccline->start_sector;
    932   1.1  reinoud 		}
    933   1.1  reinoud 		bit = (uint64_t) 1 << eccsect;
    934   1.1  reinoud 		KASSERT((eccline->readin & bit) == 0);
    935   1.1  reinoud 		eccline->present |= bit;
    936   1.1  reinoud 		eccline->dirty   |= bit;
    937   1.1  reinoud 		eccline->bufs[eccsect] = NULL;
    938   1.1  reinoud 
    939   1.1  reinoud 		src = (uint8_t *) buf->b_data + bpos;
    940   1.1  reinoud 		dst = (uint8_t *)
    941   1.1  reinoud 			eccline->blob + eccsect * sector_size;
    942   1.1  reinoud 		if (len != sector_size)
    943   1.1  reinoud 			memset(dst, 0, sector_size);
    944   1.1  reinoud 		memcpy(dst, src, len);
    945   1.1  reinoud 
    946   1.1  reinoud 		/* note that its finished for this extent */
    947   1.1  reinoud 		nestiobuf_done(buf, len, 0);
    948   1.1  reinoud 
    949   1.1  reinoud 		bpos += sector_size;
    950   1.1  reinoud 		sectornr = *pmappos++;
    951   1.1  reinoud 		buf_len -= len;
    952   1.1  reinoud 	}
    953   1.1  reinoud 	eccline->flags |= ECC_SEQWRITING;
    954   1.1  reinoud 	udf_puteccline(eccline);
    955   1.1  reinoud 	mutex_exit(&priv->seqwrite_mutex);
    956   1.1  reinoud }
    957   1.1  reinoud 
    958   1.1  reinoud /* --------------------------------------------------------------------- */
    959   1.1  reinoud 
    960   1.1  reinoud static void
    961   1.1  reinoud udf_shedule_read_callback(struct buf *buf)
    962   1.1  reinoud {
    963   1.1  reinoud 	struct udf_eccline *eccline = BTOE(buf);
    964   1.1  reinoud 	struct udf_mount *ump = eccline->ump;
    965   1.1  reinoud 	uint64_t bit;
    966   1.1  reinoud 	uint8_t *src, *dst;
    967   1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
    968   1.1  reinoud 	int error, i, len;
    969   1.1  reinoud 
    970   1.3  reinoud 	DPRINTF(ECCLINE, ("read callback called\n"));
    971   1.1  reinoud 	/* post process read action */
    972   1.1  reinoud 	error = buf->b_error;
    973   1.1  reinoud 	for (i = 0; i < ump->packet_size; i++) {
    974   1.1  reinoud 		bit = (uint64_t) 1 << i;
    975   1.1  reinoud 		src = (uint8_t *) buf->b_data +   i * sector_size;
    976   1.1  reinoud 		dst = (uint8_t *) eccline->blob + i * sector_size;
    977   1.1  reinoud 		if (eccline->present & bit)
    978   1.1  reinoud 			continue;
    979   1.8  reinoud 		eccline->present |= bit;
    980   1.8  reinoud 		if (error)
    981   1.1  reinoud 			eccline->error |= bit;
    982   1.1  reinoud 		if (eccline->bufs[i]) {
    983   1.1  reinoud 			dst = (uint8_t *) eccline->bufs[i]->b_data +
    984   1.1  reinoud 				eccline->bufs_bpos[i];
    985   1.1  reinoud 			len = eccline->bufs_len[i];
    986   1.1  reinoud 			if (!error)
    987   1.1  reinoud 				memcpy(dst, src, len);
    988   1.1  reinoud 			nestiobuf_done(eccline->bufs[i], len, error);
    989   1.1  reinoud 			eccline->bufs[i] = NULL;
    990   1.1  reinoud 		}
    991   1.1  reinoud 
    992   1.1  reinoud 	}
    993   1.1  reinoud 	KASSERT(buf->b_data == eccline->blob);
    994   1.1  reinoud 	KASSERT(eccline->present == ((uint64_t) 1 << ump->packet_size)-1);
    995   1.1  reinoud 
    996   1.1  reinoud 	/*
    997   1.1  reinoud 	 * XXX TODO what to do on read errors? read in all sectors
    998   1.1  reinoud 	 * synchronously and allocate a sparable entry?
    999   1.1  reinoud 	 */
   1000   1.1  reinoud 
   1001   1.1  reinoud 	wakeup(eccline);
   1002   1.1  reinoud 	udf_puteccline(eccline);
   1003   1.3  reinoud 	DPRINTF(ECCLINE, ("read callback finished\n"));
   1004   1.1  reinoud }
   1005   1.1  reinoud 
   1006   1.1  reinoud 
   1007   1.1  reinoud static void
   1008   1.1  reinoud udf_shedule_write_callback(struct buf *buf)
   1009   1.1  reinoud {
   1010   1.1  reinoud 	struct udf_eccline *eccline = BTOE(buf);
   1011   1.1  reinoud 	struct udf_mount *ump = eccline->ump;
   1012   1.1  reinoud 	uint64_t bit;
   1013   1.1  reinoud 	int error, i, len;
   1014   1.1  reinoud 
   1015   1.3  reinoud 	DPRINTF(ECCLINE, ("write callback called\n"));
   1016   1.1  reinoud 	/* post process write action */
   1017   1.1  reinoud 	error = buf->b_error;
   1018   1.1  reinoud 	for (i = 0; i < ump->packet_size; i++) {
   1019   1.1  reinoud 		bit = (uint64_t) 1 << i;
   1020   1.1  reinoud 		if ((eccline->dirty & bit) == 0)
   1021   1.1  reinoud 			continue;
   1022   1.1  reinoud 		if (error) {
   1023   1.1  reinoud 			eccline->error |= bit;
   1024   1.1  reinoud 		} else {
   1025   1.1  reinoud 			eccline->dirty &= ~bit;
   1026   1.1  reinoud 		}
   1027   1.1  reinoud 		if (eccline->bufs[i]) {
   1028   1.1  reinoud 			len = eccline->bufs_len[i];
   1029   1.1  reinoud 			nestiobuf_done(eccline->bufs[i], len, error);
   1030   1.1  reinoud 			eccline->bufs[i] = NULL;
   1031   1.1  reinoud 		}
   1032   1.1  reinoud 	}
   1033   1.1  reinoud 	KASSERT(eccline->dirty == 0);
   1034   1.1  reinoud 
   1035   1.1  reinoud 	KASSERT(error == 0);
   1036   1.1  reinoud 	/*
   1037   1.1  reinoud 	 * XXX TODO on write errors allocate a sparable entry
   1038   1.1  reinoud 	 */
   1039   1.1  reinoud 
   1040   1.1  reinoud 	wakeup(eccline);
   1041   1.1  reinoud 	udf_puteccline(eccline);
   1042   1.1  reinoud }
   1043   1.1  reinoud 
   1044   1.1  reinoud 
   1045   1.1  reinoud static void
   1046   1.1  reinoud udf_issue_eccline(struct udf_eccline *eccline, int queued_on)
   1047   1.1  reinoud {
   1048   1.1  reinoud 	struct udf_mount *ump = eccline->ump;
   1049   1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1050   1.1  reinoud 	struct buf *buf, *nestbuf;
   1051   1.1  reinoud 	uint64_t bit, allbits = ((uint64_t) 1 << ump->packet_size)-1;
   1052   1.1  reinoud 	uint32_t start;
   1053   1.1  reinoud 	int sector_size = ump->discinfo.sector_size;
   1054   1.1  reinoud 	int blks = sector_size / DEV_BSIZE;
   1055   1.1  reinoud 	int i;
   1056   1.1  reinoud 
   1057   1.1  reinoud 	if (queued_on == UDF_SHED_READING) {
   1058   1.3  reinoud 		DPRINTF(SHEDULE, ("udf_issue_eccline reading : "));
   1059   1.1  reinoud 		/* read all bits that are not yet present */
   1060   1.1  reinoud 		eccline->readin = (~eccline->present) & allbits;
   1061   1.1  reinoud 		KASSERT(eccline->readin);
   1062   1.1  reinoud 		start = eccline->start_sector;
   1063   1.1  reinoud 		buf = eccline->buf;
   1064   1.1  reinoud 		buf_init(buf);
   1065   1.1  reinoud 		buf->b_flags    = B_READ | B_ASYNC;
   1066   1.4  reinoud 		SET(buf->b_cflags, BC_BUSY);	/* mark buffer busy */
   1067   1.1  reinoud 		buf->b_oflags   = 0;
   1068   1.1  reinoud 		buf->b_iodone   = udf_shedule_read_callback;
   1069   1.1  reinoud 		buf->b_data     = eccline->blob;
   1070   1.1  reinoud 		buf->b_bcount   = ump->packet_size * sector_size;
   1071   1.1  reinoud 		buf->b_resid    = buf->b_bcount;
   1072   1.1  reinoud 		buf->b_bufsize  = buf->b_bcount;
   1073   1.1  reinoud 		buf->b_private  = eccline;
   1074   1.1  reinoud 		BIO_SETPRIO(buf, BPRIO_DEFAULT);
   1075   1.1  reinoud 		buf->b_lblkno   = buf->b_blkno = buf->b_rawblkno = start * blks;
   1076   1.1  reinoud 		buf->b_proc     = NULL;
   1077   1.1  reinoud 
   1078   1.1  reinoud 		if (eccline->present != 0) {
   1079   1.1  reinoud 			for (i = 0; i < ump->packet_size; i++) {
   1080   1.1  reinoud 				bit = (uint64_t) 1 << i;
   1081   1.1  reinoud 				if (eccline->present & bit) {
   1082   1.1  reinoud 					nestiobuf_done(buf, sector_size, 0);
   1083   1.1  reinoud 					continue;
   1084   1.1  reinoud 				}
   1085   1.1  reinoud 				nestbuf = getiobuf(NULL, true);
   1086   1.1  reinoud 				nestiobuf_setup(buf, nestbuf, i * sector_size,
   1087   1.1  reinoud 					sector_size);
   1088   1.1  reinoud 				/* adjust blocknumber to read */
   1089   1.1  reinoud 				nestbuf->b_blkno = buf->b_blkno + i*blks;
   1090   1.1  reinoud 				nestbuf->b_rawblkno = buf->b_rawblkno + i*blks;
   1091   1.1  reinoud 
   1092   1.3  reinoud 				DPRINTF(SHEDULE, ("sector %d ",
   1093   1.3  reinoud 					start + i));
   1094   1.1  reinoud 				/* call asynchronous */
   1095   1.1  reinoud 				VOP_STRATEGY(ump->devvp, nestbuf);
   1096   1.1  reinoud 			}
   1097   1.3  reinoud 			DPRINTF(SHEDULE, ("\n"));
   1098   1.1  reinoud 			return;
   1099   1.1  reinoud 		}
   1100   1.1  reinoud 	} else {
   1101   1.1  reinoud 		/* write or seqwrite */
   1102   1.3  reinoud 		DPRINTF(SHEDULE, ("udf_issue_eccline writing or seqwriting : "));
   1103   1.1  reinoud 		if (eccline->present != allbits) {
   1104   1.1  reinoud 			/* requeue to read-only */
   1105   1.3  reinoud 			DPRINTF(SHEDULE, ("\n\t-> not complete, requeue to "
   1106   1.3  reinoud 				"reading\n"));
   1107   1.1  reinoud 			udf_push_eccline(eccline, UDF_SHED_READING);
   1108   1.1  reinoud 			return;
   1109   1.1  reinoud 		}
   1110   1.1  reinoud 		start = eccline->start_sector;
   1111   1.1  reinoud 		buf = eccline->buf;
   1112   1.1  reinoud 		buf_init(buf);
   1113   1.1  reinoud 		buf->b_flags    = B_WRITE | B_ASYNC;
   1114   1.4  reinoud 		SET(buf->b_cflags, BC_BUSY);	/* mark buffer busy */
   1115   1.1  reinoud 		buf->b_oflags   = 0;
   1116   1.1  reinoud 		buf->b_iodone   = udf_shedule_write_callback;
   1117   1.1  reinoud 		buf->b_data     = eccline->blob;
   1118   1.1  reinoud 		buf->b_bcount   = ump->packet_size * sector_size;
   1119   1.1  reinoud 		buf->b_resid    = buf->b_bcount;
   1120   1.1  reinoud 		buf->b_bufsize  = buf->b_bcount;
   1121   1.1  reinoud 		buf->b_private  = eccline;
   1122   1.1  reinoud 		BIO_SETPRIO(buf, BPRIO_DEFAULT);
   1123   1.1  reinoud 		buf->b_lblkno   = buf->b_blkno = buf->b_rawblkno = start * blks;
   1124   1.1  reinoud 		buf->b_proc     = NULL;
   1125   1.1  reinoud 	}
   1126   1.1  reinoud 
   1127   1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
   1128   1.1  reinoud 		/* call asynchronous */
   1129   1.3  reinoud 		DPRINTF(SHEDULE, ("sector %d for %d\n",
   1130   1.3  reinoud 			start, ump->packet_size));
   1131   1.1  reinoud 		VOP_STRATEGY(ump->devvp, buf);
   1132   1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
   1133   1.1  reinoud }
   1134   1.1  reinoud 
   1135   1.1  reinoud 
   1136   1.1  reinoud static void
   1137   1.1  reinoud udf_discstrat_thread(void *arg)
   1138   1.1  reinoud {
   1139   1.1  reinoud 	struct udf_mount *ump = (struct udf_mount *) arg;
   1140   1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1141   1.1  reinoud 	struct udf_eccline *eccline;
   1142   1.1  reinoud 	struct timespec now, *last;
   1143  1.11  reinoud 	uint64_t allbits = ((uint64_t) 1 << ump->packet_size)-1;
   1144  1.11  reinoud 	int new_queue, wait, work, num, cnt;
   1145   1.1  reinoud 
   1146   1.1  reinoud 	work = 1;
   1147   1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
   1148   1.1  reinoud 	priv->num_floating = 0;
   1149   1.1  reinoud 	while (priv->run_thread || work || priv->num_floating) {
   1150  1.11  reinoud 		/* get our time */
   1151  1.11  reinoud 		vfs_timestamp(&now);
   1152  1.11  reinoud 
   1153  1.11  reinoud 		/* maintenance: handle eccline state machine */
   1154  1.11  reinoud 		num = priv->num_queued[UDF_SHED_WAITING];
   1155  1.11  reinoud 		cnt = 0;
   1156  1.11  reinoud 		while (cnt < num) {
   1157  1.11  reinoud 			eccline = udf_pop_eccline(priv, UDF_SHED_WAITING);
   1158  1.11  reinoud 			/* requeue */
   1159  1.11  reinoud 			new_queue = UDF_SHED_FREE;
   1160  1.11  reinoud 			if (eccline->refcnt > 0)
   1161  1.11  reinoud 				new_queue = UDF_SHED_IDLE;
   1162  1.11  reinoud 			if (eccline->flags & ECC_WANTED)
   1163  1.11  reinoud 				new_queue = UDF_SHED_IDLE;
   1164  1.11  reinoud 			if (eccline->readin)
   1165  1.11  reinoud 				new_queue = UDF_SHED_READING;
   1166  1.11  reinoud 			if (eccline->dirty) {
   1167  1.11  reinoud 				new_queue = UDF_SHED_WAITING;
   1168  1.11  reinoud 				if (eccline->wait_time.tv_sec - now.tv_sec <= 0) {
   1169  1.11  reinoud 					new_queue = UDF_SHED_WRITING;
   1170  1.11  reinoud 					if (eccline->flags & ECC_SEQWRITING)
   1171  1.11  reinoud 						new_queue = UDF_SHED_SEQWRITING;
   1172  1.11  reinoud 					if (eccline->present != allbits)
   1173  1.11  reinoud 						new_queue = UDF_SHED_READING;
   1174  1.11  reinoud 				}
   1175  1.11  reinoud 			}
   1176  1.11  reinoud 			udf_push_eccline(eccline, new_queue);
   1177  1.11  reinoud 			cnt++;
   1178  1.11  reinoud 		}
   1179  1.11  reinoud 
   1180   1.1  reinoud 		/* maintenance: free exess ecclines */
   1181   1.1  reinoud 		while (priv->num_queued[UDF_SHED_FREE] > UDF_ECCLINE_MAXFREE) {
   1182   1.1  reinoud 			eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
   1183   1.1  reinoud 			KASSERT(eccline);
   1184   1.1  reinoud 			KASSERT(eccline->refcnt == 0);
   1185  1.11  reinoud 			if (eccline->flags & ECC_WANTED) {
   1186  1.11  reinoud 				udf_push_eccline(eccline, UDF_SHED_IDLE);
   1187  1.11  reinoud 				DPRINTF(ECCLINE, ("Tried removing, pushed back to free list\n"));
   1188  1.11  reinoud 			} else {
   1189  1.11  reinoud 				DPRINTF(ECCLINE, ("Removing entry from free list\n"));
   1190  1.11  reinoud 				udf_dispose_eccline(eccline);
   1191  1.11  reinoud 			}
   1192   1.1  reinoud 		}
   1193   1.1  reinoud 
   1194  1.11  reinoud 		/* process the current selected queue */
   1195   1.1  reinoud 		/* get our time */
   1196   1.1  reinoud 		vfs_timestamp(&now);
   1197   1.1  reinoud 		last = &priv->last_queued[priv->cur_queue];
   1198   1.1  reinoud 
   1199   1.1  reinoud 		/* don't shedule too quickly when there is only one */
   1200   1.1  reinoud 		if (priv->cur_queue == UDF_SHED_WRITING) {
   1201   1.1  reinoud 			if (priv->num_queued[priv->cur_queue] <= 2) {
   1202  1.10  reinoud 				if (now.tv_sec - last->tv_sec < 4) {
   1203   1.1  reinoud 					/* wait some time */
   1204   1.1  reinoud 					cv_timedwait(&priv->discstrat_cv,
   1205   1.1  reinoud 						&priv->discstrat_mutex, hz);
   1206  1.10  reinoud 					continue;
   1207   1.1  reinoud 				}
   1208   1.1  reinoud 			}
   1209   1.1  reinoud 		}
   1210   1.1  reinoud 
   1211   1.1  reinoud 		/* get our line */
   1212   1.1  reinoud 		eccline = udf_pop_eccline(priv, priv->cur_queue);
   1213   1.1  reinoud 		if (eccline) {
   1214   1.1  reinoud 			wait = 0;
   1215   1.1  reinoud 			new_queue = priv->cur_queue;
   1216   1.3  reinoud 			DPRINTF(ECCLINE, ("UDF_ISSUE_ECCLINE\n"));
   1217   1.1  reinoud 
   1218   1.1  reinoud 			/* complete the `get' by locking and refcounting it */
   1219   1.1  reinoud 			UDF_LOCK_ECCLINE(eccline);
   1220   1.1  reinoud 			eccline->refcnt++;
   1221   1.1  reinoud 
   1222   1.1  reinoud 			udf_issue_eccline(eccline, priv->cur_queue);
   1223   1.1  reinoud 		} else {
   1224   1.1  reinoud 			wait = 1;
   1225   1.1  reinoud 			/* check if we can/should switch */
   1226   1.1  reinoud 			new_queue = priv->cur_queue;
   1227   1.1  reinoud 			if (BUFQ_PEEK(priv->queues[UDF_SHED_READING]))
   1228   1.1  reinoud 				new_queue = UDF_SHED_READING;
   1229   1.1  reinoud 			if (BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]))
   1230   1.1  reinoud 				new_queue = UDF_SHED_WRITING;
   1231   1.1  reinoud 			if (BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]))
   1232   1.1  reinoud 				new_queue = UDF_SHED_SEQWRITING;
   1233   1.1  reinoud 
   1234   1.1  reinoud 			/* dont switch seqwriting too fast */
   1235   1.1  reinoud 			if (priv->cur_queue == UDF_SHED_READING) {
   1236   1.1  reinoud 				if (now.tv_sec - last->tv_sec < 1)
   1237   1.1  reinoud 					new_queue = priv->cur_queue;
   1238   1.1  reinoud 			}
   1239   1.1  reinoud 			if (priv->cur_queue == UDF_SHED_WRITING) {
   1240   1.1  reinoud 				if (now.tv_sec - last->tv_sec < 2)
   1241   1.1  reinoud 					new_queue = priv->cur_queue;
   1242   1.1  reinoud 			}
   1243   1.1  reinoud 			if (priv->cur_queue == UDF_SHED_SEQWRITING) {
   1244   1.1  reinoud 				if (now.tv_sec - last->tv_sec < 4)
   1245   1.1  reinoud 					new_queue = priv->cur_queue;
   1246   1.1  reinoud 			}
   1247   1.1  reinoud 		}
   1248   1.1  reinoud 
   1249   1.1  reinoud 		/* give room */
   1250   1.1  reinoud 		mutex_exit(&priv->discstrat_mutex);
   1251   1.1  reinoud 
   1252   1.1  reinoud 		if (new_queue != priv->cur_queue) {
   1253   1.1  reinoud 			wait = 0;
   1254   1.1  reinoud 			DPRINTF(SHEDULE, ("switching from %d to %d\n",
   1255   1.1  reinoud 				priv->cur_queue, new_queue));
   1256   1.1  reinoud 			priv->cur_queue = new_queue;
   1257   1.1  reinoud 		}
   1258   1.1  reinoud 		mutex_enter(&priv->discstrat_mutex);
   1259   1.1  reinoud 
   1260   1.1  reinoud 		/* wait for more if needed */
   1261   1.1  reinoud 		if (wait)
   1262   1.1  reinoud 			cv_timedwait(&priv->discstrat_cv,
   1263   1.1  reinoud 				&priv->discstrat_mutex, hz);	/* /8 */
   1264   1.1  reinoud 
   1265  1.11  reinoud 		work  = (BUFQ_PEEK(priv->queues[UDF_SHED_WAITING]) != NULL);
   1266  1.11  reinoud 		work |= (BUFQ_PEEK(priv->queues[UDF_SHED_READING]) != NULL);
   1267   1.1  reinoud 		work |= (BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]) != NULL);
   1268   1.1  reinoud 		work |= (BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]) != NULL);
   1269   1.1  reinoud 
   1270   1.1  reinoud 		DPRINTF(PARANOIA, ("work : (%d, %d, %d) -> work %d, float %d\n",
   1271   1.1  reinoud 			(BUFQ_PEEK(priv->queues[UDF_SHED_READING]) != NULL),
   1272   1.1  reinoud 			(BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]) != NULL),
   1273   1.1  reinoud 			(BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]) != NULL),
   1274   1.1  reinoud 			work, priv->num_floating));
   1275   1.1  reinoud 	}
   1276   1.1  reinoud 
   1277   1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
   1278   1.1  reinoud 
   1279   1.1  reinoud 	/* tear down remaining ecclines */
   1280   1.1  reinoud 	mutex_enter(&priv->discstrat_mutex);
   1281  1.11  reinoud 	KASSERT(priv->num_queued[UDF_SHED_WAITING] == 0);
   1282   1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_IDLE] == 0);
   1283   1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_READING] == 0);
   1284   1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_WRITING] == 0);
   1285   1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_SEQWRITING] == 0);
   1286   1.1  reinoud 
   1287  1.11  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_WAITING]) == NULL);
   1288   1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_IDLE]) == NULL);
   1289   1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_READING]) == NULL);
   1290   1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_WRITING]) == NULL);
   1291   1.1  reinoud 	KASSERT(BUFQ_PEEK(priv->queues[UDF_SHED_SEQWRITING]) == NULL);
   1292   1.1  reinoud 	eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
   1293   1.1  reinoud 	while (eccline) {
   1294   1.1  reinoud 		udf_dispose_eccline(eccline);
   1295   1.1  reinoud 		eccline = udf_pop_eccline(priv, UDF_SHED_FREE);
   1296   1.1  reinoud 	}
   1297   1.1  reinoud 	KASSERT(priv->num_queued[UDF_SHED_FREE] == 0);
   1298   1.1  reinoud 	mutex_exit(&priv->discstrat_mutex);
   1299   1.1  reinoud 
   1300   1.1  reinoud 	priv->thread_finished = 1;
   1301   1.1  reinoud 	wakeup(&priv->run_thread);
   1302   1.1  reinoud 	kthread_exit(0);
   1303   1.1  reinoud 	/* not reached */
   1304   1.1  reinoud }
   1305   1.1  reinoud 
   1306   1.1  reinoud /* --------------------------------------------------------------------- */
   1307   1.1  reinoud 
   1308   1.1  reinoud /*
   1309   1.1  reinoud  * Buffer memory pool allocator.
   1310   1.1  reinoud  */
   1311   1.1  reinoud 
   1312   1.1  reinoud static void *
   1313   1.1  reinoud ecclinepool_page_alloc(struct pool *pp, int flags)
   1314   1.1  reinoud {
   1315   1.1  reinoud         return (void *)uvm_km_alloc(kernel_map,
   1316   1.1  reinoud             MAXBSIZE, MAXBSIZE,
   1317   1.1  reinoud             ((flags & PR_WAITOK) ? 0 : UVM_KMF_NOWAIT | UVM_KMF_TRYLOCK)
   1318   1.1  reinoud 	    	| UVM_KMF_WIRED /* UVM_KMF_PAGABLE? */);
   1319   1.1  reinoud }
   1320   1.1  reinoud 
   1321   1.1  reinoud static void
   1322   1.1  reinoud ecclinepool_page_free(struct pool *pp, void *v)
   1323   1.1  reinoud {
   1324   1.1  reinoud         uvm_km_free(kernel_map, (vaddr_t)v, MAXBSIZE, UVM_KMF_WIRED);
   1325   1.1  reinoud }
   1326   1.1  reinoud 
   1327   1.1  reinoud static struct pool_allocator ecclinepool_allocator = {
   1328   1.1  reinoud         .pa_alloc = ecclinepool_page_alloc,
   1329   1.1  reinoud         .pa_free  = ecclinepool_page_free,
   1330   1.1  reinoud         .pa_pagesz = MAXBSIZE,
   1331   1.1  reinoud };
   1332   1.1  reinoud 
   1333   1.1  reinoud 
   1334   1.1  reinoud static void
   1335   1.1  reinoud udf_discstrat_init_rmw(struct udf_strat_args *args)
   1336   1.1  reinoud {
   1337   1.1  reinoud 	struct udf_mount *ump = args->ump;
   1338   1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1339   1.1  reinoud 	uint32_t lb_size, blobsize, hashline;
   1340   1.1  reinoud 	int i;
   1341   1.1  reinoud 
   1342   1.1  reinoud 	KASSERT(ump);
   1343   1.1  reinoud 	KASSERT(ump->logical_vol);
   1344   1.1  reinoud 	KASSERT(priv == NULL);
   1345   1.1  reinoud 
   1346   1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   1347   1.1  reinoud 	blobsize = ump->packet_size * lb_size;
   1348   1.1  reinoud 	KASSERT(lb_size > 0);
   1349   1.1  reinoud 	KASSERT(ump->packet_size <= 64);
   1350   1.1  reinoud 
   1351   1.1  reinoud 	/* initialise our memory space */
   1352   1.1  reinoud 	ump->strategy_private = malloc(sizeof(struct strat_private),
   1353   1.1  reinoud 		M_UDFTEMP, M_WAITOK);
   1354   1.1  reinoud 	priv = ump->strategy_private;
   1355   1.1  reinoud 	memset(priv, 0 , sizeof(struct strat_private));
   1356   1.1  reinoud 
   1357   1.1  reinoud 	/* initialise locks */
   1358   1.1  reinoud 	cv_init(&priv->discstrat_cv, "udfstrat");
   1359   1.1  reinoud 	mutex_init(&priv->discstrat_mutex, MUTEX_DRIVER, IPL_BIO);
   1360   1.1  reinoud 	mutex_init(&priv->seqwrite_mutex, MUTEX_DEFAULT, IPL_NONE);
   1361   1.1  reinoud 
   1362   1.1  reinoud 	/* initialise struct eccline pool */
   1363   1.1  reinoud 	pool_init(&priv->eccline_pool, sizeof(struct udf_eccline),
   1364   1.1  reinoud 		0, 0, 0, "udf_eccline_pool", NULL, IPL_NONE);
   1365   1.1  reinoud 
   1366   1.1  reinoud 	/* initialise eccline blob pool */
   1367  1.12  reinoud         ecclinepool_allocator.pa_pagesz = blobsize;
   1368   1.1  reinoud 	pool_init(&priv->ecclineblob_pool, blobsize,
   1369  1.12  reinoud 		0, 0, 0, "udf_eccline_blob", &ecclinepool_allocator, IPL_NONE);
   1370   1.1  reinoud 
   1371   1.1  reinoud 	/* initialise main queues */
   1372   1.1  reinoud 	for (i = 0; i < UDF_SHED_MAX; i++) {
   1373   1.1  reinoud 		priv->num_queued[i] = 0;
   1374   1.1  reinoud 		vfs_timestamp(&priv->last_queued[i]);
   1375   1.1  reinoud 	}
   1376  1.11  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_WAITING], "fcfs",
   1377  1.11  reinoud 		BUFQ_SORT_RAWBLOCK);
   1378   1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_READING], "disksort",
   1379   1.1  reinoud 		BUFQ_SORT_RAWBLOCK);
   1380   1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_WRITING], "disksort",
   1381   1.1  reinoud 		BUFQ_SORT_RAWBLOCK);
   1382   1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_SEQWRITING], "disksort", 0);
   1383   1.1  reinoud 
   1384   1.1  reinoud 	/* initialise administrative queues */
   1385   1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_IDLE], "fcfs", 0);
   1386   1.1  reinoud 	bufq_alloc(&priv->queues[UDF_SHED_FREE], "fcfs", 0);
   1387   1.1  reinoud 
   1388   1.1  reinoud 	for (hashline = 0; hashline < UDF_ECCBUF_HASHSIZE; hashline++) {
   1389   1.1  reinoud 		LIST_INIT(&priv->eccline_hash[hashline]);
   1390   1.1  reinoud 	}
   1391   1.1  reinoud 
   1392   1.1  reinoud 	/* create our disk strategy thread */
   1393   1.1  reinoud 	priv->cur_queue = UDF_SHED_READING;
   1394   1.1  reinoud 	priv->thread_finished = 0;
   1395   1.1  reinoud 	priv->run_thread      = 1;
   1396   1.1  reinoud 	if (kthread_create(PRI_NONE, 0 /* KTHREAD_MPSAFE*/, NULL /* cpu_info*/,
   1397   1.1  reinoud 		udf_discstrat_thread, ump, &priv->queue_lwp,
   1398   1.1  reinoud 		"%s", "udf_rw")) {
   1399   1.1  reinoud 		panic("fork udf_rw");
   1400   1.1  reinoud 	}
   1401   1.1  reinoud }
   1402   1.1  reinoud 
   1403   1.1  reinoud 
   1404   1.1  reinoud static void
   1405   1.1  reinoud udf_discstrat_finish_rmw(struct udf_strat_args *args)
   1406   1.1  reinoud {
   1407   1.1  reinoud 	struct udf_mount *ump = args->ump;
   1408   1.1  reinoud 	struct strat_private *priv = PRIV(ump);
   1409   1.1  reinoud 	int error;
   1410   1.1  reinoud 
   1411   1.1  reinoud 	if (ump == NULL)
   1412   1.1  reinoud 		return;
   1413   1.1  reinoud 
   1414   1.1  reinoud 	/* stop our sheduling thread */
   1415   1.1  reinoud 	KASSERT(priv->run_thread == 1);
   1416   1.1  reinoud 	priv->run_thread = 0;
   1417   1.1  reinoud 	wakeup(priv->queue_lwp);
   1418   1.1  reinoud 	while (!priv->thread_finished) {
   1419   1.1  reinoud 		error = tsleep(&priv->run_thread, PRIBIO+1,
   1420   1.1  reinoud 			"udfshedfin", hz);
   1421   1.1  reinoud 	}
   1422   1.1  reinoud 	/* kthread should be finished now */
   1423   1.1  reinoud 
   1424   1.1  reinoud 	/* cleanup our pools */
   1425   1.1  reinoud 	pool_destroy(&priv->eccline_pool);
   1426   1.1  reinoud 	pool_destroy(&priv->ecclineblob_pool);
   1427   1.1  reinoud 
   1428   1.1  reinoud 	cv_destroy(&priv->discstrat_cv);
   1429   1.1  reinoud 	mutex_destroy(&priv->discstrat_mutex);
   1430   1.1  reinoud 	mutex_destroy(&priv->seqwrite_mutex);
   1431   1.1  reinoud 
   1432   1.1  reinoud 	/* free our private space */
   1433   1.1  reinoud 	free(ump->strategy_private, M_UDFTEMP);
   1434   1.1  reinoud 	ump->strategy_private = NULL;
   1435   1.1  reinoud }
   1436   1.1  reinoud 
   1437   1.1  reinoud /* --------------------------------------------------------------------- */
   1438   1.1  reinoud 
   1439   1.1  reinoud struct udf_strategy udf_strat_rmw =
   1440   1.1  reinoud {
   1441   1.5  reinoud 	udf_create_nodedscr_rmw,
   1442   1.5  reinoud 	udf_free_nodedscr_rmw,
   1443   1.5  reinoud 	udf_read_nodedscr_rmw,
   1444   1.5  reinoud 	udf_write_nodedscr_rmw,
   1445   1.1  reinoud 	udf_queuebuf_rmw,
   1446   1.1  reinoud 	udf_discstrat_init_rmw,
   1447   1.1  reinoud 	udf_discstrat_finish_rmw
   1448   1.1  reinoud };
   1449   1.1  reinoud 
   1450