sunxi: Fix clock_twi_onoff for sun6i

The clock_sun6i.c implementation was not deasserting the reset for
the regular i2c controllers, this commit fixes this.

Signed-off-by: Hans de Goede <hdegoede@redhat.com>
Acked-by: Ian Campbell <ijc@hellion.org.uk>

diff --git a/arch/arm/cpu/armv7/sunxi/clock_sun6i.c b/arch/arm/cpu/armv7/sunxi/clock_sun6i.c
index 700b605..4e1e1a4 100644 (file)
--- a/arch/arm/cpu/armv7/sunxi/clock_sun6i.c
+++ b/arch/arm/cpu/armv7/sunxi/clock_sun6i.c
@@ -100,13 +100,18 @@ int clock_twi_onoff(int port, int state)
                return 0;
        }
 
-       /* set the apb clock gate for twi */
-       if (state)
+       /* set the apb clock gate and reset for twi */
+       if (state) {
                setbits_le32(&ccm->apb2_gate,
                             CLK_GATE_OPEN << (APB2_GATE_TWI_SHIFT+port));
-       else
+               setbits_le32(&ccm->apb2_reset_cfg,
+                            1 << (APB2_RESET_TWI_SHIFT + port));
+       } else {
+               clrbits_le32(&ccm->apb2_reset_cfg,
+                            1 << (APB2_RESET_TWI_SHIFT + port));
                clrbits_le32(&ccm->apb2_gate,
                             CLK_GATE_OPEN << (APB2_GATE_TWI_SHIFT+port));
+       }
 
        return 0;
 }