bcma: cc: set GPIOTIMER register

We use value supplied via SPROM, or default 10:90 as fallback.

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

diff --git a/drivers/bcma/driver_chipcommon.c b/drivers/bcma/driver_chipcommon.c
index 606102256b449af47bf23e26f4e3d2c7e0b8002c..fb543024df2f7529920b577607539920cfa8d202 100644 (file)
--- a/drivers/bcma/driver_chipcommon.c
+++ b/drivers/bcma/driver_chipcommon.c
@@ -23,6 +23,9 @@ static inline u32 bcma_cc_write32_masked(struct bcma_drv_cc *cc, u16 offset,
 
 void bcma_core_chipcommon_init(struct bcma_drv_cc *cc)
 {
+       u32 leddc_on = 10;
+       u32 leddc_off = 90;
+
        if (cc->core->id.rev >= 11)
                cc->status = bcma_cc_read32(cc, BCMA_CC_CHIPSTAT);
        cc->capabilities = bcma_cc_read32(cc, BCMA_CC_CAP);
@@ -38,6 +41,17 @@ void bcma_core_chipcommon_init(struct bcma_drv_cc *cc)
                bcma_pmu_init(cc);
        if (cc->capabilities & BCMA_CC_CAP_PCTL)
                pr_err("Power control not implemented!\n");
+
+       if (cc->core->id.rev >= 16) {
+               if (cc->core->bus->sprom.leddc_on_time &&
+                   cc->core->bus->sprom.leddc_off_time) {
+                       leddc_on = cc->core->bus->sprom.leddc_on_time;
+                       leddc_off = cc->core->bus->sprom.leddc_off_time;
+               }
+               bcma_cc_write32(cc, BCMA_CC_GPIOTIMER,
+                       ((leddc_on << BCMA_CC_GPIOTIMER_ONTIME_SHIFT) |
+                        (leddc_off << BCMA_CC_GPIOTIMER_OFFTIME_SHIFT)));
+       }
 }
 
 /* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */