xref: /openbmc/linux/drivers/s390/block/dasd_eckd.c (revision b8ed5dd5)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * File...........: linux/drivers/s390/block/dasd_eckd.c
31da177e4SLinus Torvalds  * Author(s)......: Holger Smolinski <Holger.Smolinski@de.ibm.com>
41da177e4SLinus Torvalds  *		    Horst Hummel <Horst.Hummel@de.ibm.com>
51da177e4SLinus Torvalds  *		    Carsten Otte <Cotte@de.ibm.com>
61da177e4SLinus Torvalds  *		    Martin Schwidefsky <schwidefsky@de.ibm.com>
71da177e4SLinus Torvalds  * Bugreports.to..: <Linux390@de.ibm.com>
8d41dd122SStefan Haberland  * Copyright IBM Corp. 1999, 2009
9ab1d848fSNigel Hislop  * EMC Symmetrix ioctl Copyright EMC Corporation, 2008
10ab1d848fSNigel Hislop  * Author.........: Nigel Hislop <hislop_nigel@emc.com>
111da177e4SLinus Torvalds  */
121da177e4SLinus Torvalds 
13ca99dab0SStefan Haberland #define KMSG_COMPONENT "dasd-eckd"
14fc19f381SStefan Haberland 
151da177e4SLinus Torvalds #include <linux/stddef.h>
161da177e4SLinus Torvalds #include <linux/kernel.h>
171da177e4SLinus Torvalds #include <linux/slab.h>
181da177e4SLinus Torvalds #include <linux/hdreg.h>	/* HDIO_GETGEO			    */
191da177e4SLinus Torvalds #include <linux/bio.h>
201da177e4SLinus Torvalds #include <linux/module.h>
211da177e4SLinus Torvalds #include <linux/init.h>
221da177e4SLinus Torvalds 
231da177e4SLinus Torvalds #include <asm/debug.h>
241da177e4SLinus Torvalds #include <asm/idals.h>
251da177e4SLinus Torvalds #include <asm/ebcdic.h>
261da177e4SLinus Torvalds #include <asm/io.h>
271da177e4SLinus Torvalds #include <asm/uaccess.h>
2840545573SHorst Hummel #include <asm/cio.h>
291da177e4SLinus Torvalds #include <asm/ccwdev.h>
30f3eb5384SStefan Weinhuber #include <asm/itcw.h>
311da177e4SLinus Torvalds 
321da177e4SLinus Torvalds #include "dasd_int.h"
331da177e4SLinus Torvalds #include "dasd_eckd.h"
34f3eb5384SStefan Weinhuber #include "../cio/chsc.h"
35f3eb5384SStefan Weinhuber 
361da177e4SLinus Torvalds 
371da177e4SLinus Torvalds #ifdef PRINTK_HEADER
381da177e4SLinus Torvalds #undef PRINTK_HEADER
391da177e4SLinus Torvalds #endif				/* PRINTK_HEADER */
401da177e4SLinus Torvalds #define PRINTK_HEADER "dasd(eckd):"
411da177e4SLinus Torvalds 
421da177e4SLinus Torvalds #define ECKD_C0(i) (i->home_bytes)
431da177e4SLinus Torvalds #define ECKD_F(i) (i->formula)
441da177e4SLinus Torvalds #define ECKD_F1(i) (ECKD_F(i)==0x01?(i->factors.f_0x01.f1):\
451da177e4SLinus Torvalds 		    (i->factors.f_0x02.f1))
461da177e4SLinus Torvalds #define ECKD_F2(i) (ECKD_F(i)==0x01?(i->factors.f_0x01.f2):\
471da177e4SLinus Torvalds 		    (i->factors.f_0x02.f2))
481da177e4SLinus Torvalds #define ECKD_F3(i) (ECKD_F(i)==0x01?(i->factors.f_0x01.f3):\
491da177e4SLinus Torvalds 		    (i->factors.f_0x02.f3))
501da177e4SLinus Torvalds #define ECKD_F4(i) (ECKD_F(i)==0x02?(i->factors.f_0x02.f4):0)
511da177e4SLinus Torvalds #define ECKD_F5(i) (ECKD_F(i)==0x02?(i->factors.f_0x02.f5):0)
521da177e4SLinus Torvalds #define ECKD_F6(i) (i->factor6)
531da177e4SLinus Torvalds #define ECKD_F7(i) (i->factor7)
541da177e4SLinus Torvalds #define ECKD_F8(i) (i->factor8)
551da177e4SLinus Torvalds 
561da177e4SLinus Torvalds MODULE_LICENSE("GPL");
571da177e4SLinus Torvalds 
581da177e4SLinus Torvalds static struct dasd_discipline dasd_eckd_discipline;
591da177e4SLinus Torvalds 
601da177e4SLinus Torvalds /* The ccw bus type uses this table to find devices that it sends to
611da177e4SLinus Torvalds  * dasd_eckd_probe */
621da177e4SLinus Torvalds static struct ccw_device_id dasd_eckd_ids[] = {
63d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x3990, 0, 0x3390, 0), .driver_info = 0x1},
64d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x2105, 0, 0x3390, 0), .driver_info = 0x2},
65d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x3880, 0, 0x3390, 0), .driver_info = 0x3},
66d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x3990, 0, 0x3380, 0), .driver_info = 0x4},
67d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x2105, 0, 0x3380, 0), .driver_info = 0x5},
68d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x9343, 0, 0x9345, 0), .driver_info = 0x6},
69d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x2107, 0, 0x3390, 0), .driver_info = 0x7},
70d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x2107, 0, 0x3380, 0), .driver_info = 0x8},
71d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x1750, 0, 0x3390, 0), .driver_info = 0x9},
72d2c993d8SHeiko Carstens 	{ CCW_DEVICE_DEVTYPE (0x1750, 0, 0x3380, 0), .driver_info = 0xa},
731da177e4SLinus Torvalds 	{ /* end of list */ },
741da177e4SLinus Torvalds };
751da177e4SLinus Torvalds 
761da177e4SLinus Torvalds MODULE_DEVICE_TABLE(ccw, dasd_eckd_ids);
771da177e4SLinus Torvalds 
781da177e4SLinus Torvalds static struct ccw_driver dasd_eckd_driver; /* see below */
791da177e4SLinus Torvalds 
80eb6e199bSStefan Weinhuber #define INIT_CQR_OK 0
81eb6e199bSStefan Weinhuber #define INIT_CQR_UNFORMATTED 1
82eb6e199bSStefan Weinhuber #define INIT_CQR_ERROR 2
83eb6e199bSStefan Weinhuber 
84eb6e199bSStefan Weinhuber 
851da177e4SLinus Torvalds /* initial attempt at a probe function. this can be simplified once
861da177e4SLinus Torvalds  * the other detection code is gone */
871da177e4SLinus Torvalds static int
881da177e4SLinus Torvalds dasd_eckd_probe (struct ccw_device *cdev)
891da177e4SLinus Torvalds {
901da177e4SLinus Torvalds 	int ret;
911da177e4SLinus Torvalds 
9240545573SHorst Hummel 	/* set ECKD specific ccw-device options */
93454e1fa1SPeter Oberparleiter 	ret = ccw_device_set_options(cdev, CCWDEV_ALLOW_FORCE |
94454e1fa1SPeter Oberparleiter 				     CCWDEV_DO_PATHGROUP | CCWDEV_DO_MULTIPATH);
9540545573SHorst Hummel 	if (ret) {
96b8ed5dd5SStefan Haberland 		DBF_EVENT_DEVID(DBF_WARNING, cdev, "%s",
97b8ed5dd5SStefan Haberland 				"dasd_eckd_probe: could not set "
98b8ed5dd5SStefan Haberland 				"ccw-device options");
991da177e4SLinus Torvalds 		return ret;
10040545573SHorst Hummel 	}
10140545573SHorst Hummel 	ret = dasd_generic_probe(cdev, &dasd_eckd_discipline);
10240545573SHorst Hummel 	return ret;
1031da177e4SLinus Torvalds }
1041da177e4SLinus Torvalds 
1051da177e4SLinus Torvalds static int
1061da177e4SLinus Torvalds dasd_eckd_set_online(struct ccw_device *cdev)
1071da177e4SLinus Torvalds {
1081da177e4SLinus Torvalds 	return dasd_generic_set_online(cdev, &dasd_eckd_discipline);
1091da177e4SLinus Torvalds }
1101da177e4SLinus Torvalds 
1111da177e4SLinus Torvalds static const int sizes_trk0[] = { 28, 148, 84 };
1121da177e4SLinus Torvalds #define LABEL_SIZE 140
1131da177e4SLinus Torvalds 
1141da177e4SLinus Torvalds static inline unsigned int
1151da177e4SLinus Torvalds round_up_multiple(unsigned int no, unsigned int mult)
1161da177e4SLinus Torvalds {
1171da177e4SLinus Torvalds 	int rem = no % mult;
1181da177e4SLinus Torvalds 	return (rem ? no - rem + mult : no);
1191da177e4SLinus Torvalds }
1201da177e4SLinus Torvalds 
1211da177e4SLinus Torvalds static inline unsigned int
1221da177e4SLinus Torvalds ceil_quot(unsigned int d1, unsigned int d2)
1231da177e4SLinus Torvalds {
1241da177e4SLinus Torvalds 	return (d1 + (d2 - 1)) / d2;
1251da177e4SLinus Torvalds }
1261da177e4SLinus Torvalds 
1274d284cacSHeiko Carstens static unsigned int
1281da177e4SLinus Torvalds recs_per_track(struct dasd_eckd_characteristics * rdc,
1291da177e4SLinus Torvalds 	       unsigned int kl, unsigned int dl)
1301da177e4SLinus Torvalds {
1311da177e4SLinus Torvalds 	int dn, kn;
1321da177e4SLinus Torvalds 
1331da177e4SLinus Torvalds 	switch (rdc->dev_type) {
1341da177e4SLinus Torvalds 	case 0x3380:
1351da177e4SLinus Torvalds 		if (kl)
1361da177e4SLinus Torvalds 			return 1499 / (15 + 7 + ceil_quot(kl + 12, 32) +
1371da177e4SLinus Torvalds 				       ceil_quot(dl + 12, 32));
1381da177e4SLinus Torvalds 		else
1391da177e4SLinus Torvalds 			return 1499 / (15 + ceil_quot(dl + 12, 32));
1401da177e4SLinus Torvalds 	case 0x3390:
1411da177e4SLinus Torvalds 		dn = ceil_quot(dl + 6, 232) + 1;
1421da177e4SLinus Torvalds 		if (kl) {
1431da177e4SLinus Torvalds 			kn = ceil_quot(kl + 6, 232) + 1;
1441da177e4SLinus Torvalds 			return 1729 / (10 + 9 + ceil_quot(kl + 6 * kn, 34) +
1451da177e4SLinus Torvalds 				       9 + ceil_quot(dl + 6 * dn, 34));
1461da177e4SLinus Torvalds 		} else
1471da177e4SLinus Torvalds 			return 1729 / (10 + 9 + ceil_quot(dl + 6 * dn, 34));
1481da177e4SLinus Torvalds 	case 0x9345:
1491da177e4SLinus Torvalds 		dn = ceil_quot(dl + 6, 232) + 1;
1501da177e4SLinus Torvalds 		if (kl) {
1511da177e4SLinus Torvalds 			kn = ceil_quot(kl + 6, 232) + 1;
1521da177e4SLinus Torvalds 			return 1420 / (18 + 7 + ceil_quot(kl + 6 * kn, 34) +
1531da177e4SLinus Torvalds 				       ceil_quot(dl + 6 * dn, 34));
1541da177e4SLinus Torvalds 		} else
1551da177e4SLinus Torvalds 			return 1420 / (18 + 7 + ceil_quot(dl + 6 * dn, 34));
1561da177e4SLinus Torvalds 	}
1571da177e4SLinus Torvalds 	return 0;
1581da177e4SLinus Torvalds }
1591da177e4SLinus Torvalds 
160b44b0ab3SStefan Weinhuber static void set_ch_t(struct ch_t *geo, __u32 cyl, __u8 head)
161b44b0ab3SStefan Weinhuber {
162b44b0ab3SStefan Weinhuber 	geo->cyl = (__u16) cyl;
163b44b0ab3SStefan Weinhuber 	geo->head = cyl >> 16;
164b44b0ab3SStefan Weinhuber 	geo->head <<= 4;
165b44b0ab3SStefan Weinhuber 	geo->head |= head;
166b44b0ab3SStefan Weinhuber }
167b44b0ab3SStefan Weinhuber 
1684d284cacSHeiko Carstens static int
1691da177e4SLinus Torvalds check_XRC (struct ccw1         *de_ccw,
1701da177e4SLinus Torvalds            struct DE_eckd_data *data,
1711da177e4SLinus Torvalds            struct dasd_device  *device)
1721da177e4SLinus Torvalds {
1731da177e4SLinus Torvalds         struct dasd_eckd_private *private;
174d54853efSMartin Schwidefsky 	int rc;
1751da177e4SLinus Torvalds 
1761da177e4SLinus Torvalds         private = (struct dasd_eckd_private *) device->private;
177d54853efSMartin Schwidefsky 	if (!private->rdc_data.facilities.XRC_supported)
178d54853efSMartin Schwidefsky 		return 0;
1791da177e4SLinus Torvalds 
1801da177e4SLinus Torvalds         /* switch on System Time Stamp - needed for XRC Support */
1811da177e4SLinus Torvalds 	data->ga_extended |= 0x08; /* switch on 'Time Stamp Valid'   */
1821da177e4SLinus Torvalds 	data->ga_extended |= 0x02; /* switch on 'Extended Parameter' */
1831da177e4SLinus Torvalds 
184d54853efSMartin Schwidefsky 	rc = get_sync_clock(&data->ep_sys_time);
185d54853efSMartin Schwidefsky 	/* Ignore return code if sync clock is switched off. */
186d54853efSMartin Schwidefsky 	if (rc == -ENOSYS || rc == -EACCES)
187d54853efSMartin Schwidefsky 		rc = 0;
1881da177e4SLinus Torvalds 
1891da177e4SLinus Torvalds 	de_ccw->count = sizeof(struct DE_eckd_data);
1901da177e4SLinus Torvalds 	de_ccw->flags |= CCW_FLAG_SLI;
191d54853efSMartin Schwidefsky 	return rc;
1921da177e4SLinus Torvalds }
1931da177e4SLinus Torvalds 
1944d284cacSHeiko Carstens static int
195b44b0ab3SStefan Weinhuber define_extent(struct ccw1 *ccw, struct DE_eckd_data *data, unsigned int trk,
196b44b0ab3SStefan Weinhuber 	      unsigned int totrk, int cmd, struct dasd_device *device)
1971da177e4SLinus Torvalds {
1981da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
199b44b0ab3SStefan Weinhuber 	u32 begcyl, endcyl;
200b44b0ab3SStefan Weinhuber 	u16 heads, beghead, endhead;
201d54853efSMartin Schwidefsky 	int rc = 0;
2021da177e4SLinus Torvalds 
2031da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
2041da177e4SLinus Torvalds 
2051da177e4SLinus Torvalds 	ccw->cmd_code = DASD_ECKD_CCW_DEFINE_EXTENT;
2061da177e4SLinus Torvalds 	ccw->flags = 0;
2071da177e4SLinus Torvalds 	ccw->count = 16;
2081da177e4SLinus Torvalds 	ccw->cda = (__u32) __pa(data);
2091da177e4SLinus Torvalds 
2101da177e4SLinus Torvalds 	memset(data, 0, sizeof(struct DE_eckd_data));
2111da177e4SLinus Torvalds 	switch (cmd) {
2121da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_HOME_ADDRESS:
2131da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_RECORD_ZERO:
2141da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ:
2151da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_MT:
2161da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_CKD:
2171da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_CKD_MT:
2181da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_KD:
2191da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_KD_MT:
2201da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_COUNT:
2211da177e4SLinus Torvalds 		data->mask.perm = 0x1;
2221da177e4SLinus Torvalds 		data->attributes.operation = private->attrib.operation;
2231da177e4SLinus Torvalds 		break;
2241da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE:
2251da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_MT:
2261da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_KD:
2271da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_KD_MT:
2281da177e4SLinus Torvalds 		data->mask.perm = 0x02;
2291da177e4SLinus Torvalds 		data->attributes.operation = private->attrib.operation;
230d54853efSMartin Schwidefsky 		rc = check_XRC (ccw, data, device);
2311da177e4SLinus Torvalds 		break;
2321da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_CKD:
2331da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_CKD_MT:
2341da177e4SLinus Torvalds 		data->attributes.operation = DASD_BYPASS_CACHE;
235d54853efSMartin Schwidefsky 		rc = check_XRC (ccw, data, device);
2361da177e4SLinus Torvalds 		break;
2371da177e4SLinus Torvalds 	case DASD_ECKD_CCW_ERASE:
2381da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_HOME_ADDRESS:
2391da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_RECORD_ZERO:
2401da177e4SLinus Torvalds 		data->mask.perm = 0x3;
2411da177e4SLinus Torvalds 		data->mask.auth = 0x1;
2421da177e4SLinus Torvalds 		data->attributes.operation = DASD_BYPASS_CACHE;
243d54853efSMartin Schwidefsky 		rc = check_XRC (ccw, data, device);
2441da177e4SLinus Torvalds 		break;
2451da177e4SLinus Torvalds 	default:
246fc19f381SStefan Haberland 		dev_err(&device->cdev->dev,
247fc19f381SStefan Haberland 			"0x%x is not a known command\n", cmd);
2481da177e4SLinus Torvalds 		break;
2491da177e4SLinus Torvalds 	}
2501da177e4SLinus Torvalds 
2511da177e4SLinus Torvalds 	data->attributes.mode = 0x3;	/* ECKD */
2521da177e4SLinus Torvalds 
2531da177e4SLinus Torvalds 	if ((private->rdc_data.cu_type == 0x2105 ||
2541da177e4SLinus Torvalds 	     private->rdc_data.cu_type == 0x2107 ||
2551da177e4SLinus Torvalds 	     private->rdc_data.cu_type == 0x1750)
2561da177e4SLinus Torvalds 	    && !(private->uses_cdl && trk < 2))
2571da177e4SLinus Torvalds 		data->ga_extended |= 0x40; /* Regular Data Format Mode */
2581da177e4SLinus Torvalds 
259b44b0ab3SStefan Weinhuber 	heads = private->rdc_data.trk_per_cyl;
260b44b0ab3SStefan Weinhuber 	begcyl = trk / heads;
261b44b0ab3SStefan Weinhuber 	beghead = trk % heads;
262b44b0ab3SStefan Weinhuber 	endcyl = totrk / heads;
263b44b0ab3SStefan Weinhuber 	endhead = totrk % heads;
2641da177e4SLinus Torvalds 
2651da177e4SLinus Torvalds 	/* check for sequential prestage - enhance cylinder range */
2661da177e4SLinus Torvalds 	if (data->attributes.operation == DASD_SEQ_PRESTAGE ||
2671da177e4SLinus Torvalds 	    data->attributes.operation == DASD_SEQ_ACCESS) {
2681da177e4SLinus Torvalds 
269b44b0ab3SStefan Weinhuber 		if (endcyl + private->attrib.nr_cyl < private->real_cyl)
270b44b0ab3SStefan Weinhuber 			endcyl += private->attrib.nr_cyl;
2711da177e4SLinus Torvalds 		else
272b44b0ab3SStefan Weinhuber 			endcyl = (private->real_cyl - 1);
2731da177e4SLinus Torvalds 	}
2741da177e4SLinus Torvalds 
275b44b0ab3SStefan Weinhuber 	set_ch_t(&data->beg_ext, begcyl, beghead);
276b44b0ab3SStefan Weinhuber 	set_ch_t(&data->end_ext, endcyl, endhead);
277d54853efSMartin Schwidefsky 	return rc;
2781da177e4SLinus Torvalds }
2791da177e4SLinus Torvalds 
2808e09f215SStefan Weinhuber static int check_XRC_on_prefix(struct PFX_eckd_data *pfxdata,
2818e09f215SStefan Weinhuber 			       struct dasd_device  *device)
2828e09f215SStefan Weinhuber {
2838e09f215SStefan Weinhuber 	struct dasd_eckd_private *private;
2848e09f215SStefan Weinhuber 	int rc;
2858e09f215SStefan Weinhuber 
2868e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) device->private;
2878e09f215SStefan Weinhuber 	if (!private->rdc_data.facilities.XRC_supported)
2888e09f215SStefan Weinhuber 		return 0;
2898e09f215SStefan Weinhuber 
2908e09f215SStefan Weinhuber 	/* switch on System Time Stamp - needed for XRC Support */
291f3eb5384SStefan Weinhuber 	pfxdata->define_extent.ga_extended |= 0x08; /* 'Time Stamp Valid'   */
292f3eb5384SStefan Weinhuber 	pfxdata->define_extent.ga_extended |= 0x02; /* 'Extended Parameter' */
2938e09f215SStefan Weinhuber 	pfxdata->validity.time_stamp = 1;	    /* 'Time Stamp Valid'   */
2948e09f215SStefan Weinhuber 
295f3eb5384SStefan Weinhuber 	rc = get_sync_clock(&pfxdata->define_extent.ep_sys_time);
2968e09f215SStefan Weinhuber 	/* Ignore return code if sync clock is switched off. */
2978e09f215SStefan Weinhuber 	if (rc == -ENOSYS || rc == -EACCES)
2988e09f215SStefan Weinhuber 		rc = 0;
2998e09f215SStefan Weinhuber 	return rc;
3008e09f215SStefan Weinhuber }
3018e09f215SStefan Weinhuber 
302f3eb5384SStefan Weinhuber static void fill_LRE_data(struct LRE_eckd_data *data, unsigned int trk,
303f3eb5384SStefan Weinhuber 			  unsigned int rec_on_trk, int count, int cmd,
304f3eb5384SStefan Weinhuber 			  struct dasd_device *device, unsigned int reclen,
305f3eb5384SStefan Weinhuber 			  unsigned int tlf)
306f3eb5384SStefan Weinhuber {
307f3eb5384SStefan Weinhuber 	struct dasd_eckd_private *private;
308f3eb5384SStefan Weinhuber 	int sector;
309f3eb5384SStefan Weinhuber 	int dn, d;
310f3eb5384SStefan Weinhuber 
311f3eb5384SStefan Weinhuber 	private = (struct dasd_eckd_private *) device->private;
312f3eb5384SStefan Weinhuber 
313f3eb5384SStefan Weinhuber 	memset(data, 0, sizeof(*data));
314f3eb5384SStefan Weinhuber 	sector = 0;
315f3eb5384SStefan Weinhuber 	if (rec_on_trk) {
316f3eb5384SStefan Weinhuber 		switch (private->rdc_data.dev_type) {
317f3eb5384SStefan Weinhuber 		case 0x3390:
318f3eb5384SStefan Weinhuber 			dn = ceil_quot(reclen + 6, 232);
319f3eb5384SStefan Weinhuber 			d = 9 + ceil_quot(reclen + 6 * (dn + 1), 34);
320f3eb5384SStefan Weinhuber 			sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8;
321f3eb5384SStefan Weinhuber 			break;
322f3eb5384SStefan Weinhuber 		case 0x3380:
323f3eb5384SStefan Weinhuber 			d = 7 + ceil_quot(reclen + 12, 32);
324f3eb5384SStefan Weinhuber 			sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7;
325f3eb5384SStefan Weinhuber 			break;
326f3eb5384SStefan Weinhuber 		}
327f3eb5384SStefan Weinhuber 	}
328f3eb5384SStefan Weinhuber 	data->sector = sector;
329f3eb5384SStefan Weinhuber 	/* note: meaning of count depends on the operation
330f3eb5384SStefan Weinhuber 	 *	 for record based I/O it's the number of records, but for
331f3eb5384SStefan Weinhuber 	 *	 track based I/O it's the number of tracks
332f3eb5384SStefan Weinhuber 	 */
333f3eb5384SStefan Weinhuber 	data->count = count;
334f3eb5384SStefan Weinhuber 	switch (cmd) {
335f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_HOME_ADDRESS:
336f3eb5384SStefan Weinhuber 		data->operation.orientation = 0x3;
337f3eb5384SStefan Weinhuber 		data->operation.operation = 0x03;
338f3eb5384SStefan Weinhuber 		break;
339f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_HOME_ADDRESS:
340f3eb5384SStefan Weinhuber 		data->operation.orientation = 0x3;
341f3eb5384SStefan Weinhuber 		data->operation.operation = 0x16;
342f3eb5384SStefan Weinhuber 		break;
343f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_RECORD_ZERO:
344f3eb5384SStefan Weinhuber 		data->operation.orientation = 0x1;
345f3eb5384SStefan Weinhuber 		data->operation.operation = 0x03;
346f3eb5384SStefan Weinhuber 		data->count++;
347f3eb5384SStefan Weinhuber 		break;
348f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_RECORD_ZERO:
349f3eb5384SStefan Weinhuber 		data->operation.orientation = 0x3;
350f3eb5384SStefan Weinhuber 		data->operation.operation = 0x16;
351f3eb5384SStefan Weinhuber 		data->count++;
352f3eb5384SStefan Weinhuber 		break;
353f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE:
354f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_MT:
355f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_KD:
356f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_KD_MT:
357f3eb5384SStefan Weinhuber 		data->auxiliary.length_valid = 0x1;
358f3eb5384SStefan Weinhuber 		data->length = reclen;
359f3eb5384SStefan Weinhuber 		data->operation.operation = 0x01;
360f3eb5384SStefan Weinhuber 		break;
361f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_CKD:
362f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_CKD_MT:
363f3eb5384SStefan Weinhuber 		data->auxiliary.length_valid = 0x1;
364f3eb5384SStefan Weinhuber 		data->length = reclen;
365f3eb5384SStefan Weinhuber 		data->operation.operation = 0x03;
366f3eb5384SStefan Weinhuber 		break;
367f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_TRACK_DATA:
368f3eb5384SStefan Weinhuber 		data->auxiliary.length_valid = 0x1;
369f3eb5384SStefan Weinhuber 		data->length = reclen;	/* not tlf, as one might think */
370f3eb5384SStefan Weinhuber 		data->operation.operation = 0x3F;
371f3eb5384SStefan Weinhuber 		data->extended_operation = 0x23;
372f3eb5384SStefan Weinhuber 		break;
373f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ:
374f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_MT:
375f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_KD:
376f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_KD_MT:
377f3eb5384SStefan Weinhuber 		data->auxiliary.length_valid = 0x1;
378f3eb5384SStefan Weinhuber 		data->length = reclen;
379f3eb5384SStefan Weinhuber 		data->operation.operation = 0x06;
380f3eb5384SStefan Weinhuber 		break;
381f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_CKD:
382f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_CKD_MT:
383f3eb5384SStefan Weinhuber 		data->auxiliary.length_valid = 0x1;
384f3eb5384SStefan Weinhuber 		data->length = reclen;
385f3eb5384SStefan Weinhuber 		data->operation.operation = 0x16;
386f3eb5384SStefan Weinhuber 		break;
387f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_COUNT:
388f3eb5384SStefan Weinhuber 		data->operation.operation = 0x06;
389f3eb5384SStefan Weinhuber 		break;
390f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_TRACK_DATA:
391f3eb5384SStefan Weinhuber 		data->auxiliary.length_valid = 0x1;
392f3eb5384SStefan Weinhuber 		data->length = tlf;
393f3eb5384SStefan Weinhuber 		data->operation.operation = 0x0C;
394f3eb5384SStefan Weinhuber 		break;
395f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_ERASE:
396f3eb5384SStefan Weinhuber 		data->length = reclen;
397f3eb5384SStefan Weinhuber 		data->auxiliary.length_valid = 0x1;
398f3eb5384SStefan Weinhuber 		data->operation.operation = 0x0b;
399f3eb5384SStefan Weinhuber 		break;
400f3eb5384SStefan Weinhuber 	default:
401f3eb5384SStefan Weinhuber 		DBF_DEV_EVENT(DBF_ERR, device,
402f3eb5384SStefan Weinhuber 			    "fill LRE unknown opcode 0x%x", cmd);
403f3eb5384SStefan Weinhuber 		BUG();
404f3eb5384SStefan Weinhuber 	}
405f3eb5384SStefan Weinhuber 	set_ch_t(&data->seek_addr,
406f3eb5384SStefan Weinhuber 		 trk / private->rdc_data.trk_per_cyl,
407f3eb5384SStefan Weinhuber 		 trk % private->rdc_data.trk_per_cyl);
408f3eb5384SStefan Weinhuber 	data->search_arg.cyl = data->seek_addr.cyl;
409f3eb5384SStefan Weinhuber 	data->search_arg.head = data->seek_addr.head;
410f3eb5384SStefan Weinhuber 	data->search_arg.record = rec_on_trk;
411f3eb5384SStefan Weinhuber }
412f3eb5384SStefan Weinhuber 
413f3eb5384SStefan Weinhuber static int prefix_LRE(struct ccw1 *ccw, struct PFX_eckd_data *pfxdata,
414b44b0ab3SStefan Weinhuber 		      unsigned int trk, unsigned int totrk, int cmd,
415f3eb5384SStefan Weinhuber 		      struct dasd_device *basedev, struct dasd_device *startdev,
416f3eb5384SStefan Weinhuber 		      unsigned char format, unsigned int rec_on_trk, int count,
417f3eb5384SStefan Weinhuber 		      unsigned int blksize, unsigned int tlf)
4188e09f215SStefan Weinhuber {
4198e09f215SStefan Weinhuber 	struct dasd_eckd_private *basepriv, *startpriv;
420f3eb5384SStefan Weinhuber 	struct DE_eckd_data *dedata;
421f3eb5384SStefan Weinhuber 	struct LRE_eckd_data *lredata;
422b44b0ab3SStefan Weinhuber 	u32 begcyl, endcyl;
423b44b0ab3SStefan Weinhuber 	u16 heads, beghead, endhead;
4248e09f215SStefan Weinhuber 	int rc = 0;
4258e09f215SStefan Weinhuber 
4268e09f215SStefan Weinhuber 	basepriv = (struct dasd_eckd_private *) basedev->private;
4278e09f215SStefan Weinhuber 	startpriv = (struct dasd_eckd_private *) startdev->private;
428f3eb5384SStefan Weinhuber 	dedata = &pfxdata->define_extent;
429f3eb5384SStefan Weinhuber 	lredata = &pfxdata->locate_record;
4308e09f215SStefan Weinhuber 
4318e09f215SStefan Weinhuber 	ccw->cmd_code = DASD_ECKD_CCW_PFX;
4328e09f215SStefan Weinhuber 	ccw->flags = 0;
4338e09f215SStefan Weinhuber 	ccw->count = sizeof(*pfxdata);
4348e09f215SStefan Weinhuber 	ccw->cda = (__u32) __pa(pfxdata);
4358e09f215SStefan Weinhuber 
4368e09f215SStefan Weinhuber 	memset(pfxdata, 0, sizeof(*pfxdata));
4378e09f215SStefan Weinhuber 	/* prefix data */
438f3eb5384SStefan Weinhuber 	if (format > 1) {
439f3eb5384SStefan Weinhuber 		DBF_DEV_EVENT(DBF_ERR, basedev,
440f3eb5384SStefan Weinhuber 			      "PFX LRE unknown format 0x%x", format);
441f3eb5384SStefan Weinhuber 		BUG();
442f3eb5384SStefan Weinhuber 		return -EINVAL;
443f3eb5384SStefan Weinhuber 	}
444f3eb5384SStefan Weinhuber 	pfxdata->format = format;
4454abb08c2SStefan Weinhuber 	pfxdata->base_address = basepriv->ned->unit_addr;
4464abb08c2SStefan Weinhuber 	pfxdata->base_lss = basepriv->ned->ID;
447f3eb5384SStefan Weinhuber 	pfxdata->validity.define_extent = 1;
4488e09f215SStefan Weinhuber 
4498e09f215SStefan Weinhuber 	/* private uid is kept up to date, conf_data may be outdated */
4508e09f215SStefan Weinhuber 	if (startpriv->uid.type != UA_BASE_DEVICE) {
4518e09f215SStefan Weinhuber 		pfxdata->validity.verify_base = 1;
4528e09f215SStefan Weinhuber 		if (startpriv->uid.type == UA_HYPER_PAV_ALIAS)
4538e09f215SStefan Weinhuber 			pfxdata->validity.hyper_pav = 1;
4548e09f215SStefan Weinhuber 	}
4558e09f215SStefan Weinhuber 
4568e09f215SStefan Weinhuber 	/* define extend data (mostly)*/
4578e09f215SStefan Weinhuber 	switch (cmd) {
4588e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_HOME_ADDRESS:
4598e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_RECORD_ZERO:
4608e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ:
4618e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_MT:
4628e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_CKD:
4638e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_CKD_MT:
4648e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_KD:
4658e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_KD_MT:
4668e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_READ_COUNT:
467f3eb5384SStefan Weinhuber 		dedata->mask.perm = 0x1;
468f3eb5384SStefan Weinhuber 		dedata->attributes.operation = basepriv->attrib.operation;
469f3eb5384SStefan Weinhuber 		break;
470f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_TRACK_DATA:
471f3eb5384SStefan Weinhuber 		dedata->mask.perm = 0x1;
472f3eb5384SStefan Weinhuber 		dedata->attributes.operation = basepriv->attrib.operation;
473f3eb5384SStefan Weinhuber 		dedata->blk_size = 0;
4748e09f215SStefan Weinhuber 		break;
4758e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE:
4768e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_MT:
4778e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_KD:
4788e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_KD_MT:
479f3eb5384SStefan Weinhuber 		dedata->mask.perm = 0x02;
480f3eb5384SStefan Weinhuber 		dedata->attributes.operation = basepriv->attrib.operation;
4818e09f215SStefan Weinhuber 		rc = check_XRC_on_prefix(pfxdata, basedev);
4828e09f215SStefan Weinhuber 		break;
4838e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_CKD:
4848e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_CKD_MT:
485f3eb5384SStefan Weinhuber 		dedata->attributes.operation = DASD_BYPASS_CACHE;
4868e09f215SStefan Weinhuber 		rc = check_XRC_on_prefix(pfxdata, basedev);
4878e09f215SStefan Weinhuber 		break;
4888e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_ERASE:
4898e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_HOME_ADDRESS:
4908e09f215SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_RECORD_ZERO:
491f3eb5384SStefan Weinhuber 		dedata->mask.perm = 0x3;
492f3eb5384SStefan Weinhuber 		dedata->mask.auth = 0x1;
493f3eb5384SStefan Weinhuber 		dedata->attributes.operation = DASD_BYPASS_CACHE;
494f3eb5384SStefan Weinhuber 		rc = check_XRC_on_prefix(pfxdata, basedev);
495f3eb5384SStefan Weinhuber 		break;
496f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_TRACK_DATA:
497f3eb5384SStefan Weinhuber 		dedata->mask.perm = 0x02;
498f3eb5384SStefan Weinhuber 		dedata->attributes.operation = basepriv->attrib.operation;
499f3eb5384SStefan Weinhuber 		dedata->blk_size = blksize;
5008e09f215SStefan Weinhuber 		rc = check_XRC_on_prefix(pfxdata, basedev);
5018e09f215SStefan Weinhuber 		break;
5028e09f215SStefan Weinhuber 	default:
503f3eb5384SStefan Weinhuber 		DBF_DEV_EVENT(DBF_ERR, basedev,
504f3eb5384SStefan Weinhuber 			    "PFX LRE unknown opcode 0x%x", cmd);
505f3eb5384SStefan Weinhuber 		BUG();
506f3eb5384SStefan Weinhuber 		return -EINVAL;
5078e09f215SStefan Weinhuber 	}
5088e09f215SStefan Weinhuber 
509f3eb5384SStefan Weinhuber 	dedata->attributes.mode = 0x3;	/* ECKD */
5108e09f215SStefan Weinhuber 
5118e09f215SStefan Weinhuber 	if ((basepriv->rdc_data.cu_type == 0x2105 ||
5128e09f215SStefan Weinhuber 	     basepriv->rdc_data.cu_type == 0x2107 ||
5138e09f215SStefan Weinhuber 	     basepriv->rdc_data.cu_type == 0x1750)
5148e09f215SStefan Weinhuber 	    && !(basepriv->uses_cdl && trk < 2))
515f3eb5384SStefan Weinhuber 		dedata->ga_extended |= 0x40; /* Regular Data Format Mode */
5168e09f215SStefan Weinhuber 
517b44b0ab3SStefan Weinhuber 	heads = basepriv->rdc_data.trk_per_cyl;
518b44b0ab3SStefan Weinhuber 	begcyl = trk / heads;
519b44b0ab3SStefan Weinhuber 	beghead = trk % heads;
520b44b0ab3SStefan Weinhuber 	endcyl = totrk / heads;
521b44b0ab3SStefan Weinhuber 	endhead = totrk % heads;
5228e09f215SStefan Weinhuber 
5238e09f215SStefan Weinhuber 	/* check for sequential prestage - enhance cylinder range */
524f3eb5384SStefan Weinhuber 	if (dedata->attributes.operation == DASD_SEQ_PRESTAGE ||
525f3eb5384SStefan Weinhuber 	    dedata->attributes.operation == DASD_SEQ_ACCESS) {
5268e09f215SStefan Weinhuber 
527b44b0ab3SStefan Weinhuber 		if (endcyl + basepriv->attrib.nr_cyl < basepriv->real_cyl)
528b44b0ab3SStefan Weinhuber 			endcyl += basepriv->attrib.nr_cyl;
5298e09f215SStefan Weinhuber 		else
530b44b0ab3SStefan Weinhuber 			endcyl = (basepriv->real_cyl - 1);
5318e09f215SStefan Weinhuber 	}
5328e09f215SStefan Weinhuber 
533f3eb5384SStefan Weinhuber 	set_ch_t(&dedata->beg_ext, begcyl, beghead);
534f3eb5384SStefan Weinhuber 	set_ch_t(&dedata->end_ext, endcyl, endhead);
535f3eb5384SStefan Weinhuber 
536f3eb5384SStefan Weinhuber 	if (format == 1) {
537f3eb5384SStefan Weinhuber 		fill_LRE_data(lredata, trk, rec_on_trk, count, cmd,
538f3eb5384SStefan Weinhuber 			      basedev, blksize, tlf);
539f3eb5384SStefan Weinhuber 	}
540f3eb5384SStefan Weinhuber 
5418e09f215SStefan Weinhuber 	return rc;
5428e09f215SStefan Weinhuber }
5438e09f215SStefan Weinhuber 
544f3eb5384SStefan Weinhuber static int prefix(struct ccw1 *ccw, struct PFX_eckd_data *pfxdata,
545f3eb5384SStefan Weinhuber 		  unsigned int trk, unsigned int totrk, int cmd,
546f3eb5384SStefan Weinhuber 		  struct dasd_device *basedev, struct dasd_device *startdev)
547f3eb5384SStefan Weinhuber {
548f3eb5384SStefan Weinhuber 	return prefix_LRE(ccw, pfxdata, trk, totrk, cmd, basedev, startdev,
549f3eb5384SStefan Weinhuber 			  0, 0, 0, 0, 0);
550f3eb5384SStefan Weinhuber }
551f3eb5384SStefan Weinhuber 
5524d284cacSHeiko Carstens static void
553b44b0ab3SStefan Weinhuber locate_record(struct ccw1 *ccw, struct LO_eckd_data *data, unsigned int trk,
554b44b0ab3SStefan Weinhuber 	      unsigned int rec_on_trk, int no_rec, int cmd,
5551da177e4SLinus Torvalds 	      struct dasd_device * device, int reclen)
5561da177e4SLinus Torvalds {
5571da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
5581da177e4SLinus Torvalds 	int sector;
5591da177e4SLinus Torvalds 	int dn, d;
5601da177e4SLinus Torvalds 
5611da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
5621da177e4SLinus Torvalds 
5631da177e4SLinus Torvalds 	DBF_DEV_EVENT(DBF_INFO, device,
5641da177e4SLinus Torvalds 		  "Locate: trk %d, rec %d, no_rec %d, cmd %d, reclen %d",
5651da177e4SLinus Torvalds 		  trk, rec_on_trk, no_rec, cmd, reclen);
5661da177e4SLinus Torvalds 
5671da177e4SLinus Torvalds 	ccw->cmd_code = DASD_ECKD_CCW_LOCATE_RECORD;
5681da177e4SLinus Torvalds 	ccw->flags = 0;
5691da177e4SLinus Torvalds 	ccw->count = 16;
5701da177e4SLinus Torvalds 	ccw->cda = (__u32) __pa(data);
5711da177e4SLinus Torvalds 
5721da177e4SLinus Torvalds 	memset(data, 0, sizeof(struct LO_eckd_data));
5731da177e4SLinus Torvalds 	sector = 0;
5741da177e4SLinus Torvalds 	if (rec_on_trk) {
5751da177e4SLinus Torvalds 		switch (private->rdc_data.dev_type) {
5761da177e4SLinus Torvalds 		case 0x3390:
5771da177e4SLinus Torvalds 			dn = ceil_quot(reclen + 6, 232);
5781da177e4SLinus Torvalds 			d = 9 + ceil_quot(reclen + 6 * (dn + 1), 34);
5791da177e4SLinus Torvalds 			sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8;
5801da177e4SLinus Torvalds 			break;
5811da177e4SLinus Torvalds 		case 0x3380:
5821da177e4SLinus Torvalds 			d = 7 + ceil_quot(reclen + 12, 32);
5831da177e4SLinus Torvalds 			sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7;
5841da177e4SLinus Torvalds 			break;
5851da177e4SLinus Torvalds 		}
5861da177e4SLinus Torvalds 	}
5871da177e4SLinus Torvalds 	data->sector = sector;
5881da177e4SLinus Torvalds 	data->count = no_rec;
5891da177e4SLinus Torvalds 	switch (cmd) {
5901da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_HOME_ADDRESS:
5911da177e4SLinus Torvalds 		data->operation.orientation = 0x3;
5921da177e4SLinus Torvalds 		data->operation.operation = 0x03;
5931da177e4SLinus Torvalds 		break;
5941da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_HOME_ADDRESS:
5951da177e4SLinus Torvalds 		data->operation.orientation = 0x3;
5961da177e4SLinus Torvalds 		data->operation.operation = 0x16;
5971da177e4SLinus Torvalds 		break;
5981da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_RECORD_ZERO:
5991da177e4SLinus Torvalds 		data->operation.orientation = 0x1;
6001da177e4SLinus Torvalds 		data->operation.operation = 0x03;
6011da177e4SLinus Torvalds 		data->count++;
6021da177e4SLinus Torvalds 		break;
6031da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_RECORD_ZERO:
6041da177e4SLinus Torvalds 		data->operation.orientation = 0x3;
6051da177e4SLinus Torvalds 		data->operation.operation = 0x16;
6061da177e4SLinus Torvalds 		data->count++;
6071da177e4SLinus Torvalds 		break;
6081da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE:
6091da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_MT:
6101da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_KD:
6111da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_KD_MT:
6121da177e4SLinus Torvalds 		data->auxiliary.last_bytes_used = 0x1;
6131da177e4SLinus Torvalds 		data->length = reclen;
6141da177e4SLinus Torvalds 		data->operation.operation = 0x01;
6151da177e4SLinus Torvalds 		break;
6161da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_CKD:
6171da177e4SLinus Torvalds 	case DASD_ECKD_CCW_WRITE_CKD_MT:
6181da177e4SLinus Torvalds 		data->auxiliary.last_bytes_used = 0x1;
6191da177e4SLinus Torvalds 		data->length = reclen;
6201da177e4SLinus Torvalds 		data->operation.operation = 0x03;
6211da177e4SLinus Torvalds 		break;
6221da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ:
6231da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_MT:
6241da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_KD:
6251da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_KD_MT:
6261da177e4SLinus Torvalds 		data->auxiliary.last_bytes_used = 0x1;
6271da177e4SLinus Torvalds 		data->length = reclen;
6281da177e4SLinus Torvalds 		data->operation.operation = 0x06;
6291da177e4SLinus Torvalds 		break;
6301da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_CKD:
6311da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_CKD_MT:
6321da177e4SLinus Torvalds 		data->auxiliary.last_bytes_used = 0x1;
6331da177e4SLinus Torvalds 		data->length = reclen;
6341da177e4SLinus Torvalds 		data->operation.operation = 0x16;
6351da177e4SLinus Torvalds 		break;
6361da177e4SLinus Torvalds 	case DASD_ECKD_CCW_READ_COUNT:
6371da177e4SLinus Torvalds 		data->operation.operation = 0x06;
6381da177e4SLinus Torvalds 		break;
6391da177e4SLinus Torvalds 	case DASD_ECKD_CCW_ERASE:
6401da177e4SLinus Torvalds 		data->length = reclen;
6411da177e4SLinus Torvalds 		data->auxiliary.last_bytes_used = 0x1;
6421da177e4SLinus Torvalds 		data->operation.operation = 0x0b;
6431da177e4SLinus Torvalds 		break;
6441da177e4SLinus Torvalds 	default:
645fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_ERR, device, "unknown locate record "
646fc19f381SStefan Haberland 			      "opcode 0x%x", cmd);
6471da177e4SLinus Torvalds 	}
648b44b0ab3SStefan Weinhuber 	set_ch_t(&data->seek_addr,
649b44b0ab3SStefan Weinhuber 		 trk / private->rdc_data.trk_per_cyl,
650b44b0ab3SStefan Weinhuber 		 trk % private->rdc_data.trk_per_cyl);
651b44b0ab3SStefan Weinhuber 	data->search_arg.cyl = data->seek_addr.cyl;
652b44b0ab3SStefan Weinhuber 	data->search_arg.head = data->seek_addr.head;
6531da177e4SLinus Torvalds 	data->search_arg.record = rec_on_trk;
6541da177e4SLinus Torvalds }
6551da177e4SLinus Torvalds 
6561da177e4SLinus Torvalds /*
6571da177e4SLinus Torvalds  * Returns 1 if the block is one of the special blocks that needs
6581da177e4SLinus Torvalds  * to get read/written with the KD variant of the command.
6591da177e4SLinus Torvalds  * That is DASD_ECKD_READ_KD_MT instead of DASD_ECKD_READ_MT and
6601da177e4SLinus Torvalds  * DASD_ECKD_WRITE_KD_MT instead of DASD_ECKD_WRITE_MT.
6611da177e4SLinus Torvalds  * Luckily the KD variants differ only by one bit (0x08) from the
6621da177e4SLinus Torvalds  * normal variant. So don't wonder about code like:
6631da177e4SLinus Torvalds  * if (dasd_eckd_cdl_special(blk_per_trk, recid))
6641da177e4SLinus Torvalds  *         ccw->cmd_code |= 0x8;
6651da177e4SLinus Torvalds  */
6661da177e4SLinus Torvalds static inline int
6671da177e4SLinus Torvalds dasd_eckd_cdl_special(int blk_per_trk, int recid)
6681da177e4SLinus Torvalds {
6691da177e4SLinus Torvalds 	if (recid < 3)
6701da177e4SLinus Torvalds 		return 1;
6711da177e4SLinus Torvalds 	if (recid < blk_per_trk)
6721da177e4SLinus Torvalds 		return 0;
6731da177e4SLinus Torvalds 	if (recid < 2 * blk_per_trk)
6741da177e4SLinus Torvalds 		return 1;
6751da177e4SLinus Torvalds 	return 0;
6761da177e4SLinus Torvalds }
6771da177e4SLinus Torvalds 
6781da177e4SLinus Torvalds /*
6791da177e4SLinus Torvalds  * Returns the record size for the special blocks of the cdl format.
6801da177e4SLinus Torvalds  * Only returns something useful if dasd_eckd_cdl_special is true
6811da177e4SLinus Torvalds  * for the recid.
6821da177e4SLinus Torvalds  */
6831da177e4SLinus Torvalds static inline int
6841da177e4SLinus Torvalds dasd_eckd_cdl_reclen(int recid)
6851da177e4SLinus Torvalds {
6861da177e4SLinus Torvalds 	if (recid < 3)
6871da177e4SLinus Torvalds 		return sizes_trk0[recid];
6881da177e4SLinus Torvalds 	return LABEL_SIZE;
6891da177e4SLinus Torvalds }
6901da177e4SLinus Torvalds 
6913d052595SHorst Hummel /*
6923d052595SHorst Hummel  * Generate device unique id that specifies the physical device.
6933d052595SHorst Hummel  */
6944abb08c2SStefan Weinhuber static int dasd_eckd_generate_uid(struct dasd_device *device,
6954abb08c2SStefan Weinhuber 				  struct dasd_uid *uid)
6963d052595SHorst Hummel {
6973d052595SHorst Hummel 	struct dasd_eckd_private *private;
6984abb08c2SStefan Weinhuber 	int count;
6993d052595SHorst Hummel 
7003d052595SHorst Hummel 	private = (struct dasd_eckd_private *) device->private;
7013d052595SHorst Hummel 	if (!private)
7023d052595SHorst Hummel 		return -ENODEV;
7034abb08c2SStefan Weinhuber 	if (!private->ned || !private->gneq)
7043d052595SHorst Hummel 		return -ENODEV;
7053d052595SHorst Hummel 
7063d052595SHorst Hummel 	memset(uid, 0, sizeof(struct dasd_uid));
7074abb08c2SStefan Weinhuber 	memcpy(uid->vendor, private->ned->HDA_manufacturer,
7083d052595SHorst Hummel 	       sizeof(uid->vendor) - 1);
7093d052595SHorst Hummel 	EBCASC(uid->vendor, sizeof(uid->vendor) - 1);
7104abb08c2SStefan Weinhuber 	memcpy(uid->serial, private->ned->HDA_location,
7113d052595SHorst Hummel 	       sizeof(uid->serial) - 1);
7123d052595SHorst Hummel 	EBCASC(uid->serial, sizeof(uid->serial) - 1);
7134abb08c2SStefan Weinhuber 	uid->ssid = private->gneq->subsystemID;
714a419aef8SJoe Perches 	uid->real_unit_addr = private->ned->unit_addr;
7154abb08c2SStefan Weinhuber 	if (private->sneq) {
7164abb08c2SStefan Weinhuber 		uid->type = private->sneq->sua_flags;
7178e09f215SStefan Weinhuber 		if (uid->type == UA_BASE_PAV_ALIAS)
7184abb08c2SStefan Weinhuber 			uid->base_unit_addr = private->sneq->base_unit_addr;
7198e09f215SStefan Weinhuber 	} else {
7208e09f215SStefan Weinhuber 		uid->type = UA_BASE_DEVICE;
7218e09f215SStefan Weinhuber 	}
7224abb08c2SStefan Weinhuber 	if (private->vdsneq) {
7234abb08c2SStefan Weinhuber 		for (count = 0; count < 16; count++) {
7244abb08c2SStefan Weinhuber 			sprintf(uid->vduit+2*count, "%02x",
7254abb08c2SStefan Weinhuber 				private->vdsneq->uit[count]);
7264abb08c2SStefan Weinhuber 		}
7274abb08c2SStefan Weinhuber 	}
7283d052595SHorst Hummel 	return 0;
7293d052595SHorst Hummel }
7303d052595SHorst Hummel 
731763968e2SHeiko Carstens static struct dasd_ccw_req *dasd_eckd_build_rcd_lpm(struct dasd_device *device,
73217283b56SCornelia Huck 						    void *rcd_buffer,
73317283b56SCornelia Huck 						    struct ciw *ciw, __u8 lpm)
73417283b56SCornelia Huck {
73517283b56SCornelia Huck 	struct dasd_ccw_req *cqr;
73617283b56SCornelia Huck 	struct ccw1 *ccw;
73717283b56SCornelia Huck 
73868b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* RCD */, ciw->count,
73968b781feSStefan Haberland 				   device);
74017283b56SCornelia Huck 
74117283b56SCornelia Huck 	if (IS_ERR(cqr)) {
742fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
74317283b56SCornelia Huck 			      "Could not allocate RCD request");
74417283b56SCornelia Huck 		return cqr;
74517283b56SCornelia Huck 	}
74617283b56SCornelia Huck 
74717283b56SCornelia Huck 	ccw = cqr->cpaddr;
74817283b56SCornelia Huck 	ccw->cmd_code = ciw->cmd;
74917283b56SCornelia Huck 	ccw->cda = (__u32)(addr_t)rcd_buffer;
75017283b56SCornelia Huck 	ccw->count = ciw->count;
75117283b56SCornelia Huck 
7528e09f215SStefan Weinhuber 	cqr->startdev = device;
7538e09f215SStefan Weinhuber 	cqr->memdev = device;
7548e09f215SStefan Weinhuber 	cqr->block = NULL;
75517283b56SCornelia Huck 	cqr->expires = 10*HZ;
75617283b56SCornelia Huck 	cqr->lpm = lpm;
757eb6e199bSStefan Weinhuber 	cqr->retries = 256;
75817283b56SCornelia Huck 	cqr->buildclk = get_clock();
75917283b56SCornelia Huck 	cqr->status = DASD_CQR_FILLED;
76017283b56SCornelia Huck 	return cqr;
76117283b56SCornelia Huck }
76217283b56SCornelia Huck 
76317283b56SCornelia Huck static int dasd_eckd_read_conf_lpm(struct dasd_device *device,
76417283b56SCornelia Huck 				   void **rcd_buffer,
76517283b56SCornelia Huck 				   int *rcd_buffer_size, __u8 lpm)
76617283b56SCornelia Huck {
76717283b56SCornelia Huck 	struct ciw *ciw;
76817283b56SCornelia Huck 	char *rcd_buf = NULL;
76917283b56SCornelia Huck 	int ret;
77017283b56SCornelia Huck 	struct dasd_ccw_req *cqr;
77117283b56SCornelia Huck 
77217283b56SCornelia Huck 	/*
77317283b56SCornelia Huck 	 * scan for RCD command in extended SenseID data
77417283b56SCornelia Huck 	 */
77517283b56SCornelia Huck 	ciw = ccw_device_get_ciw(device->cdev, CIW_TYPE_RCD);
77617283b56SCornelia Huck 	if (!ciw || ciw->cmd == 0) {
77717283b56SCornelia Huck 		ret = -EOPNOTSUPP;
77817283b56SCornelia Huck 		goto out_error;
77917283b56SCornelia Huck 	}
78017283b56SCornelia Huck 	rcd_buf = kzalloc(ciw->count, GFP_KERNEL | GFP_DMA);
78117283b56SCornelia Huck 	if (!rcd_buf) {
78217283b56SCornelia Huck 		ret = -ENOMEM;
78317283b56SCornelia Huck 		goto out_error;
78417283b56SCornelia Huck 	}
7854abb08c2SStefan Weinhuber 
7864abb08c2SStefan Weinhuber 	/*
7874abb08c2SStefan Weinhuber 	 * buffer has to start with EBCDIC "V1.0" to show
7884abb08c2SStefan Weinhuber 	 * support for virtual device SNEQ
7894abb08c2SStefan Weinhuber 	 */
7904abb08c2SStefan Weinhuber 	rcd_buf[0] = 0xE5;
7914abb08c2SStefan Weinhuber 	rcd_buf[1] = 0xF1;
7924abb08c2SStefan Weinhuber 	rcd_buf[2] = 0x4B;
7934abb08c2SStefan Weinhuber 	rcd_buf[3] = 0xF0;
79417283b56SCornelia Huck 	cqr = dasd_eckd_build_rcd_lpm(device, rcd_buf, ciw, lpm);
79517283b56SCornelia Huck 	if (IS_ERR(cqr)) {
79617283b56SCornelia Huck 		ret =  PTR_ERR(cqr);
79717283b56SCornelia Huck 		goto out_error;
79817283b56SCornelia Huck 	}
79917283b56SCornelia Huck 	ret = dasd_sleep_on(cqr);
80017283b56SCornelia Huck 	/*
80117283b56SCornelia Huck 	 * on success we update the user input parms
80217283b56SCornelia Huck 	 */
8038e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
80417283b56SCornelia Huck 	if (ret)
80517283b56SCornelia Huck 		goto out_error;
80617283b56SCornelia Huck 
80717283b56SCornelia Huck 	*rcd_buffer_size = ciw->count;
80817283b56SCornelia Huck 	*rcd_buffer = rcd_buf;
80917283b56SCornelia Huck 	return 0;
81017283b56SCornelia Huck out_error:
81117283b56SCornelia Huck 	kfree(rcd_buf);
81217283b56SCornelia Huck 	*rcd_buffer = NULL;
81317283b56SCornelia Huck 	*rcd_buffer_size = 0;
81417283b56SCornelia Huck 	return ret;
81517283b56SCornelia Huck }
81617283b56SCornelia Huck 
8174abb08c2SStefan Weinhuber static int dasd_eckd_identify_conf_parts(struct dasd_eckd_private *private)
8184abb08c2SStefan Weinhuber {
8194abb08c2SStefan Weinhuber 
8204abb08c2SStefan Weinhuber 	struct dasd_sneq *sneq;
8214abb08c2SStefan Weinhuber 	int i, count;
8224abb08c2SStefan Weinhuber 
8234abb08c2SStefan Weinhuber 	private->ned = NULL;
8244abb08c2SStefan Weinhuber 	private->sneq = NULL;
8254abb08c2SStefan Weinhuber 	private->vdsneq = NULL;
8264abb08c2SStefan Weinhuber 	private->gneq = NULL;
8274abb08c2SStefan Weinhuber 	count = private->conf_len / sizeof(struct dasd_sneq);
8284abb08c2SStefan Weinhuber 	sneq = (struct dasd_sneq *)private->conf_data;
8294abb08c2SStefan Weinhuber 	for (i = 0; i < count; ++i) {
8304abb08c2SStefan Weinhuber 		if (sneq->flags.identifier == 1 && sneq->format == 1)
8314abb08c2SStefan Weinhuber 			private->sneq = sneq;
8324abb08c2SStefan Weinhuber 		else if (sneq->flags.identifier == 1 && sneq->format == 4)
8334abb08c2SStefan Weinhuber 			private->vdsneq = (struct vd_sneq *)sneq;
8344abb08c2SStefan Weinhuber 		else if (sneq->flags.identifier == 2)
8354abb08c2SStefan Weinhuber 			private->gneq = (struct dasd_gneq *)sneq;
8364abb08c2SStefan Weinhuber 		else if (sneq->flags.identifier == 3 && sneq->res1 == 1)
8374abb08c2SStefan Weinhuber 			private->ned = (struct dasd_ned *)sneq;
8384abb08c2SStefan Weinhuber 		sneq++;
8394abb08c2SStefan Weinhuber 	}
8404abb08c2SStefan Weinhuber 	if (!private->ned || !private->gneq) {
8414abb08c2SStefan Weinhuber 		private->ned = NULL;
8424abb08c2SStefan Weinhuber 		private->sneq = NULL;
8434abb08c2SStefan Weinhuber 		private->vdsneq = NULL;
8444abb08c2SStefan Weinhuber 		private->gneq = NULL;
8454abb08c2SStefan Weinhuber 		return -EINVAL;
8464abb08c2SStefan Weinhuber 	}
8474abb08c2SStefan Weinhuber 	return 0;
8484abb08c2SStefan Weinhuber 
8494abb08c2SStefan Weinhuber };
8504abb08c2SStefan Weinhuber 
8514abb08c2SStefan Weinhuber static unsigned char dasd_eckd_path_access(void *conf_data, int conf_len)
8524abb08c2SStefan Weinhuber {
8534abb08c2SStefan Weinhuber 	struct dasd_gneq *gneq;
8544abb08c2SStefan Weinhuber 	int i, count, found;
8554abb08c2SStefan Weinhuber 
8564abb08c2SStefan Weinhuber 	count = conf_len / sizeof(*gneq);
8574abb08c2SStefan Weinhuber 	gneq = (struct dasd_gneq *)conf_data;
8584abb08c2SStefan Weinhuber 	found = 0;
8594abb08c2SStefan Weinhuber 	for (i = 0; i < count; ++i) {
8604abb08c2SStefan Weinhuber 		if (gneq->flags.identifier == 2) {
8614abb08c2SStefan Weinhuber 			found = 1;
8624abb08c2SStefan Weinhuber 			break;
8634abb08c2SStefan Weinhuber 		}
8644abb08c2SStefan Weinhuber 		gneq++;
8654abb08c2SStefan Weinhuber 	}
8664abb08c2SStefan Weinhuber 	if (found)
8674abb08c2SStefan Weinhuber 		return ((char *)gneq)[18] & 0x07;
8684abb08c2SStefan Weinhuber 	else
8694abb08c2SStefan Weinhuber 		return 0;
8704abb08c2SStefan Weinhuber }
8714abb08c2SStefan Weinhuber 
8724abb08c2SStefan Weinhuber static int dasd_eckd_read_conf(struct dasd_device *device)
8731da177e4SLinus Torvalds {
8741da177e4SLinus Torvalds 	void *conf_data;
8751da177e4SLinus Torvalds 	int conf_len, conf_data_saved;
8761da177e4SLinus Torvalds 	int rc;
8771da177e4SLinus Torvalds 	__u8 lpm;
8781da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
8791da177e4SLinus Torvalds 	struct dasd_eckd_path *path_data;
8801da177e4SLinus Torvalds 
8811da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
8821da177e4SLinus Torvalds 	path_data = (struct dasd_eckd_path *) &private->path_data;
8831da177e4SLinus Torvalds 	path_data->opm = ccw_device_get_path_mask(device->cdev);
8841da177e4SLinus Torvalds 	lpm = 0x80;
8851da177e4SLinus Torvalds 	conf_data_saved = 0;
8861da177e4SLinus Torvalds 	/* get configuration data per operational path */
8871da177e4SLinus Torvalds 	for (lpm = 0x80; lpm; lpm>>= 1) {
8881da177e4SLinus Torvalds 		if (lpm & path_data->opm){
88917283b56SCornelia Huck 			rc = dasd_eckd_read_conf_lpm(device, &conf_data,
8901da177e4SLinus Torvalds 						     &conf_len, lpm);
8911da177e4SLinus Torvalds 			if (rc && rc != -EOPNOTSUPP) {	/* -EOPNOTSUPP is ok */
892b8ed5dd5SStefan Haberland 				DBF_EVENT_DEVID(DBF_WARNING, device->cdev,
8931da177e4SLinus Torvalds 					  "Read configuration data returned "
894b8ed5dd5SStefan Haberland 					  "error %d", rc);
8951da177e4SLinus Torvalds 				return rc;
8961da177e4SLinus Torvalds 			}
8971da177e4SLinus Torvalds 			if (conf_data == NULL) {
898b8ed5dd5SStefan Haberland 				DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s",
899b8ed5dd5SStefan Haberland 						"No configuration data "
900b8ed5dd5SStefan Haberland 						"retrieved");
901d133a960SGabriel Craciunescu 				continue;	/* no error */
9021da177e4SLinus Torvalds 			}
9031da177e4SLinus Torvalds 			/* save first valid configuration data */
9041da177e4SLinus Torvalds 			if (!conf_data_saved) {
9054abb08c2SStefan Weinhuber 				kfree(private->conf_data);
9064abb08c2SStefan Weinhuber 				private->conf_data = conf_data;
9074abb08c2SStefan Weinhuber 				private->conf_len = conf_len;
9084abb08c2SStefan Weinhuber 				if (dasd_eckd_identify_conf_parts(private)) {
9094abb08c2SStefan Weinhuber 					private->conf_data = NULL;
9104abb08c2SStefan Weinhuber 					private->conf_len = 0;
9114abb08c2SStefan Weinhuber 					kfree(conf_data);
9124abb08c2SStefan Weinhuber 					continue;
9134abb08c2SStefan Weinhuber 				}
9141da177e4SLinus Torvalds 				conf_data_saved++;
9151da177e4SLinus Torvalds 			}
9164abb08c2SStefan Weinhuber 			switch (dasd_eckd_path_access(conf_data, conf_len)) {
9171da177e4SLinus Torvalds 			case 0x02:
9181da177e4SLinus Torvalds 				path_data->npm |= lpm;
9191da177e4SLinus Torvalds 				break;
9201da177e4SLinus Torvalds 			case 0x03:
9211da177e4SLinus Torvalds 				path_data->ppm |= lpm;
9221da177e4SLinus Torvalds 				break;
9231da177e4SLinus Torvalds 			}
9244abb08c2SStefan Weinhuber 			if (conf_data != private->conf_data)
9251da177e4SLinus Torvalds 				kfree(conf_data);
9261da177e4SLinus Torvalds 		}
9271da177e4SLinus Torvalds 	}
9281da177e4SLinus Torvalds 	return 0;
9291da177e4SLinus Torvalds }
9301da177e4SLinus Torvalds 
9318e09f215SStefan Weinhuber static int dasd_eckd_read_features(struct dasd_device *device)
9328e09f215SStefan Weinhuber {
9338e09f215SStefan Weinhuber 	struct dasd_psf_prssd_data *prssdp;
9348e09f215SStefan Weinhuber 	struct dasd_rssd_features *features;
9358e09f215SStefan Weinhuber 	struct dasd_ccw_req *cqr;
9368e09f215SStefan Weinhuber 	struct ccw1 *ccw;
9378e09f215SStefan Weinhuber 	int rc;
9388e09f215SStefan Weinhuber 	struct dasd_eckd_private *private;
9398e09f215SStefan Weinhuber 
9408e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) device->private;
94168d1e5f0SStefan Weinhuber 	memset(&private->features, 0, sizeof(struct dasd_rssd_features));
94268b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */	+ 1 /* RSSD */,
9438e09f215SStefan Weinhuber 				   (sizeof(struct dasd_psf_prssd_data) +
9448e09f215SStefan Weinhuber 				    sizeof(struct dasd_rssd_features)),
9458e09f215SStefan Weinhuber 				   device);
9468e09f215SStefan Weinhuber 	if (IS_ERR(cqr)) {
947b8ed5dd5SStefan Haberland 		DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", "Could not "
948b8ed5dd5SStefan Haberland 				"allocate initialization request");
9498e09f215SStefan Weinhuber 		return PTR_ERR(cqr);
9508e09f215SStefan Weinhuber 	}
9518e09f215SStefan Weinhuber 	cqr->startdev = device;
9528e09f215SStefan Weinhuber 	cqr->memdev = device;
9538e09f215SStefan Weinhuber 	cqr->block = NULL;
954eb6e199bSStefan Weinhuber 	cqr->retries = 256;
9558e09f215SStefan Weinhuber 	cqr->expires = 10 * HZ;
9568e09f215SStefan Weinhuber 
9578e09f215SStefan Weinhuber 	/* Prepare for Read Subsystem Data */
9588e09f215SStefan Weinhuber 	prssdp = (struct dasd_psf_prssd_data *) cqr->data;
9598e09f215SStefan Weinhuber 	memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data));
9608e09f215SStefan Weinhuber 	prssdp->order = PSF_ORDER_PRSSD;
9618e09f215SStefan Weinhuber 	prssdp->suborder = 0x41;	/* Read Feature Codes */
9628e09f215SStefan Weinhuber 	/* all other bytes of prssdp must be zero */
9638e09f215SStefan Weinhuber 
9648e09f215SStefan Weinhuber 	ccw = cqr->cpaddr;
9658e09f215SStefan Weinhuber 	ccw->cmd_code = DASD_ECKD_CCW_PSF;
9668e09f215SStefan Weinhuber 	ccw->count = sizeof(struct dasd_psf_prssd_data);
9678e09f215SStefan Weinhuber 	ccw->flags |= CCW_FLAG_CC;
9688e09f215SStefan Weinhuber 	ccw->cda = (__u32)(addr_t) prssdp;
9698e09f215SStefan Weinhuber 
9708e09f215SStefan Weinhuber 	/* Read Subsystem Data - feature codes */
9718e09f215SStefan Weinhuber 	features = (struct dasd_rssd_features *) (prssdp + 1);
9728e09f215SStefan Weinhuber 	memset(features, 0, sizeof(struct dasd_rssd_features));
9738e09f215SStefan Weinhuber 
9748e09f215SStefan Weinhuber 	ccw++;
9758e09f215SStefan Weinhuber 	ccw->cmd_code = DASD_ECKD_CCW_RSSD;
9768e09f215SStefan Weinhuber 	ccw->count = sizeof(struct dasd_rssd_features);
9778e09f215SStefan Weinhuber 	ccw->cda = (__u32)(addr_t) features;
9788e09f215SStefan Weinhuber 
9798e09f215SStefan Weinhuber 	cqr->buildclk = get_clock();
9808e09f215SStefan Weinhuber 	cqr->status = DASD_CQR_FILLED;
9818e09f215SStefan Weinhuber 	rc = dasd_sleep_on(cqr);
9828e09f215SStefan Weinhuber 	if (rc == 0) {
9838e09f215SStefan Weinhuber 		prssdp = (struct dasd_psf_prssd_data *) cqr->data;
9848e09f215SStefan Weinhuber 		features = (struct dasd_rssd_features *) (prssdp + 1);
9858e09f215SStefan Weinhuber 		memcpy(&private->features, features,
9868e09f215SStefan Weinhuber 		       sizeof(struct dasd_rssd_features));
98768d1e5f0SStefan Weinhuber 	} else
98868d1e5f0SStefan Weinhuber 		dev_warn(&device->cdev->dev, "Reading device feature codes"
98968d1e5f0SStefan Weinhuber 			 " failed with rc=%d\n", rc);
9908e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
9918e09f215SStefan Weinhuber 	return rc;
9928e09f215SStefan Weinhuber }
9938e09f215SStefan Weinhuber 
9948e09f215SStefan Weinhuber 
9953d052595SHorst Hummel /*
99640545573SHorst Hummel  * Build CP for Perform Subsystem Function - SSC.
99740545573SHorst Hummel  */
998f3eb5384SStefan Weinhuber static struct dasd_ccw_req *dasd_eckd_build_psf_ssc(struct dasd_device *device,
999f3eb5384SStefan Weinhuber 						    int enable_pav)
100040545573SHorst Hummel {
100140545573SHorst Hummel 	struct dasd_ccw_req *cqr;
100240545573SHorst Hummel 	struct dasd_psf_ssc_data *psf_ssc_data;
100340545573SHorst Hummel 	struct ccw1 *ccw;
100440545573SHorst Hummel 
100568b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ ,
100640545573SHorst Hummel 				  sizeof(struct dasd_psf_ssc_data),
100740545573SHorst Hummel 				  device);
100840545573SHorst Hummel 
100940545573SHorst Hummel 	if (IS_ERR(cqr)) {
1010fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
101140545573SHorst Hummel 			   "Could not allocate PSF-SSC request");
101240545573SHorst Hummel 		return cqr;
101340545573SHorst Hummel 	}
101440545573SHorst Hummel 	psf_ssc_data = (struct dasd_psf_ssc_data *)cqr->data;
101540545573SHorst Hummel 	psf_ssc_data->order = PSF_ORDER_SSC;
1016626350b6SStefan Weinhuber 	psf_ssc_data->suborder = 0xc0;
1017f3eb5384SStefan Weinhuber 	if (enable_pav) {
1018626350b6SStefan Weinhuber 		psf_ssc_data->suborder |= 0x08;
10198e09f215SStefan Weinhuber 		psf_ssc_data->reserved[0] = 0x88;
1020f3eb5384SStefan Weinhuber 	}
102140545573SHorst Hummel 	ccw = cqr->cpaddr;
102240545573SHorst Hummel 	ccw->cmd_code = DASD_ECKD_CCW_PSF;
102340545573SHorst Hummel 	ccw->cda = (__u32)(addr_t)psf_ssc_data;
102440545573SHorst Hummel 	ccw->count = 66;
102540545573SHorst Hummel 
10268e09f215SStefan Weinhuber 	cqr->startdev = device;
10278e09f215SStefan Weinhuber 	cqr->memdev = device;
10288e09f215SStefan Weinhuber 	cqr->block = NULL;
1029eb6e199bSStefan Weinhuber 	cqr->retries = 256;
103040545573SHorst Hummel 	cqr->expires = 10*HZ;
103140545573SHorst Hummel 	cqr->buildclk = get_clock();
103240545573SHorst Hummel 	cqr->status = DASD_CQR_FILLED;
103340545573SHorst Hummel 	return cqr;
103440545573SHorst Hummel }
103540545573SHorst Hummel 
103640545573SHorst Hummel /*
103740545573SHorst Hummel  * Perform Subsystem Function.
103840545573SHorst Hummel  * It is necessary to trigger CIO for channel revalidation since this
103940545573SHorst Hummel  * call might change behaviour of DASD devices.
104040545573SHorst Hummel  */
104140545573SHorst Hummel static int
1042f3eb5384SStefan Weinhuber dasd_eckd_psf_ssc(struct dasd_device *device, int enable_pav)
104340545573SHorst Hummel {
104440545573SHorst Hummel 	struct dasd_ccw_req *cqr;
104540545573SHorst Hummel 	int rc;
104640545573SHorst Hummel 
1047f3eb5384SStefan Weinhuber 	cqr = dasd_eckd_build_psf_ssc(device, enable_pav);
104840545573SHorst Hummel 	if (IS_ERR(cqr))
104940545573SHorst Hummel 		return PTR_ERR(cqr);
105040545573SHorst Hummel 
105140545573SHorst Hummel 	rc = dasd_sleep_on(cqr);
105240545573SHorst Hummel 	if (!rc)
105340545573SHorst Hummel 		/* trigger CIO to reprobe devices */
105440545573SHorst Hummel 		css_schedule_reprobe();
10558e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
105640545573SHorst Hummel 	return rc;
105740545573SHorst Hummel }
105840545573SHorst Hummel 
105940545573SHorst Hummel /*
106040545573SHorst Hummel  * Valide storage server of current device.
106140545573SHorst Hummel  */
10628e09f215SStefan Weinhuber static int dasd_eckd_validate_server(struct dasd_device *device)
106340545573SHorst Hummel {
106440545573SHorst Hummel 	int rc;
10658e09f215SStefan Weinhuber 	struct dasd_eckd_private *private;
1066f3eb5384SStefan Weinhuber 	int enable_pav;
106740545573SHorst Hummel 
106840545573SHorst Hummel 	if (dasd_nopav || MACHINE_IS_VM)
1069f3eb5384SStefan Weinhuber 		enable_pav = 0;
1070f3eb5384SStefan Weinhuber 	else
1071f3eb5384SStefan Weinhuber 		enable_pav = 1;
1072f3eb5384SStefan Weinhuber 	rc = dasd_eckd_psf_ssc(device, enable_pav);
1073eb6e199bSStefan Weinhuber 
107440545573SHorst Hummel 	/* may be requested feature is not available on server,
107540545573SHorst Hummel 	 * therefore just report error and go ahead */
10768e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) device->private;
1077b8ed5dd5SStefan Haberland 	DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "PSF-SSC for SSID %04x "
1078b8ed5dd5SStefan Haberland 			"returned rc=%d", private->uid.ssid, rc);
107940545573SHorst Hummel 	/* RE-Read Configuration Data */
108040545573SHorst Hummel 	return dasd_eckd_read_conf(device);
108140545573SHorst Hummel }
108240545573SHorst Hummel 
108340545573SHorst Hummel /*
10843d052595SHorst Hummel  * Check device characteristics.
10853d052595SHorst Hummel  * If the device is accessible using ECKD discipline, the device is enabled.
10863d052595SHorst Hummel  */
10871da177e4SLinus Torvalds static int
10881da177e4SLinus Torvalds dasd_eckd_check_characteristics(struct dasd_device *device)
10891da177e4SLinus Torvalds {
10901da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
10918e09f215SStefan Weinhuber 	struct dasd_block *block;
10928e09f215SStefan Weinhuber 	int is_known, rc;
10931da177e4SLinus Torvalds 
1094454e1fa1SPeter Oberparleiter 	if (!ccw_device_is_pathgroup(device->cdev)) {
1095454e1fa1SPeter Oberparleiter 		dev_warn(&device->cdev->dev,
1096454e1fa1SPeter Oberparleiter 			 "A channel path group could not be established\n");
1097454e1fa1SPeter Oberparleiter 		return -EIO;
1098454e1fa1SPeter Oberparleiter 	}
1099454e1fa1SPeter Oberparleiter 	if (!ccw_device_is_multipath(device->cdev)) {
1100454e1fa1SPeter Oberparleiter 		dev_info(&device->cdev->dev,
1101454e1fa1SPeter Oberparleiter 			 "The DASD is not operating in multipath mode\n");
1102454e1fa1SPeter Oberparleiter 	}
11031da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
110492636b15SSebastian Ott 	if (!private) {
110592636b15SSebastian Ott 		private = kzalloc(sizeof(*private), GFP_KERNEL | GFP_DMA);
110692636b15SSebastian Ott 		if (!private) {
1107fc19f381SStefan Haberland 			dev_warn(&device->cdev->dev,
1108fc19f381SStefan Haberland 				 "Allocating memory for private DASD data "
1109fc19f381SStefan Haberland 				 "failed\n");
11101da177e4SLinus Torvalds 			return -ENOMEM;
11111da177e4SLinus Torvalds 		}
11121da177e4SLinus Torvalds 		device->private = (void *) private;
111392636b15SSebastian Ott 	} else {
111492636b15SSebastian Ott 		memset(private, 0, sizeof(*private));
11151da177e4SLinus Torvalds 	}
11161da177e4SLinus Torvalds 	/* Invalidate status of initial analysis. */
11171da177e4SLinus Torvalds 	private->init_cqr_status = -1;
11181da177e4SLinus Torvalds 	/* Set default cache operations. */
11191da177e4SLinus Torvalds 	private->attrib.operation = DASD_NORMAL_CACHE;
11201da177e4SLinus Torvalds 	private->attrib.nr_cyl = 0;
11211da177e4SLinus Torvalds 
112240545573SHorst Hummel 	/* Read Configuration Data */
112340545573SHorst Hummel 	rc = dasd_eckd_read_conf(device);
112440545573SHorst Hummel 	if (rc)
11258e09f215SStefan Weinhuber 		goto out_err1;
112640545573SHorst Hummel 
112740545573SHorst Hummel 	/* Generate device unique id and register in devmap */
11288e09f215SStefan Weinhuber 	rc = dasd_eckd_generate_uid(device, &private->uid);
112940545573SHorst Hummel 	if (rc)
11308e09f215SStefan Weinhuber 		goto out_err1;
11318e09f215SStefan Weinhuber 	dasd_set_uid(device->cdev, &private->uid);
11328e09f215SStefan Weinhuber 
11338e09f215SStefan Weinhuber 	if (private->uid.type == UA_BASE_DEVICE) {
11348e09f215SStefan Weinhuber 		block = dasd_alloc_block();
11358e09f215SStefan Weinhuber 		if (IS_ERR(block)) {
1136b8ed5dd5SStefan Haberland 			DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s",
1137b8ed5dd5SStefan Haberland 					"could not allocate dasd "
1138b8ed5dd5SStefan Haberland 					"block structure");
11398e09f215SStefan Weinhuber 			rc = PTR_ERR(block);
11408e09f215SStefan Weinhuber 			goto out_err1;
11418e09f215SStefan Weinhuber 		}
11428e09f215SStefan Weinhuber 		device->block = block;
11438e09f215SStefan Weinhuber 		block->base = device;
11448e09f215SStefan Weinhuber 	}
11458e09f215SStefan Weinhuber 
11468e09f215SStefan Weinhuber 	/* register lcu with alias handling, enable PAV if this is a new lcu */
11478e09f215SStefan Weinhuber 	is_known = dasd_alias_make_device_known_to_lcu(device);
11488e09f215SStefan Weinhuber 	if (is_known < 0) {
11498e09f215SStefan Weinhuber 		rc = is_known;
11508e09f215SStefan Weinhuber 		goto out_err2;
11518e09f215SStefan Weinhuber 	}
11528e09f215SStefan Weinhuber 	if (!is_known) {
11538e09f215SStefan Weinhuber 		/* new lcu found */
11548e09f215SStefan Weinhuber 		rc = dasd_eckd_validate_server(device); /* will switch pav on */
115540545573SHorst Hummel 		if (rc)
11568e09f215SStefan Weinhuber 			goto out_err3;
11578e09f215SStefan Weinhuber 	}
11588e09f215SStefan Weinhuber 
11598e09f215SStefan Weinhuber 	/* Read Feature Codes */
116068d1e5f0SStefan Weinhuber 	dasd_eckd_read_features(device);
116140545573SHorst Hummel 
11621da177e4SLinus Torvalds 	/* Read Device Characteristics */
116368b781feSStefan Haberland 	rc = dasd_generic_read_dev_chars(device, DASD_ECKD_MAGIC,
116468b781feSStefan Haberland 					 &private->rdc_data, 64);
11658e09f215SStefan Weinhuber 	if (rc) {
1166b8ed5dd5SStefan Haberland 		DBF_EVENT_DEVID(DBF_WARNING, device->cdev,
1167b8ed5dd5SStefan Haberland 				"Read device characteristic failed, rc=%d", rc);
11688e09f215SStefan Weinhuber 		goto out_err3;
11698e09f215SStefan Weinhuber 	}
1170b44b0ab3SStefan Weinhuber 	/* find the vaild cylinder size */
1171b44b0ab3SStefan Weinhuber 	if (private->rdc_data.no_cyl == LV_COMPAT_CYL &&
1172b44b0ab3SStefan Weinhuber 	    private->rdc_data.long_no_cyl)
1173b44b0ab3SStefan Weinhuber 		private->real_cyl = private->rdc_data.long_no_cyl;
1174b44b0ab3SStefan Weinhuber 	else
1175b44b0ab3SStefan Weinhuber 		private->real_cyl = private->rdc_data.no_cyl;
1176b44b0ab3SStefan Weinhuber 
1177fc19f381SStefan Haberland 	dev_info(&device->cdev->dev, "New DASD %04X/%02X (CU %04X/%02X) "
1178fc19f381SStefan Haberland 		 "with %d cylinders, %d heads, %d sectors\n",
11791da177e4SLinus Torvalds 		 private->rdc_data.dev_type,
11801da177e4SLinus Torvalds 		 private->rdc_data.dev_model,
11811da177e4SLinus Torvalds 		 private->rdc_data.cu_type,
11821da177e4SLinus Torvalds 		 private->rdc_data.cu_model.model,
1183b44b0ab3SStefan Weinhuber 		 private->real_cyl,
11841da177e4SLinus Torvalds 		 private->rdc_data.trk_per_cyl,
11851da177e4SLinus Torvalds 		 private->rdc_data.sec_per_trk);
11868e09f215SStefan Weinhuber 	return 0;
11878e09f215SStefan Weinhuber 
11888e09f215SStefan Weinhuber out_err3:
11898e09f215SStefan Weinhuber 	dasd_alias_disconnect_device_from_lcu(device);
11908e09f215SStefan Weinhuber out_err2:
11918e09f215SStefan Weinhuber 	dasd_free_block(device->block);
11928e09f215SStefan Weinhuber 	device->block = NULL;
11938e09f215SStefan Weinhuber out_err1:
11944abb08c2SStefan Weinhuber 	kfree(private->conf_data);
11958e09f215SStefan Weinhuber 	kfree(device->private);
11968e09f215SStefan Weinhuber 	device->private = NULL;
11973d052595SHorst Hummel 	return rc;
11981da177e4SLinus Torvalds }
11991da177e4SLinus Torvalds 
12008e09f215SStefan Weinhuber static void dasd_eckd_uncheck_device(struct dasd_device *device)
12018e09f215SStefan Weinhuber {
12024abb08c2SStefan Weinhuber 	struct dasd_eckd_private *private;
12034abb08c2SStefan Weinhuber 
12044abb08c2SStefan Weinhuber 	private = (struct dasd_eckd_private *) device->private;
12058e09f215SStefan Weinhuber 	dasd_alias_disconnect_device_from_lcu(device);
12064abb08c2SStefan Weinhuber 	private->ned = NULL;
12074abb08c2SStefan Weinhuber 	private->sneq = NULL;
12084abb08c2SStefan Weinhuber 	private->vdsneq = NULL;
12094abb08c2SStefan Weinhuber 	private->gneq = NULL;
12104abb08c2SStefan Weinhuber 	private->conf_len = 0;
12114abb08c2SStefan Weinhuber 	kfree(private->conf_data);
12124abb08c2SStefan Weinhuber 	private->conf_data = NULL;
12138e09f215SStefan Weinhuber }
12148e09f215SStefan Weinhuber 
12151da177e4SLinus Torvalds static struct dasd_ccw_req *
12161da177e4SLinus Torvalds dasd_eckd_analysis_ccw(struct dasd_device *device)
12171da177e4SLinus Torvalds {
12181da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
12191da177e4SLinus Torvalds 	struct eckd_count *count_data;
12201da177e4SLinus Torvalds 	struct LO_eckd_data *LO_data;
12211da177e4SLinus Torvalds 	struct dasd_ccw_req *cqr;
12221da177e4SLinus Torvalds 	struct ccw1 *ccw;
12231da177e4SLinus Torvalds 	int cplength, datasize;
12241da177e4SLinus Torvalds 	int i;
12251da177e4SLinus Torvalds 
12261da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
12271da177e4SLinus Torvalds 
12281da177e4SLinus Torvalds 	cplength = 8;
12291da177e4SLinus Torvalds 	datasize = sizeof(struct DE_eckd_data) + 2*sizeof(struct LO_eckd_data);
123068b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, device);
12311da177e4SLinus Torvalds 	if (IS_ERR(cqr))
12321da177e4SLinus Torvalds 		return cqr;
12331da177e4SLinus Torvalds 	ccw = cqr->cpaddr;
12341da177e4SLinus Torvalds 	/* Define extent for the first 3 tracks. */
12351da177e4SLinus Torvalds 	define_extent(ccw++, cqr->data, 0, 2,
12361da177e4SLinus Torvalds 		      DASD_ECKD_CCW_READ_COUNT, device);
12371da177e4SLinus Torvalds 	LO_data = cqr->data + sizeof(struct DE_eckd_data);
12381da177e4SLinus Torvalds 	/* Locate record for the first 4 records on track 0. */
12391da177e4SLinus Torvalds 	ccw[-1].flags |= CCW_FLAG_CC;
12401da177e4SLinus Torvalds 	locate_record(ccw++, LO_data++, 0, 0, 4,
12411da177e4SLinus Torvalds 		      DASD_ECKD_CCW_READ_COUNT, device, 0);
12421da177e4SLinus Torvalds 
12431da177e4SLinus Torvalds 	count_data = private->count_area;
12441da177e4SLinus Torvalds 	for (i = 0; i < 4; i++) {
12451da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
12461da177e4SLinus Torvalds 		ccw->cmd_code = DASD_ECKD_CCW_READ_COUNT;
12471da177e4SLinus Torvalds 		ccw->flags = 0;
12481da177e4SLinus Torvalds 		ccw->count = 8;
12491da177e4SLinus Torvalds 		ccw->cda = (__u32)(addr_t) count_data;
12501da177e4SLinus Torvalds 		ccw++;
12511da177e4SLinus Torvalds 		count_data++;
12521da177e4SLinus Torvalds 	}
12531da177e4SLinus Torvalds 
12541da177e4SLinus Torvalds 	/* Locate record for the first record on track 2. */
12551da177e4SLinus Torvalds 	ccw[-1].flags |= CCW_FLAG_CC;
12561da177e4SLinus Torvalds 	locate_record(ccw++, LO_data++, 2, 0, 1,
12571da177e4SLinus Torvalds 		      DASD_ECKD_CCW_READ_COUNT, device, 0);
12581da177e4SLinus Torvalds 	/* Read count ccw. */
12591da177e4SLinus Torvalds 	ccw[-1].flags |= CCW_FLAG_CC;
12601da177e4SLinus Torvalds 	ccw->cmd_code = DASD_ECKD_CCW_READ_COUNT;
12611da177e4SLinus Torvalds 	ccw->flags = 0;
12621da177e4SLinus Torvalds 	ccw->count = 8;
12631da177e4SLinus Torvalds 	ccw->cda = (__u32)(addr_t) count_data;
12641da177e4SLinus Torvalds 
12658e09f215SStefan Weinhuber 	cqr->block = NULL;
12668e09f215SStefan Weinhuber 	cqr->startdev = device;
12678e09f215SStefan Weinhuber 	cqr->memdev = device;
1268eb6e199bSStefan Weinhuber 	cqr->retries = 255;
12691da177e4SLinus Torvalds 	cqr->buildclk = get_clock();
12701da177e4SLinus Torvalds 	cqr->status = DASD_CQR_FILLED;
12711da177e4SLinus Torvalds 	return cqr;
12721da177e4SLinus Torvalds }
12731da177e4SLinus Torvalds 
1274eb6e199bSStefan Weinhuber /* differentiate between 'no record found' and any other error */
1275eb6e199bSStefan Weinhuber static int dasd_eckd_analysis_evaluation(struct dasd_ccw_req *init_cqr)
1276eb6e199bSStefan Weinhuber {
1277eb6e199bSStefan Weinhuber 	char *sense;
1278eb6e199bSStefan Weinhuber 	if (init_cqr->status == DASD_CQR_DONE)
1279eb6e199bSStefan Weinhuber 		return INIT_CQR_OK;
1280eb6e199bSStefan Weinhuber 	else if (init_cqr->status == DASD_CQR_NEED_ERP ||
1281eb6e199bSStefan Weinhuber 		 init_cqr->status == DASD_CQR_FAILED) {
1282eb6e199bSStefan Weinhuber 		sense = dasd_get_sense(&init_cqr->irb);
1283eb6e199bSStefan Weinhuber 		if (sense && (sense[1] & SNS1_NO_REC_FOUND))
1284eb6e199bSStefan Weinhuber 			return INIT_CQR_UNFORMATTED;
1285eb6e199bSStefan Weinhuber 		else
1286eb6e199bSStefan Weinhuber 			return INIT_CQR_ERROR;
1287eb6e199bSStefan Weinhuber 	} else
1288eb6e199bSStefan Weinhuber 		return INIT_CQR_ERROR;
1289eb6e199bSStefan Weinhuber }
1290eb6e199bSStefan Weinhuber 
12911da177e4SLinus Torvalds /*
12921da177e4SLinus Torvalds  * This is the callback function for the init_analysis cqr. It saves
12931da177e4SLinus Torvalds  * the status of the initial analysis ccw before it frees it and kicks
12941da177e4SLinus Torvalds  * the device to continue the startup sequence. This will call
12951da177e4SLinus Torvalds  * dasd_eckd_do_analysis again (if the devices has not been marked
12961da177e4SLinus Torvalds  * for deletion in the meantime).
12971da177e4SLinus Torvalds  */
1298eb6e199bSStefan Weinhuber static void dasd_eckd_analysis_callback(struct dasd_ccw_req *init_cqr,
1299eb6e199bSStefan Weinhuber 					void *data)
13001da177e4SLinus Torvalds {
13011da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
13021da177e4SLinus Torvalds 	struct dasd_device *device;
13031da177e4SLinus Torvalds 
13048e09f215SStefan Weinhuber 	device = init_cqr->startdev;
13051da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
1306eb6e199bSStefan Weinhuber 	private->init_cqr_status = dasd_eckd_analysis_evaluation(init_cqr);
13071da177e4SLinus Torvalds 	dasd_sfree_request(init_cqr, device);
13081da177e4SLinus Torvalds 	dasd_kick_device(device);
13091da177e4SLinus Torvalds }
13101da177e4SLinus Torvalds 
1311eb6e199bSStefan Weinhuber static int dasd_eckd_start_analysis(struct dasd_block *block)
13121da177e4SLinus Torvalds {
13131da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
13141da177e4SLinus Torvalds 	struct dasd_ccw_req *init_cqr;
13151da177e4SLinus Torvalds 
13168e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) block->base->private;
13178e09f215SStefan Weinhuber 	init_cqr = dasd_eckd_analysis_ccw(block->base);
13181da177e4SLinus Torvalds 	if (IS_ERR(init_cqr))
13191da177e4SLinus Torvalds 		return PTR_ERR(init_cqr);
13201da177e4SLinus Torvalds 	init_cqr->callback = dasd_eckd_analysis_callback;
13211da177e4SLinus Torvalds 	init_cqr->callback_data = NULL;
13221da177e4SLinus Torvalds 	init_cqr->expires = 5*HZ;
1323eb6e199bSStefan Weinhuber 	/* first try without ERP, so we can later handle unformatted
1324eb6e199bSStefan Weinhuber 	 * devices as special case
1325eb6e199bSStefan Weinhuber 	 */
1326eb6e199bSStefan Weinhuber 	clear_bit(DASD_CQR_FLAGS_USE_ERP, &init_cqr->flags);
1327eb6e199bSStefan Weinhuber 	init_cqr->retries = 0;
13281da177e4SLinus Torvalds 	dasd_add_request_head(init_cqr);
13291da177e4SLinus Torvalds 	return -EAGAIN;
13301da177e4SLinus Torvalds }
13311da177e4SLinus Torvalds 
1332eb6e199bSStefan Weinhuber static int dasd_eckd_end_analysis(struct dasd_block *block)
13331da177e4SLinus Torvalds {
13348e09f215SStefan Weinhuber 	struct dasd_device *device;
13351da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
13361da177e4SLinus Torvalds 	struct eckd_count *count_area;
13371da177e4SLinus Torvalds 	unsigned int sb, blk_per_trk;
13381da177e4SLinus Torvalds 	int status, i;
1339eb6e199bSStefan Weinhuber 	struct dasd_ccw_req *init_cqr;
13401da177e4SLinus Torvalds 
13418e09f215SStefan Weinhuber 	device = block->base;
13421da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
13431da177e4SLinus Torvalds 	status = private->init_cqr_status;
13441da177e4SLinus Torvalds 	private->init_cqr_status = -1;
1345eb6e199bSStefan Weinhuber 	if (status == INIT_CQR_ERROR) {
1346eb6e199bSStefan Weinhuber 		/* try again, this time with full ERP */
1347eb6e199bSStefan Weinhuber 		init_cqr = dasd_eckd_analysis_ccw(device);
1348eb6e199bSStefan Weinhuber 		dasd_sleep_on(init_cqr);
1349eb6e199bSStefan Weinhuber 		status = dasd_eckd_analysis_evaluation(init_cqr);
1350eb6e199bSStefan Weinhuber 		dasd_sfree_request(init_cqr, device);
1351eb6e199bSStefan Weinhuber 	}
1352eb6e199bSStefan Weinhuber 
1353eb6e199bSStefan Weinhuber 	if (status == INIT_CQR_UNFORMATTED) {
1354eb6e199bSStefan Weinhuber 		dev_warn(&device->cdev->dev, "The DASD is not formatted\n");
13551da177e4SLinus Torvalds 		return -EMEDIUMTYPE;
1356eb6e199bSStefan Weinhuber 	} else if (status == INIT_CQR_ERROR) {
1357eb6e199bSStefan Weinhuber 		dev_err(&device->cdev->dev,
1358eb6e199bSStefan Weinhuber 			"Detecting the DASD disk layout failed because "
1359eb6e199bSStefan Weinhuber 			"of an I/O error\n");
1360eb6e199bSStefan Weinhuber 		return -EIO;
13611da177e4SLinus Torvalds 	}
13621da177e4SLinus Torvalds 
13631da177e4SLinus Torvalds 	private->uses_cdl = 1;
13641da177e4SLinus Torvalds 	/* Check Track 0 for Compatible Disk Layout */
13651da177e4SLinus Torvalds 	count_area = NULL;
13661da177e4SLinus Torvalds 	for (i = 0; i < 3; i++) {
13671da177e4SLinus Torvalds 		if (private->count_area[i].kl != 4 ||
13681da177e4SLinus Torvalds 		    private->count_area[i].dl != dasd_eckd_cdl_reclen(i) - 4) {
13691da177e4SLinus Torvalds 			private->uses_cdl = 0;
13701da177e4SLinus Torvalds 			break;
13711da177e4SLinus Torvalds 		}
13721da177e4SLinus Torvalds 	}
13731da177e4SLinus Torvalds 	if (i == 3)
13741da177e4SLinus Torvalds 		count_area = &private->count_area[4];
13751da177e4SLinus Torvalds 
13761da177e4SLinus Torvalds 	if (private->uses_cdl == 0) {
13771da177e4SLinus Torvalds 		for (i = 0; i < 5; i++) {
13781da177e4SLinus Torvalds 			if ((private->count_area[i].kl != 0) ||
13791da177e4SLinus Torvalds 			    (private->count_area[i].dl !=
13801da177e4SLinus Torvalds 			     private->count_area[0].dl))
13811da177e4SLinus Torvalds 				break;
13821da177e4SLinus Torvalds 		}
13831da177e4SLinus Torvalds 		if (i == 5)
13841da177e4SLinus Torvalds 			count_area = &private->count_area[0];
13851da177e4SLinus Torvalds 	} else {
13861da177e4SLinus Torvalds 		if (private->count_area[3].record == 1)
1387fc19f381SStefan Haberland 			dev_warn(&device->cdev->dev,
1388fc19f381SStefan Haberland 				 "Track 0 has no records following the VTOC\n");
13891da177e4SLinus Torvalds 	}
13901da177e4SLinus Torvalds 	if (count_area != NULL && count_area->kl == 0) {
13911da177e4SLinus Torvalds 		/* we found notthing violating our disk layout */
13921da177e4SLinus Torvalds 		if (dasd_check_blocksize(count_area->dl) == 0)
13938e09f215SStefan Weinhuber 			block->bp_block = count_area->dl;
13941da177e4SLinus Torvalds 	}
13958e09f215SStefan Weinhuber 	if (block->bp_block == 0) {
1396fc19f381SStefan Haberland 		dev_warn(&device->cdev->dev,
1397fc19f381SStefan Haberland 			 "The disk layout of the DASD is not supported\n");
13981da177e4SLinus Torvalds 		return -EMEDIUMTYPE;
13991da177e4SLinus Torvalds 	}
14008e09f215SStefan Weinhuber 	block->s2b_shift = 0;	/* bits to shift 512 to get a block */
14018e09f215SStefan Weinhuber 	for (sb = 512; sb < block->bp_block; sb = sb << 1)
14028e09f215SStefan Weinhuber 		block->s2b_shift++;
14031da177e4SLinus Torvalds 
14048e09f215SStefan Weinhuber 	blk_per_trk = recs_per_track(&private->rdc_data, 0, block->bp_block);
1405b44b0ab3SStefan Weinhuber 	block->blocks = (private->real_cyl *
14061da177e4SLinus Torvalds 			  private->rdc_data.trk_per_cyl *
14071da177e4SLinus Torvalds 			  blk_per_trk);
14081da177e4SLinus Torvalds 
1409fc19f381SStefan Haberland 	dev_info(&device->cdev->dev,
1410fc19f381SStefan Haberland 		 "DASD with %d KB/block, %d KB total size, %d KB/track, "
1411fc19f381SStefan Haberland 		 "%s\n", (block->bp_block >> 10),
1412b44b0ab3SStefan Weinhuber 		 ((private->real_cyl *
14131da177e4SLinus Torvalds 		   private->rdc_data.trk_per_cyl *
14148e09f215SStefan Weinhuber 		   blk_per_trk * (block->bp_block >> 9)) >> 1),
14158e09f215SStefan Weinhuber 		 ((blk_per_trk * block->bp_block) >> 10),
14161da177e4SLinus Torvalds 		 private->uses_cdl ?
14171da177e4SLinus Torvalds 		 "compatible disk layout" : "linux disk layout");
14181da177e4SLinus Torvalds 
14191da177e4SLinus Torvalds 	return 0;
14201da177e4SLinus Torvalds }
14211da177e4SLinus Torvalds 
14228e09f215SStefan Weinhuber static int dasd_eckd_do_analysis(struct dasd_block *block)
14231da177e4SLinus Torvalds {
14241da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
14251da177e4SLinus Torvalds 
14268e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) block->base->private;
14271da177e4SLinus Torvalds 	if (private->init_cqr_status < 0)
14288e09f215SStefan Weinhuber 		return dasd_eckd_start_analysis(block);
14291da177e4SLinus Torvalds 	else
14308e09f215SStefan Weinhuber 		return dasd_eckd_end_analysis(block);
14311da177e4SLinus Torvalds }
14321da177e4SLinus Torvalds 
14338e09f215SStefan Weinhuber static int dasd_eckd_ready_to_online(struct dasd_device *device)
14348e09f215SStefan Weinhuber {
14358e09f215SStefan Weinhuber 	return dasd_alias_add_device(device);
14368e09f215SStefan Weinhuber };
14378e09f215SStefan Weinhuber 
14388e09f215SStefan Weinhuber static int dasd_eckd_online_to_ready(struct dasd_device *device)
14398e09f215SStefan Weinhuber {
14408e09f215SStefan Weinhuber 	return dasd_alias_remove_device(device);
14418e09f215SStefan Weinhuber };
14428e09f215SStefan Weinhuber 
14431da177e4SLinus Torvalds static int
14448e09f215SStefan Weinhuber dasd_eckd_fill_geometry(struct dasd_block *block, struct hd_geometry *geo)
14451da177e4SLinus Torvalds {
14461da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
14471da177e4SLinus Torvalds 
14488e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) block->base->private;
14498e09f215SStefan Weinhuber 	if (dasd_check_blocksize(block->bp_block) == 0) {
14501da177e4SLinus Torvalds 		geo->sectors = recs_per_track(&private->rdc_data,
14518e09f215SStefan Weinhuber 					      0, block->bp_block);
14521da177e4SLinus Torvalds 	}
14531da177e4SLinus Torvalds 	geo->cylinders = private->rdc_data.no_cyl;
14541da177e4SLinus Torvalds 	geo->heads = private->rdc_data.trk_per_cyl;
14551da177e4SLinus Torvalds 	return 0;
14561da177e4SLinus Torvalds }
14571da177e4SLinus Torvalds 
14581da177e4SLinus Torvalds static struct dasd_ccw_req *
14591da177e4SLinus Torvalds dasd_eckd_format_device(struct dasd_device * device,
14601da177e4SLinus Torvalds 			struct format_data_t * fdata)
14611da177e4SLinus Torvalds {
14621da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
14631da177e4SLinus Torvalds 	struct dasd_ccw_req *fcp;
14641da177e4SLinus Torvalds 	struct eckd_count *ect;
14651da177e4SLinus Torvalds 	struct ccw1 *ccw;
14661da177e4SLinus Torvalds 	void *data;
1467b44b0ab3SStefan Weinhuber 	int rpt;
1468b44b0ab3SStefan Weinhuber 	struct ch_t address;
14691da177e4SLinus Torvalds 	int cplength, datasize;
14701da177e4SLinus Torvalds 	int i;
1471f9a28f7bSJean-Baptiste Joret 	int intensity = 0;
1472f9a28f7bSJean-Baptiste Joret 	int r0_perm;
14731da177e4SLinus Torvalds 
14741da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
14751da177e4SLinus Torvalds 	rpt = recs_per_track(&private->rdc_data, 0, fdata->blksize);
1476b44b0ab3SStefan Weinhuber 	set_ch_t(&address,
1477b44b0ab3SStefan Weinhuber 		 fdata->start_unit / private->rdc_data.trk_per_cyl,
1478b44b0ab3SStefan Weinhuber 		 fdata->start_unit % private->rdc_data.trk_per_cyl);
14791da177e4SLinus Torvalds 
14801da177e4SLinus Torvalds 	/* Sanity checks. */
14811da177e4SLinus Torvalds 	if (fdata->start_unit >=
1482b44b0ab3SStefan Weinhuber 	    (private->real_cyl * private->rdc_data.trk_per_cyl)) {
1483fc19f381SStefan Haberland 		dev_warn(&device->cdev->dev, "Start track number %d used in "
1484fc19f381SStefan Haberland 			 "formatting is too big\n", fdata->start_unit);
14851da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
14861da177e4SLinus Torvalds 	}
14871da177e4SLinus Torvalds 	if (fdata->start_unit > fdata->stop_unit) {
1488fc19f381SStefan Haberland 		dev_warn(&device->cdev->dev, "Start track %d used in "
1489fc19f381SStefan Haberland 			 "formatting exceeds end track\n", fdata->start_unit);
14901da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
14911da177e4SLinus Torvalds 	}
14921da177e4SLinus Torvalds 	if (dasd_check_blocksize(fdata->blksize) != 0) {
1493fc19f381SStefan Haberland 		dev_warn(&device->cdev->dev,
1494fc19f381SStefan Haberland 			 "The DASD cannot be formatted with block size %d\n",
14951da177e4SLinus Torvalds 			 fdata->blksize);
14961da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
14971da177e4SLinus Torvalds 	}
14981da177e4SLinus Torvalds 
14991da177e4SLinus Torvalds 	/*
15001da177e4SLinus Torvalds 	 * fdata->intensity is a bit string that tells us what to do:
15011da177e4SLinus Torvalds 	 *   Bit 0: write record zero
15021da177e4SLinus Torvalds 	 *   Bit 1: write home address, currently not supported
15031da177e4SLinus Torvalds 	 *   Bit 2: invalidate tracks
15041da177e4SLinus Torvalds 	 *   Bit 3: use OS/390 compatible disk layout (cdl)
1505f9a28f7bSJean-Baptiste Joret 	 *   Bit 4: do not allow storage subsystem to modify record zero
15061da177e4SLinus Torvalds 	 * Only some bit combinations do make sense.
15071da177e4SLinus Torvalds 	 */
1508f9a28f7bSJean-Baptiste Joret 	if (fdata->intensity & 0x10) {
1509f9a28f7bSJean-Baptiste Joret 		r0_perm = 0;
1510f9a28f7bSJean-Baptiste Joret 		intensity = fdata->intensity & ~0x10;
1511f9a28f7bSJean-Baptiste Joret 	} else {
1512f9a28f7bSJean-Baptiste Joret 		r0_perm = 1;
1513f9a28f7bSJean-Baptiste Joret 		intensity = fdata->intensity;
1514f9a28f7bSJean-Baptiste Joret 	}
1515f9a28f7bSJean-Baptiste Joret 	switch (intensity) {
15161da177e4SLinus Torvalds 	case 0x00:	/* Normal format */
15171da177e4SLinus Torvalds 	case 0x08:	/* Normal format, use cdl. */
15181da177e4SLinus Torvalds 		cplength = 2 + rpt;
15191da177e4SLinus Torvalds 		datasize = sizeof(struct DE_eckd_data) +
15201da177e4SLinus Torvalds 			sizeof(struct LO_eckd_data) +
15211da177e4SLinus Torvalds 			rpt * sizeof(struct eckd_count);
15221da177e4SLinus Torvalds 		break;
15231da177e4SLinus Torvalds 	case 0x01:	/* Write record zero and format track. */
15241da177e4SLinus Torvalds 	case 0x09:	/* Write record zero and format track, use cdl. */
15251da177e4SLinus Torvalds 		cplength = 3 + rpt;
15261da177e4SLinus Torvalds 		datasize = sizeof(struct DE_eckd_data) +
15271da177e4SLinus Torvalds 			sizeof(struct LO_eckd_data) +
15281da177e4SLinus Torvalds 			sizeof(struct eckd_count) +
15291da177e4SLinus Torvalds 			rpt * sizeof(struct eckd_count);
15301da177e4SLinus Torvalds 		break;
15311da177e4SLinus Torvalds 	case 0x04:	/* Invalidate track. */
15321da177e4SLinus Torvalds 	case 0x0c:	/* Invalidate track, use cdl. */
15331da177e4SLinus Torvalds 		cplength = 3;
15341da177e4SLinus Torvalds 		datasize = sizeof(struct DE_eckd_data) +
15351da177e4SLinus Torvalds 			sizeof(struct LO_eckd_data) +
15361da177e4SLinus Torvalds 			sizeof(struct eckd_count);
15371da177e4SLinus Torvalds 		break;
15381da177e4SLinus Torvalds 	default:
1539fc19f381SStefan Haberland 		dev_warn(&device->cdev->dev, "An I/O control call used "
1540fc19f381SStefan Haberland 			 "incorrect flags 0x%x\n", fdata->intensity);
15411da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
15421da177e4SLinus Torvalds 	}
15431da177e4SLinus Torvalds 	/* Allocate the format ccw request. */
154468b781feSStefan Haberland 	fcp = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, device);
15451da177e4SLinus Torvalds 	if (IS_ERR(fcp))
15461da177e4SLinus Torvalds 		return fcp;
15471da177e4SLinus Torvalds 
15481da177e4SLinus Torvalds 	data = fcp->data;
15491da177e4SLinus Torvalds 	ccw = fcp->cpaddr;
15501da177e4SLinus Torvalds 
1551f9a28f7bSJean-Baptiste Joret 	switch (intensity & ~0x08) {
15521da177e4SLinus Torvalds 	case 0x00: /* Normal format. */
15531da177e4SLinus Torvalds 		define_extent(ccw++, (struct DE_eckd_data *) data,
15541da177e4SLinus Torvalds 			      fdata->start_unit, fdata->start_unit,
15551da177e4SLinus Torvalds 			      DASD_ECKD_CCW_WRITE_CKD, device);
1556f9a28f7bSJean-Baptiste Joret 		/* grant subsystem permission to format R0 */
1557f9a28f7bSJean-Baptiste Joret 		if (r0_perm)
1558f9a28f7bSJean-Baptiste Joret 			((struct DE_eckd_data *)data)->ga_extended |= 0x04;
15591da177e4SLinus Torvalds 		data += sizeof(struct DE_eckd_data);
15601da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
15611da177e4SLinus Torvalds 		locate_record(ccw++, (struct LO_eckd_data *) data,
15621da177e4SLinus Torvalds 			      fdata->start_unit, 0, rpt,
15631da177e4SLinus Torvalds 			      DASD_ECKD_CCW_WRITE_CKD, device,
15641da177e4SLinus Torvalds 			      fdata->blksize);
15651da177e4SLinus Torvalds 		data += sizeof(struct LO_eckd_data);
15661da177e4SLinus Torvalds 		break;
15671da177e4SLinus Torvalds 	case 0x01: /* Write record zero + format track. */
15681da177e4SLinus Torvalds 		define_extent(ccw++, (struct DE_eckd_data *) data,
15691da177e4SLinus Torvalds 			      fdata->start_unit, fdata->start_unit,
15701da177e4SLinus Torvalds 			      DASD_ECKD_CCW_WRITE_RECORD_ZERO,
15711da177e4SLinus Torvalds 			      device);
15721da177e4SLinus Torvalds 		data += sizeof(struct DE_eckd_data);
15731da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
15741da177e4SLinus Torvalds 		locate_record(ccw++, (struct LO_eckd_data *) data,
15751da177e4SLinus Torvalds 			      fdata->start_unit, 0, rpt + 1,
15761da177e4SLinus Torvalds 			      DASD_ECKD_CCW_WRITE_RECORD_ZERO, device,
15778e09f215SStefan Weinhuber 			      device->block->bp_block);
15781da177e4SLinus Torvalds 		data += sizeof(struct LO_eckd_data);
15791da177e4SLinus Torvalds 		break;
15801da177e4SLinus Torvalds 	case 0x04: /* Invalidate track. */
15811da177e4SLinus Torvalds 		define_extent(ccw++, (struct DE_eckd_data *) data,
15821da177e4SLinus Torvalds 			      fdata->start_unit, fdata->start_unit,
15831da177e4SLinus Torvalds 			      DASD_ECKD_CCW_WRITE_CKD, device);
15841da177e4SLinus Torvalds 		data += sizeof(struct DE_eckd_data);
15851da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
15861da177e4SLinus Torvalds 		locate_record(ccw++, (struct LO_eckd_data *) data,
15871da177e4SLinus Torvalds 			      fdata->start_unit, 0, 1,
15881da177e4SLinus Torvalds 			      DASD_ECKD_CCW_WRITE_CKD, device, 8);
15891da177e4SLinus Torvalds 		data += sizeof(struct LO_eckd_data);
15901da177e4SLinus Torvalds 		break;
15911da177e4SLinus Torvalds 	}
1592f9a28f7bSJean-Baptiste Joret 	if (intensity & 0x01) {	/* write record zero */
15931da177e4SLinus Torvalds 		ect = (struct eckd_count *) data;
15941da177e4SLinus Torvalds 		data += sizeof(struct eckd_count);
1595b44b0ab3SStefan Weinhuber 		ect->cyl = address.cyl;
1596b44b0ab3SStefan Weinhuber 		ect->head = address.head;
15971da177e4SLinus Torvalds 		ect->record = 0;
15981da177e4SLinus Torvalds 		ect->kl = 0;
15991da177e4SLinus Torvalds 		ect->dl = 8;
16001da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
16011da177e4SLinus Torvalds 		ccw->cmd_code = DASD_ECKD_CCW_WRITE_RECORD_ZERO;
16021da177e4SLinus Torvalds 		ccw->flags = CCW_FLAG_SLI;
16031da177e4SLinus Torvalds 		ccw->count = 8;
16041da177e4SLinus Torvalds 		ccw->cda = (__u32)(addr_t) ect;
16051da177e4SLinus Torvalds 		ccw++;
16061da177e4SLinus Torvalds 	}
1607f9a28f7bSJean-Baptiste Joret 	if ((intensity & ~0x08) & 0x04) {	/* erase track */
16081da177e4SLinus Torvalds 		ect = (struct eckd_count *) data;
16091da177e4SLinus Torvalds 		data += sizeof(struct eckd_count);
1610b44b0ab3SStefan Weinhuber 		ect->cyl = address.cyl;
1611b44b0ab3SStefan Weinhuber 		ect->head = address.head;
16121da177e4SLinus Torvalds 		ect->record = 1;
16131da177e4SLinus Torvalds 		ect->kl = 0;
16141da177e4SLinus Torvalds 		ect->dl = 0;
16151da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
16161da177e4SLinus Torvalds 		ccw->cmd_code = DASD_ECKD_CCW_WRITE_CKD;
16171da177e4SLinus Torvalds 		ccw->flags = CCW_FLAG_SLI;
16181da177e4SLinus Torvalds 		ccw->count = 8;
16191da177e4SLinus Torvalds 		ccw->cda = (__u32)(addr_t) ect;
16201da177e4SLinus Torvalds 	} else {		/* write remaining records */
16211da177e4SLinus Torvalds 		for (i = 0; i < rpt; i++) {
16221da177e4SLinus Torvalds 			ect = (struct eckd_count *) data;
16231da177e4SLinus Torvalds 			data += sizeof(struct eckd_count);
1624b44b0ab3SStefan Weinhuber 			ect->cyl = address.cyl;
1625b44b0ab3SStefan Weinhuber 			ect->head = address.head;
16261da177e4SLinus Torvalds 			ect->record = i + 1;
16271da177e4SLinus Torvalds 			ect->kl = 0;
16281da177e4SLinus Torvalds 			ect->dl = fdata->blksize;
16291da177e4SLinus Torvalds 			/* Check for special tracks 0-1 when formatting CDL */
1630f9a28f7bSJean-Baptiste Joret 			if ((intensity & 0x08) &&
16311da177e4SLinus Torvalds 			    fdata->start_unit == 0) {
16321da177e4SLinus Torvalds 				if (i < 3) {
16331da177e4SLinus Torvalds 					ect->kl = 4;
16341da177e4SLinus Torvalds 					ect->dl = sizes_trk0[i] - 4;
16351da177e4SLinus Torvalds 				}
16361da177e4SLinus Torvalds 			}
1637f9a28f7bSJean-Baptiste Joret 			if ((intensity & 0x08) &&
16381da177e4SLinus Torvalds 			    fdata->start_unit == 1) {
16391da177e4SLinus Torvalds 				ect->kl = 44;
16401da177e4SLinus Torvalds 				ect->dl = LABEL_SIZE - 44;
16411da177e4SLinus Torvalds 			}
16421da177e4SLinus Torvalds 			ccw[-1].flags |= CCW_FLAG_CC;
16431da177e4SLinus Torvalds 			ccw->cmd_code = DASD_ECKD_CCW_WRITE_CKD;
16441da177e4SLinus Torvalds 			ccw->flags = CCW_FLAG_SLI;
16451da177e4SLinus Torvalds 			ccw->count = 8;
16461da177e4SLinus Torvalds 			ccw->cda = (__u32)(addr_t) ect;
16471da177e4SLinus Torvalds 			ccw++;
16481da177e4SLinus Torvalds 		}
16491da177e4SLinus Torvalds 	}
16508e09f215SStefan Weinhuber 	fcp->startdev = device;
16518e09f215SStefan Weinhuber 	fcp->memdev = device;
1652eb6e199bSStefan Weinhuber 	fcp->retries = 256;
16531da177e4SLinus Torvalds 	fcp->buildclk = get_clock();
16541da177e4SLinus Torvalds 	fcp->status = DASD_CQR_FILLED;
16551da177e4SLinus Torvalds 	return fcp;
16561da177e4SLinus Torvalds }
16571da177e4SLinus Torvalds 
16588e09f215SStefan Weinhuber static void dasd_eckd_handle_terminated_request(struct dasd_ccw_req *cqr)
16591da177e4SLinus Torvalds {
16608e09f215SStefan Weinhuber 	cqr->status = DASD_CQR_FILLED;
16618e09f215SStefan Weinhuber 	if (cqr->block && (cqr->startdev != cqr->block->base)) {
16628e09f215SStefan Weinhuber 		dasd_eckd_reset_ccw_to_base_io(cqr);
16638e09f215SStefan Weinhuber 		cqr->startdev = cqr->block->base;
16641da177e4SLinus Torvalds 	}
16658e09f215SStefan Weinhuber };
16661da177e4SLinus Torvalds 
16671da177e4SLinus Torvalds static dasd_erp_fn_t
16681da177e4SLinus Torvalds dasd_eckd_erp_action(struct dasd_ccw_req * cqr)
16691da177e4SLinus Torvalds {
16708e09f215SStefan Weinhuber 	struct dasd_device *device = (struct dasd_device *) cqr->startdev;
16711da177e4SLinus Torvalds 	struct ccw_device *cdev = device->cdev;
16721da177e4SLinus Torvalds 
16731da177e4SLinus Torvalds 	switch (cdev->id.cu_type) {
16741da177e4SLinus Torvalds 	case 0x3990:
16751da177e4SLinus Torvalds 	case 0x2105:
16761da177e4SLinus Torvalds 	case 0x2107:
16771da177e4SLinus Torvalds 	case 0x1750:
16781da177e4SLinus Torvalds 		return dasd_3990_erp_action;
16791da177e4SLinus Torvalds 	case 0x9343:
16801da177e4SLinus Torvalds 	case 0x3880:
16811da177e4SLinus Torvalds 	default:
16821da177e4SLinus Torvalds 		return dasd_default_erp_action;
16831da177e4SLinus Torvalds 	}
16841da177e4SLinus Torvalds }
16851da177e4SLinus Torvalds 
16861da177e4SLinus Torvalds static dasd_erp_fn_t
16871da177e4SLinus Torvalds dasd_eckd_erp_postaction(struct dasd_ccw_req * cqr)
16881da177e4SLinus Torvalds {
16891da177e4SLinus Torvalds 	return dasd_default_erp_postaction;
16901da177e4SLinus Torvalds }
16911da177e4SLinus Torvalds 
16928e09f215SStefan Weinhuber 
16938e09f215SStefan Weinhuber static void dasd_eckd_handle_unsolicited_interrupt(struct dasd_device *device,
16948e09f215SStefan Weinhuber 						   struct irb *irb)
16958e09f215SStefan Weinhuber {
16968e09f215SStefan Weinhuber 	char mask;
1697f3eb5384SStefan Weinhuber 	char *sense = NULL;
16988e09f215SStefan Weinhuber 
16998e09f215SStefan Weinhuber 	/* first of all check for state change pending interrupt */
17008e09f215SStefan Weinhuber 	mask = DEV_STAT_ATTENTION | DEV_STAT_DEV_END | DEV_STAT_UNIT_EXCEP;
1701f3eb5384SStefan Weinhuber 	if ((scsw_dstat(&irb->scsw) & mask) == mask) {
17028e09f215SStefan Weinhuber 		dasd_generic_handle_state_change(device);
17038e09f215SStefan Weinhuber 		return;
17048e09f215SStefan Weinhuber 	}
17058e09f215SStefan Weinhuber 
17068e09f215SStefan Weinhuber 	/* summary unit check */
1707f3eb5384SStefan Weinhuber 	if ((scsw_dstat(&irb->scsw) & DEV_STAT_UNIT_CHECK) &&
170823d805b6SPeter Oberparleiter 	    (irb->ecw[7] == 0x0D)) {
17098e09f215SStefan Weinhuber 		dasd_alias_handle_summary_unit_check(device, irb);
17108e09f215SStefan Weinhuber 		return;
17118e09f215SStefan Weinhuber 	}
17128e09f215SStefan Weinhuber 
1713f3eb5384SStefan Weinhuber 	sense = dasd_get_sense(irb);
1714f60c768cSStefan Haberland 	/* service information message SIM */
1715f3eb5384SStefan Weinhuber 	if (sense && !(sense[27] & DASD_SENSE_BIT_0) &&
1716f3eb5384SStefan Weinhuber 	    ((sense[6] & DASD_SIM_SENSE) == DASD_SIM_SENSE)) {
1717f3eb5384SStefan Weinhuber 		dasd_3990_erp_handle_sim(device, sense);
17189d853cafSStefan Haberland 		dasd_schedule_device_bh(device);
1719f60c768cSStefan Haberland 		return;
1720f60c768cSStefan Haberland 	}
1721f60c768cSStefan Haberland 
1722f3eb5384SStefan Weinhuber 	if ((scsw_cc(&irb->scsw) == 1) &&
1723f3eb5384SStefan Weinhuber 	    (scsw_fctl(&irb->scsw) & SCSW_FCTL_START_FUNC) &&
1724f3eb5384SStefan Weinhuber 	    (scsw_actl(&irb->scsw) & SCSW_ACTL_START_PEND) &&
1725f3eb5384SStefan Weinhuber 	    (scsw_stctl(&irb->scsw) & SCSW_STCTL_STATUS_PEND)) {
1726ada3df91SStefan Haberland 		/* fake irb do nothing, they are handled elsewhere */
17278e09f215SStefan Weinhuber 		dasd_schedule_device_bh(device);
1728ada3df91SStefan Haberland 		return;
1729ada3df91SStefan Haberland 	}
17308e09f215SStefan Weinhuber 
1731f3eb5384SStefan Weinhuber 	if (!sense) {
1732ada3df91SStefan Haberland 		/* just report other unsolicited interrupts */
1733fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_ERR, device, "%s",
1734ada3df91SStefan Haberland 			    "unsolicited interrupt received");
1735ada3df91SStefan Haberland 	} else {
1736fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_ERR, device, "%s",
1737ada3df91SStefan Haberland 			    "unsolicited interrupt received "
1738ada3df91SStefan Haberland 			    "(sense available)");
1739aeec92caSStefan Haberland 		device->discipline->dump_sense_dbf(device, irb, "unsolicited");
1740ada3df91SStefan Haberland 	}
1741ada3df91SStefan Haberland 
1742ada3df91SStefan Haberland 	dasd_schedule_device_bh(device);
17438e09f215SStefan Weinhuber 	return;
17448e09f215SStefan Weinhuber };
17458e09f215SStefan Weinhuber 
1746f3eb5384SStefan Weinhuber 
1747f3eb5384SStefan Weinhuber static struct dasd_ccw_req *dasd_eckd_build_cp_cmd_single(
1748f3eb5384SStefan Weinhuber 					       struct dasd_device *startdev,
17498e09f215SStefan Weinhuber 					       struct dasd_block *block,
1750f3eb5384SStefan Weinhuber 					       struct request *req,
1751f3eb5384SStefan Weinhuber 					       sector_t first_rec,
1752f3eb5384SStefan Weinhuber 					       sector_t last_rec,
1753f3eb5384SStefan Weinhuber 					       sector_t first_trk,
1754f3eb5384SStefan Weinhuber 					       sector_t last_trk,
1755f3eb5384SStefan Weinhuber 					       unsigned int first_offs,
1756f3eb5384SStefan Weinhuber 					       unsigned int last_offs,
1757f3eb5384SStefan Weinhuber 					       unsigned int blk_per_trk,
1758f3eb5384SStefan Weinhuber 					       unsigned int blksize)
17591da177e4SLinus Torvalds {
17601da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
17611da177e4SLinus Torvalds 	unsigned long *idaws;
17621da177e4SLinus Torvalds 	struct LO_eckd_data *LO_data;
17631da177e4SLinus Torvalds 	struct dasd_ccw_req *cqr;
17641da177e4SLinus Torvalds 	struct ccw1 *ccw;
17655705f702SNeilBrown 	struct req_iterator iter;
17661da177e4SLinus Torvalds 	struct bio_vec *bv;
17671da177e4SLinus Torvalds 	char *dst;
1768f3eb5384SStefan Weinhuber 	unsigned int off;
17691da177e4SLinus Torvalds 	int count, cidaw, cplength, datasize;
1770f3eb5384SStefan Weinhuber 	sector_t recid;
17711da177e4SLinus Torvalds 	unsigned char cmd, rcmd;
17728e09f215SStefan Weinhuber 	int use_prefix;
17738e09f215SStefan Weinhuber 	struct dasd_device *basedev;
17741da177e4SLinus Torvalds 
17758e09f215SStefan Weinhuber 	basedev = block->base;
17768e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) basedev->private;
17771da177e4SLinus Torvalds 	if (rq_data_dir(req) == READ)
17781da177e4SLinus Torvalds 		cmd = DASD_ECKD_CCW_READ_MT;
17791da177e4SLinus Torvalds 	else if (rq_data_dir(req) == WRITE)
17801da177e4SLinus Torvalds 		cmd = DASD_ECKD_CCW_WRITE_MT;
17811da177e4SLinus Torvalds 	else
17821da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
1783f3eb5384SStefan Weinhuber 
17841da177e4SLinus Torvalds 	/* Check struct bio and count the number of blocks for the request. */
17851da177e4SLinus Torvalds 	count = 0;
17861da177e4SLinus Torvalds 	cidaw = 0;
17875705f702SNeilBrown 	rq_for_each_segment(bv, req, iter) {
17881da177e4SLinus Torvalds 		if (bv->bv_len & (blksize - 1))
17891da177e4SLinus Torvalds 			/* Eckd can only do full blocks. */
17901da177e4SLinus Torvalds 			return ERR_PTR(-EINVAL);
17918e09f215SStefan Weinhuber 		count += bv->bv_len >> (block->s2b_shift + 9);
1792347a8dc3SMartin Schwidefsky #if defined(CONFIG_64BIT)
17936c92e699SJens Axboe 		if (idal_is_needed (page_address(bv->bv_page), bv->bv_len))
17948e09f215SStefan Weinhuber 			cidaw += bv->bv_len >> (block->s2b_shift + 9);
17951da177e4SLinus Torvalds #endif
17961da177e4SLinus Torvalds 	}
17971da177e4SLinus Torvalds 	/* Paranoia. */
17981da177e4SLinus Torvalds 	if (count != last_rec - first_rec + 1)
17991da177e4SLinus Torvalds 		return ERR_PTR(-EINVAL);
18008e09f215SStefan Weinhuber 
18018e09f215SStefan Weinhuber 	/* use the prefix command if available */
18028e09f215SStefan Weinhuber 	use_prefix = private->features.feature[8] & 0x01;
18038e09f215SStefan Weinhuber 	if (use_prefix) {
18048e09f215SStefan Weinhuber 		/* 1x prefix + number of blocks */
18058e09f215SStefan Weinhuber 		cplength = 2 + count;
18068e09f215SStefan Weinhuber 		/* 1x prefix + cidaws*sizeof(long) */
18078e09f215SStefan Weinhuber 		datasize = sizeof(struct PFX_eckd_data) +
18088e09f215SStefan Weinhuber 			sizeof(struct LO_eckd_data) +
18098e09f215SStefan Weinhuber 			cidaw * sizeof(unsigned long);
18108e09f215SStefan Weinhuber 	} else {
18111da177e4SLinus Torvalds 		/* 1x define extent + 1x locate record + number of blocks */
18121da177e4SLinus Torvalds 		cplength = 2 + count;
18131da177e4SLinus Torvalds 		/* 1x define extent + 1x locate record + cidaws*sizeof(long) */
18148e09f215SStefan Weinhuber 		datasize = sizeof(struct DE_eckd_data) +
18158e09f215SStefan Weinhuber 			sizeof(struct LO_eckd_data) +
18161da177e4SLinus Torvalds 			cidaw * sizeof(unsigned long);
18178e09f215SStefan Weinhuber 	}
18181da177e4SLinus Torvalds 	/* Find out the number of additional locate record ccws for cdl. */
18191da177e4SLinus Torvalds 	if (private->uses_cdl && first_rec < 2*blk_per_trk) {
18201da177e4SLinus Torvalds 		if (last_rec >= 2*blk_per_trk)
18211da177e4SLinus Torvalds 			count = 2*blk_per_trk - first_rec;
18221da177e4SLinus Torvalds 		cplength += count;
18231da177e4SLinus Torvalds 		datasize += count*sizeof(struct LO_eckd_data);
18241da177e4SLinus Torvalds 	}
18251da177e4SLinus Torvalds 	/* Allocate the ccw request. */
182668b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize,
182768b781feSStefan Haberland 				   startdev);
18281da177e4SLinus Torvalds 	if (IS_ERR(cqr))
18291da177e4SLinus Torvalds 		return cqr;
18301da177e4SLinus Torvalds 	ccw = cqr->cpaddr;
18318e09f215SStefan Weinhuber 	/* First ccw is define extent or prefix. */
18328e09f215SStefan Weinhuber 	if (use_prefix) {
18338e09f215SStefan Weinhuber 		if (prefix(ccw++, cqr->data, first_trk,
18348e09f215SStefan Weinhuber 			   last_trk, cmd, basedev, startdev) == -EAGAIN) {
18358e09f215SStefan Weinhuber 			/* Clock not in sync and XRC is enabled.
18368e09f215SStefan Weinhuber 			 * Try again later.
18378e09f215SStefan Weinhuber 			 */
18388e09f215SStefan Weinhuber 			dasd_sfree_request(cqr, startdev);
1839d54853efSMartin Schwidefsky 			return ERR_PTR(-EAGAIN);
1840d54853efSMartin Schwidefsky 		}
18418e09f215SStefan Weinhuber 		idaws = (unsigned long *) (cqr->data +
18428e09f215SStefan Weinhuber 					   sizeof(struct PFX_eckd_data));
18438e09f215SStefan Weinhuber 	} else {
18448e09f215SStefan Weinhuber 		if (define_extent(ccw++, cqr->data, first_trk,
18458e09f215SStefan Weinhuber 				  last_trk, cmd, startdev) == -EAGAIN) {
18468e09f215SStefan Weinhuber 			/* Clock not in sync and XRC is enabled.
18478e09f215SStefan Weinhuber 			 * Try again later.
18488e09f215SStefan Weinhuber 			 */
18498e09f215SStefan Weinhuber 			dasd_sfree_request(cqr, startdev);
18508e09f215SStefan Weinhuber 			return ERR_PTR(-EAGAIN);
18518e09f215SStefan Weinhuber 		}
18528e09f215SStefan Weinhuber 		idaws = (unsigned long *) (cqr->data +
18538e09f215SStefan Weinhuber 					   sizeof(struct DE_eckd_data));
18548e09f215SStefan Weinhuber 	}
18551da177e4SLinus Torvalds 	/* Build locate_record+read/write/ccws. */
18561da177e4SLinus Torvalds 	LO_data = (struct LO_eckd_data *) (idaws + cidaw);
18571da177e4SLinus Torvalds 	recid = first_rec;
18581da177e4SLinus Torvalds 	if (private->uses_cdl == 0 || recid > 2*blk_per_trk) {
18591da177e4SLinus Torvalds 		/* Only standard blocks so there is just one locate record. */
18601da177e4SLinus Torvalds 		ccw[-1].flags |= CCW_FLAG_CC;
18611da177e4SLinus Torvalds 		locate_record(ccw++, LO_data++, first_trk, first_offs + 1,
18628e09f215SStefan Weinhuber 			      last_rec - recid + 1, cmd, basedev, blksize);
18631da177e4SLinus Torvalds 	}
18645705f702SNeilBrown 	rq_for_each_segment(bv, req, iter) {
18651da177e4SLinus Torvalds 		dst = page_address(bv->bv_page) + bv->bv_offset;
18661da177e4SLinus Torvalds 		if (dasd_page_cache) {
18671da177e4SLinus Torvalds 			char *copy = kmem_cache_alloc(dasd_page_cache,
1868441e143eSChristoph Lameter 						      GFP_DMA | __GFP_NOWARN);
18691da177e4SLinus Torvalds 			if (copy && rq_data_dir(req) == WRITE)
18701da177e4SLinus Torvalds 				memcpy(copy + bv->bv_offset, dst, bv->bv_len);
18711da177e4SLinus Torvalds 			if (copy)
18721da177e4SLinus Torvalds 				dst = copy + bv->bv_offset;
18731da177e4SLinus Torvalds 		}
18741da177e4SLinus Torvalds 		for (off = 0; off < bv->bv_len; off += blksize) {
18751da177e4SLinus Torvalds 			sector_t trkid = recid;
18761da177e4SLinus Torvalds 			unsigned int recoffs = sector_div(trkid, blk_per_trk);
18771da177e4SLinus Torvalds 			rcmd = cmd;
18781da177e4SLinus Torvalds 			count = blksize;
18791da177e4SLinus Torvalds 			/* Locate record for cdl special block ? */
18801da177e4SLinus Torvalds 			if (private->uses_cdl && recid < 2*blk_per_trk) {
18811da177e4SLinus Torvalds 				if (dasd_eckd_cdl_special(blk_per_trk, recid)){
18821da177e4SLinus Torvalds 					rcmd |= 0x8;
18831da177e4SLinus Torvalds 					count = dasd_eckd_cdl_reclen(recid);
1884ec5883abSHorst Hummel 					if (count < blksize &&
1885ec5883abSHorst Hummel 					    rq_data_dir(req) == READ)
18861da177e4SLinus Torvalds 						memset(dst + count, 0xe5,
18871da177e4SLinus Torvalds 						       blksize - count);
18881da177e4SLinus Torvalds 				}
18891da177e4SLinus Torvalds 				ccw[-1].flags |= CCW_FLAG_CC;
18901da177e4SLinus Torvalds 				locate_record(ccw++, LO_data++,
18911da177e4SLinus Torvalds 					      trkid, recoffs + 1,
18928e09f215SStefan Weinhuber 					      1, rcmd, basedev, count);
18931da177e4SLinus Torvalds 			}
18941da177e4SLinus Torvalds 			/* Locate record for standard blocks ? */
18951da177e4SLinus Torvalds 			if (private->uses_cdl && recid == 2*blk_per_trk) {
18961da177e4SLinus Torvalds 				ccw[-1].flags |= CCW_FLAG_CC;
18971da177e4SLinus Torvalds 				locate_record(ccw++, LO_data++,
18981da177e4SLinus Torvalds 					      trkid, recoffs + 1,
18991da177e4SLinus Torvalds 					      last_rec - recid + 1,
19008e09f215SStefan Weinhuber 					      cmd, basedev, count);
19011da177e4SLinus Torvalds 			}
19021da177e4SLinus Torvalds 			/* Read/write ccw. */
19031da177e4SLinus Torvalds 			ccw[-1].flags |= CCW_FLAG_CC;
19041da177e4SLinus Torvalds 			ccw->cmd_code = rcmd;
19051da177e4SLinus Torvalds 			ccw->count = count;
19061da177e4SLinus Torvalds 			if (idal_is_needed(dst, blksize)) {
19071da177e4SLinus Torvalds 				ccw->cda = (__u32)(addr_t) idaws;
19081da177e4SLinus Torvalds 				ccw->flags = CCW_FLAG_IDA;
19091da177e4SLinus Torvalds 				idaws = idal_create_words(idaws, dst, blksize);
19101da177e4SLinus Torvalds 			} else {
19111da177e4SLinus Torvalds 				ccw->cda = (__u32)(addr_t) dst;
19121da177e4SLinus Torvalds 				ccw->flags = 0;
19131da177e4SLinus Torvalds 			}
19141da177e4SLinus Torvalds 			ccw++;
19151da177e4SLinus Torvalds 			dst += blksize;
19161da177e4SLinus Torvalds 			recid++;
19171da177e4SLinus Torvalds 		}
19181da177e4SLinus Torvalds 	}
191913de227bSHolger Smolinski 	if (blk_noretry_request(req) ||
192013de227bSHolger Smolinski 	    block->base->features & DASD_FEATURE_FAILFAST)
19211c01b8a5SHorst Hummel 		set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
19228e09f215SStefan Weinhuber 	cqr->startdev = startdev;
19238e09f215SStefan Weinhuber 	cqr->memdev = startdev;
19248e09f215SStefan Weinhuber 	cqr->block = block;
19251da177e4SLinus Torvalds 	cqr->expires = 5 * 60 * HZ;	/* 5 minutes */
19261da177e4SLinus Torvalds 	cqr->lpm = private->path_data.ppm;
19271da177e4SLinus Torvalds 	cqr->retries = 256;
19281da177e4SLinus Torvalds 	cqr->buildclk = get_clock();
19291da177e4SLinus Torvalds 	cqr->status = DASD_CQR_FILLED;
19301da177e4SLinus Torvalds 	return cqr;
19311da177e4SLinus Torvalds }
19321da177e4SLinus Torvalds 
1933f3eb5384SStefan Weinhuber static struct dasd_ccw_req *dasd_eckd_build_cp_cmd_track(
1934f3eb5384SStefan Weinhuber 					       struct dasd_device *startdev,
1935f3eb5384SStefan Weinhuber 					       struct dasd_block *block,
1936f3eb5384SStefan Weinhuber 					       struct request *req,
1937f3eb5384SStefan Weinhuber 					       sector_t first_rec,
1938f3eb5384SStefan Weinhuber 					       sector_t last_rec,
1939f3eb5384SStefan Weinhuber 					       sector_t first_trk,
1940f3eb5384SStefan Weinhuber 					       sector_t last_trk,
1941f3eb5384SStefan Weinhuber 					       unsigned int first_offs,
1942f3eb5384SStefan Weinhuber 					       unsigned int last_offs,
1943f3eb5384SStefan Weinhuber 					       unsigned int blk_per_trk,
1944f3eb5384SStefan Weinhuber 					       unsigned int blksize)
1945f3eb5384SStefan Weinhuber {
1946f3eb5384SStefan Weinhuber 	struct dasd_eckd_private *private;
1947f3eb5384SStefan Weinhuber 	unsigned long *idaws;
1948f3eb5384SStefan Weinhuber 	struct dasd_ccw_req *cqr;
1949f3eb5384SStefan Weinhuber 	struct ccw1 *ccw;
1950f3eb5384SStefan Weinhuber 	struct req_iterator iter;
1951f3eb5384SStefan Weinhuber 	struct bio_vec *bv;
1952f3eb5384SStefan Weinhuber 	char *dst, *idaw_dst;
1953f3eb5384SStefan Weinhuber 	unsigned int cidaw, cplength, datasize;
1954f3eb5384SStefan Weinhuber 	unsigned int tlf;
1955f3eb5384SStefan Weinhuber 	sector_t recid;
1956f3eb5384SStefan Weinhuber 	unsigned char cmd;
1957f3eb5384SStefan Weinhuber 	struct dasd_device *basedev;
1958f3eb5384SStefan Weinhuber 	unsigned int trkcount, count, count_to_trk_end;
1959f3eb5384SStefan Weinhuber 	unsigned int idaw_len, seg_len, part_len, len_to_track_end;
1960f3eb5384SStefan Weinhuber 	unsigned char new_track, end_idaw;
1961f3eb5384SStefan Weinhuber 	sector_t trkid;
1962f3eb5384SStefan Weinhuber 	unsigned int recoffs;
1963f3eb5384SStefan Weinhuber 
1964f3eb5384SStefan Weinhuber 	basedev = block->base;
1965f3eb5384SStefan Weinhuber 	private = (struct dasd_eckd_private *) basedev->private;
1966f3eb5384SStefan Weinhuber 	if (rq_data_dir(req) == READ)
1967f3eb5384SStefan Weinhuber 		cmd = DASD_ECKD_CCW_READ_TRACK_DATA;
1968f3eb5384SStefan Weinhuber 	else if (rq_data_dir(req) == WRITE)
1969f3eb5384SStefan Weinhuber 		cmd = DASD_ECKD_CCW_WRITE_TRACK_DATA;
1970f3eb5384SStefan Weinhuber 	else
1971f3eb5384SStefan Weinhuber 		return ERR_PTR(-EINVAL);
1972f3eb5384SStefan Weinhuber 
1973f3eb5384SStefan Weinhuber 	/* Track based I/O needs IDAWs for each page, and not just for
1974f3eb5384SStefan Weinhuber 	 * 64 bit addresses. We need additional idals for pages
1975f3eb5384SStefan Weinhuber 	 * that get filled from two tracks, so we use the number
1976f3eb5384SStefan Weinhuber 	 * of records as upper limit.
1977f3eb5384SStefan Weinhuber 	 */
1978f3eb5384SStefan Weinhuber 	cidaw = last_rec - first_rec + 1;
1979f3eb5384SStefan Weinhuber 	trkcount = last_trk - first_trk + 1;
1980f3eb5384SStefan Weinhuber 
1981f3eb5384SStefan Weinhuber 	/* 1x prefix + one read/write ccw per track */
1982f3eb5384SStefan Weinhuber 	cplength = 1 + trkcount;
1983f3eb5384SStefan Weinhuber 
1984f3eb5384SStefan Weinhuber 	/* on 31-bit we need space for two 32 bit addresses per page
1985f3eb5384SStefan Weinhuber 	 * on 64-bit one 64 bit address
1986f3eb5384SStefan Weinhuber 	 */
1987f3eb5384SStefan Weinhuber 	datasize = sizeof(struct PFX_eckd_data) +
1988f3eb5384SStefan Weinhuber 		cidaw * sizeof(unsigned long long);
1989f3eb5384SStefan Weinhuber 
1990f3eb5384SStefan Weinhuber 	/* Allocate the ccw request. */
199168b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize,
199268b781feSStefan Haberland 				   startdev);
1993f3eb5384SStefan Weinhuber 	if (IS_ERR(cqr))
1994f3eb5384SStefan Weinhuber 		return cqr;
1995f3eb5384SStefan Weinhuber 	ccw = cqr->cpaddr;
1996f3eb5384SStefan Weinhuber 	/* transfer length factor: how many bytes to read from the last track */
1997f3eb5384SStefan Weinhuber 	if (first_trk == last_trk)
1998f3eb5384SStefan Weinhuber 		tlf = last_offs - first_offs + 1;
1999f3eb5384SStefan Weinhuber 	else
2000f3eb5384SStefan Weinhuber 		tlf = last_offs + 1;
2001f3eb5384SStefan Weinhuber 	tlf *= blksize;
2002f3eb5384SStefan Weinhuber 
2003f3eb5384SStefan Weinhuber 	if (prefix_LRE(ccw++, cqr->data, first_trk,
2004f3eb5384SStefan Weinhuber 		       last_trk, cmd, basedev, startdev,
2005f3eb5384SStefan Weinhuber 		       1 /* format */, first_offs + 1,
2006f3eb5384SStefan Weinhuber 		       trkcount, blksize,
2007f3eb5384SStefan Weinhuber 		       tlf) == -EAGAIN) {
2008f3eb5384SStefan Weinhuber 		/* Clock not in sync and XRC is enabled.
2009f3eb5384SStefan Weinhuber 		 * Try again later.
2010f3eb5384SStefan Weinhuber 		 */
2011f3eb5384SStefan Weinhuber 		dasd_sfree_request(cqr, startdev);
2012f3eb5384SStefan Weinhuber 		return ERR_PTR(-EAGAIN);
2013f3eb5384SStefan Weinhuber 	}
2014f3eb5384SStefan Weinhuber 
2015f3eb5384SStefan Weinhuber 	/*
2016f3eb5384SStefan Weinhuber 	 * The translation of request into ccw programs must meet the
2017f3eb5384SStefan Weinhuber 	 * following conditions:
2018f3eb5384SStefan Weinhuber 	 * - all idaws but the first and the last must address full pages
2019f3eb5384SStefan Weinhuber 	 *   (or 2K blocks on 31-bit)
2020f3eb5384SStefan Weinhuber 	 * - the scope of a ccw and it's idal ends with the track boundaries
2021f3eb5384SStefan Weinhuber 	 */
2022f3eb5384SStefan Weinhuber 	idaws = (unsigned long *) (cqr->data + sizeof(struct PFX_eckd_data));
2023f3eb5384SStefan Weinhuber 	recid = first_rec;
2024f3eb5384SStefan Weinhuber 	new_track = 1;
2025f3eb5384SStefan Weinhuber 	end_idaw = 0;
2026f3eb5384SStefan Weinhuber 	len_to_track_end = 0;
2027f3eb5384SStefan Weinhuber 	idaw_dst = 0;
2028f3eb5384SStefan Weinhuber 	idaw_len = 0;
2029f3eb5384SStefan Weinhuber 	rq_for_each_segment(bv, req, iter) {
2030f3eb5384SStefan Weinhuber 		dst = page_address(bv->bv_page) + bv->bv_offset;
2031f3eb5384SStefan Weinhuber 		seg_len = bv->bv_len;
2032f3eb5384SStefan Weinhuber 		while (seg_len) {
2033f3eb5384SStefan Weinhuber 			if (new_track) {
2034f3eb5384SStefan Weinhuber 				trkid = recid;
2035f3eb5384SStefan Weinhuber 				recoffs = sector_div(trkid, blk_per_trk);
2036f3eb5384SStefan Weinhuber 				count_to_trk_end = blk_per_trk - recoffs;
2037f3eb5384SStefan Weinhuber 				count = min((last_rec - recid + 1),
2038f3eb5384SStefan Weinhuber 					    (sector_t)count_to_trk_end);
2039f3eb5384SStefan Weinhuber 				len_to_track_end = count * blksize;
2040f3eb5384SStefan Weinhuber 				ccw[-1].flags |= CCW_FLAG_CC;
2041f3eb5384SStefan Weinhuber 				ccw->cmd_code = cmd;
2042f3eb5384SStefan Weinhuber 				ccw->count = len_to_track_end;
2043f3eb5384SStefan Weinhuber 				ccw->cda = (__u32)(addr_t)idaws;
2044f3eb5384SStefan Weinhuber 				ccw->flags = CCW_FLAG_IDA;
2045f3eb5384SStefan Weinhuber 				ccw++;
2046f3eb5384SStefan Weinhuber 				recid += count;
2047f3eb5384SStefan Weinhuber 				new_track = 0;
204852db45c3SStefan Weinhuber 				/* first idaw for a ccw may start anywhere */
204952db45c3SStefan Weinhuber 				if (!idaw_dst)
205052db45c3SStefan Weinhuber 					idaw_dst = dst;
2051f3eb5384SStefan Weinhuber 			}
205252db45c3SStefan Weinhuber 			/* If we start a new idaw, we must make sure that it
205352db45c3SStefan Weinhuber 			 * starts on an IDA_BLOCK_SIZE boundary.
2054f3eb5384SStefan Weinhuber 			 * If we continue an idaw, we must make sure that the
2055f3eb5384SStefan Weinhuber 			 * current segment begins where the so far accumulated
2056f3eb5384SStefan Weinhuber 			 * idaw ends
2057f3eb5384SStefan Weinhuber 			 */
205852db45c3SStefan Weinhuber 			if (!idaw_dst) {
205952db45c3SStefan Weinhuber 				if (__pa(dst) & (IDA_BLOCK_SIZE-1)) {
206052db45c3SStefan Weinhuber 					dasd_sfree_request(cqr, startdev);
206152db45c3SStefan Weinhuber 					return ERR_PTR(-ERANGE);
206252db45c3SStefan Weinhuber 				} else
2063f3eb5384SStefan Weinhuber 					idaw_dst = dst;
206452db45c3SStefan Weinhuber 			}
2065f3eb5384SStefan Weinhuber 			if ((idaw_dst + idaw_len) != dst) {
2066f3eb5384SStefan Weinhuber 				dasd_sfree_request(cqr, startdev);
2067f3eb5384SStefan Weinhuber 				return ERR_PTR(-ERANGE);
2068f3eb5384SStefan Weinhuber 			}
2069f3eb5384SStefan Weinhuber 			part_len = min(seg_len, len_to_track_end);
2070f3eb5384SStefan Weinhuber 			seg_len -= part_len;
2071f3eb5384SStefan Weinhuber 			dst += part_len;
2072f3eb5384SStefan Weinhuber 			idaw_len += part_len;
2073f3eb5384SStefan Weinhuber 			len_to_track_end -= part_len;
2074f3eb5384SStefan Weinhuber 			/* collected memory area ends on an IDA_BLOCK border,
2075f3eb5384SStefan Weinhuber 			 * -> create an idaw
2076f3eb5384SStefan Weinhuber 			 * idal_create_words will handle cases where idaw_len
2077f3eb5384SStefan Weinhuber 			 * is larger then IDA_BLOCK_SIZE
2078f3eb5384SStefan Weinhuber 			 */
2079f3eb5384SStefan Weinhuber 			if (!(__pa(idaw_dst + idaw_len) & (IDA_BLOCK_SIZE-1)))
2080f3eb5384SStefan Weinhuber 				end_idaw = 1;
2081f3eb5384SStefan Weinhuber 			/* We also need to end the idaw at track end */
2082f3eb5384SStefan Weinhuber 			if (!len_to_track_end) {
2083f3eb5384SStefan Weinhuber 				new_track = 1;
2084f3eb5384SStefan Weinhuber 				end_idaw = 1;
2085f3eb5384SStefan Weinhuber 			}
2086f3eb5384SStefan Weinhuber 			if (end_idaw) {
2087f3eb5384SStefan Weinhuber 				idaws = idal_create_words(idaws, idaw_dst,
2088f3eb5384SStefan Weinhuber 							  idaw_len);
2089f3eb5384SStefan Weinhuber 				idaw_dst = 0;
2090f3eb5384SStefan Weinhuber 				idaw_len = 0;
2091f3eb5384SStefan Weinhuber 				end_idaw = 0;
2092f3eb5384SStefan Weinhuber 			}
2093f3eb5384SStefan Weinhuber 		}
2094f3eb5384SStefan Weinhuber 	}
2095f3eb5384SStefan Weinhuber 
2096f3eb5384SStefan Weinhuber 	if (blk_noretry_request(req) ||
2097f3eb5384SStefan Weinhuber 	    block->base->features & DASD_FEATURE_FAILFAST)
2098f3eb5384SStefan Weinhuber 		set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
2099f3eb5384SStefan Weinhuber 	cqr->startdev = startdev;
2100f3eb5384SStefan Weinhuber 	cqr->memdev = startdev;
2101f3eb5384SStefan Weinhuber 	cqr->block = block;
2102f3eb5384SStefan Weinhuber 	cqr->expires = 5 * 60 * HZ;	/* 5 minutes */
2103f3eb5384SStefan Weinhuber 	cqr->lpm = private->path_data.ppm;
2104f3eb5384SStefan Weinhuber 	cqr->retries = 256;
2105f3eb5384SStefan Weinhuber 	cqr->buildclk = get_clock();
2106f3eb5384SStefan Weinhuber 	cqr->status = DASD_CQR_FILLED;
2107f3eb5384SStefan Weinhuber 	return cqr;
2108f3eb5384SStefan Weinhuber }
2109f3eb5384SStefan Weinhuber 
2110f3eb5384SStefan Weinhuber static int prepare_itcw(struct itcw *itcw,
2111f3eb5384SStefan Weinhuber 			unsigned int trk, unsigned int totrk, int cmd,
2112f3eb5384SStefan Weinhuber 			struct dasd_device *basedev,
2113f3eb5384SStefan Weinhuber 			struct dasd_device *startdev,
2114f3eb5384SStefan Weinhuber 			unsigned int rec_on_trk, int count,
2115f3eb5384SStefan Weinhuber 			unsigned int blksize,
2116f3eb5384SStefan Weinhuber 			unsigned int total_data_size,
2117f3eb5384SStefan Weinhuber 			unsigned int tlf,
2118f3eb5384SStefan Weinhuber 			unsigned int blk_per_trk)
2119f3eb5384SStefan Weinhuber {
2120f3eb5384SStefan Weinhuber 	struct PFX_eckd_data pfxdata;
2121f3eb5384SStefan Weinhuber 	struct dasd_eckd_private *basepriv, *startpriv;
2122f3eb5384SStefan Weinhuber 	struct DE_eckd_data *dedata;
2123f3eb5384SStefan Weinhuber 	struct LRE_eckd_data *lredata;
2124f3eb5384SStefan Weinhuber 	struct dcw *dcw;
2125f3eb5384SStefan Weinhuber 
2126f3eb5384SStefan Weinhuber 	u32 begcyl, endcyl;
2127f3eb5384SStefan Weinhuber 	u16 heads, beghead, endhead;
2128f3eb5384SStefan Weinhuber 	u8 pfx_cmd;
2129f3eb5384SStefan Weinhuber 
2130f3eb5384SStefan Weinhuber 	int rc = 0;
2131f3eb5384SStefan Weinhuber 	int sector = 0;
2132f3eb5384SStefan Weinhuber 	int dn, d;
2133f3eb5384SStefan Weinhuber 
2134f3eb5384SStefan Weinhuber 
2135f3eb5384SStefan Weinhuber 	/* setup prefix data */
2136f3eb5384SStefan Weinhuber 	basepriv = (struct dasd_eckd_private *) basedev->private;
2137f3eb5384SStefan Weinhuber 	startpriv = (struct dasd_eckd_private *) startdev->private;
2138f3eb5384SStefan Weinhuber 	dedata = &pfxdata.define_extent;
2139f3eb5384SStefan Weinhuber 	lredata = &pfxdata.locate_record;
2140f3eb5384SStefan Weinhuber 
2141f3eb5384SStefan Weinhuber 	memset(&pfxdata, 0, sizeof(pfxdata));
2142f3eb5384SStefan Weinhuber 	pfxdata.format = 1; /* PFX with LRE */
2143f3eb5384SStefan Weinhuber 	pfxdata.base_address = basepriv->ned->unit_addr;
2144f3eb5384SStefan Weinhuber 	pfxdata.base_lss = basepriv->ned->ID;
2145f3eb5384SStefan Weinhuber 	pfxdata.validity.define_extent = 1;
2146f3eb5384SStefan Weinhuber 
2147f3eb5384SStefan Weinhuber 	/* private uid is kept up to date, conf_data may be outdated */
2148f3eb5384SStefan Weinhuber 	if (startpriv->uid.type != UA_BASE_DEVICE) {
2149f3eb5384SStefan Weinhuber 		pfxdata.validity.verify_base = 1;
2150f3eb5384SStefan Weinhuber 		if (startpriv->uid.type == UA_HYPER_PAV_ALIAS)
2151f3eb5384SStefan Weinhuber 			pfxdata.validity.hyper_pav = 1;
2152f3eb5384SStefan Weinhuber 	}
2153f3eb5384SStefan Weinhuber 
2154f3eb5384SStefan Weinhuber 	switch (cmd) {
2155f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_READ_TRACK_DATA:
2156f3eb5384SStefan Weinhuber 		dedata->mask.perm = 0x1;
2157f3eb5384SStefan Weinhuber 		dedata->attributes.operation = basepriv->attrib.operation;
2158f3eb5384SStefan Weinhuber 		dedata->blk_size = blksize;
2159f3eb5384SStefan Weinhuber 		dedata->ga_extended |= 0x42;
2160f3eb5384SStefan Weinhuber 		lredata->operation.orientation = 0x0;
2161f3eb5384SStefan Weinhuber 		lredata->operation.operation = 0x0C;
2162f3eb5384SStefan Weinhuber 		lredata->auxiliary.check_bytes = 0x01;
2163f3eb5384SStefan Weinhuber 		pfx_cmd = DASD_ECKD_CCW_PFX_READ;
2164f3eb5384SStefan Weinhuber 		break;
2165f3eb5384SStefan Weinhuber 	case DASD_ECKD_CCW_WRITE_TRACK_DATA:
2166f3eb5384SStefan Weinhuber 		dedata->mask.perm = 0x02;
2167f3eb5384SStefan Weinhuber 		dedata->attributes.operation = basepriv->attrib.operation;
2168f3eb5384SStefan Weinhuber 		dedata->blk_size = blksize;
2169f3eb5384SStefan Weinhuber 		rc = check_XRC_on_prefix(&pfxdata, basedev);
2170f3eb5384SStefan Weinhuber 		dedata->ga_extended |= 0x42;
2171f3eb5384SStefan Weinhuber 		lredata->operation.orientation = 0x0;
2172f3eb5384SStefan Weinhuber 		lredata->operation.operation = 0x3F;
2173f3eb5384SStefan Weinhuber 		lredata->extended_operation = 0x23;
2174f3eb5384SStefan Weinhuber 		lredata->auxiliary.check_bytes = 0x2;
2175f3eb5384SStefan Weinhuber 		pfx_cmd = DASD_ECKD_CCW_PFX;
2176f3eb5384SStefan Weinhuber 		break;
2177f3eb5384SStefan Weinhuber 	default:
2178f3eb5384SStefan Weinhuber 		DBF_DEV_EVENT(DBF_ERR, basedev,
2179f3eb5384SStefan Weinhuber 			      "prepare itcw, unknown opcode 0x%x", cmd);
2180f3eb5384SStefan Weinhuber 		BUG();
2181f3eb5384SStefan Weinhuber 		break;
2182f3eb5384SStefan Weinhuber 	}
2183f3eb5384SStefan Weinhuber 	if (rc)
2184f3eb5384SStefan Weinhuber 		return rc;
2185f3eb5384SStefan Weinhuber 
2186f3eb5384SStefan Weinhuber 	dedata->attributes.mode = 0x3;	/* ECKD */
2187f3eb5384SStefan Weinhuber 
2188f3eb5384SStefan Weinhuber 	heads = basepriv->rdc_data.trk_per_cyl;
2189f3eb5384SStefan Weinhuber 	begcyl = trk / heads;
2190f3eb5384SStefan Weinhuber 	beghead = trk % heads;
2191f3eb5384SStefan Weinhuber 	endcyl = totrk / heads;
2192f3eb5384SStefan Weinhuber 	endhead = totrk % heads;
2193f3eb5384SStefan Weinhuber 
2194f3eb5384SStefan Weinhuber 	/* check for sequential prestage - enhance cylinder range */
2195f3eb5384SStefan Weinhuber 	if (dedata->attributes.operation == DASD_SEQ_PRESTAGE ||
2196f3eb5384SStefan Weinhuber 	    dedata->attributes.operation == DASD_SEQ_ACCESS) {
2197f3eb5384SStefan Weinhuber 
2198f3eb5384SStefan Weinhuber 		if (endcyl + basepriv->attrib.nr_cyl < basepriv->real_cyl)
2199f3eb5384SStefan Weinhuber 			endcyl += basepriv->attrib.nr_cyl;
2200f3eb5384SStefan Weinhuber 		else
2201f3eb5384SStefan Weinhuber 			endcyl = (basepriv->real_cyl - 1);
2202f3eb5384SStefan Weinhuber 	}
2203f3eb5384SStefan Weinhuber 
2204f3eb5384SStefan Weinhuber 	set_ch_t(&dedata->beg_ext, begcyl, beghead);
2205f3eb5384SStefan Weinhuber 	set_ch_t(&dedata->end_ext, endcyl, endhead);
2206f3eb5384SStefan Weinhuber 
2207f3eb5384SStefan Weinhuber 	dedata->ep_format = 0x20; /* records per track is valid */
2208f3eb5384SStefan Weinhuber 	dedata->ep_rec_per_track = blk_per_trk;
2209f3eb5384SStefan Weinhuber 
2210f3eb5384SStefan Weinhuber 	if (rec_on_trk) {
2211f3eb5384SStefan Weinhuber 		switch (basepriv->rdc_data.dev_type) {
2212f3eb5384SStefan Weinhuber 		case 0x3390:
2213f3eb5384SStefan Weinhuber 			dn = ceil_quot(blksize + 6, 232);
2214f3eb5384SStefan Weinhuber 			d = 9 + ceil_quot(blksize + 6 * (dn + 1), 34);
2215f3eb5384SStefan Weinhuber 			sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8;
2216f3eb5384SStefan Weinhuber 			break;
2217f3eb5384SStefan Weinhuber 		case 0x3380:
2218f3eb5384SStefan Weinhuber 			d = 7 + ceil_quot(blksize + 12, 32);
2219f3eb5384SStefan Weinhuber 			sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7;
2220f3eb5384SStefan Weinhuber 			break;
2221f3eb5384SStefan Weinhuber 		}
2222f3eb5384SStefan Weinhuber 	}
2223f3eb5384SStefan Weinhuber 
2224f3eb5384SStefan Weinhuber 	lredata->auxiliary.length_valid = 1;
2225f3eb5384SStefan Weinhuber 	lredata->auxiliary.length_scope = 1;
2226f3eb5384SStefan Weinhuber 	lredata->auxiliary.imbedded_ccw_valid = 1;
2227f3eb5384SStefan Weinhuber 	lredata->length = tlf;
2228f3eb5384SStefan Weinhuber 	lredata->imbedded_ccw = cmd;
2229f3eb5384SStefan Weinhuber 	lredata->count = count;
2230f3eb5384SStefan Weinhuber 	lredata->sector = sector;
2231f3eb5384SStefan Weinhuber 	set_ch_t(&lredata->seek_addr, begcyl, beghead);
2232f3eb5384SStefan Weinhuber 	lredata->search_arg.cyl = lredata->seek_addr.cyl;
2233f3eb5384SStefan Weinhuber 	lredata->search_arg.head = lredata->seek_addr.head;
2234f3eb5384SStefan Weinhuber 	lredata->search_arg.record = rec_on_trk;
2235f3eb5384SStefan Weinhuber 
2236f3eb5384SStefan Weinhuber 	dcw = itcw_add_dcw(itcw, pfx_cmd, 0,
2237f3eb5384SStefan Weinhuber 		     &pfxdata, sizeof(pfxdata), total_data_size);
2238f3eb5384SStefan Weinhuber 
2239f3eb5384SStefan Weinhuber 	return rc;
2240f3eb5384SStefan Weinhuber }
2241f3eb5384SStefan Weinhuber 
2242f3eb5384SStefan Weinhuber static struct dasd_ccw_req *dasd_eckd_build_cp_tpm_track(
2243f3eb5384SStefan Weinhuber 					       struct dasd_device *startdev,
2244f3eb5384SStefan Weinhuber 					       struct dasd_block *block,
2245f3eb5384SStefan Weinhuber 					       struct request *req,
2246f3eb5384SStefan Weinhuber 					       sector_t first_rec,
2247f3eb5384SStefan Weinhuber 					       sector_t last_rec,
2248f3eb5384SStefan Weinhuber 					       sector_t first_trk,
2249f3eb5384SStefan Weinhuber 					       sector_t last_trk,
2250f3eb5384SStefan Weinhuber 					       unsigned int first_offs,
2251f3eb5384SStefan Weinhuber 					       unsigned int last_offs,
2252f3eb5384SStefan Weinhuber 					       unsigned int blk_per_trk,
2253f3eb5384SStefan Weinhuber 					       unsigned int blksize)
2254f3eb5384SStefan Weinhuber {
2255f3eb5384SStefan Weinhuber 	struct dasd_eckd_private *private;
2256f3eb5384SStefan Weinhuber 	struct dasd_ccw_req *cqr;
2257f3eb5384SStefan Weinhuber 	struct req_iterator iter;
2258f3eb5384SStefan Weinhuber 	struct bio_vec *bv;
2259f3eb5384SStefan Weinhuber 	char *dst;
2260f3eb5384SStefan Weinhuber 	unsigned int trkcount, ctidaw;
2261f3eb5384SStefan Weinhuber 	unsigned char cmd;
2262f3eb5384SStefan Weinhuber 	struct dasd_device *basedev;
2263f3eb5384SStefan Weinhuber 	unsigned int tlf;
2264f3eb5384SStefan Weinhuber 	struct itcw *itcw;
2265f3eb5384SStefan Weinhuber 	struct tidaw *last_tidaw = NULL;
2266f3eb5384SStefan Weinhuber 	int itcw_op;
2267f3eb5384SStefan Weinhuber 	size_t itcw_size;
2268f3eb5384SStefan Weinhuber 
2269f3eb5384SStefan Weinhuber 	basedev = block->base;
2270f3eb5384SStefan Weinhuber 	private = (struct dasd_eckd_private *) basedev->private;
2271f3eb5384SStefan Weinhuber 	if (rq_data_dir(req) == READ) {
2272f3eb5384SStefan Weinhuber 		cmd = DASD_ECKD_CCW_READ_TRACK_DATA;
2273f3eb5384SStefan Weinhuber 		itcw_op = ITCW_OP_READ;
2274f3eb5384SStefan Weinhuber 	} else if (rq_data_dir(req) == WRITE) {
2275f3eb5384SStefan Weinhuber 		cmd = DASD_ECKD_CCW_WRITE_TRACK_DATA;
2276f3eb5384SStefan Weinhuber 		itcw_op = ITCW_OP_WRITE;
2277f3eb5384SStefan Weinhuber 	} else
2278f3eb5384SStefan Weinhuber 		return ERR_PTR(-EINVAL);
2279f3eb5384SStefan Weinhuber 
2280f3eb5384SStefan Weinhuber 	/* trackbased I/O needs address all memory via TIDAWs,
2281f3eb5384SStefan Weinhuber 	 * not just for 64 bit addresses. This allows us to map
2282f3eb5384SStefan Weinhuber 	 * each segment directly to one tidaw.
2283f3eb5384SStefan Weinhuber 	 */
2284f3eb5384SStefan Weinhuber 	trkcount = last_trk - first_trk + 1;
2285f3eb5384SStefan Weinhuber 	ctidaw = 0;
2286f3eb5384SStefan Weinhuber 	rq_for_each_segment(bv, req, iter) {
2287f3eb5384SStefan Weinhuber 		++ctidaw;
2288f3eb5384SStefan Weinhuber 	}
2289f3eb5384SStefan Weinhuber 
2290f3eb5384SStefan Weinhuber 	/* Allocate the ccw request. */
2291f3eb5384SStefan Weinhuber 	itcw_size = itcw_calc_size(0, ctidaw, 0);
229268b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 0, itcw_size, startdev);
2293f3eb5384SStefan Weinhuber 	if (IS_ERR(cqr))
2294f3eb5384SStefan Weinhuber 		return cqr;
2295f3eb5384SStefan Weinhuber 
2296f3eb5384SStefan Weinhuber 	cqr->cpmode = 1;
2297f3eb5384SStefan Weinhuber 	cqr->startdev = startdev;
2298f3eb5384SStefan Weinhuber 	cqr->memdev = startdev;
2299f3eb5384SStefan Weinhuber 	cqr->block = block;
2300f3eb5384SStefan Weinhuber 	cqr->expires = 100*HZ;
2301f3eb5384SStefan Weinhuber 	cqr->buildclk = get_clock();
2302f3eb5384SStefan Weinhuber 	cqr->status = DASD_CQR_FILLED;
2303f3eb5384SStefan Weinhuber 	cqr->retries = 10;
2304f3eb5384SStefan Weinhuber 
2305f3eb5384SStefan Weinhuber 	/* transfer length factor: how many bytes to read from the last track */
2306f3eb5384SStefan Weinhuber 	if (first_trk == last_trk)
2307f3eb5384SStefan Weinhuber 		tlf = last_offs - first_offs + 1;
2308f3eb5384SStefan Weinhuber 	else
2309f3eb5384SStefan Weinhuber 		tlf = last_offs + 1;
2310f3eb5384SStefan Weinhuber 	tlf *= blksize;
2311f3eb5384SStefan Weinhuber 
2312f3eb5384SStefan Weinhuber 	itcw = itcw_init(cqr->data, itcw_size, itcw_op, 0, ctidaw, 0);
2313f3eb5384SStefan Weinhuber 	cqr->cpaddr = itcw_get_tcw(itcw);
2314f3eb5384SStefan Weinhuber 
2315f3eb5384SStefan Weinhuber 	if (prepare_itcw(itcw, first_trk, last_trk,
2316f3eb5384SStefan Weinhuber 			 cmd, basedev, startdev,
2317f3eb5384SStefan Weinhuber 			 first_offs + 1,
2318f3eb5384SStefan Weinhuber 			 trkcount, blksize,
2319f3eb5384SStefan Weinhuber 			 (last_rec - first_rec + 1) * blksize,
2320f3eb5384SStefan Weinhuber 			 tlf, blk_per_trk) == -EAGAIN) {
2321f3eb5384SStefan Weinhuber 		/* Clock not in sync and XRC is enabled.
2322f3eb5384SStefan Weinhuber 		 * Try again later.
2323f3eb5384SStefan Weinhuber 		 */
2324f3eb5384SStefan Weinhuber 		dasd_sfree_request(cqr, startdev);
2325f3eb5384SStefan Weinhuber 		return ERR_PTR(-EAGAIN);
2326f3eb5384SStefan Weinhuber 	}
2327f3eb5384SStefan Weinhuber 
2328f3eb5384SStefan Weinhuber 	/*
2329f3eb5384SStefan Weinhuber 	 * A tidaw can address 4k of memory, but must not cross page boundaries
2330f3eb5384SStefan Weinhuber 	 * We can let the block layer handle this by setting
2331f3eb5384SStefan Weinhuber 	 * blk_queue_segment_boundary to page boundaries and
2332f3eb5384SStefan Weinhuber 	 * blk_max_segment_size to page size when setting up the request queue.
2333f3eb5384SStefan Weinhuber 	 */
2334f3eb5384SStefan Weinhuber 	rq_for_each_segment(bv, req, iter) {
2335f3eb5384SStefan Weinhuber 		dst = page_address(bv->bv_page) + bv->bv_offset;
2336f3eb5384SStefan Weinhuber 		last_tidaw = itcw_add_tidaw(itcw, 0x00, dst, bv->bv_len);
2337f3eb5384SStefan Weinhuber 		if (IS_ERR(last_tidaw))
2338f3eb5384SStefan Weinhuber 			return (struct dasd_ccw_req *)last_tidaw;
2339f3eb5384SStefan Weinhuber 	}
2340f3eb5384SStefan Weinhuber 
2341f3eb5384SStefan Weinhuber 	last_tidaw->flags |= 0x80;
2342f3eb5384SStefan Weinhuber 	itcw_finalize(itcw);
2343f3eb5384SStefan Weinhuber 
2344f3eb5384SStefan Weinhuber 	if (blk_noretry_request(req) ||
2345f3eb5384SStefan Weinhuber 	    block->base->features & DASD_FEATURE_FAILFAST)
2346f3eb5384SStefan Weinhuber 		set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
2347f3eb5384SStefan Weinhuber 	cqr->startdev = startdev;
2348f3eb5384SStefan Weinhuber 	cqr->memdev = startdev;
2349f3eb5384SStefan Weinhuber 	cqr->block = block;
2350f3eb5384SStefan Weinhuber 	cqr->expires = 5 * 60 * HZ;	/* 5 minutes */
2351f3eb5384SStefan Weinhuber 	cqr->lpm = private->path_data.ppm;
2352f3eb5384SStefan Weinhuber 	cqr->retries = 256;
2353f3eb5384SStefan Weinhuber 	cqr->buildclk = get_clock();
2354f3eb5384SStefan Weinhuber 	cqr->status = DASD_CQR_FILLED;
2355f3eb5384SStefan Weinhuber 	return cqr;
2356f3eb5384SStefan Weinhuber }
2357f3eb5384SStefan Weinhuber 
2358f3eb5384SStefan Weinhuber static struct dasd_ccw_req *dasd_eckd_build_cp(struct dasd_device *startdev,
2359f3eb5384SStefan Weinhuber 					       struct dasd_block *block,
2360f3eb5384SStefan Weinhuber 					       struct request *req)
2361f3eb5384SStefan Weinhuber {
2362f3eb5384SStefan Weinhuber 	int tpm, cmdrtd, cmdwtd;
2363f3eb5384SStefan Weinhuber 	int use_prefix;
236445b44d76SStefan Weinhuber #if defined(CONFIG_64BIT)
2365f3eb5384SStefan Weinhuber 	int fcx_in_css, fcx_in_gneq, fcx_in_features;
236645b44d76SStefan Weinhuber #endif
236745b44d76SStefan Weinhuber 	struct dasd_eckd_private *private;
2368f3eb5384SStefan Weinhuber 	struct dasd_device *basedev;
2369f3eb5384SStefan Weinhuber 	sector_t first_rec, last_rec;
2370f3eb5384SStefan Weinhuber 	sector_t first_trk, last_trk;
2371f3eb5384SStefan Weinhuber 	unsigned int first_offs, last_offs;
2372f3eb5384SStefan Weinhuber 	unsigned int blk_per_trk, blksize;
2373f3eb5384SStefan Weinhuber 	int cdlspecial;
2374f3eb5384SStefan Weinhuber 	struct dasd_ccw_req *cqr;
2375f3eb5384SStefan Weinhuber 
2376f3eb5384SStefan Weinhuber 	basedev = block->base;
2377f3eb5384SStefan Weinhuber 	private = (struct dasd_eckd_private *) basedev->private;
2378f3eb5384SStefan Weinhuber 
2379f3eb5384SStefan Weinhuber 	/* Calculate number of blocks/records per track. */
2380f3eb5384SStefan Weinhuber 	blksize = block->bp_block;
2381f3eb5384SStefan Weinhuber 	blk_per_trk = recs_per_track(&private->rdc_data, 0, blksize);
23826fca97a9SStefan Haberland 	if (blk_per_trk == 0)
23836fca97a9SStefan Haberland 		return ERR_PTR(-EINVAL);
2384f3eb5384SStefan Weinhuber 	/* Calculate record id of first and last block. */
238583096ebfSTejun Heo 	first_rec = first_trk = blk_rq_pos(req) >> block->s2b_shift;
2386f3eb5384SStefan Weinhuber 	first_offs = sector_div(first_trk, blk_per_trk);
2387f3eb5384SStefan Weinhuber 	last_rec = last_trk =
238883096ebfSTejun Heo 		(blk_rq_pos(req) + blk_rq_sectors(req) - 1) >> block->s2b_shift;
2389f3eb5384SStefan Weinhuber 	last_offs = sector_div(last_trk, blk_per_trk);
2390f3eb5384SStefan Weinhuber 	cdlspecial = (private->uses_cdl && first_rec < 2*blk_per_trk);
2391f3eb5384SStefan Weinhuber 
2392f3eb5384SStefan Weinhuber 	/* is transport mode supported? */
239345b44d76SStefan Weinhuber #if defined(CONFIG_64BIT)
2394f3eb5384SStefan Weinhuber 	fcx_in_css = css_general_characteristics.fcx;
2395f3eb5384SStefan Weinhuber 	fcx_in_gneq = private->gneq->reserved2[7] & 0x04;
2396f3eb5384SStefan Weinhuber 	fcx_in_features = private->features.feature[40] & 0x80;
2397f3eb5384SStefan Weinhuber 	tpm = fcx_in_css && fcx_in_gneq && fcx_in_features;
239845b44d76SStefan Weinhuber #else
239945b44d76SStefan Weinhuber 	tpm = 0;
240045b44d76SStefan Weinhuber #endif
2401f3eb5384SStefan Weinhuber 
2402f3eb5384SStefan Weinhuber 	/* is read track data and write track data in command mode supported? */
2403f3eb5384SStefan Weinhuber 	cmdrtd = private->features.feature[9] & 0x20;
2404f3eb5384SStefan Weinhuber 	cmdwtd = private->features.feature[12] & 0x40;
2405f3eb5384SStefan Weinhuber 	use_prefix = private->features.feature[8] & 0x01;
2406f3eb5384SStefan Weinhuber 
2407f3eb5384SStefan Weinhuber 	cqr = NULL;
2408f3eb5384SStefan Weinhuber 	if (cdlspecial || dasd_page_cache) {
2409f3eb5384SStefan Weinhuber 		/* do nothing, just fall through to the cmd mode single case */
2410f3eb5384SStefan Weinhuber 	} else if (!dasd_nofcx && tpm && (first_trk == last_trk)) {
2411f3eb5384SStefan Weinhuber 		cqr = dasd_eckd_build_cp_tpm_track(startdev, block, req,
2412f3eb5384SStefan Weinhuber 						    first_rec, last_rec,
2413f3eb5384SStefan Weinhuber 						    first_trk, last_trk,
2414f3eb5384SStefan Weinhuber 						    first_offs, last_offs,
2415f3eb5384SStefan Weinhuber 						    blk_per_trk, blksize);
2416f3eb5384SStefan Weinhuber 		if (IS_ERR(cqr) && PTR_ERR(cqr) != -EAGAIN)
2417f3eb5384SStefan Weinhuber 			cqr = NULL;
2418f3eb5384SStefan Weinhuber 	} else if (use_prefix &&
2419f3eb5384SStefan Weinhuber 		   (((rq_data_dir(req) == READ) && cmdrtd) ||
2420f3eb5384SStefan Weinhuber 		    ((rq_data_dir(req) == WRITE) && cmdwtd))) {
2421f3eb5384SStefan Weinhuber 		cqr = dasd_eckd_build_cp_cmd_track(startdev, block, req,
2422f3eb5384SStefan Weinhuber 						   first_rec, last_rec,
2423f3eb5384SStefan Weinhuber 						   first_trk, last_trk,
2424f3eb5384SStefan Weinhuber 						   first_offs, last_offs,
2425f3eb5384SStefan Weinhuber 						   blk_per_trk, blksize);
2426f3eb5384SStefan Weinhuber 		if (IS_ERR(cqr) && PTR_ERR(cqr) != -EAGAIN)
2427f3eb5384SStefan Weinhuber 			cqr = NULL;
2428f3eb5384SStefan Weinhuber 	}
2429f3eb5384SStefan Weinhuber 	if (!cqr)
2430f3eb5384SStefan Weinhuber 		cqr = dasd_eckd_build_cp_cmd_single(startdev, block, req,
2431f3eb5384SStefan Weinhuber 						    first_rec, last_rec,
2432f3eb5384SStefan Weinhuber 						    first_trk, last_trk,
2433f3eb5384SStefan Weinhuber 						    first_offs, last_offs,
2434f3eb5384SStefan Weinhuber 						    blk_per_trk, blksize);
2435f3eb5384SStefan Weinhuber 	return cqr;
2436f3eb5384SStefan Weinhuber }
2437f3eb5384SStefan Weinhuber 
24381da177e4SLinus Torvalds static int
24391da177e4SLinus Torvalds dasd_eckd_free_cp(struct dasd_ccw_req *cqr, struct request *req)
24401da177e4SLinus Torvalds {
24411da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
24421da177e4SLinus Torvalds 	struct ccw1 *ccw;
24435705f702SNeilBrown 	struct req_iterator iter;
24441da177e4SLinus Torvalds 	struct bio_vec *bv;
24451da177e4SLinus Torvalds 	char *dst, *cda;
24461da177e4SLinus Torvalds 	unsigned int blksize, blk_per_trk, off;
24471da177e4SLinus Torvalds 	sector_t recid;
24485705f702SNeilBrown 	int status;
24491da177e4SLinus Torvalds 
24501da177e4SLinus Torvalds 	if (!dasd_page_cache)
24511da177e4SLinus Torvalds 		goto out;
24528e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) cqr->block->base->private;
24538e09f215SStefan Weinhuber 	blksize = cqr->block->bp_block;
24541da177e4SLinus Torvalds 	blk_per_trk = recs_per_track(&private->rdc_data, 0, blksize);
245583096ebfSTejun Heo 	recid = blk_rq_pos(req) >> cqr->block->s2b_shift;
24561da177e4SLinus Torvalds 	ccw = cqr->cpaddr;
24571da177e4SLinus Torvalds 	/* Skip over define extent & locate record. */
24581da177e4SLinus Torvalds 	ccw++;
24591da177e4SLinus Torvalds 	if (private->uses_cdl == 0 || recid > 2*blk_per_trk)
24601da177e4SLinus Torvalds 		ccw++;
24615705f702SNeilBrown 	rq_for_each_segment(bv, req, iter) {
24621da177e4SLinus Torvalds 		dst = page_address(bv->bv_page) + bv->bv_offset;
24631da177e4SLinus Torvalds 		for (off = 0; off < bv->bv_len; off += blksize) {
24641da177e4SLinus Torvalds 			/* Skip locate record. */
24651da177e4SLinus Torvalds 			if (private->uses_cdl && recid <= 2*blk_per_trk)
24661da177e4SLinus Torvalds 				ccw++;
24671da177e4SLinus Torvalds 			if (dst) {
24681da177e4SLinus Torvalds 				if (ccw->flags & CCW_FLAG_IDA)
24691da177e4SLinus Torvalds 					cda = *((char **)((addr_t) ccw->cda));
24701da177e4SLinus Torvalds 				else
24711da177e4SLinus Torvalds 					cda = (char *)((addr_t) ccw->cda);
24721da177e4SLinus Torvalds 				if (dst != cda) {
24731da177e4SLinus Torvalds 					if (rq_data_dir(req) == READ)
24741da177e4SLinus Torvalds 						memcpy(dst, cda, bv->bv_len);
24751da177e4SLinus Torvalds 					kmem_cache_free(dasd_page_cache,
24761da177e4SLinus Torvalds 					    (void *)((addr_t)cda & PAGE_MASK));
24771da177e4SLinus Torvalds 				}
24781da177e4SLinus Torvalds 				dst = NULL;
24791da177e4SLinus Torvalds 			}
24801da177e4SLinus Torvalds 			ccw++;
24811da177e4SLinus Torvalds 			recid++;
24821da177e4SLinus Torvalds 		}
24831da177e4SLinus Torvalds 	}
24841da177e4SLinus Torvalds out:
24851da177e4SLinus Torvalds 	status = cqr->status == DASD_CQR_DONE;
24868e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
24871da177e4SLinus Torvalds 	return status;
24881da177e4SLinus Torvalds }
24891da177e4SLinus Torvalds 
24908e09f215SStefan Weinhuber /*
2491f3eb5384SStefan Weinhuber  * Modify ccw/tcw in cqr so it can be started on a base device.
24928e09f215SStefan Weinhuber  *
24938e09f215SStefan Weinhuber  * Note that this is not enough to restart the cqr!
24948e09f215SStefan Weinhuber  * Either reset cqr->startdev as well (summary unit check handling)
24958e09f215SStefan Weinhuber  * or restart via separate cqr (as in ERP handling).
24968e09f215SStefan Weinhuber  */
24978e09f215SStefan Weinhuber void dasd_eckd_reset_ccw_to_base_io(struct dasd_ccw_req *cqr)
24988e09f215SStefan Weinhuber {
24998e09f215SStefan Weinhuber 	struct ccw1 *ccw;
25008e09f215SStefan Weinhuber 	struct PFX_eckd_data *pfxdata;
2501f3eb5384SStefan Weinhuber 	struct tcw *tcw;
2502f3eb5384SStefan Weinhuber 	struct tccb *tccb;
2503f3eb5384SStefan Weinhuber 	struct dcw *dcw;
25048e09f215SStefan Weinhuber 
2505f3eb5384SStefan Weinhuber 	if (cqr->cpmode == 1) {
2506f3eb5384SStefan Weinhuber 		tcw = cqr->cpaddr;
2507f3eb5384SStefan Weinhuber 		tccb = tcw_get_tccb(tcw);
2508f3eb5384SStefan Weinhuber 		dcw = (struct dcw *)&tccb->tca[0];
2509f3eb5384SStefan Weinhuber 		pfxdata = (struct PFX_eckd_data *)&dcw->cd[0];
2510f3eb5384SStefan Weinhuber 		pfxdata->validity.verify_base = 0;
2511f3eb5384SStefan Weinhuber 		pfxdata->validity.hyper_pav = 0;
2512f3eb5384SStefan Weinhuber 	} else {
25138e09f215SStefan Weinhuber 		ccw = cqr->cpaddr;
25148e09f215SStefan Weinhuber 		pfxdata = cqr->data;
25158e09f215SStefan Weinhuber 		if (ccw->cmd_code == DASD_ECKD_CCW_PFX) {
25168e09f215SStefan Weinhuber 			pfxdata->validity.verify_base = 0;
25178e09f215SStefan Weinhuber 			pfxdata->validity.hyper_pav = 0;
25188e09f215SStefan Weinhuber 		}
25198e09f215SStefan Weinhuber 	}
2520f3eb5384SStefan Weinhuber }
25218e09f215SStefan Weinhuber 
25228e09f215SStefan Weinhuber #define DASD_ECKD_CHANQ_MAX_SIZE 4
25238e09f215SStefan Weinhuber 
25248e09f215SStefan Weinhuber static struct dasd_ccw_req *dasd_eckd_build_alias_cp(struct dasd_device *base,
25258e09f215SStefan Weinhuber 						     struct dasd_block *block,
25268e09f215SStefan Weinhuber 						     struct request *req)
25278e09f215SStefan Weinhuber {
25288e09f215SStefan Weinhuber 	struct dasd_eckd_private *private;
25298e09f215SStefan Weinhuber 	struct dasd_device *startdev;
25308e09f215SStefan Weinhuber 	unsigned long flags;
25318e09f215SStefan Weinhuber 	struct dasd_ccw_req *cqr;
25328e09f215SStefan Weinhuber 
25338e09f215SStefan Weinhuber 	startdev = dasd_alias_get_start_dev(base);
25348e09f215SStefan Weinhuber 	if (!startdev)
25358e09f215SStefan Weinhuber 		startdev = base;
25368e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) startdev->private;
25378e09f215SStefan Weinhuber 	if (private->count >= DASD_ECKD_CHANQ_MAX_SIZE)
25388e09f215SStefan Weinhuber 		return ERR_PTR(-EBUSY);
25398e09f215SStefan Weinhuber 
25408e09f215SStefan Weinhuber 	spin_lock_irqsave(get_ccwdev_lock(startdev->cdev), flags);
25418e09f215SStefan Weinhuber 	private->count++;
25428e09f215SStefan Weinhuber 	cqr = dasd_eckd_build_cp(startdev, block, req);
25438e09f215SStefan Weinhuber 	if (IS_ERR(cqr))
25448e09f215SStefan Weinhuber 		private->count--;
25458e09f215SStefan Weinhuber 	spin_unlock_irqrestore(get_ccwdev_lock(startdev->cdev), flags);
25468e09f215SStefan Weinhuber 	return cqr;
25478e09f215SStefan Weinhuber }
25488e09f215SStefan Weinhuber 
25498e09f215SStefan Weinhuber static int dasd_eckd_free_alias_cp(struct dasd_ccw_req *cqr,
25508e09f215SStefan Weinhuber 				   struct request *req)
25518e09f215SStefan Weinhuber {
25528e09f215SStefan Weinhuber 	struct dasd_eckd_private *private;
25538e09f215SStefan Weinhuber 	unsigned long flags;
25548e09f215SStefan Weinhuber 
25558e09f215SStefan Weinhuber 	spin_lock_irqsave(get_ccwdev_lock(cqr->memdev->cdev), flags);
25568e09f215SStefan Weinhuber 	private = (struct dasd_eckd_private *) cqr->memdev->private;
25578e09f215SStefan Weinhuber 	private->count--;
25588e09f215SStefan Weinhuber 	spin_unlock_irqrestore(get_ccwdev_lock(cqr->memdev->cdev), flags);
25598e09f215SStefan Weinhuber 	return dasd_eckd_free_cp(cqr, req);
25608e09f215SStefan Weinhuber }
25618e09f215SStefan Weinhuber 
25621da177e4SLinus Torvalds static int
25631da177e4SLinus Torvalds dasd_eckd_fill_info(struct dasd_device * device,
25641da177e4SLinus Torvalds 		    struct dasd_information2_t * info)
25651da177e4SLinus Torvalds {
25661da177e4SLinus Torvalds 	struct dasd_eckd_private *private;
25671da177e4SLinus Torvalds 
25681da177e4SLinus Torvalds 	private = (struct dasd_eckd_private *) device->private;
25691da177e4SLinus Torvalds 	info->label_block = 2;
25701da177e4SLinus Torvalds 	info->FBA_layout = private->uses_cdl ? 0 : 1;
25711da177e4SLinus Torvalds 	info->format = private->uses_cdl ? DASD_FORMAT_CDL : DASD_FORMAT_LDL;
25721da177e4SLinus Torvalds 	info->characteristics_size = sizeof(struct dasd_eckd_characteristics);
25731da177e4SLinus Torvalds 	memcpy(info->characteristics, &private->rdc_data,
25741da177e4SLinus Torvalds 	       sizeof(struct dasd_eckd_characteristics));
25754abb08c2SStefan Weinhuber 	info->confdata_size = min((unsigned long)private->conf_len,
25764abb08c2SStefan Weinhuber 				  sizeof(info->configuration_data));
25774abb08c2SStefan Weinhuber 	memcpy(info->configuration_data, private->conf_data,
25784abb08c2SStefan Weinhuber 	       info->confdata_size);
25791da177e4SLinus Torvalds 	return 0;
25801da177e4SLinus Torvalds }
25811da177e4SLinus Torvalds 
25821da177e4SLinus Torvalds /*
25831da177e4SLinus Torvalds  * SECTION: ioctl functions for eckd devices.
25841da177e4SLinus Torvalds  */
25851da177e4SLinus Torvalds 
25861da177e4SLinus Torvalds /*
25871da177e4SLinus Torvalds  * Release device ioctl.
25881da177e4SLinus Torvalds  * Buils a channel programm to releases a prior reserved
25891da177e4SLinus Torvalds  * (see dasd_eckd_reserve) device.
25901da177e4SLinus Torvalds  */
25911da177e4SLinus Torvalds static int
25921107ccfbSChristoph Hellwig dasd_eckd_release(struct dasd_device *device)
25931da177e4SLinus Torvalds {
25941da177e4SLinus Torvalds 	struct dasd_ccw_req *cqr;
25951da177e4SLinus Torvalds 	int rc;
2596f3eb5384SStefan Weinhuber 	struct ccw1 *ccw;
25971da177e4SLinus Torvalds 
25981da177e4SLinus Torvalds 	if (!capable(CAP_SYS_ADMIN))
25991da177e4SLinus Torvalds 		return -EACCES;
26001da177e4SLinus Torvalds 
260168b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device);
26021da177e4SLinus Torvalds 	if (IS_ERR(cqr)) {
2603fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
26041da177e4SLinus Torvalds 			    "Could not allocate initialization request");
26051da177e4SLinus Torvalds 		return PTR_ERR(cqr);
26061da177e4SLinus Torvalds 	}
2607f3eb5384SStefan Weinhuber 	ccw = cqr->cpaddr;
2608f3eb5384SStefan Weinhuber 	ccw->cmd_code = DASD_ECKD_CCW_RELEASE;
2609f3eb5384SStefan Weinhuber 	ccw->flags |= CCW_FLAG_SLI;
2610f3eb5384SStefan Weinhuber 	ccw->count = 32;
2611f3eb5384SStefan Weinhuber 	ccw->cda = (__u32)(addr_t) cqr->data;
26128e09f215SStefan Weinhuber 	cqr->startdev = device;
26138e09f215SStefan Weinhuber 	cqr->memdev = device;
26141da177e4SLinus Torvalds 	clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags);
26151c01b8a5SHorst Hummel 	set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
2616336c340bSHorst Hummel 	cqr->retries = 2;	/* set retry counter to enable basic ERP */
26171da177e4SLinus Torvalds 	cqr->expires = 2 * HZ;
26181da177e4SLinus Torvalds 	cqr->buildclk = get_clock();
26191da177e4SLinus Torvalds 	cqr->status = DASD_CQR_FILLED;
26201da177e4SLinus Torvalds 
26211da177e4SLinus Torvalds 	rc = dasd_sleep_on_immediatly(cqr);
26221da177e4SLinus Torvalds 
26238e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
26241da177e4SLinus Torvalds 	return rc;
26251da177e4SLinus Torvalds }
26261da177e4SLinus Torvalds 
26271da177e4SLinus Torvalds /*
26281da177e4SLinus Torvalds  * Reserve device ioctl.
26291da177e4SLinus Torvalds  * Options are set to 'synchronous wait for interrupt' and
26301da177e4SLinus Torvalds  * 'timeout the request'. This leads to a terminate IO if
26311da177e4SLinus Torvalds  * the interrupt is outstanding for a certain time.
26321da177e4SLinus Torvalds  */
26331da177e4SLinus Torvalds static int
26341107ccfbSChristoph Hellwig dasd_eckd_reserve(struct dasd_device *device)
26351da177e4SLinus Torvalds {
26361da177e4SLinus Torvalds 	struct dasd_ccw_req *cqr;
26371da177e4SLinus Torvalds 	int rc;
2638f3eb5384SStefan Weinhuber 	struct ccw1 *ccw;
26391da177e4SLinus Torvalds 
26401da177e4SLinus Torvalds 	if (!capable(CAP_SYS_ADMIN))
26411da177e4SLinus Torvalds 		return -EACCES;
26421da177e4SLinus Torvalds 
264368b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device);
26441da177e4SLinus Torvalds 	if (IS_ERR(cqr)) {
2645fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
26461da177e4SLinus Torvalds 			    "Could not allocate initialization request");
26471da177e4SLinus Torvalds 		return PTR_ERR(cqr);
26481da177e4SLinus Torvalds 	}
2649f3eb5384SStefan Weinhuber 	ccw = cqr->cpaddr;
2650f3eb5384SStefan Weinhuber 	ccw->cmd_code = DASD_ECKD_CCW_RESERVE;
2651f3eb5384SStefan Weinhuber 	ccw->flags |= CCW_FLAG_SLI;
2652f3eb5384SStefan Weinhuber 	ccw->count = 32;
2653f3eb5384SStefan Weinhuber 	ccw->cda = (__u32)(addr_t) cqr->data;
26548e09f215SStefan Weinhuber 	cqr->startdev = device;
26558e09f215SStefan Weinhuber 	cqr->memdev = device;
26561da177e4SLinus Torvalds 	clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags);
26571c01b8a5SHorst Hummel 	set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
2658336c340bSHorst Hummel 	cqr->retries = 2;	/* set retry counter to enable basic ERP */
26591da177e4SLinus Torvalds 	cqr->expires = 2 * HZ;
26601da177e4SLinus Torvalds 	cqr->buildclk = get_clock();
26611da177e4SLinus Torvalds 	cqr->status = DASD_CQR_FILLED;
26621da177e4SLinus Torvalds 
26631da177e4SLinus Torvalds 	rc = dasd_sleep_on_immediatly(cqr);
26641da177e4SLinus Torvalds 
26658e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
26661da177e4SLinus Torvalds 	return rc;
26671da177e4SLinus Torvalds }
26681da177e4SLinus Torvalds 
26691da177e4SLinus Torvalds /*
26701da177e4SLinus Torvalds  * Steal lock ioctl - unconditional reserve device.
26711da177e4SLinus Torvalds  * Buils a channel programm to break a device's reservation.
26721da177e4SLinus Torvalds  * (unconditional reserve)
26731da177e4SLinus Torvalds  */
26741da177e4SLinus Torvalds static int
26751107ccfbSChristoph Hellwig dasd_eckd_steal_lock(struct dasd_device *device)
26761da177e4SLinus Torvalds {
26771da177e4SLinus Torvalds 	struct dasd_ccw_req *cqr;
26781da177e4SLinus Torvalds 	int rc;
2679f3eb5384SStefan Weinhuber 	struct ccw1 *ccw;
26801da177e4SLinus Torvalds 
26811da177e4SLinus Torvalds 	if (!capable(CAP_SYS_ADMIN))
26821da177e4SLinus Torvalds 		return -EACCES;
26831da177e4SLinus Torvalds 
268468b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device);
26851da177e4SLinus Torvalds 	if (IS_ERR(cqr)) {
2686fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
26871da177e4SLinus Torvalds 			    "Could not allocate initialization request");
26881da177e4SLinus Torvalds 		return PTR_ERR(cqr);
26891da177e4SLinus Torvalds 	}
2690f3eb5384SStefan Weinhuber 	ccw = cqr->cpaddr;
2691f3eb5384SStefan Weinhuber 	ccw->cmd_code = DASD_ECKD_CCW_SLCK;
2692f3eb5384SStefan Weinhuber 	ccw->flags |= CCW_FLAG_SLI;
2693f3eb5384SStefan Weinhuber 	ccw->count = 32;
2694f3eb5384SStefan Weinhuber 	ccw->cda = (__u32)(addr_t) cqr->data;
26958e09f215SStefan Weinhuber 	cqr->startdev = device;
26968e09f215SStefan Weinhuber 	cqr->memdev = device;
26971da177e4SLinus Torvalds 	clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags);
26981c01b8a5SHorst Hummel 	set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags);
2699336c340bSHorst Hummel 	cqr->retries = 2;	/* set retry counter to enable basic ERP */
27001da177e4SLinus Torvalds 	cqr->expires = 2 * HZ;
27011da177e4SLinus Torvalds 	cqr->buildclk = get_clock();
27021da177e4SLinus Torvalds 	cqr->status = DASD_CQR_FILLED;
27031da177e4SLinus Torvalds 
27041da177e4SLinus Torvalds 	rc = dasd_sleep_on_immediatly(cqr);
27051da177e4SLinus Torvalds 
27068e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
27071da177e4SLinus Torvalds 	return rc;
27081da177e4SLinus Torvalds }
27091da177e4SLinus Torvalds 
27101da177e4SLinus Torvalds /*
27111da177e4SLinus Torvalds  * Read performance statistics
27121da177e4SLinus Torvalds  */
27131da177e4SLinus Torvalds static int
27141107ccfbSChristoph Hellwig dasd_eckd_performance(struct dasd_device *device, void __user *argp)
27151da177e4SLinus Torvalds {
27161da177e4SLinus Torvalds 	struct dasd_psf_prssd_data *prssdp;
27171da177e4SLinus Torvalds 	struct dasd_rssd_perf_stats_t *stats;
27181da177e4SLinus Torvalds 	struct dasd_ccw_req *cqr;
27191da177e4SLinus Torvalds 	struct ccw1 *ccw;
27201da177e4SLinus Torvalds 	int rc;
27211da177e4SLinus Torvalds 
272268b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */  + 1 /* RSSD */,
27231da177e4SLinus Torvalds 				   (sizeof(struct dasd_psf_prssd_data) +
27241da177e4SLinus Torvalds 				    sizeof(struct dasd_rssd_perf_stats_t)),
27251da177e4SLinus Torvalds 				   device);
27261da177e4SLinus Torvalds 	if (IS_ERR(cqr)) {
2727fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
27281da177e4SLinus Torvalds 			    "Could not allocate initialization request");
27291da177e4SLinus Torvalds 		return PTR_ERR(cqr);
27301da177e4SLinus Torvalds 	}
27318e09f215SStefan Weinhuber 	cqr->startdev = device;
27328e09f215SStefan Weinhuber 	cqr->memdev = device;
27331da177e4SLinus Torvalds 	cqr->retries = 0;
2734eb6e199bSStefan Weinhuber 	clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags);
27351da177e4SLinus Torvalds 	cqr->expires = 10 * HZ;
27361da177e4SLinus Torvalds 
27371da177e4SLinus Torvalds 	/* Prepare for Read Subsystem Data */
27381da177e4SLinus Torvalds 	prssdp = (struct dasd_psf_prssd_data *) cqr->data;
27391da177e4SLinus Torvalds 	memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data));
27401da177e4SLinus Torvalds 	prssdp->order = PSF_ORDER_PRSSD;
27415d67d164SJoe Perches 	prssdp->suborder = 0x01;	/* Performance Statistics */
27421da177e4SLinus Torvalds 	prssdp->varies[1] = 0x01;	/* Perf Statistics for the Subsystem */
27431da177e4SLinus Torvalds 
27441da177e4SLinus Torvalds 	ccw = cqr->cpaddr;
27451da177e4SLinus Torvalds 	ccw->cmd_code = DASD_ECKD_CCW_PSF;
27461da177e4SLinus Torvalds 	ccw->count = sizeof(struct dasd_psf_prssd_data);
27471da177e4SLinus Torvalds 	ccw->flags |= CCW_FLAG_CC;
27481da177e4SLinus Torvalds 	ccw->cda = (__u32)(addr_t) prssdp;
27491da177e4SLinus Torvalds 
27501da177e4SLinus Torvalds 	/* Read Subsystem Data - Performance Statistics */
27511da177e4SLinus Torvalds 	stats = (struct dasd_rssd_perf_stats_t *) (prssdp + 1);
27521da177e4SLinus Torvalds 	memset(stats, 0, sizeof(struct dasd_rssd_perf_stats_t));
27531da177e4SLinus Torvalds 
27541da177e4SLinus Torvalds 	ccw++;
27551da177e4SLinus Torvalds 	ccw->cmd_code = DASD_ECKD_CCW_RSSD;
27561da177e4SLinus Torvalds 	ccw->count = sizeof(struct dasd_rssd_perf_stats_t);
27571da177e4SLinus Torvalds 	ccw->cda = (__u32)(addr_t) stats;
27581da177e4SLinus Torvalds 
27591da177e4SLinus Torvalds 	cqr->buildclk = get_clock();
27601da177e4SLinus Torvalds 	cqr->status = DASD_CQR_FILLED;
27611da177e4SLinus Torvalds 	rc = dasd_sleep_on(cqr);
27621da177e4SLinus Torvalds 	if (rc == 0) {
27631da177e4SLinus Torvalds 		prssdp = (struct dasd_psf_prssd_data *) cqr->data;
27641da177e4SLinus Torvalds 		stats = (struct dasd_rssd_perf_stats_t *) (prssdp + 1);
27651107ccfbSChristoph Hellwig 		if (copy_to_user(argp, stats,
27661107ccfbSChristoph Hellwig 				 sizeof(struct dasd_rssd_perf_stats_t)))
27671107ccfbSChristoph Hellwig 			rc = -EFAULT;
27681da177e4SLinus Torvalds 	}
27698e09f215SStefan Weinhuber 	dasd_sfree_request(cqr, cqr->memdev);
27701da177e4SLinus Torvalds 	return rc;
27711da177e4SLinus Torvalds }
27721da177e4SLinus Torvalds 
27731da177e4SLinus Torvalds /*
27741da177e4SLinus Torvalds  * Get attributes (cache operations)
27751da177e4SLinus Torvalds  * Returnes the cache attributes used in Define Extend (DE).
27761da177e4SLinus Torvalds  */
27771da177e4SLinus Torvalds static int
27781107ccfbSChristoph Hellwig dasd_eckd_get_attrib(struct dasd_device *device, void __user *argp)
27791da177e4SLinus Torvalds {
27801107ccfbSChristoph Hellwig 	struct dasd_eckd_private *private =
27811107ccfbSChristoph Hellwig 		(struct dasd_eckd_private *)device->private;
27821107ccfbSChristoph Hellwig 	struct attrib_data_t attrib = private->attrib;
27831da177e4SLinus Torvalds 	int rc;
27841da177e4SLinus Torvalds 
27851da177e4SLinus Torvalds         if (!capable(CAP_SYS_ADMIN))
27861da177e4SLinus Torvalds                 return -EACCES;
27871107ccfbSChristoph Hellwig 	if (!argp)
27881da177e4SLinus Torvalds                 return -EINVAL;
27891da177e4SLinus Torvalds 
27901107ccfbSChristoph Hellwig 	rc = 0;
27911107ccfbSChristoph Hellwig 	if (copy_to_user(argp, (long *) &attrib,
27921107ccfbSChristoph Hellwig 			 sizeof(struct attrib_data_t)))
27931107ccfbSChristoph Hellwig 		rc = -EFAULT;
27941da177e4SLinus Torvalds 
27951da177e4SLinus Torvalds 	return rc;
27961da177e4SLinus Torvalds }
27971da177e4SLinus Torvalds 
27981da177e4SLinus Torvalds /*
27991da177e4SLinus Torvalds  * Set attributes (cache operations)
28001da177e4SLinus Torvalds  * Stores the attributes for cache operation to be used in Define Extend (DE).
28011da177e4SLinus Torvalds  */
28021da177e4SLinus Torvalds static int
28031107ccfbSChristoph Hellwig dasd_eckd_set_attrib(struct dasd_device *device, void __user *argp)
28041da177e4SLinus Torvalds {
28051107ccfbSChristoph Hellwig 	struct dasd_eckd_private *private =
28061107ccfbSChristoph Hellwig 		(struct dasd_eckd_private *)device->private;
28071da177e4SLinus Torvalds 	struct attrib_data_t attrib;
28081da177e4SLinus Torvalds 
28091da177e4SLinus Torvalds 	if (!capable(CAP_SYS_ADMIN))
28101da177e4SLinus Torvalds 		return -EACCES;
28111107ccfbSChristoph Hellwig 	if (!argp)
28121da177e4SLinus Torvalds 		return -EINVAL;
28131da177e4SLinus Torvalds 
28141107ccfbSChristoph Hellwig 	if (copy_from_user(&attrib, argp, sizeof(struct attrib_data_t)))
28151da177e4SLinus Torvalds 		return -EFAULT;
28161da177e4SLinus Torvalds 	private->attrib = attrib;
28171da177e4SLinus Torvalds 
2818fc19f381SStefan Haberland 	dev_info(&device->cdev->dev,
2819fc19f381SStefan Haberland 		 "The DASD cache mode was set to %x (%i cylinder prestage)\n",
28201da177e4SLinus Torvalds 		 private->attrib.operation, private->attrib.nr_cyl);
28211da177e4SLinus Torvalds 	return 0;
28221da177e4SLinus Torvalds }
28231da177e4SLinus Torvalds 
2824ab1d848fSNigel Hislop /*
2825ab1d848fSNigel Hislop  * Issue syscall I/O to EMC Symmetrix array.
2826ab1d848fSNigel Hislop  * CCWs are PSF and RSSD
2827ab1d848fSNigel Hislop  */
2828ab1d848fSNigel Hislop static int dasd_symm_io(struct dasd_device *device, void __user *argp)
2829ab1d848fSNigel Hislop {
2830ab1d848fSNigel Hislop 	struct dasd_symmio_parms usrparm;
2831ab1d848fSNigel Hislop 	char *psf_data, *rssd_result;
2832ab1d848fSNigel Hislop 	struct dasd_ccw_req *cqr;
2833ab1d848fSNigel Hislop 	struct ccw1 *ccw;
2834ab1d848fSNigel Hislop 	int rc;
2835ab1d848fSNigel Hislop 
2836ab1d848fSNigel Hislop 	/* Copy parms from caller */
2837ab1d848fSNigel Hislop 	rc = -EFAULT;
2838ab1d848fSNigel Hislop 	if (copy_from_user(&usrparm, argp, sizeof(usrparm)))
2839ab1d848fSNigel Hislop 		goto out;
2840ab1d848fSNigel Hislop #ifndef CONFIG_64BIT
2841ab1d848fSNigel Hislop 	/* Make sure pointers are sane even on 31 bit. */
2842ab1d848fSNigel Hislop 	if ((usrparm.psf_data >> 32) != 0 || (usrparm.rssd_result >> 32) != 0) {
2843ab1d848fSNigel Hislop 		rc = -EINVAL;
2844ab1d848fSNigel Hislop 		goto out;
2845ab1d848fSNigel Hislop 	}
2846ab1d848fSNigel Hislop #endif
2847ab1d848fSNigel Hislop 	/* alloc I/O data area */
2848ab1d848fSNigel Hislop 	psf_data = kzalloc(usrparm.psf_data_len, GFP_KERNEL | GFP_DMA);
2849ab1d848fSNigel Hislop 	rssd_result = kzalloc(usrparm.rssd_result_len, GFP_KERNEL | GFP_DMA);
2850ab1d848fSNigel Hislop 	if (!psf_data || !rssd_result) {
2851ab1d848fSNigel Hislop 		rc = -ENOMEM;
2852ab1d848fSNigel Hislop 		goto out_free;
2853ab1d848fSNigel Hislop 	}
2854ab1d848fSNigel Hislop 
2855ab1d848fSNigel Hislop 	/* get syscall header from user space */
2856ab1d848fSNigel Hislop 	rc = -EFAULT;
2857ab1d848fSNigel Hislop 	if (copy_from_user(psf_data,
2858ab1d848fSNigel Hislop 			   (void __user *)(unsigned long) usrparm.psf_data,
2859ab1d848fSNigel Hislop 			   usrparm.psf_data_len))
2860ab1d848fSNigel Hislop 		goto out_free;
2861ab1d848fSNigel Hislop 
2862ab1d848fSNigel Hislop 	/* sanity check on syscall header */
2863ab1d848fSNigel Hislop 	if (psf_data[0] != 0x17 && psf_data[1] != 0xce) {
2864ab1d848fSNigel Hislop 		rc = -EINVAL;
2865ab1d848fSNigel Hislop 		goto out_free;
2866ab1d848fSNigel Hislop 	}
2867ab1d848fSNigel Hislop 
2868ab1d848fSNigel Hislop 	/* setup CCWs for PSF + RSSD */
286968b781feSStefan Haberland 	cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 2 , 0, device);
2870ab1d848fSNigel Hislop 	if (IS_ERR(cqr)) {
2871fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
2872ab1d848fSNigel Hislop 			"Could not allocate initialization request");
2873ab1d848fSNigel Hislop 		rc = PTR_ERR(cqr);
2874ab1d848fSNigel Hislop 		goto out_free;
2875ab1d848fSNigel Hislop 	}
2876ab1d848fSNigel Hislop 
2877ab1d848fSNigel Hislop 	cqr->startdev = device;
2878ab1d848fSNigel Hislop 	cqr->memdev = device;
2879ab1d848fSNigel Hislop 	cqr->retries = 3;
2880ab1d848fSNigel Hislop 	cqr->expires = 10 * HZ;
2881ab1d848fSNigel Hislop 	cqr->buildclk = get_clock();
2882ab1d848fSNigel Hislop 	cqr->status = DASD_CQR_FILLED;
2883ab1d848fSNigel Hislop 
2884ab1d848fSNigel Hislop 	/* Build the ccws */
2885ab1d848fSNigel Hislop 	ccw = cqr->cpaddr;
2886ab1d848fSNigel Hislop 
2887ab1d848fSNigel Hislop 	/* PSF ccw */
2888ab1d848fSNigel Hislop 	ccw->cmd_code = DASD_ECKD_CCW_PSF;
2889ab1d848fSNigel Hislop 	ccw->count = usrparm.psf_data_len;
2890ab1d848fSNigel Hislop 	ccw->flags |= CCW_FLAG_CC;
2891ab1d848fSNigel Hislop 	ccw->cda = (__u32)(addr_t) psf_data;
2892ab1d848fSNigel Hislop 
2893ab1d848fSNigel Hislop 	ccw++;
2894ab1d848fSNigel Hislop 
2895ab1d848fSNigel Hislop 	/* RSSD ccw  */
2896ab1d848fSNigel Hislop 	ccw->cmd_code = DASD_ECKD_CCW_RSSD;
2897ab1d848fSNigel Hislop 	ccw->count = usrparm.rssd_result_len;
2898ab1d848fSNigel Hislop 	ccw->flags = CCW_FLAG_SLI ;
2899ab1d848fSNigel Hislop 	ccw->cda = (__u32)(addr_t) rssd_result;
2900ab1d848fSNigel Hislop 
2901ab1d848fSNigel Hislop 	rc = dasd_sleep_on(cqr);
2902ab1d848fSNigel Hislop 	if (rc)
2903ab1d848fSNigel Hislop 		goto out_sfree;
2904ab1d848fSNigel Hislop 
2905ab1d848fSNigel Hislop 	rc = -EFAULT;
2906ab1d848fSNigel Hislop 	if (copy_to_user((void __user *)(unsigned long) usrparm.rssd_result,
2907ab1d848fSNigel Hislop 			   rssd_result, usrparm.rssd_result_len))
2908ab1d848fSNigel Hislop 		goto out_sfree;
2909ab1d848fSNigel Hislop 	rc = 0;
2910ab1d848fSNigel Hislop 
2911ab1d848fSNigel Hislop out_sfree:
2912ab1d848fSNigel Hislop 	dasd_sfree_request(cqr, cqr->memdev);
2913ab1d848fSNigel Hislop out_free:
2914ab1d848fSNigel Hislop 	kfree(rssd_result);
2915ab1d848fSNigel Hislop 	kfree(psf_data);
2916ab1d848fSNigel Hislop out:
2917ab1d848fSNigel Hislop 	DBF_DEV_EVENT(DBF_WARNING, device, "Symmetrix ioctl: rc=%d", rc);
2918ab1d848fSNigel Hislop 	return rc;
2919ab1d848fSNigel Hislop }
2920ab1d848fSNigel Hislop 
29211107ccfbSChristoph Hellwig static int
29228e09f215SStefan Weinhuber dasd_eckd_ioctl(struct dasd_block *block, unsigned int cmd, void __user *argp)
29231107ccfbSChristoph Hellwig {
29248e09f215SStefan Weinhuber 	struct dasd_device *device = block->base;
29258e09f215SStefan Weinhuber 
29261107ccfbSChristoph Hellwig 	switch (cmd) {
29271107ccfbSChristoph Hellwig 	case BIODASDGATTR:
29281107ccfbSChristoph Hellwig 		return dasd_eckd_get_attrib(device, argp);
29291107ccfbSChristoph Hellwig 	case BIODASDSATTR:
29301107ccfbSChristoph Hellwig 		return dasd_eckd_set_attrib(device, argp);
29311107ccfbSChristoph Hellwig 	case BIODASDPSRD:
29321107ccfbSChristoph Hellwig 		return dasd_eckd_performance(device, argp);
29331107ccfbSChristoph Hellwig 	case BIODASDRLSE:
29341107ccfbSChristoph Hellwig 		return dasd_eckd_release(device);
29351107ccfbSChristoph Hellwig 	case BIODASDRSRV:
29361107ccfbSChristoph Hellwig 		return dasd_eckd_reserve(device);
29371107ccfbSChristoph Hellwig 	case BIODASDSLCK:
29381107ccfbSChristoph Hellwig 		return dasd_eckd_steal_lock(device);
2939ab1d848fSNigel Hislop 	case BIODASDSYMMIO:
2940ab1d848fSNigel Hislop 		return dasd_symm_io(device, argp);
29411107ccfbSChristoph Hellwig 	default:
29421107ccfbSChristoph Hellwig 		return -ENOIOCTLCMD;
29431107ccfbSChristoph Hellwig 	}
29441107ccfbSChristoph Hellwig }
29451107ccfbSChristoph Hellwig 
29461da177e4SLinus Torvalds /*
2947445b5b49SHorst Hummel  * Dump the range of CCWs into 'page' buffer
2948445b5b49SHorst Hummel  * and return number of printed chars.
2949445b5b49SHorst Hummel  */
29504d284cacSHeiko Carstens static int
2951445b5b49SHorst Hummel dasd_eckd_dump_ccw_range(struct ccw1 *from, struct ccw1 *to, char *page)
2952445b5b49SHorst Hummel {
2953445b5b49SHorst Hummel 	int len, count;
2954445b5b49SHorst Hummel 	char *datap;
2955445b5b49SHorst Hummel 
2956445b5b49SHorst Hummel 	len = 0;
2957445b5b49SHorst Hummel 	while (from <= to) {
2958445b5b49SHorst Hummel 		len += sprintf(page + len, KERN_ERR PRINTK_HEADER
2959445b5b49SHorst Hummel 			       " CCW %p: %08X %08X DAT:",
2960445b5b49SHorst Hummel 			       from, ((int *) from)[0], ((int *) from)[1]);
2961445b5b49SHorst Hummel 
2962445b5b49SHorst Hummel 		/* get pointer to data (consider IDALs) */
2963445b5b49SHorst Hummel 		if (from->flags & CCW_FLAG_IDA)
2964445b5b49SHorst Hummel 			datap = (char *) *((addr_t *) (addr_t) from->cda);
2965445b5b49SHorst Hummel 		else
2966445b5b49SHorst Hummel 			datap = (char *) ((addr_t) from->cda);
2967445b5b49SHorst Hummel 
2968445b5b49SHorst Hummel 		/* dump data (max 32 bytes) */
2969445b5b49SHorst Hummel 		for (count = 0; count < from->count && count < 32; count++) {
2970445b5b49SHorst Hummel 			if (count % 8 == 0) len += sprintf(page + len, " ");
2971445b5b49SHorst Hummel 			if (count % 4 == 0) len += sprintf(page + len, " ");
2972445b5b49SHorst Hummel 			len += sprintf(page + len, "%02x", datap[count]);
2973445b5b49SHorst Hummel 		}
2974445b5b49SHorst Hummel 		len += sprintf(page + len, "\n");
2975445b5b49SHorst Hummel 		from++;
2976445b5b49SHorst Hummel 	}
2977445b5b49SHorst Hummel 	return len;
2978445b5b49SHorst Hummel }
2979445b5b49SHorst Hummel 
2980fc19f381SStefan Haberland static void
2981aeec92caSStefan Haberland dasd_eckd_dump_sense_dbf(struct dasd_device *device, struct irb *irb,
2982aeec92caSStefan Haberland 			 char *reason)
2983fc19f381SStefan Haberland {
2984fc19f381SStefan Haberland 	u64 *sense;
2985fc19f381SStefan Haberland 
2986aeec92caSStefan Haberland 	sense = (u64 *) dasd_get_sense(irb);
2987fc19f381SStefan Haberland 	if (sense) {
2988fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_EMERG, device,
2989aeec92caSStefan Haberland 			      "%s: %s %02x%02x%02x %016llx %016llx %016llx "
2990aeec92caSStefan Haberland 			      "%016llx", reason,
2991aeec92caSStefan Haberland 			      scsw_is_tm(&irb->scsw) ? "t" : "c",
2992aeec92caSStefan Haberland 			      scsw_cc(&irb->scsw), scsw_cstat(&irb->scsw),
2993aeec92caSStefan Haberland 			      scsw_dstat(&irb->scsw), sense[0], sense[1],
2994aeec92caSStefan Haberland 			      sense[2], sense[3]);
2995fc19f381SStefan Haberland 	} else {
2996fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_EMERG, device, "%s",
2997fc19f381SStefan Haberland 			      "SORRY - NO VALID SENSE AVAILABLE\n");
2998fc19f381SStefan Haberland 	}
2999fc19f381SStefan Haberland }
3000fc19f381SStefan Haberland 
3001445b5b49SHorst Hummel /*
30021da177e4SLinus Torvalds  * Print sense data and related channel program.
30031da177e4SLinus Torvalds  * Parts are printed because printk buffer is only 1024 bytes.
30041da177e4SLinus Torvalds  */
3005f3eb5384SStefan Weinhuber static void dasd_eckd_dump_sense_ccw(struct dasd_device *device,
30068e09f215SStefan Weinhuber 				 struct dasd_ccw_req *req, struct irb *irb)
30071da177e4SLinus Torvalds {
30081da177e4SLinus Torvalds 	char *page;
3009445b5b49SHorst Hummel 	struct ccw1 *first, *last, *fail, *from, *to;
3010445b5b49SHorst Hummel 	int len, sl, sct;
30111da177e4SLinus Torvalds 
30121da177e4SLinus Torvalds 	page = (char *) get_zeroed_page(GFP_ATOMIC);
30131da177e4SLinus Torvalds 	if (page == NULL) {
3014fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, "%s",
3015fc19f381SStefan Haberland 			      "No memory to dump sense data\n");
30161da177e4SLinus Torvalds 		return;
30171da177e4SLinus Torvalds 	}
3018445b5b49SHorst Hummel 	/* dump the sense data */
30191da177e4SLinus Torvalds 	len = sprintf(page,  KERN_ERR PRINTK_HEADER
30201da177e4SLinus Torvalds 		      " I/O status report for device %s:\n",
30212a0217d5SKay Sievers 		      dev_name(&device->cdev->dev));
30221da177e4SLinus Torvalds 	len += sprintf(page + len, KERN_ERR PRINTK_HEADER
30236cc7f168SStefan Weinhuber 		       " in req: %p CS: 0x%02X DS: 0x%02X CC: 0x%02X RC: %d\n",
30246cc7f168SStefan Weinhuber 		       req, scsw_cstat(&irb->scsw), scsw_dstat(&irb->scsw),
30256cc7f168SStefan Weinhuber 		       scsw_cc(&irb->scsw), req->intrc);
30261da177e4SLinus Torvalds 	len += sprintf(page + len, KERN_ERR PRINTK_HEADER
30271da177e4SLinus Torvalds 		       " device %s: Failing CCW: %p\n",
30282a0217d5SKay Sievers 		       dev_name(&device->cdev->dev),
302923d805b6SPeter Oberparleiter 		       (void *) (addr_t) irb->scsw.cmd.cpa);
30301da177e4SLinus Torvalds 	if (irb->esw.esw0.erw.cons) {
30311da177e4SLinus Torvalds 		for (sl = 0; sl < 4; sl++) {
30321da177e4SLinus Torvalds 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
30331da177e4SLinus Torvalds 				       " Sense(hex) %2d-%2d:",
30341da177e4SLinus Torvalds 				       (8 * sl), ((8 * sl) + 7));
30351da177e4SLinus Torvalds 
30361da177e4SLinus Torvalds 			for (sct = 0; sct < 8; sct++) {
30371da177e4SLinus Torvalds 				len += sprintf(page + len, " %02x",
30381da177e4SLinus Torvalds 					       irb->ecw[8 * sl + sct]);
30391da177e4SLinus Torvalds 			}
30401da177e4SLinus Torvalds 			len += sprintf(page + len, "\n");
30411da177e4SLinus Torvalds 		}
30421da177e4SLinus Torvalds 
30431da177e4SLinus Torvalds 		if (irb->ecw[27] & DASD_SENSE_BIT_0) {
30441da177e4SLinus Torvalds 			/* 24 Byte Sense Data */
3045445b5b49SHorst Hummel 			sprintf(page + len, KERN_ERR PRINTK_HEADER
30461da177e4SLinus Torvalds 				" 24 Byte: %x MSG %x, "
30471da177e4SLinus Torvalds 				"%s MSGb to SYSOP\n",
30481da177e4SLinus Torvalds 				irb->ecw[7] >> 4, irb->ecw[7] & 0x0f,
30491da177e4SLinus Torvalds 				irb->ecw[1] & 0x10 ? "" : "no");
30501da177e4SLinus Torvalds 		} else {
30511da177e4SLinus Torvalds 			/* 32 Byte Sense Data */
3052445b5b49SHorst Hummel 			sprintf(page + len, KERN_ERR PRINTK_HEADER
30531da177e4SLinus Torvalds 				" 32 Byte: Format: %x "
30541da177e4SLinus Torvalds 				"Exception class %x\n",
30551da177e4SLinus Torvalds 				irb->ecw[6] & 0x0f, irb->ecw[22] >> 4);
30561da177e4SLinus Torvalds 		}
30571da177e4SLinus Torvalds 	} else {
3058445b5b49SHorst Hummel 		sprintf(page + len, KERN_ERR PRINTK_HEADER
30591da177e4SLinus Torvalds 			" SORRY - NO VALID SENSE AVAILABLE\n");
30601da177e4SLinus Torvalds 	}
3061445b5b49SHorst Hummel 	printk("%s", page);
30621da177e4SLinus Torvalds 
30638e09f215SStefan Weinhuber 	if (req) {
30648e09f215SStefan Weinhuber 		/* req == NULL for unsolicited interrupts */
3065445b5b49SHorst Hummel 		/* dump the Channel Program (max 140 Bytes per line) */
3066445b5b49SHorst Hummel 		/* Count CCW and print first CCWs (maximum 1024 % 140 = 7) */
3067445b5b49SHorst Hummel 		first = req->cpaddr;
3068445b5b49SHorst Hummel 		for (last = first; last->flags & (CCW_FLAG_CC | CCW_FLAG_DC); last++);
3069445b5b49SHorst Hummel 		to = min(first + 6, last);
30701da177e4SLinus Torvalds 		len = sprintf(page,  KERN_ERR PRINTK_HEADER
30711da177e4SLinus Torvalds 			      " Related CP in req: %p\n", req);
3072445b5b49SHorst Hummel 		dasd_eckd_dump_ccw_range(first, to, page + len);
3073445b5b49SHorst Hummel 		printk("%s", page);
30741da177e4SLinus Torvalds 
3075445b5b49SHorst Hummel 		/* print failing CCW area (maximum 4) */
3076445b5b49SHorst Hummel 		/* scsw->cda is either valid or zero  */
30771da177e4SLinus Torvalds 		len = 0;
3078445b5b49SHorst Hummel 		from = ++to;
307923d805b6SPeter Oberparleiter 		fail = (struct ccw1 *)(addr_t)
308023d805b6SPeter Oberparleiter 				irb->scsw.cmd.cpa; /* failing CCW */
3081445b5b49SHorst Hummel 		if (from <  fail - 2) {
3082445b5b49SHorst Hummel 			from = fail - 2;     /* there is a gap - print header */
3083445b5b49SHorst Hummel 			len += sprintf(page, KERN_ERR PRINTK_HEADER "......\n");
30841da177e4SLinus Torvalds 		}
3085445b5b49SHorst Hummel 		to = min(fail + 1, last);
3086445b5b49SHorst Hummel 		len += dasd_eckd_dump_ccw_range(from, to, page + len);
30871da177e4SLinus Torvalds 
3088445b5b49SHorst Hummel 		/* print last CCWs (maximum 2) */
3089445b5b49SHorst Hummel 		from = max(from, ++to);
3090445b5b49SHorst Hummel 		if (from < last - 1) {
3091445b5b49SHorst Hummel 			from = last - 1;     /* there is a gap - print header */
30921da177e4SLinus Torvalds 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER "......\n");
30931da177e4SLinus Torvalds 		}
3094445b5b49SHorst Hummel 		len += dasd_eckd_dump_ccw_range(from, last, page + len);
30951da177e4SLinus Torvalds 		if (len > 0)
3096445b5b49SHorst Hummel 			printk("%s", page);
30978e09f215SStefan Weinhuber 	}
30981da177e4SLinus Torvalds 	free_page((unsigned long) page);
30991da177e4SLinus Torvalds }
31001da177e4SLinus Torvalds 
3101f3eb5384SStefan Weinhuber 
3102f3eb5384SStefan Weinhuber /*
3103f3eb5384SStefan Weinhuber  * Print sense data from a tcw.
3104f3eb5384SStefan Weinhuber  */
3105f3eb5384SStefan Weinhuber static void dasd_eckd_dump_sense_tcw(struct dasd_device *device,
3106f3eb5384SStefan Weinhuber 				 struct dasd_ccw_req *req, struct irb *irb)
3107f3eb5384SStefan Weinhuber {
3108f3eb5384SStefan Weinhuber 	char *page;
3109f3eb5384SStefan Weinhuber 	int len, sl, sct, residual;
3110f3eb5384SStefan Weinhuber 
3111f3eb5384SStefan Weinhuber 	struct tsb *tsb;
3112f3eb5384SStefan Weinhuber 	u8 *sense;
3113f3eb5384SStefan Weinhuber 
3114f3eb5384SStefan Weinhuber 
3115f3eb5384SStefan Weinhuber 	page = (char *) get_zeroed_page(GFP_ATOMIC);
3116f3eb5384SStefan Weinhuber 	if (page == NULL) {
3117fc19f381SStefan Haberland 		DBF_DEV_EVENT(DBF_WARNING, device, " %s",
3118f3eb5384SStefan Weinhuber 			    "No memory to dump sense data");
3119f3eb5384SStefan Weinhuber 		return;
3120f3eb5384SStefan Weinhuber 	}
3121f3eb5384SStefan Weinhuber 	/* dump the sense data */
3122f3eb5384SStefan Weinhuber 	len = sprintf(page,  KERN_ERR PRINTK_HEADER
3123f3eb5384SStefan Weinhuber 		      " I/O status report for device %s:\n",
3124f3eb5384SStefan Weinhuber 		      dev_name(&device->cdev->dev));
3125f3eb5384SStefan Weinhuber 	len += sprintf(page + len, KERN_ERR PRINTK_HEADER
31266cc7f168SStefan Weinhuber 		       " in req: %p CS: 0x%02X DS: 0x%02X CC: 0x%02X RC: %d "
3127f3eb5384SStefan Weinhuber 		       "fcxs: 0x%02X schxs: 0x%02X\n", req,
3128f3eb5384SStefan Weinhuber 		       scsw_cstat(&irb->scsw), scsw_dstat(&irb->scsw),
31296cc7f168SStefan Weinhuber 		       scsw_cc(&irb->scsw), req->intrc,
3130f3eb5384SStefan Weinhuber 		       irb->scsw.tm.fcxs, irb->scsw.tm.schxs);
3131f3eb5384SStefan Weinhuber 	len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3132f3eb5384SStefan Weinhuber 		       " device %s: Failing TCW: %p\n",
3133f3eb5384SStefan Weinhuber 		       dev_name(&device->cdev->dev),
3134f3eb5384SStefan Weinhuber 		       (void *) (addr_t) irb->scsw.tm.tcw);
3135f3eb5384SStefan Weinhuber 
3136f3eb5384SStefan Weinhuber 	tsb = NULL;
3137f3eb5384SStefan Weinhuber 	sense = NULL;
3138f3eb5384SStefan Weinhuber 	if (irb->scsw.tm.tcw)
3139f3eb5384SStefan Weinhuber 		tsb = tcw_get_tsb(
3140f3eb5384SStefan Weinhuber 			(struct tcw *)(unsigned long)irb->scsw.tm.tcw);
3141f3eb5384SStefan Weinhuber 
3142f3eb5384SStefan Weinhuber 	if (tsb && (irb->scsw.tm.fcxs == 0x01)) {
3143f3eb5384SStefan Weinhuber 		len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3144f3eb5384SStefan Weinhuber 			       " tsb->length %d\n", tsb->length);
3145f3eb5384SStefan Weinhuber 		len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3146f3eb5384SStefan Weinhuber 			       " tsb->flags %x\n", tsb->flags);
3147f3eb5384SStefan Weinhuber 		len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3148f3eb5384SStefan Weinhuber 			       " tsb->dcw_offset %d\n", tsb->dcw_offset);
3149f3eb5384SStefan Weinhuber 		len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3150f3eb5384SStefan Weinhuber 			       " tsb->count %d\n", tsb->count);
3151f3eb5384SStefan Weinhuber 		residual = tsb->count - 28;
3152f3eb5384SStefan Weinhuber 		len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3153f3eb5384SStefan Weinhuber 			       " residual %d\n", residual);
3154f3eb5384SStefan Weinhuber 
3155f3eb5384SStefan Weinhuber 		switch (tsb->flags & 0x07) {
3156f3eb5384SStefan Weinhuber 		case 1:	/* tsa_iostat */
3157f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3158f3eb5384SStefan Weinhuber 			       " tsb->tsa.iostat.dev_time %d\n",
3159f3eb5384SStefan Weinhuber 				       tsb->tsa.iostat.dev_time);
3160f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3161f3eb5384SStefan Weinhuber 			       " tsb->tsa.iostat.def_time %d\n",
3162f3eb5384SStefan Weinhuber 				       tsb->tsa.iostat.def_time);
3163f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3164f3eb5384SStefan Weinhuber 			       " tsb->tsa.iostat.queue_time %d\n",
3165f3eb5384SStefan Weinhuber 				       tsb->tsa.iostat.queue_time);
3166f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3167f3eb5384SStefan Weinhuber 			       " tsb->tsa.iostat.dev_busy_time %d\n",
3168f3eb5384SStefan Weinhuber 				       tsb->tsa.iostat.dev_busy_time);
3169f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3170f3eb5384SStefan Weinhuber 			       " tsb->tsa.iostat.dev_act_time %d\n",
3171f3eb5384SStefan Weinhuber 				       tsb->tsa.iostat.dev_act_time);
3172f3eb5384SStefan Weinhuber 			sense = tsb->tsa.iostat.sense;
3173f3eb5384SStefan Weinhuber 			break;
3174f3eb5384SStefan Weinhuber 		case 2: /* ts_ddpc */
3175f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3176f3eb5384SStefan Weinhuber 			       " tsb->tsa.ddpc.rc %d\n", tsb->tsa.ddpc.rc);
3177f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3178f3eb5384SStefan Weinhuber 			       " tsb->tsa.ddpc.rcq:  ");
3179f3eb5384SStefan Weinhuber 			for (sl = 0; sl < 16; sl++) {
3180f3eb5384SStefan Weinhuber 				for (sct = 0; sct < 8; sct++) {
3181f3eb5384SStefan Weinhuber 					len += sprintf(page + len, " %02x",
3182f3eb5384SStefan Weinhuber 						       tsb->tsa.ddpc.rcq[sl]);
3183f3eb5384SStefan Weinhuber 				}
3184f3eb5384SStefan Weinhuber 				len += sprintf(page + len, "\n");
3185f3eb5384SStefan Weinhuber 			}
3186f3eb5384SStefan Weinhuber 			sense = tsb->tsa.ddpc.sense;
3187f3eb5384SStefan Weinhuber 			break;
3188f3eb5384SStefan Weinhuber 		case 3: /* tsa_intrg */
3189f3eb5384SStefan Weinhuber 			len += sprintf(page + len, KERN_ERR PRINTK_HEADER
3190f3eb5384SStefan Weinhuber 				      " tsb->tsa.intrg.: not supportet yet \n");
3191f3eb5384SStefan Weinhuber 			break;
3192f3eb5384SStefan Weinhuber 		}
3193f3eb5384SStefan Weinhuber 
3194f3eb5384SStefan Weinhuber 		if (sense) {
3195f3eb5384SStefan Weinhuber 			for (sl = 0; sl < 4; sl++) {
3196f3eb5384SStefan Weinhuber 				len += sprintf(page + len,
3197f3eb5384SStefan Weinhuber 					       KERN_ERR PRINTK_HEADER
3198f3eb5384SStefan Weinhuber 					       " Sense(hex) %2d-%2d:",
3199f3eb5384SStefan Weinhuber 					       (8 * sl), ((8 * sl) + 7));
3200f3eb5384SStefan Weinhuber 				for (sct = 0; sct < 8; sct++) {
3201f3eb5384SStefan Weinhuber 					len += sprintf(page + len, " %02x",
3202f3eb5384SStefan Weinhuber 						       sense[8 * sl + sct]);
3203f3eb5384SStefan Weinhuber 				}
3204f3eb5384SStefan Weinhuber 				len += sprintf(page + len, "\n");
3205f3eb5384SStefan Weinhuber 			}
3206f3eb5384SStefan Weinhuber 
3207f3eb5384SStefan Weinhuber 			if (sense[27] & DASD_SENSE_BIT_0) {
3208f3eb5384SStefan Weinhuber 				/* 24 Byte Sense Data */
3209f3eb5384SStefan Weinhuber 				sprintf(page + len, KERN_ERR PRINTK_HEADER
3210f3eb5384SStefan Weinhuber 					" 24 Byte: %x MSG %x, "
3211f3eb5384SStefan Weinhuber 					"%s MSGb to SYSOP\n",
3212f3eb5384SStefan Weinhuber 					sense[7] >> 4, sense[7] & 0x0f,
3213f3eb5384SStefan Weinhuber 					sense[1] & 0x10 ? "" : "no");
3214f3eb5384SStefan Weinhuber 			} else {
3215f3eb5384SStefan Weinhuber 				/* 32 Byte Sense Data */
3216f3eb5384SStefan Weinhuber 				sprintf(page + len, KERN_ERR PRINTK_HEADER
3217f3eb5384SStefan Weinhuber 					" 32 Byte: Format: %x "
3218f3eb5384SStefan Weinhuber 					"Exception class %x\n",
3219f3eb5384SStefan Weinhuber 					sense[6] & 0x0f, sense[22] >> 4);
3220f3eb5384SStefan Weinhuber 			}
3221f3eb5384SStefan Weinhuber 		} else {
3222f3eb5384SStefan Weinhuber 			sprintf(page + len, KERN_ERR PRINTK_HEADER
3223f3eb5384SStefan Weinhuber 				" SORRY - NO VALID SENSE AVAILABLE\n");
3224f3eb5384SStefan Weinhuber 		}
3225f3eb5384SStefan Weinhuber 	} else {
3226f3eb5384SStefan Weinhuber 		sprintf(page + len, KERN_ERR PRINTK_HEADER
3227f3eb5384SStefan Weinhuber 			" SORRY - NO TSB DATA AVAILABLE\n");
3228f3eb5384SStefan Weinhuber 	}
3229f3eb5384SStefan Weinhuber 	printk("%s", page);
3230f3eb5384SStefan Weinhuber 	free_page((unsigned long) page);
3231f3eb5384SStefan Weinhuber }
3232f3eb5384SStefan Weinhuber 
3233f3eb5384SStefan Weinhuber static void dasd_eckd_dump_sense(struct dasd_device *device,
3234f3eb5384SStefan Weinhuber 				 struct dasd_ccw_req *req, struct irb *irb)
3235f3eb5384SStefan Weinhuber {
3236f3eb5384SStefan Weinhuber 	if (req && scsw_is_tm(&req->irb.scsw))
3237f3eb5384SStefan Weinhuber 		dasd_eckd_dump_sense_tcw(device, req, irb);
3238f3eb5384SStefan Weinhuber 	else
3239f3eb5384SStefan Weinhuber 		dasd_eckd_dump_sense_ccw(device, req, irb);
3240f3eb5384SStefan Weinhuber }
3241f3eb5384SStefan Weinhuber 
3242d41dd122SStefan Haberland int dasd_eckd_pm_freeze(struct dasd_device *device)
3243d41dd122SStefan Haberland {
3244d41dd122SStefan Haberland 	/*
3245d41dd122SStefan Haberland 	 * the device should be disconnected from our LCU structure
3246d41dd122SStefan Haberland 	 * on restore we will reconnect it and reread LCU specific
3247d41dd122SStefan Haberland 	 * information like PAV support that might have changed
3248d41dd122SStefan Haberland 	 */
3249d41dd122SStefan Haberland 	dasd_alias_remove_device(device);
3250d41dd122SStefan Haberland 	dasd_alias_disconnect_device_from_lcu(device);
3251d41dd122SStefan Haberland 
3252d41dd122SStefan Haberland 	return 0;
3253d41dd122SStefan Haberland }
3254d41dd122SStefan Haberland 
3255d41dd122SStefan Haberland int dasd_eckd_restore_device(struct dasd_device *device)
3256d41dd122SStefan Haberland {
3257d41dd122SStefan Haberland 	struct dasd_eckd_private *private;
32586fca97a9SStefan Haberland 	struct dasd_eckd_characteristics temp_rdc_data;
3259d41dd122SStefan Haberland 	int is_known, rc;
3260d41dd122SStefan Haberland 	struct dasd_uid temp_uid;
3261a7602f6cSStefan Haberland 	unsigned long flags;
3262d41dd122SStefan Haberland 
3263d41dd122SStefan Haberland 	private = (struct dasd_eckd_private *) device->private;
3264d41dd122SStefan Haberland 
3265d41dd122SStefan Haberland 	/* Read Configuration Data */
3266d41dd122SStefan Haberland 	rc = dasd_eckd_read_conf(device);
3267d41dd122SStefan Haberland 	if (rc)
3268d41dd122SStefan Haberland 		goto out_err;
3269d41dd122SStefan Haberland 
3270d41dd122SStefan Haberland 	/* Generate device unique id and register in devmap */
3271d41dd122SStefan Haberland 	rc = dasd_eckd_generate_uid(device, &private->uid);
3272d41dd122SStefan Haberland 	dasd_get_uid(device->cdev, &temp_uid);
3273d41dd122SStefan Haberland 	if (memcmp(&private->uid, &temp_uid, sizeof(struct dasd_uid)) != 0)
3274a7602f6cSStefan Haberland 		dev_err(&device->cdev->dev, "The UID of the DASD has "
3275a7602f6cSStefan Haberland 			"changed\n");
3276d41dd122SStefan Haberland 	if (rc)
3277d41dd122SStefan Haberland 		goto out_err;
3278d41dd122SStefan Haberland 	dasd_set_uid(device->cdev, &private->uid);
3279d41dd122SStefan Haberland 
3280d41dd122SStefan Haberland 	/* register lcu with alias handling, enable PAV if this is a new lcu */
3281d41dd122SStefan Haberland 	is_known = dasd_alias_make_device_known_to_lcu(device);
3282d41dd122SStefan Haberland 	if (is_known < 0)
3283d41dd122SStefan Haberland 		return is_known;
3284d41dd122SStefan Haberland 	if (!is_known) {
3285d41dd122SStefan Haberland 		/* new lcu found */
3286d41dd122SStefan Haberland 		rc = dasd_eckd_validate_server(device); /* will switch pav on */
3287d41dd122SStefan Haberland 		if (rc)
3288d41dd122SStefan Haberland 			goto out_err;
3289d41dd122SStefan Haberland 	}
3290d41dd122SStefan Haberland 
3291d41dd122SStefan Haberland 	/* Read Feature Codes */
329268d1e5f0SStefan Weinhuber 	dasd_eckd_read_features(device);
3293d41dd122SStefan Haberland 
3294d41dd122SStefan Haberland 	/* Read Device Characteristics */
329568b781feSStefan Haberland 	rc = dasd_generic_read_dev_chars(device, DASD_ECKD_MAGIC,
32966fca97a9SStefan Haberland 					 &temp_rdc_data, 64);
3297d41dd122SStefan Haberland 	if (rc) {
3298b8ed5dd5SStefan Haberland 		DBF_EVENT_DEVID(DBF_WARNING, device->cdev,
3299b8ed5dd5SStefan Haberland 				"Read device characteristic failed, rc=%d", rc);
3300d41dd122SStefan Haberland 		goto out_err;
3301d41dd122SStefan Haberland 	}
3302a7602f6cSStefan Haberland 	spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags);
33036fca97a9SStefan Haberland 	memcpy(&private->rdc_data, &temp_rdc_data, sizeof(temp_rdc_data));
3304a7602f6cSStefan Haberland 	spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags);
3305d41dd122SStefan Haberland 
3306d41dd122SStefan Haberland 	/* add device to alias management */
3307d41dd122SStefan Haberland 	dasd_alias_add_device(device);
3308d41dd122SStefan Haberland 
3309d41dd122SStefan Haberland 	return 0;
3310d41dd122SStefan Haberland 
3311d41dd122SStefan Haberland out_err:
3312e6125fbaSStefan Haberland 	return -1;
3313d41dd122SStefan Haberland }
3314d41dd122SStefan Haberland 
3315d41dd122SStefan Haberland static struct ccw_driver dasd_eckd_driver = {
3316d41dd122SStefan Haberland 	.name	     = "dasd-eckd",
3317d41dd122SStefan Haberland 	.owner	     = THIS_MODULE,
3318d41dd122SStefan Haberland 	.ids	     = dasd_eckd_ids,
3319d41dd122SStefan Haberland 	.probe	     = dasd_eckd_probe,
3320d41dd122SStefan Haberland 	.remove      = dasd_generic_remove,
3321d41dd122SStefan Haberland 	.set_offline = dasd_generic_set_offline,
3322d41dd122SStefan Haberland 	.set_online  = dasd_eckd_set_online,
3323d41dd122SStefan Haberland 	.notify      = dasd_generic_notify,
3324d41dd122SStefan Haberland 	.freeze      = dasd_generic_pm_freeze,
3325d41dd122SStefan Haberland 	.thaw	     = dasd_generic_restore_device,
3326d41dd122SStefan Haberland 	.restore     = dasd_generic_restore_device,
3327d41dd122SStefan Haberland };
3328f3eb5384SStefan Weinhuber 
33291da177e4SLinus Torvalds /*
33301da177e4SLinus Torvalds  * max_blocks is dependent on the amount of storage that is available
33311da177e4SLinus Torvalds  * in the static io buffer for each device. Currently each device has
33321da177e4SLinus Torvalds  * 8192 bytes (=2 pages). For 64 bit one dasd_mchunkt_t structure has
33331da177e4SLinus Torvalds  * 24 bytes, the struct dasd_ccw_req has 136 bytes and each block can use
33341da177e4SLinus Torvalds  * up to 16 bytes (8 for the ccw and 8 for the idal pointer). In
33351da177e4SLinus Torvalds  * addition we have one define extent ccw + 16 bytes of data and one
33361da177e4SLinus Torvalds  * locate record ccw + 16 bytes of data. That makes:
33371da177e4SLinus Torvalds  * (8192 - 24 - 136 - 8 - 16 - 8 - 16) / 16 = 499 blocks at maximum.
33381da177e4SLinus Torvalds  * We want to fit two into the available memory so that we can immediately
33391da177e4SLinus Torvalds  * start the next request if one finishes off. That makes 249.5 blocks
33401da177e4SLinus Torvalds  * for one request. Give a little safety and the result is 240.
33411da177e4SLinus Torvalds  */
33421da177e4SLinus Torvalds static struct dasd_discipline dasd_eckd_discipline = {
33431da177e4SLinus Torvalds 	.owner = THIS_MODULE,
33441da177e4SLinus Torvalds 	.name = "ECKD",
33451da177e4SLinus Torvalds 	.ebcname = "ECKD",
33461da177e4SLinus Torvalds 	.max_blocks = 240,
33471da177e4SLinus Torvalds 	.check_device = dasd_eckd_check_characteristics,
33488e09f215SStefan Weinhuber 	.uncheck_device = dasd_eckd_uncheck_device,
33491da177e4SLinus Torvalds 	.do_analysis = dasd_eckd_do_analysis,
33508e09f215SStefan Weinhuber 	.ready_to_online = dasd_eckd_ready_to_online,
33518e09f215SStefan Weinhuber 	.online_to_ready = dasd_eckd_online_to_ready,
33521da177e4SLinus Torvalds 	.fill_geometry = dasd_eckd_fill_geometry,
33531da177e4SLinus Torvalds 	.start_IO = dasd_start_IO,
33541da177e4SLinus Torvalds 	.term_IO = dasd_term_IO,
33558e09f215SStefan Weinhuber 	.handle_terminated_request = dasd_eckd_handle_terminated_request,
33561da177e4SLinus Torvalds 	.format_device = dasd_eckd_format_device,
33571da177e4SLinus Torvalds 	.erp_action = dasd_eckd_erp_action,
33581da177e4SLinus Torvalds 	.erp_postaction = dasd_eckd_erp_postaction,
33598e09f215SStefan Weinhuber 	.handle_unsolicited_interrupt = dasd_eckd_handle_unsolicited_interrupt,
33608e09f215SStefan Weinhuber 	.build_cp = dasd_eckd_build_alias_cp,
33618e09f215SStefan Weinhuber 	.free_cp = dasd_eckd_free_alias_cp,
33621da177e4SLinus Torvalds 	.dump_sense = dasd_eckd_dump_sense,
3363fc19f381SStefan Haberland 	.dump_sense_dbf = dasd_eckd_dump_sense_dbf,
33641da177e4SLinus Torvalds 	.fill_info = dasd_eckd_fill_info,
33651107ccfbSChristoph Hellwig 	.ioctl = dasd_eckd_ioctl,
3366d41dd122SStefan Haberland 	.freeze = dasd_eckd_pm_freeze,
3367d41dd122SStefan Haberland 	.restore = dasd_eckd_restore_device,
33681da177e4SLinus Torvalds };
33691da177e4SLinus Torvalds 
33701da177e4SLinus Torvalds static int __init
33711da177e4SLinus Torvalds dasd_eckd_init(void)
33721da177e4SLinus Torvalds {
3373736e6ea0SSebastian Ott 	int ret;
3374736e6ea0SSebastian Ott 
33751da177e4SLinus Torvalds 	ASCEBC(dasd_eckd_discipline.ebcname, 4);
3376736e6ea0SSebastian Ott 	ret = ccw_driver_register(&dasd_eckd_driver);
3377736e6ea0SSebastian Ott 	if (!ret)
3378736e6ea0SSebastian Ott 		wait_for_device_probe();
3379736e6ea0SSebastian Ott 
3380736e6ea0SSebastian Ott 	return ret;
33811da177e4SLinus Torvalds }
33821da177e4SLinus Torvalds 
33831da177e4SLinus Torvalds static void __exit
33841da177e4SLinus Torvalds dasd_eckd_cleanup(void)
33851da177e4SLinus Torvalds {
33861da177e4SLinus Torvalds 	ccw_driver_unregister(&dasd_eckd_driver);
33871da177e4SLinus Torvalds }
33881da177e4SLinus Torvalds 
33891da177e4SLinus Torvalds module_init(dasd_eckd_init);
33901da177e4SLinus Torvalds module_exit(dasd_eckd_cleanup);
3391