Ticket #781: lm4857_off_on_suspend_and_shutdown.patch

sound/soc/s3c24xx/neo1973_wm8753.c

@@ -615 +615 @@
         return i2c_probe(adap, &addr_data, lm4857_amp_probe);
 }
 
+static u8 lm4857_state;
+
+static int lm4857_suspend(struct device * dev, pm_message_t state)
+{
+  //printk("Suspend Called");
+  if (lm4857_state = (lm4857_regs[LM4857_CTRL] & 0xF)) {
+    lm4857_regs[LM4857_CTRL] &= 0xf0;
+    lm4857_write_regs();
+  }
+  return 0;
+}
+
+static int lm4857_resume(struct device * dev)
+{
+  //printk("Resume Called");
+  if (lm4857_state) {
+    lm4857_regs[LM4857_CTRL] |= (lm4857_state & 0x0f);
+    lm4857_write_regs();
+  }
+  return 0;
+}
+
+static void lm4857_shutdown(struct device * dev)
+{
+  lm4857_regs[LM4857_CTRL] &= 0xf0;
+  lm4857_write_regs();
+}
+
 /* corgi i2c codec control layer */
 static struct i2c_driver lm4857_i2c_driver = {
         .driver = {
                 .name = "LM4857 I2C Amp",
                 .owner = THIS_MODULE,
+                .suspend = lm4857_suspend,
+                .resume = lm4857_resume,
+                .shutdown = lm4857_shutdown,
         },
         .id =             I2C_DRIVERID_LM4857,
         .attach_adapter = lm4857_i2c_attach,