scsi_transport_spi.c 41.5 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/* 
 *  Parallel SCSI (SPI) transport specific attributes exported to sysfs.
 *
 *  Copyright (c) 2003 Silicon Graphics, Inc.  All rights reserved.
 *  Copyright (c) 2004, 2005 James Bottomley <James.Bottomley@SteelEye.com>
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */
#include <linux/ctype.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/workqueue.h>
25
#include <linux/blkdev.h>
26
#include <linux/mutex.h>
27
#include <linux/sysfs.h>
L
Linus Torvalds 已提交
28 29 30 31
#include <scsi/scsi.h>
#include "scsi_priv.h"
#include <scsi/scsi_device.h>
#include <scsi/scsi_host.h>
32
#include <scsi/scsi_cmnd.h>
L
Linus Torvalds 已提交
33 34 35 36
#include <scsi/scsi_eh.h>
#include <scsi/scsi_transport.h>
#include <scsi/scsi_transport_spi.h>

37
#define SPI_NUM_ATTRS 14	/* increase this if you add attributes */
L
Linus Torvalds 已提交
38 39 40 41 42 43
#define SPI_OTHER_ATTRS 1	/* Increase this if you add "always
				 * on" attributes */
#define SPI_HOST_ATTRS	1

#define SPI_MAX_ECHO_BUFFER_SIZE	4096

44 45 46 47 48
#define DV_LOOPS	3
#define DV_TIMEOUT	(10*HZ)
#define DV_RETRIES	3	/* should only need at most 
				 * two cc/ua clears */

L
Linus Torvalds 已提交
49
/* Private data accessors (keep these out of the header file) */
50
#define spi_dv_in_progress(x) (((struct spi_transport_attrs *)&(x)->starget_data)->dv_in_progress)
51
#define spi_dv_mutex(x) (((struct spi_transport_attrs *)&(x)->starget_data)->dv_mutex)
L
Linus Torvalds 已提交
52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100

struct spi_internal {
	struct scsi_transport_template t;
	struct spi_function_template *f;
};

#define to_spi_internal(tmpl)	container_of(tmpl, struct spi_internal, t)

static const int ppr_to_ps[] = {
	/* The PPR values 0-6 are reserved, fill them in when
	 * the committee defines them */
	-1,			/* 0x00 */
	-1,			/* 0x01 */
	-1,			/* 0x02 */
	-1,			/* 0x03 */
	-1,			/* 0x04 */
	-1,			/* 0x05 */
	-1,			/* 0x06 */
	 3125,			/* 0x07 */
	 6250,			/* 0x08 */
	12500,			/* 0x09 */
	25000,			/* 0x0a */
	30300,			/* 0x0b */
	50000,			/* 0x0c */
};
/* The PPR values at which you calculate the period in ns by multiplying
 * by 4 */
#define SPI_STATIC_PPR	0x0c

static int sprint_frac(char *dest, int value, int denom)
{
	int frac = value % denom;
	int result = sprintf(dest, "%d", value / denom);

	if (frac == 0)
		return result;
	dest[result++] = '.';

	do {
		denom /= 10;
		sprintf(dest + result, "%d", frac / denom);
		result++;
		frac %= denom;
	} while (frac);

	dest[result++] = '\0';
	return result;
}

101 102 103 104
static int spi_execute(struct scsi_device *sdev, const void *cmd,
		       enum dma_data_direction dir,
		       void *buffer, unsigned bufflen,
		       struct scsi_sense_hdr *sshdr)
105
{
106 107
	int i, result;
	unsigned char sense[SCSI_SENSE_BUFFERSIZE];
108 109

	for(i = 0; i < DV_RETRIES; i++) {
110 111
		result = scsi_execute(sdev, cmd, dir, buffer, bufflen,
				      sense, DV_TIMEOUT, /* retries */ 1,
112 113
				      REQ_FAILFAST_DEV |
				      REQ_FAILFAST_TRANSPORT |
114 115
				      REQ_FAILFAST_DRIVER,
				      NULL);
116
		if (driver_byte(result) & DRIVER_SENSE) {
117 118 119 120
			struct scsi_sense_hdr sshdr_tmp;
			if (!sshdr)
				sshdr = &sshdr_tmp;

121
			if (scsi_normalize_sense(sense, SCSI_SENSE_BUFFERSIZE,
122 123
						 sshdr)
			    && sshdr->sense_key == UNIT_ATTENTION)
124 125 126 127
				continue;
		}
		break;
	}
128
	return result;
129 130
}

L
Linus Torvalds 已提交
131 132 133 134 135 136 137 138 139 140 141 142 143 144
static struct {
	enum spi_signal_type	value;
	char			*name;
} signal_types[] = {
	{ SPI_SIGNAL_UNKNOWN, "unknown" },
	{ SPI_SIGNAL_SE, "SE" },
	{ SPI_SIGNAL_LVD, "LVD" },
	{ SPI_SIGNAL_HVD, "HVD" },
};

static inline const char *spi_signal_to_string(enum spi_signal_type type)
{
	int i;

145
	for (i = 0; i < ARRAY_SIZE(signal_types); i++) {
L
Linus Torvalds 已提交
146 147 148 149 150 151 152 153 154
		if (type == signal_types[i].value)
			return signal_types[i].name;
	}
	return NULL;
}
static inline enum spi_signal_type spi_signal_to_value(const char *name)
{
	int i, len;

155
	for (i = 0; i < ARRAY_SIZE(signal_types); i++) {
L
Linus Torvalds 已提交
156 157 158 159 160 161 162 163
		len =  strlen(signal_types[i].name);
		if (strncmp(name, signal_types[i].name, len) == 0 &&
		    (name[len] == '\n' || name[len] == '\0'))
			return signal_types[i].value;
	}
	return SPI_SIGNAL_UNKNOWN;
}

164
static int spi_host_setup(struct transport_container *tc, struct device *dev,
165
			  struct device *cdev)
L
Linus Torvalds 已提交
166 167 168 169 170 171 172 173
{
	struct Scsi_Host *shost = dev_to_shost(dev);

	spi_signalling(shost) = SPI_SIGNAL_UNKNOWN;

	return 0;
}

174 175
static int spi_host_configure(struct transport_container *tc,
			      struct device *dev,
176
			      struct device *cdev);
177

L
Linus Torvalds 已提交
178 179 180 181
static DECLARE_TRANSPORT_CLASS(spi_host_class,
			       "spi_host",
			       spi_host_setup,
			       NULL,
182
			       spi_host_configure);
L
Linus Torvalds 已提交
183 184 185 186 187 188 189 190 191 192 193 194 195 196

static int spi_host_match(struct attribute_container *cont,
			  struct device *dev)
{
	struct Scsi_Host *shost;

	if (!scsi_is_host_device(dev))
		return 0;

	shost = dev_to_shost(dev);
	if (!shost->transportt  || shost->transportt->host_attrs.ac.class
	    != &spi_host_class.class)
		return 0;

197
	return &shost->transportt->host_attrs.ac == cont;
L
Linus Torvalds 已提交
198 199
}

200 201
static int spi_target_configure(struct transport_container *tc,
				struct device *dev,
202
				struct device *cdev);
203

204 205
static int spi_device_configure(struct transport_container *tc,
				struct device *dev,
206
				struct device *cdev)
L
Linus Torvalds 已提交
207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223
{
	struct scsi_device *sdev = to_scsi_device(dev);
	struct scsi_target *starget = sdev->sdev_target;

	/* Populate the target capability fields with the values
	 * gleaned from the device inquiry */

	spi_support_sync(starget) = scsi_device_sync(sdev);
	spi_support_wide(starget) = scsi_device_wide(sdev);
	spi_support_dt(starget) = scsi_device_dt(sdev);
	spi_support_dt_only(starget) = scsi_device_dt_only(sdev);
	spi_support_ius(starget) = scsi_device_ius(sdev);
	spi_support_qas(starget) = scsi_device_qas(sdev);

	return 0;
}

224 225
static int spi_setup_transport_attrs(struct transport_container *tc,
				     struct device *dev,
226
				     struct device *cdev)
L
Linus Torvalds 已提交
227 228 229 230
{
	struct scsi_target *starget = to_scsi_target(dev);

	spi_period(starget) = -1;	/* illegal value */
231
	spi_min_period(starget) = 0;
L
Linus Torvalds 已提交
232
	spi_offset(starget) = 0;	/* async */
233
	spi_max_offset(starget) = 255;
L
Linus Torvalds 已提交
234
	spi_width(starget) = 0;	/* narrow */
235
	spi_max_width(starget) = 1;
L
Linus Torvalds 已提交
236 237 238 239 240 241 242
	spi_iu(starget) = 0;	/* no IU */
	spi_dt(starget) = 0;	/* ST */
	spi_qas(starget) = 0;
	spi_wr_flow(starget) = 0;
	spi_rd_strm(starget) = 0;
	spi_rti(starget) = 0;
	spi_pcomp_en(starget) = 0;
243
	spi_hold_mcs(starget) = 0;
L
Linus Torvalds 已提交
244
	spi_dv_pending(starget) = 0;
245
	spi_dv_in_progress(starget) = 0;
L
Linus Torvalds 已提交
246
	spi_initial_dv(starget) = 0;
247
	mutex_init(&spi_dv_mutex(starget));
L
Linus Torvalds 已提交
248 249 250 251

	return 0;
}

252 253 254
#define spi_transport_show_simple(field, format_string)			\
									\
static ssize_t								\
255 256
show_spi_transport_##field(struct device *dev, 			\
			   struct device_attribute *attr, char *buf)	\
257
{									\
258
	struct scsi_target *starget = transport_class_to_starget(dev);	\
259 260 261 262 263 264 265 266 267
	struct spi_transport_attrs *tp;					\
									\
	tp = (struct spi_transport_attrs *)&starget->starget_data;	\
	return snprintf(buf, 20, format_string, tp->field);		\
}

#define spi_transport_store_simple(field, format_string)		\
									\
static ssize_t								\
268 269 270
store_spi_transport_##field(struct device *dev, 			\
			    struct device_attribute *attr, 		\
			    const char *buf, size_t count)		\
271 272
{									\
	int val;							\
273
	struct scsi_target *starget = transport_class_to_starget(dev);	\
274 275 276 277 278 279 280 281
	struct spi_transport_attrs *tp;					\
									\
	tp = (struct spi_transport_attrs *)&starget->starget_data;	\
	val = simple_strtoul(buf, NULL, 0);				\
	tp->field = val;						\
	return count;							\
}

L
Linus Torvalds 已提交
282 283 284
#define spi_transport_show_function(field, format_string)		\
									\
static ssize_t								\
285 286
show_spi_transport_##field(struct device *dev, 			\
			   struct device_attribute *attr, char *buf)	\
L
Linus Torvalds 已提交
287
{									\
288
	struct scsi_target *starget = transport_class_to_starget(dev);	\
L
Linus Torvalds 已提交
289 290 291 292 293 294 295 296 297 298 299
	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);	\
	struct spi_transport_attrs *tp;					\
	struct spi_internal *i = to_spi_internal(shost->transportt);	\
	tp = (struct spi_transport_attrs *)&starget->starget_data;	\
	if (i->f->get_##field)						\
		i->f->get_##field(starget);				\
	return snprintf(buf, 20, format_string, tp->field);		\
}

#define spi_transport_store_function(field, format_string)		\
static ssize_t								\
300 301 302
store_spi_transport_##field(struct device *dev, 			\
			    struct device_attribute *attr,		\
			    const char *buf, size_t count)		\
L
Linus Torvalds 已提交
303 304
{									\
	int val;							\
305
	struct scsi_target *starget = transport_class_to_starget(dev);	\
L
Linus Torvalds 已提交
306 307 308
	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);	\
	struct spi_internal *i = to_spi_internal(shost->transportt);	\
									\
309 310
	if (!i->f->set_##field)						\
		return -EINVAL;						\
L
Linus Torvalds 已提交
311
	val = simple_strtoul(buf, NULL, 0);				\
312
	i->f->set_##field(starget, val);				\
313 314 315 316 317
	return count;							\
}

#define spi_transport_store_max(field, format_string)			\
static ssize_t								\
318 319 320
store_spi_transport_##field(struct device *dev, 			\
			    struct device_attribute *attr,		\
			    const char *buf, size_t count)		\
321 322
{									\
	int val;							\
323
	struct scsi_target *starget = transport_class_to_starget(dev);	\
324 325 326 327 328
	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);	\
	struct spi_internal *i = to_spi_internal(shost->transportt);	\
	struct spi_transport_attrs *tp					\
		= (struct spi_transport_attrs *)&starget->starget_data;	\
									\
329 330
	if (i->f->set_##field)						\
		return -EINVAL;						\
331 332 333
	val = simple_strtoul(buf, NULL, 0);				\
	if (val > tp->max_##field)					\
		val = tp->max_##field;					\
L
Linus Torvalds 已提交
334 335 336 337 338 339 340
	i->f->set_##field(starget, val);				\
	return count;							\
}

#define spi_transport_rd_attr(field, format_string)			\
	spi_transport_show_function(field, format_string)		\
	spi_transport_store_function(field, format_string)		\
341 342 343
static DEVICE_ATTR(field, S_IRUGO,				\
		   show_spi_transport_##field,			\
		   store_spi_transport_##field);
L
Linus Torvalds 已提交
344

345 346 347
#define spi_transport_simple_attr(field, format_string)			\
	spi_transport_show_simple(field, format_string)			\
	spi_transport_store_simple(field, format_string)		\
348 349 350
static DEVICE_ATTR(field, S_IRUGO,				\
		   show_spi_transport_##field,			\
		   store_spi_transport_##field);
351 352 353 354 355

#define spi_transport_max_attr(field, format_string)			\
	spi_transport_show_function(field, format_string)		\
	spi_transport_store_max(field, format_string)			\
	spi_transport_simple_attr(max_##field, format_string)		\
356 357 358
static DEVICE_ATTR(field, S_IRUGO,				\
		   show_spi_transport_##field,			\
		   store_spi_transport_##field);
359

L
Linus Torvalds 已提交
360
/* The Parallel SCSI Tranport Attributes: */
361 362
spi_transport_max_attr(offset, "%d\n");
spi_transport_max_attr(width, "%d\n");
L
Linus Torvalds 已提交
363 364 365 366 367 368 369
spi_transport_rd_attr(iu, "%d\n");
spi_transport_rd_attr(dt, "%d\n");
spi_transport_rd_attr(qas, "%d\n");
spi_transport_rd_attr(wr_flow, "%d\n");
spi_transport_rd_attr(rd_strm, "%d\n");
spi_transport_rd_attr(rti, "%d\n");
spi_transport_rd_attr(pcomp_en, "%d\n");
370
spi_transport_rd_attr(hold_mcs, "%d\n");
L
Linus Torvalds 已提交
371

372 373
/* we only care about the first child device that's a real SCSI device
 * so we return 1 to terminate the iteration when we find it */
374 375
static int child_iter(struct device *dev, void *data)
{
376 377
	if (!scsi_is_sdev_device(dev))
		return 0;
378

379
	spi_dv_device(to_scsi_device(dev));
380 381 382
	return 1;
}

L
Linus Torvalds 已提交
383
static ssize_t
384 385
store_spi_revalidate(struct device *dev, struct device_attribute *attr,
		     const char *buf, size_t count)
L
Linus Torvalds 已提交
386
{
387
	struct scsi_target *starget = transport_class_to_starget(dev);
L
Linus Torvalds 已提交
388

389
	device_for_each_child(&starget->dev, NULL, child_iter);
L
Linus Torvalds 已提交
390 391
	return count;
}
392
static DEVICE_ATTR(revalidate, S_IWUSR, NULL, store_spi_revalidate);
L
Linus Torvalds 已提交
393 394 395

/* Translate the period into ns according to the current spec
 * for SDTR/PPR messages */
396
static int period_to_str(char *buf, int period)
L
Linus Torvalds 已提交
397 398 399
{
	int len, picosec;

400
	if (period < 0 || period > 0xff) {
L
Linus Torvalds 已提交
401
		picosec = -1;
402 403
	} else if (period <= SPI_STATIC_PPR) {
		picosec = ppr_to_ps[period];
L
Linus Torvalds 已提交
404
	} else {
405
		picosec = period * 4000;
L
Linus Torvalds 已提交
406 407 408 409 410 411 412 413
	}

	if (picosec == -1) {
		len = sprintf(buf, "reserved");
	} else {
		len = sprint_frac(buf, picosec, 1000);
	}

414 415 416 417
	return len;
}

static ssize_t
418
show_spi_transport_period_helper(char *buf, int period)
419 420
{
	int len = period_to_str(buf, period);
L
Linus Torvalds 已提交
421 422 423 424 425 426
	buf[len++] = '\n';
	buf[len] = '\0';
	return len;
}

static ssize_t
427
store_spi_transport_period_helper(struct device *dev, const char *buf,
428
				  size_t count, int *periodp)
L
Linus Torvalds 已提交
429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457
{
	int j, picosec, period = -1;
	char *endp;

	picosec = simple_strtoul(buf, &endp, 10) * 1000;
	if (*endp == '.') {
		int mult = 100;
		do {
			endp++;
			if (!isdigit(*endp))
				break;
			picosec += (*endp - '0') * mult;
			mult /= 10;
		} while (mult > 0);
	}

	for (j = 0; j <= SPI_STATIC_PPR; j++) {
		if (ppr_to_ps[j] < picosec)
			continue;
		period = j;
		break;
	}

	if (period == -1)
		period = picosec / 4000;

	if (period > 0xff)
		period = 0xff;

458
	*periodp = period;
L
Linus Torvalds 已提交
459 460 461 462

	return count;
}

463
static ssize_t
464 465
show_spi_transport_period(struct device *dev,
			  struct device_attribute *attr, char *buf)
466
{
467
	struct scsi_target *starget = transport_class_to_starget(dev);
468 469 470 471 472 473 474 475
	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
	struct spi_internal *i = to_spi_internal(shost->transportt);
	struct spi_transport_attrs *tp =
		(struct spi_transport_attrs *)&starget->starget_data;

	if (i->f->get_period)
		i->f->get_period(starget);

476
	return show_spi_transport_period_helper(buf, tp->period);
477 478 479
}

static ssize_t
480 481
store_spi_transport_period(struct device *cdev, struct device_attribute *attr,
			   const char *buf, size_t count)
482 483 484 485 486 487 488 489
{
	struct scsi_target *starget = transport_class_to_starget(cdev);
	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
	struct spi_internal *i = to_spi_internal(shost->transportt);
	struct spi_transport_attrs *tp =
		(struct spi_transport_attrs *)&starget->starget_data;
	int period, retval;

490 491 492
	if (!i->f->set_period)
		return -EINVAL;

493 494 495 496 497 498 499 500 501 502
	retval = store_spi_transport_period_helper(cdev, buf, count, &period);

	if (period < tp->min_period)
		period = tp->min_period;

	i->f->set_period(starget, period);

	return retval;
}

503 504 505
static DEVICE_ATTR(period, S_IRUGO,
		   show_spi_transport_period,
		   store_spi_transport_period);
L
Linus Torvalds 已提交
506

507
static ssize_t
508 509
show_spi_transport_min_period(struct device *cdev,
			      struct device_attribute *attr, char *buf)
510 511
{
	struct scsi_target *starget = transport_class_to_starget(cdev);
512 513
	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
	struct spi_internal *i = to_spi_internal(shost->transportt);
514 515 516
	struct spi_transport_attrs *tp =
		(struct spi_transport_attrs *)&starget->starget_data;

517 518 519
	if (!i->f->set_period)
		return -EINVAL;

520
	return show_spi_transport_period_helper(buf, tp->min_period);
521 522 523
}

static ssize_t
524 525 526
store_spi_transport_min_period(struct device *cdev,
			       struct device_attribute *attr,
			       const char *buf, size_t count)
527 528 529 530 531 532 533 534 535 536
{
	struct scsi_target *starget = transport_class_to_starget(cdev);
	struct spi_transport_attrs *tp =
		(struct spi_transport_attrs *)&starget->starget_data;

	return store_spi_transport_period_helper(cdev, buf, count,
						 &tp->min_period);
}


537 538 539
static DEVICE_ATTR(min_period, S_IRUGO,
		   show_spi_transport_min_period,
		   store_spi_transport_min_period);
540 541


542 543 544
static ssize_t show_spi_host_signalling(struct device *cdev,
					struct device_attribute *attr,
					char *buf)
L
Linus Torvalds 已提交
545 546 547 548 549 550 551 552 553
{
	struct Scsi_Host *shost = transport_class_to_shost(cdev);
	struct spi_internal *i = to_spi_internal(shost->transportt);

	if (i->f->get_signalling)
		i->f->get_signalling(shost);

	return sprintf(buf, "%s\n", spi_signal_to_string(spi_signalling(shost)));
}
554 555
static ssize_t store_spi_host_signalling(struct device *dev,
					 struct device_attribute *attr,
L
Linus Torvalds 已提交
556 557
					 const char *buf, size_t count)
{
558
	struct Scsi_Host *shost = transport_class_to_shost(dev);
L
Linus Torvalds 已提交
559 560 561
	struct spi_internal *i = to_spi_internal(shost->transportt);
	enum spi_signal_type type = spi_signal_to_value(buf);

562 563 564
	if (!i->f->set_signalling)
		return -EINVAL;

L
Linus Torvalds 已提交
565 566 567 568 569
	if (type != SPI_SIGNAL_UNKNOWN)
		i->f->set_signalling(shost, type);

	return count;
}
570 571 572
static DEVICE_ATTR(signalling, S_IRUGO,
		   show_spi_host_signalling,
		   store_spi_host_signalling);
L
Linus Torvalds 已提交
573 574 575 576 577 578 579 580 581 582 583 584 585 586 587

#define DV_SET(x, y)			\
	if(i->f->set_##x)		\
		i->f->set_##x(sdev->sdev_target, y)

enum spi_compare_returns {
	SPI_COMPARE_SUCCESS,
	SPI_COMPARE_FAILURE,
	SPI_COMPARE_SKIP_TEST,
};


/* This is for read/write Domain Validation:  If the device supports
 * an echo buffer, we do read/write tests to it */
static enum spi_compare_returns
588
spi_dv_device_echo_buffer(struct scsi_device *sdev, u8 *buffer,
L
Linus Torvalds 已提交
589 590 591
			  u8 *ptr, const int retries)
{
	int len = ptr - buffer;
592
	int j, k, r, result;
L
Linus Torvalds 已提交
593
	unsigned int pattern = 0x0000ffff;
594
	struct scsi_sense_hdr sshdr;
L
Linus Torvalds 已提交
595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638

	const char spi_write_buffer[] = {
		WRITE_BUFFER, 0x0a, 0, 0, 0, 0, 0, len >> 8, len & 0xff, 0
	};
	const char spi_read_buffer[] = {
		READ_BUFFER, 0x0a, 0, 0, 0, 0, 0, len >> 8, len & 0xff, 0
	};

	/* set up the pattern buffer.  Doesn't matter if we spill
	 * slightly beyond since that's where the read buffer is */
	for (j = 0; j < len; ) {

		/* fill the buffer with counting (test a) */
		for ( ; j < min(len, 32); j++)
			buffer[j] = j;
		k = j;
		/* fill the buffer with alternating words of 0x0 and
		 * 0xffff (test b) */
		for ( ; j < min(len, k + 32); j += 2) {
			u16 *word = (u16 *)&buffer[j];
			
			*word = (j & 0x02) ? 0x0000 : 0xffff;
		}
		k = j;
		/* fill with crosstalk (alternating 0x5555 0xaaa)
                 * (test c) */
		for ( ; j < min(len, k + 32); j += 2) {
			u16 *word = (u16 *)&buffer[j];

			*word = (j & 0x02) ? 0x5555 : 0xaaaa;
		}
		k = j;
		/* fill with shifting bits (test d) */
		for ( ; j < min(len, k + 32); j += 4) {
			u32 *word = (unsigned int *)&buffer[j];
			u32 roll = (pattern & 0x80000000) ? 1 : 0;
			
			*word = pattern;
			pattern = (pattern << 1) | roll;
		}
		/* don't bother with random data (test e) */
	}

	for (r = 0; r < retries; r++) {
639 640 641
		result = spi_execute(sdev, spi_write_buffer, DMA_TO_DEVICE,
				     buffer, len, &sshdr);
		if(result || !scsi_device_online(sdev)) {
L
Linus Torvalds 已提交
642 643

			scsi_device_set_state(sdev, SDEV_QUIESCE);
644
			if (scsi_sense_valid(&sshdr)
L
Linus Torvalds 已提交
645 646 647 648 649 650 651 652 653 654 655
			    && sshdr.sense_key == ILLEGAL_REQUEST
			    /* INVALID FIELD IN CDB */
			    && sshdr.asc == 0x24 && sshdr.ascq == 0x00)
				/* This would mean that the drive lied
				 * to us about supporting an echo
				 * buffer (unfortunately some Western
				 * Digital drives do precisely this)
				 */
				return SPI_COMPARE_SKIP_TEST;


656
			sdev_printk(KERN_ERR, sdev, "Write Buffer failure %x\n", result);
L
Linus Torvalds 已提交
657 658 659 660
			return SPI_COMPARE_FAILURE;
		}

		memset(ptr, 0, len);
661 662
		spi_execute(sdev, spi_read_buffer, DMA_FROM_DEVICE,
			    ptr, len, NULL);
L
Linus Torvalds 已提交
663 664 665 666 667 668 669 670 671 672 673
		scsi_device_set_state(sdev, SDEV_QUIESCE);

		if (memcmp(buffer, ptr, len) != 0)
			return SPI_COMPARE_FAILURE;
	}
	return SPI_COMPARE_SUCCESS;
}

/* This is for the simplest form of Domain Validation: a read test
 * on the inquiry data from the device */
static enum spi_compare_returns
674
spi_dv_device_compare_inquiry(struct scsi_device *sdev, u8 *buffer,
L
Linus Torvalds 已提交
675 676
			      u8 *ptr, const int retries)
{
677 678
	int r, result;
	const int len = sdev->inquiry_len;
L
Linus Torvalds 已提交
679 680 681 682 683 684 685
	const char spi_inquiry[] = {
		INQUIRY, 0, 0, 0, len, 0
	};

	for (r = 0; r < retries; r++) {
		memset(ptr, 0, len);

686 687
		result = spi_execute(sdev, spi_inquiry, DMA_FROM_DEVICE,
				     ptr, len, NULL);
L
Linus Torvalds 已提交
688
		
689
		if(result || !scsi_device_online(sdev)) {
L
Linus Torvalds 已提交
690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709
			scsi_device_set_state(sdev, SDEV_QUIESCE);
			return SPI_COMPARE_FAILURE;
		}

		/* If we don't have the inquiry data already, the
		 * first read gets it */
		if (ptr == buffer) {
			ptr += len;
			--r;
			continue;
		}

		if (memcmp(buffer, ptr, len) != 0)
			/* failure */
			return SPI_COMPARE_FAILURE;
	}
	return SPI_COMPARE_SUCCESS;
}

static enum spi_compare_returns
710
spi_dv_retrain(struct scsi_device *sdev, u8 *buffer, u8 *ptr,
L
Linus Torvalds 已提交
711
	       enum spi_compare_returns 
712
	       (*compare_fn)(struct scsi_device *, u8 *, u8 *, int))
L
Linus Torvalds 已提交
713
{
714
	struct spi_internal *i = to_spi_internal(sdev->host->transportt);
715
	struct scsi_target *starget = sdev->sdev_target;
L
Linus Torvalds 已提交
716 717 718 719 720 721
	int period = 0, prevperiod = 0; 
	enum spi_compare_returns retval;


	for (;;) {
		int newperiod;
722
		retval = compare_fn(sdev, buffer, ptr, DV_LOOPS);
L
Linus Torvalds 已提交
723 724 725 726 727 728

		if (retval == SPI_COMPARE_SUCCESS
		    || retval == SPI_COMPARE_SKIP_TEST)
			break;

		/* OK, retrain, fallback */
729 730 731 732
		if (i->f->get_iu)
			i->f->get_iu(starget);
		if (i->f->get_qas)
			i->f->get_qas(starget);
L
Linus Torvalds 已提交
733 734
		if (i->f->get_period)
			i->f->get_period(sdev->sdev_target);
735 736 737 738 739

		/* Here's the fallback sequence; first try turning off
		 * IU, then QAS (if we can control them), then finally
		 * fall down the periods */
		if (i->f->set_iu && spi_iu(starget)) {
740
			starget_printk(KERN_ERR, starget, "Domain Validation Disabing Information Units\n");
741 742
			DV_SET(iu, 0);
		} else if (i->f->set_qas && spi_qas(starget)) {
743
			starget_printk(KERN_ERR, starget, "Domain Validation Disabing Quick Arbitration and Selection\n");
744 745 746 747 748 749 750 751 752 753 754
			DV_SET(qas, 0);
		} else {
			newperiod = spi_period(starget);
			period = newperiod > period ? newperiod : period;
			if (period < 0x0d)
				period++;
			else
				period += period >> 1;

			if (unlikely(period > 0xff || period == prevperiod)) {
				/* Total failure; set to async and return */
755
				starget_printk(KERN_ERR, starget, "Domain Validation Failure, dropping back to Asynchronous\n");
756 757 758
				DV_SET(offset, 0);
				return SPI_COMPARE_FAILURE;
			}
759
			starget_printk(KERN_ERR, starget, "Domain Validation detected failure, dropping back\n");
760 761
			DV_SET(period, period);
			prevperiod = period;
L
Linus Torvalds 已提交
762 763 764 765 766 767
		}
	}
	return retval;
}

static int
768
spi_dv_device_get_echo_buffer(struct scsi_device *sdev, u8 *buffer)
L
Linus Torvalds 已提交
769
{
770
	int l, result;
L
Linus Torvalds 已提交
771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791

	/* first off do a test unit ready.  This can error out 
	 * because of reservations or some other reason.  If it
	 * fails, the device won't let us write to the echo buffer
	 * so just return failure */
	
	const char spi_test_unit_ready[] = {
		TEST_UNIT_READY, 0, 0, 0, 0, 0
	};

	const char spi_read_buffer_descriptor[] = {
		READ_BUFFER, 0x0b, 0, 0, 0, 0, 0, 0, 4, 0
	};

	
	/* We send a set of three TURs to clear any outstanding 
	 * unit attention conditions if they exist (Otherwise the
	 * buffer tests won't be happy).  If the TUR still fails
	 * (reservation conflict, device not ready, etc) just
	 * skip the write tests */
	for (l = 0; ; l++) {
792 793
		result = spi_execute(sdev, spi_test_unit_ready, DMA_NONE, 
				     NULL, 0, NULL);
L
Linus Torvalds 已提交
794

795
		if(result) {
L
Linus Torvalds 已提交
796 797 798 799 800 801 802 803
			if(l >= 3)
				return 0;
		} else {
			/* TUR succeeded */
			break;
		}
	}

804 805
	result = spi_execute(sdev, spi_read_buffer_descriptor, 
			     DMA_FROM_DEVICE, buffer, 4, NULL);
L
Linus Torvalds 已提交
806

807
	if (result)
L
Linus Torvalds 已提交
808 809 810 811 812 813 814
		/* Device has no echo buffer */
		return 0;

	return buffer[3] + ((buffer[2] & 0x1f) << 8);
}

static void
815
spi_dv_device_internal(struct scsi_device *sdev, u8 *buffer)
L
Linus Torvalds 已提交
816
{
817
	struct spi_internal *i = to_spi_internal(sdev->host->transportt);
818
	struct scsi_target *starget = sdev->sdev_target;
819
	struct Scsi_Host *shost = sdev->host;
L
Linus Torvalds 已提交
820
	int len = sdev->inquiry_len;
821 822
	int min_period = spi_min_period(starget);
	int max_width = spi_max_width(starget);
L
Linus Torvalds 已提交
823 824 825
	/* first set us up for narrow async */
	DV_SET(offset, 0);
	DV_SET(width, 0);
826

827
	if (spi_dv_device_compare_inquiry(sdev, buffer, buffer, DV_LOOPS)
L
Linus Torvalds 已提交
828
	    != SPI_COMPARE_SUCCESS) {
829
		starget_printk(KERN_ERR, starget, "Domain Validation Initial Inquiry Failed\n");
L
Linus Torvalds 已提交
830 831 832 833
		/* FIXME: should probably offline the device here? */
		return;
	}

834 835 836 837 838
	if (!scsi_device_wide(sdev)) {
		spi_max_width(starget) = 0;
		max_width = 0;
	}

L
Linus Torvalds 已提交
839
	/* test width */
840
	if (i->f->set_width && max_width) {
841
		i->f->set_width(starget, 1);
842

843
		if (spi_dv_device_compare_inquiry(sdev, buffer,
L
Linus Torvalds 已提交
844 845 846
						   buffer + len,
						   DV_LOOPS)
		    != SPI_COMPARE_SUCCESS) {
847
			starget_printk(KERN_ERR, starget, "Wide Transfers Fail\n");
848
			i->f->set_width(starget, 0);
849 850 851 852 853
			/* Make sure we don't force wide back on by asking
			 * for a transfer period that requires it */
			max_width = 0;
			if (min_period < 10)
				min_period = 10;
L
Linus Torvalds 已提交
854 855 856 857 858 859 860
		}
	}

	if (!i->f->set_period)
		return;

	/* device can't handle synchronous */
861
	if (!scsi_device_sync(sdev) && !scsi_device_dt(sdev))
L
Linus Torvalds 已提交
862 863
		return;

864 865 866 867
	/* len == -1 is the signal that we need to ascertain the
	 * presence of an echo buffer before trying to use it.  len ==
	 * 0 means we don't have an echo buffer */
	len = -1;
L
Linus Torvalds 已提交
868 869 870 871

 retry:

	/* now set up to the maximum */
872
	DV_SET(offset, spi_max_offset(starget));
873 874
	DV_SET(period, min_period);

875 876
	/* try QAS requests; this should be harmless to set if the
	 * target supports it */
877
	if (scsi_device_qas(sdev)) {
878
		DV_SET(qas, 1);
879 880 881 882
	} else {
		DV_SET(qas, 0);
	}

883
	if (scsi_device_ius(sdev) && min_period < 9) {
884
		/* This u320 (or u640). Set IU transfers */
885
		DV_SET(iu, 1);
886
		/* Then set the optional parameters */
887 888 889
		DV_SET(rd_strm, 1);
		DV_SET(wr_flow, 1);
		DV_SET(rti, 1);
890
		if (min_period == 8)
891
			DV_SET(pcomp_en, 1);
892 893
	} else {
		DV_SET(iu, 0);
894
	}
895

896 897 898 899 900 901
	/* now that we've done all this, actually check the bus
	 * signal type (if known).  Some devices are stupid on
	 * a SE bus and still claim they can try LVD only settings */
	if (i->f->get_signalling)
		i->f->get_signalling(shost);
	if (spi_signalling(shost) == SPI_SIGNAL_SE ||
902 903
	    spi_signalling(shost) == SPI_SIGNAL_HVD ||
	    !scsi_device_dt(sdev)) {
904
		DV_SET(dt, 0);
905 906 907
	} else {
		DV_SET(dt, 1);
	}
908 909 910 911
	/* set width last because it will pull all the other
	 * parameters down to required values */
	DV_SET(width, max_width);

912 913 914 915 916 917 918 919 920 921 922 923 924 925
	/* Do the read only INQUIRY tests */
	spi_dv_retrain(sdev, buffer, buffer + sdev->inquiry_len,
		       spi_dv_device_compare_inquiry);
	/* See if we actually managed to negotiate and sustain DT */
	if (i->f->get_dt)
		i->f->get_dt(starget);

	/* see if the device has an echo buffer.  If it does we can do
	 * the SPI pattern write tests.  Because of some broken
	 * devices, we *only* try this on a device that has actually
	 * negotiated DT */

	if (len == -1 && spi_dt(starget))
		len = spi_dv_device_get_echo_buffer(sdev, buffer);
L
Linus Torvalds 已提交
926

927
	if (len <= 0) {
928
		starget_printk(KERN_INFO, starget, "Domain Validation skipping write tests\n");
L
Linus Torvalds 已提交
929 930 931 932
		return;
	}

	if (len > SPI_MAX_ECHO_BUFFER_SIZE) {
933
		starget_printk(KERN_WARNING, starget, "Echo buffer size %d is too big, trimming to %d\n", len, SPI_MAX_ECHO_BUFFER_SIZE);
L
Linus Torvalds 已提交
934 935 936
		len = SPI_MAX_ECHO_BUFFER_SIZE;
	}

937
	if (spi_dv_retrain(sdev, buffer, buffer + len,
L
Linus Torvalds 已提交
938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964
			   spi_dv_device_echo_buffer)
	    == SPI_COMPARE_SKIP_TEST) {
		/* OK, the stupid drive can't do a write echo buffer
		 * test after all, fall back to the read tests */
		len = 0;
		goto retry;
	}
}


/**	spi_dv_device - Do Domain Validation on the device
 *	@sdev:		scsi device to validate
 *
 *	Performs the domain validation on the given device in the
 *	current execution thread.  Since DV operations may sleep,
 *	the current thread must have user context.  Also no SCSI
 *	related locks that would deadlock I/O issued by the DV may
 *	be held.
 */
void
spi_dv_device(struct scsi_device *sdev)
{
	struct scsi_target *starget = sdev->sdev_target;
	u8 *buffer;
	const int len = SPI_MAX_ECHO_BUFFER_SIZE*2;

	if (unlikely(scsi_device_get(sdev)))
965
		return;
L
Linus Torvalds 已提交
966

967 968 969 970
	if (unlikely(spi_dv_in_progress(starget)))
		return;
	spi_dv_in_progress(starget) = 1;

J
Jes Sorensen 已提交
971
	buffer = kzalloc(len, GFP_KERNEL);
L
Linus Torvalds 已提交
972 973 974 975 976 977 978 979 980 981 982 983

	if (unlikely(!buffer))
		goto out_put;

	/* We need to verify that the actual device will quiesce; the
	 * later target quiesce is just a nice to have */
	if (unlikely(scsi_device_quiesce(sdev)))
		goto out_free;

	scsi_target_quiesce(starget);

	spi_dv_pending(starget) = 1;
984
	mutex_lock(&spi_dv_mutex(starget));
L
Linus Torvalds 已提交
985

986
	starget_printk(KERN_INFO, starget, "Beginning Domain Validation\n");
L
Linus Torvalds 已提交
987

988
	spi_dv_device_internal(sdev, buffer);
L
Linus Torvalds 已提交
989

990
	starget_printk(KERN_INFO, starget, "Ending Domain Validation\n");
L
Linus Torvalds 已提交
991

992
	mutex_unlock(&spi_dv_mutex(starget));
L
Linus Torvalds 已提交
993 994 995 996 997 998 999 1000 1001
	spi_dv_pending(starget) = 0;

	scsi_target_resume(starget);

	spi_initial_dv(starget) = 1;

 out_free:
	kfree(buffer);
 out_put:
1002
	spi_dv_in_progress(starget) = 0;
L
Linus Torvalds 已提交
1003 1004 1005 1006 1007 1008 1009 1010 1011 1012
	scsi_device_put(sdev);
}
EXPORT_SYMBOL(spi_dv_device);

struct work_queue_wrapper {
	struct work_struct	work;
	struct scsi_device	*sdev;
};

static void
D
David Howells 已提交
1013
spi_dv_device_work_wrapper(struct work_struct *work)
L
Linus Torvalds 已提交
1014
{
D
David Howells 已提交
1015 1016
	struct work_queue_wrapper *wqw =
		container_of(work, struct work_queue_wrapper, work);
L
Linus Torvalds 已提交
1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055
	struct scsi_device *sdev = wqw->sdev;

	kfree(wqw);
	spi_dv_device(sdev);
	spi_dv_pending(sdev->sdev_target) = 0;
	scsi_device_put(sdev);
}


/**
 *	spi_schedule_dv_device - schedule domain validation to occur on the device
 *	@sdev:	The device to validate
 *
 *	Identical to spi_dv_device() above, except that the DV will be
 *	scheduled to occur in a workqueue later.  All memory allocations
 *	are atomic, so may be called from any context including those holding
 *	SCSI locks.
 */
void
spi_schedule_dv_device(struct scsi_device *sdev)
{
	struct work_queue_wrapper *wqw =
		kmalloc(sizeof(struct work_queue_wrapper), GFP_ATOMIC);

	if (unlikely(!wqw))
		return;

	if (unlikely(spi_dv_pending(sdev->sdev_target))) {
		kfree(wqw);
		return;
	}
	/* Set pending early (dv_device doesn't check it, only sets it) */
	spi_dv_pending(sdev->sdev_target) = 1;
	if (unlikely(scsi_device_get(sdev))) {
		kfree(wqw);
		spi_dv_pending(sdev->sdev_target) = 0;
		return;
	}

D
David Howells 已提交
1056
	INIT_WORK(&wqw->work, spi_dv_device_work_wrapper);
L
Linus Torvalds 已提交
1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
	wqw->sdev = sdev;

	schedule_work(&wqw->work);
}
EXPORT_SYMBOL(spi_schedule_dv_device);

/**
 * spi_display_xfer_agreement - Print the current target transfer agreement
 * @starget: The target for which to display the agreement
 *
 * Each SPI port is required to maintain a transfer agreement for each
 * other port on the bus.  This function prints a one-line summary of
 * the current agreement; more detailed information is available in sysfs.
 */
void spi_display_xfer_agreement(struct scsi_target *starget)
{
	struct spi_transport_attrs *tp;
	tp = (struct spi_transport_attrs *)&starget->starget_data;

	if (tp->offset > 0 && tp->period > 0) {
		unsigned int picosec, kb100;
		char *scsi = "FAST-?";
		char tmp[8];

		if (tp->period <= SPI_STATIC_PPR) {
			picosec = ppr_to_ps[tp->period];
			switch (tp->period) {
				case  7: scsi = "FAST-320"; break;
				case  8: scsi = "FAST-160"; break;
				case  9: scsi = "FAST-80"; break;
				case 10:
				case 11: scsi = "FAST-40"; break;
				case 12: scsi = "FAST-20"; break;
			}
		} else {
			picosec = tp->period * 4000;
			if (tp->period < 25)
				scsi = "FAST-20";
			else if (tp->period < 50)
				scsi = "FAST-10";
			else
				scsi = "FAST-5";
		}

		kb100 = (10000000 + picosec / 2) / picosec;
		if (tp->width)
			kb100 *= 2;
		sprint_frac(tmp, picosec, 1000);

		dev_info(&starget->dev,
1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117
			 "%s %sSCSI %d.%d MB/s %s%s%s%s%s%s%s%s (%s ns, offset %d)\n",
			 scsi, tp->width ? "WIDE " : "", kb100/10, kb100 % 10,
			 tp->dt ? "DT" : "ST",
			 tp->iu ? " IU" : "",
			 tp->qas  ? " QAS" : "",
			 tp->rd_strm ? " RDSTRM" : "",
			 tp->rti ? " RTI" : "",
			 tp->wr_flow ? " WRFLOW" : "",
			 tp->pcomp_en ? " PCOMP" : "",
			 tp->hold_mcs ? " HMCS" : "",
			 tmp, tp->offset);
L
Linus Torvalds 已提交
1118
	} else {
M
Matthew Wilcox 已提交
1119
		dev_info(&starget->dev, "%sasynchronous\n",
L
Linus Torvalds 已提交
1120 1121 1122 1123 1124
				tp->width ? "wide " : "");
	}
}
EXPORT_SYMBOL(spi_display_xfer_agreement);

1125 1126 1127 1128 1129 1130 1131 1132
int spi_populate_width_msg(unsigned char *msg, int width)
{
	msg[0] = EXTENDED_MESSAGE;
	msg[1] = 2;
	msg[2] = EXTENDED_WDTR;
	msg[3] = width;
	return 4;
}
1133
EXPORT_SYMBOL_GPL(spi_populate_width_msg);
1134 1135 1136 1137 1138 1139 1140 1141 1142 1143

int spi_populate_sync_msg(unsigned char *msg, int period, int offset)
{
	msg[0] = EXTENDED_MESSAGE;
	msg[1] = 3;
	msg[2] = EXTENDED_SDTR;
	msg[3] = period;
	msg[4] = offset;
	return 5;
}
1144
EXPORT_SYMBOL_GPL(spi_populate_sync_msg);
1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158

int spi_populate_ppr_msg(unsigned char *msg, int period, int offset,
		int width, int options)
{
	msg[0] = EXTENDED_MESSAGE;
	msg[1] = 6;
	msg[2] = EXTENDED_PPR;
	msg[3] = period;
	msg[4] = 0;
	msg[5] = offset;
	msg[6] = width;
	msg[7] = options;
	return 8;
}
1159
EXPORT_SYMBOL_GPL(spi_populate_ppr_msg);
1160

1161 1162
#ifdef CONFIG_SCSI_CONSTANTS
static const char * const one_byte_msgs[] = {
1163
/* 0x00 */ "Task Complete", NULL /* Extended Message */, "Save Pointers",
1164
/* 0x03 */ "Restore Pointers", "Disconnect", "Initiator Error", 
1165
/* 0x06 */ "Abort Task Set", "Message Reject", "Nop", "Message Parity Error",
1166
/* 0x0a */ "Linked Command Complete", "Linked Command Complete w/flag",
1167 1168 1169 1170
/* 0x0c */ "Target Reset", "Abort Task", "Clear Task Set", 
/* 0x0f */ "Initiate Recovery", "Release Recovery",
/* 0x11 */ "Terminate Process", "Continue Task", "Target Transfer Disable",
/* 0x14 */ NULL, NULL, "Clear ACA", "LUN Reset"
1171 1172 1173
};

static const char * const two_byte_msgs[] = {
1174
/* 0x20 */ "Simple Queue Tag", "Head of Queue Tag", "Ordered Queue Tag",
1175
/* 0x23 */ "Ignore Wide Residue", "ACA"
1176 1177 1178 1179
};

static const char * const extended_msgs[] = {
/* 0x00 */ "Modify Data Pointer", "Synchronous Data Transfer Request",
1180
/* 0x02 */ "SCSI-I Extended Identify", "Wide Data Transfer Request",
1181
/* 0x04 */ "Parallel Protocol Request", "Modify Bidirectional Data Pointer"
1182 1183
};

1184
static void print_nego(const unsigned char *msg, int per, int off, int width)
1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196
{
	if (per) {
		char buf[20];
		period_to_str(buf, msg[per]);
		printk("period = %s ns ", buf);
	}

	if (off)
		printk("offset = %d ", msg[off]);
	if (width)
		printk("width = %d ", 8 << msg[width]);
}
1197

1198 1199 1200 1201 1202 1203 1204
static void print_ptr(const unsigned char *msg, int msb, const char *desc)
{
	int ptr = (msg[msb] << 24) | (msg[msb+1] << 16) | (msg[msb+2] << 8) |
			msg[msb+3];
	printk("%s = %d ", desc, ptr);
}

1205
int spi_print_msg(const unsigned char *msg)
1206
{
1207
	int len = 1, i;
1208
	if (msg[0] == EXTENDED_MESSAGE) {
1209 1210 1211
		len = 2 + msg[1];
		if (len == 2)
			len += 256;
1212
		if (msg[2] < ARRAY_SIZE(extended_msgs))
1213 1214 1215 1216 1217 1218
			printk ("%s ", extended_msgs[msg[2]]); 
		else 
			printk ("Extended Message, reserved code (0x%02x) ",
				(int) msg[2]);
		switch (msg[2]) {
		case EXTENDED_MODIFY_DATA_POINTER:
1219
			print_ptr(msg, 3, "pointer");
1220 1221
			break;
		case EXTENDED_SDTR:
1222
			print_nego(msg, 3, 4, 0);
1223 1224
			break;
		case EXTENDED_WDTR:
1225 1226 1227 1228
			print_nego(msg, 0, 0, 3);
			break;
		case EXTENDED_PPR:
			print_nego(msg, 3, 5, 6);
1229
			break;
1230 1231 1232 1233
		case EXTENDED_MODIFY_BIDI_DATA_PTR:
			print_ptr(msg, 3, "out");
			print_ptr(msg, 7, "in");
			break;
1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245
		default:
		for (i = 2; i < len; ++i) 
			printk("%02x ", msg[i]);
		}
	/* Identify */
	} else if (msg[0] & 0x80) {
		printk("Identify disconnect %sallowed %s %d ",
			(msg[0] & 0x40) ? "" : "not ",
			(msg[0] & 0x20) ? "target routine" : "lun",
			msg[0] & 0x7);
	/* Normal One byte */
	} else if (msg[0] < 0x1f) {
1246
		if (msg[0] < ARRAY_SIZE(one_byte_msgs) && one_byte_msgs[msg[0]])
1247
			printk("%s ", one_byte_msgs[msg[0]]);
1248 1249
		else
			printk("reserved (%02x) ", msg[0]);
1250 1251
	} else if (msg[0] == 0x55) {
		printk("QAS Request ");
1252 1253
	/* Two byte */
	} else if (msg[0] <= 0x2f) {
1254
		if ((msg[0] - 0x20) < ARRAY_SIZE(two_byte_msgs))
1255 1256 1257 1258 1259 1260 1261
			printk("%s %02x ", two_byte_msgs[msg[0] - 0x20], 
				msg[1]);
		else 
			printk("reserved two byte (%02x %02x) ", 
				msg[0], msg[1]);
		len = 2;
	} else 
1262
		printk("reserved ");
1263 1264
	return len;
}
1265
EXPORT_SYMBOL(spi_print_msg);
1266 1267 1268

#else  /* ifndef CONFIG_SCSI_CONSTANTS */

1269
int spi_print_msg(const unsigned char *msg)
1270
{
1271
	int len = 1, i;
1272 1273

	if (msg[0] == EXTENDED_MESSAGE) {
1274 1275 1276
		len = 2 + msg[1];
		if (len == 2)
			len += 256;
1277 1278 1279 1280 1281 1282
		for (i = 0; i < len; ++i)
			printk("%02x ", msg[i]);
	/* Identify */
	} else if (msg[0] & 0x80) {
		printk("%02x ", msg[0]);
	/* Normal One byte */
1283
	} else if ((msg[0] < 0x1f) || (msg[0] == 0x55)) {
1284 1285 1286 1287 1288 1289 1290 1291 1292
		printk("%02x ", msg[0]);
	/* Two byte */
	} else if (msg[0] <= 0x2f) {
		printk("%02x %02x", msg[0], msg[1]);
		len = 2;
	} else 
		printk("%02x ", msg[0]);
	return len;
}
1293
EXPORT_SYMBOL(spi_print_msg);
1294 1295
#endif /* ! CONFIG_SCSI_CONSTANTS */

L
Linus Torvalds 已提交
1296 1297 1298 1299 1300
static int spi_device_match(struct attribute_container *cont,
			    struct device *dev)
{
	struct scsi_device *sdev;
	struct Scsi_Host *shost;
1301
	struct spi_internal *i;
L
Linus Torvalds 已提交
1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313

	if (!scsi_is_sdev_device(dev))
		return 0;

	sdev = to_scsi_device(dev);
	shost = sdev->host;
	if (!shost->transportt  || shost->transportt->host_attrs.ac.class
	    != &spi_host_class.class)
		return 0;
	/* Note: this class has no device attributes, so it has
	 * no per-HBA allocation and thus we don't need to distinguish
	 * the attribute containers for the device */
1314 1315 1316
	i = to_spi_internal(shost->transportt);
	if (i->f->deny_binding && i->f->deny_binding(sdev->sdev_target))
		return 0;
L
Linus Torvalds 已提交
1317 1318 1319 1320 1321 1322 1323
	return 1;
}

static int spi_target_match(struct attribute_container *cont,
			    struct device *dev)
{
	struct Scsi_Host *shost;
1324
	struct scsi_target *starget;
L
Linus Torvalds 已提交
1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335
	struct spi_internal *i;

	if (!scsi_is_target_device(dev))
		return 0;

	shost = dev_to_shost(dev->parent);
	if (!shost->transportt  || shost->transportt->host_attrs.ac.class
	    != &spi_host_class.class)
		return 0;

	i = to_spi_internal(shost->transportt);
1336 1337 1338 1339 1340
	starget = to_scsi_target(dev);

	if (i->f->deny_binding && i->f->deny_binding(starget))
		return 0;

L
Linus Torvalds 已提交
1341 1342 1343 1344 1345 1346 1347
	return &i->t.target_attrs.ac == cont;
}

static DECLARE_TRANSPORT_CLASS(spi_transport_class,
			       "spi_transport",
			       spi_setup_transport_attrs,
			       NULL,
1348
			       spi_target_configure);
L
Linus Torvalds 已提交
1349 1350 1351 1352 1353

static DECLARE_ANON_TRANSPORT_CLASS(spi_device_class,
				    spi_device_match,
				    spi_device_configure);

1354
static struct attribute *host_attributes[] = {
1355
	&dev_attr_signalling.attr,
1356 1357 1358 1359 1360 1361 1362 1363 1364
	NULL
};

static struct attribute_group host_attribute_group = {
	.attrs = host_attributes,
};

static int spi_host_configure(struct transport_container *tc,
			      struct device *dev,
1365
			      struct device *cdev)
1366 1367 1368 1369
{
	struct kobject *kobj = &cdev->kobj;
	struct Scsi_Host *shost = transport_class_to_shost(cdev);
	struct spi_internal *si = to_spi_internal(shost->transportt);
1370
	struct attribute *attr = &dev_attr_signalling.attr;
1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382
	int rc = 0;

	if (si->f->set_signalling)
		rc = sysfs_chmod_file(kobj, attr, attr->mode | S_IWUSR);

	return rc;
}

/* returns true if we should be showing the variable.  Also
 * overloads the return by setting 1<<1 if the attribute should
 * be writeable */
#define TARGET_ATTRIBUTE_HELPER(name) \
1383 1384
	(si->f->show_##name ? S_IRUGO : 0) | \
	(si->f->set_##name ? S_IWUSR : 0)
1385

1386 1387
static mode_t target_attribute_is_visible(struct kobject *kobj,
					  struct attribute *attr, int i)
1388
{
1389
	struct device *cdev = container_of(kobj, struct device, kobj);
1390 1391 1392 1393
	struct scsi_target *starget = transport_class_to_starget(cdev);
	struct Scsi_Host *shost = transport_class_to_shost(cdev);
	struct spi_internal *si = to_spi_internal(shost->transportt);

1394
	if (attr == &dev_attr_period.attr &&
1395 1396
	    spi_support_sync(starget))
		return TARGET_ATTRIBUTE_HELPER(period);
1397
	else if (attr == &dev_attr_min_period.attr &&
1398 1399
		 spi_support_sync(starget))
		return TARGET_ATTRIBUTE_HELPER(period);
1400
	else if (attr == &dev_attr_offset.attr &&
1401 1402
		 spi_support_sync(starget))
		return TARGET_ATTRIBUTE_HELPER(offset);
1403
	else if (attr == &dev_attr_max_offset.attr &&
1404 1405
		 spi_support_sync(starget))
		return TARGET_ATTRIBUTE_HELPER(offset);
1406
	else if (attr == &dev_attr_width.attr &&
1407 1408
		 spi_support_wide(starget))
		return TARGET_ATTRIBUTE_HELPER(width);
1409
	else if (attr == &dev_attr_max_width.attr &&
1410 1411
		 spi_support_wide(starget))
		return TARGET_ATTRIBUTE_HELPER(width);
1412
	else if (attr == &dev_attr_iu.attr &&
1413 1414
		 spi_support_ius(starget))
		return TARGET_ATTRIBUTE_HELPER(iu);
1415
	else if (attr == &dev_attr_dt.attr &&
1416 1417
		 spi_support_dt(starget))
		return TARGET_ATTRIBUTE_HELPER(dt);
1418
	else if (attr == &dev_attr_qas.attr &&
1419 1420
		 spi_support_qas(starget))
		return TARGET_ATTRIBUTE_HELPER(qas);
1421
	else if (attr == &dev_attr_wr_flow.attr &&
1422 1423
		 spi_support_ius(starget))
		return TARGET_ATTRIBUTE_HELPER(wr_flow);
1424
	else if (attr == &dev_attr_rd_strm.attr &&
1425 1426
		 spi_support_ius(starget))
		return TARGET_ATTRIBUTE_HELPER(rd_strm);
1427
	else if (attr == &dev_attr_rti.attr &&
1428 1429
		 spi_support_ius(starget))
		return TARGET_ATTRIBUTE_HELPER(rti);
1430
	else if (attr == &dev_attr_pcomp_en.attr &&
1431 1432
		 spi_support_ius(starget))
		return TARGET_ATTRIBUTE_HELPER(pcomp_en);
1433
	else if (attr == &dev_attr_hold_mcs.attr &&
1434 1435
		 spi_support_ius(starget))
		return TARGET_ATTRIBUTE_HELPER(hold_mcs);
1436
	else if (attr == &dev_attr_revalidate.attr)
1437
		return S_IWUSR;
1438 1439 1440 1441 1442

	return 0;
}

static struct attribute *target_attributes[] = {
1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457
	&dev_attr_period.attr,
	&dev_attr_min_period.attr,
	&dev_attr_offset.attr,
	&dev_attr_max_offset.attr,
	&dev_attr_width.attr,
	&dev_attr_max_width.attr,
	&dev_attr_iu.attr,
	&dev_attr_dt.attr,
	&dev_attr_qas.attr,
	&dev_attr_wr_flow.attr,
	&dev_attr_rd_strm.attr,
	&dev_attr_rti.attr,
	&dev_attr_pcomp_en.attr,
	&dev_attr_hold_mcs.attr,
	&dev_attr_revalidate.attr,
1458 1459 1460 1461 1462 1463 1464 1465 1466 1467
	NULL
};

static struct attribute_group target_attribute_group = {
	.attrs = target_attributes,
	.is_visible = target_attribute_is_visible,
};

static int spi_target_configure(struct transport_container *tc,
				struct device *dev,
1468
				struct device *cdev)
1469 1470
{
	struct kobject *kobj = &cdev->kobj;
1471 1472 1473

	/* force an update based on parameters read from the device */
	sysfs_update_group(kobj, &target_attribute_group);
1474 1475 1476 1477

	return 0;
}

L
Linus Torvalds 已提交
1478 1479 1480
struct scsi_transport_template *
spi_attach_transport(struct spi_function_template *ft)
{
J
Jes Sorensen 已提交
1481 1482 1483
	struct spi_internal *i = kzalloc(sizeof(struct spi_internal),
					 GFP_KERNEL);

L
Linus Torvalds 已提交
1484 1485 1486 1487
	if (unlikely(!i))
		return NULL;

	i->t.target_attrs.ac.class = &spi_transport_class.class;
1488
	i->t.target_attrs.ac.grp = &target_attribute_group;
L
Linus Torvalds 已提交
1489 1490 1491 1492
	i->t.target_attrs.ac.match = spi_target_match;
	transport_container_register(&i->t.target_attrs);
	i->t.target_size = sizeof(struct spi_transport_attrs);
	i->t.host_attrs.ac.class = &spi_host_class.class;
1493
	i->t.host_attrs.ac.grp = &host_attribute_group;
L
Linus Torvalds 已提交
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
	i->t.host_attrs.ac.match = spi_host_match;
	transport_container_register(&i->t.host_attrs);
	i->t.host_size = sizeof(struct spi_host_attrs);
	i->f = ft;

	return &i->t;
}
EXPORT_SYMBOL(spi_attach_transport);

void spi_release_transport(struct scsi_transport_template *t)
{
	struct spi_internal *i = to_spi_internal(t);

	transport_container_unregister(&i->t.target_attrs);
	transport_container_unregister(&i->t.host_attrs);

	kfree(i);
}
EXPORT_SYMBOL(spi_release_transport);

static __init int spi_transport_init(void)
{
	int error = transport_class_register(&spi_transport_class);
	if (error)
		return error;
	error = anon_transport_class_register(&spi_device_class);
	return transport_class_register(&spi_host_class);
}

static void __exit spi_transport_exit(void)
{
	transport_class_unregister(&spi_transport_class);
	anon_transport_class_unregister(&spi_device_class);
	transport_class_unregister(&spi_host_class);
}

MODULE_AUTHOR("Martin Hicks");
MODULE_DESCRIPTION("SPI Transport Attributes");
MODULE_LICENSE("GPL");

module_init(spi_transport_init);
module_exit(spi_transport_exit);