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

Commit 8362ca5d authored by Venkatesh Yadav Abbarapu's avatar Venkatesh Yadav Abbarapu
Browse files

msm: fsm_rfic: Add PVC table entries to rfic driver 



Add PVC table entries to FTR, WTR and MTR to support AGC. Add
checks to validate inputs.

Change-Id: I8fd225d92fa1a25b1d6652acb2eca8cfc0160c4a
Acked-by: default avatarEdward Rodrigues <erodrigu@qti.qualcomm.com>
Signed-off-by: default avatarVenkatesh Yadav Abbarapu <quicvenkat@codeaurora.org>
parent d3904af2

arch/arm/mach-msm/rfic-fsm9900.c

+72 −17
Original line number Diff line number Diff line
@@ -45,6 +45,20 @@ 
#define GENI_ARB_MISC_CONFIG_ADDR	  0x3004

#define GENI_ARB_CHNL_CONFIG_ADDDR	  0x3804



#define PVC_INTF_EN	0x1

#define PVC_INTF_CTL	0x3008

#define PVC_PORT_EN	0x3

#define PVC_PORT_CTL	0x3200

#define ARB_PRI_VAL	0x3f

#define SSBI_ARB_PRI	0x3100

#define PVC_ADDR1	0x3400

#define PVC_ADDR2	0x3404



#define FTR_RXGAIN_REG1  0xB8

#define FTR_RXGAIN_REG2  0xB9

#define WTR_RXGAIN_REG1  0x80

#define WTR_RXGAIN_REG2  0x81

#define MTR_RXGAIN_REG   0x7E

/*

 * FTR8700, WTR1605  RFIC

 */
@@ -79,6 +93,8 @@ 
#define PDM_WORD	0x8000

#define MSM_MAX_GPIO    32



#define RF_MAX_WF_SIZE  0xA00000



uint8_t rfbid;

void __iomem *grfc_base;

void __iomem *pdm_base;
@@ -105,7 +121,7 @@ struct ftr_dev_file_info { 
	int ftrid;

};



int nDev;

int n_dev;

/*

 * File interface

 */
@@ -394,6 +410,7 @@ static long ftr_ioctl(struct file *file, 
	case RFIC_IOCTL_SET_WFM:

		{

			struct rfic_wfm_param param;

			unsigned int p_sum;



			if (pdfi->ftrid != 0)

				return -EINVAL;
@@ -401,7 +418,16 @@ static long ftr_ioctl(struct file *file, 
			if (copy_from_user(&param, argp, sizeof(param)))

				return -EFAULT;



			if (param.offset + param.num > 0xA00000)

			/* Check for integer overflow */

			if (param.offset > UINT_MAX - param.num)

				return -EINVAL;



			p_sum = param.offset + param.num;



			if (p_sum < param.offset || p_sum < param.num)

				return -EINVAL;



			if (p_sum  >  RF_MAX_WF_SIZE)

				return -EINVAL;



			if (copy_from_user(wf_base + param.offset,
@@ -792,6 +818,29 @@ void pdm_mtr_enable(void) 
	__raw_writel(0xb2, pdm_base + PDM_2_1_CTL + 4);

}



void rfic_pvc_enable(void __iomem *pvc_addr, int rfic)

{

	writel_relaxed(PVC_INTF_EN, pvc_addr + PVC_INTF_CTL);

	writel_relaxed(PVC_PORT_EN, pvc_addr + PVC_PORT_CTL);

	writel_relaxed(ARB_PRI_VAL, pvc_addr + SSBI_ARB_PRI);

	switch (rfic) {

	case 1:

		writel_relaxed(FTR_RXGAIN_REG1, pvc_addr + PVC_ADDR1);

		writel_relaxed(FTR_RXGAIN_REG2, pvc_addr + PVC_ADDR2);

		break;

	case 2:

		writel_relaxed(WTR_RXGAIN_REG1, pvc_addr + PVC_ADDR1);

		writel_relaxed(WTR_RXGAIN_REG2, pvc_addr + PVC_ADDR2);

		break;

	case 3:

		writel_relaxed(MTR_RXGAIN_REG, pvc_addr + PVC_ADDR1);

		break;

	default:

		pr_err("%s: Unsupported RFIC\n", __func__);

		break;

	}

}





static int ftr_probe(struct platform_device *pdev)

{
@@ -807,13 +856,13 @@ static int ftr_probe(struct platform_device *pdev) 


	mutex_lock(&rficlock);



	if (nDev >= RFIC_DEVICE_NUM) {

		pr_warn("%s: Invalid devices %d\n", __func__, nDev);

	if (n_dev >= RFIC_DEVICE_NUM) {

		pr_warn("%s: Invalid devices %d\n", __func__, n_dev);

		mutex_unlock(&rficlock);

		return -EINVAL;

	}



	if (!nDev) {

	if (!n_dev) {

		rfbid = rf_interface_id();

		if ((rfbid != 0xff) && (rfbid != 0))

			rfbid = rfbid & RF_TYPE_48;
@@ -900,30 +949,36 @@ static int ftr_probe(struct platform_device *pdev) 


	}



	ptr = ftr_dev_info + nDev;

	ptr = ftr_dev_info + n_dev;

	ptr->dev = &pdev->dev;



	if ((nDev >= 1)  && (nDev <= 7)) {

	if ((n_dev >= 1)  && (n_dev <= 7)) {

		struct ssbi *ssbi =

		platform_get_drvdata(to_platform_device(pdev->dev.parent));

		if ((rfbid > RF_TYPE_48) && (nDev <= 4)) {

		if ((rfbid > RF_TYPE_48) && (n_dev <= 4)) {

			ssbi->controller_type =

				FSM_SBI_CTRL_GENI_SSBI2_ARBITER;

			set_ssbi_mode_2(ssbi->base);

			pr_debug("%s: SSBI2 = 0x%x\n", __func__,

				ssbi->controller_type);

			rfic_pvc_enable(ssbi->base, 3);

		} else {

			ssbi->controller_type =

				FSM_SBI_CTRL_GENI_SSBI_ARBITER;

			set_ssbi_mode_1(ssbi->base);

			pr_debug("%s: SSBI1 = 0x%x\n", __func__,

				ssbi->controller_type);

			if ((n_dev == 1) || (n_dev == 2))

				rfic_pvc_enable(ssbi->base, 1);

			if ((n_dev == 3) && (rfbid > RF_TYPE_16)

					&& (rfbid < RF_TYPE_32))

				rfic_pvc_enable(ssbi->base, 2);

		}

		platform_set_drvdata(to_platform_device(pdev->dev.parent),

				ssbi);

	}



	if ((rfbid > RF_TYPE_16) && (rfbid < RF_TYPE_48) && (nDev == 1)) {

	if ((rfbid > RF_TYPE_16) && (rfbid < RF_TYPE_48) && (n_dev == 1)) {

		ssbi_write(pdev->dev.parent, 0xff, &version, 1);

		ssbi_read(pdev->dev.parent, 0x2, &version, 1);

		pr_info("%s: FTR1 Version = %02x\n", __func__, version);
@@ -937,7 +992,7 @@ static int ftr_probe(struct platform_device *pdev) 
		ptr->busselect[MISC_BUS] = 0x00000800;

		ptr->busselect[RX_BUS] = 0x00001800;

	} else if ((rfbid > RF_TYPE_16) && (rfbid < RF_TYPE_48) &&

		(nDev == 2)) {

		(n_dev == 2)) {

		ssbi_write(pdev->dev.parent, 0xff, &version, 1);

		ssbi_read(pdev->dev.parent, 0x2, &version, 1);

		pr_info("%s: FTR2 Version = %02x\n", __func__, version);
@@ -955,25 +1010,25 @@ static int ftr_probe(struct platform_device *pdev) 
	mutex_init(&ptr->lock);



	if (rfbid < RF_TYPE_48) {

		ret = misc_register(ftr_misc_dev + nDev);

		ret = misc_register(ftr_misc_dev + n_dev);



		if (ret < 0) {

			misc_deregister(ftr_misc_dev + nDev);

			misc_deregister(ftr_misc_dev + n_dev);

			mutex_unlock(&rficlock);

			return ret;

		}

	} else {

		ret = misc_register(mtr_misc_dev + nDev);

		ret = misc_register(mtr_misc_dev + n_dev);



		if (ret < 0) {

			misc_deregister(mtr_misc_dev + nDev);

			misc_deregister(mtr_misc_dev + n_dev);

			mutex_unlock(&rficlock);

			return ret;

		}

	}



	nDev++;

	pr_debug("%s: num_of_ssbi_devices = %d\n", __func__, nDev);

	n_dev++;

	pr_debug("%s: num_of_ssbi_devices = %d\n", __func__, n_dev);

	mutex_unlock(&rficlock);



	return of_platform_populate(np, NULL, NULL, &pdev->dev);
@@ -1014,7 +1069,7 @@ int __init ftr_init(void) 
{

	int rc;



	nDev = 0;

	n_dev = 0;

	mutex_init(&rficlock);

	pr_debug("%s: rfic-fsm9900 driver init\n",  __func__);

	rc = platform_driver_register(&ftr_driver);