Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 797150b9 authored by Charles's avatar Charles Committed by Martin K. Petersen
Browse files

stex: Add S3/S4 support 



Add S3/S4 support, add .suspend and .resume function in pci_driver.  In
.suspend handler, driver send S3/S4 signal to the device.

Signed-off-by: default avatarCharles Chiou <charles.chiou@tw.promise.com>
Reviewed-by: default avatarJohannes Thumshirn <jthumshirn@suse.de>
Signed-off-by: default avatarMartin K. Petersen <martin.petersen@oracle.com>
parent 45b42adb

drivers/scsi/stex.c

+65 −3
Original line number Original line Diff line number Diff line
@@ -167,6 +167,14 @@ enum { 




	ST_ADDITIONAL_MEM			= 0x200000,

	ST_ADDITIONAL_MEM			= 0x200000,

	ST_ADDITIONAL_MEM_MIN			= 0x80000,

	ST_ADDITIONAL_MEM_MIN			= 0x80000,

	PMIC_SHUTDOWN				= 0x0D,

	PMIC_REUMSE					= 0x10,

	ST_IGNORED					= -1,

	ST_NOTHANDLED				= 7,

	ST_S3						= 3,

	ST_S4						= 4,

	ST_S5						= 5,

	ST_S6						= 6,

};

};





struct st_sgitem {

struct st_sgitem {
@@ -1718,7 +1726,7 @@ static int stex_probe(struct pci_dev *pdev, const struct pci_device_id *id) 
	return err;

	return err;

}

}





static void stex_hba_stop(struct st_hba *hba)

static void stex_hba_stop(struct st_hba *hba, int st_sleep_mic)

{

{

	struct req_msg *req;

	struct req_msg *req;

	struct st_msg_header *msg_h;

	struct st_msg_header *msg_h;
@@ -1727,6 +1735,15 @@ static void stex_hba_stop(struct st_hba *hba) 
	u16 tag = 0;

	u16 tag = 0;





	spin_lock_irqsave(hba->host->host_lock, flags);

	spin_lock_irqsave(hba->host->host_lock, flags);



	if (hba->cardtype == st_yel && hba->supports_pm == 1)

	{

		if(st_sleep_mic == ST_NOTHANDLED)

		{

			spin_unlock_irqrestore(hba->host->host_lock, flags);

			return;

		}

	}

	req = hba->alloc_rq(hba);

	req = hba->alloc_rq(hba);

	if (hba->cardtype == st_yel) {

	if (hba->cardtype == st_yel) {

		msg_h = (struct st_msg_header *)req - 1;

		msg_h = (struct st_msg_header *)req - 1;
@@ -1734,11 +1751,18 @@ static void stex_hba_stop(struct st_hba *hba) 
	} else

	} else

		memset(req, 0, hba->rq_size);

		memset(req, 0, hba->rq_size);





	if (hba->cardtype == st_yosemite || hba->cardtype == st_yel) {

	if ((hba->cardtype == st_yosemite || hba->cardtype == st_yel)

		&& st_sleep_mic == ST_IGNORED) {

		req->cdb[0] = MGT_CMD;

		req->cdb[0] = MGT_CMD;

		req->cdb[1] = MGT_CMD_SIGNATURE;

		req->cdb[1] = MGT_CMD_SIGNATURE;

		req->cdb[2] = CTLR_CONFIG_CMD;

		req->cdb[2] = CTLR_CONFIG_CMD;

		req->cdb[3] = CTLR_SHUTDOWN;

		req->cdb[3] = CTLR_SHUTDOWN;

	} else if (hba->cardtype == st_yel && st_sleep_mic != ST_IGNORED) {

		req->cdb[0] = MGT_CMD;

		req->cdb[1] = MGT_CMD_SIGNATURE;

		req->cdb[2] = CTLR_CONFIG_CMD;

		req->cdb[3] = PMIC_SHUTDOWN;

		req->cdb[4] = st_sleep_mic;

	} else {

	} else {

		req->cdb[0] = CONTROLLER_CMD;

		req->cdb[0] = CONTROLLER_CMD;

		req->cdb[1] = CTLR_POWER_STATE_CHANGE;

		req->cdb[1] = CTLR_POWER_STATE_CHANGE;
@@ -1758,10 +1782,12 @@ static void stex_hba_stop(struct st_hba *hba) 
	while (hba->ccb[tag].req_type & PASSTHRU_REQ_TYPE) {

	while (hba->ccb[tag].req_type & PASSTHRU_REQ_TYPE) {

		if (time_after(jiffies, before + ST_INTERNAL_TIMEOUT * HZ)) {

		if (time_after(jiffies, before + ST_INTERNAL_TIMEOUT * HZ)) {

			hba->ccb[tag].req_type = 0;

			hba->ccb[tag].req_type = 0;

			hba->mu_status = MU_STATE_STOP;

			return;

			return;

		}

		}

		msleep(1);

		msleep(1);

	}

	}

	hba->mu_status = MU_STATE_STOP;

}

}





static void stex_hba_free(struct st_hba *hba)

static void stex_hba_free(struct st_hba *hba)
@@ -1801,9 +1827,43 @@ static void stex_shutdown(struct pci_dev *pdev) 
{

{

	struct st_hba *hba = pci_get_drvdata(pdev);

	struct st_hba *hba = pci_get_drvdata(pdev);





	stex_hba_stop(hba);

	if (hba->supports_pm == 0)

		stex_hba_stop(hba, ST_IGNORED);

	else

		stex_hba_stop(hba, ST_S5);

}

}





static int stex_choice_sleep_mic(pm_message_t state)

{

	switch (state.event) {

	case PM_EVENT_SUSPEND:

		return ST_S3;

	case PM_EVENT_HIBERNATE:

		return ST_S4;

	default:

		return ST_NOTHANDLED;

	}

}



static int stex_suspend(struct pci_dev *pdev, pm_message_t state)

{

	struct st_hba *hba = pci_get_drvdata(pdev);



	if (hba->cardtype == st_yel && hba->supports_pm == 1)

		stex_hba_stop(hba, stex_choice_sleep_mic(state));

	else

		stex_hba_stop(hba, ST_IGNORED);

	return 0;

}



static int stex_resume(struct pci_dev *pdev)

{

	struct st_hba *hba = pci_get_drvdata(pdev);



	hba->mu_status = MU_STATE_STARTING;

	stex_handshake(hba);

	return 0;

}

MODULE_DEVICE_TABLE(pci, stex_pci_tbl);

MODULE_DEVICE_TABLE(pci, stex_pci_tbl);





static struct pci_driver stex_pci_driver = {

static struct pci_driver stex_pci_driver = {
@@ -1812,6 +1872,8 @@ static struct pci_driver stex_pci_driver = { 
	.probe		= stex_probe,

	.probe		= stex_probe,

	.remove		= stex_remove,

	.remove		= stex_remove,

	.shutdown	= stex_shutdown,

	.shutdown	= stex_shutdown,

	.suspend	= stex_suspend,

	.resume		= stex_resume,

};

};





static int __init stex_init(void)

static int __init stex_init(void)