soc: qcom: rpmh-rsc: Factor "tcs_reg_addr" and "tcs_cmd_addr" calculation

 *  +---------------------------------------------------+

 */

static u32 read_tcs_cmd(struct rsc_drv *drv, int reg, int tcs_id, int cmd_id)

static inline void __iomem *

tcs_reg_addr(const struct rsc_drv *drv, int reg, int tcs_id)

{

	return readl_relaxed(drv->tcs_base + RSC_DRV_TCS_OFFSET * tcs_id + reg +

			     RSC_DRV_CMD_OFFSET * cmd_id);

	return drv->tcs_base + RSC_DRV_TCS_OFFSET * tcs_id + reg;

}

static u32 read_tcs_reg(struct rsc_drv *drv, int reg, int tcs_id)

static inline void __iomem *

tcs_cmd_addr(const struct rsc_drv *drv, int reg, int tcs_id, int cmd_id)

{

	return readl_relaxed(drv->tcs_base + RSC_DRV_TCS_OFFSET * tcs_id + reg);

	return tcs_reg_addr(drv, reg, tcs_id) + RSC_DRV_CMD_OFFSET * cmd_id;

}

static void write_tcs_cmd(struct rsc_drv *drv, int reg, int tcs_id, int cmd_id,

			  u32 data)

static u32 read_tcs_cmd(const struct rsc_drv *drv, int reg, int tcs_id,

			int cmd_id)

{

	return readl_relaxed(tcs_cmd_addr(drv, reg, tcs_id, cmd_id));

}

static u32 read_tcs_reg(const struct rsc_drv *drv, int reg, int tcs_id)

{

	writel_relaxed(data, drv->tcs_base + RSC_DRV_TCS_OFFSET * tcs_id + reg +

		       RSC_DRV_CMD_OFFSET * cmd_id);

	return readl_relaxed(tcs_reg_addr(drv, reg, tcs_id));

}

static void write_tcs_reg(struct rsc_drv *drv, int reg, int tcs_id, u32 data)

static void write_tcs_cmd(const struct rsc_drv *drv, int reg, int tcs_id,

			  int cmd_id, u32 data)

{

	writel_relaxed(data, tcs_cmd_addr(drv, reg, tcs_id, cmd_id));

}

static void write_tcs_reg(const struct rsc_drv *drv, int reg, int tcs_id,

			  u32 data)

{

	writel_relaxed(data, drv->tcs_base + RSC_DRV_TCS_OFFSET * tcs_id + reg);

	writel_relaxed(data, tcs_reg_addr(drv, reg, tcs_id));

}

static void write_tcs_reg_sync(struct rsc_drv *drv, int reg, int tcs_id,

static void write_tcs_reg_sync(const struct rsc_drv *drv, int reg, int tcs_id,

			       u32 data)

{

	writel(data, drv->tcs_base + RSC_DRV_TCS_OFFSET * tcs_id + reg);

	writel(data, tcs_reg_addr(drv, reg, tcs_id));

	for (;;) {

		if (data == readl(drv->tcs_base + reg +

				  RSC_DRV_TCS_OFFSET * tcs_id))

		if (data == readl(tcs_reg_addr(drv, reg, tcs_id)))

			break;

		udelay(1);

	}