blob: 138a521ba1a81c238c2ff817630c107a38a5771c [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/drivers/acorn/scsi/scsi.h
3 *
4 * Copyright (C) 2002 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 * Commonly used scsi driver functions.
11 */
12
David Hardeman378f0582005-09-17 17:55:31 +100013#include <linux/scatterlist.h>
14
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#define BELT_AND_BRACES
16
17/*
18 * The scatter-gather list handling. This contains all
19 * the yucky stuff that needs to be fixed properly.
20 */
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030021
22/*
23 * copy_SCp_to_sg() Assumes contiguous allocation at @sg of at-most @max
24 * entries of uninitialized memory. SCp is from scsi-ml and has a valid
25 * (possibly chained) sg-list
26 */
Christoph Hellwig0a041372005-10-31 18:31:56 +010027static inline int copy_SCp_to_sg(struct scatterlist *sg, struct scsi_pointer *SCp, int max)
Linus Torvalds1da177e2005-04-16 15:20:36 -070028{
29 int bufs = SCp->buffers_residual;
30
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030031 /* FIXME: It should be easy for drivers to loop on copy_SCp_to_sg().
32 * and to remove this BUG_ON. Use min() in-its-place
33 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070034 BUG_ON(bufs + 1 > max);
35
David Hardeman378f0582005-09-17 17:55:31 +100036 sg_set_buf(sg, SCp->ptr, SCp->this_residual);
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030038 if (bufs) {
39 struct scatterlist *src_sg;
40 unsigned i;
41
42 for_each_sg(sg_next(SCp->buffer), src_sg, bufs, i)
43 *(++sg) = *src_sg;
44 sg_mark_end(sg);
45 }
46
Linus Torvalds1da177e2005-04-16 15:20:36 -070047 return bufs + 1;
48}
49
Christoph Hellwig0a041372005-10-31 18:31:56 +010050static inline int next_SCp(struct scsi_pointer *SCp)
Linus Torvalds1da177e2005-04-16 15:20:36 -070051{
52 int ret = SCp->buffers_residual;
53 if (ret) {
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030054 SCp->buffer = sg_next(SCp->buffer);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055 SCp->buffers_residual--;
Russell King01c0ad52007-10-26 17:47:34 +010056 SCp->ptr = sg_virt(SCp->buffer);
Linus Torvalds1da177e2005-04-16 15:20:36 -070057 SCp->this_residual = SCp->buffer->length;
58 } else {
59 SCp->ptr = NULL;
60 SCp->this_residual = 0;
61 }
62 return ret;
63}
64
Christoph Hellwig0a041372005-10-31 18:31:56 +010065static inline unsigned char get_next_SCp_byte(struct scsi_pointer *SCp)
Linus Torvalds1da177e2005-04-16 15:20:36 -070066{
67 char c = *SCp->ptr;
68
69 SCp->ptr += 1;
70 SCp->this_residual -= 1;
71
72 return c;
73}
74
Christoph Hellwig0a041372005-10-31 18:31:56 +010075static inline void put_next_SCp_byte(struct scsi_pointer *SCp, unsigned char c)
Linus Torvalds1da177e2005-04-16 15:20:36 -070076{
77 *SCp->ptr = c;
78 SCp->ptr += 1;
79 SCp->this_residual -= 1;
80}
81
Henneee0ca6b2006-10-01 13:18:37 +020082static inline void init_SCp(struct scsi_cmnd *SCpnt)
Linus Torvalds1da177e2005-04-16 15:20:36 -070083{
84 memset(&SCpnt->SCp, 0, sizeof(struct scsi_pointer));
85
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030086 if (scsi_bufflen(SCpnt)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070087 unsigned long len = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070088
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030089 SCpnt->SCp.buffer = scsi_sglist(SCpnt);
90 SCpnt->SCp.buffers_residual = scsi_sg_count(SCpnt) - 1;
Russell King01c0ad52007-10-26 17:47:34 +010091 SCpnt->SCp.ptr = sg_virt(SCpnt->SCp.buffer);
Linus Torvalds1da177e2005-04-16 15:20:36 -070092 SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length;
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030093 SCpnt->SCp.phase = scsi_bufflen(SCpnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -070094
95#ifdef BELT_AND_BRACES
Boaz Harrosh84ac86c2007-09-09 21:31:21 +030096 { /*
97 * Calculate correct buffer length. Some commands
98 * come in with the wrong scsi_bufflen.
99 */
100 struct scatterlist *sg;
101 unsigned i, sg_count = scsi_sg_count(SCpnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102
Boaz Harrosh84ac86c2007-09-09 21:31:21 +0300103 scsi_for_each_sg(SCpnt, sg, sg_count, i)
104 len += sg->length;
105
106 if (scsi_bufflen(SCpnt) != len) {
107 printk(KERN_WARNING
108 "scsi%d.%c: bad request buffer "
109 "length %d, should be %ld\n",
110 SCpnt->device->host->host_no,
111 '0' + SCpnt->device->id,
112 scsi_bufflen(SCpnt), len);
113 /*
114 * FIXME: Totaly naive fixup. We should abort
115 * with error
116 */
117 SCpnt->SCp.phase =
118 min_t(unsigned long, len,
119 scsi_bufflen(SCpnt));
120 }
121 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122#endif
123 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124 SCpnt->SCp.ptr = NULL;
Boaz Harrosh84ac86c2007-09-09 21:31:21 +0300125 SCpnt->SCp.this_residual = 0;
126 SCpnt->SCp.phase = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 }
128}