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

Commit 806bb768 authored by John Garry's avatar John Garry Committed by Martin K. Petersen
Browse files

hisi_sas: add init_id_frame_v2_hw() 



Signed-off-by: default avatarJohn Garry <john.garry@huawei.com>
Reviewed-by: default avatarHannes Reinecke <hare@suse.de>
Signed-off-by: default avatarMartin K. Petersen <martin.petersen@oracle.com>
parent 94eac9e1

drivers/scsi/hisi_sas/hisi_sas_v2_hw.c

+40 −0
Original line number Diff line number Diff line
@@ -288,6 +288,44 @@ static u32 hisi_sas_phy_read32(struct hisi_hba *hisi_hba, 
	return readl(regs);

}



static void config_id_frame_v2_hw(struct hisi_hba *hisi_hba, int phy_no)

{

	struct sas_identify_frame identify_frame;

	u32 *identify_buffer;



	memset(&identify_frame, 0, sizeof(identify_frame));

	identify_frame.dev_type = SAS_END_DEVICE;

	identify_frame.frame_type = 0;

	identify_frame._un1 = 1;

	identify_frame.initiator_bits = SAS_PROTOCOL_ALL;

	identify_frame.target_bits = SAS_PROTOCOL_NONE;

	memcpy(&identify_frame._un4_11[0], hisi_hba->sas_addr, SAS_ADDR_SIZE);

	memcpy(&identify_frame.sas_addr[0], hisi_hba->sas_addr,	SAS_ADDR_SIZE);

	identify_frame.phy_id = phy_no;

	identify_buffer = (u32 *)(&identify_frame);



	hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD0,

			__swab32(identify_buffer[0]));

	hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD1,

			identify_buffer[2]);

	hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD2,

			identify_buffer[1]);

	hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD3,

			identify_buffer[4]);

	hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD4,

			identify_buffer[3]);

	hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD5,

			__swab32(identify_buffer[5]));

}



static void init_id_frame_v2_hw(struct hisi_hba *hisi_hba)

{

	int i;



	for (i = 0; i < hisi_hba->n_phy; i++)

		config_id_frame_v2_hw(hisi_hba, i);

}



static int reset_hw_v2_hw(struct hisi_hba *hisi_hba)

{

	int i, reset_val;
@@ -520,6 +558,8 @@ static int hw_init_v2_hw(struct hisi_hba *hisi_hba) 
	msleep(100);

	init_reg_v2_hw(hisi_hba);



	init_id_frame_v2_hw(hisi_hba);



	return 0;

}