2 files changed, 13 insertions, 23 deletions

diff --git a/firmware/drivers/audio/wm8758.c b/firmware/drivers/audio/wm8758.c
index 40ead0cdf2..12ca987bd7 100644
--- a/firmware/drivers/audio/wm8758.c
+++ b/firmware/drivers/audio/wm8758.c
@@ -183,19 +183,15 @@ void audiohw_set_lineout_vol(int vol_l, int vol_r)
 
 void audiohw_enable_lineout(bool enable)
 {
+    /* Initialize data without lineout enabling. */
+    int pwrmgmt3_data  = PWRMGMT3_RMIXEN  | PWRMGMT3_LMIXEN
+                       | PWRMGMT3_DACENR  | PWRMGMT3_DACENL;
+    /* Set lineout (OUT2), if enabled. */ 
     if (enable)
-    {
-        /* include enabling of OUT2 */
-        wmcodec_write(PWRMGMT3, PWRMGMT3_LOUT2EN | PWRMGMT3_ROUT2EN
-                              | PWRMGMT3_RMIXEN | PWRMGMT3_LMIXEN
-                              | PWRMGMT3_DACENR | PWRMGMT3_DACENL);
-    }
-    else
-    {
-        /* exclude enabling of OUT2 */
-        wmcodec_write(PWRMGMT3, PWRMGMT3_RMIXEN | PWRMGMT3_LMIXEN
-                              | PWRMGMT3_DACENR | PWRMGMT3_DACENL);
-    }
+        pwrmgmt3_data |= PWRMGMT3_LOUT2EN | PWRMGMT3_ROUT2EN;
+
+    /* Set register. */
+    wmcodec_write(PWRMGMT3, pwrmgmt3_data);
 }
 
 void audiohw_set_bass(int value)
diff --git a/firmware/target/arm/ipod/powermgmt-ipod-pcf.c b/firmware/target/arm/ipod/powermgmt-ipod-pcf.c
index 95f5380b92..c939f398e3 100644
--- a/firmware/target/arm/ipod/powermgmt-ipod-pcf.c
+++ b/firmware/target/arm/ipod/powermgmt-ipod-pcf.c
@@ -117,17 +117,11 @@ unsigned int battery_adc_voltage(void)
 #ifdef HAVE_ACCESSORY_SUPPLY
 void accessory_supply_set(bool enable)
 {
-    if (enable)
-    {
-        /* Accessory voltage supply on */
-        pcf50605_write(PCF5060X_D2REGC1, 0xf8); /* 3.3V ON */
-    }
-    else
-    {
-        /* Accessory voltage supply off */
-        pcf50605_write(PCF5060X_D2REGC1, 0x18); /* OFF */
-    }
-
+    /* Set accessory power supply to 3.3V, otherwise switch it off. */
+    unsigned char value = enable ? 0xf8 : 0x18;
+    
+    /* Write to register. */
+    pcf50605_write(PCF5060X_D2REGC1, value);
 }
 #endif