[U-Boot] [PATCH 3/5] imx: mx6qp: Adjust AQos settings for peripherals

[Peng Fan]

To resolve USB camera bandwidth issue, the patch sets recommended AQoS
setting from IC team value for peripheral and only on imx6qp.

Signed-off-by: Peng Fan <peng.fan at nxp.com>
Cc: Stefano Babic <sbabic at denx.de>
Cc: Fabio Estevam <fabio.estevam at nxp.com>
---
 arch/arm/mach-imx/mx6/soc.c | 11 +++++++++++
 1 file changed, 11 insertions(+)

diff --git a/arch/arm/mach-imx/mx6/soc.c b/arch/arm/mach-imx/mx6/soc.c
index 9c3c8dd..e2ecc3a 100644
--- a/arch/arm/mach-imx/mx6/soc.c
+++ b/arch/arm/mach-imx/mx6/soc.c
@@ -362,6 +362,9 @@ static void set_preclk_from_osc(void)
 
 int arch_cpu_init(void)
 {
+	struct sched_ctrl_regs *regs =
+		(struct sched_ctrl_regs *)MF2_SCHED_BASE_ADDR;
+
 	init_aips();
 
 	/* Need to clear MMDC_CHx_MASK to make warm reset work. */
@@ -431,6 +434,14 @@ int arch_cpu_init(void)
 
 	imx_set_wdog_powerdown(false); /* Disable PDE bit of WMCR register */
 
+	/*
+	 * To resolve USB camera bandwidth issue, the patch sets
+	 * recommended AQoS setting from IC team value for peripheral
+	 * and only on imx6qp.
+	 */
+	if (is_mx6dqp())
+		writel(0x80000201, &regs->aqos[AQOS_FAST1FARIC_ID].priority);
+
 	init_src();
 
 	return 0;
-- 
2.6.2