ssb: reset device only if it was enabled

Signed-off-by: Rafał Miłecki <zajec5@gmail.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

drivers/ssb/main.c

@@ -1226,6 +1226,8 @@ void ssb_device_disable(struct ssb_device *dev, u32 core_specific_flags)
 		return;
 
 	reject = ssb_tmslow_reject_bitmask(dev);
+
+	if (ssb_read32(dev, SSB_TMSLOW) & SSB_TMSLOW_CLOCK) {
 		ssb_write32(dev, SSB_TMSLOW, reject | SSB_TMSLOW_CLOCK);
 		ssb_wait_bits(dev, SSB_TMSLOW, reject, 1000, 1);
 		ssb_wait_bits(dev, SSB_TMSHIGH, SSB_TMSHIGH_BUSY, 1000, 0);
@@ -1234,7 +1236,8 @@ void ssb_device_disable(struct ssb_device *dev, u32 core_specific_flags)
 			val = ssb_read32(dev, SSB_IMSTATE);
 			val |= SSB_IMSTATE_REJECT;
 			ssb_write32(dev, SSB_IMSTATE, val);
-		ssb_wait_bits(dev, SSB_IMSTATE, SSB_IMSTATE_BUSY, 1000, 0);
+			ssb_wait_bits(dev, SSB_IMSTATE, SSB_IMSTATE_BUSY, 1000,
+				      0);
 		}
 
 		ssb_write32(dev, SSB_TMSLOW,
@@ -1248,6 +1251,7 @@ void ssb_device_disable(struct ssb_device *dev, u32 core_specific_flags)
 			val &= ~SSB_IMSTATE_REJECT;
 			ssb_write32(dev, SSB_IMSTATE, val);
 		}
+	}
 
 	ssb_write32(dev, SSB_TMSLOW,
 		    reject | SSB_TMSLOW_RESET |