xref: /openbmc/linux/drivers/s390/block/dasd_fba.c (revision 28b841b3)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * Author(s)......: Holger Smolinski <Holger.Smolinski@de.ibm.com>
31da177e4SLinus Torvalds  * Bugreports.to..: <Linux390@de.ibm.com>
4d41dd122SStefan Haberland  * Copyright IBM Corp. 1999, 2009
51da177e4SLinus Torvalds  */
61da177e4SLinus Torvalds 
7ca99dab0SStefan Haberland #define KMSG_COMPONENT "dasd-fba"
8fc19f381SStefan Haberland 
91da177e4SLinus Torvalds #include <linux/stddef.h>
101da177e4SLinus Torvalds #include <linux/kernel.h>
111da177e4SLinus Torvalds #include <asm/debug.h>
121da177e4SLinus Torvalds 
131da177e4SLinus Torvalds #include <linux/slab.h>
141da177e4SLinus Torvalds #include <linux/hdreg.h>	/* HDIO_GETGEO			    */
151da177e4SLinus Torvalds #include <linux/bio.h>
161da177e4SLinus Torvalds #include <linux/module.h>
171da177e4SLinus Torvalds #include <linux/init.h>
181da177e4SLinus Torvalds 
191da177e4SLinus Torvalds #include <asm/idals.h>
201da177e4SLinus Torvalds #include <asm/ebcdic.h>
211da177e4SLinus Torvalds #include <asm/io.h>
221da177e4SLinus Torvalds #include <asm/ccwdev.h>
231da177e4SLinus Torvalds 
241da177e4SLinus Torvalds #include "dasd_int.h"
251da177e4SLinus Torvalds #include "dasd_fba.h"
261da177e4SLinus Torvalds 
271da177e4SLinus Torvalds #ifdef PRINTK_HEADER
281da177e4SLinus Torvalds #undef PRINTK_HEADER
291da177e4SLinus Torvalds #endif				/* PRINTK_HEADER */
301da177e4SLinus Torvalds #define PRINTK_HEADER "dasd(fba):"
311da177e4SLinus Torvalds 
321f1ee9adSHannes Reinecke #define FBA_DEFAULT_RETRIES 32
331f1ee9adSHannes Reinecke 
341da177e4SLinus Torvalds #define DASD_FBA_CCW_WRITE 0x41
351da177e4SLinus Torvalds #define DASD_FBA_CCW_READ 0x42
361da177e4SLinus Torvalds #define DASD_FBA_CCW_LOCATE 0x43
371da177e4SLinus Torvalds #define DASD_FBA_CCW_DEFINE_EXTENT 0x63
381da177e4SLinus Torvalds 
391da177e4SLinus Torvalds MODULE_LICENSE("GPL");
401da177e4SLinus Torvalds 
411da177e4SLinus Torvalds static struct dasd_discipline dasd_fba_discipline;
421da177e4SLinus Torvalds 
431da177e4SLinus Torvalds struct dasd_fba_private {
441da177e4SLinus Torvalds 	struct dasd_fba_characteristics rdc_data;
451da177e4SLinus Torvalds };
461da177e4SLinus Torvalds 
471da177e4SLinus Torvalds static struct ccw_device_id dasd_fba_ids[] = {
48d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x6310, 0, 0x9336, 0), .driver_info = 0x1},
49d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x3880, 0, 0x3370, 0), .driver_info = 0x2},
501da177e4SLinus Torvalds 	{ /* end of list */ },
511da177e4SLinus Torvalds };
521da177e4SLinus Torvalds 
531da177e4SLinus Torvalds MODULE_DEVICE_TABLE(ccw, dasd_fba_ids);
541da177e4SLinus Torvalds 
551da177e4SLinus Torvalds static struct ccw_driver dasd_fba_driver; /* see below */
561da177e4SLinus Torvalds static int
571da177e4SLinus Torvalds dasd_fba_probe(struct ccw_device *cdev)
581da177e4SLinus Torvalds {
5940545573SHorst Hummel 	return dasd_generic_probe(cdev, &dasd_fba_discipline);
601da177e4SLinus Torvalds }
611da177e4SLinus Torvalds 
621da177e4SLinus Torvalds static int
631da177e4SLinus Torvalds dasd_fba_set_online(struct ccw_device *cdev)
641da177e4SLinus Torvalds {
651da177e4SLinus Torvalds 	return dasd_generic_set_online(cdev, &dasd_fba_discipline);
661da177e4SLinus Torvalds }
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds static struct ccw_driver dasd_fba_driver = {
693bda058bSSebastian Ott 	.driver = {
701da177e4SLinus Torvalds 		.name	= "dasd-fba",
711da177e4SLinus Torvalds 		.owner	= THIS_MODULE,
723bda058bSSebastian Ott 	},
731da177e4SLinus Torvalds 	.ids         = dasd_fba_ids,
741da177e4SLinus Torvalds 	.probe       = dasd_fba_probe,
751da177e4SLinus Torvalds 	.remove      = dasd_generic_remove,
761da177e4SLinus Torvalds 	.set_offline = dasd_generic_set_offline,
771da177e4SLinus Torvalds 	.set_online  = dasd_fba_set_online,
781da177e4SLinus Torvalds 	.notify      = dasd_generic_notify,
79a4d26c6aSStefan Weinhuber 	.path_event  = dasd_generic_path_event,
80d41dd122SStefan Haberland 	.freeze      = dasd_generic_pm_freeze,
81d41dd122SStefan Haberland 	.thaw	     = dasd_generic_restore_device,
82d41dd122SStefan Haberland 	.restore     = dasd_generic_restore_device,
83420f42ecSHeiko Carstens 	.int_class   = IRQIO_DAS,
841da177e4SLinus Torvalds };
851da177e4SLinus Torvalds 
864d284cacSHeiko Carstens static void
871da177e4SLinus Torvalds define_extent(struct ccw1 * ccw, struct DE_fba_data *data, int rw,
881da177e4SLinus Torvalds 	      int blksize, int beg, int nr)
891da177e4SLinus Torvalds {
901da177e4SLinus Torvalds 	ccw->cmd_code = DASD_FBA_CCW_DEFINE_EXTENT;
911da177e4SLinus Torvalds 	ccw->flags = 0;
921da177e4SLinus Torvalds 	ccw->count = 16;
931da177e4SLinus Torvalds 	ccw->cda = (__u32) __pa(data);
941da177e4SLinus Torvalds 	memset(data, 0, sizeof (struct DE_fba_data));
951da177e4SLinus Torvalds 	if (rw == WRITE)
961da177e4SLinus Torvalds 		(data->mask).perm = 0x0;
971da177e4SLinus Torvalds 	else if (rw == READ)
981da177e4SLinus Torvalds 		(data->mask).perm = 0x1;
991da177e4SLinus Torvalds 	else
1001da177e4SLinus Torvalds 		data->mask.perm = 0x2;
1011da177e4SLinus Torvalds 	data->blk_size = blksize;
1021da177e4SLinus Torvalds 	data->ext_loc = beg;
1031da177e4SLinus Torvalds 	data->ext_end = nr - 1;
1041da177e4SLinus Torvalds }
1051da177e4SLinus Torvalds 
1064d284cacSHeiko Carstens static void
1071da177e4SLinus Torvalds locate_record(struct ccw1 * ccw, struct LO_fba_data *data, int rw,
1081da177e4SLinus Torvalds 	      int block_nr, int block_ct)
1091da177e4SLinus Torvalds {
1101da177e4SLinus Torvalds 	ccw->cmd_code = DASD_FBA_CCW_LOCATE;
1111da177e4SLinus Torvalds 	ccw->flags = 0;
1121da177e4SLinus Torvalds 	ccw->count = 8;
1131da177e4SLinus Torvalds 	ccw->cda = (__u32) __pa(data);
1141da177e4SLinus Torvalds 	memset(data, 0, sizeof (struct LO_fba_data));
1151da177e4SLinus Torvalds 	if (rw == WRITE)
1161da177e4SLinus Torvalds 		data->operation.cmd = 0x5;
1171da177e4SLinus Torvalds 	else if (rw == READ)
1181da177e4SLinus Torvalds 		data->operation.cmd = 0x6;
1191da177e4SLinus Torvalds 	else
1201da177e4SLinus Torvalds 		data->operation.cmd = 0x8;
1211da177e4SLinus Torvalds 	data->blk_nr = block_nr;
1221da177e4SLinus Torvalds 	data->blk_ct = block_ct;
1231da177e4SLinus Torvalds }
1241da177e4SLinus Torvalds 
1251da177e4SLinus Torvalds static int
1261da177e4SLinus Torvalds dasd_fba_check_characteristics(struct dasd_device *device)
1271da177e4SLinus Torvalds {
128543691a4SSebastian Ott 	struct dasd_fba_private *private = device->private;
1291da177e4SLinus Torvalds 	struct ccw_device *cdev = device->cdev;
130543691a4SSebastian Ott 	struct dasd_block *block;
131543691a4SSebastian Ott 	int readonly, rc;
1321da177e4SLinus Torvalds 
13392636b15SSebastian Ott 	if (!private) {
13492636b15SSebastian Ott 		private = kzalloc(sizeof(*private), GFP_KERNEL | GFP_DMA);
13592636b15SSebastian Ott 		if (!private) {
136fc19f381SStefan Haberland 			dev_warn(&device->cdev->dev,
137fc19f381SStefan Haberland 				 "Allocating memory for private DASD "
138fc19f381SStefan Haberland 				 "data failed\n");
1391da177e4SLinus Torvalds 			return -ENOMEM;
1401da177e4SLinus Torvalds 		}
141543691a4SSebastian Ott 		device->private = private;
14292636b15SSebastian Ott 	} else {
14392636b15SSebastian Ott 		memset(private, 0, sizeof(*private));
1441da177e4SLinus Torvalds 	}
1458e09f215SStefan Weinhuber 	block = dasd_alloc_block();
1468e09f215SStefan Weinhuber 	if (IS_ERR(block)) {
147b8ed5dd5SStefan Haberland 		DBF_EVENT_DEVID(DBF_WARNING, cdev, "%s", "could not allocate "
148b8ed5dd5SStefan Haberland 				"dasd block structure");
1497337194fSCornelia Huck 		device->private = NULL;
1507337194fSCornelia Huck 		kfree(private);
1518e09f215SStefan Weinhuber 		return PTR_ERR(block);
1528e09f215SStefan Weinhuber 	}
1538e09f215SStefan Weinhuber 	device->block = block;
1548e09f215SStefan Weinhuber 	block->base = device;
1558e09f215SStefan Weinhuber 
1561da177e4SLinus Torvalds 	/* Read Device Characteristics */
15768b781feSStefan Haberland 	rc = dasd_generic_read_dev_chars(device, DASD_FBA_MAGIC,
15868b781feSStefan Haberland 					 &private->rdc_data, 32);
1591da177e4SLinus Torvalds 	if (rc) {
160b8ed5dd5SStefan Haberland 		DBF_EVENT_DEVID(DBF_WARNING, cdev, "Read device "
161b8ed5dd5SStefan Haberland 				"characteristics returned error %d", rc);
1627337194fSCornelia Huck 		device->block = NULL;
1637337194fSCornelia Huck 		dasd_free_block(block);
1647337194fSCornelia Huck 		device->private = NULL;
1657337194fSCornelia Huck 		kfree(private);
1661da177e4SLinus Torvalds 		return rc;
1671da177e4SLinus Torvalds 	}
1681da177e4SLinus Torvalds 
1697c8faa86SStefan Haberland 	device->default_expires = DASD_EXPIRES;
1701f1ee9adSHannes Reinecke 	device->default_retries = FBA_DEFAULT_RETRIES;
171c9346151SStefan Haberland 	dasd_path_set_opm(device, LPM_ANYPATH);
1727c8faa86SStefan Haberland 
17333b62a30SStefan Weinhuber 	readonly = dasd_device_is_ro(device);
17433b62a30SStefan Weinhuber 	if (readonly)
17533b62a30SStefan Weinhuber 		set_bit(DASD_FLAG_DEVICE_RO, &device->flags);
17633b62a30SStefan Weinhuber 
17728b841b3SJan Höppner 	/* FBA supports discard, set the according feature bit */
17828b841b3SJan Höppner 	dasd_set_feature(cdev, DASD_FEATURE_DISCARD, 1);
17928b841b3SJan Höppner 
180fc19f381SStefan Haberland 	dev_info(&device->cdev->dev,
181fc19f381SStefan Haberland 		 "New FBA DASD %04X/%02X (CU %04X/%02X) with %d MB "
18233b62a30SStefan Weinhuber 		 "and %d B/blk%s\n",
1831da177e4SLinus Torvalds 		 cdev->id.dev_type,
1841da177e4SLinus Torvalds 		 cdev->id.dev_model,
1851da177e4SLinus Torvalds 		 cdev->id.cu_type,
1861da177e4SLinus Torvalds 		 cdev->id.cu_model,
1871da177e4SLinus Torvalds 		 ((private->rdc_data.blk_bdsa *
1881da177e4SLinus Torvalds 		   (private->rdc_data.blk_size >> 9)) >> 11),
18933b62a30SStefan Weinhuber 		 private->rdc_data.blk_size,
19033b62a30SStefan Weinhuber 		 readonly ? ", read-only device" : "");
1911da177e4SLinus Torvalds 	return 0;
1921da177e4SLinus Torvalds }
1931da177e4SLinus Torvalds 
1948e09f215SStefan Weinhuber static int dasd_fba_do_analysis(struct dasd_block *block)
1951da177e4SLinus Torvalds {
196543691a4SSebastian Ott 	struct dasd_fba_private *private = block->base->private;
1971da177e4SLinus Torvalds 	int sb, rc;
1981da177e4SLinus Torvalds 
1991da177e4SLinus Torvalds 	rc = dasd_check_blocksize(private->rdc_data.blk_size);
2001da177e4SLinus Torvalds 	if (rc) {
201fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, block->base, "unknown blocksize %d",
2021da177e4SLinus Torvalds 			    private->rdc_data.blk_size);
2031da177e4SLinus Torvalds 		return rc;
2041da177e4SLinus Torvalds 	}
2058e09f215SStefan Weinhuber 	block->blocks = private->rdc_data.blk_bdsa;
2068e09f215SStefan Weinhuber 	block->bp_block = private->rdc_data.blk_size;
2078e09f215SStefan Weinhuber 	block->s2b_shift = 0;	/* bits to shift 512 to get a block */
2081da177e4SLinus Torvalds 	for (sb = 512; sb < private->rdc_data.blk_size; sb = sb << 1)
2098e09f215SStefan Weinhuber 		block->s2b_shift++;
2101da177e4SLinus Torvalds 	return 0;
2111da177e4SLinus Torvalds }
2121da177e4SLinus Torvalds 
2138e09f215SStefan Weinhuber static int dasd_fba_fill_geometry(struct dasd_block *block,
2148e09f215SStefan Weinhuber 				  struct hd_geometry *geo)
2151da177e4SLinus Torvalds {
2168e09f215SStefan Weinhuber 	if (dasd_check_blocksize(block->bp_block) != 0)
2171da177e4SLinus Torvalds 		return -EINVAL;
2188e09f215SStefan Weinhuber 	geo->cylinders = (block->blocks << block->s2b_shift) >> 10;
2191da177e4SLinus Torvalds 	geo->heads = 16;
2208e09f215SStefan Weinhuber 	geo->sectors = 128 >> block->s2b_shift;
2211da177e4SLinus Torvalds 	return 0;
2221da177e4SLinus Torvalds }
2231da177e4SLinus Torvalds 
2241da177e4SLinus Torvalds static dasd_erp_fn_t
2251da177e4SLinus Torvalds dasd_fba_erp_action(struct dasd_ccw_req * cqr)
2261da177e4SLinus Torvalds {
2271da177e4SLinus Torvalds 	return dasd_default_erp_action;
2281da177e4SLinus Torvalds }
2291da177e4SLinus Torvalds 
2301da177e4SLinus Torvalds static dasd_erp_fn_t
2311da177e4SLinus Torvalds dasd_fba_erp_postaction(struct dasd_ccw_req * cqr)
2321da177e4SLinus Torvalds {
2331da177e4SLinus Torvalds 	if (cqr->function == dasd_default_erp_action)
2341da177e4SLinus Torvalds 		return dasd_default_erp_postaction;
2351da177e4SLinus Torvalds 
236fc19f381SStefan Haberland 	DBF_DEV_EVENT(DBF_WARNING, cqr->startdev, "unknown ERP action %p",
2371da177e4SLinus Torvalds 		    cqr->function);
2381da177e4SLinus Torvalds 	return NULL;
2391da177e4SLinus Torvalds }
2401da177e4SLinus Torvalds 
2415a27e60dSStefan Weinhuber static void dasd_fba_check_for_device_change(struct dasd_device *device,
2425a27e60dSStefan Weinhuber 					     struct dasd_ccw_req *cqr,
2438e09f215SStefan Weinhuber 					     struct irb *irb)
2448e09f215SStefan Weinhuber {
2458e09f215SStefan Weinhuber 	char mask;
2468e09f215SStefan Weinhuber 
2478e09f215SStefan Weinhuber 	/* first of all check for state change pending interrupt */
2488e09f215SStefan Weinhuber 	mask = DEV_STAT_ATTENTION | DEV_STAT_DEV_END | DEV_STAT_UNIT_EXCEP;
2495a27e60dSStefan Weinhuber 	if ((irb->scsw.cmd.dstat & mask) == mask)
2508e09f215SStefan Weinhuber 		dasd_generic_handle_state_change(device);
2518e09f215SStefan Weinhuber };
2528e09f215SStefan Weinhuber 
25328b841b3SJan Höppner 
25428b841b3SJan Höppner /*
25528b841b3SJan Höppner  * Builds a CCW with no data payload
25628b841b3SJan Höppner  */
25728b841b3SJan Höppner static void ccw_write_no_data(struct ccw1 *ccw)
25828b841b3SJan Höppner {
25928b841b3SJan Höppner 	ccw->cmd_code = DASD_FBA_CCW_WRITE;
26028b841b3SJan Höppner 	ccw->flags |= CCW_FLAG_SLI;
26128b841b3SJan Höppner 	ccw->count = 0;
26228b841b3SJan Höppner }
26328b841b3SJan Höppner 
26428b841b3SJan Höppner /*
26528b841b3SJan Höppner  * Builds a CCW that writes only zeroes.
26628b841b3SJan Höppner  */
26728b841b3SJan Höppner static void ccw_write_zero(struct ccw1 *ccw, int count)
26828b841b3SJan Höppner {
26928b841b3SJan Höppner 	ccw->cmd_code = DASD_FBA_CCW_WRITE;
27028b841b3SJan Höppner 	ccw->flags |= CCW_FLAG_SLI;
27128b841b3SJan Höppner 	ccw->count = count;
27228b841b3SJan Höppner 	ccw->cda = (__u32) (addr_t) page_to_phys(ZERO_PAGE(0));
27328b841b3SJan Höppner }
27428b841b3SJan Höppner 
27528b841b3SJan Höppner /*
27628b841b3SJan Höppner  * Helper function to count the amount of necessary CCWs within a given range
27728b841b3SJan Höppner  * with 4k alignment and command chaining in mind.
27828b841b3SJan Höppner  */
27928b841b3SJan Höppner static int count_ccws(sector_t first_rec, sector_t last_rec,
28028b841b3SJan Höppner 		      unsigned int blocks_per_page)
28128b841b3SJan Höppner {
28228b841b3SJan Höppner 	sector_t wz_stop = 0, d_stop = 0;
28328b841b3SJan Höppner 	int cur_pos = 0;
28428b841b3SJan Höppner 	int count = 0;
28528b841b3SJan Höppner 
28628b841b3SJan Höppner 	if (first_rec % blocks_per_page != 0) {
28728b841b3SJan Höppner 		wz_stop = first_rec + blocks_per_page -
28828b841b3SJan Höppner 			(first_rec % blocks_per_page) - 1;
28928b841b3SJan Höppner 		if (wz_stop > last_rec)
29028b841b3SJan Höppner 			wz_stop = last_rec;
29128b841b3SJan Höppner 		cur_pos = wz_stop - first_rec + 1;
29228b841b3SJan Höppner 		count++;
29328b841b3SJan Höppner 	}
29428b841b3SJan Höppner 
29528b841b3SJan Höppner 	if (last_rec - (first_rec + cur_pos) + 1 >= blocks_per_page) {
29628b841b3SJan Höppner 		if ((last_rec - blocks_per_page + 1) % blocks_per_page != 0)
29728b841b3SJan Höppner 			d_stop = last_rec - ((last_rec - blocks_per_page + 1) %
29828b841b3SJan Höppner 					     blocks_per_page);
29928b841b3SJan Höppner 		else
30028b841b3SJan Höppner 			d_stop = last_rec;
30128b841b3SJan Höppner 
30228b841b3SJan Höppner 		cur_pos += d_stop - (first_rec + cur_pos) + 1;
30328b841b3SJan Höppner 		count++;
30428b841b3SJan Höppner 	}
30528b841b3SJan Höppner 
30628b841b3SJan Höppner 	if (cur_pos == 0 || first_rec + cur_pos - 1 < last_rec)
30728b841b3SJan Höppner 		count++;
30828b841b3SJan Höppner 
30928b841b3SJan Höppner 	return count;
31028b841b3SJan Höppner }
31128b841b3SJan Höppner 
31228b841b3SJan Höppner /*
31328b841b3SJan Höppner  * This function builds a CCW request for block layer discard requests.
31428b841b3SJan Höppner  * Each page in the z/VM hypervisor that represents certain records of an FBA
31528b841b3SJan Höppner  * device will be padded with zeros. This is a special behaviour of the WRITE
31628b841b3SJan Höppner  * command which is triggered when no data payload is added to the CCW.
31728b841b3SJan Höppner  *
31828b841b3SJan Höppner  * Note: Due to issues in some z/VM versions, we can't fully utilise this
31928b841b3SJan Höppner  * special behaviour. We have to keep a 4k (or 8 block) alignment in mind to
32028b841b3SJan Höppner  * work around those issues and write actual zeroes to the unaligned parts in
32128b841b3SJan Höppner  * the request. This workaround might be removed in the future.
32228b841b3SJan Höppner  */
32328b841b3SJan Höppner static struct dasd_ccw_req *dasd_fba_build_cp_discard(
32428b841b3SJan Höppner 						struct dasd_device *memdev,
32528b841b3SJan Höppner 						struct dasd_block *block,
32628b841b3SJan Höppner 						struct request *req)
32728b841b3SJan Höppner {
32828b841b3SJan Höppner 	struct LO_fba_data *LO_data;
32928b841b3SJan Höppner 	struct dasd_ccw_req *cqr;
33028b841b3SJan Höppner 	struct ccw1 *ccw;
33128b841b3SJan Höppner 
33228b841b3SJan Höppner 	sector_t wz_stop = 0, d_stop = 0;
33328b841b3SJan Höppner 	sector_t first_rec, last_rec;
33428b841b3SJan Höppner 
33528b841b3SJan Höppner 	unsigned int blksize = block->bp_block;
33628b841b3SJan Höppner 	unsigned int blocks_per_page;
33728b841b3SJan Höppner 	int wz_count = 0;
33828b841b3SJan Höppner 	int d_count = 0;
33928b841b3SJan Höppner 	int cur_pos = 0; /* Current position within the extent */
34028b841b3SJan Höppner 	int count = 0;
34128b841b3SJan Höppner 	int cplength;
34228b841b3SJan Höppner 	int datasize;
34328b841b3SJan Höppner 	int nr_ccws;
34428b841b3SJan Höppner 
34528b841b3SJan Höppner 	first_rec = blk_rq_pos(req) >> block->s2b_shift;
34628b841b3SJan Höppner 	last_rec =
34728b841b3SJan Höppner 		(blk_rq_pos(req) + blk_rq_sectors(req) - 1) >> block->s2b_shift;
34828b841b3SJan Höppner 	count = last_rec - first_rec + 1;
34928b841b3SJan Höppner 
35028b841b3SJan Höppner 	blocks_per_page = BLOCKS_PER_PAGE(blksize);
35128b841b3SJan Höppner 	nr_ccws = count_ccws(first_rec, last_rec, blocks_per_page);
35228b841b3SJan Höppner 
35328b841b3SJan Höppner 	/* define extent + nr_ccws * locate record + nr_ccws * single CCW */
35428b841b3SJan Höppner 	cplength = 1 + 2 * nr_ccws;
35528b841b3SJan Höppner 	datasize = sizeof(struct DE_fba_data) +
35628b841b3SJan Höppner 		nr_ccws * (sizeof(struct LO_fba_data) + sizeof(struct ccw1));
35728b841b3SJan Höppner 
35828b841b3SJan Höppner 	cqr = dasd_smalloc_request(DASD_FBA_MAGIC, cplength, datasize, memdev);
35928b841b3SJan Höppner 	if (IS_ERR(cqr))
36028b841b3SJan Höppner 		return cqr;
36128b841b3SJan Höppner 
36228b841b3SJan Höppner 	ccw = cqr->cpaddr;
36328b841b3SJan Höppner 
36428b841b3SJan Höppner 	define_extent(ccw++, cqr->data, WRITE, blksize, first_rec, count);
36528b841b3SJan Höppner 	LO_data = cqr->data + sizeof(struct DE_fba_data);
36628b841b3SJan Höppner 
36728b841b3SJan Höppner 	/* First part is not aligned. Calculate range to write zeroes. */
36828b841b3SJan Höppner 	if (first_rec % blocks_per_page != 0) {
36928b841b3SJan Höppner 		wz_stop = first_rec + blocks_per_page -
37028b841b3SJan Höppner 			(first_rec % blocks_per_page) - 1;
37128b841b3SJan Höppner 		if (wz_stop > last_rec)
37228b841b3SJan Höppner 			wz_stop = last_rec;
37328b841b3SJan Höppner 		wz_count = wz_stop - first_rec + 1;
37428b841b3SJan Höppner 
37528b841b3SJan Höppner 		ccw[-1].flags |= CCW_FLAG_CC;
37628b841b3SJan Höppner 		locate_record(ccw++, LO_data++, WRITE, cur_pos, wz_count);
37728b841b3SJan Höppner 
37828b841b3SJan Höppner 		ccw[-1].flags |= CCW_FLAG_CC;
37928b841b3SJan Höppner 		ccw_write_zero(ccw++, wz_count * blksize);
38028b841b3SJan Höppner 
38128b841b3SJan Höppner 		cur_pos = wz_count;
38228b841b3SJan Höppner 	}
38328b841b3SJan Höppner 
38428b841b3SJan Höppner 	/* We can do proper discard when we've got at least blocks_per_page blocks. */
38528b841b3SJan Höppner 	if (last_rec - (first_rec + cur_pos) + 1 >= blocks_per_page) {
38628b841b3SJan Höppner 		/* is last record at page boundary? */
38728b841b3SJan Höppner 		if ((last_rec - blocks_per_page + 1) % blocks_per_page != 0)
38828b841b3SJan Höppner 			d_stop = last_rec - ((last_rec - blocks_per_page + 1) %
38928b841b3SJan Höppner 					     blocks_per_page);
39028b841b3SJan Höppner 		else
39128b841b3SJan Höppner 			d_stop = last_rec;
39228b841b3SJan Höppner 
39328b841b3SJan Höppner 		d_count = d_stop - (first_rec + cur_pos) + 1;
39428b841b3SJan Höppner 
39528b841b3SJan Höppner 		ccw[-1].flags |= CCW_FLAG_CC;
39628b841b3SJan Höppner 		locate_record(ccw++, LO_data++, WRITE, cur_pos, d_count);
39728b841b3SJan Höppner 
39828b841b3SJan Höppner 		ccw[-1].flags |= CCW_FLAG_CC;
39928b841b3SJan Höppner 		ccw_write_no_data(ccw++);
40028b841b3SJan Höppner 
40128b841b3SJan Höppner 		cur_pos += d_count;
40228b841b3SJan Höppner 	}
40328b841b3SJan Höppner 
40428b841b3SJan Höppner 	/* We might still have some bits left which need to be zeroed. */
40528b841b3SJan Höppner 	if (cur_pos == 0 || first_rec + cur_pos - 1 < last_rec) {
40628b841b3SJan Höppner 		if (d_stop != 0)
40728b841b3SJan Höppner 			wz_count = last_rec - d_stop;
40828b841b3SJan Höppner 		else if (wz_stop != 0)
40928b841b3SJan Höppner 			wz_count = last_rec - wz_stop;
41028b841b3SJan Höppner 		else
41128b841b3SJan Höppner 			wz_count = count;
41228b841b3SJan Höppner 
41328b841b3SJan Höppner 		ccw[-1].flags |= CCW_FLAG_CC;
41428b841b3SJan Höppner 		locate_record(ccw++, LO_data++, WRITE, cur_pos, wz_count);
41528b841b3SJan Höppner 
41628b841b3SJan Höppner 		ccw[-1].flags |= CCW_FLAG_CC;
41728b841b3SJan Höppner 		ccw_write_zero(ccw++, wz_count * blksize);
41828b841b3SJan Höppner 	}
41928b841b3SJan Höppner 
42028b841b3SJan Höppner 	if (blk_noretry_request(req) ||
42128b841b3SJan Höppner 	    block->base->features & DASD_FEATURE_FAILFAST)
42228b841b3SJan Höppner 		set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
42328b841b3SJan Höppner 
42428b841b3SJan Höppner 	cqr->startdev = memdev;
42528b841b3SJan Höppner 	cqr->memdev = memdev;
42628b841b3SJan Höppner 	cqr->block = block;
42728b841b3SJan Höppner 	cqr->expires = memdev->default_expires * HZ;	/* default 5 minutes */
42828b841b3SJan Höppner 	cqr->retries = memdev->default_retries;
42928b841b3SJan Höppner 	cqr->buildclk = get_tod_clock();
43028b841b3SJan Höppner 	cqr->status = DASD_CQR_FILLED;
43128b841b3SJan Höppner 
43228b841b3SJan Höppner 	return cqr;
43328b841b3SJan Höppner }
43428b841b3SJan Höppner 
43528b841b3SJan Höppner static struct dasd_ccw_req *dasd_fba_build_cp_regular(
43628b841b3SJan Höppner 						struct dasd_device *memdev,
4378e09f215SStefan Weinhuber 						struct dasd_block *block,
4388e09f215SStefan Weinhuber 						struct request *req)
4391da177e4SLinus Torvalds {
440543691a4SSebastian Ott 	struct dasd_fba_private *private = block->base->private;
4411da177e4SLinus Torvalds 	unsigned long *idaws;
4421da177e4SLinus Torvalds 	struct LO_fba_data *LO_data;
4431da177e4SLinus Torvalds 	struct dasd_ccw_req *cqr;
4441da177e4SLinus Torvalds 	struct ccw1 *ccw;
4455705f702SNeilBrown 	struct req_iterator iter;
4467988613bSKent Overstreet 	struct bio_vec bv;
4471da177e4SLinus Torvalds 	char *dst;
4481da177e4SLinus Torvalds 	int count, cidaw, cplength, datasize;
4491da177e4SLinus Torvalds 	sector_t recid, first_rec, last_rec;
4501da177e4SLinus Torvalds 	unsigned int blksize, off;
4511da177e4SLinus Torvalds 	unsigned char cmd;
4521da177e4SLinus Torvalds 
4531da177e4SLinus Torvalds 	if (rq_data_dir(req) == READ) {
4541da177e4SLinus Torvalds 		cmd = DASD_FBA_CCW_READ;
4551da177e4SLinus Torvalds 	} else if (rq_data_dir(req) == WRITE) {
4561da177e4SLinus Torvalds 		cmd = DASD_FBA_CCW_WRITE;
4571da177e4SLinus Torvalds 	} else
4581da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
4598e09f215SStefan Weinhuber 	blksize = block->bp_block;
4601da177e4SLinus Torvalds 	/* Calculate record id of first and last block. */
46183096ebfSTejun Heo 	first_rec = blk_rq_pos(req) >> block->s2b_shift;
46283096ebfSTejun Heo 	last_rec =
46383096ebfSTejun Heo 		(blk_rq_pos(req) + blk_rq_sectors(req) - 1) >> block->s2b_shift;
4641da177e4SLinus Torvalds 	/* Check struct bio and count the number of blocks for the request. */
4651da177e4SLinus Torvalds 	count = 0;
4661da177e4SLinus Torvalds 	cidaw = 0;
4675705f702SNeilBrown 	rq_for_each_segment(bv, req, iter) {
4687988613bSKent Overstreet 		if (bv.bv_len & (blksize - 1))
4691da177e4SLinus Torvalds 			/* Fba can only do full blocks. */
4701da177e4SLinus Torvalds 			return ERR_PTR(-EINVAL);
4717988613bSKent Overstreet 		count += bv.bv_len >> (block->s2b_shift + 9);
4727988613bSKent Overstreet 		if (idal_is_needed (page_address(bv.bv_page), bv.bv_len))
4737988613bSKent Overstreet 			cidaw += bv.bv_len / blksize;
4741da177e4SLinus Torvalds 	}
4751da177e4SLinus Torvalds 	/* Paranoia. */
4761da177e4SLinus Torvalds 	if (count != last_rec - first_rec + 1)
4771da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
4781da177e4SLinus Torvalds 	/* 1x define extent + 1x locate record + number of blocks */
4791da177e4SLinus Torvalds 	cplength = 2 + count;
4801da177e4SLinus Torvalds 	/* 1x define extent + 1x locate record */
4811da177e4SLinus Torvalds 	datasize = sizeof(struct DE_fba_data) + sizeof(struct LO_fba_data) +
4821da177e4SLinus Torvalds 		cidaw * sizeof(unsigned long);
4831da177e4SLinus Torvalds 	/*
4841da177e4SLinus Torvalds 	 * Find out number of additional locate record ccws if the device
4851da177e4SLinus Torvalds 	 * can't do data chaining.
4861da177e4SLinus Torvalds 	 */
4871da177e4SLinus Torvalds 	if (private->rdc_data.mode.bits.data_chain == 0) {
4881da177e4SLinus Torvalds 		cplength += count - 1;
4891da177e4SLinus Torvalds 		datasize += (count - 1)*sizeof(struct LO_fba_data);
4901da177e4SLinus Torvalds 	}
4911da177e4SLinus Torvalds 	/* Allocate the ccw request. */
49268b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_FBA_MAGIC, cplength, datasize, memdev);
4931da177e4SLinus Torvalds 	if (IS_ERR(cqr))
4941da177e4SLinus Torvalds 		return cqr;
4951da177e4SLinus Torvalds 	ccw = cqr->cpaddr;
4961da177e4SLinus Torvalds 	/* First ccw is define extent. */
4971da177e4SLinus Torvalds 	define_extent(ccw++, cqr->data, rq_data_dir(req),
49883096ebfSTejun Heo 		      block->bp_block, blk_rq_pos(req), blk_rq_sectors(req));
4991da177e4SLinus Torvalds 	/* Build locate_record + read/write ccws. */
5001da177e4SLinus Torvalds 	idaws = (unsigned long *) (cqr->data + sizeof(struct DE_fba_data));
5011da177e4SLinus Torvalds 	LO_data = (struct LO_fba_data *) (idaws + cidaw);
5021da177e4SLinus Torvalds 	/* Locate record for all blocks for smart devices. */
5031da177e4SLinus Torvalds 	if (private->rdc_data.mode.bits.data_chain != 0) {
5041da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
5051da177e4SLinus Torvalds 		locate_record(ccw++, LO_data++, rq_data_dir(req), 0, count);
5061da177e4SLinus Torvalds 	}
5071da177e4SLinus Torvalds 	recid = first_rec;
5085705f702SNeilBrown 	rq_for_each_segment(bv, req, iter) {
5097988613bSKent Overstreet 		dst = page_address(bv.bv_page) + bv.bv_offset;
5101da177e4SLinus Torvalds 		if (dasd_page_cache) {
5111da177e4SLinus Torvalds 			char *copy = kmem_cache_alloc(dasd_page_cache,
512441e143eSChristoph Lameter 						      GFP_DMA | __GFP_NOWARN);
5131da177e4SLinus Torvalds 			if (copy && rq_data_dir(req) == WRITE)
5147988613bSKent Overstreet 				memcpy(copy + bv.bv_offset, dst, bv.bv_len);
5151da177e4SLinus Torvalds 			if (copy)
5167988613bSKent Overstreet 				dst = copy + bv.bv_offset;
5171da177e4SLinus Torvalds 		}
5187988613bSKent Overstreet 		for (off = 0; off < bv.bv_len; off += blksize) {
5191da177e4SLinus Torvalds 			/* Locate record for stupid devices. */
5201da177e4SLinus Torvalds 			if (private->rdc_data.mode.bits.data_chain == 0) {
5211da177e4SLinus Torvalds 				ccw[-1].flags |= CCW_FLAG_CC;
5221da177e4SLinus Torvalds 				locate_record(ccw, LO_data++,
5231da177e4SLinus Torvalds 					      rq_data_dir(req),
5241da177e4SLinus Torvalds 					      recid - first_rec, 1);
5251da177e4SLinus Torvalds 				ccw->flags = CCW_FLAG_CC;
5261da177e4SLinus Torvalds 				ccw++;
5271da177e4SLinus Torvalds 			} else {
5281da177e4SLinus Torvalds 				if (recid > first_rec)
5291da177e4SLinus Torvalds 					ccw[-1].flags |= CCW_FLAG_DC;
5301da177e4SLinus Torvalds 				else
5311da177e4SLinus Torvalds 					ccw[-1].flags |= CCW_FLAG_CC;
5321da177e4SLinus Torvalds 			}
5331da177e4SLinus Torvalds 			ccw->cmd_code = cmd;
5348e09f215SStefan Weinhuber 			ccw->count = block->bp_block;
5351da177e4SLinus Torvalds 			if (idal_is_needed(dst, blksize)) {
5361da177e4SLinus Torvalds 				ccw->cda = (__u32)(addr_t) idaws;
5371da177e4SLinus Torvalds 				ccw->flags = CCW_FLAG_IDA;
5381da177e4SLinus Torvalds 				idaws = idal_create_words(idaws, dst, blksize);
5391da177e4SLinus Torvalds 			} else {
5401da177e4SLinus Torvalds 				ccw->cda = (__u32)(addr_t) dst;
5411da177e4SLinus Torvalds 				ccw->flags = 0;
5421da177e4SLinus Torvalds 			}
5431da177e4SLinus Torvalds 			ccw++;
5441da177e4SLinus Torvalds 			dst += blksize;
5451da177e4SLinus Torvalds 			recid++;
5461da177e4SLinus Torvalds 		}
5471da177e4SLinus Torvalds 	}
54813de227bSHolger Smolinski 	if (blk_noretry_request(req) ||
54913de227bSHolger Smolinski 	    block->base->features & DASD_FEATURE_FAILFAST)
5501c01b8a5SHorst Hummel 		set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
5518e09f215SStefan Weinhuber 	cqr->startdev = memdev;
5528e09f215SStefan Weinhuber 	cqr->memdev = memdev;
5538e09f215SStefan Weinhuber 	cqr->block = block;
5547c8faa86SStefan Haberland 	cqr->expires = memdev->default_expires * HZ;	/* default 5 minutes */
5551f1ee9adSHannes Reinecke 	cqr->retries = memdev->default_retries;
5561aae0560SHeiko Carstens 	cqr->buildclk = get_tod_clock();
5571da177e4SLinus Torvalds 	cqr->status = DASD_CQR_FILLED;
5581da177e4SLinus Torvalds 	return cqr;
5591da177e4SLinus Torvalds }
5601da177e4SLinus Torvalds 
56128b841b3SJan Höppner static struct dasd_ccw_req *dasd_fba_build_cp(struct dasd_device *memdev,
56228b841b3SJan Höppner 					      struct dasd_block *block,
56328b841b3SJan Höppner 					      struct request *req)
56428b841b3SJan Höppner {
56528b841b3SJan Höppner 	if (req_op(req) == REQ_OP_DISCARD || req_op(req) == REQ_OP_WRITE_ZEROES)
56628b841b3SJan Höppner 		return dasd_fba_build_cp_discard(memdev, block, req);
56728b841b3SJan Höppner 	else
56828b841b3SJan Höppner 		return dasd_fba_build_cp_regular(memdev, block, req);
56928b841b3SJan Höppner }
57028b841b3SJan Höppner 
5711da177e4SLinus Torvalds static int
5721da177e4SLinus Torvalds dasd_fba_free_cp(struct dasd_ccw_req *cqr, struct request *req)
5731da177e4SLinus Torvalds {
574543691a4SSebastian Ott 	struct dasd_fba_private *private = cqr->block->base->private;
5751da177e4SLinus Torvalds 	struct ccw1 *ccw;
5765705f702SNeilBrown 	struct req_iterator iter;
5777988613bSKent Overstreet 	struct bio_vec bv;
5781da177e4SLinus Torvalds 	char *dst, *cda;
5791da177e4SLinus Torvalds 	unsigned int blksize, off;
5805705f702SNeilBrown 	int status;
5811da177e4SLinus Torvalds 
5821da177e4SLinus Torvalds 	if (!dasd_page_cache)
5831da177e4SLinus Torvalds 		goto out;
5848e09f215SStefan Weinhuber 	blksize = cqr->block->bp_block;
5851da177e4SLinus Torvalds 	ccw = cqr->cpaddr;
5861da177e4SLinus Torvalds 	/* Skip over define extent & locate record. */
5871da177e4SLinus Torvalds 	ccw++;
5881da177e4SLinus Torvalds 	if (private->rdc_data.mode.bits.data_chain != 0)
5891da177e4SLinus Torvalds 		ccw++;
5905705f702SNeilBrown 	rq_for_each_segment(bv, req, iter) {
5917988613bSKent Overstreet 		dst = page_address(bv.bv_page) + bv.bv_offset;
5927988613bSKent Overstreet 		for (off = 0; off < bv.bv_len; off += blksize) {
5931da177e4SLinus Torvalds 			/* Skip locate record. */
5941da177e4SLinus Torvalds 			if (private->rdc_data.mode.bits.data_chain == 0)
5951da177e4SLinus Torvalds 				ccw++;
5961da177e4SLinus Torvalds 			if (dst) {
5971da177e4SLinus Torvalds 				if (ccw->flags & CCW_FLAG_IDA)
5981da177e4SLinus Torvalds 					cda = *((char **)((addr_t) ccw->cda));
5991da177e4SLinus Torvalds 				else
6001da177e4SLinus Torvalds 					cda = (char *)((addr_t) ccw->cda);
6011da177e4SLinus Torvalds 				if (dst != cda) {
6021da177e4SLinus Torvalds 					if (rq_data_dir(req) == READ)
6037988613bSKent Overstreet 						memcpy(dst, cda, bv.bv_len);
6041da177e4SLinus Torvalds 					kmem_cache_free(dasd_page_cache,
6051da177e4SLinus Torvalds 					    (void *)((addr_t)cda & PAGE_MASK));
6061da177e4SLinus Torvalds 				}
6071da177e4SLinus Torvalds 				dst = NULL;
6081da177e4SLinus Torvalds 			}
6091da177e4SLinus Torvalds 			ccw++;
6101da177e4SLinus Torvalds 		}
6111da177e4SLinus Torvalds 	}
6121da177e4SLinus Torvalds out:
6131da177e4SLinus Torvalds 	status = cqr->status == DASD_CQR_DONE;
6148e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
6151da177e4SLinus Torvalds 	return status;
6161da177e4SLinus Torvalds }
6171da177e4SLinus Torvalds 
6188e09f215SStefan Weinhuber static void dasd_fba_handle_terminated_request(struct dasd_ccw_req *cqr)
6198e09f215SStefan Weinhuber {
620a2ace466SHannes Reinecke 	if (cqr->retries < 0)
621a2ace466SHannes Reinecke 		cqr->status = DASD_CQR_FAILED;
622a2ace466SHannes Reinecke 	else
6238e09f215SStefan Weinhuber 		cqr->status = DASD_CQR_FILLED;
6248e09f215SStefan Weinhuber };
6258e09f215SStefan Weinhuber 
6261da177e4SLinus Torvalds static int
6271da177e4SLinus Torvalds dasd_fba_fill_info(struct dasd_device * device,
6281da177e4SLinus Torvalds 		   struct dasd_information2_t * info)
6291da177e4SLinus Torvalds {
630543691a4SSebastian Ott 	struct dasd_fba_private *private = device->private;
631543691a4SSebastian Ott 
6321da177e4SLinus Torvalds 	info->label_block = 1;
6331da177e4SLinus Torvalds 	info->FBA_layout = 1;
6341da177e4SLinus Torvalds 	info->format = DASD_FORMAT_LDL;
635543691a4SSebastian Ott 	info->characteristics_size = sizeof(private->rdc_data);
636543691a4SSebastian Ott 	memcpy(info->characteristics, &private->rdc_data,
637543691a4SSebastian Ott 	       sizeof(private->rdc_data));
6381da177e4SLinus Torvalds 	info->confdata_size = 0;
6391da177e4SLinus Torvalds 	return 0;
6401da177e4SLinus Torvalds }
6411da177e4SLinus Torvalds 
6421da177e4SLinus Torvalds static void
643aeec92caSStefan Haberland dasd_fba_dump_sense_dbf(struct dasd_device *device, struct irb *irb,
644aeec92caSStefan Haberland 			char *reason)
645fc19f381SStefan Haberland {
646aeec92caSStefan Haberland 	u64 *sense;
647aeec92caSStefan Haberland 
648aeec92caSStefan Haberland 	sense = (u64 *) dasd_get_sense(irb);
649aeec92caSStefan Haberland 	if (sense) {
650fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_EMERG, device,
651aeec92caSStefan Haberland 			      "%s: %s %02x%02x%02x %016llx %016llx %016llx "
652aeec92caSStefan Haberland 			      "%016llx", reason,
653aeec92caSStefan Haberland 			      scsw_is_tm(&irb->scsw) ? "t" : "c",
654aeec92caSStefan Haberland 			      scsw_cc(&irb->scsw), scsw_cstat(&irb->scsw),
655aeec92caSStefan Haberland 			      scsw_dstat(&irb->scsw), sense[0], sense[1],
656aeec92caSStefan Haberland 			      sense[2], sense[3]);
657fc19f381SStefan Haberland 	} else {
658fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_EMERG, device, "%s",
659fc19f381SStefan Haberland 			      "SORRY - NO VALID SENSE AVAILABLE\n");
660fc19f381SStefan Haberland 	}
661fc19f381SStefan Haberland }
662fc19f381SStefan Haberland 
663fc19f381SStefan Haberland 
664fc19f381SStefan Haberland static void
6651da177e4SLinus Torvalds dasd_fba_dump_sense(struct dasd_device *device, struct dasd_ccw_req * req,
6661da177e4SLinus Torvalds 		    struct irb *irb)
6671da177e4SLinus Torvalds {
6681da177e4SLinus Torvalds 	char *page;
6691da177e4SLinus Torvalds 	struct ccw1 *act, *end, *last;
6701da177e4SLinus Torvalds 	int len, sl, sct, count;
6711da177e4SLinus Torvalds 
6721da177e4SLinus Torvalds 	page = (char *) get_zeroed_page(GFP_ATOMIC);
6731da177e4SLinus Torvalds 	if (page == NULL) {
674fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
6751da177e4SLinus Torvalds 			    "No memory to dump sense data");
6761da177e4SLinus Torvalds 		return;
6771da177e4SLinus Torvalds 	}
678773bab4aSSebastian Ott 	len = sprintf(page, PRINTK_HEADER
6791da177e4SLinus Torvalds 		      " I/O status report for device %s:\n",
6802a0217d5SKay Sievers 		      dev_name(&device->cdev->dev));
681773bab4aSSebastian Ott 	len += sprintf(page + len, PRINTK_HEADER
6821da177e4SLinus Torvalds 		       " in req: %p CS: 0x%02X DS: 0x%02X\n", req,
68323d805b6SPeter Oberparleiter 		       irb->scsw.cmd.cstat, irb->scsw.cmd.dstat);
684773bab4aSSebastian Ott 	len += sprintf(page + len, PRINTK_HEADER
6851da177e4SLinus Torvalds 		       " device %s: Failing CCW: %p\n",
6862a0217d5SKay Sievers 		       dev_name(&device->cdev->dev),
68723d805b6SPeter Oberparleiter 		       (void *) (addr_t) irb->scsw.cmd.cpa);
6881da177e4SLinus Torvalds 	if (irb->esw.esw0.erw.cons) {
6891da177e4SLinus Torvalds 		for (sl = 0; sl < 4; sl++) {
690773bab4aSSebastian Ott 			len += sprintf(page + len, PRINTK_HEADER
6911da177e4SLinus Torvalds 				       " Sense(hex) %2d-%2d:",
6921da177e4SLinus Torvalds 				       (8 * sl), ((8 * sl) + 7));
6931da177e4SLinus Torvalds 
6941da177e4SLinus Torvalds 			for (sct = 0; sct < 8; sct++) {
6951da177e4SLinus Torvalds 				len += sprintf(page + len, " %02x",
6961da177e4SLinus Torvalds 					       irb->ecw[8 * sl + sct]);
6971da177e4SLinus Torvalds 			}
6981da177e4SLinus Torvalds 			len += sprintf(page + len, "\n");
6991da177e4SLinus Torvalds 		}
7001da177e4SLinus Torvalds 	} else {
701773bab4aSSebastian Ott 		len += sprintf(page + len, PRINTK_HEADER
7021da177e4SLinus Torvalds 			       " SORRY - NO VALID SENSE AVAILABLE\n");
7031da177e4SLinus Torvalds 	}
704fc19f381SStefan Haberland 	printk(KERN_ERR "%s", page);
7051da177e4SLinus Torvalds 
7061da177e4SLinus Torvalds 	/* dump the Channel Program */
7071da177e4SLinus Torvalds 	/* print first CCWs (maximum 8) */
7081da177e4SLinus Torvalds 	act = req->cpaddr;
7091da177e4SLinus Torvalds         for (last = act; last->flags & (CCW_FLAG_CC | CCW_FLAG_DC); last++);
7101da177e4SLinus Torvalds 	end = min(act + 8, last);
711773bab4aSSebastian Ott 	len = sprintf(page, PRINTK_HEADER " Related CP in req: %p\n", req);
7121da177e4SLinus Torvalds 	while (act <= end) {
713773bab4aSSebastian Ott 		len += sprintf(page + len, PRINTK_HEADER
7141da177e4SLinus Torvalds 			       " CCW %p: %08X %08X DAT:",
7151da177e4SLinus Torvalds 			       act, ((int *) act)[0], ((int *) act)[1]);
7161da177e4SLinus Torvalds 		for (count = 0; count < 32 && count < act->count;
7171da177e4SLinus Torvalds 		     count += sizeof(int))
7181da177e4SLinus Torvalds 			len += sprintf(page + len, " %08X",
7191da177e4SLinus Torvalds 				       ((int *) (addr_t) act->cda)
7201da177e4SLinus Torvalds 				       [(count>>2)]);
7211da177e4SLinus Torvalds 		len += sprintf(page + len, "\n");
7221da177e4SLinus Torvalds 		act++;
7231da177e4SLinus Torvalds 	}
724fc19f381SStefan Haberland 	printk(KERN_ERR "%s", page);
7251da177e4SLinus Torvalds 
7261da177e4SLinus Torvalds 
7271da177e4SLinus Torvalds 	/* print failing CCW area */
7281da177e4SLinus Torvalds 	len = 0;
72923d805b6SPeter Oberparleiter 	if (act <  ((struct ccw1 *)(addr_t) irb->scsw.cmd.cpa) - 2) {
73023d805b6SPeter Oberparleiter 		act = ((struct ccw1 *)(addr_t) irb->scsw.cmd.cpa) - 2;
731773bab4aSSebastian Ott 		len += sprintf(page + len, PRINTK_HEADER "......\n");
7321da177e4SLinus Torvalds 	}
73323d805b6SPeter Oberparleiter 	end = min((struct ccw1 *)(addr_t) irb->scsw.cmd.cpa + 2, last);
7341da177e4SLinus Torvalds 	while (act <= end) {
735773bab4aSSebastian Ott 		len += sprintf(page + len, PRINTK_HEADER
7361da177e4SLinus Torvalds 			       " CCW %p: %08X %08X DAT:",
7371da177e4SLinus Torvalds 			       act, ((int *) act)[0], ((int *) act)[1]);
7381da177e4SLinus Torvalds 		for (count = 0; count < 32 && count < act->count;
7391da177e4SLinus Torvalds 		     count += sizeof(int))
7401da177e4SLinus Torvalds 			len += sprintf(page + len, " %08X",
7411da177e4SLinus Torvalds 				       ((int *) (addr_t) act->cda)
7421da177e4SLinus Torvalds 				       [(count>>2)]);
7431da177e4SLinus Torvalds 		len += sprintf(page + len, "\n");
7441da177e4SLinus Torvalds 		act++;
7451da177e4SLinus Torvalds 	}
7461da177e4SLinus Torvalds 
7471da177e4SLinus Torvalds 	/* print last CCWs */
7481da177e4SLinus Torvalds 	if (act <  last - 2) {
7491da177e4SLinus Torvalds 		act = last - 2;
750773bab4aSSebastian Ott 		len += sprintf(page + len, PRINTK_HEADER "......\n");
7511da177e4SLinus Torvalds 	}
7521da177e4SLinus Torvalds 	while (act <= last) {
753773bab4aSSebastian Ott 		len += sprintf(page + len, PRINTK_HEADER
7541da177e4SLinus Torvalds 			       " CCW %p: %08X %08X DAT:",
7551da177e4SLinus Torvalds 			       act, ((int *) act)[0], ((int *) act)[1]);
7561da177e4SLinus Torvalds 		for (count = 0; count < 32 && count < act->count;
7571da177e4SLinus Torvalds 		     count += sizeof(int))
7581da177e4SLinus Torvalds 			len += sprintf(page + len, " %08X",
7591da177e4SLinus Torvalds 				       ((int *) (addr_t) act->cda)
7601da177e4SLinus Torvalds 				       [(count>>2)]);
7611da177e4SLinus Torvalds 		len += sprintf(page + len, "\n");
7621da177e4SLinus Torvalds 		act++;
7631da177e4SLinus Torvalds 	}
7641da177e4SLinus Torvalds 	if (len > 0)
765fc19f381SStefan Haberland 		printk(KERN_ERR "%s", page);
7661da177e4SLinus Torvalds 	free_page((unsigned long) page);
7671da177e4SLinus Torvalds }
7681da177e4SLinus Torvalds 
7691da177e4SLinus Torvalds /*
7701da177e4SLinus Torvalds  * max_blocks is dependent on the amount of storage that is available
7711da177e4SLinus Torvalds  * in the static io buffer for each device. Currently each device has
7721da177e4SLinus Torvalds  * 8192 bytes (=2 pages). For 64 bit one dasd_mchunkt_t structure has
7731da177e4SLinus Torvalds  * 24 bytes, the struct dasd_ccw_req has 136 bytes and each block can use
7741da177e4SLinus Torvalds  * up to 16 bytes (8 for the ccw and 8 for the idal pointer). In
7751da177e4SLinus Torvalds  * addition we have one define extent ccw + 16 bytes of data and a
7761da177e4SLinus Torvalds  * locate record ccw for each block (stupid devices!) + 16 bytes of data.
7771da177e4SLinus Torvalds  * That makes:
7781da177e4SLinus Torvalds  * (8192 - 24 - 136 - 8 - 16) / 40 = 200.2 blocks at maximum.
7791da177e4SLinus Torvalds  * We want to fit two into the available memory so that we can immediately
7801da177e4SLinus Torvalds  * start the next request if one finishes off. That makes 100.1 blocks
7811da177e4SLinus Torvalds  * for one request. Give a little safety and the result is 96.
7821da177e4SLinus Torvalds  */
7831da177e4SLinus Torvalds static struct dasd_discipline dasd_fba_discipline = {
7841da177e4SLinus Torvalds 	.owner = THIS_MODULE,
7851da177e4SLinus Torvalds 	.name = "FBA ",
7861da177e4SLinus Torvalds 	.ebcname = "FBA ",
7871da177e4SLinus Torvalds 	.max_blocks = 96,
7881da177e4SLinus Torvalds 	.check_device = dasd_fba_check_characteristics,
7891da177e4SLinus Torvalds 	.do_analysis = dasd_fba_do_analysis,
790a4d26c6aSStefan Weinhuber 	.verify_path = dasd_generic_verify_path,
7911da177e4SLinus Torvalds 	.fill_geometry = dasd_fba_fill_geometry,
7921da177e4SLinus Torvalds 	.start_IO = dasd_start_IO,
7931da177e4SLinus Torvalds 	.term_IO = dasd_term_IO,
7948e09f215SStefan Weinhuber 	.handle_terminated_request = dasd_fba_handle_terminated_request,
7951da177e4SLinus Torvalds 	.erp_action = dasd_fba_erp_action,
7961da177e4SLinus Torvalds 	.erp_postaction = dasd_fba_erp_postaction,
7975a27e60dSStefan Weinhuber 	.check_for_device_change = dasd_fba_check_for_device_change,
7981da177e4SLinus Torvalds 	.build_cp = dasd_fba_build_cp,
7991da177e4SLinus Torvalds 	.free_cp = dasd_fba_free_cp,
8001da177e4SLinus Torvalds 	.dump_sense = dasd_fba_dump_sense,
801fc19f381SStefan Haberland 	.dump_sense_dbf = dasd_fba_dump_sense_dbf,
8021da177e4SLinus Torvalds 	.fill_info = dasd_fba_fill_info,
8031da177e4SLinus Torvalds };
8041da177e4SLinus Torvalds 
8051da177e4SLinus Torvalds static int __init
8061da177e4SLinus Torvalds dasd_fba_init(void)
8071da177e4SLinus Torvalds {
808736e6ea0SSebastian Ott 	int ret;
809736e6ea0SSebastian Ott 
8101da177e4SLinus Torvalds 	ASCEBC(dasd_fba_discipline.ebcname, 4);
811736e6ea0SSebastian Ott 	ret = ccw_driver_register(&dasd_fba_driver);
812736e6ea0SSebastian Ott 	if (!ret)
813736e6ea0SSebastian Ott 		wait_for_device_probe();
814736e6ea0SSebastian Ott 
815736e6ea0SSebastian Ott 	return ret;
8161da177e4SLinus Torvalds }
8171da177e4SLinus Torvalds 
8181da177e4SLinus Torvalds static void __exit
8191da177e4SLinus Torvalds dasd_fba_cleanup(void)
8201da177e4SLinus Torvalds {
8211da177e4SLinus Torvalds 	ccw_driver_unregister(&dasd_fba_driver);
8221da177e4SLinus Torvalds }
8231da177e4SLinus Torvalds 
8241da177e4SLinus Torvalds module_init(dasd_fba_init);
8251da177e4SLinus Torvalds module_exit(dasd_fba_cleanup);
826