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

Commit 4ddca890 authored by Venkatesh Yadav Abbarapu's avatar Venkatesh Yadav Abbarapu
Browse files

msm: fsm-rfic: Add PVC index write support 



Add support for TIMED RF by adding IOCTLs to write SSBI address to
PVC index registers.

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

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

+73 −2
Original line number Diff line number Diff line
@@ -53,6 +53,7 @@ 
#define SSBI_ARB_PRI	0x3100

#define PVC_ADDR1	0x3400

#define PVC_ADDR2	0x3404

#define PVC_INDEX_MAX   9



#define FTR_RXGAIN_REG1  0xB8

#define FTR_RXGAIN_REG2  0xB9
@@ -108,6 +109,7 @@ struct mutex rficlock; 
static struct ftr_dev_node_info {

	void *grfcctrladdr;

	void *grfcmaskaddr;

	void *pvcaddr;

	unsigned int busselect[4];

	int maskvalue;

	struct device *dev;
@@ -306,9 +308,77 @@ static long ftr_ioctl(struct file *file, 
				RFIC_FTR_GET_ADDR(rficaddr), &value, 1);



			mutex_unlock(&pdev->lock);

		}

		break;



			if (ret)

				return ret;

	case RFIC_IOCTL_WRITE_PVC_REGISTER:

		{

		    struct rfic_write_register_param param;

		    unsigned int ssbiaddr;

		    u8 pvc_index;



		    if (copy_from_user(&param, argp, sizeof(param)))

			return -EFAULT;



		    ssbiaddr = param.rficaddr;

		    pvc_index = (u8) param.value;



		    if (pvc_index > PVC_INDEX_MAX) {

			pr_err("%s: %d PVC index exceeds max (10)\n",

				__func__, pvc_index);

			return -EINVAL;

		    }



		    mutex_lock(&pdev->lock);



		    writel_relaxed(PVC_INTF_EN, pdev->pvcaddr + PVC_INTF_CTL);

		    writel_relaxed(PVC_PORT_EN, pdev->pvcaddr + PVC_PORT_CTL);

		    writel_relaxed(ARB_PRI_VAL, pdev->pvcaddr + SSBI_ARB_PRI);

		    writel_relaxed(ssbiaddr, pdev->pvcaddr + PVC_ADDR1 +

			    pvc_index * 4);



		    mutex_unlock(&pdev->lock);



		    return 0;

		}

		break;



	case RFIC_IOCTL_WRITE_PVC_REGISTER_WITH_BUS:

		{

		    struct rfic_write_register_param param;

		    unsigned int ssbiaddr;

		    u8 pvc_index;



		    if (copy_from_user(&param, argp, sizeof(param)))

			return -EFAULT;



		    ssbiaddr = param.rficaddr;

		    pvc_index = (u8) param.value;



		    if (pvc_index > PVC_INDEX_MAX) {

			pr_err("%s: %d PVC index exceeds max (10)\n",

				__func__, pvc_index);

			return -EINVAL;

		    }



		    mutex_lock(&pdev->lock);



		    if (((pdfi->ftrid == 1) || (pdfi->ftrid == 2))

				&& (rfbid < RF_TYPE_48)) {

			__raw_writel(

				pdev->busselect[RFIC_FTR_GET_BUS(ssbiaddr)],

				pdev->grfcctrladdr);

			mb();

		    }

		    writel_relaxed(PVC_INTF_EN, pdev->pvcaddr + PVC_INTF_CTL);

		    writel_relaxed(PVC_PORT_EN, pdev->pvcaddr + PVC_PORT_CTL);

		    writel_relaxed(ARB_PRI_VAL, pdev->pvcaddr + SSBI_ARB_PRI);

		    writel_relaxed(ssbiaddr, pdev->pvcaddr + PVC_ADDR1 +

			    pvc_index * 4);



		    mutex_unlock(&pdev->lock);



		    return 0;

		}

		break;
@@ -958,6 +1028,7 @@ static int ftr_probe(struct platform_device *pdev) 
	if ((n_dev >= 1)  && (n_dev <= 7)) {

		struct ssbi *ssbi =

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

		ptr->pvcaddr = ssbi->base;

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

			ssbi->controller_type =

				FSM_SBI_CTRL_GENI_SSBI2_ARBITER;

include/linux/fsm_rfic.h

+6 −0
Original line number Diff line number Diff line
@@ -121,6 +121,12 @@ struct rfic_wfm_param { 
#define RFIC_IOCTL_WRITE_REGISTER_WITH_MASK \

	_IOC(_IOC_WRITE, RFIC_IOCTL_MAGIC, 0x03, \

		sizeof(struct rfic_write_register_mask_param *))

#define RFIC_IOCTL_WRITE_PVC_REGISTER \

	_IOC(_IOC_WRITE, RFIC_IOCTL_MAGIC, 0x04, \

		sizeof(struct rfic_write_register_param *))

#define RFIC_IOCTL_WRITE_PVC_REGISTER_WITH_BUS \

	_IOC(_IOC_WRITE, RFIC_IOCTL_MAGIC, 0x05, \

		sizeof(struct rfic_write_register_param *))

#define RFIC_IOCTL_GET_GRFC \

	_IOC(_IOC_WRITE, RFIC_IOCTL_MAGIC, 0x10, \

		sizeof(struct rfic_grfc_param *))