linux-imx

/*

 * Copyright (C) 2010 FUJITSU LIMITED

 * Copyright (C) 2010 Tomohiro Kusumi <kusumi.tomohiro@jp.fujitsu.com>

 *

 * 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.

 *

 * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

 */

#include <linux/kernel.h>

#include <linux/trace_seq.h>

#include <asm/unaligned.h>

#include <trace/events/scsi.h>

​

#define SERVICE_ACTION16(cdb) (cdb[1] & 0x1f)

#define SERVICE_ACTION32(cdb) ((cdb[8] << 8) | cdb[9])

​

static const char *

scsi_trace_misc(struct trace_seq *, unsigned char *, int);

​

static const char *

scsi_trace_rw6(struct trace_seq *p, unsigned char *cdb, int len)

{

    const char *ret = trace_seq_buffer_ptr(p);

    sector_t lba = 0, txlen = 0;

​

    lba |= ((cdb[1] & 0x1F) << 16);

    lba |=  (cdb[2] << 8);

    lba |=   cdb[3];

    txlen = cdb[4];

​

    trace_seq_printf(p, "lba=%llu txlen=%llu",

             (unsigned long long)lba, (unsigned long long)txlen);

    trace_seq_putc(p, 0);

​

    return ret;

}

​

static const char *

scsi_trace_rw10(struct trace_seq *p, unsigned char *cdb, int len)

{

    const char *ret = trace_seq_buffer_ptr(p);

    sector_t lba = 0, txlen = 0;

​

    lba |= (cdb[2] << 24);

    lba |= (cdb[3] << 16);

    lba |= (cdb[4] << 8);

    lba |=  cdb[5];

    txlen |= (cdb[7] << 8);

    txlen |=  cdb[8];

​

    trace_seq_printf(p, "lba=%llu txlen=%llu protect=%u",

             (unsigned long long)lba, (unsigned long long)txlen,

             cdb[1] >> 5);

​

    if (cdb[0] == WRITE_SAME)

        trace_seq_printf(p, " unmap=%u", cdb[1] >> 3 & 1);

​

    trace_seq_putc(p, 0);

​

    return ret;

}

​

static const char *

scsi_trace_rw12(struct trace_seq *p, unsigned char *cdb, int len)

{

    const char *ret = trace_seq_buffer_ptr(p);

    sector_t lba = 0, txlen = 0;

​

    lba |= (cdb[2] << 24);

    lba |= (cdb[3] << 16);

    lba |= (cdb[4] << 8);

    lba |=  cdb[5];

    txlen |= (cdb[6] << 24);

    txlen |= (cdb[7] << 16);

    txlen |= (cdb[8] << 8);

    txlen |=  cdb[9];

​

    trace_seq_printf(p, "lba=%llu txlen=%llu protect=%u",

             (unsigned long long)lba, (unsigned long long)txlen,

             cdb[1] >> 5);

    trace_seq_putc(p, 0);

​

    return ret;