xref: /utopia/UTPA2-700.0.x/modules/usb/drv/usb_ecos/usbhost/drvProtocol.c (revision 53ee8cc121a030b8d368113ac3e966b4705770ef)

//<MStar Software>
//******************************************************************************
// MStar Software
// Copyright (c) 2010 - 2012 MStar Semiconductor, Inc. All rights reserved.
// All software, firmware and related documentation herein ("MStar Software") are
// intellectual property of MStar Semiconductor, Inc. ("MStar") and protected by
// law, including, but not limited to, copyright law and international treaties.
// Any use, modification, reproduction, retransmission, or republication of all
// or part of MStar Software is expressly prohibited, unless prior written
// permission has been granted by MStar.
//
// By accessing, browsing and/or using MStar Software, you acknowledge that you
// have read, understood, and agree, to be bound by below terms ("Terms") and to
// comply with all applicable laws and regulations:
//
// 1. MStar shall retain any and all right, ownership and interest to MStar
//    Software and any modification/derivatives thereof.
//    No right, ownership, or interest to MStar Software and any
//    modification/derivatives thereof is transferred to you under Terms.
//
// 2. You understand that MStar Software might include, incorporate or be
//    supplied together with third party`s software and the use of MStar
//    Software may require additional licenses from third parties.
//    Therefore, you hereby agree it is your sole responsibility to separately
//    obtain any and all third party right and license necessary for your use of
//    such third party`s software.
//
// 3. MStar Software and any modification/derivatives thereof shall be deemed as
//    MStar`s confidential information and you agree to keep MStar`s
//    confidential information in strictest confidence and not disclose to any
//    third party.
//
// 4. MStar Software is provided on an "AS IS" basis without warranties of any
//    kind. Any warranties are hereby expressly disclaimed by MStar, including
//    without limitation, any warranties of merchantability, non-infringement of
//    intellectual property rights, fitness for a particular purpose, error free
//    and in conformity with any international standard.  You agree to waive any
//    claim against MStar for any loss, damage, cost or expense that you may
//    incur related to your use of MStar Software.
//    In no event shall MStar be liable for any direct, indirect, incidental or
//    consequential damages, including without limitation, lost of profit or
//    revenues, lost or damage of data, and unauthorized system use.
//    You agree that this Section 4 shall still apply without being affected
//    even if MStar Software has been modified by MStar in accordance with your
//    request or instruction for your use, except otherwise agreed by both
//    parties in writing.
//
// 5. If requested, MStar may from time to time provide technical supports or
//    services in relation with MStar Software to you for your use of
//    MStar Software in conjunction with your or your customer`s product
//    ("Services").
//    You understand and agree that, except otherwise agreed by both parties in
//    writing, Services are provided on an "AS IS" basis and the warranty
//    disclaimer set forth in Section 4 above shall apply.
//
// 6. Nothing contained herein shall be construed as by implication, estoppels
//    or otherwise:
//    (a) conferring any license or right to use MStar name, trademark, service
//        mark, symbol or any other identification;
//    (b) obligating MStar or any of its affiliates to furnish any person,
//        including without limitation, you and your customers, any assistance
//        of any kind whatsoever, or any information; or
//    (c) conferring any license or right under any intellectual property right.
//
// 7. These terms shall be governed by and construed in accordance with the laws
//    of Taiwan, R.O.C., excluding its conflict of law rules.
//    Any and all dispute arising out hereof or related hereto shall be finally
//    settled by arbitration referred to the Chinese Arbitration Association,
//    Taipei in accordance with the ROC Arbitration Law and the Arbitration
//    Rules of the Association by three (3) arbitrators appointed in accordance
//    with the said Rules.
//    The place of arbitration shall be in Taipei, Taiwan and the language shall
//    be English.
//    The arbitration award shall be final and binding to both parties.
//
//******************************************************************************
//<MStar Software>

#include <MsCommon.h>
#include "drvProtocol.h"
#include "drvMassStor.h"
//#include "debug.h"
#include "drvTransport.h"
#if 1

#ifdef US_DEBUG
#define US_DEBUGP(x,...) printk(x,__VA_ARGS__)
#else
#define US_DEBUGP(x,...)
#endif

static void *
find_data_location(Scsi_Cmnd *srb)
{
	if (srb->use_sg)
	{
		printk("find_data_location : unsupport scatter function.");
		return (void *) srb->request_buffer;
	}
	else
		return (void *) srb->request_buffer;
}

static void fix_inquiry_data(Scsi_Cmnd *srb)
{
	unsigned char *data_ptr;

	if (srb->cmnd[0] != INQUIRY)
		return;

	if (srb->request_bufflen < 3)
		return;

	data_ptr = (unsigned char*) find_data_location(srb);

	if ((data_ptr[2] & 7) == 2)
		return;

	US_DEBUGP("Fixing INQUIRY data to show SCSI rev 2 - was %d\n",
		  data_ptr[2] & 7);

	data_ptr[2] = (data_ptr[2] & ~7) | 2;
}

static void fix_read_capacity(Scsi_Cmnd *srb)
{
	unsigned char *dp;
	U32 capacity;

	if (srb->cmnd[0] != READ_CAPACITY)
		return;

	dp = (unsigned char*) find_data_location(srb);

	capacity = (dp[0]<<24) + (dp[1]<<16) + (dp[2]<<8) + (dp[3]);
	US_DEBUGP("US: Fixing capacity: from %ld to %ld\n",
	       capacity+1, capacity);
	capacity--;
	dp[0] = (capacity >> 24);
	dp[1] = (capacity >> 16);
	dp[2] = (capacity >> 8);
	dp[3] = (capacity);
}

#if SupportOtherDevice
void usb_stor_qic157_command(Scsi_Cmnd *srb, struct us_data *us)
{
	for (; srb->cmd_len<12; srb->cmd_len++)
		srb->cmnd[srb->cmd_len] = 0;

	srb->cmd_len = 12;

	usb_stor_invoke_transport(srb, us);
	if (srb->result == SAM_STAT_GOOD) {
		fix_inquiry_data(srb);
	}
}

void usb_stor_ATAPI_command(Scsi_Cmnd *srb, struct us_data *us)
{

	for (; srb->cmd_len<12; srb->cmd_len++)
		srb->cmnd[srb->cmd_len] = 0;

	srb->cmd_len = 12;

	usb_stor_invoke_transport(srb, us);

	if (srb->result == SAM_STAT_GOOD) {
		fix_inquiry_data(srb);
	}
}


void usb_stor_ufi_command(Scsi_Cmnd *srb, struct us_data *us)
{
	for (; srb->cmd_len<12; srb->cmd_len++)
		srb->cmnd[srb->cmd_len] = 0;

	srb->cmd_len = 12;

	switch (srb->cmnd[0]) {

	case INQUIRY:
		srb->cmnd[4] = 36;
		break;

	//case MODE_SENSE_10:
	case MODE_SENSE:	//GGYY
		srb->cmnd[7] = 0;
		srb->cmnd[8] = 8;
		break;

	case REQUEST_SENSE:
		srb->cmnd[4] = 18;
		break;
	} /* end switch on cmnd[0] */

	usb_stor_invoke_transport(srb, us);

	if (srb->result == SAM_STAT_GOOD) {
		fix_inquiry_data(srb);
	}
}
#endif

void usb_stor_transparent_scsi_command(Scsi_Cmnd *srb, struct us_data *us)
{
	usb_stor_invoke_transport(srb, us);

	if (srb->result == SAM_STAT_GOOD) {
		fix_inquiry_data(srb);

		if (us->flags & US_FL_FIX_CAPACITY)
			fix_read_capacity(srb);
	}
}
#endif	//#