|  | /* | 
|  | *  linux/drivers/acorn/scsi/scsi.h | 
|  | * | 
|  | *  Copyright (C) 2002 Russell King | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or modify | 
|  | * it under the terms of the GNU General Public License version 2 as | 
|  | * published by the Free Software Foundation. | 
|  | * | 
|  | *  Commonly used scsi driver functions. | 
|  | */ | 
|  |  | 
|  | #include <linux/scatterlist.h> | 
|  |  | 
|  | #define BELT_AND_BRACES | 
|  |  | 
|  | /* | 
|  | * The scatter-gather list handling.  This contains all | 
|  | * the yucky stuff that needs to be fixed properly. | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * copy_SCp_to_sg() Assumes contiguous allocation at @sg of at-most @max | 
|  | * entries of uninitialized memory. SCp is from scsi-ml and has a valid | 
|  | * (possibly chained) sg-list | 
|  | */ | 
|  | static inline int copy_SCp_to_sg(struct scatterlist *sg, struct scsi_pointer *SCp, int max) | 
|  | { | 
|  | int bufs = SCp->buffers_residual; | 
|  |  | 
|  | /* FIXME: It should be easy for drivers to loop on copy_SCp_to_sg(). | 
|  | * and to remove this BUG_ON. Use min() in-its-place | 
|  | */ | 
|  | BUG_ON(bufs + 1 > max); | 
|  |  | 
|  | sg_set_buf(sg, SCp->ptr, SCp->this_residual); | 
|  |  | 
|  | if (bufs) { | 
|  | struct scatterlist *src_sg; | 
|  | unsigned i; | 
|  |  | 
|  | for_each_sg(sg_next(SCp->buffer), src_sg, bufs, i) | 
|  | *(++sg) = *src_sg; | 
|  | sg_mark_end(sg); | 
|  | } | 
|  |  | 
|  | return bufs + 1; | 
|  | } | 
|  |  | 
|  | static inline int next_SCp(struct scsi_pointer *SCp) | 
|  | { | 
|  | int ret = SCp->buffers_residual; | 
|  | if (ret) { | 
|  | SCp->buffer = sg_next(SCp->buffer); | 
|  | SCp->buffers_residual--; | 
|  | SCp->ptr = sg_virt(SCp->buffer); | 
|  | SCp->this_residual = SCp->buffer->length; | 
|  | } else { | 
|  | SCp->ptr = NULL; | 
|  | SCp->this_residual = 0; | 
|  | } | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static inline unsigned char get_next_SCp_byte(struct scsi_pointer *SCp) | 
|  | { | 
|  | char c = *SCp->ptr; | 
|  |  | 
|  | SCp->ptr += 1; | 
|  | SCp->this_residual -= 1; | 
|  |  | 
|  | return c; | 
|  | } | 
|  |  | 
|  | static inline void put_next_SCp_byte(struct scsi_pointer *SCp, unsigned char c) | 
|  | { | 
|  | *SCp->ptr = c; | 
|  | SCp->ptr += 1; | 
|  | SCp->this_residual -= 1; | 
|  | } | 
|  |  | 
|  | static inline void init_SCp(struct scsi_cmnd *SCpnt) | 
|  | { | 
|  | memset(&SCpnt->SCp, 0, sizeof(struct scsi_pointer)); | 
|  |  | 
|  | if (scsi_bufflen(SCpnt)) { | 
|  | unsigned long len = 0; | 
|  |  | 
|  | SCpnt->SCp.buffer = scsi_sglist(SCpnt); | 
|  | SCpnt->SCp.buffers_residual = scsi_sg_count(SCpnt) - 1; | 
|  | SCpnt->SCp.ptr = sg_virt(SCpnt->SCp.buffer); | 
|  | SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length; | 
|  | SCpnt->SCp.phase = scsi_bufflen(SCpnt); | 
|  |  | 
|  | #ifdef BELT_AND_BRACES | 
|  | {	/* | 
|  | * Calculate correct buffer length.  Some commands | 
|  | * come in with the wrong scsi_bufflen. | 
|  | */ | 
|  | struct scatterlist *sg; | 
|  | unsigned i, sg_count = scsi_sg_count(SCpnt); | 
|  |  | 
|  | scsi_for_each_sg(SCpnt, sg, sg_count, i) | 
|  | len += sg->length; | 
|  |  | 
|  | if (scsi_bufflen(SCpnt) != len) { | 
|  | printk(KERN_WARNING | 
|  | "scsi%d.%c: bad request buffer " | 
|  | "length %d, should be %ld\n", | 
|  | SCpnt->device->host->host_no, | 
|  | '0' + SCpnt->device->id, | 
|  | scsi_bufflen(SCpnt), len); | 
|  | /* | 
|  | * FIXME: Totaly naive fixup. We should abort | 
|  | * with error | 
|  | */ | 
|  | SCpnt->SCp.phase = | 
|  | min_t(unsigned long, len, | 
|  | scsi_bufflen(SCpnt)); | 
|  | } | 
|  | } | 
|  | #endif | 
|  | } else { | 
|  | SCpnt->SCp.ptr = NULL; | 
|  | SCpnt->SCp.this_residual = 0; | 
|  | SCpnt->SCp.phase = 0; | 
|  | } | 
|  | } |