mfd: Add support for multiple arizona PDM speaker outputs

The registers have stride 2 so we can write the loop properly now.

Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>

2 files changed, 3 insertions, 4 deletions

diff --git a/drivers/mfd/arizona-core.c b/drivers/mfd/arizona-core.c
index ffa011f4677e..b35680dcd8c1 100644
--- a/drivers/mfd/arizona-core.c
+++ b/drivers/mfd/arizona-core.c
@@ -462,18 +462,17 @@ int __devinit arizona_dev_init(struct arizona *arizona)
                                    ARIZONA_OUT1_MONO, val);
         }
 
-        BUILD_BUG_ON(ARIZONA_MAX_PDM_SPK > 1);
         for (i = 0; i < ARIZONA_MAX_PDM_SPK; i++) {
                 if (arizona->pdata.spk_mute[i])
                         regmap_update_bits(arizona->regmap,
-                                           ARIZONA_PDM_SPK1_CTRL_1,
+                                           ARIZONA_PDM_SPK1_CTRL_1 + (i * 2),
                                            ARIZONA_SPK1_MUTE_ENDIAN_MASK |
                                            ARIZONA_SPK1_MUTE_SEQ1_MASK,
                                            arizona->pdata.spk_mute[i]);
 
                 if (arizona->pdata.spk_fmt[i])
                         regmap_update_bits(arizona->regmap,
-                                           ARIZONA_PDM_SPK1_CTRL_2,
+                                           ARIZONA_PDM_SPK1_CTRL_2 + (i * 2),
                                            ARIZONA_SPK1_FMT_MASK,
                                            arizona->pdata.spk_fmt[i]);
         }
diff --git a/include/linux/mfd/arizona/pdata.h b/include/linux/mfd/arizona/pdata.h
index fa2cb9885d62..68ff91aa3888 100644
--- a/include/linux/mfd/arizona/pdata.h
+++ b/include/linux/mfd/arizona/pdata.h
@@ -62,7 +62,7 @@
 
 #define ARIZONA_MAX_OUTPUT 5
 
-#define ARIZONA_MAX_PDM_SPK 1
+#define ARIZONA_MAX_PDM_SPK 2
 
 struct regulator_init_data;